1 / 8

Joonejärgimisrobot

Joonejärgimisrobot. Lennart Lüsi Maie-Liis Guitar Allan Ild Karl Leoste. Põhimõtted. Robot ei tohi oma tegevuse ega tegevusetusega inimesele kahju teha; Robot peab täitma inimese antud korraldusi, kui need pole vastuolus esimese seadusega;

jameson-gardner
Download Presentation

Joonejärgimisrobot

An Image/Link below is provided (as is) to download presentation Download Policy: Content on the Website is provided to you AS IS for your information and personal use and may not be sold / licensed / shared on other websites without getting consent from its author. Content is provided to you AS IS for your information and personal use only. Download presentation by click this link. While downloading, if for some reason you are not able to download a presentation, the publisher may have deleted the file from their server. During download, if you can't get a presentation, the file might be deleted by the publisher.

E N D

Presentation Transcript

  1. Joonejärgimisrobot Lennart Lüsi Maie-Liis Guitar Allan Ild Karl Leoste

  2. Põhimõtted • Robot ei tohi oma tegevuse ega tegevusetusega inimesele kahju teha; • Robot peab täitma inimese antud korraldusi, kui need pole vastuolus esimese seadusega; • Robot peab kaitsma oma olemasolu, kuni see ei lähe vastuollu esimese ega teise seadusega.

  3. Eesmärgid • Robot järgib tumedat joont kuni joon eksisteerib • Joone puudumisel püüab robot põgeneda oma loomulikku elukeskkonda.

  4. Kood longrunningAverage(int M) { staticint LM[100]; staticbyteindex = 0; staticlongsum = 0; staticbytecount = 0; int LMSIZE = 50; sum -= LM[index]; LM[index] = M; sum += LM[index]; index = index % LMSIZE; if (count < LMSIZE) count++; returnsum / count; }

  5. voiddrive(intspd, inttrn = 0){ intlspd; intrspd; if (trn!=0){ lspd=spd-trn/2; rspd=spd+trn/2; } else { lspd=spd; rspd=spd; } if (rspd>0){ digitalWrite(13, HIGH); } else if(rspd<0){ digitalWrite(13, LOW); } if (lspd>0){ digitalWrite(12, LOW); } else if(lspd<0){ digitalWrite(12, HIGH); } digitalWrite(9, LOW); //channel A nobreak digitalWrite(8, LOW); //channel B nobreak if((spd!=0||trn!=0)&&abs(lspd)<minspeed){ lspd=minspeed; } if((spd!=0||trn!=0)&&abs(rspd)<minspeed){ rspd=minspeed; } if(lspd>maxspeed){ rspd=rspd-(lspd-maxspeed); lspd=maxspeed; } if(rspd>maxspeed){ lspd=lspd-(rspd-maxspeed); rspd=maxspeed; } analogWrite(3, abs(lspd)); //channel A speed 1-255 analogWrite(11, abs(rspd)); //channel B speed 1-255 }

  6. Veel koodi intreadSensors(){ lightLevelv=analogRead(3); lightLevelp=analogRead(2); intavgleft=runningAverage(lightLevelv); intavgright=runningAverage(lightLevelp); intavgvahe=avgleft-avgright; /*Serial.print("readSensors[left:"); Serial.print(lightLevelv); Serial.print(" right:"); Serial.print(lightLevelp); Serial.print(" LeftAvg:"); Serial.print(avgleft); Serial.print(" RightAvg:"); Serial.print(avgright); Serial.print(" Avgvahe:"); Serial.println(avgvahe);*/ return(avgvahe); }

  7. Olekumasin voidloop(){ intavgvahe = readSensors(); switch (state) { case 0://State:STOP Serial.println("State:STOP"); drive(0,0); if((avgvahe > 2)||(avgvahe < 0)){ state = 2; //State:FOLLOWLINE } break; case 1: Serial.println("State:FORWARD"); speeed = 105;//State:FORWARD drive(speeed,0); if((avgvahe > 3)||(avgvahe < 1)){ state = 2; //State:FOLLOWLINE } break; case 2://State:FOLLOWLINE Serial.println("State:FOLLOWLINE"); if(avgvahe > 3){ drive(255,250); } elseif(avgvahe < 1){ drive(255,-250); } else { state = 1;//State:FORWARD } break; default: Serial.println("State:default"); speeed = 255; drive(speeed,0); if(lightLevelv<whiteLimiter||lightLevelp<whiteLimiter){ state=2; } } }

  8. Tänan kuulamast ja vaatamast!

More Related