首先我们下载FreeModbus源码，然后放到自己的工程中，新建一个MODBUS_TCP和PORT_TCP文件夹，然后将相关文件复制到里面，如下图所示：
! r& u6 n, e! b2 }% X) t1 L

然后修改porttcp中的代码：
首先定义一个数组用于接收数据：

1. static UCHAR    aucTCPBuf[MB_TCP_BUF_SIZE];           //接收缓冲区

复制代码

4 c, p% Y8 \& M然后在xMBTCPPortInit中初始化socket连接，然后监听端口。

  \9 P& c/ v9 b9 c! ^

1. BOOL
   : B+ l* p4 O) e! o; W
2. xMBTCPPortInit( USHORT usTCPPort )
   
3. {
   4 p, B4 J# U% @/ |
4.     BOOL bOkay = FALSE;
   * w% ?: A( X$ s" h! E% f0 G) T7 [6 K
5. 
   
6.     // 侦听端口 Modbus-TCP 端口
   % Y0 T- U6 w  Y2 Y' i' s" P
7.         socket_init(SOCK_TCP_PORT,Sn_MR_TCP_TCP,local_tcp_port++,Sn_MR_ND_TCP);
   4 M' F2 l4 P9 M8 @( W& h7 J
8.         listen_tcp_socket(SOCK_TCP_PORT);
   ! S! A7 f; {8 B9 P
9. 
   6 X2 Y5 s. M) A; |  |
10.     bOkay = TRUE;
    
11.     return bOkay;
    
12. }

复制代码

然后在xMBTCPPortSendResponse函数中发送数据

1. BOOL
   
2. xMBTCPPortSendResponse(const UCHAR * pucMBTCPFrame, USHORT usTCPLength )
   
3. {
   
4.         send_tcp_socket_data(SOCK_TCP_PORT,(UCHAR*)pucMBTCPFrame,usTCPLength);        
   
5.     return TRUE;
   
6. }

复制代码

然后在xMBPortTCPPool执行接收和其他操作
. K8 E# Q$ b+ K; r' |
- O8 ~; D( \! G; z7 N7 u8 U! t- I

1. BOOL
   ) E3 e7 L0 F% d9 ]* S& Y! V
2. xMBPortTCPPool( void )
   
3. {  
   
4.         unsigned short int us_rlen;
   
5.         unsigned char i;
   
6.         i=get_tcp_socket_state(SOCK_TCP_PORT);
     x0 T: [/ e* Z8 M7 {
7. 
   & _4 f) ]5 ?; C3 c1 I
8.         if(i==SOCK_ESTABLISHED_TCP)
   8 T% P0 f: p9 u
9.         {
   8 ^# D  F) W( S' Z& o) W
10.                 if(get_tcp_socket_irq(SOCK_TCP_PORT) & Sn_IR_CON_TCP)                //查看中断有没有发生
    . ~4 o" T, t* D
11.                 {
    $ C, f- f4 u4 ]7 E6 j! ^
12.                         clear_tcp_socket_irq(SOCK_TCP_PORT, Sn_IR_CON_TCP);         /*清除接收中断标志位*/                                                         
    . Q: i  v1 N* s# q) Y
13.                 }
    ; G; o2 `6 R7 P+ M0 z
14.                 us_rlen=get_tcp_rx_buffer_size(SOCK_TCP_PORT);                                 //获取接收到的数据字节                                                   /*定义len为已接收数据的长度*/
    
15.                 if(us_rlen==0)                                                                                                //没有接收到数据
    ' O% N9 e% c/ T/ _$ y$ E  w
16.                         return FALSE;                                                                                        //返回
    3 t' T  [# r- i- O) S9 `5 l
17.                 else
    
18.                 {
    ' P  `/ i& r$ V8 w+ O
19.                         recv_tcp_socket_data(SOCK_TCP_PORT,aucTCPBuf,us_rlen);         //接收数据                                                                            /*接收来自Server的数据*/
    
20.                         printf("receive\r\n");
    2 n' @! ^, J, g5 f" v; u  t) T& o+ ^
21.                         usTCPBufLen=us_rlen;
    7 ~- ~) v0 e5 c0 N. R" c1 S" L
22.                 }
    1 y8 @" f/ \' T7 n+ O& y
23.                 ( void )xMBPortEventPost( EV_FRAME_RECEIVED );                        //发送已接收到新数据到Modbus-TCP状态机
    
24.         }
    0 G8 G4 B2 d; r3 W! O. q
