Trajectory got more tests.
Renaming class.
Now the robots angle are limited between -PI and PI.
Comments.
Fixing minor rendering issues.