// Pin การเชื่อมต่อ Serial Micromation Dev Board
#define RXD2 16
#define TXD2 17

// Pin การเชื่อมต่อ Serial i-Mation Pico Dev Board
//#define RXD2 34
//#define TXD2 33

byte ByteArray[250];
int ByteData[20];


void setup() {
Serial.begin(9600);
Serial2.begin(4800, SERIAL_8N1, RXD2, TXD2);
}


void loop() {
delay(500);
byte msgfs[] = {0x01,0x03,0x00,0x00,0x00,0x01,0x84,0x0A};
int i;
int len=8;
Serial.println();
Serial.println();
Serial.println("RS-FSA-N01 => SEND DATA");
for(i = 0 ; i < len ; i++){
Serial2.write(msgfs[i]);
Serial.print("[");
Serial.print(i);
Serial.print("]");
Serial.print("=>");
Serial.print(String(msgfs[i], HEX));
Serial.print(" ");
}
len = 0;
Serial.println();
Serial.println();


int a = 0;
while(Serial2.available())
{
ByteArray[a] = Serial2.read();
a++;
}
int b = 0;
String registros;
Serial.println("DATA RECEPTION => RS-FS-N01");
for(b = 0 ; b < a ; b++){
Serial.print("[");
Serial.print(b);
Serial.print("]");
Serial.print("=>");
registros =String(ByteArray[b], HEX);
Serial.print(registros);
Serial.print(" ");
}
Serial.println();
Serial.println();


Serial.println("REGISTERS HEX");


ByteData[0] = ByteArray[3] * 256 + ByteArray[4];
Serial.println(ByteData[0],DEC);
Serial.println();
Serial.println();


float winds;
winds = ByteData[0] * 0.1;



Serial.println("RS-FSA-N01 => Result");
Serial.print("Wind Speed = ");
Serial.print(winds);
Serial.print(" m/s");
delay(200);


}