that_one_nigga_you_k

motor/sonar e giro

Mar 8th, 2018
123
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 0.75 KB | None | 0 0
  1. #include <Ultrasonic.h>
  2. #include <L298N.h>
  3.  
  4. #define ENA 9 //pwm do motor A
  5. #define IN1 4
  6. #define IN2 5
  7. #define ENB 10// pwm do motor B
  8. #define IN3 6
  9. #define IN4 7
  10.  
  11. //create a motor instance
  12. L298N motor1(ENA,IN1,IN2); //definir qual pino é de qual motor
  13. L298N motor2(ENB,IN3,IN4);
  14.  
  15. Ultrasonic sonar(11,12); //definindo os pinos do ultrassom/sonar
  16.  
  17. void setup() {
  18.   Serial.begin(9600);
  19.  
  20.   motor1.setSpeed(130); //definindo a velocidade do pwm
  21.   motor2.setSpeed(130);
  22.  
  23. }
  24.  
  25. void loop() {
  26.   int cm;
  27.  cm = sonar.distanceRead(CM);
  28.  
  29.  motor1.forward();
  30.  motor2.forward();
  31.  
  32.  if(cm > 17){
  33.  
  34.   motor1.setSpeed(90); //desacelerar
  35.   motor2.setSpeed(90);
  36.  
  37.   motor1.backward(); //pra frente
  38.   motor2.forward(); //pra tras (movimento é sexy)
  39.  }
  40.  
  41. }
Add Comment
Please, Sign In to add comment