Added grabber control

Grabber added to code and motor assignment error corrected.