MODBUS通訊+C語言源代碼

1、/*/  /*函數(shù)名稱: strmcpy()                            *輸入?yún)?shù)：  共  個參數(shù)；  *輸出參數(shù)：  共  個參數(shù)；  *返回值：    *需儲存的參數(shù)： 共  個參數(shù)；      *功能介紹：            (1

2、)字符數(shù)組拷貝；                *修改日志：  *2006-3-6 17:07  Ver. 1.00          開始編寫；          完成；                                &#

3、160;     /*                                      */  /*/    void strmcpy(unsigned char dest, unsigned char src, int count)        int i;     

4、60;     for(i = 0; i < count; i +)                desti = srci;            desti = '0'      /*/      /*/  /*函數(shù)名稱: bitmcpy()              &#

5、160;             *輸入?yún)?shù)：  共  個參數(shù)；  *輸出參數(shù)：  共  個參數(shù)；  *返回值：    *需儲存的參數(shù)： 共  個參數(shù)；      *功能介紹：            (1)開關(guān)量數(shù)組拷貝；       *修改日志：  *2006-3-7 14:59  Ver. 1.

6、00          開始編寫；          完成；                                      /*                        &

7、#160;             */  /*/    void bitmcpy(int dest, int src, int count)        int i;            for(i = 0; i < count; i +)                desti = srci; 

8、60;         /*/      /*/  /*函數(shù)名稱: strmcmp()                            *輸入?yún)?shù)：  共  個參數(shù)；  *輸出參數(shù)：  共  個參數(shù)；  *返回值：    *需儲存的參數(shù)： 共  個參數(shù)；    &

9、#160; *功能介紹：            (1)字符數(shù)組比較；相同則返回0，不相同則返回1；                *修改日志：  *2006-3-6 17:41  Ver. 1.00          開始編寫；          完成；            &

10、#160;                         /*                                      */  /*/    int strmcmp(unsigned char str1, unsigned char str

11、2, int count)        int i;            for(i = 0; i < count; i +)                if(str1i != str2i)                        return 1;    &

12、#160;                         return 0;      /*/      /*/  /*函數(shù)名稱: Datamcmp()                            *輸入?yún)?shù)：  共  個參數(shù)； 

13、; *輸出參數(shù)：  共  個參數(shù)；  *返回值：    *需儲存的參數(shù)： 共  個參數(shù)；      *功能介紹：            (1)浮點數(shù)組比較；相同則返回0，不相同則返回1；                *修改日志：  *2006-3-6 18:05  Ver. 1.00        

14、0; 開始編寫；          完成；      *2006-3-9 13:52          加了一層括號，以前是錯誤的          if(!(data1i - data2i < 0.0001) && (data1i - data2i > -0.0001)                

15、0;                       /*                                      */  /*/    int Datamcmp(float data1, float data2, int count) 

16、60;     int i;            for(i = 0; i < count; i +)                if(!(data1i - data2i < 0.0001) && (data1i - data2i > -0.0001)                    

17、0;   return 1;                              return 0;      /*/    /*/  /*函數(shù)名稱: Bitmcmp()                            *輸入?yún)?/p>

18、數(shù)：  共  個參數(shù)；  *輸出參數(shù)：  共  個參數(shù)；  *返回值：    *需儲存的參數(shù)： 共  個參數(shù)；      *功能介紹：            (1)開關(guān)量數(shù)組比較；相同則返回0，不相同則返回1；                *修改日志：  *2006-3-6 18:10  Ver. 1.00 

19、;         開始編寫；          完成；                                      /*                          &

20、#160;           */  /*/    int Bitmcmp(int data1, int data2, int count)            int i;            for(i = 0; i < count; i +)                if(data1i != d

21、ata2i)                        return 1;                              return 0;      /*/      /*/  /*函數(shù)名稱: GetCRC16()   

22、                        *輸入?yún)?shù)：  共  個參數(shù)；  *輸出參數(shù)：  共  個參數(shù)；  *返回值：    *需儲存的參數(shù)： 共  個參數(shù)；      *功能介紹：            (1)CRC16校驗； 返回校驗碼；      

23、0;         *修改日志：  *2005-11-28 16:40    Ver. 1.00          開始編寫；          完成；                                      /*

24、60;                                     */  /*/    unsigned short GetCRC16(unsigned char *puchMsg, unsigned short usDataLen)            /* CRC 高位字節(jié)值表 */   

