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;
}
