首先将FreeModbus移植到自己工程中，如下图所示：
3 o$ R. c9 ^. ~6 M( Y
- h( N& r. k$ h- N% j/ ^
5 A3 c2 ^8 \* {" l4 s* }然后修改portserial.c和porttimer.c文件：
# i9 E6 h1 S. ~4 aportserial.c

1. /*
   # y6 h! F/ A% A: [0 V
2. * FreeModbus Libary: BARE Port
   & C* _9 o! V/ r$ W; d8 q9 X
3. * Copyright (C) 2006 Christian Walter
   
4. *
   
5. * This library is free software; you can redistribute it and/or
   6 z9 k! w- \2 x/ K
6. * modify it under the terms of the GNU Lesser General Public
   
7. * License as published by the Free Software Foundation; either
   
8. * version 2.1 of the License, or (at your option) any later version.
   - ?: S3 g: c  x& w7 G. \
9. *
   7 n9 n: T; d# f
10. * This library is distributed in the hope that it will be useful,
    
11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
    
12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
    
13. * Lesser General Public License for more details.
    
14. *
    6 N0 P7 @6 ~/ F. F# G& v
15. * You should have received a copy of the GNU Lesser General Public
    + c. c$ P% a# X; g( b6 `, v$ f9 W
16. * License along with this library; if not, write to the Free Software
    
17. * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
    8 q$ O3 S; F( b- F5 X( y/ y
18. *
    ' J2 b# D: E9 B( k
19. * File: $Id: portserial.c,v 1.1 2006/08/22 21:35:13 wolti Exp $
    
20. */
    
21. 
      y  c" ^4 p3 }
22. #include "port.h"
    
23. #include "stm32f10x.h"
    
24. #include "modbus.h"
    9 s$ i- H! y5 ~, e: x
25. /* ----------------------- Modbus includes ----------------------------------*/
    
26. #include "mb.h"
    9 d9 F5 C2 ]; c( y
27. #include "mbport.h"
    ) B. |6 R$ G# C8 p0 h0 p
28. 
    
29. /* ----------------------- static functions ---------------------------------*/
    
30. static void prvvUARTTxReadyISR( void );
    
31. static void prvvUARTRxISR( void );
    
32. 
    
33. /* ----------------------- Start implementation -----------------------------*/
    
34. void
    
35. vMBPortSerialEnable( BOOL xRxEnable, BOOL xTxEnable )
    % ?  X. R' z( O2 Z, R+ N9 Z  h
36. {
    
37.     /* If xRXEnable enable serial receive interrupts. If xTxENable enable
    
38.      * transmitter empty interrupts.
    
39.      */
    
40.         if(xRxEnable == TRUE)
    
41.         {
    $ k. |# f8 R4 H# s; w
42.                 USART_ITConfig(USART2, USART_IT_RXNE, ENABLE);
    
43.         }
    
44.         else
    2 f+ m  H6 H$ B9 W8 _& q) x
45.         {
    
46.                 USART_ITConfig(USART2, USART_IT_RXNE, DISABLE);
    0 p5 Y$ l; w+ U- U4 [9 `; Q/ Y
47.         }
    
48.         
    
49.         if(xTxEnable == TRUE)
    ; p0 ~* x2 D; m- ~9 T$ ?
50.         {
    
51.                 USART_ITConfig(USART2, USART_IT_TC, ENABLE);
    
52.         }
    
53.         else
    
54.         {
    
55.                 USART_ITConfig(USART2, USART_IT_TC, DISABLE);
    
56.         }
    
57. }
    & @9 \. q$ h( ~5 c( U2 j) s
58. 
    
59. BOOL
    9 U/ {- y' Z/ d7 i0 M
60. xMBPortSerialInit( UCHAR ucPORT, ULONG ulBaudRate, UCHAR ucDataBits, eMBParity eParity )
    
61. {
    
62.         modbus_uart_init((uint16_t)ulBaudRate);  
    " [; z) u- R- z8 N1 o3 u4 v0 A
63. 
    # Z! T0 Q. _" y
64.         return TRUE;
    ' p" S5 D* E5 ~& y& \0 ~
65. }
    
66. 
      u$ Z+ }7 w: k  G3 j& i8 S, |: p* J
67. BOOL
    / M4 U; K4 M# V& `3 y. @
68. xMBPortSerialPutByte( CHAR ucByte )
    
69. {
    9 m% G( ]9 n) _4 N+ g0 H" Y$ |& O
70.     /* Put a byte in the UARTs transmit buffer. This function is called
    
71.      * by the protocol stack if pxMBFrameCBTransmitterEmpty( ) has been
    1 F7 k2 ]/ A1 Z1 y
72.      * called. */
    
73.         
    ) n% _- f) Q) ?8 P3 J, I* F& G) J$ c
