Major changes: moveToLocation

Added moveToLocation function (untested)
Changed gear ratios
Moved function prototype below struct
Changed displayAngles parameters