int main(){
//myrobot³õʼ»¯
const double l1=300,l2 =500;
Vector2d WF_vx(1,0),WF_vy(0,1);
Point wf_origin("wf_origin",0,0);
Joint jt1(0,0,0,-180,180,0),jt2(l1,0,0,-180,180,0);
Frame WF("wf",WF_vx,WF_vy,wf_origin);
Robot myRobot(l1,l2,jt1,jt2,WF);
//Point tf1_origin("tf1_origin",400,200),tf2_origin("tf2_origin",100,300),tf3_origin("tf3_origin",200,400);
//Vector2d TF1_vx(0,1),TF1_vy(-1,0),TF2_vx(-1,0),TF2_vy(0,-1),TF3_vx(0,-1),TF3_vy(1,0);
//Frame TF1("tf1",TF1_vx,TF1_vy,tf1_origin),TF2("tf2",TF2_vx,TF2_vy,tf2_origin),TF3("tf3",TF3_vx,TF3_vy,tf3_origin);
//myRobot.TaskFrameCreate(TF1);
//myRobot.TaskFrameCreate(TF2);
//myRobot.TaskFrameCreate(TF3);
//Point P1(1,2),P2(1,2),P3(1,2),P4(1,2),P5(1,2);
//myRobot.RobotShow();
//myRobot.PTPMove(WF,P2);
//myRobot.RobotShow();
//myRobot.PTPMove(TF1,P3);
//myRobot.RobotShow();
//myRobot.PTPMove(TF2,P4);
//myRobot.RobotShow();
//myRobot.PTPMove(TF3,P5);
//myRobot.RobotShow();
return 0;
}
int main ()
{
vector<double> v(10, 0.0);
list<double> L;
for (int i = 0; i < 10; i++) {
L.push_back(100 - i * i);
v.push_back(10-i);
}
vectorIterator<double> itr(v);
for (itr.init(); ! itr; itr++)
cout << itr( ) << ' ';
cout << '\n';
double total = 0;
for (itr.init(); ! itr; itr++)
total += itr ();
cout << "total is " << total << '\n';
vectorIterator<double> jtr(v);
sort1(itr, jtr);
for (itr.init(); ! itr; itr++)
cout << itr( ) << ' ';
cout << '\n';
itr.sort(itr, jtr);
for (itr.init(); ! itr; itr++)
cout << itr( ) << ' ';
cout << '\n';
listIterator<double> lt1(L);
for (lt1.init(); ! lt1; lt1++)
cout << lt1( ) << ' ';
cout << '\n';
total = 0;
for (lt1.init(); ! lt1; lt1++)
total += lt1 ();
cout << "total is " << total << '\n';
listIterator<double> jt1(L);
sort1(lt1, jt1);
for (lt1.init(); ! lt1; lt1++)
cout << lt1( ) << ' ';
cout << '\n';
lt1.sort(lt1, jt1);
for (lt1.init(); ! lt1; lt1++)
cout << lt1( ) << ' ';
cout << '\n';
cout << "\nMY STUFF BEGINS HERE!\n";
cout << "VECTOR ITERATOR:\n" << itr;
cout << "LIST ITERATOR:\n" << lt1;
return 1;
}
