Motor Control
The Algorithm in moving into the desired location
This is the 2nd part of the project - to move the robot to its desired location. This is based on the popular robotic soccer sin-cos formula, documented in 1995 CMU 1st robotic soccer paper.