Arduino.ru

Здравствуйте знатоки Ардуино, хотел бы тоже попросить помощи т.к. у самого уже мозги закипают. Итак есть два скейтча:

1. Авто подсос на карбюраторную машину, контроль через датчик хола и термометр, управление через сервопривод, вывод на OLED экран.

2. Ручное управление через энкодер.

По отдельности все прекрасно работает, при попытке обьединения, в зависимости от того какой код идет первым от того сервопривод и работает, переключаться переключается работать не хочет. Посмотрите пожалуйста что тут не так.

Скейтч №1.

#include <Wire.h>        // подключение библиотеки для ds18b20
#include <OneWire.h>
//DS18b20
OneWire ds(10);   //подключаем датчик ds18b20 к 10 цифровому входу
#include <OLED_I2C.h>
OLED  myOLED(8, 9, 8); // 8pin - SDA , 9pin - SCL
extern uint8_t RusFont[]; // Русский шрифт
extern uint8_t MegaNumbers[]; // Подключение больших шрифтов
extern uint8_t SmallFont[]; // Базовый шрифт без поддержки русскийх символов.
#include <Servo.h>      //подключение библиотеки для сервопривода
Servo servo;
int potPin = 2; // Порт для провода от датчика холла
int now = 0;// последнее значение сигнала с датчика
long time = 0; // для сохранения времени начала счета импульсов
int count = 0; // колличество импльсов
int val; //временная переменная для считывания сигнала с датчика
bool LampState4 = false;
int flg_push; //флаг прихода импульса
float Temp;
float volts;
int i;
int n;
int analogPin = A0;// порт потенциометра сервопривода
#define LCD_UPDATE_TIME  1000
unsigned long lcdLastUpdateTime = 0;
long updtime = 0;

void setup()
{
  Wire.begin();
  servo.attach(11,130,175);   //подключаем сервопривод к 11 цифровому порту
  myOLED.begin();

}

void loop()
{
  setTemperature(); // вызываем функцию работы с DS18b20
  setOboroti();
}
int setTemperature() // DS18B20
{ byte type_s;
  type_s = 0;
  byte data[2];
  ds.reset();
  ds.write(0xCC);
  ds.write(0x44);

  // обращаемся к датчикам раз в 1000 мс, т.к. 750 может быть недостаточно
  if (millis() - lcdLastUpdateTime > LCD_UPDATE_TIME)
  { lcdLastUpdateTime = millis();

    ds.reset();
    ds.write(0xCC);
    ds.write(0xBE);
    data[0] = ds.read();
    data[1] = ds.read();
    Temp = (data[1] << 8) + data[0];
    Temp = (float)Temp / 16.0;;
  int rawReading = analogRead(analogPin);
float volts = (rawReading-360.0)/106*100;
    // Температура
    
  myOLED.clrScr(); // очищаем экран
  myOLED.setFont(RusFont); // Устанавливаем русский шрифт
  myOLED.print("NTVGTHFNEHF", LEFT, 0); // Выводим надпись "Температура"
  myOLED.print("GJLCJC", LEFT, 55); // Выводим надпись "Обороты"
  myOLED.setFont(SmallFont);
  myOLED.printNumF(Temp,1, RIGHT, 0); // Температура
  myOLED.printNumI(volts, RIGHT, 55); // подсос
  myOLED.setFont(MegaNumbers);
  myOLED.printNumI(i, CENTER, 10); // Обороты
  myOLED.update();
  }
  return Temp;
}
int setOboroti()
{
  //считываем данные с датчика холла
  val = digitalRead(potPin);

  //если пришел импульс
  if ((val == HIGH) && (flg_push == 0))  {
    //флаг ставим в 1
    flg_push = 1;
  }
  //если импульс ушел, то увеличиваем счетчик
  if ((val == LOW) && (flg_push == 1))  {
    //флаг ставим в 0
    flg_push = 0;
    count++;
  }
  //если прошло 500 милисекунд
  now = (millis() - time) / 500;
  if (now == 1) {

    //выводим кол импульсов из расчета (об/мин)
    int i = count * 60;
    if (i == 0)
    { if (Temp <= 30) {
        servo.write(130);
      }
      if ((Temp > 30) && (Temp <= 35))
      {
        servo.write(145);
      }
      if ((Temp > 35) && (Temp <= 40))
      {
        servo.write(155);
      }
      if ((Temp > 40) && (Temp <= 50))
      {
        servo.write(165);
      }
      if (Temp > 50)
      {
        servo.write(175);
      }
    }
    else
    {
      if ((Temp <= 30))
      {

        if (i > 1900)
        {
          n = servo.read();
          n--;
          servo.write(n);
        }
      }
      if ((Temp > 30) && (Temp <= 35))
      {
        if (i > 1600)
        {
          n = servo.read();
          n--;
          servo.write(n);
        }
      }
      if ((Temp > 35) && (Temp <= 40))
      {
        if (i > 1400)
        {
          n = servo.read();
          n--;
          servo.write(n);
        }
      }

      if ((Temp > 40) && (Temp <= 50))
      {
        if (i > 1200)
        {
          n = servo.read();
          n--;
          servo.write(n);
        }
      }

      if (Temp > 50)
      {
        servo.write(175);
        servo.detach();
      }
    }
    //сбрасываем начальный счетчик
    time = millis();
    //сбрасываем количество импульсов
    count = 0;
  }
  return i;
}

