SKFC
/
IFB_dev
3
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

NX4 사용

Browse Source 
- 단, 각 485의 첫번째만 NX4 가능
- 필요시 추후 확장 예정
- UAE SOFC용으로 업데이트
devIFB_v2
Changwoo Park 2 weeks ago
parent 9d5f29ee40
commit 30a1e87a1a
7 changed files with 238 additions and 109 deletions
Show Stats Download Patch File Download Diff File

12
FC_InterfaceBoard/FC_InterfaceBoard.h
Unescape Escape View File

@ -8,8 +8,8 @@
// ------------------ // ------------------
#include "GP8403.h" #include "GP8403.h"
#define VERSION "240129 1044" #define VERSION "250228 1553"
#define COMMENT "MC9 or AO init" #define COMMENT "MC9 & NX4"
#define AI_RANGE 10 #define AI_RANGE 10
#define AI_AVG_SIZE 20 #define AI_AVG_SIZE 20
@ -99,14 +99,17 @@ char Buff_485_2_Wr[BUFF_SIZE] = {0};
char Buff_485_2_Rd[BUFF_SIZE] = {0}; char Buff_485_2_Rd[BUFF_SIZE] = {0};
String latest_sent_msg_1; String latest_sent_msg_1;
int numOf485 = 0; int numOf485_1 = 0;
int returnTime = 0; int returnTime_1 = 0;
String latest_sent_msg_2; String latest_sent_msg_2;
int numOf485_2 = 0; int numOf485_2 = 0;
int returnTime_2 = 0; int returnTime_2 = 0;
/* ---------- RS485 ---------- */ /* ---------- RS485 ---------- */
// NX4 Addr Start
#define NX4_ADDR 11
// 485 CH 1 // 485 CH 1
bool Wait_485_1; bool Wait_485_1;
int Wait_485_1_cnt; int Wait_485_1_cnt;
@ -156,7 +159,6 @@ void send_485_1();
void send_485_2(); void send_485_2();
int recieve_485_1(); int recieve_485_1();
int recieve_485_2(); int recieve_485_2();
void recieve_485_0();
//GPIO //GPIO
void GPIO_setup(); void GPIO_setup();

38
FC_InterfaceBoard/FC_InterfaceBoard.ino
Unescape Escape View File

