Gripper code for R5 bot

Dependents:   GrabTest R5 2016 Robotics Team 1