A repo for the code of the Line Following robot we are making for Robotex 2022
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

41 lines
763B

  1. int MODE = 8;
  2. int left_motor_in = 6;
  3. int left_motor_out = 9;
  4. int right_motor_in = 3;
  5. int right_motor_out = 5;
  6. void setup() {
  7. Serial.begin(9600);
  8. Serial.println("Start");
  9. init_motor();
  10. }
  11. void loop() {
  12. left_motor_go(250);
  13. right_motor_go(250);
  14. }
  15. void init_motor(){
  16. pinMode(left_motor_in, OUTPUT);
  17. pinMode(left_motor_out, OUTPUT);
  18. pinMode(right_motor_in, OUTPUT);
  19. pinMode(right_motor_out, OUTPUT);
  20. pinMode(MODE, OUTPUT);
  21. digitalWrite(MODE, HIGH);
  22. }
  23. //range:0<value<255
  24. void left_motor_go(int motor_speed){
  25. analogWrite(left_motor_in, motor_speed);
  26. digitalWrite(left_motor_out, LOW);
  27. }
  28. //range:0<value<255
  29. void right_motor_go(int motor_speed){
  30. analogWrite(right_motor_in, motor_speed);
  31. digitalWrite(right_motor_out, LOW);
  32. }