25.         else if(i==SOCK_CLOSED_TCP)                                                                        //如果socket关闭
    7 z' R' \2 M8 J+ @* n9 d
26.         {
    
27.                 socket_init(SOCK_TCP_PORT,Sn_MR_TCP_TCP,local_tcp_port++,Sn_MR_ND_TCP);//重新初始化
    . ?1 i+ \) Y) ~) u7 e- p
28.         }
    . ~: A& F6 d+ j( y  J
29.         else if(i==SOCK_INIT_TCP)                                                                //如果socket初始化完毕，监听端口
    * a# Y. @0 b  S3 l2 g
30.         {
    
31.                 listen_tcp_socket(SOCK_TCP_PORT);
    
32.         }
    
33.         else if(i==SOCK_CLOSE_WAIT_TCP)                                                        //如果socket等待关闭，关闭socket连接
    
34.         {
    
35.                 close_tcp_socket(SOCK_TCP_PORT);
    
36.         }
    6 D+ W" p: T: \$ t
37. 
    $ W: X5 O- f  g& y# m7 J
38.         return TRUE;
    . N/ V$ R6 _: H" X% Y; n" w1 `$ V' J
39. }

复制代码

( i0 g) e" I( j% d/ ^7 K7 a0 T其次还要实现读线圈、写线圈、读离散输入、写保持寄存器、读保持寄存器、读输入寄存器等功能，如下：
: A3 J1 ?* {. \$ R$ }& {/ B# e

1. #define REG_INPUT_START       0x0001        //输入寄存器起始地址
   5 i2 n# k4 }& }" e: r& p
2. #define REG_INPUT_NREGS       8                        //输入寄存器数量
   
3. 
   ) \. L# \4 {& H" l
4. #define REG_HOLDING_START     0x0001        //保持寄存器起始地址
   
5. #define REG_HOLDING_NREGS     8                        //保持寄存器数量
   
6. 
   
7. #define REG_COILS_START       0x0001        //线圈起始地址
   3 l/ i/ }6 f1 o* [" t: q
8. #define REG_COILS_SIZE        16                        //线圈数量
   
9. 
   , r. b9 c- I2 d; x) e  U
10. #define REG_DISCRETE_START    0x0001        //开关寄存器其实地址
    9 ?: g. |# N$ s5 T
11. #define REG_DISCRETE_SIZE     16                        //开关寄存器数量
    , Y) K" g, T/ H8 e9 J( o
12. //输入寄存器内容
    
13. uint16_t usRegInputBuf[REG_INPUT_NREGS] = {0x1000,0x1001,0x1002,0x1003,0x1004,0x1005,0x1006,0x1007};
    . q2 h6 k$ n0 k9 F* M  ^  g% r
14. //保持寄存器内容               
    ' u# @  Y) Y4 m! B$ Y. v  ^
15. uint16_t usRegHoldingBuf[REG_HOLDING_NREGS] = {0x2000,0x2001,0x2002,0x2003,0x2004,0x2005,0x2006,0x2007};                                       
    
16. //线圈状态
    
17. uint8_t ucRegCoilsBuf[REG_COILS_SIZE] = {0x01,0x01,0x00,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00};
    
18. //离散寄存器内容
    
19. uint8_t ucRegDiscreteBuf[REG_DISCRETE_SIZE] = {0x01,0x01,0x00,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x01};
    
20. 
    ' N7 ~$ ^. U9 B# m
21. /****************************************************************************
    2 X, ~3 q3 \; _" t' Q5 c
22. * 名          称：eMBRegInputCB
    
23. * 功    能：读取输入寄存器，对应功能码是 04 eMBFuncReadInputRegister
    
24. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
    
25. *                                                usAddress: 寄存器地址
    
26. *                                                usNRegs: 要读取的寄存器个数
    
27. * 出口参数：
    
28. * 注          意：上位机发来的 帧格式是: SlaveAddr(1 Byte)+FuncCode(1 Byte)
    
29. *                                                                +StartAddrHiByte(1 Byte)+StartAddrLoByte(1 Byte)
    3 P: i8 \; D% v' n: g% T" d
30. *                                                                +LenAddrHiByte(1 Byte)+LenAddrLoByte(1 Byte)+
    1 p- B+ N" W  m' j# B" K
31. *                                                                +CRCAddrHiByte(1 Byte)+CRCAddrLoByte(1 Byte)
    + c" m1 e+ F3 E- T: d- I+ P
32. *                                                        3 区
    
33. ****************************************************************************/
    
34. eMBErrorCode
    * b, x% O1 a% w
35. eMBRegInputCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs )
    . {" K6 L$ @/ K. z
36. {
    0 m$ [9 x/ a6 W5 r5 J
37.     eMBErrorCode    eStatus = MB_ENOERR;
    7 `) }7 g$ ^5 B2 {7 g* h$ ^
38.     int             iRegIndex;
    & L+ I6 a! \( {" U6 X1 q
39. 
    + N7 n* ?8 u. S7 w8 g
40.     if( ( usAddress >= REG_INPUT_START )
    
41.         && ( usAddress + usNRegs <= REG_INPUT_START + REG_INPUT_NREGS ) )
    ; W2 @) e! {- h: P
42.     {
    4 b: E& J( t* F" B( R' `
43.         iRegIndex = ( int )( usAddress - REG_INPUT_START );
    - U9 C: F8 W" w# I+ E
44.         while( usNRegs > 0 )
    - k; y9 d! ^3 D. }
45.         {
    
46.             *pucRegBuffer++ = ( UCHAR )( usRegInputBuf[iRegIndex] >> 8 );
    . w! n: ?' O0 |, ~/ y; F
47.             *pucRegBuffer++ = ( UCHAR )( usRegInputBuf[iRegIndex] & 0xFF );
    
48.             iRegIndex++;
    
49.             usNRegs--;
    
50.         }
    
51.     }
    
52.     else
    / P% P, x7 K: N) |, }% m, t
53.     {
    
54.         eStatus = MB_ENOREG;
    9 h' m! B. T: A6 R. j- f1 z0 \9 \
55.     }
    # i7 H. F. Z7 Y* z9 w5 q1 N# ^
56. 
    3 B6 Y2 {. f9 p8 ~
57.     return eStatus;
    
58. }
    
59. 
    
60. /****************************************************************************
    0 {5 |9 }) d( g/ M9 N2 \( K, R* [
61. * 名          称：eMBRegHoldingCB
    
62. * 功    能：对应功能码有：06 写保持寄存器 eMBFuncWriteHoldingRegister
    + S$ d% p: O$ ?# B4 g
63. *                                                                                                        16 写多个保持寄存器 eMBFuncWriteMultipleHoldingRegister
    $ v5 z) f  m  C" L+ e' t, ~, o/ `+ @
64. *                                                                                                        03 读保持寄存器 eMBFuncReadHoldingRegister
    9 q1 n; z2 C+ P/ g+ S! e# I
65. *                                                                                                        23 读写多个保持寄存器 eMBFuncReadWriteMultipleHoldingRegister
    
66. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
    4 }+ c; Y8 @0 u' `2 ]
67. *                                                usAddress: 寄存器地址
    ! H3 B% w+ ~3 M. b3 b9 c
68. *                                                usNRegs: 要读写的寄存器个数
    % {9 w' c; O2 S. z/ q
69. *                                                eMode: 功能码
    . G* A. Y/ w, t( w( I) r  E
70. * 出口参数：
    
71. * 注          意：4 区
    
72. ****************************************************************************/
    , L/ N5 w# m* `1 b8 F  C- d$ |9 v
73. eMBErrorCode
    
74. eMBRegHoldingCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs, eMBRegisterMode eMode )
    % t3 C/ C6 h! U% I6 ?
75. {
    . e+ p* a: L8 Q9 A  C
76.         eMBErrorCode    eStatus = MB_ENOERR;
    ; S4 X7 f: y( a& X; O2 q
77.         int             iRegIndex;
    ) }  P3 A3 i6 [
78. 
    
79. 
    
80.         if((usAddress >= REG_HOLDING_START)&&\
    8 w" D5 O( T9 v
81.                 ((usAddress+usNRegs) <= (REG_HOLDING_START + REG_HOLDING_NREGS)))
    ) T3 x: T" S* ~9 A) ~! x  ~. d
82.         {
    4 q/ i" w8 `. W8 v1 m& m
83.                 iRegIndex = (int)(usAddress - REG_HOLDING_START);
    + n( P8 ^- b  C# V3 K% e
84.                 switch(eMode)
    
85.                 {                                       
    
86.                         case MB_REG_READ://读 MB_REG_READ = 0
    
87.                                 while(usNRegs > 0)
    
88.                                 {
    
89.                                         *pucRegBuffer++ = (u8)(usRegHoldingBuf[iRegIndex] >> 8);            
    8 W5 u6 S6 N' ^
90.                                         *pucRegBuffer++ = (u8)(usRegHoldingBuf[iRegIndex] & 0xFF);
    
91.                                         iRegIndex++;
    5 _* |# C4 T/ B- j8 H3 b
92.                                         usNRegs--;                                       
    
93.                                 }                           
    
94.                         break;
    
95.                         case MB_REG_WRITE://写 MB_REG_WRITE = 0
    3 b  L3 r) r, e& M( T* y- ?
96.                                 while(usNRegs > 0)
    ; e& A0 I7 o, M4 Z; F  ^6 I
97.                                 {         
    
98.                                         usRegHoldingBuf[iRegIndex] = *pucRegBuffer++ << 8;
    
99.                                         usRegHoldingBuf[iRegIndex] |= *pucRegBuffer++;
    0 H5 i" \, [5 w1 Z
100.                                         iRegIndex++;
     * g) S. U( o" b* V1 h/ g2 v& w
101.                                         usNRegs--;
       C2 P: F; l, Y/ }5 }% [9 b
102.                                 }
     $ }0 y  |' l" Q6 N
103.                         break;                                
     % `# p9 e& Y1 N0 \; L: P3 }: Y
104.                 }
     8 T! B5 L& a% g7 p# j
105.         }
     ) F# K/ A% }" c! C; `& \% T
106.         else//错误
     
107.         {
     
108.                 eStatus = MB_ENOREG;
     
109.         }        
     4 r1 ?4 D& A, q( z& W( j
110.         
     0 N0 q7 J* |: c* C4 P
111.         return eStatus;
     ) K4 z3 J" y; x
112. }
     
113. 
     
114. /****************************************************************************
     
115. * 名          称：eMBRegCoilsCB
     
116. * 功    能：对应功能码有：01 读线圈 eMBFuncReadCoils
     
117. *                                                  05 写线圈 eMBFuncWriteCoil
     
118. *                                                  15 写多个线圈 eMBFuncWriteMultipleCoils
     
119. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
     
120. *                                                usAddress: 线圈地址
     
121. *                                                usNCoils: 要读写的线圈个数
     + F) x3 E/ C/ N% `
122. *                                                eMode: 功能码
     
123. * 出口参数：
     
124. * 注          意：如继电器
     
125. *                                                0 区
     
126. ****************************************************************************/
     + Q/ ^3 G4 j4 u/ Z1 ?4 e: f2 {
127. eMBErrorCode
     
128. eMBRegCoilsCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNCoils, eMBRegisterMode eMode )
     
129. {
     
130.         eMBErrorCode    eStatus = MB_ENOERR;
     / B9 J7 I$ j" L$ j: m$ h: t/ _
131.         int             iRegIndex;
     9 B7 K) U, @' d
132.         u8 i;
     ) B3 a* C: S+ y- R; W% T
133.         USHORT readNumber=usNCoils;
     4 x, p; ~6 \* Z( Y2 Z0 n# A
134.         USHORT coilValue=0x0000;
     
135.         if((usAddress >= REG_COILS_START)&&\
     
136.         ((usAddress+usNCoils) <= (REG_COILS_START + REG_COILS_SIZE)))
     
137.         {
     8 D7 }( X5 p  [/ O0 L3 X
138.                 iRegIndex = (int)(usAddress + usNCoils-REG_COILS_START);
     * E6 W0 W; p8 O1 ^% H
139.                 switch(eMode)
     6 |2 {9 z$ l6 b- Z7 z2 \2 B
140.                 {                                       
     
141.                         case MB_REG_READ://读 MB_REG_READ = 0
     0 E5 A9 U7 A. k
142.                                 for(i=0;i<usNCoils;i++)
     # h; W& U# K0 D" k8 @2 B( d
143.                                 {
     & F- F) i" p( d- [' g, ]
144.                                         readNumber--;
     " x5 o! O5 u2 U* T" i* G0 Y& K8 x
145.                                         iRegIndex--;
     
146.                                         coilValue|=ucRegCoilsBuf[iRegIndex]<<readNumber;
     % _5 @3 |# I: C8 B0 G9 t0 w
147.                                 }
     ! M! \6 B4 \$ `) C! }$ c" f& |1 V( a
148.                                 if(usNCoils<=8)
     
149.                                 {
     
150.                                         * pucRegBuffer=coilValue;
     
151.                                 }
     - T- ]0 Q6 F% R3 `" |
152.                                 else
     4 q1 G8 {2 H* s: c& s
153.                                 {
     
154.                                         * pucRegBuffer++ = (coilValue)&0x00ff;
     : J. C$ C: b% J, s
155.                                         * pucRegBuffer++ = (coilValue>>8)&0x00ff;
     - W! D) C; q8 |
156.                                 }
     
157.                         break;                           
     / t9 _8 }: ~9 F1 d; Q8 u
158.                         case MB_REG_WRITE://写 MB_REG_WRITE = 1
     5 f& P: b1 C, k8 T( i
159.                                 while(usNCoils > 0)
     
160.                                 {         
     
161.                                         //                         usRegHoldingBuf[iRegIndex] = *pucRegBuffer++ << 8;
     0 c( k5 k7 l/ Y: X/ E7 Y
162.                                         //           usRegHoldingBuf[iRegIndex] |= *pucRegBuffer++;
     
163.                                                 iRegIndex++;
     ) Y. g( [  a" Q! R0 @  F; t
164.                                                 usNCoils--;
     
165.                                 }
     6 P) B+ f$ {9 U+ b, P$ Z  w% c/ E
166.                         break;
       Y* M& O- c  C6 \
167.                 }
     
168.         }
     
169.         else//错误
     
170.         {
     
171.                 eStatus = MB_ENOREG;
     4 r9 I0 c) \' n. Q8 y
172.         }        
     
173. 
     
174.         return eStatus;
     
175. }
     
176. /****************************************************************************
     6 x8 V4 n/ I$ P4 W0 V5 L, Z
177. * 名          称：eMBRegDiscreteCB
     
178. * 功    能：读取离散寄存器，对应功能码有：02 读离散寄存器 eMBFuncReadDiscreteInputs
     7 t; C1 E* }% I" M. q
179. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
     & V, _9 b+ X: F% U
180. *                                                usAddress: 寄存器地址
     + X- z$ t& O6 o  N
181. *                                                usNDiscrete: 要读取的寄存器个数
     
182. * 出口参数：
     
183. * 注          意：1 区
     
184. ****************************************************************************/
       ~6 f" b2 i3 X; r+ F8 g
185. eMBErrorCode
     
186. eMBRegDiscreteCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNDiscrete )
     
187. {
     1 j5 j3 }0 d2 o' e* h- z
188.         eMBErrorCode    eStatus = MB_ENOERR;
     
189.         int             iRegIndex;
     3 E: Z, r6 w1 T( L+ M
190.         u8 i;
     ' P8 y8 `- U! [. t3 A; t
191.         USHORT readNumber=usNDiscrete;
     
192.         USHORT coilValue=0x0000;
     
193.         iRegIndex = (int)(usAddress + usNDiscrete-REG_DISCRETE_START);
     
194.         if((usAddress >= REG_DISCRETE_START)&&\
     - k8 H4 X! J- h0 V8 `- V
195.         ((usAddress+usNDiscrete) <= (REG_DISCRETE_START + REG_DISCRETE_SIZE)))
     
196.         {
     2 K' X! x& I& o4 c- p7 [
197.                 for(i=0;i<usNDiscrete;i++)
     ' o5 H0 |* Q) W& E4 m" z0 t
198.                 {
     
199.                         readNumber--;
     
200.                         iRegIndex--;
     2 G9 j4 W) ?/ e# t; D3 r0 R" Z
201.                         coilValue|=ucRegDiscreteBuf[iRegIndex]<<readNumber;
     
202.                 }
     
203.                 if(usNDiscrete<=8)
     
204.                 {
     + @! r( C7 n* r! p# V  T- `: _$ j$ u
205.                         * pucRegBuffer=coilValue;
     * ]7 q( k3 L) ]; ?+ ^
206.                 }
     
207.                 else
     
208.                 {
     . p$ |0 T1 w% E* m& b
209.                         * pucRegBuffer++ = (coilValue)&0x00ff;
     8 l: p; b- f+ ~
210.                         * pucRegBuffer++ = (coilValue>>8)&0x00ff;
     
211.                 }
     
212.         }
     
213.         else
     
214.         {
     2 b5 ?6 D* E: X5 t1 b7 c+ k& `
215.                 eStatus = MB_ENOREG;
     1 A/ u) s5 _  S, e- s6 Y
216.         }
     
217.     return eStatus;
     
218. }
     
219. 
     
220. 
     ; ^6 V- c# p' `& w0 b, r
221. 
     
222. 
     

复制代码

% z5 B: q  }4 p5 H$ z, [
/ D, l8 P, P5 X) z