C# (CSharp) RTIMULibCS RTQuaternion.FromAngleVector Examples

Example #1

        public void AccelToQuaternion(out RTQuaternion qPose)
        {
            RTVector3 normAccel = this;
            RTVector3 vec;
            RTVector3 z = new RTVector3(0, 0, 1.0);

            qPose = new RTQuaternion();

            normAccel.Normalize();

            double angle = Math.Acos(RTVector3.DotProduct(z, normAccel));

            RTVector3.CrossProduct(normAccel, z, out vec);
            vec.Normalize();

            qPose.FromAngleVector(angle, vec);
        }

Example #2

File: RTVector3.cs Project: emmellsoft/RTIMULibCS

        public void AccelToQuaternion(out RTQuaternion qPose)
        {
            RTVector3 normAccel = this;
            RTVector3 vec;
            RTVector3 z = new RTVector3(0, 0, 1.0);
            qPose = new RTQuaternion();

            normAccel.Normalize();

            double angle = Math.Acos(RTVector3.DotProduct(z, normAccel));
            RTVector3.CrossProduct(normAccel, z, out vec);
            vec.Normalize();

            qPose.FromAngleVector(angle, vec);
        }