Added lift encoder reset to RobotMain.update()
Organized FancyMotor.  Not tested.