void doInstruction() { int currentTime = getCurrentTimeInSecond(); if (instructionIndex == 0 && currentTime > 1) { motionDriverForward(600.0f); instructionIndex++; } else if (instructionIndex == 1 && currentTime > 10) { motionDriverLeft(1800.0f); } else if (instructionIndex == 2 && currentTime > 20) { motionDriverForward(600.0f); } }
void homologation5_Totem(int color) { unsigned int index = getMotionInstructionIndex(); switch (index) { case 1: armDriver2012Down(ARM_LEFT); armDriver2012Down(ARM_RIGHT); delaymSec(1000); setReadyForNextMotion(TRUE); break; case 2: motionDriverForward(500.0f); break; case 3: armDriver2012Up(ARM_LEFT); armDriver2012Up(ARM_RIGHT); break; } }
BOOL motionDriverMaintainPosition() { BOOL result = motionDriverForward(0.0f); return result; }