Скейтч №2.

#include <Servo.h> //Подключаем библиотеку для сервопривода.
Servo Servo;//"Называем" сервопривод.
int ServoPos = 145; //Угол поворота сервопривода.    
int PosLevel = 3; //Значение, на которое будет изменятся угол сервопривода.
unsigned long currentTime;
unsigned long loopTime;
const int pin_A = 7;    //Пин, к которому подключен энкодер.  
const int pin_B = 6;    //Пин, к которому подключен энкодер.  
unsigned char encoder_A;
unsigned char encoder_B;
unsigned char encoder_A_prev=0;
 
void setup()  
{
  Servo.attach(11,117,175);//Инициализация серво.
  pinMode(pin_A, INPUT);
  pinMode(pin_B, INPUT);
  currentTime = millis();
  loopTime = currentTime; 
} 
 
void loop()  {
  currentTime = millis();
  if(currentTime >= (loopTime + 5)){
    encoder_A = digitalRead(pin_A);    
    encoder_B = digitalRead(pin_B);      
    if((!encoder_A) && (encoder_A_prev)){ 
      if(encoder_B) {
        if(ServoPos + PosLevel <= 175) ServoPos += PosLevel;               
      }   
      else {
        if(ServoPos - PosLevel >= 117) ServoPos -= PosLevel;               
      }   
 
    }   
    encoder_A_prev = encoder_A;     
     
      MyServo.write(ServoPos); //Вращаем сервопривод в зависимости от переменной.
      
    loopTime = currentTime;
    
  }      
            
}

Обьедененый скейтч.

#include <Wire.h>        // подключение библиотеки для ds18b20
#include <OneWire.h>
//DS18b20
OneWire ds(10);   //подключаем датчик ds18b20 к 10 цифровому входу
#include <OLED_I2C.h>
OLED  myOLED(8, 9, 8); // 8pin - SDA , 9pin - SCL
extern uint8_t RusFont[]; // Русский шрифт
extern uint8_t MegaNumbers[]; // Подключение больших шрифтов
extern uint8_t SmallFont[]; // Базовый шрифт без поддержки русскийх символов.
#include <Servo.h>      //подключение библиотеки для сервопривода
Servo servo;
int n;
int ServoPos = 145; //Угол поворота сервопривода.    
int PosLevel = 3; //Значение, на которое будет изменятся угол сервопривода.
unsigned long currentTime;
unsigned long loopTime;
const int pin_A = 7;    //Пин, к которому подключен энкодер.  
const int pin_B = 6;    //Пин, к которому подключен энкодер.  
unsigned char encoder_A;
unsigned char encoder_B;
unsigned char encoder_A_prev=0;
int i;
int potPin = 2; // Порт для провода от датчика холла
int now = 0;// последнее значение сигнала с датчика
long time = 0; // для сохранения времени начала счета импульсов
int count = 0; // колличество импльсов
int val; //временная переменная для считывания сигнала с датчика
bool LampState4 = false;
int flg_push; //флаг прихода импульса
float Temp;
float volts;
int analogPin = A0;// порт потенциометра сервопривода
#define LCD_UPDATE_TIME  1000
unsigned long lcdLastUpdateTime = 0;
long updtime = 0;
const int knopkaPin = 4;
const int swichButtonPin=5;
boolean poslSost = LOW;
boolean znachKnopki = LOW;
int dvig = 0;
int counter = 1;

