I have updated the TurnToObject class and now you can turn to the ball,
teammate, opponent. I still have to add goal after vision adds the goal
info. I have tested this quite extensively and it works. However when
mounting the marker onto the robot it sometimes fails when vision does
not pick up the dot in the correct position.
Okay, so I added the turn to goal function however i still have to
improve it after testing so it always turns the shorter angle to an open
goal. I have also made two new function getYellowUs() and
getYellowDefendingLeft() in ObjectLocations. Still need to test this
code.
adding pitch constants and shit
merging