SOLIS Mini 1000 4G über Modbus auslesen

#include <SoftwareSerial.h>

#include <Wire.h>

#include <LiquidCrystal_I2C.h>

#define rxPin 2

#define txPin 3

#define DataEnablePin A0

#define slaveID 0xA

#define regRequested 33050

#define numRegReq 0x1

#define FRAMESIZE  9                                   //size of out/in array

float dataReceived = 0.00;

SoftwareSerial mySerial (rxPin, txPin);

uint16_t calculateCRC(uint8_t *array, uint8_t num);

LiquidCrystal_I2C lcd(0x3F, 20, 4);

void setup() {

  pinMode(DataEnablePin, OUTPUT);

  digitalWrite(DataEnablePin, LOW);

  mySerial.begin(9600);

  Serial.begin(115200);

  lcd.begin();

  lcd.backlight();

  Serial.println("---- STARTING ----");

}

void loop() {

  uint8_t modArr[9];

  modArr[0] = slaveID; // Slave ID

  modArr[1] = 0x04;    // Object type

  modArr[2] = highByte(regRequested);

  modArr[3] = lowByte(regRequested);

  modArr[4] = highByte(numRegReq);

  modArr[5] = lowByte(numRegReq);

  uint16_t temp = calculateCRC(modArr, FRAMESIZE - 3);

  modArr[6] = lowByte(temp);

  modArr[7] = highByte(temp);

  digitalWrite(DataEnablePin, HIGH);

  delayMicroseconds(20);

  mySerial.write(modArr, FRAMESIZE - 1);

  mySerial.flush();

  delayMicroseconds(10);

  digitalWrite(DataEnablePin, LOW);

  if (mySerial.available() >= FRAMESIZE) {

    for (uint16_t n = 0; n < FRAMESIZE - 2; n++) {

      modArr[n] = mySerial.read();

    }

  }

  if (modArr[0] == slaveID) {

    dataReceived = word(modArr[3], modArr[4]) / 100.00f;

  }

  lcd.print("F:");

  lcd.setCursor(3,0);

  lcd.print(dataReceived);

  lcd.setCursor(10,0);

  lcd.print("Hz");

  lcd.home();

  delay(2500);

}

uint16_t calculateCRC(uint8_t *array, uint8_t num) {

  uint16_t _crc, _flag;

  _crc = 0xFFFF;

  for (uint8_t i = 0; i < num; i++) {

    _crc = _crc ^ array[i];

    for (uint8_t j = 8; j; j--) {

      _flag = _crc & 0x0001;

      _crc >>= 1;

      if (_flag)

        _crc ^= 0xA001;

    }

  }

  return _crc;

}