Added gripper angle and jaw control. Bug fixes,