use angular motor to rotate joint
x is twist; large mass more like fk
use kinematic obj to set tm instead of force and torque