@ -44,7 +44,7 @@ void loop() {
String cmdData; String cmdData;
unsigned int data[32]; unsigned int data[32];
int dataSize; int dataSize;
Serial.println("new start");
// check if client is connected // check if client is connected
Serial.println("Client Connected!!!"); Serial.println("Client Connected!!!");
@ -83,29 +83,41 @@ void loop() {
// GPIO // GPIO
else if(cmd=="DO!"){ else if(cmd=="DO!"){
dataSize = demuxNum(cmdData, data); dataSize = demuxNum(cmdData, data);
client.print(Prcss_DO_Write(data, dataSize)); Prcss_DO_Write(data, dataSize);
client.print(Prcss_ALL_Read());
//client.print(Prcss_DO_Write(data, dataSize));
}else if(cmd=="AO!"){ }else if(cmd=="AO!"){
dataSize = demuxNum(cmdData, data); dataSize = demuxNum(cmdData, data);
client.print(Prcss_AO_Write(data, dataSize)); Prcss_AO_Write(data, dataSize);
client.print(Prcss_ALL_Read());
//client.print(Prcss_AO_Write(data, dataSize));
} }
// MC9 // MC9
else if(cmd=="SV_1!"){ else if(cmd=="SV_1!"){
dataSize = demuxNum(cmdData, data); dataSize = demuxNum(cmdData, data);
client.print(Prcss_SV_Write_1(data, dataSize)); Prcss_SV_Write_1(data, dataSize);
client.print(Prcss_ALL_Read());
//client.print(Prcss_SV_Write_1(data, dataSize));
}else if(cmd=="AT_1!"){ }else if(cmd=="AT_1!"){
dataSize = demuxNum(cmdData, data); dataSize = demuxNum(cmdData, data);
client.print(Prcss_AT_Write_1(data, dataSize)); Prcss_AT_Write_1(data, dataSize);
client.print(Prcss_ALL_Read());
//client.print(Prcss_AT_Write_1(data, dataSize));
} }
else if(cmd=="SV_2!"){ else if(cmd=="SV_2!"){
dataSize = demuxNum(cmdData, data); dataSize = demuxNum(cmdData, data);
client.print(Prcss_SV_Write_2(data, dataSize)); Prcss_SV_Write_2(data, dataSize);
client.print(Prcss_ALL_Read());
//client.print(Prcss_SV_Write_2(data, dataSize));
}else if(cmd=="AT_2!"){ }else if(cmd=="AT_2!"){
dataSize = demuxNum(cmdData, data); dataSize = demuxNum(cmdData, data);
client.print(Prcss_AT_Write_2(data, dataSize)); Prcss_AT_Write_2(data, dataSize);
client.print(Prcss_ALL_Read());
//client.print(Prcss_AT_Write_2(data, dataSize));
} }
// Init // Init
@ -114,15 +126,21 @@ void loop() {
}else if(cmd=="RngAO!"){ }else if(cmd=="RngAO!"){
dataSize = demuxNum(cmdData, data); dataSize = demuxNum(cmdData, data);
client.print(Prcss_RngAO(data, dataSize)); Prcss_RngAO(data, dataSize);
client.print(Prcss_ALL_Read());
//client.print(Prcss_RngAO(data, dataSize));
Init_AO = true; Init_AO = true;
}else if(cmd=="ChMC9_1!"){ }else if(cmd=="ChMC9_1!"){
dataSize = demuxNum(cmdData, data); dataSize = demuxNum(cmdData, data);
client.print(Prcss_ChMC9_1(data, dataSize)); Prcss_ChMC9_1(data, dataSize);
client.print(Prcss_ALL_Read());
//client.print(Prcss_ChMC9_1(data, dataSize));
Init_MC9 = true; Init_MC9 = true;
}else if(cmd=="ChMC9_2!"){ }else if(cmd=="ChMC9_2!"){
dataSize = demuxNum(cmdData, data); dataSize = demuxNum(cmdData, data);
client.print(Prcss_ChMC9_2(data, dataSize)); Prcss_ChMC9_2(data, dataSize);
client.print(Prcss_ALL_Read());
//client.print(Prcss_ChMC9_2(data, dataSize));
Init_MC9 = true; Init_MC9 = true;
} }

151
FC_InterfaceBoard/MC9.ino
Unescape Escape View File

@ -22,9 +22,16 @@ String msg_MC9_PV_read(int addr){
message += "0"; message += "0";
} }
message += String(addr); // Address message += String(addr); // Address
if(addr < NX4_ADDR){ //MC9
message += "DRS,08,0001"; // Data Read Seris 08 data from 0001(PV) ch message += "DRS,08,0001"; // Data Read Seris 08 data from 0001(PV) ch
message += sumMC9(message); // Check Sum message += sumMC9(message); // Check Sum
message = "" + message; // Start with STX message = "" + message; // Start with STX
}else{ //NX4, only 1 Ch
message += "DRS,01,0001"; // Data Read Seris 08 data from 0001(PV) ch
message += sumMC9(message); // Check Sum
message = "" + message; // Start with STX
}
return message; return message;
} }
@ -36,9 +43,16 @@ String msg_MC9_SV_read(int addr){
message += "0"; message += "0";
} }
message += String(addr); // Address message += String(addr); // Address
if(addr < NX4_ADDR){ //MC9
message += "DRS,08,0011"; // Data Read Seris 08 data from 0001(SV) ch message += "DRS,08,0011"; // Data Read Seris 08 data from 0001(SV) ch
message += sumMC9(message); // Check Sum message += sumMC9(message); // Check Sum
message = "" + message; // Start with STX message = "" + message; // Start with STX
}else{ //NX4, only 1 Ch
message += "DRS,01,0002"; // Data Read Seris 08 data from 0001(PV) ch
message += sumMC9(message); // Check Sum
message = "" + message; // Start with STX
}
return message; return message;
} }
@ -46,7 +60,7 @@ String msg_MC9_SV_read(int addr){
int msg_MC9_SV_set_1(unsigned int data[], int dataSize){ int msg_MC9_SV_set_1(unsigned int data[], int dataSize){
String message = ""; String message = "";
int lp0, lp1; int lp0, lp1;
int addr;
if(dataSize > 16){ if(dataSize > 16){
dataSize = 16; dataSize = 16;
} }
@ -58,11 +72,14 @@ int msg_MC9_SV_set_1(unsigned int data[], int dataSize){
lp1 = 0; lp1 = 0;
} }
if(RS485_1_Addr[0] != 0){ addr = RS485_1_Addr[0];
if(RS485_1_Addr[0] < 10){ if(addr != 0){
if(addr < 10){
message += "0"; message += "0";
} }
message = String(RS485_1_Addr[0]); message = String(addr);
if(addr < NX4_ADDR){ //MC9
message += "DWR,0" + String(lp0) + ","; message += "DWR,0" + String(lp0) + ",";
for(int i=0 ; i<lp0 ; i++){ for(int i=0 ; i<lp0 ; i++){
char hexStr[5]; // Buffer to hold the hexadecimal string (4 characters + null terminator) char hexStr[5]; // Buffer to hold the hexadecimal string (4 characters + null terminator)
@ -77,7 +94,36 @@ int msg_MC9_SV_set_1(unsigned int data[], int dataSize){
} }
message += sumMC9(message); message += sumMC9(message);
message = "" + message + CRLF; message = "" + message + CRLF;
write_buff_first(Buff_485_1_Wr, message); if(write_buff_first(Buff_485_1_Wr, message)){
numOf485_1++;
}
}else{ //NX4, only 1 Ch
char hexStr[5]; // Buffer to hold the hexadecimal string (4 characters + null terminator)
String messageRate = message;
//SV Message
message += "DWS,01,0301,";
sprintf(hexStr, "%04X", data[0]); // Format as 4 digit uppercase hexadecimal
message += String(hexStr);
message += sumMC9(message);
message = "" + message + CRLF;
if(write_buff_first(Buff_485_1_Wr, message)){
numOf485_1++;
}
//Up,Down Rate Message
messageRate += "DWS,02,0108,";
sprintf(hexStr, "%04X", data[1]); // Format as 4 digit uppercase hexadecimal
messageRate += String(hexStr) + "," + String(hexStr);
messageRate += sumMC9(messageRate);
messageRate = "" + messageRate + CRLF;
if(write_buff_first(Buff_485_1_Wr, messageRate)){
numOf485_1++;
}
}
} }
if((RS485_1_Addr[1] != 0) && (lp1>0)){ if((RS485_1_Addr[1] != 0) && (lp1>0)){
@ -100,7 +146,9 @@ int msg_MC9_SV_set_1(unsigned int data[], int dataSize){
message += sumMC9(message); message += sumMC9(message);
message = "" + message + CRLF; message = "" + message + CRLF;
write_buff_first(Buff_485_1_Wr, message); if(write_buff_first(Buff_485_1_Wr, message)){
numOf485_1++;
}
} }
return 0; return 0;
@ -146,7 +194,9 @@ int msg_MC9_AT_set_1(unsigned int data[], int dataSize){
message += sumMC9(message); message += sumMC9(message);
message = "" + message + CRLF; message = "" + message + CRLF;
write_buff_first(Buff_485_1_Wr, message); if(write_buff_first(Buff_485_1_Wr, message)){
numOf485_1++;
}
} }
message = ""; message = "";
@ -174,7 +224,9 @@ int msg_MC9_AT_set_1(unsigned int data[], int dataSize){
} }
message += sumMC9(message); message += sumMC9(message);
message = "" + message + CRLF; message = "" + message + CRLF;
write_buff_first(Buff_485_1_Wr, message); if(write_buff_first(Buff_485_1_Wr, message)){
numOf485_1++;
}
} }
return 0; return 0;
} }
@ -182,6 +234,7 @@ int msg_MC9_AT_set_1(unsigned int data[], int dataSize){
int msg_MC9_SV_set_2(unsigned int data[], int dataSize){ int msg_MC9_SV_set_2(unsigned int data[], int dataSize){
String message = ""; String message = "";
int lp0, lp1; int lp0, lp1;
int addr;
if(dataSize > 16){ if(dataSize > 16){
dataSize = 16; dataSize = 16;
@ -194,11 +247,14 @@ int msg_MC9_SV_set_2(unsigned int data[], int dataSize){
lp1 = 0; lp1 = 0;
} }
if(RS485_2_Addr[0] != 0){ addr = RS485_2_Addr[0];
if(RS485_2_Addr[0] < 10){ if(addr != 0){
if(addr < 10){
message += "0"; message += "0";
} }
message = String(RS485_2_Addr[0]); message = String(addr);
if(addr < NX4_ADDR){ //MC9
message += "DWR,0" + String(lp0) + ","; message += "DWR,0" + String(lp0) + ",";
for(int i=0 ; i<lp0 ; i++){ for(int i=0 ; i<lp0 ; i++){
char hexStr[5]; // Buffer to hold the hexadecimal string (4 characters + null terminator) char hexStr[5]; // Buffer to hold the hexadecimal string (4 characters + null terminator)
@ -213,7 +269,37 @@ int msg_MC9_SV_set_2(unsigned int data[], int dataSize){
} }
message += sumMC9(message); message += sumMC9(message);
message = "" + message + CRLF; message = "" + message + CRLF;
write_buff_first(Buff_485_2_Wr, message); if(write_buff_first(Buff_485_2_Wr, message)){
numOf485_2++;
}
}else{ //NX4, only 1 Ch
char hexStr[5]; // Buffer to hold the hexadecimal string (4 characters + null terminator)
String messageRate = message;
//SV Message
message += "DWS,01,0301,";
sprintf(hexStr, "%04X", data[0]); // Format as 4 digit uppercase hexadecimal
message += String(hexStr);
message += sumMC9(message);
message = "" + message + CRLF;
if(write_buff_first(Buff_485_2_Wr, message)){
numOf485_2++;
}
//Up,Down Rate Message
messageRate += "DWS,02,0108,";
sprintf(hexStr, "%04X", data[1]); // Format as 4 digit uppercase hexadecimal
messageRate += String(hexStr) + "," + String(hexStr);
messageRate += sumMC9(messageRate);
messageRate = "" + messageRate + CRLF;
if(write_buff_first(Buff_485_2_Wr, messageRate)){
numOf485_2++;
}
}
} }
if((RS485_2_Addr[1] != 0) && (lp1>0)){ if((RS485_2_Addr[1] != 0) && (lp1>0)){
@ -235,7 +321,9 @@ int msg_MC9_SV_set_2(unsigned int data[], int dataSize){
} }
message += sumMC9(message); message += sumMC9(message);
message = "" + message + CRLF; message = "" + message + CRLF;
write_buff_first(Buff_485_2_Wr, message); if(write_buff_first(Buff_485_2_Wr, message)){
numOf485_2++;
}
} }
return 0; return 0;
@ -281,7 +369,9 @@ int msg_MC9_AT_set_2(unsigned int data[], int dataSize){
} }
message += sumMC9(message); message += sumMC9(message);
message = "" + message + CRLF; message = "" + message + CRLF;
write_buff_first(Buff_485_2_Wr, message); if(write_buff_first(Buff_485_2_Wr, message)){
numOf485_2++;
}
} }
message = ""; message = "";
@ -309,7 +399,9 @@ int msg_MC9_AT_set_2(unsigned int data[], int dataSize){
} }
message += sumMC9(message); message += sumMC9(message);
message = "" + message + CRLF; message = "" + message + CRLF;
write_buff_first(Buff_485_2_Wr, message); if(write_buff_first(Buff_485_2_Wr, message)){
numOf485_2++;
}
} }
return 0; return 0;
@ -340,6 +432,10 @@ int saveMC9_1(String message){
for(int i = 0 ; i < RS485_1_Rcv_size ; i++){ for(int i = 0 ; i < RS485_1_Rcv_size ; i++){
RS485_1_Values_PV[i + idx*8] = data[i]; RS485_1_Values_PV[i + idx*8] = data[i];
} }
}else if(latest_sent_msg_1.indexOf("DRS,01,0001") != -1){ // if sent message is PV CMD
//rcv_10_PV = true;
RS485_1_Rcv_PV[idx] = true;
RS485_1_Values_PV[0] = data[0];
} }
if(latest_sent_msg_1.indexOf("DRS,08,0011") != -1){ // if sent message is SV CMD if(latest_sent_msg_1.indexOf("DRS,08,0011") != -1){ // if sent message is SV CMD
@ -348,11 +444,15 @@ int saveMC9_1(String message){
for(int i = 0 ; i < RS485_1_Rcv_size ; i++){ for(int i = 0 ; i < RS485_1_Rcv_size ; i++){
RS485_1_Values_SV[i + idx*8] = data[i]; RS485_1_Values_SV[i + idx*8] = data[i];
} }
}else if(latest_sent_msg_1.indexOf("DRS,01,0002") != -1){ // if sent message is PV CMD
//rcv_10_PV = true;
RS485_1_Rcv_SV[idx] = true;
RS485_1_Values_SV[0] = data[0];
} }
return 0; return 0;
} else { } else {
Serial.println("error 485 read"); Serial.println("485_1: unknown message recived");
return -1; return -1;
} }
} }
@ -379,22 +479,31 @@ int saveMC9_2(String message){
if(latest_sent_msg_2.indexOf("DRS,08,0001") != -1){ // if sent message is PV CMD if(latest_sent_msg_2.indexOf("DRS,08,0001") != -1){ // if sent message is PV CMD
//rcv_10_PV = true; //rcv_10_PV = true;
RS485_2_Rcv_PV[idx] = true; RS485_2_Rcv_PV[idx] = true;
for(int i = 0 ; i < RS485_1_Rcv_size ; i++){ for(int i = 0 ; i < RS485_2_Rcv_size ; i++){
RS485_2_Values_PV[i + idx*8] = data[i]; RS485_2_Values_PV[i + idx*8] = data[i];
} }
}else if(latest_sent_msg_2.indexOf("DRS,01,0001") != -1){ // if sent message is PV CMD
//rcv_10_PV = true;
RS485_2_Rcv_PV[idx] = true;
RS485_2_Values_PV[0] = data[0];
} }
if(latest_sent_msg_2.indexOf("DRS,08,0011") != -1){ // if sent message is SV CMD if(latest_sent_msg_2.indexOf("DRS,08,0011") != -1){ // if sent message is SV CMD
//rcv_10_SV = true; //rcv_10_SV = true;
RS485_2_Rcv_SV[idx] = true; RS485_2_Rcv_SV[idx] = true;
for(int i = 0 ; i < RS485_1_Rcv_size ; i++){ for(int i = 0 ; i < RS485_2_Rcv_size ; i++){
RS485_2_Values_SV[i + idx*8] = data[i]; RS485_2_Values_SV[i + idx*8] = data[i];
} }
}else if(latest_sent_msg_2.indexOf("DRS,01,0002") != -1){ // if sent message is PV CMD
//rcv_10_PV = true;
RS485_2_Rcv_SV[idx] = true;
RS485_2_Values_SV[0] = data[0];
} }
return 0; return 0;
} else { } else {
Serial.println("error 485 read"); Serial.println("485_2: unknown message recived");
return -1; return -1;
} }
} }
@ -478,8 +587,12 @@ int parseMC9(const String& message, int& addr, String& mode, int data[8], int& c
// Check the parsed status and the number of extracted elements // Check the parsed status and the number of extracted elements
if (strcmp(statusC, "OK") != 0 || ret != 12) { if (strcmp(statusC, "OK") != 0 || ret != 12) {
int ret = sscanf(message.c_str(), "%2s%3s,%2s,%4x%2x",
addrC, modeC, statusC, &dataC[0], &crcC);
if (strcmp(statusC, "OK") != 0 || ret != 5) {
return -1; return -1;
} }
}
// Copy data to the output parameters // Copy data to the output parameters
addr = atoi(addrC); addr = atoi(addrC);

21
FC_InterfaceBoard/Periodics.ino
Unescape Escape View File

@ -22,7 +22,9 @@ void Periodic_run(){
} }
if(T_20ms){ if(T_20ms){
send_485_1(); send_485_1();
send_485_2();
recieve_485_1(); recieve_485_1();
recieve_485_2();
T_20ms = false; T_20ms = false;
} }
if(T_50ms){ if(T_50ms){
@ -39,7 +41,6 @@ void Periodic_run(){
} }
if(T_500ms){ if(T_500ms){
recieve_485_0(); // RS485 recieve (for developing)
T_500ms = false; T_500ms = false;
} }
if(T_1000ms){ if(T_1000ms){
@ -48,15 +49,27 @@ void Periodic_run(){
} }
if(T_2000ms){ if(T_2000ms){
// Read MC9 PV // Read MC9 PV
for(int i=0 ; i < 2 ; i++){ for(int i=0 ; i < 2 ; i++){
if(RS485_1_Addr[i] > 0){ if(RS485_1_Addr[i] > 0){
write_buff(Buff_485_1_Wr, msg_MC9_PV_read(RS485_1_Addr[i])); if(write_buff(Buff_485_1_Wr, msg_MC9_PV_read(RS485_1_Addr[i]))){
numOf485_1++;
}
}
}
for(int i=0 ; i < 2 ; i++){
if(RS485_2_Addr[i] > 0){
if(write_buff(Buff_485_2_Wr, msg_MC9_PV_read(RS485_2_Addr[i]))){
numOf485_2++;
} }
} }
}
if(numOf485 > 10){ if(numOf485_1 > 10){
Serial.print("----- remain 485 buff : "); // For Serial.print("----- remain 485 buff : "); // For
Serial.println(numOf485); // Debugging Serial.println(numOf485_1); // Debugging
} }
T_2000ms = false; T_2000ms = false;
} }

20
FC_InterfaceBoard/Processes.ino
Unescape Escape View File

@ -48,6 +48,26 @@ String Prcss_ALL_Read(){
} }
str += RcvOK; str += RcvOK;
str += "PV_2?:";
for (int i = 0; i < RS485_2_Rcv_size*2; i++) {
int rcv = int(RS485_2_Rcv_PV[i/RS485_2_Rcv_size]);
sprintf(formattedNumber, "%04X", RS485_2_Values_PV[i] * rcv);
str += formattedNumber;
str += ',';
}
str += RcvOK;
str += "SV_2?:";
for (int i = 0; i < RS485_2_Rcv_size*2; i++) {
int rcv = int(RS485_2_Rcv_SV[i/RS485_2_Rcv_size]);
sprintf(formattedNumber, "%04X", RS485_2_Values_SV[i] * rcv);
str += formattedNumber;
str += ',';
}
str += RcvOK;
str += "INIT?:"; str += "INIT?:";
sprintf(formattedNumber, "%04X", ((unsigned int)(Init_AO | Init_MC9))); sprintf(formattedNumber, "%04X", ((unsigned int)(Init_AO | Init_MC9)));
str += formattedNumber; str += formattedNumber;

49
FC_InterfaceBoard/RS485.ino
Unescape Escape View File

@ -29,7 +29,7 @@ void send_485_1(){
message += CRLF; message += CRLF;
digitalWrite(RS485_OE_1, Snd_485); delay(5); digitalWrite(RS485_OE_1, Snd_485); delay(5);
Serial1.print(message); Serial1.print(message);
returnTime = millis(); returnTime_1 = millis();
Serial1.flush(); Serial1.flush();
digitalWrite(RS485_OE_1, Rcv_485); delay(5); digitalWrite(RS485_OE_1, Rcv_485); delay(5);
@ -50,12 +50,13 @@ void send_485_2(){
message += CRLF; message += CRLF;
digitalWrite(RS485_OE_2, Snd_485); delay(5); digitalWrite(RS485_OE_2, Snd_485); delay(5);
Serial2.print(message); Serial2.print(message);
returnTime = millis(); returnTime_2 = millis();
Serial2.flush(); Serial2.flush();
digitalWrite(RS485_OE_2, Rcv_485); delay(5); digitalWrite(RS485_OE_2, Rcv_485); delay(5);
Wait_485_2 = true; Wait_485_2 = true;
Wait_485_2_cnt = 0; Wait_485_2_cnt = 0;
} }
} }
} }
@ -71,7 +72,7 @@ int recieve_485_1(){
latest_sent_msg_1 = ""; latest_sent_msg_1 = "";
Wait_485_1 = false; Wait_485_1 = false;
Wait_485_1_cnt = 0; Wait_485_1_cnt = 0;
numOf485--; numOf485_1--;
return -1; return -1;
} }
@ -84,7 +85,7 @@ int recieve_485_1(){
String message = read_buff(Buff_485_1_Rd); String message = read_buff(Buff_485_1_Rd);
if(message != ""){ if(message != ""){
numOf485--; numOf485_1--;
if(latest_sent_msg_1.indexOf("DRS") != -1){ if(latest_sent_msg_1.indexOf("DRS") != -1){
saveMC9_1(message); saveMC9_1(message);
} }
@ -110,7 +111,7 @@ int recieve_485_2(){
latest_sent_msg_2 = ""; latest_sent_msg_2 = "";
Wait_485_2 = false; Wait_485_2 = false;
Wait_485_2_cnt = 0; Wait_485_2_cnt = 0;
numOf485--; numOf485_2--;
return -1; return -1;
} }
@ -123,7 +124,7 @@ int recieve_485_2(){
String message = read_buff(Buff_485_2_Rd); String message = read_buff(Buff_485_2_Rd);
if(message != ""){ if(message != ""){
numOf485--; numOf485_2--;
if(latest_sent_msg_2.indexOf("DRS") != -1){ if(latest_sent_msg_2.indexOf("DRS") != -1){
saveMC9_2(message); saveMC9_2(message);
} }
@ -137,39 +138,3 @@ int recieve_485_2(){
return 0; return 0;
} }
/* For Test from PC */
void recieve_485_0(){
while(Serial.available() > 0) {
char c = Serial.read();
IdeSerial += c;
}
if(IdeSerial.endsWith("\n")){
IdeSerial.replace(CRLF,"");
IdeSerial += sumMC9(IdeSerial);
IdeSerial = "" + IdeSerial + CRLF;
write_buff_first(Buff_485_1_Wr, IdeSerial);
IdeSerial = "";
}
}
void send_temp(bool F){
String message = "TEST";
if(F) {
message += CRLF;
message += " with CRLF";
message += CRLF;
}
digitalWrite(RS485_OE_1, Snd_485); delay(5);
Serial1.print(message);
returnTime = millis();
Serial1.flush();
digitalWrite(RS485_OE_1, Rcv_485); delay(5);
}

2
FC_InterfaceBoard/Utils.ino
Unescape Escape View File

@ -21,7 +21,6 @@ int write_buff(char* buff, String str) {
size_t len = strlen(cstr); size_t len = strlen(cstr);
if (strlen(buff) + len < BUFF_SIZE) { if (strlen(buff) + len < BUFF_SIZE) {
strcat(buff, cstr); strcat(buff, cstr);
numOf485++;
return 1; return 1;
} else { } else {
Serial.println("Not enough space in buffer! (write)"); Serial.println("Not enough space in buffer! (write)");
@ -38,7 +37,6 @@ int write_buff_first(char* buff, String str) {
strcpy(temp, buff); // copy existing content to temp buffer strcpy(temp, buff); // copy existing content to temp buffer
strcpy(buff, cstr); // copy new string to buffer strcpy(buff, cstr); // copy new string to buffer
strcat(buff, temp); // append old content to buffer strcat(buff, temp); // append old content to buffer
numOf485++;
return 1; return 1;
} else { } else {
Serial.println("Not enough space in buffer! (prepend)"); Serial.println("Not enough space in buffer! (prepend)");

Write Preview
Loading…
Cancel
Save