George_Andreou/Line_Following-Robotex
1
0
Fork 0
Code Issues Pull requests Releases Wiki Activity

add arduino code

Browse source
This commit is contained in:
George_Andreou 2022-06-01 12:50:06 +03:00
parent eb673befcb
commit 7777dd3a54
4 changed files with 420 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

40
main.ino Normal file
View file

@ -0,0 +1,40 @@
int MODE = 8;
int left_motor_in = 6;
int left_motor_out = 9;
int right_motor_in = 3;
int right_motor_out = 5;
void setup() {
Serial.begin(9600);
Serial.println("Start");
init_motor();
}
void loop() {
left_motor_go(250);
right_motor_go(250);
}
void init_motor(){
pinMode(left_motor_in, OUTPUT);
pinMode(left_motor_out, OUTPUT);
pinMode(right_motor_in, OUTPUT);
pinMode(right_motor_out, OUTPUT);
pinMode(MODE, OUTPUT);
digitalWrite(MODE, HIGH);
}
//range:0<value<255
void left_motor_go(int motor_speed){
analogWrite(left_motor_in, motor_speed);
digitalWrite(left_motor_out, LOW);
}
//range:0<value<255
void right_motor_go(int motor_speed){
analogWrite(right_motor_in, motor_speed);
digitalWrite(right_motor_out, LOW);
}