Added quaternion inversion
Added force frame interpretation switch (Inertial or Body [default is body])