Sensores de Hexbug araña barba / mi Instructable primera (2 / 3 paso)

Paso 2: código

int pbLeft = 0; var para la derecha
int pbRight = 0; var para la izquierda

void setup() {}
pinMode (bumpLeft, entrada);
pinMode (bumpRight, entrada);
pinMode (ledPin, salida);
pinMode (servoFw, salida);
pinMode (servoTrn, salida);
}

void loop() {}
Forward(); Inicio adelante
interruptor de prueba
pbLeft = digitalRead(bumpLeft);
pbRight = digitalRead(bumpRight);

Mostrar indicador de LED
showLED();

Si pulsa izquierda
Si (pbLeft == HIGH) {}
REVERSE();
Delay(500);
turnRight();
Delay(1500);
}

Si derecha pegado
Si (pbRight == HIGH) {}
REVERSE();
Delay(500);
turnLeft();
Delay(1500);
}
}

Rutinas de movimiento
{} void forward()
digitalWrite (servoFw, HIGH);
digitalWrite (servoTrn, bajo);
}

{} void reverse()
digitalWrite (servoFw, bajo);
digitalWrite (servoTrn, HIGH);
}

{} void turnRight()
digitalWrite (servoFw, bajo);
digitalWrite (servoTrn, HIGH);
}

{} void turnLeft()
digitalWrite (servoFw, bajo);
digitalWrite (servoTrn, HIGH);
}

void showLED() {}
Ver led si golpe de parachoques
Si (pbRight == alta || pbLeft == HIGH) {}
activar led
digitalWrite (ledPin, HIGH);
}
Else {}
Apagar el LED
digitalWrite (ledPin, LOW);
}
}