Lin/Ang Velocity 6 trig functions