74.         USART_SendData(USART2, ucByte);
    6 O( |$ Y) D4 v1 H
75.     return TRUE;
    
76. }
    
77. 
    
78. BOOL
    * j; d6 b3 e- A2 X8 R! ]% n
79. xMBPortSerialGetByte( CHAR * pucByte )
    
80. {
      ]- W  i- u( L7 _7 i, K; i
81.     /* Return the byte in the UARTs receive buffer. This function is called
    
82.      * by the protocol stack after pxMBFrameCBByteReceived( ) has been called.
    
83.      */
    
84.   *pucByte = USART_ReceiveData(USART2);
    
85.         return TRUE;
    - w8 a1 ?$ u2 S7 l4 Q
86. }
    ' K! i  a  e$ d$ O9 }; T# p
87. 
    
88. /* Create an interrupt handler for the transmit buffer empty interrupt
    " U9 h, l' k+ M5 [' A  H, x. M# b
89. * (or an equivalent) for your target processor. This function should then
    / [& ]3 a/ _7 \; ~& `. a3 e& V4 {
90. * call pxMBFrameCBTransmitterEmpty( ) which tells the protocol stack that
    
91. * a new character can be sent. The protocol stack will then call
    ( q0 Z) n+ @! U+ o
92. * xMBPortSerialPutByte( ) to send the character.
    
93. */
    5 S8 I0 H+ @% r' l, f% v9 X7 X
94. static void prvvUARTTxReadyISR( void )
    
95. {
    
96.     pxMBFrameCBTransmitterEmpty(  );
    9 ?# W+ `) a/ a# `- M+ K
97. }
    
98. 
    1 G) k" ^8 v! T+ f. Y! @
99. /* Create an interrupt handler for the receive interrupt for your target
    
100. * processor. This function should then call pxMBFrameCBByteReceived( ). The
     . H4 A- g- {" L. l/ W
101. * protocol stack will then call xMBPortSerialGetByte( ) to retrieve the
     
102. * character.
     ! D& S6 ^: y5 l" P+ K/ }3 u* G
103. */
     
104. static void prvvUARTRxISR( void )
     : `  s2 i$ _# I; ?; {5 B
105. {
     
106.     pxMBFrameCBByteReceived(  );
     
107. }
     
108. 
     
109. /**
     
110.   * @brief  This function handles usart1 Handler.
     
111.   * @param  None
     
112.   * @retval None
     
113.   */
     - R& x4 ?& C* `2 i* z# R8 j
114. void USART2_IRQHandler(void)
     % H2 v& F' j% c) Y4 y. K% O9 z
