Exemple #1
0
        public Vector3d Rotate(Vector3d axis, double angle)
        {
            Vector3d vectorToRotate = this;
            Vector3d rotatedVector  = Vector3d.zero;

            if (axis.Equals(Vector3d.up) || axis.Equals(Vector3d.down))
            {
                rotatedVector.x = vectorToRotate.x * Mathd.Cos(angle) + vectorToRotate.z * Mathd.Sin(angle);
                rotatedVector.y = y;
                rotatedVector.z = -vectorToRotate.x * Mathd.Sin(angle) + vectorToRotate.z * Mathd.Cos(angle);
            }
            else if (axis.Equals(Vector3d.left) || axis.Equals(Vector3d.right))
            {
                rotatedVector.x = x;
                rotatedVector.y = vectorToRotate.y * Mathd.Cos(angle) - vectorToRotate.z * Mathd.Sin(angle);
                rotatedVector.z = vectorToRotate.y * Mathd.Sin(angle) + vectorToRotate.z * Mathd.Cos(angle);
            }
            else if (axis.Equals(Vector3d.forward) || axis.Equals(Vector3d.back))
            {
                rotatedVector.x = vectorToRotate.x * Mathd.Cos(angle) - vectorToRotate.y * Mathd.Sin(angle);
                rotatedVector.y = vectorToRotate.x * Mathd.Sin(angle) + vectorToRotate.y * Mathd.Cos(angle);
                rotatedVector.z = z;
            }
            return(rotatedVector);
        }