Update joint torque and tcp wrench in ui