25、     unsigned char auchCRCHi256 =       0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,        0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,        0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,&#

26、160;       0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,        0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,        0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41,        0x00, 0xC1, 0

27、x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,        0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,        0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,        0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81

28、, 0x40,        0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,        0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,        0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,        0x80

29、, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40,        0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,        0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40,        0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0

30、x41, 0x01, 0xC0,        0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,        0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,        0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41,      &#

31、160; 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0,        0x80, 0x41, 0x00, 0xC1, 0x81, 0x40, 0x00, 0xC1, 0x81, 0x40,        0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0, 0x80, 0x41, 0x00, 0xC1,        0x81, 0x40, 0x00, 0xC1, 0x81, 0x40

32、, 0x01, 0xC0, 0x80, 0x41,        0x00, 0xC1, 0x81, 0x40, 0x01, 0xC0, 0x80, 0x41, 0x01, 0xC0,        0x80, 0x41, 0x00, 0xC1, 0x81, 0x40      ;              unsigned char auchCRCLo256 =       0x00,

33、 0xC0, 0xC1, 0x01, 0xC3, 0x03, 0x02, 0xC2, 0xC6, 0x06,        0x07, 0xC7, 0x05, 0xC5, 0xC4, 0x04, 0xCC, 0x0C, 0x0D, 0xCD,        0x0F, 0xCF, 0xCE, 0x0E, 0x0A, 0xCA, 0xCB, 0x0B, 0xC9, 0x09,        0x08, 0xC8, 0xD8, 0x18, 0x19, 0xD9, 0x1B, 0x

34、DB, 0xDA, 0x1A,        0x1E, 0xDE, 0xDF, 0x1F, 0xDD, 0x1D, 0x1C, 0xDC, 0x14, 0xD4,        0xD5, 0x15, 0xD7, 0x17, 0x16, 0xD6, 0xD2, 0x12, 0x13, 0xD3,        0x11, 0xD1, 0xD0, 0x10, 0xF0, 0x30, 0x31, 0xF1, 0x33, 0xF3,     

35、60; 0xF2, 0x32, 0x36, 0xF6, 0xF7, 0x37, 0xF5, 0x35, 0x34, 0xF4,        0x3C, 0xFC, 0xFD, 0x3D, 0xFF, 0x3F, 0x3E, 0xFE, 0xFA, 0x3A,        0x3B, 0xFB, 0x39, 0xF9, 0xF8, 0x38, 0x28, 0xE8, 0xE9, 0x29,        0xEB, 0x2B, 0x2A, 0xEA, 0xEE, 0x2E,

36、 0x2F, 0xEF, 0x2D, 0xED,        0xEC, 0x2C, 0xE4, 0x24, 0x25, 0xE5, 0x27, 0xE7, 0xE6, 0x26,        0x22, 0xE2, 0xE3, 0x23, 0xE1, 0x21, 0x20, 0xE0, 0xA0, 0x60,        0x61, 0xA1, 0x63, 0xA3, 0xA2, 0x62, 0x66, 0xA6, 0xA7, 0x67,    &

37、#160;   0xA5, 0x65, 0x64, 0xA4, 0x6C, 0xAC, 0xAD, 0x6D, 0xAF, 0x6F,        0x6E, 0xAE, 0xAA, 0x6A, 0x6B, 0xAB, 0x69, 0xA9, 0xA8, 0x68,        0x78, 0xB8, 0xB9, 0x79, 0xBB, 0x7B, 0x7A, 0xBA, 0xBE, 0x7E,        0x7F, 0xBF, 0x7D, 0xBD, 0x

