Debugged some issues with torque and residual computation. Things seem to work now, but the torque residual is more sensitive than I’d like.