第一次作业

  1 #include <iostream>
  2 #include <string>
  3 #include <Eigen/Dense>
  4 #include "math.h"
  5 #include <stdlib.h>
  6 
  7 #define pi 3.141592653589793
  8 
  9 using namespace std;
 10 using namespace Eigen;
 11 
 12  int Dimension = 2;
 13 
 14 MatrixXd & getCoordinate(MatrixXd &,string & coordinate);//将输入坐标值的字符串转换为数值
 15 MatrixXd & RotationMatrix(MatrixXd &,string &);    //根据输入的旋转角度求得旋转矩阵
 16 MatrixXd & Move(MatrixXd &,MatrixXd &);    //平移之后得到平移坐标矩阵
 17 MatrixXd & Rotate(MatrixXd &,MatrixXd &,string &,string &);    //旋转结果
 18 MatrixXd & LineMirror(MatrixXd &, Vector3d &);
 19 
 20 int main()
 21 {
 22   int NumberOfPoints ;
 23   string GraphicName;
 24   string Coordinate;
 25 
 26   cout <<"输入图形名字，图形点数，点的坐标:" <<endl;
 27   cin >> GraphicName >> NumberOfPoints >> Coordinate;
 28 
 29   MatrixXd PointMatrix(Dimension,NumberOfPoints);    //定义点的矩阵
 30   PointMatrix = getCoordinate(PointMatrix,Coordinate);
 31   MatrixXd store = PointMatrix;
 32 
 33   cout << "初始坐标值" << endl << PointMatrix << endl;
 34 
 35   string Command;
 36   string GraphicNameC;
 37   string RotPoint;    //旋转中心
 38   string CommandCoordinate;    //旋转点坐标
 39 
 40   cout <<"请输入指令，如move l1 （3,6），rotate -30 (0,0):" <<endl;
 41   cin >> Command >> GraphicNameC >> CommandCoordinate>>RotPoint ;
 42 
 43   if (Command == "move")
 44   {
 45     MatrixXd MoveMatrix(Dimension,1);    //定义移动矩阵
 46     //int Num = 1;
 47     MoveMatrix = getCoordinate(MoveMatrix,CommandCoordinate);
 48     PointMatrix = Move(PointMatrix,MoveMatrix);
 49 
 50   }
 51   if(Command == "rotate")
 52   {
 53     MatrixXd Rotation(Dimension,Dimension);    //旋转矩阵
 54     PointMatrix = Rotate(PointMatrix,Rotation,CommandCoordinate,RotPoint);
 55   }
 56 
 57   cout << "The transfer result is:" <<endl << PointMatrix << endl;
 58 
 59   double a,b,c;
 60   cout << "请输入直线的参数a,b,c,ax+by+c=0:"<< endl;
 61   cin >> a >> b >> c;
 62   Vector3d LCo(a,b,c);
 63   MatrixXd MirrorResult;
 64   MirrorResult = LineMirror(store,LCo);
 65   cout << "关于直线镜像的结果："<< endl << MirrorResult<< endl;
 66   system("pause");
 67 }
 68 
 69 MatrixXd & getCoordinate(MatrixXd & pointMatrix,string & coordinate)
 70 {
 71     //提取输入的坐标值
 72   string tempt;        //temp用来存储字符串里面的数字量
 73   int count = 0;
 74 //  MatrixXd pointMatrix(Dimen,pointNumber);
 75   for(int i = 0; i < coordinate.length(); i++)
 76   {  
 77     if((coordinate[i] >= ‘0‘ && coordinate[i] <= ‘9‘)|| 
 78         coordinate[i] == ‘,‘||coordinate[i] == ‘)‘|| coordinate[i] == ‘.‘)
 79     {
 80         if(coordinate[i] == ‘,‘ || coordinate[i] == ‘)‘)
 81         { 
 82             count = count + 1;
 83             int k = count/2;
 84             int m = count%2 - 1;
 85         if(m == 0)
 86             double j = pointMatrix(0,k) = atof(tempt.c_str());    
 87         if(m == -1)
 88         {
 89             double n = 0;
 90             n = pointMatrix(1,k-1) = atof(tempt.c_str());
 91             int i = 0;
 92         }
 93         tempt.clear();
 94         continue;
 95         }
 96         tempt = tempt + coordinate[i];
 97     }    
 98   }
 99   return pointMatrix;
100 }
101 
102 //根据输入的转换角度求出转换矩阵
103 MatrixXd & RotationMatrix(MatrixXd & Rotation,string & arc)
104 {
105     double angle = atof(arc.c_str());
106     
107     double s1,c1;
108     s1 = sin(angle*pi/180);
109     c1 = cos(angle*pi/180);
110 
111     if(abs(s1)<0.000000000000001)
112         s1 = 0.0;
113     if (abs(c1) < 0.000000000000001)
114         c1=0;
115     
116     Rotation(0,0) = c1;
117     Rotation(0,1) = s1;
118     Rotation(1,0) = -s1;
119     Rotation(1,1) = c1;
120 
121     return Rotation;
122 }
123 
124 //求移动后的点坐标
125 MatrixXd & Move(MatrixXd & point,MatrixXd & moveMatrix)
126 {
127     int Num = point.cols();
128 
129     for(int i = 0; i < Num; i++)
130     {
131         point(0,i) = point(0,i) + moveMatrix(0,0);
132         point(1,i) = point(1,i) + moveMatrix(1,0);
133     }
134 
135     return point;
136 }
137 
138 //求旋转后的点坐标
139 MatrixXd & Rotate(MatrixXd & Poi,MatrixXd & Rot ,string &command,string &RPoint)
140 {
141     MatrixXd rotPoint;    //存储输入旋转中心
142     MatrixXd temp(Dimension,Dimension);
143 
144     rotPoint = getCoordinate(temp,RPoint);    //旋转中心坐标
145     rotPoint = (-1)*rotPoint;
146     Poi = Move(Poi,rotPoint);    //旋转中心移动到原点
147     Rot = RotationMatrix(Rot,command);
148     Poi = Rot*Poi;        //关于原点对称
149     rotPoint = (-1)*rotPoint;
150     Poi = Move(Poi,rotPoint);    //将旋转中心移回原始位置
151 
152     return Poi;
153 }
154 
155 //求镜像后的坐标值
156 MatrixXd & LineMirror(MatrixXd & point,Vector3d & Co)
157 {
158     int Num = point.cols();
159     double a = Co(0);
160     if( Co(0) == 0)
161     {
162         double y=-Co(2)/Co(1);
163         for(int i = 0; i < Num; i++)
164             point(1,i) = 2*y - point(1,i);
165     }
166     if(Co(1) == 0)
167     {
168         double x = -Co(2)/Co(0);
169         for(int i = 0; i < Num; i++)
170             point(0,i) = 2*x - point(0,i);
171     }
172     if(Co(0)!=0 && Co(1)!=0)
173     {
174         
175         for(int i = 0; i < Num; i++)
176         {
177             double L = (Co(0)*point(0,i)+Co(1)*point(1,i)+Co(2));
178             double D = (Co(0)*Co(0)+Co(1)*Co(1));
179             if(Co(0)*point(0,i)+Co(1)*point(1,i)+Co(2) == 0)
180                 continue;
181             point(0,i) = point(0,i)-2*Co(0)*L/D;
182             point(1,i) = point(1,i)-2*Co(1)*L/D;
183         }
184     }
185     return point;
186 }