Wrote code for new vertical lift robot - teleop and NXT brick