void setup()
{
  Wire.begin();
  servo.attach(11,130,175);   //подключаем сервопривод к 11 цифровому порту
  myOLED.begin();
  pinMode(knopkaPin, INPUT);
  pinMode(swichButtonPin, INPUT);
  pinMode(pin_A, INPUT);
  pinMode(pin_B, INPUT);
  currentTime = millis();
  loopTime = currentTime;
}
boolean debounce(boolean posl)
{
  boolean znach = digitalRead(knopkaPin);
  if (posl!=znach)
  {
    delay(5);
    znach = digitalRead(knopkaPin);
  }
  return znach;
}
void loop()
{ 
if (digitalRead(swichButtonPin) == LOW)
counter++;
else if (counter > 2)
counter = 1;
znachKnopki = debounce(poslSost);
switch (counter)
{
case 1: {firstcode(); break;}
case 2: {secondcode(); break;}
}
}
int firstcode()
{
  currentTime = millis();
  if(currentTime >= (loopTime + 5)){
    encoder_A = digitalRead(pin_A);    
    encoder_B = digitalRead(pin_B);      
    if((!encoder_A) && (encoder_A_prev)){ 
      if(encoder_B) {
        if(ServoPos + PosLevel <= 175) ServoPos += PosLevel;               
      }   
      else {
        if(ServoPos - PosLevel >= 117) ServoPos -= PosLevel;               
      }   
     }   
    encoder_A_prev = encoder_A;     
    servo.write(ServoPos); //Вращаем сервопривод в зависимости от переменной.
    loopTime = currentTime;  
            
}
}
int secondcode()

{
  setTemperature(); // вызываем функцию работы с DS18b20
  setOboroti();
}
int setTemperature() // DS18B20
{ byte type_s;
  type_s = 0;
  byte data[2];
  ds.reset();
  ds.write(0xCC);
  ds.write(0x44);

  // обращаемся к датчикам раз в 1000 мс, т.к. 750 может быть недостаточно
  if (millis() - lcdLastUpdateTime > LCD_UPDATE_TIME)
  { lcdLastUpdateTime = millis();

    ds.reset();
    ds.write(0xCC);
    ds.write(0xBE);
    data[0] = ds.read();
    data[1] = ds.read();
    Temp = (data[1] << 8) + data[0];
    Temp = (float)Temp / 16.0;;
  int rawReading = analogRead(analogPin);
float volts = (rawReading-360.0)/106*100;
    // Температура
    
  myOLED.clrScr(); // очищаем экран
  myOLED.setFont(RusFont); // Устанавливаем русский шрифт
  myOLED.print("NTVGTHFNEHF", LEFT, 0); // Выводим надпись "Температура"
  myOLED.print("GJLCJC", LEFT, 55); // Выводим надпись "Обороты"
  myOLED.setFont(SmallFont);
  myOLED.printNumF(Temp,1, RIGHT, 0); // Температура
  myOLED.printNumI(volts, RIGHT, 55); // подсос
  myOLED.setFont(MegaNumbers);
  myOLED.printNumI(i, CENTER, 10); // Обороты
  myOLED.update();
  }
  return Temp;
}
int setOboroti()
{
  //считываем данные с датчика холла
  val = digitalRead(potPin);

  //если пришел импульс
  if ((val == HIGH) && (flg_push == 0))  {
    //флаг ставим в 1
    flg_push = 1;
  }
  //если импульс ушел, то увеличиваем счетчик
  if ((val == LOW) && (flg_push == 1))  {
    //флаг ставим в 0
    flg_push = 0;
    count++;
  }
  //если прошло 500 милисекунд
  now = (millis() - time) / 500;
  if (now == 1) {

    int i = count * 60;    //выводим кол импульсов из расчета (об/мин)
    
    if (i == 0)
    { if (Temp <= 30) {
        servo.write(n=130);
      }
      if ((Temp > 30) && (Temp <= 35))
      {
        servo.write(n=145);
      }
      if ((Temp > 35) && (Temp <= 40))
      {
        servo.write(n=155);
      }
      if ((Temp > 40) && (Temp <= 50))
      {
        servo.write(n=165);
      }
      if (Temp > 50)
      {
        servo.write(n=175);
      }
    }
    else
    {
      if ((Temp <= 30))
      {

        if (i > 1900)
        {
          n = servo.read();
          n--;
          servo.write(n);
        }
      }
      if ((Temp > 30) && (Temp <= 35))
      {
        if (i > 1600)
        {
          n = servo.read();
          n--;
          servo.write(n);
        }
      }
      if ((Temp > 35) && (Temp <= 40))
      {
        if (i > 1400)
        {
          n = servo.read();
          n--;
          servo.write(n);
        }
      }

      if ((Temp > 40) && (Temp <= 50))
      {
        if (i > 1200)
        {
          n = servo.read();
          n--;
          servo.write(n);
        }
      }

      if (Temp > 50)
      {
        servo.write(n);
      }
    }
    //сбрасываем начальный счетчик
    time = millis();
    //сбрасываем количество импульсов
    count = 0;
  }
  return i;
}