gripper orientation difference
changed to use new control mode
added new control mode to enum ARM_FRAME_MAPPED=3
misc changes while testing optimize