Exercio de C
Por: quirosmar • 29/10/2015 • Trabalho acadêmico • 432 Palavras (2 Páginas) • 130 Visualizações
int esquerdaSensor = 8, esquerdaValue, esquerdaMotor = 6;
int direitaSensor = 9, direitaValue, direitaMotor = 4;
int frontSensor = 10, frontValue = 1;
int direitaPlus = direitaMotor;
int direitaMin = direitaMotor + 1;
int esquerdaPlus = esquerdaMotor;
int esquerdaMin = esquerdaMotor + 1;
int firstloop = 1;
int delayAcceleration = 50;
void setup() {
Serial.begin(9600);
pinMode(esquerdaSensor, INPUT);
pinMode(direitaSensor, INPUT);
pinMode(direitaPlus, OUTPUT);
pinMode(direitaMin, OUTPUT);
pinMode(esquerdaPlus, OUTPUT);
pinMode(esquerdaMin, OUTPUT);
}
void accelerate(int motor){
digitalWrite(motor, HIGH);
digitalWrite(motor + 1, LOW);
delay(delayAcceleration);
digitalWrite(motor, LOW);
digitalWrite(motor + 1, LOW);
Serial.print("Acelerando... -> ");
Serial.print(motor);
Serial.print("\n");
}
void goFoward(){
digitalWrite(direitaPlus, HIGH);
digitalWrite(direitaMin, LOW);
digitalWrite(esquerdaPlus, HIGH);
digitalWrite(esquerdaMin, LOW);
};
void goDireita(){
digitalWrite(direitaPlus, HIGH);
digitalWrite(direitaMin, LOW);
digitalWrite(esquerdaPlus, LOW);
digitalWrite(esquerdaMin, HIGH);
};
void goEsquerda(){
digitalWrite(direitaPlus, LOW);
digitalWrite(direitaMin, HIGH);
digitalWrite(esquerdaPlus, HIGH);
digitalWrite(esquerdaMin, LOW);
};
void stopMotors(){
digitalWrite(direitaPlus, LOW);
digitalWrite(direitaMin, LOW);
digitalWrite(esquerdaPlus, LOW);
digitalWrite(esquerdaMin, LOW);
}
void runMotors(int delayNum, int entrada){
if(entrada == 0){
goFoward();
Serial.print("Reto \n");
}else if(entrada == 1){
goDireita();
...