38、BC, 0x7C, 0xB4, 0x74, 0x75, 0xB5,        0x77, 0xB7, 0xB6, 0x76, 0x72, 0xB2, 0xB3, 0x73, 0xB1, 0x71,        0x70, 0xB0, 0x50, 0x90, 0x91, 0x51, 0x93, 0x53, 0x52, 0x92,        0x96, 0x56, 0x57, 0x97, 0x55, 0x95, 0x94, 0x54, 0x9C, 0x5C, 

39、       0x5D, 0x9D, 0x5F, 0x9F, 0x9E, 0x5E, 0x5A, 0x9A, 0x9B, 0x5B,        0x99, 0x59, 0x58, 0x98, 0x88, 0x48, 0x49, 0x89, 0x4B, 0x8B,        0x8A, 0x4A, 0x4E, 0x8E, 0x8F, 0x4F, 0x8D, 0x4D, 0x4C, 0x8C,        0x44, 0x84, 0x85,

40、 0x45, 0x87, 0x47, 0x46, 0x86, 0x82, 0x42,        0x43, 0x83, 0x41, 0x81, 0x80, 0x40      ;            unsigned char uchCRCHi = 0xFF ; /* 高CRC字節(jié)初始化 */        unsigned char uchCRCLo = 0xFF ; /* 低CRC 字節(jié)初始化 */  &#

41、160;     unsigned uIndex = 0; /* CRC循環(huán)中的索引 */              while (usDataLen-) /* 傳輸消息緩沖區(qū) */                    uIndex = uchCRCHi *puchMsg+ ; /* 計算CRC */            uchCRCHi =

