《实时控制软件设计》第一次编程作业

#include <iostream>
#include <stdlib.h>
#include <Eigen/Dense>
#include <math.h> 
using namespace std;
using Eigen::MatrixXd;
MatrixXd extract(char str[])
{
	        MatrixXd p(1,2);
			int u;
			int i,j;
			char a[10];
			for(i=0;i<=49&&str[i]!='(';i++);
			for(j=0;j<=49&&str[j]!=',';j++);
			for(u=0;u<=10&&i!=j-1;u++)
			{
				i++;
				a[u]=str[i];
			}
			
			p(0,0)=atof(a);
			for(i=j;i<=49&&str[i]!=')';i++);
			for(u=0;u<=10&&j!=i-1;u++)
			{
				j++;
				a[u]=str[j];
			}
			p(0,1)=atof(a);
			return p;
}
int main()
{
char name[15];
int n;
double avg,deg;
float pi=3.14159265;
char str1[20];
char str2[20];
char str3[20];
char str4[15];
char str5[15];
char str6[15];
MatrixXd rot(2,2);
MatrixXd p1(1,2);
MatrixXd p2(1,2);
MatrixXd p3(1,2);
MatrixXd p4(1,2);
cout<<"请输入 ";
cin>>name;
cin>>n;
switch(n)
{
	case 1:
		{
			cin>>str1;
			p1=extract(str1);
		}
		break;
	case 2:
		{
			cin>>str1;
		    p1=extract(str1);
			cin>>str2;
			p2=extract(str2);	
		}
		break;
	case 3:
		{
			cin>>str1;
		    p1=extract(str1);
			cin>>str2;
			p2=extract(str2);
            cin>>str3;
	        p3=extract(str3);
		}
		break;
	default:cout<<"输入错误";
 
}
cout<<"请输入操作指令"<<endl;
cin>>str4;
if(str4[0]=='m'&&str4[1]=='o'&&str4[2]=='v'&&str4[3]=='e'&&str4[4]==0)
		{
		cin>>str5;
		cin>>str6;
		p4=extract(str6);
		if(n==1)
         {
		   p1=p1+p4;
		   cout<<"("<<p1<<")"<<endl;
	     }
        else if(n==2)
             {
               p1=p1+p4;	
        	   p2=p2+p4;
        	   cout<<"("<<p1<<")"<<"("<<p2<<")"<<endl;
	      	 }
	    else
	         {
               p1=p1+p4;	
        	   p2=p2+p4;
        	   p3=p3+p4;
        	   cout<<"("<<p1<<")"<<"("<<p2<<")"<<"("<<p3<<")"<<endl;
	      	 }
	    }
else if(str4[0]=='r'&&str4[1]=='o'&&str4[2]=='t'&&str4[3]=='a'&&str4[4]=='t'&&str4[5]=='e'&&str4[6]==0)
       {
       	cin>>str5;
       	cin>>avg;
       	deg=avg/180*pi;
       	rot(0,0)=cos(deg);
       	rot(0,1)=sin(deg);
       	rot(1,0)=-sin(deg);
       	rot(1,1)=cos(deg);
       	if(n==1)
         {
		   p1=p1*rot;
		   cout<<"("<<p1<<")"<<endl;
	     }
        else if(n==2)
             {
               p1=p1*rot;	
        	   p2=p2*rot;
        	  cout<<"("<<p1<<")"<<"("<<p2<<")"<<endl;
	      	 }
	    else
	         {
               p1=p1*rot;	
        	   p2=p2*rot;
        	   p3=p3*rot;
        	   cout<<"("<<p1<<")"<<"("<<p2<<")"<<"("<<p3<<")"<<endl;
	      	 }
       	
       }
else
    {
    	cout<<"输入出错"<<endl; 
	}	
return 0; 
}

//输出结果