Differences

This shows you the differences between two versions of the page.

Link to this comparison view

--- et:projects:arduino [2015/12/28 12:46] – kaupo.raid
+++ et:projects:arduino [2020/07/20 09:00] (current) – external edit 127.0.0.1
@@ Line 22: / Line 22: @@
 ===== Näiteprogrammid =====
+{{youtube>4LQQmu8EffI?medium}}
 === Mootorite kalibreerimine ===
@@ Line 46: / Line 48: @@
 #define L_MOTOR_FWD 3
 #define R_MOTOR_FWD 4
+#define S_MOTOR_LEFT 5
+#define S_MOTOR_RIGHT 6
 void setup() {
@@ Line 63: / Line 67: @@
 void calibMotors() {
-  int leftVal, rightVal, sensVal, fwdLeft, fwdRight;
+  int leftVal, rightVal, sensVal, fwdLeft, fwdRight, sensLeftSide, sensRightSide;
-  ////Kalibratsiooni algus. Indikaatori tuli läheb põlema. (Viigul 13 led)
+  //Calibration in progress inidicator HIGH
   digitalWrite(LED, HIGH);
   while (digitalRead(SWITCH) == LOW);
   delay(200);
-  for (int i = 0; i < 3; i++) {
+  for (int i = 0; i < 5; i++) {
     while (digitalRead(SWITCH) == HIGH) {
       if (i == 0) {
@@ Line 82: / Line 86: @@
         sensVal = map(analogRead(POTPIN), 0, 1023, 30, 150);
         sensM.write(sensVal);
+      }
+      if (i == 3) {
+        sensLeftSide = map(analogRead(POTPIN), 0, 1023, 0, 180);
+        sensM.write(sensLeftSide);
+      }
+      if (i == 4) {
+        sensRightSide = map(analogRead(POTPIN), 0, 1023, 0, 180);
+        sensM.write(sensRightSide);
       }
     }
@@ Line 92: / Line 104: @@
   while (digitalRead(SWITCH) == HIGH);
   delay(1000);
-  if (digitalRead(IRSENS) == 1) {
     while (digitalRead(SWITCH) == HIGH) {
       fwdLeft = 0;
@@ Line 98: / Line 109: @@
       rightM.write(fwdRight);
     }
-  }
+    delay(1000);
-  else {
     while (digitalRead(SWITCH) == HIGH) {
       fwdRight = 180;
@@ Line 105: / Line 115: @@
       leftM.write(fwdLeft);
     }
-  }
+  //Stop motors
-  //Peata mootorid
   leftM.write(leftVal);
   rightM.write(rightVal);
@@ Line 118: / Line 127: @@
   EEPROM.update(R_MOTOR_STOP, rightVal);
   EEPROM.update(S_MOTOR_CENTR, sensVal);
+  EEPROM.update(S_MOTOR_LEFT, sensLeftSide);
+  EEPROM.update(S_MOTOR_RIGHT, sensRightSide);
   EEPROM.update(L_MOTOR_FWD, fwdLeft);
   EEPROM.update(R_MOTOR_FWD, fwdRight);
-  //Kalibratsiooni lõpp. Indikaatori tuli kustub. (Viigul 13 led)
+  //Calibration end inidicator LOW
   digitalWrite(LED, LOW);
-  //Prindi välja väärtused jadaporti
+  //Print out values
   Serial.print("L: ");
   Serial.println(EEPROM.read(L_MOTOR_STOP));
@@ Line 146: / Line 157: @@
 **Programmi töö selgitus:**
-  * Vajutada korraks nuppu
+  * Vajutada korraks nuppu.
-  * Keerata potentsiomeetrit kuni vasak mootor jääb seisma
+  * Keerata potentsiomeetrit kuni vasak mootor jääb seisma.
-  * Vajutada korraks nuppu
+  * Vajutada korraks nuppu.
-  * Keerata potentsiomeetrit kuni parem mootor jääb seisma
+  * Keerata potentsiomeetrit kuni parem mootor jääb seisma.
-  * Vajutada korraks nuppu
+  * Vajutada korraks nuppu.
   * Keerata potentsiomeetrit kuni ultrahelianduri servo on võimalikult otse suunatud.
-  * Vajutada korraks nuppu
+  * Vajutada korraks nuppu.
-  * Paigutada robot maha ja vaadata kummale poole robot kaldub. Kui kaldub vasakule, siis tuleb korrigeerida parema mootori kiirust. Teisel juhul vastupidi.
+  * Keerata potentsiomeetrit kuni ultrahelianduri servo on suunatud umbes 60 kraadi roboti keskteljest vasakule.
-  * Vajutada korraks nuppu (Kui hoida kätt digitaalse infrapunaanduri ees, siis korrigeeritakse vasakut mootorit. Kui anduril takistust ees ei ole, siis korrigeeritakse paremat mootorit.)
+  * Vajutada korraks nuppu.
-  * Keerata potentsiomeetrit kuni robot sõidab enamvähem otse
+  * Keerata potentsiomeetrit kuni ultrahelianduri servo on suunatud umbes 60 kraadi roboti keskteljest paremale.
-  * Vajutada korraks nuppu
+  * Vajutada korraks nuppu.
-  * Kalibratsioon on lõpule jõudnud ja väärtused EEPROM mällu salvestatud. Kalibratsiooni väärtusi on võimalik näha kui Arduino IDE-s avada juba kalibratsiooni alguses jadapordi monitor.
+  * Roboti mõlemad mootorid hakkavad pöörlema maksimum kiirusel. Paigutada robot maha ja vaadata kummale poole robot kaldub. Kui kaldub vasakule, siis tuleb võtta vasaku mootori kiirus maksimum kiiruseks, et robot liiguks otse. Vastasel juhul parema mootori kiirus. Vajadusel võib aeglasemaks liikumiskiiruseks mõlema mootori kiirust vähendada.
+  * Vajutada korraks nuppu.
+  * Keerata potentsiomeetrit kuni mootori pöörlemiskiirus on sobiv.
+  * Vajutada korraks nuppu.
+  * Keerata potentsiomeetrit kuni roboti teine mootor liigub sama kiirusega ja roboti trajektoor on sirge.
+  * Vajutada korraks nuppu.
+  * Kalibratsioon on lõpule jõudnud ja väärtused EEPROM mällu salvestatud. Kalibratsiooni väärtusi on võimalik näha kui Arduino IDE-s avada enne kalibratsiooni algust jadapordi monitor ja see jätta lahti kogu kalibrerimise ajaks.
+  * Kalibratsiooni lõpus on võimalik potentsiomeetriga testida ultrahelianduri servo liikumist.
 === Lihtne navigeerimine ===
@@ Line 251: / Line 269: @@
 #include <NewPing.h>
-//Parameetrid
+//Parameters
-#define SONARDIFF 10 //miinimum kahe suuna vahe, et teha väikest pööret
+#define TURNDLY 800 //90deg turn delay
-#define TURNDLY 800 //90 kraadise pöörde tegemise viide
+#define SMIN 0 //distance from which to activate small turns
-#define SMIN 40 //kaugus millest alates aktiveerida väikse pöörde tegemine
+#define SMAX 200 //distance from which to deactivate small turns
-#define SMAX 200 //kaugus, millest alates lõpetada väikse pöörde tegemine
-//Servo objektide loomine
+//Servo objects create
 Servo leftM, rightM, sensM;
-//Ultrahelianduri(Sonar) objekti loomine ja viikude määramine
+//Sonra distance sensor pins reference and object create
 #define TRIG 12
 #define ECHO 11
 NewPing sonar(TRIG, ECHO, 200);
-//Roboti osadele viikude määramine
+//Define constants for pin reference
 #define LED 13
 #define POTPIN A0
@@ Line 271: / Line 288: @@
 #define R_SERVO 9
 #define S_SERVO 8
-//EEPROM bitid
+//EEPROM bytes
 #define L_MOTOR_STOP 0
 #define R_MOTOR_STOP 1
@@ Line 277: / Line 294: @@
 #define L_MOTOR_FWD 3
 #define R_MOTOR_FWD 4
+#define S_MOTOR_LEFT 5
+#define S_MOTOR_RIGHT 6
-//Globaalsed muutujad
+//Global variables
 const int leftStop = EEPROM.read(L_MOTOR_STOP);
 const int rightStop = EEPROM.read(R_MOTOR_STOP);
 const int sensCentr = EEPROM.read(S_MOTOR_CENTR);
+const int sensLeft = EEPROM.read(S_MOTOR_LEFT);
+const int sensRight = EEPROM.read(S_MOTOR_RIGHT);
 const int leftFwd = EEPROM.read(L_MOTOR_FWD);
 const int rightFwd = EEPROM.read(R_MOTOR_FWD);
 int sonarDist[3];
 void motorTurn(int dir);
-//Funktsioonide prototüübid
+//Functions prototypes
 int sweepRun(int pos ,int moveOnly);
 void motorStop(int servo);
@@ Line 293: / Line 316: @@
 void setup() {
-  //Servo objekti ja viigu sidumine
+  //Servo object to Arduino pin setup
   leftM.attach(L_SERVO);
   rightM.attach(R_SERVO);
   sensM.attach(S_SERVO);
-  //Jadaliidese käivitamine
+  //Serial port setup
   Serial.begin(9600);
-  //viikude seadistamine
+  //Pins direction setup
   pinMode(POTPIN, INPUT);
   pinMode(IRSENS, INPUT);
@@ Line 307: / Line 330: @@
 }
+//Main program loop
 void loop() {
-  //Lokaalsed muutujad
   int frontWall;
   int fwdTime = 1000;
   int sweepPos = 0;
-  int sweepDir = -1;  // -1 vasakule ja 1 paremale
+  int sweepDir = -1;  // -1 left and 1 right
   unsigned long lastSweep = 0;
   int scanDone = 0;
-  int sonarDiff;
   unsigned long lastTurn = 0;
-  //Kirjuta servodele algväärtused
+  //Write initial values to servos
   leftM.write(leftStop);
   rightM.write(rightStop);
   sensM.write(sensCentr);
-  //Wait for switch press to start
+  //Wait until switch is pressed
   while (digitalRead(SWITCH) == HIGH) {
     digitalWrite(LED, HIGH);
@@ Line 329: / Line 352: @@
     delay(100);
   }
-  //Algoritmi lõputu tsükkel
+  //Algorithm main loop
   while (1) {
-    //Loe ees oleva infrapunaanduri väärtus
+    //check if something is blocking way
     frontWall = digitalRead(IRSENS);
-    //Ultraheliandur käib edasi tagasi, et pidevalt vaadata kolme suunda
-    if(millis() - lastSweep > 400){
+    //Sweeping motion distance measure
+    if(millis() - lastSweep > 350){
       sweepRun(sweepPos, 0);
       if(sweepPos == -1 || sweepPos == 1) scanDone = 1;
@@ Line 345: / Line 369: @@
       sweepRun(sweepPos, 1);
       lastSweep = millis();
+    Serial.print("V: ");
+    Serial.print(sonarDist[0]);
+    Serial.print("K: ");
+    Serial.print(sonarDist[1]);
+    Serial.print("P: ");
+    Serial.println(sonarDist[2]);
     }
     if (frontWall == 0) {
       motorStop(0);
@@ Line 354: / Line 385: @@
       lastTurn = millis();
     }
-    else if(sonarDist[0] > 0 && sonarDist[2] > 0 && scanDone == 1 && sonarDist[1] > SMIN && sonarDist[1] < SMAX && (millis() - lastTurn > 2000))
+    else if(scanDone == 1 && (millis() - lastTurn > 2000))
     {
-      //calculate sonar sensors distance difference
+      if (sonarDist[0] < 25) {
-      sonarDiff = sonarDist[0] - sonarDist[2];
-      if (sonarDiff > SONARDIFF) {
         motorStop(0);
-        motorTurn(-1, 200);
+        motorTurn(1, 200);
       }
-      else if(sonarDiff < -1*SONARDIFF){
+      else if(sonarDist[2] < 25){
         motorStop(0);
-        motorTurn(1, 200);
+        motorTurn(-1, 200);
       }
       scanDone = 0;
@@ Line 375: / Line 403: @@
   }
 }
+//Motors stopping function
-//Mootorite koos või eraldi peatamise funktsioon
 void motorStop(int wheel){
   if(wheel == 0){
@@ Line 389: / Line 416: @@
   }
 }
+//Forward moving function
-//Otse liikumise funktsioon
 void motorFwd(void){
     leftM.write(leftFwd);
     rightM.write(rightFwd);
 }
+//Robot on the spot turning function
-//Pööramise funktsioon
 void motorTurn(int dir, int dly){
   //left
@@ Line 410: / Line 435: @@
   delay(dly);
 }
+//Sonar sweeping function for servo motor movement
-//Ultrahelianduri lugemise funktsioon
 int sweepRun(int pos, int moveOnly){
   if(pos == 2){
@@ Line 417: / Line 441: @@
     delay(400);
     sonarDist[1] = sonar.ping_cm();
-    sensM.write(180);
+    sensM.write(sensLeft);
     delay(400);
     sonarDist[0] = sonar.ping_cm();
-    sensM.write(0);
+    sensM.write(sensRight);
     delay(800);
     sonarDist[2] = sonar.ping_cm();
@@ Line 432: / Line 456: @@
   }
   else if(pos == -1){
-    sensM.write(180);
+    sensM.write(sensLeft);
     if(moveOnly) return 0;
     sonarDist[0] = sonar.ping_cm();
@@ Line 438: / Line 462: @@
   }
   else if(pos == 1){
-    sensM.write(0);
+    sensM.write(sensRight);
     if(moveOnly) return 0;
     sonarDist[2] = sonar.ping_cm();

et/projects/arduino.1451306763.txt.gz · Last modified: 2020/07/20 09:00 (external edit)