From cbfd16060e8352d7ea8f05d9bb8d58253243930d Mon Sep 17 00:00:00 2001 From: Frank v/d Haterd Date: Sun, 22 Dec 2013 16:53:17 +0100 Subject: New commit of the rotation, seems to be working now. --- src/RobotRace.java | 13 ++++++++++--- 1 file changed, 10 insertions(+), 3 deletions(-) diff --git a/src/RobotRace.java b/src/RobotRace.java index bcfceab..ee7fbcc 100644 --- a/src/RobotRace.java +++ b/src/RobotRace.java @@ -414,9 +414,16 @@ public class RobotRace extends Base { Vector robotPos = raceTrack.getPointForLane(robot.getTimePos(), i); gl.glTranslated(robotPos.x(), robotPos.y(), robotPos.z()); - // 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; + /* Calculate angle for the robots to look at, multiply by 180/PI + * to convert the radions to degrees. + * First get the tangent of the robot, that is the real direction + * where the robot is looking to. + * Then add this vector to the actual position, and from the + * resulting vector we can calculate the angle. */ + Vector robotTangent = raceTrack.getTangent(robot.getTimePos()); + Vector totalVector = robotTangent.add(robotPos); + + double angle = atan2(totalVector.y(), totalVector.x()) * 180/PI; gl.glRotated(angle, 0, 0, 1); -- cgit v1.2.1