CHE-WEI LIN
/
modbus_test
share
Revision 2:9497b91d341a, committed 2020-03-23
- Comitter:
- ohlaaa
- Date:
- Mon Mar 23 08:05:49 2020 +0000
- Parent:
- 1:17ea42de4a8a
- Commit message:
- 12345;
Changed in this revision
ATParser.lib | Show annotated file Show diff for this revision Revisions of this file |
main.cpp | Show annotated file Show diff for this revision Revisions of this file |
diff -r 17ea42de4a8a -r 9497b91d341a ATParser.lib --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/ATParser.lib Mon Mar 23 08:05:49 2020 +0000 @@ -0,0 +1,1 @@ +https://os.mbed.com/users/ohlaaa/code/ATParser2/#ead74003acde
diff -r 17ea42de4a8a -r 9497b91d341a main.cpp --- a/main.cpp Thu Aug 22 07:17:07 2019 +0000 +++ b/main.cpp Mon Mar 23 08:05:49 2020 +0000 @@ -1,49 +1,36 @@ #include "mbed.h" - +#include "ATParser.h" +#include "string.h" +#include <string> + + Serial pc(USBTX, USBRX); //((USBTX, USBRX)) Serial modbus(PA_9, PA_10,9600);//(tx,rx,baud) -Serial evk(PC_10,PC_11,115200); //CN7 +//Serial evk(PC_10,PC_11,115200); //CN7 +BufferedSerial evk(PC_10,PC_11,1024); +ATParser at=ATParser(evk,"\r\n"); + DigitalOut DE_RE(PA_8); -#define Read_Reg 0x03 int Max_Byte=8; -uint8_t mdb_Command_buffer[8]; +uint8_t mdb_Command_buffer[11]; uint8_t mdb_Message_buffer[8]; uint16_t RTU_CRC; int message_in_byte=0; +char device_counter=1; +int D3_X0 = 0; +int D1_X0 = 0; +char server_buff[27]={0}; + + +void AT_publish(char* s); + struct mdb_Data_Set { uint8_t Addr; uint8_t Data[8]; }; mdb_Data_Set mdb_Data[8]; -//put PC input into modbus -void PC_callback() { - //modbus.putc(pc.getc()); - // char incomming_CMD; - /* while (pc.readable()){ - incomming_CMD+=pc.getc()-1; - } - pc.printf("Received Command :%c\r\n", incomming_CMD);*/ - - pc.putc(pc.getc()); -} - -void evk_callback() { - pc.putc('a'); - pc.putc(evk.getc()); -} - - -//put modbus reply into PC -void MODBUS_callback() { - //pc.putc(modbus.getc()); - mdb_Message_buffer[message_in_byte]=modbus.getc(); - message_in_byte++; - -} - - //MODBUS RTU CRC uint16_t mdbRTU_CRC(uint8_t message[], int Length) { @@ -68,34 +55,210 @@ //pc.printf("lo_mdb_CRC= %02X \r\n", lo_RTU_CRC); } -int main() { - pc.baud(115200); - evk.attach(&evk_callback); - pc.attach(&PC_callback); - modbus.attach(&MODBUS_callback); - uint8_t dev_Addr; - uint16_t Hold_Reg=1; - uint16_t Reg_len=2; +//char to int + +int char_to_int(char high,char low){ + int H = high - 48; + int L = low - 48; + int K = H*10 + L -30; - while(1) { - for (dev_Addr=1; dev_Addr<6; dev_Addr++){ - mdb_Command_buffer[0]=(uint8_t)dev_Addr; - mdb_Command_buffer[1]=Read_Reg; - mdb_Command_buffer[2]=(uint8_t)((Hold_Reg & 0xFF00) >> 8); - mdb_Command_buffer[3]=(uint8_t)(Hold_Reg & 0x00FF); - mdb_Command_buffer[4]=(uint8_t)((Reg_len & 0xFF00) >> 8); - mdb_Command_buffer[5]=(uint8_t)(Reg_len & 0x00FF); - //mdbRTU_CRC(); + if(K == 31) return 10; + else if(K == 32) return 11; + else if(K == 33) return 12; + else if(K == 34) return 13; + else if(K == 35) return 14; + else if(K == 36) return 15; + else return K; + } + + +//write modbus_data +void mdb_control(uint8_t action){ + int dev_Addr = 0; + int command_length=0; + uint8_t hi_RTU_CRC ; + uint8_t lo_RTU_CRC ; + + + switch(action){ + + case 1: + dev_Addr = 1; + pc.printf("Device 1 task 1 : Read X0~X7 \n"); + command_length = 8; + //pc.printf("\nRead from device %d at %04x with length %04x\n",dev_Addr,Hold_Reg,Reg_len); + mdb_Command_buffer[0]=(uint8_t) 0x01; + mdb_Command_buffer[1]=(uint8_t) 0x02; + mdb_Command_buffer[2]=(uint8_t) 0x04; + mdb_Command_buffer[3]=(uint8_t) 0x10; + mdb_Command_buffer[4]=(uint8_t) 0x00; + mdb_Command_buffer[5]=(uint8_t) 0x08; RTU_CRC=mdbRTU_CRC(mdb_Command_buffer,6); - //pc.printf("RTU_CRC=%04x\r\n",RTU_CRC); - uint8_t hi_RTU_CRC = (uint8_t)((RTU_CRC & 0xFF00) >> 8); - uint8_t lo_RTU_CRC = (uint8_t)(RTU_CRC & 0x00FF); + hi_RTU_CRC = (uint8_t)((RTU_CRC & 0xFF00) >> 8); + lo_RTU_CRC = (uint8_t)(RTU_CRC & 0x00FF); + mdb_Command_buffer[6]=lo_RTU_CRC; + mdb_Command_buffer[7]=hi_RTU_CRC; + break; + + case 2: + dev_Addr = 1; + pc.printf("Device 1 task2 : Y3 change state every 5 seconds \n"); + command_length = 8; + //pc.printf("\nRead from device %d at %04x with length %04x\n",dev_Addr,Hold_Reg,Reg_len); + mdb_Command_buffer[0]=(uint8_t) 0x01; + mdb_Command_buffer[1]=(uint8_t) 0x01; + mdb_Command_buffer[2]=(uint8_t) 0x05; + mdb_Command_buffer[3]=(uint8_t) 0x03; + mdb_Command_buffer[4]=(uint8_t) 0x00; + mdb_Command_buffer[5]=(uint8_t) 0x01; + RTU_CRC=mdbRTU_CRC(mdb_Command_buffer,6); + hi_RTU_CRC = (uint8_t)((RTU_CRC & 0xFF00) >> 8); + lo_RTU_CRC = (uint8_t)(RTU_CRC & 0x00FF); + mdb_Command_buffer[6]=lo_RTU_CRC; + mdb_Command_buffer[7]=hi_RTU_CRC; + break; + + case 3: + dev_Addr = 1; + pc.printf("Device 1 task 3 : Read D0 which add 1 per second \n"); + command_length = 8; + //pc.printf("\nRead from device %d at %04x with length %04x\n",dev_Addr,Hold_Reg,Reg_len); + mdb_Command_buffer[0]=(uint8_t) 0x01; + mdb_Command_buffer[1]=(uint8_t) 0x03; + mdb_Command_buffer[2]=(uint8_t) 0x10; + mdb_Command_buffer[3]=(uint8_t) 0x00; + mdb_Command_buffer[4]=(uint8_t) 0x00; + mdb_Command_buffer[5]=(uint8_t) 0x01; + RTU_CRC=mdbRTU_CRC(mdb_Command_buffer,6); + hi_RTU_CRC = (uint8_t)((RTU_CRC & 0xFF00) >> 8); + lo_RTU_CRC = (uint8_t)(RTU_CRC & 0x00FF); + mdb_Command_buffer[6]=lo_RTU_CRC; + mdb_Command_buffer[7]=hi_RTU_CRC; + break; + + case 4: + dev_Addr = 1; + if(D1_X0==0)pc.printf("Device 1 task 4 : Set X0 ON\n"); + else pc.printf("Device 1 task 4 : Set X0 OFF\n"); + command_length = 8; + //pc.printf("\nRead from device %d at %04x with length %04x\n",dev_Addr,Hold_Reg,Reg_len); + mdb_Command_buffer[0]=(uint8_t) 0x01; + mdb_Command_buffer[1]=(uint8_t) 0x05; + mdb_Command_buffer[2]=(uint8_t) 0x05; + mdb_Command_buffer[3]=(uint8_t) 0x00; + if(D1_X0==0)mdb_Command_buffer[4]=(uint8_t) 0xFF; + else mdb_Command_buffer[4]=(uint8_t) 0x00; + mdb_Command_buffer[5]=(uint8_t) 0x00; + RTU_CRC=mdbRTU_CRC(mdb_Command_buffer,6); + hi_RTU_CRC = (uint8_t)((RTU_CRC & 0xFF00) >> 8); + lo_RTU_CRC = (uint8_t)(RTU_CRC & 0x00FF); mdb_Command_buffer[6]=lo_RTU_CRC; mdb_Command_buffer[7]=hi_RTU_CRC; + break; + case 5: + dev_Addr = 1; + pc.printf("Device 1 task 4 : Read Y0 \n"); + command_length = 8; + //pc.printf("\nRead from device %d at %04x with length %04x\n",dev_Addr,Hold_Reg,Reg_len); + mdb_Command_buffer[0]=(uint8_t) 0x01; + mdb_Command_buffer[1]=(uint8_t) 0x02; + mdb_Command_buffer[2]=(uint8_t) 0x04; + mdb_Command_buffer[3]=(uint8_t) 0x00; + mdb_Command_buffer[4]=(uint8_t) 0x00; + mdb_Command_buffer[5]=(uint8_t) 0x08; + RTU_CRC=mdbRTU_CRC(mdb_Command_buffer,6); + hi_RTU_CRC = (uint8_t)((RTU_CRC & 0xFF00) >> 8); + lo_RTU_CRC = (uint8_t)(RTU_CRC & 0x00FF); + mdb_Command_buffer[6]=lo_RTU_CRC; + mdb_Command_buffer[7]=hi_RTU_CRC; + break; + + case 6: + dev_Addr = 2; + pc.printf("Device 2 : Voltage \n"); + command_length = 8; + //pc.printf("\nRead from device %d at %04x with length %04x\n",dev_Addr,Hold_Reg,Reg_len); + mdb_Command_buffer[0]=(uint8_t) 0x02; + mdb_Command_buffer[1]=(uint8_t) 0x03; + mdb_Command_buffer[2]=(uint8_t) 0x01; + mdb_Command_buffer[3]=(uint8_t) 0x06; + mdb_Command_buffer[4]=(uint8_t) 0x00; + mdb_Command_buffer[5]=(uint8_t) 0x02; + RTU_CRC=mdbRTU_CRC(mdb_Command_buffer,6); + hi_RTU_CRC = (uint8_t)((RTU_CRC & 0xFF00) >> 8); + lo_RTU_CRC = (uint8_t)(RTU_CRC & 0x00FF); + mdb_Command_buffer[6]=lo_RTU_CRC; + mdb_Command_buffer[7]=hi_RTU_CRC; + break; + + case 7: + dev_Addr = 3; + if(D3_X0==0)pc.printf("Device 3 : Set X0 ON\n"); + else pc.printf("Device 3 : Set X0 OFF\n"); + command_length = 8; + //pc.printf("\nRead from device %d at %04x with length %04x\n",dev_Addr,Hold_Reg,Reg_len); + mdb_Command_buffer[0]=(uint8_t) 0x03; + mdb_Command_buffer[1]=(uint8_t) 0x05; + mdb_Command_buffer[2]=(uint8_t) 0x05; + mdb_Command_buffer[3]=(uint8_t) 0x00; + if(D3_X0==0)mdb_Command_buffer[4]=(uint8_t) 0xFF; + else mdb_Command_buffer[4]=(uint8_t) 0x00; + mdb_Command_buffer[5]=(uint8_t) 0x00; + RTU_CRC=mdbRTU_CRC(mdb_Command_buffer,6); + hi_RTU_CRC = (uint8_t)((RTU_CRC & 0xFF00) >> 8); + lo_RTU_CRC = (uint8_t)(RTU_CRC & 0x00FF); + mdb_Command_buffer[6]=lo_RTU_CRC; + mdb_Command_buffer[7]=hi_RTU_CRC; + break; + + case 8: + dev_Addr = 3; + pc.printf("Device 3 : Read Y0 \n"); + command_length = 8; + //pc.printf("\nRead from device %d at %04x with length %04x\n",dev_Addr,Hold_Reg,Reg_len); + mdb_Command_buffer[0]=(uint8_t) 0x03; + mdb_Command_buffer[1]=(uint8_t) 0x02; + mdb_Command_buffer[2]=(uint8_t) 0x04; + mdb_Command_buffer[3]=(uint8_t) 0x00; + mdb_Command_buffer[4]=(uint8_t) 0x00; + mdb_Command_buffer[5]=(uint8_t) 0x08; + RTU_CRC=mdbRTU_CRC(mdb_Command_buffer,6); + hi_RTU_CRC = (uint8_t)((RTU_CRC & 0xFF00) >> 8); + lo_RTU_CRC = (uint8_t)(RTU_CRC & 0x00FF); + mdb_Command_buffer[6]=lo_RTU_CRC; + mdb_Command_buffer[7]=hi_RTU_CRC; + break; + + case 9: + dev_Addr = 5; + pc.printf("Device 5 : Read Temperature \n"); + command_length = 8; + //pc.printf("\nRead from device %d at %04x with length %04x\n",dev_Addr,Hold_Reg,Reg_len); + mdb_Command_buffer[0]=(uint8_t) 0x05; + mdb_Command_buffer[1]=(uint8_t) 0x03; + mdb_Command_buffer[2]=(uint8_t) 0x10; + mdb_Command_buffer[3]=(uint8_t) 0x00; + mdb_Command_buffer[4]=(uint8_t) 0x00; + mdb_Command_buffer[5]=(uint8_t) 0x01; + RTU_CRC=mdbRTU_CRC(mdb_Command_buffer,6); + hi_RTU_CRC = (uint8_t)((RTU_CRC & 0xFF00) >> 8); + lo_RTU_CRC = (uint8_t)(RTU_CRC & 0x00FF); + mdb_Command_buffer[6]=lo_RTU_CRC; + mdb_Command_buffer[7]=hi_RTU_CRC; + break; + + default: + command_length = 0; + pc.printf("there is no action in mdb_ctrol"); + break; + } + + // put command_buffer to modbus DE_RE=1; + int byte_of_buffer; - for (byte_of_buffer=0 ; byte_of_buffer<Max_Byte ; byte_of_buffer++) + for (byte_of_buffer=0 ; byte_of_buffer<command_length ; byte_of_buffer++) { modbus.putc(mdb_Command_buffer[byte_of_buffer]); } @@ -103,28 +266,239 @@ wait_ms(2); message_in_byte=0; DE_RE =0 ; - wait(1); - mdb_Data[(dev_Addr)].Addr=dev_Addr; - pc.printf("device_ID=%d\r\n", dev_Addr); + wait_ms(80); int data_len=(int)(mdb_Message_buffer[2]); RTU_CRC=mdbRTU_CRC(mdb_Message_buffer,data_len+3); - //pc.printf("RTU_CRC=%04x\r\n",RTU_CRC); hi_RTU_CRC = (uint8_t)((RTU_CRC & 0xFF00) >> 8); lo_RTU_CRC = (uint8_t)(RTU_CRC & 0x00FF); - if ((mdb_Message_buffer[data_len+3]==lo_RTU_CRC)&&(mdb_Message_buffer[data_len+4]==hi_RTU_CRC)) { for (int i=0 ; i<data_len ; i++) { mdb_Data[(dev_Addr)].Data[i]=mdb_Message_buffer[i+3]; - //pc.putc(mdb_Message_buffer[i]); pc.printf("mdb_Data= %02x\r\n",mdb_Data[(dev_Addr)].Data[i]); - // evk.printf("mdb_Data= %02x\r\n",mdb_Data[(dev_Addr)].Data[i]); - - + char _buff[13]; + sprintf((char*)_buff,"mdb_Data= %02x",mdb_Data[(dev_Addr)].Data[i]); + char buff[4]; + sprintf((char*)buff,"%d,%02x",dev_Addr,mdb_Data[(dev_Addr)].Data[i]); + } } + } + + +//put PC input into modbus +void PC_callback() { + //modbus.putc(pc.getc()); + // char incomming_CMD; + /* while (pc.readable()){ + incomming_CMD+=pc.getc()-1; } + pc.printf("Received Command :%c\r\n", incomming_CMD);*/ + + // evk.putc(pc.getc()); + +/* if(pc.readable()){ + ch=pc.getc(); + at_cmd[index++]=ch; + } + at_cmd[index]='\x0'; + pc.printf(at_cmd);*/ + if(pc.readable()){ + char at_cmd[100]; + int index=0; + char ch; + do{ + ch=pc.getc(); + at_cmd[index++]=ch; + pc.printf(at_cmd); + }while(ch!='\n'); + + at_cmd[index]='\x0'; + pc.printf(at_cmd); + AT_publish(at_cmd); + + //pc.putc(pc.getc()); + } + +} + +void evk_callback() { + /* int counter=0; + char ch; + char evk_buff[300]; + while(evk.readable()){ + ch=at.getc(); + evk_buff[counter]=ch; + counter++; + } + evk_buff[counter]='\x0'; + if(strncmp(evk_buff,"AT+UUSORD",9)==1){ + + } + else pc.printf(evk_buff); */ + //pc.putc(evk.getc()); + //int callback_len=0; + //if(at.recv("AT+USORD=0,%d",&callback_len))pc.printf(&callback_len); +} + + +//put modbus reply into PC +void MODBUS_callback() { + //pc.putc(modbus.getc()); + mdb_Message_buffer[message_in_byte]=modbus.getc(); + message_in_byte++; + +} + +void AT_publish(char* s){ + if(at.send("AT+UMQTTC=2,0,0,\"nbiot/gw\",\"%s\"",s) + )pc.printf("Send \"%s\" to MQTT server\r\n",s); + else pc.printf("Send \"%s\" to Server Failed !\r\n",s); + at.flush(); + wait_ms(10); } + + + +int main() { + pc.baud(115200); + evk.baud(115200); + at.setTimeout(6000); + + + //evk.attach(&evk_callback); + pc.attach(&PC_callback); + modbus.attach(&MODBUS_callback); + + server_buff[2]=';'; + server_buff[4]=';'; + server_buff[11]=';'; + server_buff[13]=';'; + server_buff[20]=';'; + server_buff[22]=';'; + + + //=========TEST AT============= + if(at.send("AT")&& at.recv("AT")&&at.recv("OK")){ + pc.printf("AT OK\n"); + // evk.printf("AT OK"); + } + else pc.printf("AT NO OK\n"); + wait_ms(3000); + //========SET MQTT IP============ + if(at.send("AT+UMQTT=3,\"140.114.78.141\"") && at.recv("AT+UMQTT=3,\"140.114.78.141\"") && at.recv("+UMQTT: 3,1") && at.recv("OK")) pc.printf("Set IP OK\n"); + else pc.printf("IP NO OK\n"); + //========CONNECT TO MQTT SERVER======= + if(at.send("AT+UMQTTC=1") && at.recv("AT+UMQTTC=1") && at.recv("+UMQTTC: 1,1") && at.recv("OK") && at.recv("+UUMQTTC: 1,0"))pc.printf("Connected to MQTT Server\n"); + else pc.printf("Connect to Server failed !\n"); + //========SEND MESSAGE ============= + if(at.send("AT+UMQTTC=2,0,0,\"nbiot/gw\",\"HELLO Send From F466RE,466924700006098\"") + && at.recv("AT+UMQTTC=2,0,0,\"nbiot/gw\",\"HELLO Send From F466RE,466924700006098\"") + && at.recv("+UMQTTC: 2,1") + && at.recv("OK"))pc.printf("Send Hello to MQTT Server\r\n"); + else pc.printf("Send Message to Server Failed !\n"); + + while(1) { + for(int i=1;i<10;i++){ + mdb_control(i); + if(i==1){ + char buff[2]; + + sprintf((char*)buff,"%02x",mdb_Data[1].Data[0]); + pc.printf("%02x\r\n",mdb_Data[1].Data[0]); + server_buff[0]=buff[0]; + server_buff[1]=buff[1]; + } + + if(i==2){ + if(mdb_Data[1].Data[0]==0x02){ + server_buff[3]='0'; + pc.printf("Y3 OFF\r\n"); + } + else { + server_buff[3]='1'; + pc.printf("Y3 ON\r\n"); + } + } + + else if(i==3){ + uint16_t data = ((((uint16_t)(mdb_Data[1].Data[0]))<<8) | (uint16_t)(mdb_Data[1].Data[1])); + pc.printf("counter = %04X(hex) , %d(int)\r\n\n",data,data); + + char buff[6]; + + sprintf((char*)buff,"%6d",data); + server_buff[5]=buff[0]; + server_buff[6]=buff[1]; + server_buff[7]=buff[2]; + server_buff[8]=buff[3]; + server_buff[9]=buff[4]; + server_buff[10]=buff[5]; + } + else if(i==5){ + + if(mdb_Data[1].Data[0]==0x00){ + server_buff[12]='0'; + pc.printf("D1_Y0 OFF\r\n"); + } + else { + server_buff[12]='1'; + pc.printf("D1_Y0 ON\r\n"); + } + } + + else if(i==6){ + int voltage = (((uint32_t)(mdb_Data[2].Data[0]))<< 8) | (((uint32_t)(mdb_Data[2].Data[1]))) | (((uint32_t)(mdb_Data[2].Data[2]))<< 24) | (((uint32_t)(mdb_Data[2].Data[3]))<< 16); + float *pf=(float*)&voltage; + //printf("%f",*pf); + pc.printf("voltage = %08x(hex) %.2f(float)\r\n",voltage,*pf); + int a = *pf*100; + pc.printf("a = %d\r\n",a); + char buff[5]; + sprintf(buff,"%5d",a); + pc.printf("buff = %02x%02x%02x%02x%02x\r\n",buff[0],buff[1],buff[2],buff[3],buff[4]); + server_buff[14]=buff[0]; + server_buff[15]=buff[1]; + server_buff[16]=buff[2]; + server_buff[17]='.'; + server_buff[18]=buff[3]; + server_buff[19]=buff[4]; + } + if(i==8){ + + if(mdb_Data[3].Data[0]==0x00){ + server_buff[21]='0'; + pc.printf("D3 Y0 OFF\r\n"); + } + else { + server_buff[21]='1'; + pc.printf("D3 Y0 ON\r\n"); + } + + } + + else if(i==9){ + uint16_t temperature = ((((uint16_t)(mdb_Data[5].Data[0]))<<8) | (uint16_t)(mdb_Data[5].Data[1])); + pc.printf("temperature = %04x(hex),%d(int)\r\n",temperature,temperature); + + char buff[3]; + + sprintf(buff,"%3d",temperature); + server_buff[23]=buff[0]; + server_buff[24]=buff[1]; + server_buff[25]='.'; + server_buff[26]=buff[2]; + AT_publish(server_buff); + } + + + pc.printf("============\r\n"); + wait_ms(50); + + } + + + } } \ No newline at end of file