Lab_interaccio/2020/Motor_test/Motor_test.ino
2025-02-25 21:29:42 +01:00

42 lines
794 B
C++

#define DIR 10
#define PWM 11
// the setup function runs once when you press reset or power the board
void setup() {
// initialize digital pin LED_BUILTIN as an output.
pinMode(DIR, OUTPUT);
pinMode(PWM, OUTPUT);
stop();
}
// the loop function runs over and over again forever
void loop() {
right(255);
delay(5000); // wait for a second
stop();
delay(100);
left(255);
delay(5000); // wait for a second
stop();
delay(100);
}
void right(uint8_t value)
{
digitalWrite(DIR, HIGH);
analogWrite(PWM, value);
}
void left(uint8_t value)
{
digitalWrite(DIR, LOW);
analogWrite(PWM, value);
}
void stop()
{
digitalWrite(DIR, LOW);
analogWrite(PWM, 0);
}