-(define-public (coord-rotate coordinate degrees-in-radians)
- (let*
- ((coordinate
- (cons
- (exact->inexact (coord-x coordinate))
- (exact->inexact (coord-y coordinate))))
- (radius
- (sqrt
- (+ (* (coord-x coordinate) (coord-x coordinate))
- (* (coord-y coordinate) (coord-y coordinate)))))
- (angle (angle-0-2pi (atan (coord-y coordinate) (coord-x coordinate)))))
- (cons
- (* radius (cos (+ angle degrees-in-radians)))
- (* radius (sin (+ angle degrees-in-radians))))))
+(define-public (coord-rotate coordinate angle-in-radians)
+ ;; getting around (sin PI) not being exactly zero by switching to cos at
+ ;; appropiate angles and/or taking the negative value (vice versa for cos)
+ (let* ((quadrant (inexact->exact (round (/ angle-in-radians (/ PI 2)))))
+ (moved-angle (- angle-in-radians (* quadrant (/ PI 2))))
+ (s (sin moved-angle))
+ (c (cos moved-angle))
+ (x (coord-x coordinate))
+ (y (coord-y coordinate)))
+ (case (modulo quadrant 4)
+ ((0) ;; -45 .. 45
+ (cons (- (* c x) (* s y))
+ (+ (* s x) (* c y))))
+ ((1) ;; 45 .. 135
+ (cons (- (* (- s) x) (* c y))
+ (+ (* c x) (* (- s) y))))
+ ((2) ;; 135 .. 225
+ (cons (- (* (- c) x) (* (- s) y))
+ (+ (* (- s) x) (* (- c) y))))
+ ((3) ;; 225 .. 315
+ (cons (- (* s x) (* (- c) y))
+ (+ (* (- c) x) (* s y))))
+ ;; for other angles (modulo quadrant 4) returns one of the above cases
+ )))