Fixes with gripper control and update loop of arm controller