Adding Inverse Tensor

This is a bug- incorrect math/derivation of DE for thetas from torque
Merge branch 'Fixing-Inverse-Tensor'
some changes?

plotting splines
Merge branch 'master' of https://github.com/shermanlam/E80-6DOF