Added code for first mini challenge

Now has functions for forward, right, and orbit.
This is all based on testing by eye and accounts for motor speed
discrepancy.