Contenu connexe
Similaire à Robotica Introducere
Similaire à Robotica Introducere (20)
Robotica Introducere
- 24. Test senzori
void setup() {
Serial.begin(9600);
}
int readDistance() {
int sum = 0;
for (int i=0; i<6;i++){
float volts = analogRead(0)* ((float) 5 / 1024);
float distance = 65*pow(volts, -1.10);
sum = sum + distance;
delay(5);
}
return (int)(sum / 6);
}
void loop() {
int distance = readDistance();
Serial.println(distance);
}
- 26. Test motoare
void go(int speedLeft, int speedRight) {
int MOTOR1_PIN1 = 10;
if (speedLeft > 0) {
int MOTOR1_PIN2 = 11;
analogWrite(MOTOR1_PIN1, speedLeft);
analogWrite(MOTOR1_PIN2, 0);
int MOTOR2_PIN1 = 5;
int MOTOR2_PIN2 = 6;
} else {
analogWrite(MOTOR1_PIN1, 0);
void setup() { analogWrite(MOTOR1_PIN2, -speedLeft);
pinMode(11, OUTPUT); }
pinMode(10, OUTPUT);
pinMode(6, OUTPUT); if (speedRight > 0) {
pinMode(5, OUTPUT); analogWrite(MOTOR2_PIN1, speedRight);
Serial.begin(9600); analogWrite(MOTOR2_PIN2, 0);
} }
else {
analogWrite(MOTOR2_PIN1, 0);
void loop() { analogWrite(MOTOR2_PIN2, -speedRight);
go (255, 255); }
} }
