Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Ultrasonic.h>
- #include <L298N.h>
- #define ENA 9 //pwm do motor A
- #define IN1 4
- #define IN2 5
- #define ENB 10// pwm do motor B
- #define IN3 6
- #define IN4 7
- //create a motor instance
- L298N motor1(ENA,IN1,IN2); //definir qual pino é de qual motor
- L298N motor2(ENB,IN3,IN4);
- Ultrasonic sonar(11,12); //definindo os pinos do ultrassom/sonar
- void setup() {
- Serial.begin(9600);
- motor1.setSpeed(130); //definindo a velocidade do pwm
- motor2.setSpeed(130);
- }
- void loop() {
- int cm;
- cm = sonar.distanceRead(CM);
- motor1.forward();
- motor2.forward();
- if(cm > 17){
- motor1.setSpeed(90); //desacelerar
- motor2.setSpeed(90);
- motor1.backward(); //pra frente
- motor2.forward(); //pra tras (movimento é sexy)
- }
- }
Add Comment
Please, Sign In to add comment