Moottorien ohjaaminen

Lego-robotin moottorit toimivat tilakoneena eli kun niille on kerran annettu nopeusohje, robotti muistaa sen kunnes annetaan uusi ohje. Moottorien nopeusohjeiden arvoalue on -100...100. Positiiviset nopeudet tarkoittavat koulun robottien tapauksessa nopeutta eteenpäin, negatiiviset nopeutta taaksepäin.

Esimerkki 1. Asetetaan moottorit B ja C täyteen nopeuteen eteenpäin. Robotti ajaa eteenpäin 10 sekunnin ajan.

task main()
{
    motor[motorB] = 100;
    motor[motorC] = 100;
    wait1Msec(10000);
}

 task main()
{
  nMotorEncoder[motorB] = 0;
  nMotorEncoder[motorC] = 0;

  nMotorEncoderTarget[motorB] = 1800;
  nMotorEncoderTarget[motorC] = 1800;

  motor[motorC] = 50;
  motor[motorB] = 50;

  while(nMotorRunState[motorB] != runStateIdle || nMotorRunState[motorC] != runStateIdle)
  {

  }
}