Friday's work
Theoretical, compiling code
Also added encoder code as backup. It *should* work. Encoder code is in block comments,
separated by a newline.
Deprecated servo implementation.
On a side note, I realize that we may have to put the blocks motor on a second controller since the wire may not be long enough...
but #yolo
Removed testing servo, switched to blocks
Robot will now move to the basket. Placing the basket is iffy.
yay workingz mostly
The go onto ramp part doesn't work yet.
TODO: REDUCE THE RETURNING TO ORIGINAL STATE TURN.