Форум РадиоКот

Код: Выделить всё

#include <SPI.h>
#include <Wire.h>
#include <ModbusRtu.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
#define OLED_RESET 4
Adafruit_SSD1306 display(OLED_RESET);

Modbus _modbusMaster(0, 0, 2);
uint16_t _regModSlav_1[4];
modbus_t _modTelegrSend1;
modbus_t _modTelegrRead1;
unsigned long _modbusTimeVar1 = millis();
bool _isNeesdedSinhronizeSlave1 =0;
uint16_t _regModSlav_2[4];
modbus_t _modTelegrSend2;
modbus_t _modTelegrRead2;
unsigned long _modbusTimeVar2 = millis();
bool _isNeesdedSinhronizeSlave2 =0;
uint8_t _modState;
int  _modTlgIndex = -1;
bool  _isModbusRead = 0;
int _gtv1 = 0;
int _gtv2 = 0;
bool _gtv3 = 0;
bool _gtv4 = 0;
int _gtv5 = 45;
int _gtv6 = 40;
int _gtv7 = 0;
bool _gen1I = 0;
bool _gen1O = 0;
unsigned long _gen1P = 0UL;
int _bitW1;
void setup()
{
  Serial.begin(9600);
  _modbusMaster.begin(19200);
  _modbusMaster.setTimeOut(1000);
  _modState = 0;
  _modTelegrSend1.u8id  = 1;
  _modTelegrSend1.u8fct  = 16;
  _modTelegrSend1.u16RegAdd  = 0;
  _modTelegrSend1.u16CoilsNo  = 4;
  _modTelegrSend1.au16reg  = _regModSlav_1;
  _modTelegrRead1.u8id  = 1;
  _modTelegrRead1.u8fct  = 3;
  _modTelegrRead1.u16RegAdd  = 0;
  _modTelegrRead1.u16CoilsNo  = 4;
  _modTelegrRead1.au16reg  = _regModSlav_1;
  _modTelegrSend2.u8id  = 2;
  _modTelegrSend2.u8fct  = 16;
  _modTelegrSend2.u16RegAdd  = 0;
  _modTelegrSend2.u16CoilsNo  = 4;
  _modTelegrSend2.au16reg  = _regModSlav_2;
  _modTelegrRead2.u8id  = 2;
  _modTelegrRead2.u8fct  = 3;
  _modTelegrRead2.u16RegAdd  = 0;
  _modTelegrRead2.u16CoilsNo  = 4;
  _modTelegrRead2.au16reg  = _regModSlav_2;
  display.begin(SSD1306_SWITCHCAPVCC, 0x3C);
  display.clearDisplay();
  pinMode(9, OUTPUT);
  digitalWrite(9, 1);
  display.setTextColor(WHITE);
  display.setTextSize(2);
  display.setCursor(0,0);
  display.println("VENT ON");
  display.display();
  delay (10000);
  digitalWrite(9, 0);
  display.clearDisplay();

}
void loop()
{
  if((_isTimer(_modbusTimeVar1, 1000 ))&&(!_isNeesdedSinhronizeSlave1)) { 
    _isNeesdedSinhronizeSlave1= 1; 
    _modbusTimeVar1 = millis();
  }
  if((_isTimer(_modbusTimeVar2, 1000 ))&&(!_isNeesdedSinhronizeSlave2)) { 
    _isNeesdedSinhronizeSlave2= 1; 
    _modbusTimeVar2 = millis();
  }
  switch(_modState) {
  case 0:
    { 
      if((_modTlgIndex == -1)&&(_isNeesdedSinhronizeSlave1)){
        _modTlgIndex = 1; 
        _isModbusRead = 1; 
        _modState = 1;  
        break;
      }
      if((_modTlgIndex == 1)&&(_isModbusRead)){
        _regModSlav_1[3] = _bitW1;
        _isModbusRead = 0; 
        _modState = 1; 
        break;
      }
      if((_modTlgIndex == 1)&&( !_isModbusRead)){
        _modTlgIndex = -1; 
        _isNeesdedSinhronizeSlave1 = 0;
      }
      if((_modTlgIndex == -1)&&(_isNeesdedSinhronizeSlave2)){
        _modTlgIndex = 2; 
        _isModbusRead = 1; 
        _modState = 1;  
        break;
      }
      if((_modTlgIndex == 2)&&(_isModbusRead)){
        _regModSlav_2[3] = _bitW1;
        _isModbusRead = 0; 
        _modState = 1; 
        break;
      }
      if((_modTlgIndex == 2)&&( !_isModbusRead)){
        _modTlgIndex = -1; 
        _isNeesdedSinhronizeSlave2 = 0;
      }
      break;
    } 
  case 1:
    { 
      if((_modTlgIndex == 1)&&(_isModbusRead)) { 
        _modbusMaster.query(_modTelegrRead1); 
        _modState = 2;  
        break; 
      }
      if((_modTlgIndex == 1)&&(! _isModbusRead)) { 
        _modbusMaster.query(_modTelegrSend1); 
        _modState = 2;  
        break; 
      }
      if((_modTlgIndex == 2)&&(_isModbusRead)) { 
        _modbusMaster.query(_modTelegrRead2); 
        _modState = 2;  
        break; 
      }
      if((_modTlgIndex == 2)&&(! _isModbusRead)) { 
        _modbusMaster.query(_modTelegrSend2); 
        _modState = 2;  
        break; 
      }
      break;
    } 
  case 2: 
    _modbusMaster.poll();
    if (_modbusMaster.getState() == COM_IDLE) {
      _modState= 0;
    }
    break;
  }




  if (1) {
    if (! _gen1I) { 
      _gen1I = 1; 
      _gen1O = 1; 
      _gen1P =  millis(); 
    } 
  } 
  else { 
    _gen1I = 0 ;  
    _gen1O= 0;  
  } 
  if (_gen1I ) { 
    if (_gen1O) { 
      if ( _isTimer( _gen1P , 100 )) { 
        _gen1P = millis(); 
        _gen1O = 0; 
      } 
    } 
    else  { 
      if ( _isTimer( _gen1P , 10000 )) {  
        _gen1P = millis(); 
        _gen1O = 1;  
      } 
    } 
  }
  if (_gen1O) {
    _gtv1 = (int(_regModSlav_1[0]));
  }
  if (_gen1O) {
    _gtv2 = (int(_regModSlav_2[0]));
  }
  _gtv3 =  ((_gtv1) >= (_gtv5)) && (! ((_gtv1) <= (_gtv6))) ;
  _gtv4 =  ((_gtv2) >= (_gtv5)) && (! ((_gtv2) <= (_gtv6))) ;
  _bitW1 = _gtv7;
  bitWrite(_bitW1, (1), ( (_gtv3) || (_gtv4) ));
  digitalWrite(9,  (_gtv3) || (_gtv4) );
  if ( (_gtv3) || (_gtv4) ){
    display.setTextColor(WHITE);
    display.setTextSize(2);
    display.setCursor(0,0);
    display.println("VENT ON");
    display.display();
  }
  display.clearDisplay();
  display.setTextSize(2);
  display.setTextColor(WHITE);
  display.setCursor(0,25);
  display.println("H1 - ");
  display.setCursor(60,25);
  display.println(_gtv1);
  display.setCursor(85,25);
  display.println("%");
  display.setCursor(0,50);
  display.println("H2 - ");
  display.setCursor(60,50);
  display.println(_gtv2);
  display.setCursor(85,50);
  display.println("%");
  display.display();




}
bool _isTimer(unsigned long startTime, unsigned long period )
{
  unsigned long currentTime;
  currentTime = millis();
  if (currentTime>= startTime) {
    return (currentTime>=(startTime + period));
  } 
  else {
    return (currentTime >=(4294967295-startTime+period));
  }
}