Bucket Update Code

Current Code that is running the simulator software.
Bucket position code has been updated by not checked.
Updates trigonometry functions

Now uses the atan2d function to ensure the angle calculated was correct
- LHH