//This code was created by Gapmekatron
//Copyright © 2026 gapmekatron.com

#include ModbusMaster.h

#define RS485_RX 16
#define RS485_TX 17
#define RS485_DE 4

HardwareSerial RS485Serial(1);
ModbusMaster node;

void preTransmission()
{
  digitalWrite(RS485_DE, HIGH);
}

void postTransmission()
{
  digitalWrite(RS485_DE, LOW);
}

void setup()
{
  Serial.begin(115200);

  pinMode(RS485_DE, OUTPUT);
  digitalWrite(RS485_DE, LOW);

  RS485Serial.begin(
    4800,
    SERIAL_8N1,
    RS485_RX,
    RS485_TX
  );

  node.begin(1, RS485Serial);

  node.preTransmission(preTransmission);
  node.postTransmission(postTransmission);

  Serial.println("RS-CFSFX-N01-2 Starting...");
}

void loop()
{
  uint8_t result;

  // Read register 0x0000 - 0x0001
  result = node.readHoldingRegisters(0x0000, 2);

  if (result == node.ku8MBSuccess)
  {
    uint16_t windSpeedRaw =
      node.getResponseBuffer(0);

    uint16_t windDirection =
      node.getResponseBuffer(1);

    float windSpeed =
      windSpeedRaw / 100.0;

    Serial.print("Wind Speed     : ");
    Serial.print(windSpeed, 2);
    Serial.println(" m/s");

    Serial.print("Wind Direction : ");
    Serial.print(windDirection);
    Serial.println(" deg");

    Serial.println("-------------------------");
  }
  else
  {
    Serial.print("Modbus Error: ");
    Serial.println(result);
  }

  delay(1000);
}