115. {
     ' R  D* k/ p! Q; p" A
116.         //发生接收中断
     . c1 d3 {3 s1 t( S* Y9 I# _7 \
117.         if(USART_GetITStatus(USART2, USART_IT_RXNE) == SET)
     ( D6 E2 F5 Y1 r9 E3 ]3 Y$ G) T
118.         {
     
119.                 prvvUARTRxISR();
     
120.                 //清除中断标志位   
     
121.                 USART_ClearITPendingBit(USART2, USART_IT_RXNE);   
     3 P8 M- g4 W% H9 ]4 o4 V+ |
122.         }
     
123. 
     9 O+ g- \2 c! _9 G
124.         if(USART_GetITStatus(USART2, USART_IT_ORE) == SET)
     
125.         {  
     
126.                 USART_ClearITPendingBit(USART2, USART_IT_ORE);
     
127.                 prvvUARTRxISR();         
     1 A: `- l' {  O$ E
128.         }
     0 K1 N# Y0 q1 K2 e2 T
129. 
     4 u. n4 o4 {( }' \
130.         //发生完成中断
     : J1 X. z  l+ z" W# L; Z' Z; R9 ~
131.         if(USART_GetITStatus(USART2, USART_IT_TC) == SET)
     
132.         {
     
133.                 prvvUARTTxReadyISR();
     
134.                 //清除中断标志
     $ |' D+ ~/ n1 t) I& O% d9 A  g
135.                 USART_ClearITPendingBit(USART2, USART_IT_TC);
     
136.         }
     
137. }
     

复制代码

. M& Z( M5 ^5 [7 N+ c/ D+ Eporttimer.c

1. 
   
2. ```c
   
3. /*
   
4. * FreeModbus Libary: BARE Port
   9 v! K/ {) H+ I
5. * Copyright (C) 2006 Christian Walter <<a href="mailto:wolti@sil.at">wolti@sil.at</a>>
   
6. *
   8 M$ X4 n7 c# U; e
7. * This library is free software; you can redistribute it and/or
   * A6 W! k8 [% F: v" n* s
8. * modify it under the terms of the GNU Lesser General Public
   $ ?2 E7 l! F$ A) d  e; Q
9. * License as published by the Free Software Foundation; either
   : E# |0 m" W( f. G* {7 V* g& z
10. * version 2.1 of the License, or (at your option) any later version.
    ! N) B4 B8 d% Z0 L7 V  n& ~3 q
11. *
    
12. * This library is distributed in the hope that it will be useful,
    9 c: M; s: s" k
13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
    
14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
    
15. * Lesser General Public License for more details.
    
16. *
    
17. * You should have received a copy of the GNU Lesser General Public
    3 ^9 K' H. y8 C! [4 s- h, V, e
18. * License along with this library; if not, write to the Free Software
    
19. * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
    
20. *
    
21. * File: $Id: porttimer.c,v 1.1 2006/08/22 21:35:13 wolti Exp $
    0 F1 P6 k  X, n9 H" L( ?. ~
22. */
    
23. 
    
24. /* ----------------------- Platform includes --------------------------------*/
    
25. #include "port.h"
    
26. #include "modbus.h"
    
27. /* ----------------------- Modbus includes ----------------------------------*/
    ! H; F# `; [- Z
28. #include "mb.h"
    
29. #include "mbport.h"
    
30. 
    
31. /* ----------------------- static functions ---------------------------------*/
    
32. static void prvvTIMERExpiredISR( void );
    9 u- E: H  n  _! v% d6 |7 D
33. 
    , @6 q9 ]% H. g+ d  R, s% e4 ^
34. /* ----------------------- Start implementation -----------------------------*/
    
35. BOOL
    
36. xMBPortTimersInit( USHORT usTim1Timerout50us )
    + f5 h) ~* Y+ l$ y  h+ G  z
37. {
    9 p' g: Z& i6 x+ U$ D) U+ q8 Y
38.         modbus_timer_init(usTim1Timerout50us);
    
39. 
    " K* s5 ^+ Z3 n7 X: F$ R7 I
40.         return TRUE;
    
41. }
    
42. 
    5 n% @2 ^0 B6 E7 R3 L
43. 
    
44. void
    
45. vMBPortTimersEnable(  )
    
