예제 #1
0
void Robot::PTPMove(TaskFrame tf,Point p){
    Solver s;
    s.TtoJ(p,arm1,arm2);
    print(p);
}
예제 #2
0
void Robot::PTPMove(WorldFrame wf,TaskFrame tf,Point p){
    Solver s;
    s.WtoT(tf,p);
    s.TtoJ(p,arm1,arm2);
    print(p);
}