42、uchCRCLo auchCRCHiuIndex ;            uchCRCLo = auchCRCLouIndex ;                return (unsigned short)(unsigned short)uchCRCHi << 8 | uchCRCLo) ;        /*/      /*/  /*函數(shù)名稱: SendRt

43、uCmdToModBus()                              *輸入?yún)?shù)：  共  個參數(shù)；  *輸出參數(shù)：  共  個參數(shù)；  *返回值：  無  *需儲存的參數(shù)： 共  個參數(shù)；      *功能介紹：            (1)發(fā)送Mo

44、dBus RTU 指令到 Modbus Slave,加上CRC16校驗碼；                  *修改日志：  *2005-11-28 16:40    Ver. 1.00          開始編寫；          完成；  *2006-3-1 9:02          返回類型改為void；&#

45、160;                                     /*                                      */  /*/    void Sen

46、dRtuCmdToModBus(int ModPort, unsigned char cmd, unsigned short len)          unsigned short CRC16;            CRC16=GetCRC16(cmd,len);      ToComBufn(ModPort,cmd,len);      ToCom(ModPort, (unsigned char)(CRC16 >&

47、gt; 8 & 0x00FF);    /* send CRC16 high */      ToCom(ModPort, (unsigned char)(CRC16 & 0x00FF);    /* send CRC16 low */        /*/      /*/  /*函數(shù)名稱: ReadModBusRtuSlave()             

48、                *輸入?yún)?shù)：  共 8 個參數(shù)；  *輸出參數(shù)：  共 5 個參數(shù)；  *返回值：  成功與否    1：成功， 2：失??；  *需儲存的參數(shù)： 共 0 個參數(shù)；    *功能介紹：            (1)讀取ModBusRtuSlave，并解碼輸出反饋字符串相關(guān)內(nèi)容；       

49、;   ReadModBusRtuSlave(COMPORT1, ModAddr, ModFunction, ModByteNum,              ModData, &ModDataLen, ModTimeout=10, waitTime=30)        *修改日志：  *2005-11-28 16:40    Ver. 1.00          開始編寫； 

50、         完成；  *2006-3-1 9:23          增加了int counter = 0;          unsigned char ModBusMessageMOD_STR_MAX_LEN;    *2006-3-1 13:46                增加了 strmcpy(ModData, ModBusMes

51、sage + 3, ModBusIdx - 5);                                  /*                                      */  /*/  &#

52、160; int ReadModBusRtuSlave(int ModPort, unsigned char *ModAddr, unsigned char *ModFunction, unsigned char *ModByteNum,        unsigned char ModData, unsigned char *ModDataLen, unsigned ModTimeout, unsigned waitTime)            unsigned char data;

53、60;     unsigned long t;      int i;      unsigned short CRC16;      int ModBusIdx = 0;      int counter = 0;      unsigned char ModBusMessageMOD_STR_MAX_LEN = '0'            wh

54、ile(!(IsCom(ModPort) && (counter < waitTime)                DelayMs(1);          counter +;                  StopWatchStart(MODBUS_STOP_WATCH);      do   

55、             while(IsCom(ModPort) && (ModBusIdx < MOD_STR_MAX_LEN - 1)                            data = ReadCom(ModPort);                  ModB

56、usMessageModBusIdx +=data;                  StopWatchStart(MODBUS_STOP_WATCH);              /*    Print("%02X",data); */                    StopWatchR

57、eadValue(MODBUS_STOP_WATCH, &t);                while(t <= ModTimeout);                    if (ModBusIdx = 0) return 0;      ModBusMessageModBusIdx = '0'      StopWa

58、tchStop(MODBUS_STOP_WATCH);                          CRC16 = GetCRC16(ModBusMessage,ModBusIdx - 2);      /* for(i=0; i> 8 & 0x00FF) = ModBusMessageModBusIdx - 2 && (unsigned char)(CRC16 & 0x00FF) = Mod

59、BusMessageModBusIdx - 1)                *ModAddr = ModBusMessage0;          *ModFunction = ModBusMessage1;          *ModByteNum = ModBusMessage2;                  &#

60、160; strmcpy(ModData, ModBusMessage + 3, ModBusIdx - 5);      /*  Print(" idx%d  ", ModBusIdx - 5);  /*test*/          /*  for(i = 3; i < ModBusIdx - 2; i+)                    &

61、#160;   ModDatai - 3 = ModBusMessagei;                    ModDatai = '0'            */          *ModDataLen = ModBusIdx - 5;          /*  Print("Da

62、taLen=%dnr", *ModDataLen); */          return 1;            else                  *ModDataLen = 0;          return 0;          /* CRC16 error */&

63、#160;     /*  Print("CRC16 Errornr"); */                /*-*/      /*/  /*函數(shù)名稱: ResponseFromModBusRtuSlave()                              *輸

64、入?yún)?shù)：  共 8 個參數(shù)；  *輸出參數(shù)：  共 5 個參數(shù)；  *返回值：  成功與否    1：成功， 2：失??；  *需儲存的參數(shù)： 共 0 個參數(shù)；    *功能介紹：            (1)寫參數(shù)到ModBusRtuSlave后，ModbusRtuSlave反饋字符串；                    *修改日志：

65、  *2006-3-1 12:34  Ver. 1.00          開始編寫；  *2006-3-1 12:48                完成；  *2006-3-6 16:32          strcpy(totalStr, ModBusMessage);          改為 strmcpy(totalS

66、tr, ModBusMessage, ModBusIdx);                                      /*                                      */