46. {
    0 x0 f# M7 l# y
47.     /* Enable the timer with the timeout passed to xMBPortTimersInit( ) */
    
48.         TIM_ClearITPendingBit(TIM3, TIM_IT_Update);
    
49.         TIM_ITConfig(TIM3, TIM_IT_Update, ENABLE);
    - v5 W; F/ p/ T0 r6 ^
50.         TIM_SetCounter(TIM3,0x0000);
    
51.         TIM_Cmd(TIM3, ENABLE);
    : Z- \& e9 `( E- f. F; i! V, L
52. }
    3 M3 L& [1 M# K3 w
53. 
    1 D; k2 v# `# a
54. void
    
55. vMBPortTimersDisable(  )
    - B8 Q$ N1 h1 J: [6 f: X9 m4 G
56. {
    
57.     /* Disable any pending timers. */
    
58.   TIM_ClearITPendingBit(TIM3, TIM_IT_Update);
    
59.   TIM_ITConfig(TIM3, TIM_IT_Update, DISABLE);
    , M; D/ W5 E" S: l0 q
60.   TIM_SetCounter(TIM3,0x0000);
    & |5 J  \# F" F- ^. w& `, w  a
61.   TIM_Cmd(TIM3, DISABLE);
    2 I, x. f+ d" @6 U: C
62. }
    
63. 
    5 G( \, H# D  G" I  c
64. /* Create an ISR which is called whenever the timer has expired. This function
    # Z8 M: W2 @4 x; B2 S* S
65. * must then call pxMBPortCBTimerExpired( ) to notify the protocol stack that
    1 U. U* X8 ]" Y: a! U2 P
66. * the timer has expired.
    
67. */
    ; S5 v7 c- C5 w/ w4 Y
68. static void prvvTIMERExpiredISR( void )
    
69. {
    
70.     ( void )pxMBPortCBTimerExpired(  );
    
71. }
    1 x: q% `, P1 Z% y1 s
72. 
    
73. void TIM3_IRQHandler(void)
    9 y" @9 i( r: l9 @7 i+ @* t
74. {
    
75.         if(TIM_GetITStatus(TIM3, TIM_IT_Update) != RESET)
    4 z! s/ ]4 f+ j& h. b
76.         {
    " \5 b) K) U* c" L6 a  y+ W
77.                 prvvTIMERExpiredISR();
    2 ?2 }. Z. c; `1 i7 t
78.                 TIM_ClearITPendingBit(TIM3, TIM_IT_Update);
    
79.         }
    5 ~( V% |; p5 P- t# X9 j* C/ y* y
80. }

复制代码

4 |( V; _$ q9 D然后主函数中调用

1. 
   5 e) r7 |( f% h% U) g  p
2. int main(void)
   2 r  _' ]6 t6 Z; d3 v( ^  A
3. {               
   7 g7 j( O4 w4 C
4.         delay_init();                     //延时函数初始化         
   9 r5 z% ^5 J) s+ N; v# a+ C
5.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //设置NVIC中断分组2:2位抢占优先级，2位响应优先级
   4 ?% Q, h# O  x' G# h& G) N
6.         uart_init(115200);
   
7.         eMBInit(MB_RTU, 0x01, 0x01, 9600, MB_PAR_NONE);
   4 o9 T" f+ x) F$ f
8.         eMBEnable();  
   
9.          while(1)
   
10.         {
      r5 e/ [. a: ^; I( M& t1 m! ?
11.                 (void)eMBPoll();
    
12.                 delay_ms(5);
    0 I6 `; `. V1 F% d, l
13.                
    
14.         }         
    3 k6 O1 _% N% m1 X2 L1 l
15. }

复制代码

6 L; ]- f. f5 P, _7 ?4 }其次还要实现读线圈、写线圈、读离散输入、写保持寄存器、读保持寄存器、读输入寄存器等功能，如下：
7 t7 i+ A! ?7 K! L* B6 a% Q0 l
. n1 S0 D. E7 a

1. #define REG_INPUT_START       0x0001        //输入寄存器起始地址
   
2. #define REG_INPUT_NREGS       8                        //输入寄存器数量
   4 O* l5 ^" \/ K3 G* l
3. 
   
4. #define REG_HOLDING_START     0x0001        //保持寄存器起始地址
   + N2 n. _% X9 d' M4 x# D, x# e
5. #define REG_HOLDING_NREGS     8                        //保持寄存器数量
   ; w" B* ?' B) F5 q9 P  P
6. 
   
7. #define REG_COILS_START       0x0001        //线圈起始地址
   
8. #define REG_COILS_SIZE        16                        //线圈数量
   
9. 
   2 ^& a# T1 p% b) g( L  E% q
10. #define REG_DISCRETE_START    0x0001        //开关寄存器其实地址
    
11. #define REG_DISCRETE_SIZE     16                        //开关寄存器数量
    
12. //输入寄存器内容
    
13. uint16_t usRegInputBuf[REG_INPUT_NREGS] = {0x1000,0x1001,0x1002,0x1003,0x1004,0x1005,0x1006,0x1007};
    
14. //保持寄存器内容               
    
15. uint16_t usRegHoldingBuf[REG_HOLDING_NREGS] = {0x2000,0x2001,0x2002,0x2003,0x2004,0x2005,0x2006,0x2007};                                       
    2 B' f; ~( x) U# y0 |
16. //线圈状态
    
17. uint8_t ucRegCoilsBuf[REG_COILS_SIZE] = {0x01,0x01,0x00,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00};
    9 N# c9 E- q  C% Z
18. //离散寄存器内容
    9 p5 l, ~0 O6 `2 n7 j. S
19. uint8_t ucRegDiscreteBuf[REG_DISCRETE_SIZE] = {0x01,0x01,0x00,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x01};
    
20. 
    * ]9 y0 k8 S" ]
21. /****************************************************************************
    
22. * 名          称：eMBRegInputCB
    
23. * 功    能：读取输入寄存器，对应功能码是 04 eMBFuncReadInputRegister
    
24. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
    
25. *                                                usAddress: 寄存器地址
    / g' g' T# k- \# M9 d
26. *                                                usNRegs: 要读取的寄存器个数
    - q9 q& `* t  Q$ }$ s. H# G8 z$ Z8 G  j
27. * 出口参数：
    
28. * 注          意：上位机发来的 帧格式是: SlaveAddr(1 Byte)+FuncCode(1 Byte)
    
29. *                                                                +StartAddrHiByte(1 Byte)+StartAddrLoByte(1 Byte)
    / t9 Q( z7 z1 }& ]( y+ t, J
30. *                                                                +LenAddrHiByte(1 Byte)+LenAddrLoByte(1 Byte)+
    5 N  r; m6 m5 [7 V
31. *                                                                +CRCAddrHiByte(1 Byte)+CRCAddrLoByte(1 Byte)
    * Y* \/ H  N, P  E: |. [! W" m0 v
32. *                                                        3 区
    " x6 m8 [; f; z: \/ v
33. ****************************************************************************/
    5 Y  k$ K6 [$ D. q1 y, M
34. eMBErrorCode
    
35. eMBRegInputCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs )
    / p& g" l% P1 K* y4 ~5 T
36. {
    
37.     eMBErrorCode    eStatus = MB_ENOERR;
    4 ?" I9 \, `( t/ K% z0 o
38.     int             iRegIndex;
    0 j: L% y$ I- E+ ~  q2 m  g( `
39. 
    
40.     if( ( usAddress >= REG_INPUT_START )
    : c+ T& l) E+ `  c' G6 \
41.         && ( usAddress + usNRegs <= REG_INPUT_START + REG_INPUT_NREGS ) )
    
42.     {
    8 n2 W/ ~4 f; S, ~6 g9 N
43.         iRegIndex = ( int )( usAddress - REG_INPUT_START );
    4 g% Y, w8 @' ~* T9 y8 b& y8 S* l& I
44.         while( usNRegs > 0 )
    + @8 G  ]. j7 c( t5 f
45.         {
    
46.             *pucRegBuffer++ = ( UCHAR )( usRegInputBuf[iRegIndex] >> 8 );
    
47.             *pucRegBuffer++ = ( UCHAR )( usRegInputBuf[iRegIndex] & 0xFF );
    $ W9 r; C9 @  `
48.             iRegIndex++;
    
49.             usNRegs--;
    
50.         }
    7 q. _( K' j3 Z% [9 f0 C! G1 B/ ^
51.     }
    , w! h0 `$ t: h8 i+ U# ?
52.     else
    0 p1 W% N8 q! G% X4 N+ X5 ?
53.     {
    
54.         eStatus = MB_ENOREG;
    " d+ q: Y* ?( d/ d$ _5 Z& B
55.     }
    & I7 `& P3 n0 o$ W( [( O
56. 
    ; u  s, ?( d2 y$ j4 L
57.     return eStatus;
    
58. }
    + I* T2 x- I9 r8 D6 Q/ j
59. 
    3 n, Y9 d) r- r& D/ ?7 v5 h
60. /****************************************************************************
    
61. * 名          称：eMBRegHoldingCB
    0 G% q8 a1 a/ o4 J2 j% ?
62. * 功    能：对应功能码有：06 写保持寄存器 eMBFuncWriteHoldingRegister
    & ]8 ^! }8 h0 v2 g7 g! M  t* K7 [
63. *                                                                                                        16 写多个保持寄存器 eMBFuncWriteMultipleHoldingRegister
    * K9 v# C9 k2 d) f3 M
64. *                                                                                                        03 读保持寄存器 eMBFuncReadHoldingRegister
    
65. *                                                                                                        23 读写多个保持寄存器 eMBFuncReadWriteMultipleHoldingRegister
    . o6 n& O8 R7 w/ {% k2 Q
66. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
    : [: L1 b& g9 H5 }6 i
67. *                                                usAddress: 寄存器地址
    
68. *                                                usNRegs: 要读写的寄存器个数
    6 ]6 `7 K) ]' k# a: _
69. *                                                eMode: 功能码
    
70. * 出口参数：
    8 x" E. c- Z- `) a' m
71. * 注          意：4 区
    
72. ****************************************************************************/
    
73. eMBErrorCode
    
74. eMBRegHoldingCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs, eMBRegisterMode eMode )
    
75. {
    
76.         eMBErrorCode    eStatus = MB_ENOERR;
    
77.         int             iRegIndex;
    
78. 
    / c: a) G* w5 }1 p
79. 
    
80.         if((usAddress >= REG_HOLDING_START)&&\
    % \1 }1 B" Z% L2 b  K% W
81.                 ((usAddress+usNRegs) <= (REG_HOLDING_START + REG_HOLDING_NREGS)))
    8 e$ i$ ~9 p5 S; z* d5 v
82.         {
    
83.                 iRegIndex = (int)(usAddress - REG_HOLDING_START);
    
84.                 switch(eMode)
    
85.                 {                                       
    
86.                         case MB_REG_READ://读 MB_REG_READ = 0
      ?* [; ~9 |" c' M1 m4 N' t
87.                                 while(usNRegs > 0)
    ) ]$ D4 a. G* X
88.                                 {
    * F0 P6 F/ I) l: ?) j6 D8 X
89.                                         *pucRegBuffer++ = (u8)(usRegHoldingBuf[iRegIndex] >> 8);            
    " h4 Z9 T3 ?7 k' u; g8 j. @
90.                                         *pucRegBuffer++ = (u8)(usRegHoldingBuf[iRegIndex] & 0xFF);
    
91.                                         iRegIndex++;
    . e+ P9 o# K, n5 ]$ Z8 i9 [# i# i
92.                                         usNRegs--;                                       
    
93.                                 }                           
    5 v2 Q. X& f; W8 K. `3 h4 @
94.                         break;
    
95.                         case MB_REG_WRITE://写 MB_REG_WRITE = 0
    6 N# L1 R* n6 b( w& m' M5 x+ c
96.                                 while(usNRegs > 0)
    6 H# W: Q" R# X) i1 L, b' P. W
97.                                 {         
    
98.                                         usRegHoldingBuf[iRegIndex] = *pucRegBuffer++ << 8;
    
99.                                         usRegHoldingBuf[iRegIndex] |= *pucRegBuffer++;
    
100.                                         iRegIndex++;
     % [( h9 x; i- t% A0 [( ^, x$ L
101.                                         usNRegs--;
     
102.                                 }
     5 E9 V8 E' K/ m6 w7 @' W( l6 L8 f
103.                         break;                                
     
104.                 }
     
105.         }
     
106.         else//错误
     ( y  I. r4 G/ R; h/ f. X* o( _
107.         {
     
108.                 eStatus = MB_ENOREG;
     
109.         }        
     * n, Q9 F$ i$ F# H
110.         
     * X7 E; M! t, l" O# m- e
111.         return eStatus;
     
112. }
     
113. 
     
114. /****************************************************************************
     ( t  f5 f8 v! J' d3 ]' g9 s/ d
115. * 名          称：eMBRegCoilsCB
     
116. * 功    能：对应功能码有：01 读线圈 eMBFuncReadCoils
     3 o" X9 }1 y2 |& f
117. *                                                  05 写线圈 eMBFuncWriteCoil
     
118. *                                                  15 写多个线圈 eMBFuncWriteMultipleCoils
     ' P% l; ]# X9 X/ r; Z
119. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
     4 e/ _$ P! Y  c# N$ M( k' t
120. *                                                usAddress: 线圈地址
     
121. *                                                usNCoils: 要读写的线圈个数
     
122. *                                                eMode: 功能码
     , V4 s1 U+ {# z1 \/ A* W% L* q3 S
123. * 出口参数：
     ' u, {6 F( v* Z* _+ r* y0 f! t/ i
124. * 注          意：如继电器
     ; E- Y3 r& @/ t# ]9 F
125. *                                                0 区
     
126. ****************************************************************************/
     6 D" Z, v9 q% L* M- e( a
127. eMBErrorCode
     # [2 E* v  _8 \3 z9 N
128. eMBRegCoilsCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNCoils, eMBRegisterMode eMode )
     
129. {
     # P; b, u$ C( A
130.         eMBErrorCode    eStatus = MB_ENOERR;
     
131.         int             iRegIndex;
     
132.         u8 i;
     9 U2 P4 i3 M/ u8 O- X" D! `
133.         USHORT readNumber=usNCoils;
     9 _3 D, x8 X# ?3 T& W
134.         USHORT coilValue=0x0000;
     8 [- U9 f0 Y0 K& ?8 y8 Z1 R
135.         if((usAddress >= REG_COILS_START)&&\
     " _# |1 @; _+ m3 |3 R
136.         ((usAddress+usNCoils) <= (REG_COILS_START + REG_COILS_SIZE)))
     
137.         {
     
138.                 iRegIndex = (int)(usAddress + usNCoils-REG_COILS_START);
     $ E8 T' G6 P  u0 P* e2 ]/ N9 C
139.                 switch(eMode)
     
140.                 {                                       
     9 k9 ]8 L' ]- n
141.                         case MB_REG_READ://读 MB_REG_READ = 0
     " c; _4 {2 r+ E7 u4 a
142.                                 for(i=0;i<usNCoils;i++)
     
143.                                 {
     / K5 d! M9 f# r2 X9 N( h4 P( H! ^
144.                                         readNumber--;
     
145.                                         iRegIndex--;
     
146.                                         coilValue|=ucRegCoilsBuf[iRegIndex]<<readNumber;
     % ^/ w% F7 l5 r" z- K# h- ?
147.                                 }
     / n3 b, M& m1 n! I5 S
148.                                 if(usNCoils<=8)
     " q4 K- N& i: `
149.                                 {
     7 d2 H! a; A6 K
150.                                         * pucRegBuffer=coilValue;
     ) R/ D" ~9 k5 ~  L! y( Y
151.                                 }
     
152.                                 else
     / L& e2 J4 W3 k: A  J( W
153.                                 {
     
154.                                         * pucRegBuffer++ = (coilValue)&0x00ff;
     
155.                                         * pucRegBuffer++ = (coilValue>>8)&0x00ff;
     ! r& f) Q, a$ c: w! y( R# a9 ?; ^
156.                                 }
     
157.                         break;                           
     
158.                         case MB_REG_WRITE://写 MB_REG_WRITE = 1
     9 o) a9 r6 u) C$ g
159.                                 while(usNCoils > 0)
     
160.                                 {         
     # M! B; V3 O. Q) U6 B
161.                                         //                         usRegHoldingBuf[iRegIndex] = *pucRegBuffer++ << 8;
     3 I( f# L8 g' |
162.                                         //           usRegHoldingBuf[iRegIndex] |= *pucRegBuffer++;
     
163.                                                 iRegIndex++;
     $ f8 _) n+ p1 F  u9 K' P+ p" U
164.                                                 usNCoils--;
     ' q; h1 M5 a% I
165.                                 }
     0 y8 j4 ^3 q* C8 I
166.                         break;
     
167.                 }
     
