Различия

Здесь показаны различия между двумя версиями данной страницы.

--- kiber_tc_2018 [2019/04/01 20:12]
super_admin [Вариант 2.1. Простейший релейный регулятор движения по линии + ультразвуковой датчик препятствия]
+++ kiber_tc_2018 [2019/11/20 23:06] (текущий)
super_admin [Реализация машины состояний при движении по линии]
@@ Строка 509: / Строка 509: @@
 </code>
+==== Релейный регулятор датчиков линии на драйвере L293D (обновленная версия) ====
+<code>
+#define PWMA 6  // выходы arduino
+#define PWMB 3
+#define AIN1 7
+#define AIN2 8
+#define BIN1 2
+#define BIN2 4
+#define lS 12
+#define rS 11
+int min_speed = 120;
+int max_speed = 255;
+int n_speed = 180;
+int dif = 180;
+uint8_t lSState;
+uint8_t rSState;
+int state;
+int prevState;
+int readyState = 0;
+void resetState(int st){
+  prevState = state;
+  state = st;
+}
+//int state;
+ void setup() {
+  /* Настроить все 7 выводов на выходы, идущие к драйверу TB6612FNG */
+  pinMode(PWMA,OUTPUT);
+  pinMode(AIN1,OUTPUT);
+  pinMode(AIN2,OUTPUT);
+  pinMode(PWMB,OUTPUT);
+  pinMode(BIN1,OUTPUT);
+  pinMode(BIN2,OUTPUT);
+  pinMode(lS,INPUT);
+  pinMode(rS,INPUT);
+  Serial.begin(9600);
+   while (readyState == 0) {
+    testSensors();
+    if (prevState != 11)
+      readyState = 1;
+      delay(1000);
+  }
+ delay(2000);
+}
+void testSensors(){
+  lSState = digitalRead(lS);
+  rSState = digitalRead(rS);
+   //Serial.println(lSState);
+   //Serial.println(rSState);
+   //Serial.println("");
+   if (lSState == 0 && rSState == 0  ){
+          resetState(0);
+       //goForward(n_speed);
+   }
+   if (lSState == 1 && rSState == 0  ){
+       resetState(10);
+       //goForward(n_speed);
+   }
+  // if (current_dist <= dangerous_dist ){
+  //    resetState(1);
+      //applyBrakes ();
+  // }
+   if (lSState == 1 && rSState == 1  ){
+     //if (readyState == 0)
+       resetState(11);
+       //veerRight(n_speed, dif);
+   }
+   if (lSState == 0 && rSState == 1   ){
+       resetState(1);
+       //veerLeft(n_speed, dif);
+   }
+}
+void loop() {
+  testSensors();
+  updateMotion(n_speed, dif);
+ // centralLineFollower();
+delay(1);
+  }
+void updateMotion(int sp, int d){
+    switch ( state ) {
+    case 0:
+      if (prevState == 1)
+        veerLeft(sp, d);
+      else if (prevState == 10)
+        veerRight(sp, d);
+      break;
+    case 1:
+      // Code
+      goForward(sp);
+      break;
+    case 10:
+      // Code
+      goForward(sp);
+      break;
+    case 11:
+      // Code
+      if (prevState == 10)
+        veerRight(sp, d);
+      else if (prevState == 1)
+        veerLeft(sp, d);
+      break;
+    }
+}
+ void leftLineFollower(){
+    //goForward(n_speed);
+    //applyBrakes ();
+    //veerRight(n_speed, dif);
+    //veerLeft(n_speed, dif);
+}
+void centralLineFollower(){
+}
+void goForward (int v)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v);
+}
+void goBackward (int v)
+{
+  digitalWrite (AIN1,LOW);
+  digitalWrite (AIN2,HIGH);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,LOW);
+  digitalWrite (BIN2,HIGH);
+  analogWrite(PWMB,v);
+}
+void rotateRight (int v)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,LOW);
+  digitalWrite (BIN2,HIGH);
+  analogWrite(PWMB,v);
+}
+void rotateLeft (int v)
+{
+  digitalWrite (AIN1,LOW);
+  digitalWrite (AIN2,HIGH);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v);
+}
+void veerLeft (int v, int d)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v -d);
+}
+void veerRight (int v, int d)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v -d);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v );
+}
+void applyBrakes ()
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,HIGH);
+  analogWrite(PWMA,255);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,HIGH);
+  analogWrite(PWMB,255);
+}
+</code>
 ==== Управление питанием посредством кнопки ====
