void ModeLibrary::pause(int mn, int ms) {
while( mn > 0 ) {
fadeLED();
mn -= 5;
delay(5);
}
ms -= mn;
while( ms > 0 ) {
fadeLED();
if ( ms <= 50 ) {
delay(ms);
ms = 0;
} else {
int d = rand()%50;
ms -= d;
delay(d);
}
}
}
static void fadePWM(void) {
fadeLED();
}
/**
* Set the motors and LED to the supplied values.
*/
void ModeLibrary::robotDo(double sa, double sb, double sc, byte r, byte g, byte b) {
fadeLED();
servos.updateServos( getServoVal(sa), getServoVal(sb), getServoVal(sc) );
brain.setLED(r,g,b);
delay(18);
}
