SlideShare a Scribd company logo

GENESIS BOARD MINI SUMO ROBOT PROGRAMFOR 3 OPPONENT SENSOR, .pdf

A
alltiusind

The document contains the complete code for a mini sumo robot programmed to utilize various sensors for movement and obstacle detection. It covers motor control, sensor input handling, and defines the robot's behavior such as making turns and moving forward based on sensor readings. Additionally, it includes a new functionality to follow a square-shaped path through a series of predefined movements.

Education
1 of 15
Download to read offline
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
/ GENESIS BOARD MINI SUMO ROBOT PROGRAM //FOR 3 OPPONENT SENSOR, 2 EDGE SENSOR // JSUMO 01/2020 /////////////////////////////////////// //MOTOR CONTROL int RPwm = 11; int RDir = 13; int LPwm = 3; int LDir = 12; //LED & BUZZER int Buzzer = 9; int ArduLed = 8; //EDGE & CONTRAST SENSORS int Redge = A0; int Ledge = A1; //TRIMPOTS int SPD = A7; int TRN = A6; //OPPONENT SENSORS int LSens = A4; int RSens = A2; int MSens = A3;
int LFSens = A5; int RFSens = 4; // DIPSWITCH & BUTTON int Button = 10; // Can be used as start pin too. int DS1 = 5; int DS2 = 6; int DS3 = 7; //VALUES int Speed =50; int MaxSpeed = 80; // Idle Speed while no sensor giving data. int TurnSpeed = 65; // Left and Right Forward Turning Speed int EdgeTurn = 150; // Turning Time variable when minisumo sees white line int Duration; // Turning Time at minisumo starting. int LastValue = 5; // Last Value Variable for remembering last Opponent sensor sense. void setup() { pinMode(LSens, INPUT); // Left Opponent Sensor Input pinMode(RSens, INPUT); // Right Opponent Sensor Input pinMode(MSens, INPUT); // Middle Opponent Sensor Input pinMode(Buzzer, OUTPUT); // Buzzer Declared as Output pinMode(ArduLed, OUTPUT); // Buzzer Declared as Output pinMode(Button, INPUT); // Buzzer Declared as Output pinMode(RPwm, OUTPUT); // Four PWM Channel Declared as Output pinMode(RDir, OUTPUT);
pinMode(LPwm, OUTPUT); pinMode(LDir, OUTPUT); digitalWrite(Buzzer, LOW); // Buzzer Pin Made Low for Silence digitalWrite(ArduLed, LOW); // Arduino Mode Led Made Low digitalWrite(DS1, HIGH); // 3 Dipswitch Pin Pullups Made digitalWrite(DS2, HIGH); digitalWrite(DS3, HIGH); digitalWrite(LSens, HIGH); // Opponent Sensor Pullups Made digitalWrite(RSens, HIGH); digitalWrite(LFSens, HIGH); digitalWrite(RFSens, HIGH); digitalWrite(MSens, HIGH); Serial.begin(9600); } //Motor Control Function void Set_Motor (float Lval, float Rval, int timex){ Lval = Lval*2.5; Rval = Rval*2.5; if (Lval >=0) { analogWrite(LPwm, Lval); digitalWrite(LDir, LOW); } else { Lval=abs(Lval); digitalWrite(LDir, HIGH); analogWrite(LPwm, Lval); } if (Rval >=0) { analogWrite(RPwm, Rval); digitalWrite(RDir, HIGH); } else {
Rval=abs(Rval); digitalWrite(RDir, LOW); analogWrite(RPwm, Rval); } //If you want to see Speed Values please uncomment bottom line. // Serial.print(Rval); Serial.print(-); Serial.println(Lval); delay(timex); } void loop() { digitalWrite(RPwm, LOW); digitalWrite(LPwm, LOW); tone(Buzzer, 18, 100); // Pin, Frequency, Duration ////////////////////////////////////////////// // This function below, used for stopping robot while no button is pushed or Microstart is not triggered. while (digitalRead(Button)==0) { Serial.println(Button Press Waited); Set_Motor(0,0,1); /// Sensor Control While Waiting The Button Press /// if ( digitalRead(MSens)==LOW || digitalRead(RSens)==LOW || digitalRead(LSens)== LOW || digitalRead(RFSens)==LOW || digitalRead(LFSens)== LOW || analogRead(Redge)< 100 || analogRead(Ledge)< 100 ) { digitalWrite(ArduLed, HIGH);} else { digitalWrite(ArduLed, LOW); } } /////////////////////////////////////////////// if (digitalRead(Button)==1) { Duration=(analogRead(TRN)/5); // Duration variable based on TRN (A6) trimpot Duration=205-Duration; // Serial.println(5 Sec Routine Started); for (int i = 0; i < 5; i++){ digitalWrite(Buzzer, HIGH); digitalWrite(ArduLed, HIGH);
delay(100); digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, LOW); delay(900); } if (digitalRead(DS1)==0 && digitalRead(DS2)==1 && digitalRead(DS3)==1){ Serial.print(LEFT TURN); Set_Motor(-100,100,Duration); // } else if (digitalRead(DS1)==0 && digitalRead(DS2)==0 && digitalRead(DS3)==0) { Serial.print(MIDDLE DIRECT); Set_Motor(80,80,2); } else if (digitalRead(DS1)==1 && digitalRead(DS2)==1 && digitalRead(DS3)==0){ Serial.print(Sag); Set_Motor(100,-100,Duration); } else if (digitalRead(DS1)==1 && digitalRead(DS2)==0 && digitalRead(DS3)==0){ Serial.print(Left Circle); Set_Motor(100,36,650); } else if (digitalRead(DS1)==0 && digitalRead(DS2)==0 && digitalRead(DS3)==1){ Serial.print(Right Circle); Set_Motor(36,100,650); } else if (digitalRead(DS1)==0 && digitalRead(DS2)==1 && digitalRead(DS3)==0){ Serial.print(Reverse 180); Set_Motor(-100,100,Duration*2); // One Duration time is for 90 degree, so we multiply by 2. } Serial.print(OK); digitalWrite(Buzzer, LOW); EdgeTurn=(analogRead(TRN)/5); // Raw value comes with 0 to 1023, we divide it for 0 t0 205 mS turning time. EdgeTurn=205-EdgeTurn; // }
//Main Loop while(1) { /// Edge Sensor Control Routine /// digitalWrite(ArduLed, LOW); if (analogRead(Ledge)<300 && analogRead(Redge)> 300) { digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, HIGH); Set_Motor(-100, -100,55); // Backward for 55 mS. Set_Motor(-100, 100, EdgeTurn); // Left Backward, Right Forward, Turning Time Based on ETRN Trimpot LastValue=5; } else if (analogRead(Ledge)> 300 && analogRead(Redge)< 300) { digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, HIGH); Set_Motor(-100, -100,55); // Backward for 55 mS. Set_Motor(100, -100, EdgeTurn); // Right Backward, Left Forward, Turning Time Based on ETRN Trimpot LastValue=5; } else if (analogRead(Ledge)< 300 && analogRead(Redge)< 300) { digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, HIGH); Set_Motor(-100, -100,55); // Backward for 55 mS. Set_Motor(100, -100, EdgeTurn); // Right Backward, Left Forward, Turning Time Based on ETRN Trimpot LastValue=5; }else /// Opponent Sensor Control Routine /// // Please uncomment below line if yu are using microstart, When microstart gives 0V it will stop motors. //while (digitalRead(Button)==LOW) {Set_Motor(0, 0, 20); digitalWrite(Buzzer, HIGH); LastValue=3;} digitalWrite(Buzzer, LOW);
if (digitalRead(MSens)==LOW) {Set_Motor(MaxSpeed, MaxSpeed,1); digitalWrite(Buzzer, HIGH); LastValue=5;} else if (digitalRead(LSens)== LOW) {Set_Motor(-40, TurnSpeed,1); digitalWrite(Buzzer, HIGH); LastValue=7;} else if (digitalRead(RSens)==LOW) {Set_Motor(TurnSpeed, -40,1); digitalWrite(Buzzer, HIGH); LastValue=3;} else if (digitalRead(LFSens)== LOW) {Set_Motor(-40, TurnSpeed,1); digitalWrite(Buzzer, HIGH); LastValue=7;} else if (digitalRead(RFSens)==LOW) {Set_Motor(TurnSpeed, -40,1); digitalWrite(Buzzer, HIGH); LastValue=3;} else { digitalWrite(Buzzer, LOW); Speed=(analogRead(SPD)/10.3); // This raw speed value comes with 0 to 1023 so we divide to 10.3 After that it is 0 to 99 integer. Speed=100-Speed; // This is used for reversing trimpot dial direction at board. if (LastValue==5) { Set_Motor(Speed, Speed,1);} else // Forward, Based on SPD (A7) Trimpot if (LastValue==7) { Set_Motor(-20, Speed,2);} else // Left Turning Based on SPD (A7) Trimpot if (LastValue==3) { Set_Motor(Speed, -20,2);} // Right Turning Based on SPD (A7) Trimpot } } } Can you integrate the above code according to the items written below? Now program your robot to follow a square shaped path, as follows: i. Go forward for one second, ii. Make a 90 degree left turn, iii. Go to step (i). iv. Stop after four turns.
/ GENESIS BOARD MINI SUMO ROBOT PROGRAM //FOR 3 OPPONENT SENSOR, 2 EDGE SENSOR // JSUMO 01/2020 /////////////////////////////////////// //MOTOR CONTROL int RPwm = 11; int RDir = 13; int LPwm = 3; int LDir = 12; //LED & BUZZER int Buzzer = 9; int ArduLed = 8; //EDGE & CONTRAST SENSORS int Redge = A0; int Ledge = A1; //TRIMPOTS int SPD = A7; int TRN = A6; //OPPONENT SENSORS int LSens = A4; int RSens = A2; int MSens = A3;
int LFSens = A5; int RFSens = 4; // DIPSWITCH & BUTTON int Button = 10; // Can be used as start pin too. int DS1 = 5; int DS2 = 6; int DS3 = 7; //VALUES int Speed =50; int MaxSpeed = 80; // Idle Speed while no sensor giving data. int TurnSpeed = 65; // Left and Right Forward Turning Speed int EdgeTurn = 150; // Turning Time variable when minisumo sees white line int Duration; // Turning Time at minisumo starting. int LastValue = 5; // Last Value Variable for remembering last Opponent sensor sense. void setup() { pinMode(LSens, INPUT); // Left Opponent Sensor Input pinMode(RSens, INPUT); // Right Opponent Sensor Input pinMode(MSens, INPUT); // Middle Opponent Sensor Input pinMode(Buzzer, OUTPUT); // Buzzer Declared as Output pinMode(ArduLed, OUTPUT); // Buzzer Declared as Output pinMode(Button, INPUT); // Buzzer Declared as Output pinMode(RPwm, OUTPUT); // Four PWM Channel Declared as Output pinMode(RDir, OUTPUT); pinMode(LPwm, OUTPUT); pinMode(LDir, OUTPUT);
digitalWrite(Buzzer, LOW); // Buzzer Pin Made Low for Silence digitalWrite(ArduLed, LOW); // Arduino Mode Led Made Low digitalWrite(DS1, HIGH); // 3 Dipswitch Pin Pullups Made digitalWrite(DS2, HIGH); digitalWrite(DS3, HIGH); digitalWrite(LSens, HIGH); // Opponent Sensor Pullups Made digitalWrite(RSens, HIGH); digitalWrite(LFSens, HIGH); digitalWrite(RFSens, HIGH); digitalWrite(MSens, HIGH); Serial.begin(9600); } //Motor Control Function void Set_Motor (float Lval, float Rval, int timex){ Lval = Lval*2.5; Rval = Rval*2.5; if (Lval >=0) { analogWrite(LPwm, Lval); digitalWrite(LDir, LOW); } else { Lval=abs(Lval); digitalWrite(LDir, HIGH); analogWrite(LPwm, Lval); } if (Rval >=0) { analogWrite(RPwm, Rval); digitalWrite(RDir, HIGH); } else { Rval=abs(Rval); digitalWrite(RDir, LOW);
analogWrite(RPwm, Rval); } //If you want to see Speed Values please uncomment bottom line. // Serial.print(Rval); Serial.print(-); Serial.println(Lval); delay(timex); } void loop() { digitalWrite(RPwm, LOW); digitalWrite(LPwm, LOW); tone(Buzzer, 18, 100); // Pin, Frequency, Duration ////////////////////////////////////////////// // This function below, used for stopping robot while no button is pushed or Microstart is not triggered. while (digitalRead(Button)==0) { Serial.println(Button Press Waited); Set_Motor(0,0,1); /// Sensor Control While Waiting The Button Press /// if ( digitalRead(MSens)==LOW || digitalRead(RSens)==LOW || digitalRead(LSens)== LOW || digitalRead(RFSens)==LOW || digitalRead(LFSens)== LOW || analogRead(Redge)< 100 || analogRead(Ledge)< 100 ) { digitalWrite(ArduLed, HIGH);} else { digitalWrite(ArduLed, LOW); } } /////////////////////////////////////////////// if (digitalRead(Button)==1) { Duration=(analogRead(TRN)/5); // Duration variable based on TRN (A6) trimpot Duration=205-Duration; // Serial.println(5 Sec Routine Started); for (int i = 0; i < 5; i++){ digitalWrite(Buzzer, HIGH); digitalWrite(ArduLed, HIGH); delay(100); digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, LOW); delay(900); }
if (digitalRead(DS1)==0 && digitalRead(DS2)==1 && digitalRead(DS3)==1){ Serial.print(LEFT TURN); Set_Motor(-100,100,Duration); // } else if (digitalRead(DS1)==0 && digitalRead(DS2)==0 && digitalRead(DS3)==0) { Serial.print(MIDDLE DIRECT); Set_Motor(80,80,2); } else if (digitalRead(DS1)==1 && digitalRead(DS2)==1 && digitalRead(DS3)==0){ Serial.print(Sag); Set_Motor(100,-100,Duration); } else if (digitalRead(DS1)==1 && digitalRead(DS2)==0 && digitalRead(DS3)==0){ Serial.print(Left Circle); Set_Motor(100,36,650); } else if (digitalRead(DS1)==0 && digitalRead(DS2)==0 && digitalRead(DS3)==1){ Serial.print(Right Circle); Set_Motor(36,100,650); } else if (digitalRead(DS1)==0 && digitalRead(DS2)==1 && digitalRead(DS3)==0){ Serial.print(Reverse 180); Set_Motor(-100,100,Duration*2); // One Duration time is for 90 degree, so we multiply by 2. } Serial.print(OK); digitalWrite(Buzzer, LOW); EdgeTurn=(analogRead(TRN)/5); // Raw value comes with 0 to 1023, we divide it for 0 t0 205 mS turning time. EdgeTurn=205-EdgeTurn; // } //Main Loop
while(1) { /// Edge Sensor Control Routine /// digitalWrite(ArduLed, LOW); if (analogRead(Ledge)<300 && analogRead(Redge)> 300) { digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, HIGH); Set_Motor(-100, -100,55); // Backward for 55 mS. Set_Motor(-100, 100, EdgeTurn); // Left Backward, Right Forward, Turning Time Based on ETRN Trimpot LastValue=5; } else if (analogRead(Ledge)> 300 && analogRead(Redge)< 300) { digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, HIGH); Set_Motor(-100, -100,55); // Backward for 55 mS. Set_Motor(100, -100, EdgeTurn); // Right Backward, Left Forward, Turning Time Based on ETRN Trimpot LastValue=5; } else if (analogRead(Ledge)< 300 && analogRead(Redge)< 300) { digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, HIGH); Set_Motor(-100, -100,55); // Backward for 55 mS. Set_Motor(100, -100, EdgeTurn); // Right Backward, Left Forward, Turning Time Based on ETRN Trimpot LastValue=5; }else /// Opponent Sensor Control Routine /// // Please uncomment below line if yu are using microstart, When microstart gives 0V it will stop motors. //while (digitalRead(Button)==LOW) {Set_Motor(0, 0, 20); digitalWrite(Buzzer, HIGH); LastValue=3;} digitalWrite(Buzzer, LOW); if (digitalRead(MSens)==LOW) {Set_Motor(MaxSpeed, MaxSpeed,1); digitalWrite(Buzzer, HIGH); LastValue=5;} else
if (digitalRead(LSens)== LOW) {Set_Motor(-40, TurnSpeed,1); digitalWrite(Buzzer, HIGH); LastValue=7;} else if (digitalRead(RSens)==LOW) {Set_Motor(TurnSpeed, -40,1); digitalWrite(Buzzer, HIGH); LastValue=3;} else if (digitalRead(LFSens)== LOW) {Set_Motor(-40, TurnSpeed,1); digitalWrite(Buzzer, HIGH); LastValue=7;} else if (digitalRead(RFSens)==LOW) {Set_Motor(TurnSpeed, -40,1); digitalWrite(Buzzer, HIGH); LastValue=3;} else { digitalWrite(Buzzer, LOW); Speed=(analogRead(SPD)/10.3); // This raw speed value comes with 0 to 1023 so we divide to 10.3 After that it is 0 to 99 integer. Speed=100-Speed; // This is used for reversing trimpot dial direction at board. if (LastValue==5) { Set_Motor(Speed, Speed,1);} else // Forward, Based on SPD (A7) Trimpot if (LastValue==7) { Set_Motor(-20, Speed,2);} else // Left Turning Based on SPD (A7) Trimpot if (LastValue==3) { Set_Motor(Speed, -20,2);} // Right Turning Based on SPD (A7) Trimpot } } } Can you integrate the above code according to the items written below? Now program your robot to follow a square shaped path, as follows: i. Go forward for one second, ii. Make a 90 degree left turn, iii. Go to step (i). iv. Stop after four turns. Now program your robot to follow a square shaped path, as follows: i. Go forward for one second,
ii. Make a 90 degree left turn, iii. Go to step (i). iv. Stop after four turns.

More Related Content

DOC
FINISHED_CODE
Jeremy Forczyk
 
PPT
Arduinomotorcontrolusingservoultrasonic
NaveenBasireddy
 
DOCX
Twin wheeler modified for arduino simplified serial protocol to sabertooth v21
josnihmurni2907
 
PDF
What will be quantization step size in numbers and in voltage for th.pdf
SIGMATAX1
 
PDF
Musical Machines and Flapping Phones
Neil Mendoza
 
PPTX
Computer networks unit III CHAPTER of frameworks
manforlover7
 
PDF
Arduino uno basic Experiments for beginner
YogeshJatav7
 
TXT
Metal detecting robot sketch
Akhil Unnikrishnan
 
FINISHED_CODE
Jeremy Forczyk
 
Arduinomotorcontrolusingservoultrasonic
NaveenBasireddy
 
Twin wheeler modified for arduino simplified serial protocol to sabertooth v21
josnihmurni2907
 
What will be quantization step size in numbers and in voltage for th.pdf
SIGMATAX1
 
Musical Machines and Flapping Phones
Neil Mendoza
 
Computer networks unit III CHAPTER of frameworks
manforlover7
 
Arduino uno basic Experiments for beginner
YogeshJatav7
 
Metal detecting robot sketch
Akhil Unnikrishnan
 

Similar to GENESIS BOARD MINI SUMO ROBOT PROGRAMFOR 3 OPPONENT SENSOR, .pdf (20)

PDF
Arduino Lecture 3 - Interactive Media CS4062 Semester 2 2009
Eoin Brazil
 
PDF
Arduino Lecture 3 - Interactive Media CS4062 Semester 2 2009
Eoin Brazil
 
DOCX
Twin wheeler modified for arduino simplified serial protocol to sabertooth v22
josnihmurni2907
 
DOCX
Ldr based line follower robot
Akshay Sharma
 
KEY
Scottish Ruby Conference 2010 Arduino, Ruby RAD
lostcaggy
 
PDF
PROGRAMMING ADC and DAC-mbed.pdf
vidhyalakshmi153619
 
PPTX
Arduino Programming
Dr Karthikeyan Periasamy
 
PDF
MaxBotix Code Examples
MaxBotix Inc
 
PPTX
INTRODUCTION TO ARDUINO and sensors for arduino.pptx
Jo Mebs
 
PPT
Hexapod ppt
shiv kumar rai
 
KEY
Sbaw090908
Atsushi Tadokoro
 
PDF
L6 Visual Output LED_7SEGMEN_LEDMATRIX upate.pdf
Indra Hermawan
 
PDF
L6 Visual Output LED_7SEGMEN_LEDMATRIX upate.pdf
Indra Hermawan
 
DOCX
Arduino Final Project
Bach Nguyen
 
PPT
01 Intro to the Arduino and it's basics.ppt
pindi2197
 
DOCX
IOT excercise ESP32 Simulation projects.docx
ashvan200
 
PPTX
online technology POWERPOINT PRESENTATION
GABRIELFRANCISCESARI
 
PDF
Mdp plus 2.1
boedax
 
PPTX
Arduino cic3
Jeni Shah
 
PDF
Arduino: Analog I/O
June-Hao Hou
 
Arduino Lecture 3 - Interactive Media CS4062 Semester 2 2009
Eoin Brazil
 
Arduino Lecture 3 - Interactive Media CS4062 Semester 2 2009
Eoin Brazil
 
Twin wheeler modified for arduino simplified serial protocol to sabertooth v22
josnihmurni2907
 
Ldr based line follower robot
Akshay Sharma
 
Scottish Ruby Conference 2010 Arduino, Ruby RAD
lostcaggy
 
PROGRAMMING ADC and DAC-mbed.pdf
vidhyalakshmi153619
 
Arduino Programming
Dr Karthikeyan Periasamy
 
MaxBotix Code Examples
MaxBotix Inc
 
INTRODUCTION TO ARDUINO and sensors for arduino.pptx
Jo Mebs
 
Hexapod ppt
shiv kumar rai
 
Sbaw090908
Atsushi Tadokoro
 
L6 Visual Output LED_7SEGMEN_LEDMATRIX upate.pdf
Indra Hermawan
 
L6 Visual Output LED_7SEGMEN_LEDMATRIX upate.pdf
Indra Hermawan
 
Arduino Final Project
Bach Nguyen
 
01 Intro to the Arduino and it's basics.ppt
pindi2197
 
IOT excercise ESP32 Simulation projects.docx
ashvan200
 
online technology POWERPOINT PRESENTATION
GABRIELFRANCISCESARI
 
Mdp plus 2.1
boedax
 
Arduino cic3
Jeni Shah
 
Arduino: Analog I/O
June-Hao Hou
 
Ad

More from alltiusind (20)

PDF
Given a doubly-linked list (2,3,4,5,6,7), node 2 s pointer(s) point(.pdf
alltiusind
 
PDF
Given a list, remove item with index 0,4,5 from list if there exist a.pdf
alltiusind
 
PDF
Georgia Kennel uses tenant-days as its measure of activity; an animal.pdf
alltiusind
 
PDF
Georgia Kennel uses tenant-days as its measure of activity; an anmal .pdf
alltiusind
 
PDF
George Morton, gerente del departamento de mantenimiento de un gr.pdf
alltiusind
 
PDF
Get an educations A sucvey asked 32,114 people how much confidence th.pdf
alltiusind
 
PDF
General Instructions - Submit your solution no later than 1159pm ET .pdf
alltiusind
 
PDF
Generate and upload a PDA in JFF format for the following grammar Hi.pdf
alltiusind
 
PDF
General exceptions to.pdf
alltiusind
 
PDF
Gator Investments provides financial services related to investment s.pdf
alltiusind
 
PDF
Gotthelf Clinic uses client-visits as its measure of activity. During.pdf
alltiusind
 
PDF
Gopton Company Is considering a capptal bodgeting froject that would .pdf
alltiusind
 
PDF
Gordon Millers job shop has four work areas, A, B, C, and D. Distanc.pdf
alltiusind
 
PDF
Given the following relation staff property staffinspection Express.pdf
alltiusind
 
PDF
Globalization and Tourism Development - western values, authenticity,.pdf
alltiusind
 
PDF
Give you two list, return True if they have common item, False if the.pdf
alltiusind
 
PDF
Glycolaldehyde inhibits the Calvin cycle by inhibiting RuBP. What Cal.pdf
alltiusind
 
PDF
Glucans are small pieces of the cell walls of molds that may cause .pdf
alltiusind
 
PDF
Give Me Your Money bank knows they get on average 18 calls per hour o.pdf
alltiusind
 
PDF
Given the following BNF (1) Rewrite the above BNF to reflect the fol.pdf
alltiusind
 
Given a doubly-linked list (2,3,4,5,6,7), node 2 s pointer(s) point(.pdf
alltiusind
 
Given a list, remove item with index 0,4,5 from list if there exist a.pdf
alltiusind
 
Georgia Kennel uses tenant-days as its measure of activity; an animal.pdf
alltiusind
 
Georgia Kennel uses tenant-days as its measure of activity; an anmal .pdf
alltiusind
 
George Morton, gerente del departamento de mantenimiento de un gr.pdf
alltiusind
 
Get an educations A sucvey asked 32,114 people how much confidence th.pdf
alltiusind
 
General Instructions - Submit your solution no later than 1159pm ET .pdf
alltiusind
 
Generate and upload a PDA in JFF format for the following grammar Hi.pdf
alltiusind
 
General exceptions to.pdf
alltiusind
 
Gator Investments provides financial services related to investment s.pdf
alltiusind
 
Gotthelf Clinic uses client-visits as its measure of activity. During.pdf
alltiusind
 
Gopton Company Is considering a capptal bodgeting froject that would .pdf
alltiusind
 
Gordon Millers job shop has four work areas, A, B, C, and D. Distanc.pdf
alltiusind
 
Given the following relation staff property staffinspection Express.pdf
alltiusind
 
Globalization and Tourism Development - western values, authenticity,.pdf
alltiusind
 
Give you two list, return True if they have common item, False if the.pdf
alltiusind
 
Glycolaldehyde inhibits the Calvin cycle by inhibiting RuBP. What Cal.pdf
alltiusind
 
Glucans are small pieces of the cell walls of molds that may cause .pdf
alltiusind
 
Give Me Your Money bank knows they get on average 18 calls per hour o.pdf
alltiusind
 
Given the following BNF (1) Rewrite the above BNF to reflect the fol.pdf
alltiusind
 
Ad

Recently uploaded (20)

PPTX
Microbial diseases, their pathogenesis and prophylaxis
DevlinaSengupta
 
PDF
Module 4: Burden of Disease Tutorial Slides S2 2025
Jonathan Hallett
 
PDF
3rd Neelam Sanjeevareddy Memorial Lecture.pdf
Academy of Grassroots Studies and Research of India (AGRASRI)
 
PPTX
Cell Structure & Organelles in detailed.
DHANASHREESIVAKUMAR
 
PDF
Complications of Minimal Access Surgery at WLH
mohitsuren827
 
PDF
Microbial disease of the cardiovascular and lymphatic systems
KeyaSharma
 
PPTX
Pharma ospi slides which help in ospi learning
rameetkumar304
 
PPTX
Final Presentation General Medicine 03-08-2024.pptx
ZaheerAhmad228692
 
PPTX
Introduction-to-Literarature-and-Literary-Studies-week-Prelim-coverage.pptx
EricaRamos80
 
PDF
The Lost Whites of Pakistan by Jahanzaib Mughal.pdf
jahanzaibmughal6
 
PDF
Saundersa Comprehensive Review for the NCLEX-RN Examination.pdf
sreejithcareers
 
PDF
FourierSeries-QuestionsWithAnswers(Part-A).pdf
Raji Murugan
 
PPTX
master seminar digital applications in india
ananyaray35
 
PPTX
IMMUNITY IMMUNITY refers to protection against infection, and the immune syst...
shilpa939953
 
PPTX
Tissue processing ( HISTOPATHOLOGICAL TECHNIQUE
mathiasmelwyn7
 
PPTX
1st Inaugural Professorial Lecture held on 19th February 2020 (Governance and...
kawisojames10
 
PDF
ANTIBIOTICS.pptx.pdf………………… xxxxxxxxxxxxx
HakHe
 
PPTX
Pharmacology of Heart Failure /Pharmacotherapy of CHF
Rajshri Ghogare
 
PDF
O5-L3 Freight Transport Ops (International) V1.pdf
labyankof
 
PDF
Anesthesia in Laparoscopic Surgery in India
mohitsuren827
 
Microbial diseases, their pathogenesis and prophylaxis
DevlinaSengupta
 
Module 4: Burden of Disease Tutorial Slides S2 2025
Jonathan Hallett
 
3rd Neelam Sanjeevareddy Memorial Lecture.pdf
Academy of Grassroots Studies and Research of India (AGRASRI)
 
Cell Structure & Organelles in detailed.
DHANASHREESIVAKUMAR
 
Complications of Minimal Access Surgery at WLH
mohitsuren827
 
Microbial disease of the cardiovascular and lymphatic systems
KeyaSharma
 
Pharma ospi slides which help in ospi learning
rameetkumar304
 
Final Presentation General Medicine 03-08-2024.pptx
ZaheerAhmad228692
 
Introduction-to-Literarature-and-Literary-Studies-week-Prelim-coverage.pptx
EricaRamos80
 
The Lost Whites of Pakistan by Jahanzaib Mughal.pdf
jahanzaibmughal6
 
Saundersa Comprehensive Review for the NCLEX-RN Examination.pdf
sreejithcareers
 
FourierSeries-QuestionsWithAnswers(Part-A).pdf
Raji Murugan
 
master seminar digital applications in india
ananyaray35
 
IMMUNITY IMMUNITY refers to protection against infection, and the immune syst...
shilpa939953
 
Tissue processing ( HISTOPATHOLOGICAL TECHNIQUE
mathiasmelwyn7
 
1st Inaugural Professorial Lecture held on 19th February 2020 (Governance and...
kawisojames10
 
ANTIBIOTICS.pptx.pdf………………… xxxxxxxxxxxxx
HakHe
 
Pharmacology of Heart Failure /Pharmacotherapy of CHF
Rajshri Ghogare
 
O5-L3 Freight Transport Ops (International) V1.pdf
labyankof
 
Anesthesia in Laparoscopic Surgery in India
mohitsuren827
 

GENESIS BOARD MINI SUMO ROBOT PROGRAMFOR 3 OPPONENT SENSOR, .pdf

  • 1. / GENESIS BOARD MINI SUMO ROBOT PROGRAM //FOR 3 OPPONENT SENSOR, 2 EDGE SENSOR // JSUMO 01/2020 /////////////////////////////////////// //MOTOR CONTROL int RPwm = 11; int RDir = 13; int LPwm = 3; int LDir = 12; //LED & BUZZER int Buzzer = 9; int ArduLed = 8; //EDGE & CONTRAST SENSORS int Redge = A0; int Ledge = A1; //TRIMPOTS int SPD = A7; int TRN = A6; //OPPONENT SENSORS int LSens = A4; int RSens = A2; int MSens = A3;
  • 2. int LFSens = A5; int RFSens = 4; // DIPSWITCH & BUTTON int Button = 10; // Can be used as start pin too. int DS1 = 5; int DS2 = 6; int DS3 = 7; //VALUES int Speed =50; int MaxSpeed = 80; // Idle Speed while no sensor giving data. int TurnSpeed = 65; // Left and Right Forward Turning Speed int EdgeTurn = 150; // Turning Time variable when minisumo sees white line int Duration; // Turning Time at minisumo starting. int LastValue = 5; // Last Value Variable for remembering last Opponent sensor sense. void setup() { pinMode(LSens, INPUT); // Left Opponent Sensor Input pinMode(RSens, INPUT); // Right Opponent Sensor Input pinMode(MSens, INPUT); // Middle Opponent Sensor Input pinMode(Buzzer, OUTPUT); // Buzzer Declared as Output pinMode(ArduLed, OUTPUT); // Buzzer Declared as Output pinMode(Button, INPUT); // Buzzer Declared as Output pinMode(RPwm, OUTPUT); // Four PWM Channel Declared as Output pinMode(RDir, OUTPUT);
  • 3. pinMode(LPwm, OUTPUT); pinMode(LDir, OUTPUT); digitalWrite(Buzzer, LOW); // Buzzer Pin Made Low for Silence digitalWrite(ArduLed, LOW); // Arduino Mode Led Made Low digitalWrite(DS1, HIGH); // 3 Dipswitch Pin Pullups Made digitalWrite(DS2, HIGH); digitalWrite(DS3, HIGH); digitalWrite(LSens, HIGH); // Opponent Sensor Pullups Made digitalWrite(RSens, HIGH); digitalWrite(LFSens, HIGH); digitalWrite(RFSens, HIGH); digitalWrite(MSens, HIGH); Serial.begin(9600); } //Motor Control Function void Set_Motor (float Lval, float Rval, int timex){ Lval = Lval*2.5; Rval = Rval*2.5; if (Lval >=0) { analogWrite(LPwm, Lval); digitalWrite(LDir, LOW); } else { Lval=abs(Lval); digitalWrite(LDir, HIGH); analogWrite(LPwm, Lval); } if (Rval >=0) { analogWrite(RPwm, Rval); digitalWrite(RDir, HIGH); } else {
  • 4. Rval=abs(Rval); digitalWrite(RDir, LOW); analogWrite(RPwm, Rval); } //If you want to see Speed Values please uncomment bottom line. // Serial.print(Rval); Serial.print(-); Serial.println(Lval); delay(timex); } void loop() { digitalWrite(RPwm, LOW); digitalWrite(LPwm, LOW); tone(Buzzer, 18, 100); // Pin, Frequency, Duration ////////////////////////////////////////////// // This function below, used for stopping robot while no button is pushed or Microstart is not triggered. while (digitalRead(Button)==0) { Serial.println(Button Press Waited); Set_Motor(0,0,1); /// Sensor Control While Waiting The Button Press /// if ( digitalRead(MSens)==LOW || digitalRead(RSens)==LOW || digitalRead(LSens)== LOW || digitalRead(RFSens)==LOW || digitalRead(LFSens)== LOW || analogRead(Redge)< 100 || analogRead(Ledge)< 100 ) { digitalWrite(ArduLed, HIGH);} else { digitalWrite(ArduLed, LOW); } } /////////////////////////////////////////////// if (digitalRead(Button)==1) { Duration=(analogRead(TRN)/5); // Duration variable based on TRN (A6) trimpot Duration=205-Duration; // Serial.println(5 Sec Routine Started); for (int i = 0; i < 5; i++){ digitalWrite(Buzzer, HIGH); digitalWrite(ArduLed, HIGH);
  • 5. delay(100); digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, LOW); delay(900); } if (digitalRead(DS1)==0 && digitalRead(DS2)==1 && digitalRead(DS3)==1){ Serial.print(LEFT TURN); Set_Motor(-100,100,Duration); // } else if (digitalRead(DS1)==0 && digitalRead(DS2)==0 && digitalRead(DS3)==0) { Serial.print(MIDDLE DIRECT); Set_Motor(80,80,2); } else if (digitalRead(DS1)==1 && digitalRead(DS2)==1 && digitalRead(DS3)==0){ Serial.print(Sag); Set_Motor(100,-100,Duration); } else if (digitalRead(DS1)==1 && digitalRead(DS2)==0 && digitalRead(DS3)==0){ Serial.print(Left Circle); Set_Motor(100,36,650); } else if (digitalRead(DS1)==0 && digitalRead(DS2)==0 && digitalRead(DS3)==1){ Serial.print(Right Circle); Set_Motor(36,100,650); } else if (digitalRead(DS1)==0 && digitalRead(DS2)==1 && digitalRead(DS3)==0){ Serial.print(Reverse 180); Set_Motor(-100,100,Duration*2); // One Duration time is for 90 degree, so we multiply by 2. } Serial.print(OK); digitalWrite(Buzzer, LOW); EdgeTurn=(analogRead(TRN)/5); // Raw value comes with 0 to 1023, we divide it for 0 t0 205 mS turning time. EdgeTurn=205-EdgeTurn; // }
  • 6. //Main Loop while(1) { /// Edge Sensor Control Routine /// digitalWrite(ArduLed, LOW); if (analogRead(Ledge)<300 && analogRead(Redge)> 300) { digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, HIGH); Set_Motor(-100, -100,55); // Backward for 55 mS. Set_Motor(-100, 100, EdgeTurn); // Left Backward, Right Forward, Turning Time Based on ETRN Trimpot LastValue=5; } else if (analogRead(Ledge)> 300 && analogRead(Redge)< 300) { digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, HIGH); Set_Motor(-100, -100,55); // Backward for 55 mS. Set_Motor(100, -100, EdgeTurn); // Right Backward, Left Forward, Turning Time Based on ETRN Trimpot LastValue=5; } else if (analogRead(Ledge)< 300 && analogRead(Redge)< 300) { digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, HIGH); Set_Motor(-100, -100,55); // Backward for 55 mS. Set_Motor(100, -100, EdgeTurn); // Right Backward, Left Forward, Turning Time Based on ETRN Trimpot LastValue=5; }else /// Opponent Sensor Control Routine /// // Please uncomment below line if yu are using microstart, When microstart gives 0V it will stop motors. //while (digitalRead(Button)==LOW) {Set_Motor(0, 0, 20); digitalWrite(Buzzer, HIGH); LastValue=3;} digitalWrite(Buzzer, LOW);
  • 7. if (digitalRead(MSens)==LOW) {Set_Motor(MaxSpeed, MaxSpeed,1); digitalWrite(Buzzer, HIGH); LastValue=5;} else if (digitalRead(LSens)== LOW) {Set_Motor(-40, TurnSpeed,1); digitalWrite(Buzzer, HIGH); LastValue=7;} else if (digitalRead(RSens)==LOW) {Set_Motor(TurnSpeed, -40,1); digitalWrite(Buzzer, HIGH); LastValue=3;} else if (digitalRead(LFSens)== LOW) {Set_Motor(-40, TurnSpeed,1); digitalWrite(Buzzer, HIGH); LastValue=7;} else if (digitalRead(RFSens)==LOW) {Set_Motor(TurnSpeed, -40,1); digitalWrite(Buzzer, HIGH); LastValue=3;} else { digitalWrite(Buzzer, LOW); Speed=(analogRead(SPD)/10.3); // This raw speed value comes with 0 to 1023 so we divide to 10.3 After that it is 0 to 99 integer. Speed=100-Speed; // This is used for reversing trimpot dial direction at board. if (LastValue==5) { Set_Motor(Speed, Speed,1);} else // Forward, Based on SPD (A7) Trimpot if (LastValue==7) { Set_Motor(-20, Speed,2);} else // Left Turning Based on SPD (A7) Trimpot if (LastValue==3) { Set_Motor(Speed, -20,2);} // Right Turning Based on SPD (A7) Trimpot } } } Can you integrate the above code according to the items written below? Now program your robot to follow a square shaped path, as follows: i. Go forward for one second, ii. Make a 90 degree left turn, iii. Go to step (i). iv. Stop after four turns.
  • 8. / GENESIS BOARD MINI SUMO ROBOT PROGRAM //FOR 3 OPPONENT SENSOR, 2 EDGE SENSOR // JSUMO 01/2020 /////////////////////////////////////// //MOTOR CONTROL int RPwm = 11; int RDir = 13; int LPwm = 3; int LDir = 12; //LED & BUZZER int Buzzer = 9; int ArduLed = 8; //EDGE & CONTRAST SENSORS int Redge = A0; int Ledge = A1; //TRIMPOTS int SPD = A7; int TRN = A6; //OPPONENT SENSORS int LSens = A4; int RSens = A2; int MSens = A3;
  • 9. int LFSens = A5; int RFSens = 4; // DIPSWITCH & BUTTON int Button = 10; // Can be used as start pin too. int DS1 = 5; int DS2 = 6; int DS3 = 7; //VALUES int Speed =50; int MaxSpeed = 80; // Idle Speed while no sensor giving data. int TurnSpeed = 65; // Left and Right Forward Turning Speed int EdgeTurn = 150; // Turning Time variable when minisumo sees white line int Duration; // Turning Time at minisumo starting. int LastValue = 5; // Last Value Variable for remembering last Opponent sensor sense. void setup() { pinMode(LSens, INPUT); // Left Opponent Sensor Input pinMode(RSens, INPUT); // Right Opponent Sensor Input pinMode(MSens, INPUT); // Middle Opponent Sensor Input pinMode(Buzzer, OUTPUT); // Buzzer Declared as Output pinMode(ArduLed, OUTPUT); // Buzzer Declared as Output pinMode(Button, INPUT); // Buzzer Declared as Output pinMode(RPwm, OUTPUT); // Four PWM Channel Declared as Output pinMode(RDir, OUTPUT); pinMode(LPwm, OUTPUT); pinMode(LDir, OUTPUT);
  • 10. digitalWrite(Buzzer, LOW); // Buzzer Pin Made Low for Silence digitalWrite(ArduLed, LOW); // Arduino Mode Led Made Low digitalWrite(DS1, HIGH); // 3 Dipswitch Pin Pullups Made digitalWrite(DS2, HIGH); digitalWrite(DS3, HIGH); digitalWrite(LSens, HIGH); // Opponent Sensor Pullups Made digitalWrite(RSens, HIGH); digitalWrite(LFSens, HIGH); digitalWrite(RFSens, HIGH); digitalWrite(MSens, HIGH); Serial.begin(9600); } //Motor Control Function void Set_Motor (float Lval, float Rval, int timex){ Lval = Lval*2.5; Rval = Rval*2.5; if (Lval >=0) { analogWrite(LPwm, Lval); digitalWrite(LDir, LOW); } else { Lval=abs(Lval); digitalWrite(LDir, HIGH); analogWrite(LPwm, Lval); } if (Rval >=0) { analogWrite(RPwm, Rval); digitalWrite(RDir, HIGH); } else { Rval=abs(Rval); digitalWrite(RDir, LOW);
  • 11. analogWrite(RPwm, Rval); } //If you want to see Speed Values please uncomment bottom line. // Serial.print(Rval); Serial.print(-); Serial.println(Lval); delay(timex); } void loop() { digitalWrite(RPwm, LOW); digitalWrite(LPwm, LOW); tone(Buzzer, 18, 100); // Pin, Frequency, Duration ////////////////////////////////////////////// // This function below, used for stopping robot while no button is pushed or Microstart is not triggered. while (digitalRead(Button)==0) { Serial.println(Button Press Waited); Set_Motor(0,0,1); /// Sensor Control While Waiting The Button Press /// if ( digitalRead(MSens)==LOW || digitalRead(RSens)==LOW || digitalRead(LSens)== LOW || digitalRead(RFSens)==LOW || digitalRead(LFSens)== LOW || analogRead(Redge)< 100 || analogRead(Ledge)< 100 ) { digitalWrite(ArduLed, HIGH);} else { digitalWrite(ArduLed, LOW); } } /////////////////////////////////////////////// if (digitalRead(Button)==1) { Duration=(analogRead(TRN)/5); // Duration variable based on TRN (A6) trimpot Duration=205-Duration; // Serial.println(5 Sec Routine Started); for (int i = 0; i < 5; i++){ digitalWrite(Buzzer, HIGH); digitalWrite(ArduLed, HIGH); delay(100); digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, LOW); delay(900); }
  • 12. if (digitalRead(DS1)==0 && digitalRead(DS2)==1 && digitalRead(DS3)==1){ Serial.print(LEFT TURN); Set_Motor(-100,100,Duration); // } else if (digitalRead(DS1)==0 && digitalRead(DS2)==0 && digitalRead(DS3)==0) { Serial.print(MIDDLE DIRECT); Set_Motor(80,80,2); } else if (digitalRead(DS1)==1 && digitalRead(DS2)==1 && digitalRead(DS3)==0){ Serial.print(Sag); Set_Motor(100,-100,Duration); } else if (digitalRead(DS1)==1 && digitalRead(DS2)==0 && digitalRead(DS3)==0){ Serial.print(Left Circle); Set_Motor(100,36,650); } else if (digitalRead(DS1)==0 && digitalRead(DS2)==0 && digitalRead(DS3)==1){ Serial.print(Right Circle); Set_Motor(36,100,650); } else if (digitalRead(DS1)==0 && digitalRead(DS2)==1 && digitalRead(DS3)==0){ Serial.print(Reverse 180); Set_Motor(-100,100,Duration*2); // One Duration time is for 90 degree, so we multiply by 2. } Serial.print(OK); digitalWrite(Buzzer, LOW); EdgeTurn=(analogRead(TRN)/5); // Raw value comes with 0 to 1023, we divide it for 0 t0 205 mS turning time. EdgeTurn=205-EdgeTurn; // } //Main Loop
  • 13. while(1) { /// Edge Sensor Control Routine /// digitalWrite(ArduLed, LOW); if (analogRead(Ledge)<300 && analogRead(Redge)> 300) { digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, HIGH); Set_Motor(-100, -100,55); // Backward for 55 mS. Set_Motor(-100, 100, EdgeTurn); // Left Backward, Right Forward, Turning Time Based on ETRN Trimpot LastValue=5; } else if (analogRead(Ledge)> 300 && analogRead(Redge)< 300) { digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, HIGH); Set_Motor(-100, -100,55); // Backward for 55 mS. Set_Motor(100, -100, EdgeTurn); // Right Backward, Left Forward, Turning Time Based on ETRN Trimpot LastValue=5; } else if (analogRead(Ledge)< 300 && analogRead(Redge)< 300) { digitalWrite(Buzzer, LOW); digitalWrite(ArduLed, HIGH); Set_Motor(-100, -100,55); // Backward for 55 mS. Set_Motor(100, -100, EdgeTurn); // Right Backward, Left Forward, Turning Time Based on ETRN Trimpot LastValue=5; }else /// Opponent Sensor Control Routine /// // Please uncomment below line if yu are using microstart, When microstart gives 0V it will stop motors. //while (digitalRead(Button)==LOW) {Set_Motor(0, 0, 20); digitalWrite(Buzzer, HIGH); LastValue=3;} digitalWrite(Buzzer, LOW); if (digitalRead(MSens)==LOW) {Set_Motor(MaxSpeed, MaxSpeed,1); digitalWrite(Buzzer, HIGH); LastValue=5;} else
  • 14. if (digitalRead(LSens)== LOW) {Set_Motor(-40, TurnSpeed,1); digitalWrite(Buzzer, HIGH); LastValue=7;} else if (digitalRead(RSens)==LOW) {Set_Motor(TurnSpeed, -40,1); digitalWrite(Buzzer, HIGH); LastValue=3;} else if (digitalRead(LFSens)== LOW) {Set_Motor(-40, TurnSpeed,1); digitalWrite(Buzzer, HIGH); LastValue=7;} else if (digitalRead(RFSens)==LOW) {Set_Motor(TurnSpeed, -40,1); digitalWrite(Buzzer, HIGH); LastValue=3;} else { digitalWrite(Buzzer, LOW); Speed=(analogRead(SPD)/10.3); // This raw speed value comes with 0 to 1023 so we divide to 10.3 After that it is 0 to 99 integer. Speed=100-Speed; // This is used for reversing trimpot dial direction at board. if (LastValue==5) { Set_Motor(Speed, Speed,1);} else // Forward, Based on SPD (A7) Trimpot if (LastValue==7) { Set_Motor(-20, Speed,2);} else // Left Turning Based on SPD (A7) Trimpot if (LastValue==3) { Set_Motor(Speed, -20,2);} // Right Turning Based on SPD (A7) Trimpot } } } Can you integrate the above code according to the items written below? Now program your robot to follow a square shaped path, as follows: i. Go forward for one second, ii. Make a 90 degree left turn, iii. Go to step (i). iv. Stop after four turns. Now program your robot to follow a square shaped path, as follows: i. Go forward for one second,
  • 15. ii. Make a 90 degree left turn, iii. Go to step (i). iv. Stop after four turns.