@@ Строка 764: / Строка 975: @@
   }
-void testmove(){
-  //startUp();
-  //goForward();
+void goForward (int v)
-  //delay(1500);
+{
-  //turnAround();
+  digitalWrite (AIN1,HIGH);
-  //goForward();
+  digitalWrite (AIN2,LOW);
-  //delay(1500);
+  analogWrite(PWMA,v);
-  //turnAround();
+  digitalWrite (BIN1,HIGH);
-  //goBackward();
+  digitalWrite (BIN2,LOW);
-  //delay(1500);
+  analogWrite(PWMB,v);
-  //rotateLeft();
+}
-  //delay(560);
-  //rotateRight();
+void goBackward (int v)
-  //delay(2240);
+{
- // goForward();
+  digitalWrite (AIN1,LOW);
- // delay(1000);
+  digitalWrite (AIN2,HIGH);
-  //applyBrakes();
+  analogWrite(PWMA,v);
- // delay(2000);
+  digitalWrite (BIN1,LOW);
+  digitalWrite (BIN2,HIGH);
+  analogWrite(PWMB,v);
+}
+void rotateRight (int v)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,LOW);
+  digitalWrite (BIN2,HIGH);
+  analogWrite(PWMB,v);
+}
+void rotateLeft (int v)
+{
+  digitalWrite (AIN1,LOW);
+  digitalWrite (AIN2,HIGH);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v);
+}
+void veerLeft (int v, int d)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v -d);
+}
+void veerRight (int v, int d)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v -d);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v );
+}
+void applyBrakes ()
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,HIGH);
+  analogWrite(PWMA,255);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,HIGH);
+  analogWrite(PWMB,255);
+}
+void startUp ()
+{
+  digitalWrite(STBY,HIGH);
+}
+void shutDown ()
+{
+  digitalWrite(STBY,LOW);
+}
+</code>
+==== Реализация машины состояний при движении по линии ====
+<code C++>
+#define PWMA 11  // выходы arduino
+#define PWMB 10
+#define AIN1 6
+#define AIN2 7
+#define BIN1 5
+#define BIN2 4
+#define STBY 13
+#define lS 9
+#define rS 8
+int min_speed = 120;
+int max_speed = 255;
+int n_speed = 200;
+int dif = 200;
+uint8_t lSState;
+uint8_t rSState;
+int state;
+int prevState;
+int readyState = 0;
+void resetState(int st){
+  prevState = state;
+  state = st;
+}
+//int state;
+ void setup() {
+  /* Настроить все 7 выводов на выходы, идущие к драйверу TB6612FNG */
+  pinMode(PWMA,OUTPUT);
+  pinMode(AIN1,OUTPUT);
+  pinMode(AIN2,OUTPUT);
+  pinMode(PWMB,OUTPUT);
+  pinMode(BIN1,OUTPUT);
+  pinMode(BIN2,OUTPUT);
+  pinMode(lS,INPUT);
+  pinMode(rS,INPUT);
+  Serial.begin(9600);
+   while (readyState == 0) {
+    testSensors();
+    if (prevState != 11)
+      readyState = 1;
+      delay(1000);
+  }
+ delay(2000);
+ startUp();
+}
+void testSensors(){
+  lSState = digitalRead(lS);
+  rSState = digitalRead(rS);
+   //Serial.println(lSState);
+   //Serial.println(rSState);
+   //Serial.println("");
+   if (lSState == 0 && rSState == 0  ){
+          resetState(0);
+       //goForward(n_speed);
+   }
+   if (lSState == 1 && rSState == 0  ){
+       resetState(10);
+       //goForward(n_speed);
+   }
+  // if (current_dist <= dangerous_dist ){
+  //    resetState(1);
+      //applyBrakes ();
+  // }
+   if (lSState == 1 && rSState == 1  ){
+     //if (readyState == 0)
+       resetState(11);
+       //veerRight(n_speed, dif);
+   }
+   if (lSState == 0 && rSState == 1   ){
+       resetState(1);
+       //veerLeft(n_speed, dif);
+   }
+}
+void loop() {
+  testSensors();
+  updateMotion(n_speed, dif);
+ // centralLineFollower();
+  //delay(1);
+  }
+void updateMotion(int sp, int d){
+    switch ( state ) {
+    case 0:
+      if (prevState == 1)
+        //veerLeft(sp, d);
+        veerRight(sp, d);
+      else if (prevState == 10)
+        //veerRight(sp, d);
+        veerLeft(sp, d);
+      break;
+    case 1:
+      // Code
+      goForward(sp);
+      break;
+    case 10:
+      // Code
+      goForward(sp);
+      break;
+    case 11:
+      // Code
+      if (prevState == 10)
+        veerRight(sp, d);
+      else if (prevState == 1)
+        veerLeft(sp, d);
+      break;
+    }
+}
+ void leftLineFollower(){
+    //goForward(n_speed);
+    //applyBrakes ();
+    //veerRight(n_speed, dif);
+    //veerLeft(n_speed, dif);
+}
+void centralLineFollower(){
 }
