コード例 #1
0
ファイル: hanoi.cpp プロジェクト: VBmgk/braco-robotico
 void moveToPin(Pin &pin) {
   // go to the top of the pin
   goTo(pin.x, pin.y, (3 + ALPHA) * DISC_HEIGHT + BASE_HEIGHT);
   // update pin state
   pin.add();
   // get disc on the middle point
   goTo(pin.x, pin.y,
        (pin.num_discs - 0.5) * DISC_HEIGHT + BASE_HEIGHT);
   // open Gripper!
   openGripper();
 }