Added safeguard to HeightMotor

If either limit switch is pressed, it will not move. The only workaround
is to use the cRIO.heightMotor.Set() function.
Implemented all "easy" DriveBase functions