matrix inverse & scale
Constraints on double pendulum dynamics
(1) fix bugs in DoublePendulumConstrainForce
(2) hardcode matrix debugging print
(3) simple ui control 'play'/'stop
'