Example #1
0
        /// <summary>
        /// 先平移后旋转
        /// </summary>
        /// <param name="angle"></param>
        /// <param name="point"></param>
        /// <param name="rotateDirection"></param>
        internal RotateMatrix RotateAt2D(double angle, Point3D point, ArcDirctionType rotateDirection)
        {
            if (rotateDirection == ArcDirctionType.UNKONW)
            {
                throw new Exception("ArcDirctionType is wrong.");
            }
            else if (rotateDirection == ArcDirctionType.CLOCK_WISE)
            {
                angle = -angle;
            }

            double[,] doubleNew = new double[this.m_row, this.m_col + 1];
            for (int i = 0; i < this.m_row; i++)
            {
                for (int j = 0; j < this.m_col; j++)
                {
                    doubleNew[i, j] = this.m_data[i, j];
                }
                doubleNew[i, this.m_col] = 1;
            }

            angle %= 360.0;

            RotateMatrix result = new RotateMatrix(doubleNew).Multiply(CreateRotationRadians2D(angle * (Math.PI / 180.0), point.X, point.Y));

            return(result);
        }
Example #2
0
        /// <summary>
        /// 旋转某角度
        /// </summary>
        /// <param name="angle"></param>
        ///  <param name="rotateDirection"></param>
        internal RotateMatrix Rotate2D(double angle, ArcDirctionType rotateDirection)
        {
            RotateMatrix result = RotateAt2D(angle, new Point3D()
            {
                X = 0, Y = 0, Z = 0
            }, rotateDirection);

            return(result);
        }
Example #3
0
        /// <summary>
        /// 乘法(乘以常数)
        /// </summary>
        /// <param name="count"></param>
        /// <returns></returns>
        internal RotateMatrix Multiply(double count)
        {
            RotateMatrix re = new RotateMatrix(m_row, m_col);

            for (int i = 0; i < m_row; i++)
            {
                for (int j = 0; j < m_col; j++)
                {
                    re.m_data[i, j] = m_data[i, j] * count;
                }
            }
            return(re);
        }
Example #4
0
        /// <summary>
        /// 减法
        /// </summary>
        /// <param name="matrix"></param>
        /// <returns></returns>
        internal RotateMatrix Subtract(RotateMatrix matrix)
        {
            if (m_row != matrix.Row || m_col != matrix.Column)
            {
                return(null);
            }

            RotateMatrix re = new RotateMatrix(m_row, m_col);

            for (int i = 0; i < matrix.Row; i++)
            {
                for (int j = 0; j < matrix.Column; j++)
                {
                    re.m_data[i, j] = m_data[i, j] - matrix.m_data[i, j];
                }
            }
            return(re);
        }
Example #5
0
        /// <summary>
        /// Creates a rotation transformation about the given point(2D)
        /// </summary>
        /// <param name="angle"></param>
        /// <param name="centerX"></param>
        /// <param name="centerY"></param>
        /// <returns></returns>
        internal static RotateMatrix CreateRotationRadians2D(double angle, double centerX, double centerY)
        {
            double[,] data = new double[3, 2];
            double sin = Math.Sin(angle);
            double cos = Math.Cos(angle);
            double dx  = (centerX * (1.0 - cos)) + (centerY * sin);
            double dy  = (centerY * (1.0 - cos)) - (centerX * sin);

            data[0, 0] = cos;
            data[0, 1] = sin;
            data[1, 0] = -sin;
            data[1, 1] = cos;
            data[2, 0] = dx;
            data[2, 1] = dy;

            RotateMatrix matrix = new RotateMatrix(data);

            return(matrix);
        }
Example #6
0
        /// <summary>
        /// 乘法(乘以矩阵)
        /// </summary>
        /// <param name="matrix"></param>
        /// <returns></returns>
        internal RotateMatrix Multiply(RotateMatrix matrix)
        {
            if (this.Column != matrix.Row)
            {
                return(null);
            }
            RotateMatrix re = new RotateMatrix(m_row, m_col);

            for (int i = 0; i < this.Row; i++)
            {
                for (int j = 0; j < matrix.Column; j++)
                {
                    for (int k = 0; k < this.Column; k++)
                    {
                        re.m_data[i, j] += m_data[i, k] * matrix.m_data[k, j];
                    }
                }
            }
            return(re);
        }