Exemplo n.º 1
0
Arquivo: IO.cpp Projeto: inicio/OTTO
void IO::write(int i, int val) { // the problem might be related to the two writers that are calling this class.
    SoftwareServo* servo;
//	servo = &servos[i];
//	servo->write(val);

    switch(i) {
    case 0:
        servo = &s1;
        break;
    case 1:
        servo = &s2;
        break;
    }

    servo->write(force[val]);
    servo->refresh();

//	SoftwareServo::refresh();
//	servo->refresh();
//	delay(100);
}