コード例 #1
0
ファイル: Robot.cpp プロジェクト: niu769584641/HOMEWORK2
void Robot::PTPMove(WorldFrame wf,TaskFrame tf,Point p){
    Solver s;
    s.WtoT(tf,p);
    s.TtoJ(p,arm1,arm2);
    print(p);
}