@@ Строка 860: / Строка 1276: @@
 }
-//void turnAround()
-//{
-//  rotateLeft();
-//  delay(1370);
-//}
 void shutDown ()
@@ Строка 873: / Строка 1285: @@
 </code>
+==== Реализация машины состояний при движении по линии (Nano ATmega328P Old) ====
+<code C++>
+#define PWMA 9  // выходы arduino
+#define PWMB 10
+#define AIN1 6
+#define AIN2 7
+#define BIN1 5
+#define BIN2 4
+#define STBY 13
+#define lS 2
+#define rS 3
+int min_speed = 120;
+int max_speed = 255;
+int n_speed = 200;
+int dif = 200;
+uint8_t lSState;
+uint8_t rSState;
+int state;
+int prevState;
+int readyState = 0;
+void resetState(int st){
+  prevState = state;
+  state = st;
+}
+//int state;
+ void setup() {
+  /* Настроить все 7 выводов на выходы, идущие к драйверу TB6612FNG */
+  pinMode(PWMA,OUTPUT);
+  pinMode(AIN1,OUTPUT);
+  pinMode(AIN2,OUTPUT);
+  pinMode(PWMB,OUTPUT);
+  pinMode(BIN1,OUTPUT);
+  pinMode(BIN2,OUTPUT);
+  pinMode(lS,INPUT);
+  pinMode(rS,INPUT);
+  Serial.begin(9600);
+   while (readyState == 0) {
+    testSensors();
+    if (prevState != 11)
+      readyState = 1;
+      delay(1000);
+  }
+ delay(2000);
+ startUp();
+}
+void testSensors(){
+  lSState = digitalRead(lS);
+  rSState = digitalRead(rS);
+   //Serial.println(lSState);
+   //Serial.println(rSState);
+   //Serial.println("");
+   if (lSState == 0 && rSState == 0  ){
+          resetState(0);
+       //goForward(n_speed);
+   }
+   if (lSState == 1 && rSState == 0  ){
+       resetState(10);
+       //goForward(n_speed);
+   }
+  // if (current_dist <= dangerous_dist ){
+  //    resetState(1);
+      //applyBrakes ();
+  // }
+   if (lSState == 1 && rSState == 1  ){
+     //if (readyState == 0)
+       resetState(11);
+       //veerRight(n_speed, dif);
+   }
+   if (lSState == 0 && rSState == 1   ){
+       resetState(1);
+       //veerLeft(n_speed, dif);
+   }
+}
+void loop() {
+  testSensors();
+  updateMotion(n_speed, dif);
+ // centralLineFollower();
+  //delay(1);
+  }
+void updateMotion(int sp, int d){
+    switch ( state ) {
+    case 0:
+      if (prevState == 1)
+        //veerLeft(sp, d);
+        veerRight(sp, d);
+      else if (prevState == 10)
+        //veerRight(sp, d);
+        veerLeft(sp, d);
+      break;
+    case 1:
+      // Code
+      goForward(sp);
+      break;
+    case 10:
+      // Code
+      goForward(sp);
+      break;
+    case 11:
+      // Code
+      if (prevState == 10)
+        veerRight(sp, d);
+      else if (prevState == 1)
+        veerLeft(sp, d);
+      break;
+    }
+}
+ void leftLineFollower(){
+    //goForward(n_speed);
+    //applyBrakes ();
+    //veerRight(n_speed, dif);
+    //veerLeft(n_speed, dif);
+}
+void centralLineFollower(){
+}
+void goForward (int v)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v);
+}
+void goBackward (int v)
+{
+  digitalWrite (AIN1,LOW);
+  digitalWrite (AIN2,HIGH);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,LOW);
+  digitalWrite (BIN2,HIGH);
+  analogWrite(PWMB,v);
+}
+void rotateRight (int v)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,LOW);
+  digitalWrite (BIN2,HIGH);
+  analogWrite(PWMB,v);
+}
+void rotateLeft (int v)
+{
+  digitalWrite (AIN1,LOW);
+  digitalWrite (AIN2,HIGH);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v);
+}
+void veerLeft (int v, int d)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v -d);
+}
+void veerRight (int v, int d)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v -d);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v );
+}
+void applyBrakes ()
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,HIGH);
+  analogWrite(PWMA,255);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,HIGH);
+  analogWrite(PWMB,255);
+}
+void startUp ()
+{
+  digitalWrite(STBY,HIGH);
+}
+void shutDown ()
+{
+  digitalWrite(STBY,LOW);
+}
+</code>
-==== Вариант 2.1. Простейший релейный регулятор движения по линии + ультразвуковой датчик препятствия ====
+==== Вариант 2.1. Простейший релейный регулятор движения по линии + ультразвуковой датчик препятствия (промежуточный вариант, требует доработки) ====
@@ Строка 893: / Строка 1525: @@
 #define STBY 13
