Program finished

6D dynamics is now correct. Interpolation is internal. Forces and
torques are now in the flow CS.