Скрыть объявление
На нашем форуме недоступен просмотр изображений для неавторизованных пользователей. Если Вы уже зарегистрированы на нашем форуме, то можете войти. Если у Вас еще нет аккаунта, мы будем рады, если Вы к нам присоединитесь. Зарегистрироваться Вы можете здесь.

Делюсь опытом Была Lego Racers RC, стала Lego Racers Blynk.

Тема в разделе "Другие проекты", создана пользователем immortal, 31 дек 2018.

  1. immortal

    immortal Новичок

    Сообщения:
    3
    Симпатии:
    0
    Первые 40 лет детства самые сложные в жизни мужчины.
    /правда жизни/

    Достались мне несколько конструкторов Lego с различными моторчиками, но без пультов управления. Один из них Lego Racers RC (номер 8475). Ну что же, будем делать из него Lego Racers Blynk ESP8266.

    Набор содержит блок управления в котором контроллер с мотором управления рулем, к блоку управления подключаются 2 детали — двигатели. Положение руля контролирует энкодер.

    Поскольку у ESP8266 мало выводов я дополнительно применил микросхему PCF8574, хотя в принципе достаточно было бы и существующих выводов, но я планировал добавить навесное оборудование типа датчика расстояния или оптических датчиков. Так же поставил магнитометр HMC5883, пока правда не придумал как его применить кроме вывода информации с него. В итоге получилась вот такая схема (на схеме нет магнитометра, но думаю не составит труда понять как он подключается)

    [​IMG]

    Внутренности.

    [​IMG]

    плату драйверов пришлось немного модернизировать чтобы запихать в корпус и питать esp8266, для этого были выпаяны все разъемы, снят радиатор, заменен преобразователь на 5 вольт преобразователем на 3,3 вольта (разъем 5 вольт выдает 3,3В), конденсатора заменены на танталовые smd. Через резистор 10K выведен светодиод в место куда вставлялась антенна.
    Энкодер у данного конструктора Lego формирует 3 бита, выводы 1,2,3 через резистор 10К подключены к 3,3В и когда внутри энкодера не замыкается на GND то формируется логическая единица, если замыкается на GND то формируется логический 0. Соответствие положению вала назначениям выводов
    Код (Text):
    1. 0 0 0 - 0 - влево
    2. 1 0 0 - 1 - 0,33 влево
    3. 1 0 1 - 5 - 0,66 влево
    4. 0 0 1 - 4 - прямо
    5. 0 1 1 - 6 - 0,66 право
    6. 0 1 0 - 2 - 0,33 право
    7. 1 1 0 - 3 - право
    При этом между положениями контакты не касаются GND, то есть получаем значение 1 1 1 или 7 в десятичной системе, а это значит надо учитывать это.
    Обозначу положение руля следующим образом: 0 — влево, 1 — 0,66 влево, 2 — 0,33 — влево, 3 — прямо, 4 — 0,33 право, 5 — 0,66 право, 6 — право.
    Энкодер подключен к выводам 0,1 и 2 PCF8574, я использовал библиотеку PCF8574
    Подключаем библиотеки, для управления машиной достаточно
    Код (Text):
    1. // библиотеки для управления
    2. #include <Wire.h> // библиотека для работы с шиной i2c
    3. #include <PCF8574.h> // библиотека для PCF8574
    у меня установлен датчик HMC5883, подключаем ещё библиотеки для работы с этим датчиком
    Код (Text):
    1. // библиотеки для датчика HMC5883
    2. #include <Adafruit_Sensor.h> // библиотека для работы HMC5883
    3. #include <Adafruit_HMC5883_U.h> // библиотека для работы HMC5883
    и задаем переменные, для переменных для управления
    Код (Text):
    1. // часть переменных для управления
    2. PCF8574 pcf20(0x20); // задаем параметры PCF8574, адрес 0х20
    3. byte pcf_byte0; // значение энкодера 1 контакт
    4. byte pcf_byte1; // значение энкодера 2 контакт
    5. byte pcf_byte2; // значение энкодера 3 контакт
    6. int pcf_command; // десятичное значение энкодера
    7. int OUT1=13; // OUT1 - шим двигателя
    8. int OUT2=12; // OUT2 - шим руля
    9. int skorost; // скорость двигателей
    10. int revers; // направление движение (1 - назад, 0 - вперед)
    11. // направление движения
    12. // 0 - влево, 1 - 0,3 влево, 2 - 0,6 - влево,
    13. // 3 - прямо, 4 - 0,6 право, 5 - 0,3 право, 6 - право.
    14. int Napravlenie = 3;
    15. int MotorStatus = 0; // статус мотора руля (0 - выключен, 1 крутиться вправо, 2 - крутиться влево)
    16. int millis1 = 0; // прерывание 1
    17. int millis2 = 0; // прерывание 2
    18. int millis3 = 0; // прерывание 3
    для датчиков
    Код (Text):
    1. // часть переменных для датчиков
    2. int BAT=17;  //  BAT - номер контакта ADC батареи
    3. int Sila, SilaLow = -43;   // Контроль силы сигнала WiFi
    4. int Batareya, BatLow = 400; //Контроль напряжения батареи
    5. String Bat, SilaW; // переменные для величины батареи и сигнала Wi-Fi
    6. Adafruit_HMC5883_Unified mag = Adafruit_HMC5883_Unified(12345); // переменная для HMC5883
    7. float mag_x; // X HMC5883
    8. float mag_y; // Y HMC5883
    9. float mag_z; // Z HMC5883
    10. float mag_k; // Курс HMC5883
    Для управления используем несколько функций.
    три функции управляют движением руля.

    Код (Text):
    1.  
    2. void ruleLeft() { // руль влево
    3.       analogWrite(OUT2, 800);
    4.       pcf20.write(4, HIGH);
    5.       pcf20.write(5, LOW);
    6.       MotorStatus = 2;
    7. }
    8. void ruleRight() { // руль вправо
    9.       analogWrite(OUT2, 800);
    10.       pcf20.write(4, LOW);
    11.       pcf20.write(5, HIGH);
    12.       MotorStatus = 1;
    13. }
    14. void ruleStop() { // остановить поворот руля
    15.       analogWrite(OUT2, 0);
    16.       pcf20.write(4, LOW);
    17.       pcf20.write(5, LOW);
    18.       MotorStatus = 0;
    19. }
    20.  
    в зависимости от направления (задаваемого программой) и положения вала (значения энкодера) нам надо позиционировать вал, для этого пишем функцию управления рулем.
    Код (Text):
    1. void processRule() {
    2.     pcf_byte0 = pcf20.readButton(0); // данные положение руля конт 1
    3.     pcf_byte1 = pcf20.readButton(1); // данные положение руля конт 2
    4.     pcf_byte2 = pcf20.readButton(2); // данные положение руля конт 3
    5.     pcf_command = pcf_byte0 + pcf_byte1 * 2 + pcf_byte2 * 4; // перевод в десятичную систему
    6.  
    7.     if (Napravlenie == 6) {
    8.       // направо - 3
    9.       if (pcf_command == 3) {
    10.         // мотор уже в правом положении
    11.         if(MotorStatus != 0) {
    12.           ruleStop();
    13.         }
    14.       } else {
    15.         // мотор не в правом положении, крутим вправо
    16.         if(MotorStatus != 1) {
    17.           ruleRight();
    18.         }
    19.       }
    20.     } else if (Napravlenie == 0) {
    21.       // налево - 0
    22.             if (pcf_command == 0) {
    23.         // мотор уже в левом положении
    24.         if(MotorStatus != 0) {
    25.           ruleStop();
    26.         }
    27.       } else {
    28.         // мотор не в левом положении, крутим налево
    29.         if(MotorStatus != 2) {
    30.           ruleLeft();
    31.         }
    32.       }
    33.     } else if (Napravlenie == 5) {
    34.       // 0.6 - 2
    35.       if (pcf_command == 2) {
    36.         // мотор уже в положении 0,6 вправо, останавливаем
    37.         if(MotorStatus != 0) {
    38.           ruleStop();
    39.         }
    40.       } else if (pcf_command == 3) {
    41.         // мотор справа, крутим влево
    42.         if(MotorStatus != 2) {
    43.           ruleLeft();
    44.         }
    45.       } else if (pcf_command == 0 || pcf_command == 1 || pcf_command == 5 || pcf_command == 4 || pcf_command == 6) {
    46.         // мотор слева, крутим вправо
    47.         if(MotorStatus != 1) {
    48.           ruleRight();
    49.         }
    50.       } else {
    51.         //энкодер стоит между контактами и мотор не крутиться, крутим
    52.         if (pcf_command == 7 && MotorStatus == 0) {
    53.           ruleRight();
    54.         }
    55.       }
    56.     } else if (Napravlenie == 4) {
    57.       // 0.3 направо - 6
    58.       if (pcf_command == 6) {
    59.         // мотор уже в положении 0,3 вправо
    60.         if(MotorStatus != 0) {
    61.           ruleStop();
    62.         }
    63.       } else if (pcf_command == 3 || pcf_command == 2) {
    64.         // мотор справа, крутим налево
    65.         if(MotorStatus != 2) {
    66.           ruleLeft();
    67.         }
    68.       } else if (pcf_command == 0 || pcf_command == 1 || pcf_command == 5 || pcf_command == 4) {
    69.         // мотор слева, крутим вправо
    70.         if(MotorStatus != 1) {
    71.           ruleRight();
    72.         }
    73.       } else {
    74.         // энкодер стоит между контактами и мотор не крутиться, крутим
    75.         if (pcf_command == 7 && MotorStatus == 0) {
    76.           ruleRight();
    77.         }
    78.       }
    79.     } else if (Napravlenie == 1) {
    80.       // 0.6 налево  - 1
    81.       if (pcf_command == 1) {
    82.         // мотор уже в положении 0,6 лево
    83.         if(MotorStatus != 0) {
    84.           ruleStop();
    85.         }
    86.       } else if (pcf_command == 0) {
    87.         // мотор в левом положении, крутим вправо
    88.         if(MotorStatus != 1) {
    89.           ruleRight();
    90.         }
    91.       } else if (pcf_command == 2 || pcf_command == 3 || pcf_command == 4 || pcf_command == 5 || pcf_command == 6){
    92.         // мотор правее, крутим влево
    93.         if(MotorStatus != 2) {
    94.           ruleLeft();
    95.         }
    96.       } else {
    97.         // энкодер стоит между контактами и мотор не крутиться, крутим
    98.         if (pcf_command == 7 && MotorStatus == 0) {
    99.           ruleLeft();
    100.         }
    101.       }
    102.     } else if (Napravlenie == 2) {
    103.       // 0.3 налево  - 5
    104.       if (pcf_command == 5) {
    105.         // мотор уже в положении 0,3 лево
    106.         if(MotorStatus != 0) {
    107.           ruleStop();
    108.         }
    109.       } else if (pcf_command == 0 || pcf_command == 1) {
    110.         // мотор в левом положении, крутим вправо
    111.         if(MotorStatus != 1) {
    112.           ruleRight();
    113.         }
    114.       } else if (pcf_command == 2 || pcf_command == 3 || pcf_command == 4 || pcf_command == 6){
    115.         // мотор правее, крутим влево
    116.         if(MotorStatus != 2) {
    117.           ruleLeft();
    118.         }
    119.       } else {
    120.         // энкодер стоит между контактами и мотор не крутиться, крутим
    121.         if (pcf_command == 7 && MotorStatus == 0) {
    122.           ruleLeft();
    123.         }
    124.       }
    125.     } else {
    126.       // прямо  - 4
    127.       if (pcf_command == 4) {
    128.         // руль стоит прямо, выключаем мотор
    129.         if(MotorStatus != 0) {
    130.           // если мотор не выключен, то выключаем
    131.           ruleStop();
    132.         }
    133.       } else if (pcf_command == 3 || pcf_command == 2 || pcf_command == 6) {
    134.         // руль находиться вправо, крутим налево
    135.         if(MotorStatus != 2) {
    136.           ruleLeft();
    137.         }
    138.       } else if (pcf_command == 0 || pcf_command == 1 || pcf_command == 5) {
    139.         // руль находиться влево, крутим направо
    140.         if(MotorStatus != 1) {
    141.           ruleRight();
    142.         }
    143.       } else {
    144.         // энкодер стоит между контактами и мотор не крутиться, крутим
    145.           if (pcf_command == 7 && MotorStatus == 0) {
    146.             ruleLeft();
    147.           }
    148.         }
    149.  
    150.     }
    151. }
     
    Последнее редактирование: 1 янв 2019
  2. immortal

    immortal Новичок

    Сообщения:
    3
    Симпатии:
    0
    Это все функции для управления рулем. Пишем функцию для управление двигателем, поскольку мотор на малых оборотах не может крутить колеса из-за малой мощности, то ограничиваем обороты включения мотора.



    Код (Text):
    1. void processMotor() {
    2.    if (skorost > 200){
    3.       // Если слайдер скорости  > 200
    4.       analogWrite(OUT1, skorost);
    5.       if (revers == 1){
    6.         pcf20.write(6, LOW);
    7.         pcf20.write(7, HIGH);
    8.       } else {
    9.         pcf20.write(6, HIGH);
    10.         pcf20.write(7, LOW);
    11.       }
    12.     }
    13.    else {
    14.       // Если слайдер скорости  < 200 - выключить моторы
    15.       analogWrite(OUT1, 0);
    16.       pcf20.write(6, LOW);
    17.       pcf20.write(7, LOW);
    18.     }
    19. }
    Это всё что необходимо для управления машиной (естественно за исключением основных функций: setup() и loop()), но у нас ещё предполагается измерять сигнал wi-fi, заряд батареи и данные магнитометра, добавляем соответствующие функции



    Код (Text):
    1. // ---------------------- заряд батареи -------------------------
    2. void Batare(){
    3.   Batareya = analogRead(BAT);         // Меряем напряжение батареи
    4.   if (Batareya < BatLow){            // Если напряжение батареи меньше порогового значения
    5.     Bat = "Батарея разряжена!!!"; // Пишем предупреждение
    6.   }
    7.   else{             // Если норма
    8.     Bat = "";       // Ничего не пишем
    9.   }
    10. }
    11. // ------------------------- Wi-Fi сигнал ----------------------------
    12. void SilaWifi(){
    13.   Sila = WiFi.RSSI();  // Меряем силу сигнала WiFi
    14.   if (Sila < SilaLow){
    15.     SilaW = "Сигнал слабый!!!";
    16.   }
    17.   else{            // Если норма
    18.     SilaW = "";    // Ничего не пишем
    19.   }
    20. }
    21. // ------------------сенсор HMC5883-----------------------
    22. void SensorMag() {
    23.   sensors_event_t event;
    24.   mag.getEvent(&event);
    25.   mag_x = event.magnetic.x; // получаем значение X
    26.   mag_y = event.magnetic.y; // получаем значение Y
    27.   mag_z = event.magnetic.z; // получаем значение Z
    28.   // вычисляем курс
    29.   float heading = atan2(event.magnetic.y, event.magnetic.x);
    30.   if(heading < 0)
    31.     heading += 2*PI;
    32.   if(heading > 2*PI)
    33.     heading -= 2*PI;
    34.   mag_k = heading * 180/M_PI;  
    35. }
    теперь нам надо заполнить функции setup и loop
    Код (Text):
    1. void setup() {
    2.   Serial.begin(115200);
    3.   // для управления
    4.   pcf20.begin(); .// инициализация PCF8574
    5.   ruleStop(); // останавливаем двигатели
    6.   // для датчиков
    7.   pinMode(BAT,INPUT); // инициализация порта для измерения заряда батареи
    8.   if(!mag.begin()) // инициализация HMC5883
    9.   {
    10.     Serial.println("Ooops, no HMC5883 detected ... Check your wiring!");
    11.     while(1);
    12.    }
    13. }
    основной цикл



    Код (Text):
    1. void loop() {
    2.   // управление машиной
    3.     // часть управления рулем
    4.     if(millis() >= millis1){
    5.       millis1 = millis()+10; //Обновляем значения раз в 10 миллисекунд
    6.       processRule();
    7.     }
    8.     // управление двигателем
    9.     if(millis() > millis2){
    10.       millis2=millis()+300;       //Обновляем значения раз в 300 миллисекунд
    11.       processMotor();
    12.     }
    13.     // конец управления машиной
    14.   // считывание с датчиков
    15.   if(millis() > millis3){
    16.     millis3=millis()+1000;       //Обновляем значения раз в 1 секунду
    17.     Batare();
    18.     SilaWifi();
    19.     SensorMag();
    20.   }
    21. }
    Это всё что необходимо для управления, однако у нас нет ещё самого главного: интерфейса управления

    Blynk

    Самое простое это реализация управления через Blynk, нам надо подключить библиотеки, задать 3 переменные и написать всего пару строк.
    добавим подключение библиотек
    Код (Text):
    1. void loop() {
    2.   // управление машиной
    3.     // часть управления рулем
    4.     if(millis() >= millis1){
    5.       millis1 = millis()+10; //Обновляем значения раз в 10 миллисекунд
    6.       processRule();
    7.     }
    8.     // управление двигателем
    9.     if(millis() > millis2){
    10.       millis2=millis()+300;       //Обновляем значения раз в 300 миллисекунд
    11.       processMotor();
    12.     }
    13.     // конец управления машиной
    14.   // считывание с датчиков
    15.   if(millis() > millis3){
    16.     millis3=millis()+1000;       //Обновляем значения раз в 1 секунду
    17.     Batare();
    18.     SilaWifi();
    19.     SensorMag();
    20.   }
    21. }

    добавим переменные

    Код (Text):
    1. #define BLYNK_PRINT Serial
    2. char auth[] = "токен"; // токен из приложения Blynk
    3. char ssid[] = "SSID";     // параметры wi-fi
    4. char pass[] = "PASSWORD"; // точки доступа

    в функцию setup() добавим в начало

    Код (Text):
    1. Blynk.begin(auth, ssid, pass);

    в функцию loop() добавим в начало



    Код (Text):
    1. Blynk.run();
    Теперь нам надо определиться с виджетами которые мы будем использовать.
    Для управления можно использовать несколько вариантов. самый пожалуй простой для управления это использования джойстика, недостатком является не полная скорость при поворотах, добавляем виждет «джойстик» со следующими параметрами.

    [​IMG]


    В скетч вставим виртуальный пин V1


    Код (Text):
    1. BLYNK_WRITE(V1) {
    2. // параметр джойстика 0
    3. // руль, направление движения
    4. // 0 - лево, 1 - 0,3 лево, 2 - 0,6 - лево,
    5. // 3 - прямо
    6. // 4 - 0,6 право, 5 - 0,3 право, 6 - право.
    7. Napravlenie = param[0].asInt();
    8. // параметр джойстика 1
    9. // управление двигателем
    10. int coord_y = param[1].asInt(); // мотор -1024 - +1024
    11. skorost = abs (coord_y);
    12. if (coord_y < 0) {
    13. revers = 1;
    14. } else {
    15. revers = 0;
    16. }
    17. }
    Заливаем скетч в ESP8266, запускаем и управляем машиной из приложения.
    Для отображения данных с датчиков думаю не возникнет проблем, используйте переменные: Sila, Batareya, mag_x, mag_y, mag_z, mag_k, главное переводите их в строку, например для вывода данных о батареи в виртуальный пин V0:

    Код (Text):
    1. Blynk.virtualWrite(V0,String(Sila));

    Скетч управления машинкой можно скачать тут.

    Управляем через web интерфейс.

    Но что делать если в месте запуска отсутствует интернет? будем делать управление другим способом, управлять будем через web интерфейс, наша машина будет в качестве web сервера к которой мы будем подключаться.

    В свой скетч я добавил из 2-х источников скетчи, это скетч с конфигуратором настроек в EEPROM, сервер и клиент и скетч управления кораблем

    Скетч, который создает точку доступа и может подключаться к сети wi-fi можно скачать тут.

    После загрузки скетча на ESP8266 надо подключиться и настроить подключение к сети wi-fi, пароль SECRET плюс последние 4 символа мак адреса чипа, они так же последние в имени точки доступа. Настройка параметров подробно описано в этой статье.

    объединив все три в один я получил скетч управления машиной, который можно скачать тут.



    Источник
     

Поделиться этой страницей