-#define lS 9 // левый датчик линии
+#define lS 9
 #define rS 8
+int distance = 10;
+int ping_distance = 400;
+Ping ping = Ping(2);
+uint32_t previousMillis = 0;
+uint16_t timePeriod = 50;
-int min_speed = 100;
+int min_speed = 120;
 int max_speed = 255;
-int n_speed = 120;
+int n_speed = 220;
-int dif = 110;
+int dif = 220;
-uint8_t lSState=0;
-uint8_t rSState=0;
-uint32_t previousMillis = 0;
-uint8_t timePeriod = 100;
-int current_dist = 500;
-int dangerous_dist = 20;
-//int state;
+uint8_t lSState;
+uint8_t rSState;
+int state;
+int prevState;
+int readyState = 0;
+void resetState(int st){
+  prevState = state;
+  state = st;
+}
-Ping ping = Ping(2);
-void setup() {
+//int state;
+ void setup() {
   /* Настроить все 7 выводов на выходы, идущие к драйверу TB6612FNG */
@@ Строка 921: / Строка 1565: @@
   pinMode(BIN1,OUTPUT);
   pinMode(BIN2,OUTPUT);
-  pinMode(STBY,OUTPUT);
   pinMode(lS,INPUT);
   pinMode(rS,INPUT);
   Serial.begin(9600);
-  startUp();
+   while (readyState == 0) {
+    testSensors();
+    if (prevState != 11)
+      readyState = 1;
+      delay(1000);
+  }
+ delay(2000);
+ startUp();
 }
+/*
+void checkTimer(){
+  uint32_t currentMillis = millis();
+  if (currentMillis - previousMillis >= timePeriod){
+    Serial.println(millis());
+  previousMillis = currentMillis;
+  }
+}
+*/
+void testSensors(){
+  lSState = digitalRead(lS);
+  rSState = digitalRead(rS);
+   //Serial.println(lSState);
+   //Serial.println(rSState);
+   //Serial.println("");
+   if (lSState == 0 && rSState == 0  ){
+          resetState(0);
+       //goForward(n_speed);
+   }
+   if (lSState == 1 && rSState == 0  ){
+       resetState(10);
+       //goForward(n_speed);
+   }
+  // if (current_dist <= dangerous_dist ){
+  //    resetState(1);
+      //applyBrakes ();
+  // }
+   if (lSState == 1 && rSState == 1  ){
+     //if (readyState == 0)
+       resetState(11);
+       //veerRight(n_speed, dif);
+   }
+   if (lSState == 0 && rSState == 1   ){
+       resetState(1);
+       //veerLeft(n_speed, dif);
+   }
+}
 void ping_fire(){
   ping.fire();
   //Serial.println("***");
 }
 void loop() {
-   uint32_t currentMillis = millis();
+  // time =====================
-   if (currentMillis - previousMillis >= timePeriod){
+  uint32_t currentMillis = millis();
+  if (currentMillis - previousMillis >= timePeriod){
+    //Serial.println(millis());
+    //Serial.println(ping.centimeters());
+    ping_distance = ping.centimeters();
     ping_fire();
     previousMillis = currentMillis;
-   }
-   current_dist = ping.centimeters();
-   lSState = digitalRead(lS);
-   rSState = digitalRead(rS);
-   //Serial.println(current_dist);
-   /*
-   Serial.println(lSState);
-   Serial.println(rSState);
-   Serial.println("");
- */
- //centralLineFollower();
- leftLineFollower();
   }
+  //=======================
+  testSensors();
+  if (ping_distance > distance){
+    updateMotion(n_speed, dif);
+  } else {
+    applyBrakes ();
+  }
+ // centralLineFollower();
+  //delay(1);
+  }
+void updateMotion(int sp, int d){
+    switch ( state ) {
+    case 0:
+      if (prevState == 1)
+        //veerLeft(sp, d);
+        veerRight(sp, d);
+      else if (prevState == 10)
+        //veerRight(sp, d);
+        veerLeft(sp, d);
+      break;
+    case 1:
+      // Code
+      goForward(sp);
+      break;
+    case 10:
+      // Code
+      goForward(sp);
+      break;
+    case 11:
+      // Code
+      if (prevState == 10)
+        veerRight(sp, d);
+      else if (prevState == 1)
+        veerLeft(sp, d);
+      break;
+    }
+}
+ void leftLineFollower(){
+    //goForward(n_speed);
+    //applyBrakes ();
+    //veerRight(n_speed, dif);
+    //veerLeft(n_speed, dif);
+}
+void centralLineFollower(){
+}
+void goForward (int v)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v);
+}
+void goBackward (int v)
+{
+  digitalWrite (AIN1,LOW);
+  digitalWrite (AIN2,HIGH);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,LOW);
+  digitalWrite (BIN2,HIGH);
+  analogWrite(PWMB,v);
+}
+void rotateRight (int v)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,LOW);
+  digitalWrite (BIN2,HIGH);
+  analogWrite(PWMB,v);
+}
+void rotateLeft (int v)
+{
+  digitalWrite (AIN1,LOW);
+  digitalWrite (AIN2,HIGH);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v);
+}
+void veerLeft (int v, int d)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v -d);
+}
+void veerRight (int v, int d)
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,LOW);
+  analogWrite(PWMA,v -d);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,LOW);
+  analogWrite(PWMB,v );
+}
+void applyBrakes ()
+{
+  digitalWrite (AIN1,HIGH);
+  digitalWrite (AIN2,HIGH);
+  analogWrite(PWMA,255);
+  digitalWrite (BIN1,HIGH);
+  digitalWrite (BIN2,HIGH);
+  analogWrite(PWMB,255);
+}
+void startUp ()
+{
+  digitalWrite(STBY,HIGH);
+}
+void shutDown ()
+{
+  digitalWrite(STBY,LOW);
+}
-void leftLineFollower(){
+/*
+В библиотеке Ping.cpp
-    if (lSState == 1 && rSState == 0 && current_dist > dangerous_dist ){
+вместо строки
-       goForward(n_speed);
+  _duration = pulseIn(_pin, HIGH);
-   }
+следует использовать
+  _duration = pulseIn(_pin, HIGH, 40000);
+*/
+</code>
+==== Вариант 2.2. Простейший релейный регулятор движения по линии + ультразвуковой датчик препятствия (боле-менее работает :-) ====
+<code C++>
+#include <Ping.h>
+/*
+*/
+#define PWMA 11  // выходы arduino
+#define PWMB 10
+#define AIN1 6
+#define AIN2 7
+#define BIN1 5
+#define BIN2 4
+#define STBY 13
-   if (current_dist <= dangerous_dist ){
+#define lS 9
-    applyBrakes ();
+#define rS 8
-   }
+int distance = 10;
-   if (lSState == 1 && rSState == 1 && current_dist > dangerous_dist ){
+int ping_distance = 400;
-    veerRight(n_speed, dif);
-   }
+Ping ping = Ping(2);
-   if (lSState == 0 && rSState == 1  && current_dist > dangerous_dist ){
-    veerLeft(n_speed, dif);
+uint32_t previousMillis = 0;
-   }
+uint16_t timePeriod = 50;
-}
-void centralLineFollower(){
-    if (lSState == 0 && rSState == 0 && current_dist > dangerous_dist ){
-       goForward(n_speed);
-   }
-   if (lSState == 1 && rSState == 1  ||  current_dist <= dangerous_dist ){
+int min_speed = 120;
-    applyBrakes ();
+int max_speed = 255;
+int n_speed = 200;
+int dif = 200;
+uint8_t lSState;
+uint8_t rSState;
+int state;
+int prevState;
+int readyState = 0;
+int is_obstacle = 0;
+void updateState(int st){
+  state = st;
+}
+void resetState(int st){
+  prevState = state;
+  state = st;
+}
+//int state;
+ void setup() {
+  /* Настроить все 7 выводов на выходы, идущие к драйверу TB6612FNG */
+  pinMode(PWMA,OUTPUT);
+  pinMode(AIN1,OUTPUT);
+  pinMode(AIN2,OUTPUT);
+  pinMode(PWMB,OUTPUT);
+  pinMode(BIN1,OUTPUT);
+  pinMode(BIN2,OUTPUT);
+  pinMode(lS,INPUT);
+  pinMode(rS,INPUT);
+  Serial.begin(9600);
+   while (readyState == 0) {
+    testSensors();
+    if (prevState != 11)
+      readyState = 1;
+      delay(1000);
+  }
+ delay(2000);
+ startUp();
+}
+/*
+void checkTimer(){
+  uint32_t currentMillis = millis();
+  if (currentMillis - previousMillis >= timePeriod){
+    Serial.println(millis());
+  previousMillis = currentMillis;
+  }
+}
+*/
+void testSensors(){
+  lSState = digitalRead(lS);
+  rSState = digitalRead(rS);
+   //Serial.println(lSState);
+   //Serial.println(rSState);
+   //Serial.println("");
+   if (lSState == 0 && rSState == 0  ){
+          //resetState(0);
+          updateState(0);
+       //goForward(n_speed);
    }
-   if (lSState == 1 && rSState == 0 && current_dist > dangerous_dist ){
+   if (lSState == 1 && rSState == 0  ){
-    veerRight(n_speed, dif);
+       resetState(10);
+       //goForward(n_speed);
    }
-   if (lSState == 0 && rSState == 1 && current_dist > dangerous_dist ){
+  // if (current_dist <= dangerous_dist ){
-    veerLeft(n_speed, dif);
+  //    resetState(1);
-   }
+      //applyBrakes ();
+  // }
+   if (lSState == 1 && rSState == 1  ){
+     //if (readyState == 0)
+       //resetState(11);
+       updateState(11);
+       //veerRight(n_speed, dif);
+   }
+   if (lSState == 0 && rSState == 1   ){
+       resetState(1);
+       //veerLeft(n_speed, dif);
+   }
 }
+void ping_fire(){
+  ping.fire();
+  //Serial.println("***");
+}
+void loop() {
+  // time =====================
+  uint32_t currentMillis = millis();
+  if (currentMillis - previousMillis >= timePeriod){
+    //Serial.println(millis());
+    //Serial.println(ping.centimeters());
+    if (ping_distance > distance){
+      is_obstacle = 0;
+    } else {
+      is_obstacle = 1;
+    }
+    ping_distance = ping.centimeters();
+    ping_fire();
+    previousMillis = currentMillis;
+  }
+  //=======================
+  if (is_obstacle != 1){
+    testSensors();
+    updateMotion(n_speed, dif);
+  } else {
+    applyBrakes ();
+  }
+ // centralLineFollower();
+  //delay(1);
+  }
+void updateMotion(int sp, int d){
+    switch ( state ) {
+    case 0:
+      if (prevState == 1)
+        //veerLeft(sp, d);
+        veerRight(sp, d);
+      else if (prevState == 10)
+        //veerRight(sp, d);
+        veerLeft(sp, d);
+      break;
+    case 1:
+      // Code
+      goForward(sp);
+      break;
+    case 10:
+      // Code
+      goForward(sp);
+      break;
+    case 11:
+      // Code
+      if (prevState == 10)
+        veerRight(sp, d);
+      else if (prevState == 1)
+        veerLeft(sp, d);
+      break;
+    }
+}
+ void leftLineFollower(){
+    //goForward(n_speed);
+    //applyBrakes ();
+    //veerRight(n_speed, dif);
+    //veerLeft(n_speed, dif);
+}
+void centralLineFollower(){
+}
 void goForward (int v)
@@ Строка 1068: / Строка 2046: @@
 }
-//void turnAround()
-//{
-//  rotateLeft();
-//  delay(1370);
-//}
 void shutDown ()
@@ Строка 1078: / Строка 2052: @@
   digitalWrite(STBY,LOW);
 }
-</code>
+/*
+В библиотеке Ping.cpp
+вместо строки
+  _duration = pulseIn(_pin, HIGH);
+следует использовать
+  _duration = pulseIn(_pin, HIGH, 40000);
+*/
+</code>
 ==== Простой таймер (прерывание по таймеру) ====
@@ Строка 1099: / Строка 2080: @@
    }
 }
