Ejemplo n.º 1
0
void Robot::PTPMove(WorldFrame wf,TaskFrame tf,Point p){
    Solver s;
    s.WtoT(tf,p);
    s.TtoJ(p,arm1,arm2);
    print(p);
}