Typo in formula. Remember last time called.
Disable torsion spring. Equations aren't correct yet.
Move state variable inside class.
Re-enable torsion equations. Fix rest position calculation. Not working yet