67、  /*/    int ResponseFromModBusRtuSlave(int ModPort, unsigned char totalStr,        unsigned char *ModAddr, unsigned char *ModFunction, unsigned short *ModDataAddr,        unsigned short *ModDataNum, unsigned ModTimeout, unsigned waitTime) 

68、               unsigned char data;      unsigned long t;          unsigned short CRC16;          int ModBusIdx = 0;      int counter = 0;      unsigned char ModBusMessage

69、MOD_STR_MAX_LEN = '0'            while(!(IsCom(ModPort) && (counter < waitTime)                DelayMs(1);          counter +;                

70、0; StopWatchStart(MODBUS_STOP_WATCH);      do                while(IsCom(ModPort) && (ModBusIdx < MOD_STR_MAX_LEN - 1)                            data = ReadCom(Mod

71、Port);                  ModBusMessageModBusIdx +=data;                  StopWatchStart(MODBUS_STOP_WATCH);              /*    Print("%02X",data); */ 

72、                  StopWatchReadValue(MODBUS_STOP_WATCH, &t);                while(t <= ModTimeout);                    if (ModBusIdx = 0) return 0;  

73、0;   ModBusMessageModBusIdx = '0'      strmcpy(totalStr, ModBusMessage, ModBusIdx);      StopWatchStop(MODBUS_STOP_WATCH);                          CRC16 = GetCRC16(ModBusMessage,ModBusIdx - 2

74、);            if(unsigned char)(CRC16 >> 8 & 0x00FF) = ModBusMessageModBusIdx - 2 && (unsigned char)(CRC16 & 0x00FF) = ModBusMessageModBusIdx - 1)                *ModAddr = ModBusMessage0;     

75、     *ModFunction = ModBusMessage1;                    *ModDataAddr = (unsigned short)(unsigned short)ModBusMessage2 << 8 | ModBusMessage3);          *ModDataNum  = (unsigned short)(unsigned short)ModBusM

76、essage4 << 8 | ModBusMessage5);                                return 1;            else                  return 0;     

77、60;   /* CRC16 error */      /*  Print("CRC16 Errornr"); */                /*-*/      /*/  /*函數(shù)名稱: ResponseSingleBitFromModBus()                     

78、      *輸入?yún)?shù)：  共 8 個參數(shù)；  *輸出參數(shù)：  共 5 個參數(shù)；  *返回值：  成功與否    1：成功， 2：失??；  *需儲存的參數(shù)： 共 0 個參數(shù)；    *功能介紹：            (1)寫參數(shù)到ModBusRtuSlave后，ModbusRtuSlave反饋字符串；              

79、0;     *修改日志：  *2006-3-7 14:40  Ver. 1.00          開始編寫；  *2006-3-7 14:40                完成；                                 

80、         /*                                      */  /*/    int ResponseSingleBitFromModBus(int ModPort, unsigned char totalStr,        unsigned char

81、*ModAddr, unsigned char *ModFunction, unsigned short *ModDataAddr,        unsigned short *ModDataState, unsigned ModTimeout, unsigned waitTime)                unsigned char data;      unsigned long t;      

82、0;   unsigned short CRC16;          int ModBusIdx = 0;      int counter = 0;      unsigned char ModBusMessageMOD_STR_MAX_LEN = '0'            while(!(IsCom(ModPort) && (counter < waitTime)

83、60;               DelayMs(1);          counter +;                  StopWatchStart(MODBUS_STOP_WATCH);      do                while(IsCom(Mod

84、Port) && (ModBusIdx < MOD_STR_MAX_LEN - 1)                            data = ReadCom(ModPort);                  ModBusMessageModBusIdx +=data;        

85、0;         StopWatchStart(MODBUS_STOP_WATCH);              /*    Print("%02X",data); */                    StopWatchReadValue(MODBUS_STOP_WATCH, &t);      &

86、#160;         while(t <= ModTimeout);                    if (ModBusIdx = 0) return 0;      ModBusMessageModBusIdx = '0'      strmcpy(totalStr, ModBusMessage, ModBusIdx);      StopWatchStop(MODBUS_STOP_WATCH);                          CRC16 = GetCRC16(ModBusMessage,ModBusIdx - 2);            if(unsigned char)(CRC16 >> 8 & 0x00FF) = ModBusMessageModBusIdx