Added code to control rack & pinion

Wrote code to control rack and pinion (basically copy of arm control
code). Directions should be correct for motor facing in same direction
as arm motor above.