-<code>
+</code>
 ==== Ультразвуковой датчик ====
@@ Строка 1105: / Строка 2086: @@
   * [[http://playground.arduino.cc/Code/Ping]]
   * [[http://embeddedlab.csuohio.edu/RoboticSwarms/ultrasonic_sensors.html]]
+  * [[http://arduino.ru/forum/programmirovanie/nestabilnaya-rabota-uz-datchika]] - Форум: "Нестабильная работа УЗ датчика"
+==== Bluetooth модуль HC-06 ====
+  * [[https://lesson.iarduino.ru/page/bluetooth-modul-hc-06-podklyuchenie-k-arduino-upravlenie-ustroystvami-s-telefona]]
+  * [[https://arduinomaster.ru/datchiki-arduino/arduino-bluetooth-hc05-hc06/]]
+  * [[http://zelectro.cc/HC-06_bluetooth_module]]
+  * [[http://psenyukov.ru/%D0%BF%D0%BE%D0%B4%D0%BA%D0%BB%D1%8E%D1%87%D0%B5%D0%BD%D0%B8%D0%B5-bluetooth-hc-06-%D0%BA-arduino-%D1%81-%D0%BF%D1%80%D0%BE%D1%88%D0%B8%D0%B2%D0%BA%D0%BE%D0%B9-grbl/]]
+  * [[https://play.google.com/store/apps/details?id=braulio.calle.bluetoothRCcontroller&hl=ru]] - Google Play bluetooth-rc-car
+  * [[https://create.arduino.cc/projecthub/samanfern/bluetooth-controlled-car-d5d9ca]] - Arduino Bluetooth Controlled Car
+  * [[https://tutorial45.com/arduino-bluetooth-rc-car-project/]]  - Arduino Bluetooth Controlled Car
+  * [[http://www.ardumotive.com/bluetooth-rc-car.html]] - Arduino Bluetooth Controlled Car
+  *
+==== Указатели в C для Ардуино ====
+  * [[http://mypractic.ru/urok-15-ukazateli-v-c-dlya-arduino-preobrazovanie-raznyx-tipov-dannyx-v-bajty.html]]

INTEPRA WIKI

Инструменты пользователя

Инструменты сайта

Различия

Инструменты страницы