168.         }
     ) j6 m4 f( W; p, ~# m
169.         else//错误
     - K4 N3 Y3 c' `1 g3 H. [; F% T
170.         {
     : ^' W; H% d7 p5 J) O
171.                 eStatus = MB_ENOREG;
     
172.         }        
     * P& G: a2 }2 I7 ?) k* v
173. 
     
174.         return eStatus;
     . i& R! ^4 v( P4 I6 l0 g  ^
175. }
     
176. /****************************************************************************
     
177. * 名          称：eMBRegDiscreteCB
     
178. * 功    能：读取离散寄存器，对应功能码有：02 读离散寄存器 eMBFuncReadDiscreteInputs
     : j) B3 p% W. p2 n% h
179. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
     
180. *                                                usAddress: 寄存器地址
     
181. *                                                usNDiscrete: 要读取的寄存器个数
     - |4 n6 H5 [6 r
182. * 出口参数：
     * ?# N0 Z; y6 n8 |& A& D/ _8 {
183. * 注          意：1 区
     
184. ****************************************************************************/
     
185. eMBErrorCode
     
186. eMBRegDiscreteCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNDiscrete )
     ( q7 p1 `$ E* v! j2 j8 x- }
187. {
     . Q, y6 a, [+ x/ E+ q" n3 J
188.         eMBErrorCode    eStatus = MB_ENOERR;
     
189.         int             iRegIndex;
     
190.         u8 i;
     
191.         USHORT readNumber=usNDiscrete;
     
192.         USHORT coilValue=0x0000;
     / ^# v/ V# `! E' C5 a- h/ k; m7 m
193.         iRegIndex = (int)(usAddress + usNDiscrete-REG_DISCRETE_START);
     6 x2 j1 m7 D* S: j- r# _% W
194.         if((usAddress >= REG_DISCRETE_START)&&\
     5 J& U6 q: ]- h
195.         ((usAddress+usNDiscrete) <= (REG_DISCRETE_START + REG_DISCRETE_SIZE)))
     
