Robot rotation (I think?) fixed

1 files changed, 10 insertions, 2 deletions

diff --git a/src/RobotRace.java b/src/RobotRace.java
index 05789e2..bcfceab 100644
--- a/src/RobotRace.java
+++ b/src/RobotRace.java
@@ -378,6 +378,11 @@ public class RobotRace extends Base {
                 // to 0 means robot is matching expected and great means that
                 // we have a turtle.
                 double jitter = current_t - robot.getTimePos();
+                
+                
+                
+                
+                
                 // TODO: do not use static speed
                 robot.setSpeed(TARGET_ROBOT_SPEED);
             }
@@ -408,8 +413,11 @@ public class RobotRace extends Base {
             // put robot centered on the lane, slightly rotated to look forward
             Vector robotPos = raceTrack.getPointForLane(robot.getTimePos(), i);
             gl.glTranslated(robotPos.x(), robotPos.y(), robotPos.z());
-            // FIXME: robot looks in wrong direction.
-            double angle = atan2(robotPos.y(), robotPos.x());
+            
+            // Calculate angle for the robots to look at, multiply by 180/PI
+            // to convert the radions to degrees. 
+            double angle = atan2(robotPos.y(), robotPos.x()) * 180/PI;
+            
             gl.glRotated(angle, 0, 0, 1);
 
             // Draw the current robot