Get rid of all the joint angle nonsense, fix gripper stuff clicking. That method for moving both arms works.