Arduino.ru

Доброго дня!

Уже третий день ломаю голову над непонятным поведением кулера, управляемого шилдом от adafruit и библиотекой AF_Motor.

Задача: управлять оборотами двух (пробовал с одним - то же самое) компьютерных кулеров по температуре с датчика ds18b20.

Алгоритм должен работать так:

Если температура больше 32С - увеличивать обороты на 5% от заданного максимума, до максимальных.

Если меньше - понижать по той же схеме.

Если обороты ниже порога в 80, то дать толчек максимум оборотов на 1сек. (иначе кулер может не стартануть).

Проблема в том, что кулер ведет себе непредсказуемо: обороты то затихают, то увеличиваются, при этом показания Serial (для отладки) вроде сответствуют ожидаемым.... 

Вот используемый скетч:

#include <AFMotor.h>
#include <SimpleTimer.h>
#include <DallasTemperature.h>
#include <OneWire.h>
#define ONE_WIRE_BUS 2

AF_DCMotor fan1(1,MOTOR12_2KHZ); //куллеры обдува на порту 1
AF_DCMotor fan2(2,MOTOR12_2KHZ);
AF_DCMotor fanMotor[2]{fan1, fan2};// массив кулеров
OneWire oneWire(ONE_WIRE_BUS); //иниц. 1 wire
DallasTemperature sensors(&oneWire);// init d18b20
int fanSpeed[2]; //массив значений скоростей
float temp; //тек. темп
byte maxFanSpeed[2]; //массив макс. скоростей
SimpleTimer timer; //таймер, millis вместо delay

void setup() {
  Serial.begin(115200);
 
for (byte i = 0; i < 2; i++){
    fanMotor[i].setSpeed(0); //init fans
    fanMotor[i].run(RELEASE);
  };
  sensors.begin();
  fanSpeed[0]=80; //начальная скорость
  fanSpeed[1]=80;

  timer.setInterval(3000,Temp); //проверять температуру раз в 3 сек
  maxFanSpeed[0]=220; //макс значения скоростей
  maxFanSpeed[1]=180;
}

void loop() {
  timer.run(); 

  for (int i=0; i<2;i++){
    fanMotor[i].run(FORWARD); 
  };
}

void Temp()
{
  static float lastTemp = 22; //предыдущее значение темпы
  sensors.requestTemperatures(); // Send the command to get temperatures
  temp = sensors.getTempCByIndex(0); //текущая температура ds18b20
  Serial.print("DS temp: "); 
  Serial.print(temp);
  Serial.print("      ");
  Serial.print("Last temp: ");
  Serial.println(lastTemp);
  lastTemp=temp; 
  if (temp <= -127){ temp = lastTemp; }; //error defense
  if (temp >= 45){ // если темп. критическая - выключить все
    Serial.println("CRITICAL");}
  else if (temp < 45 && temp<lastTemp) { //если температура меньше критической,  и падает то включить обратно
   Serial.println("FINE AGAINE");}
  
for (byte i = 0; i < 2; i++){ //перебор кулеров
  if (temp >= 32){ // если больше 32 увеличиваем обороты
    float Step=(float(maxFanSpeed[i]) / 100)*5;
    Serial.print("step:");
    Serial.println(Step);
    fanSpeed[i] += int(Step);
  } else if (temp < 32 && (temp-lastTemp)>0.3) { // если меньше и падает уменьшаем
     float Step=(float(maxFanSpeed[i]) / 100)*5;
    Serial.print("step:");
    Serial.println(Step);
    fanSpeed[i] -= int(Step);
  };
  if (fanSpeed[i] >= maxFanSpeed[i]){ fanSpeed[i] = maxFanSpeed[i]; } //но не более максимальной
    else if (fanSpeed[i] <= 80){ fanSpeed[i] = 80; }; //но не менее минимальной
  
  Serial.print("fanspeed of fan ");
      Serial.print(i);
      Serial.print("  : ");
      Serial.print(fanSpeed[i]);
  Serial.println();
  };

  SetSpeed();
}
void SetSpeed()
{

static byte prev[2] = { 0, 0 }; // last fanspeed
  static boolean st = 0; // флаг толчка
  Serial.print("st:");
  Serial.println(st);
  
  for (byte i = 0; i < 2; i++){
      
        fanMotor[i].setSpeed(fanSpeed[i]);
        Serial.print(" NEW FAN SPEED of fan ");
        Serial.print(i);
        Serial.print(" is: ");
        Serial.print(fanSpeed[i]);
        Serial.print("      ");
        Serial.print(" Prev fan speed is:");
        Serial.print(prev[i]);
        Serial.println();
     
        st = 0; //возвращаем флаг в 0
        if (fanSpeed[i] <= 80 && prev[i] != fanSpeed[i]){//если скорость ниже зупускной   и это новое значение - дать толчек 
        if (!st){ // если его не было
          fanMotor[i].setSpeed(255);
          fanMotor[i].run(FORWARD); //пуск кулера
          Serial.print(" PUSH fan ");
          Serial.print(i);
          Serial.print("      ");
          st = 1;
          Serial.println();
        };
      };
         prev[i] = fanSpeed[i]; //новое предыдущее значение
      };
      
  if (st){ timer.setTimeout(2000, SetSpeed); Serial.println("push timer is on"); }; //если нужен толчек, то перезапустить функцию через секунду
  
}

  

Помогите разобраться, пожалуйста!