Added gripper control and staged head control