196.         {
     
197.                 for(i=0;i<usNDiscrete;i++)
     
198.                 {
     ! [" g0 X% n6 D  ?! U
199.                         readNumber--;
     ) _5 v, F. H! y4 v  S! Q* v9 Z
200.                         iRegIndex--;
     - q/ \5 C6 c; Z2 F' h' o
201.                         coilValue|=ucRegDiscreteBuf[iRegIndex]<<readNumber;
     / t  Q- a5 d% O! }: ~! b4 |; P
202.                 }
     
203.                 if(usNDiscrete<=8)
     
204.                 {
     
205.                         * pucRegBuffer=coilValue;
     
206.                 }
     
207.                 else
       `/ o, p- V2 R; k6 ]8 {; x
208.                 {
     9 N7 N  I) c- M) c! f
209.                         * pucRegBuffer++ = (coilValue)&0x00ff;
     2 V& ^$ [2 v5 a9 f
210.                         * pucRegBuffer++ = (coilValue>>8)&0x00ff;
     9 ?7 e- ^( [4 A# b
211.                 }
     
212.         }
     
213.         else
     4 e, x/ R# @/ C/ o9 v5 @, m$ y# H
214.         {
     
215.                 eStatus = MB_ENOREG;
     
216.         }
     
217.     return eStatus;
     ( W5 W' M. f; @- Y
218. }
     
219. 
     
220. 
     
221. 
     6 T& \2 a' J5 u) W- c7 L! D
222. 
     

复制代码

+ Q1 D) @5 j/ ]8 N% D& C
# @4 c" w9 x7 {* X' S