首先将FreeModbus移植到自己工程中，如下图所示：

1 y' w9 A, I: Y* k1 k. S4 |. L: W
然后修改portserial.c和porttimer.c文件：
portserial.c
; {% e# f3 b% a7 |* O

1. /*
   # W2 p* C; K# m& P4 t
2. * FreeModbus Libary: BARE Port
   
3. * Copyright (C) 2006 Christian Walter
   
4. *
   + [  u" Y9 s/ u5 W: W/ B" Y: ~5 g* p' Y+ k
5. * This library is free software; you can redistribute it and/or
   1 ~" H$ Q& [. D4 {/ ?  u/ `
6. * modify it under the terms of the GNU Lesser General Public
   
7. * License as published by the Free Software Foundation; either
   1 }( ~8 T3 w+ Q# x
8. * version 2.1 of the License, or (at your option) any later version.
   
9. *
   
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
    1 b  \6 F, o8 U/ d
13. * Lesser General Public License for more details.
    
14. *
    
15. * You should have received a copy of the GNU Lesser General Public
    
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
    
18. *
    
19. * File: $Id: portserial.c,v 1.1 2006/08/22 21:35:13 wolti Exp $
    
20. */
    
21. 
    ' v  W8 q/ \) f# e8 G" l& ]3 ^, U
22. #include "port.h"
    
23. #include "stm32f10x.h"
    . Y* C. }, C+ N0 ?. }
24. #include "modbus.h"
    9 e9 g! a4 H% b8 D$ T) b# J- U" L- o
25. /* ----------------------- Modbus includes ----------------------------------*/
    
26. #include "mb.h"
    
27. #include "mbport.h"
    
28. 
    
29. /* ----------------------- static functions ---------------------------------*/
    
30. static void prvvUARTTxReadyISR( void );
    
31. static void prvvUARTRxISR( void );
    
32. 
    - `. o3 U7 I/ ^, K7 l* E
33. /* ----------------------- Start implementation -----------------------------*/
      _0 I+ @1 p; e- A, j+ B
34. void
    2 h% n' r* U/ A8 b( `5 U. o+ y
35. vMBPortSerialEnable( BOOL xRxEnable, BOOL xTxEnable )
    
36. {
    + b" J/ X% l( g, z) e
37.     /* If xRXEnable enable serial receive interrupts. If xTxENable enable
    : s) y4 e. O0 `# j. p* A; X! |, }
38.      * transmitter empty interrupts.
    
39.      */
    
40.         if(xRxEnable == TRUE)
    
41.         {
    & W+ J9 K0 q( V- t* N+ x
42.                 USART_ITConfig(USART2, USART_IT_RXNE, ENABLE);
    
43.         }
    . a+ p1 k: @  q
44.         else
    
45.         {
    
46.                 USART_ITConfig(USART2, USART_IT_RXNE, DISABLE);
    
47.         }
    . H! P6 `* n. b% i; k! ?
48.         
    ; G) T! M2 \. {7 S4 |& J
49.         if(xTxEnable == TRUE)
    8 z& {/ j& r0 s+ I  }. Y
50.         {
    
51.                 USART_ITConfig(USART2, USART_IT_TC, ENABLE);
    ! y6 R  M6 q3 O
52.         }
    
53.         else
    
54.         {
    
55.                 USART_ITConfig(USART2, USART_IT_TC, DISABLE);
    + a' U3 |$ t% w7 P  _
56.         }
    2 U4 }% s0 q9 R1 i
57. }
    % F$ b; P5 V0 M
58. 
    
59. BOOL
    
60. xMBPortSerialInit( UCHAR ucPORT, ULONG ulBaudRate, UCHAR ucDataBits, eMBParity eParity )
    
61. {
    
62.         modbus_uart_init((uint16_t)ulBaudRate);  
    
63. 
    
64.         return TRUE;
    
65. }
    
66. 
    
67. BOOL
    
68. xMBPortSerialPutByte( CHAR ucByte )
    & T- m" I' u7 h7 {( ~* V1 M
69. {
    & I/ w+ o) T4 B$ H
70.     /* Put a byte in the UARTs transmit buffer. This function is called
    
71.      * by the protocol stack if pxMBFrameCBTransmitterEmpty( ) has been
    0 N% O, |9 ~  ]4 i8 G) A
72.      * called. */
    ) X% E5 m. Q1 X7 `
73.         
    
74.         USART_SendData(USART2, ucByte);
    0 I$ m8 R4 J0 e# u- {
75.     return TRUE;
    ! `) [/ Y% p. n) }, x
76. }
    0 L4 ~6 z! r( x& g6 [6 y- l
77. 
    
78. BOOL
    
79. xMBPortSerialGetByte( CHAR * pucByte )
    - x" M* N! F' b- ?
80. {
    6 I6 s; w3 J$ w' T4 \
81.     /* Return the byte in the UARTs receive buffer. This function is called
    
82.      * by the protocol stack after pxMBFrameCBByteReceived( ) has been called.
    ; V" ]- ]0 u- `1 s+ g
83.      */
    
84.   *pucByte = USART_ReceiveData(USART2);
    
85.         return TRUE;
    
86. }
    
87. 
    
88. /* Create an interrupt handler for the transmit buffer empty interrupt
    0 A6 K9 R3 S) T1 t0 q
89. * (or an equivalent) for your target processor. This function should then
    
90. * call pxMBFrameCBTransmitterEmpty( ) which tells the protocol stack that
    
91. * a new character can be sent. The protocol stack will then call
    $ t/ J8 g  W8 p
92. * xMBPortSerialPutByte( ) to send the character.
    
93. */
    # r0 L& X% u- m- ]1 s/ P5 z& {
94. static void prvvUARTTxReadyISR( void )
    
95. {
    ( R( \& \7 I  h$ O. y% n
96.     pxMBFrameCBTransmitterEmpty(  );
    . Y' F. }( R8 q* R: Q& d1 H
97. }
    / g$ E1 p  m  V
98. 
    % c' a! [) e) v+ j0 R
99. /* Create an interrupt handler for the receive interrupt for your target
    ) n( [& [& B7 D* e7 ?/ Q+ p
100. * processor. This function should then call pxMBFrameCBByteReceived( ). The
     " B. l3 Z+ v% @! W2 o$ E, h( y
101. * protocol stack will then call xMBPortSerialGetByte( ) to retrieve the
     
102. * character.
       O8 ~9 j+ E( I3 f6 X) I1 _
103. */
     / H8 B9 X$ O& V  Y3 v! ?# e
104. static void prvvUARTRxISR( void )
     
105. {
     4 Q& g: d$ Z9 P1 Q6 |7 H
106.     pxMBFrameCBByteReceived(  );
     8 t* ?$ S' O* R4 s! M$ f$ H
107. }
     4 J. _: T$ G( G. c$ F
108. 
     
109. /**
     - k: {6 a6 I, q. T- Z) T* h
110.   * @brief  This function handles usart1 Handler.
     
111.   * @param  None
     * U8 b$ R4 }' z* i7 [* q! J  v
112.   * @retval None
     5 i) p9 b' U' @' o% Y- F
113.   */
     
114. void USART2_IRQHandler(void)
     " n; H* l3 T& w  C1 J
115. {
     9 _. m+ `2 w6 V
116.         //发生接收中断
     3 Z0 y+ C- e& r, {* d: S
117.         if(USART_GetITStatus(USART2, USART_IT_RXNE) == SET)
     
118.         {
     - ^. P+ [4 Y/ t8 N( d# W% U% ^
119.                 prvvUARTRxISR();
     
120.                 //清除中断标志位   
     5 v6 J- o! a" ~. q2 I0 a
121.                 USART_ClearITPendingBit(USART2, USART_IT_RXNE);   
     
122.         }
     
123. 
     
124.         if(USART_GetITStatus(USART2, USART_IT_ORE) == SET)
     , ^7 i* F+ A6 p
125.         {  
     $ V* F4 J3 [( r& A
126.                 USART_ClearITPendingBit(USART2, USART_IT_ORE);
     
127.                 prvvUARTRxISR();         
       r% J/ D2 K  ~. v+ Z
128.         }
     1 g& d/ O  m- L: A  f
129. 
     6 d5 Q3 n8 k$ c' {: N! t. x
130.         //发生完成中断
     * Z4 j& }8 h0 [$ T+ K* S& C- w: a
131.         if(USART_GetITStatus(USART2, USART_IT_TC) == SET)
     ; E3 c9 |! @/ `2 Y4 [
132.         {
     
133.                 prvvUARTTxReadyISR();
     
134.                 //清除中断标志
     
135.                 USART_ClearITPendingBit(USART2, USART_IT_TC);
     
136.         }
     
137. }
     

复制代码

porttimer.c
# [3 n2 A) L( R8 C
5 O6 A4 D2 l2 X$ v$ U5 z: d; P

1. 
   
2. ```c
   - F2 u! X. C' b2 F
3. /*
   ( G4 S' K6 R' }1 J
4. * FreeModbus Libary: BARE Port
   
5. * Copyright (C) 2006 Christian Walter <<a href="mailto:wolti@sil.at">wolti@sil.at</a>>
   1 T- b# V2 ~! j, ~
6. *
   
7. * This library is free software; you can redistribute it and/or
   
8. * modify it under the terms of the GNU Lesser General Public
   * a. u0 ~$ B# I, C
9. * License as published by the Free Software Foundation; either
   . R& y+ }% I9 p
10. * version 2.1 of the License, or (at your option) any later version.
    ) n* H8 d$ ]) v" W: d  C5 Z
11. *
    # |# W* s0 D. x8 _
12. * This library is distributed in the hope that it will be useful,
    8 F) [* ~  i/ d' j7 T$ z- W
13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
    5 l# y, T1 C% M
14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
    ' }7 U- T. T, |5 E
15. * Lesser General Public License for more details.
    
16. *
    
17. * You should have received a copy of the GNU Lesser General Public
    ( Q' R  E" L' q# s7 n0 K5 ^
18. * License along with this library; if not, write to the Free Software
    8 @& @5 f, i3 U8 _
19. * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
    
20. *
    ' \1 g5 s# h9 |( _
21. * File: $Id: porttimer.c,v 1.1 2006/08/22 21:35:13 wolti Exp $
    8 k2 E8 I$ L) _4 ^
22. */
    
23. 
    : x0 @. Z) \7 o4 K6 u
24. /* ----------------------- Platform includes --------------------------------*/
    
25. #include "port.h"
    
26. #include "modbus.h"
    + }) Q* @2 u3 q9 c. q
27. /* ----------------------- Modbus includes ----------------------------------*/
    + E1 P: W; P( X! i  }& a# ]
28. #include "mb.h"
    
29. #include "mbport.h"
    
30. 
    
31. /* ----------------------- static functions ---------------------------------*/
    
32. static void prvvTIMERExpiredISR( void );
    2 c! s) M5 w7 p+ b7 W5 ?/ ^, v" l
33. 
    
34. /* ----------------------- Start implementation -----------------------------*/
    * H$ e0 f' R) g3 o" ]; y  s
35. BOOL
    4 m# S3 A5 X( e0 N, E
36. xMBPortTimersInit( USHORT usTim1Timerout50us )
    
37. {
    
38.         modbus_timer_init(usTim1Timerout50us);
    
39. 
    ' t, l& f+ k! L( g3 m# o1 Z- |
40.         return TRUE;
    - @6 i' r0 r" ~( z3 z* e, L
41. }
    7 d& O4 W  ]* }4 a* Q0 j
42. 
    
43. 
    
44. void
    : G4 J4 I! d) p. T/ B6 ~
45. vMBPortTimersEnable(  )
    - i+ D1 K9 S0 B1 x; l1 F
46. {
    0 N4 I' w5 S5 {$ A/ N9 i
47.     /* Enable the timer with the timeout passed to xMBPortTimersInit( ) */
    4 P, A8 y9 S0 ~' K* F$ r2 L; U
48.         TIM_ClearITPendingBit(TIM3, TIM_IT_Update);
    / S; i9 k4 l1 s9 ?- [2 `5 ^9 f
49.         TIM_ITConfig(TIM3, TIM_IT_Update, ENABLE);
    
50.         TIM_SetCounter(TIM3,0x0000);
    ) C& K, U" n/ `# y/ o4 p! T
51.         TIM_Cmd(TIM3, ENABLE);
    
52. }
    : `# ^5 s! b+ U  k
53. 
    
54. void
    
55. vMBPortTimersDisable(  )
    % L4 i# _( B  ?" I- A
56. {
    2 p, {$ z1 i$ d+ V3 N1 i
57.     /* Disable any pending timers. */
    $ M/ @, @1 m( O8 z
58.   TIM_ClearITPendingBit(TIM3, TIM_IT_Update);
    8 z& Y  E2 X9 w7 _% f
59.   TIM_ITConfig(TIM3, TIM_IT_Update, DISABLE);
    . ?# N7 J/ I" d
60.   TIM_SetCounter(TIM3,0x0000);
    , o# C1 a1 y/ {! Y# C$ {
61.   TIM_Cmd(TIM3, DISABLE);
    
62. }
    + Y1 z) |% L" y
63. 
    
64. /* Create an ISR which is called whenever the timer has expired. This function
    
65. * must then call pxMBPortCBTimerExpired( ) to notify the protocol stack that
    
66. * the timer has expired.
    2 d% X) a$ N0 v1 r$ a2 z
67. */
    8 k4 v1 ?4 S7 S! f7 Q
68. static void prvvTIMERExpiredISR( void )
    ) Z+ f/ M' f( Y9 F! |
69. {
    - x* z+ Z; J! \* Y$ k* Z9 I. t- \  g
70.     ( void )pxMBPortCBTimerExpired(  );
    6 s) U# s2 E4 J5 Z$ S$ E* J3 k
71. }
    
72. 
    
73. void TIM3_IRQHandler(void)
    * m) i! R7 ?+ s0 G5 h  M& D
74. {
    
75.         if(TIM_GetITStatus(TIM3, TIM_IT_Update) != RESET)
    - |( X2 X5 B5 {  u
76.         {
    
77.                 prvvTIMERExpiredISR();
    
78.                 TIM_ClearITPendingBit(TIM3, TIM_IT_Update);
    * i8 s1 L7 `- H* Q0 ^8 w( U
79.         }
    2 z& |8 s3 ?2 J' j% z
80. }

复制代码

然后主函数中调用

1. 
   : Y: L7 J; L' B0 y! N( u" H
2. int main(void)
   $ z4 m1 d' @' m$ C
3. {               
   ) D5 M( z0 w  N3 l3 M  L
4.         delay_init();                     //延时函数初始化         
   3 T4 \# r# ~# H" ~
5.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //设置NVIC中断分组2:2位抢占优先级，2位响应优先级
   / {) x* e6 Y$ X9 }& ^* N
6.         uart_init(115200);
   1 Q4 R3 Y' q/ T3 f
7.         eMBInit(MB_RTU, 0x01, 0x01, 9600, MB_PAR_NONE);
   ! D% A+ K7 D' w: t, h- A
8.         eMBEnable();  
   6 M9 B; u; F0 Y% h# p4 p1 O" t
9.          while(1)
     d1 w$ T6 q* t
10.         {
    4 \/ J" A2 j% p& d# W! h
11.                 (void)eMBPoll();
    + x3 {# O3 @4 l& n$ s0 t. _
12.                 delay_ms(5);
    ; |# ^+ f1 O1 d, ^
13.                
    
14.         }         
    
15. }

复制代码

8 k7 f' ?- p, o9 G其次还要实现读线圈、写线圈、读离散输入、写保持寄存器、读保持寄存器、读输入寄存器等功能，如下：

/ k, M& ^9 s5 G! C

1. #define REG_INPUT_START       0x0001        //输入寄存器起始地址
   
2. #define REG_INPUT_NREGS       8                        //输入寄存器数量
   4 @3 N& {4 x$ b; M- m) J
3. 
   4 ~. c0 m( P: Q* t. l6 U
4. #define REG_HOLDING_START     0x0001        //保持寄存器起始地址
   % [5 f8 @9 c7 q) M* ~' Z/ S% M
5. #define REG_HOLDING_NREGS     8                        //保持寄存器数量
   
6. 
   
7. #define REG_COILS_START       0x0001        //线圈起始地址
   
8. #define REG_COILS_SIZE        16                        //线圈数量
   4 H1 E4 K" L( V* n2 v
9. 
   
10. #define REG_DISCRETE_START    0x0001        //开关寄存器其实地址
    5 l8 V4 h1 g- \$ E( C
11. #define REG_DISCRETE_SIZE     16                        //开关寄存器数量
    ' V8 @/ i, \- H/ G
12. //输入寄存器内容
    $ Z7 O$ h% ]5 o$ |4 j" G
13. uint16_t usRegInputBuf[REG_INPUT_NREGS] = {0x1000,0x1001,0x1002,0x1003,0x1004,0x1005,0x1006,0x1007};
    
14. //保持寄存器内容               
    $ k+ V5 ?& V3 p, q
15. uint16_t usRegHoldingBuf[REG_HOLDING_NREGS] = {0x2000,0x2001,0x2002,0x2003,0x2004,0x2005,0x2006,0x2007};                                       
    0 \9 |# l6 h* b! }$ c0 x3 R, N0 l
16. //线圈状态
    8 a" n4 Q6 {' j/ b1 F
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. 
    
21. /****************************************************************************
    9 o3 q3 [8 o* u; A
22. * 名          称：eMBRegInputCB
    
23. * 功    能：读取输入寄存器，对应功能码是 04 eMBFuncReadInputRegister
    ) q9 d& Y- K" q  y9 k' G5 c0 E
24. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
    ( [& w. @" d3 f+ [/ A
25. *                                                usAddress: 寄存器地址
    6 p2 w0 ]5 u7 B
26. *                                                usNRegs: 要读取的寄存器个数
    
27. * 出口参数：
    * E$ p, I" P3 p
28. * 注          意：上位机发来的 帧格式是: SlaveAddr(1 Byte)+FuncCode(1 Byte)
    % F8 j: Z/ I- s. m
29. *                                                                +StartAddrHiByte(1 Byte)+StartAddrLoByte(1 Byte)
    + ?  R3 I* g6 V
30. *                                                                +LenAddrHiByte(1 Byte)+LenAddrLoByte(1 Byte)+
    
31. *                                                                +CRCAddrHiByte(1 Byte)+CRCAddrLoByte(1 Byte)
    
32. *                                                        3 区
    
33. ****************************************************************************/
    * W  h; [5 u* J9 n
34. eMBErrorCode
    
35. eMBRegInputCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs )
    ) A" b; W3 @2 C. |1 \! i# D
36. {
    
37.     eMBErrorCode    eStatus = MB_ENOERR;
    7 ~: d% ]# F9 v' u2 S5 Y: C0 J6 o/ a
38.     int             iRegIndex;
    8 R8 B, \- {2 }  m# w
39. 
    , ?1 p) v! z+ z
40.     if( ( usAddress >= REG_INPUT_START )
    7 Z$ c+ A5 Y, R, j
41.         && ( usAddress + usNRegs <= REG_INPUT_START + REG_INPUT_NREGS ) )
    
42.     {
    ( V% ^  b8 J  N6 F# [, Y; x
43.         iRegIndex = ( int )( usAddress - REG_INPUT_START );
    1 G* p' c" \7 ~2 g6 w
44.         while( usNRegs > 0 )
    1 G0 r: C$ m5 S
45.         {
    6 |; ]9 s# z# n+ ^3 P5 {; O
46.             *pucRegBuffer++ = ( UCHAR )( usRegInputBuf[iRegIndex] >> 8 );
    $ Y* g3 s, }! i6 t' j: d5 [
47.             *pucRegBuffer++ = ( UCHAR )( usRegInputBuf[iRegIndex] & 0xFF );
    ; m) N8 Q0 f) {. f* P2 h4 c
48.             iRegIndex++;
    
49.             usNRegs--;
    
50.         }
    
51.     }
    " b( ~( j3 ?: {4 Z/ ]
52.     else
    
53.     {
    $ z1 n+ ]8 E  T. x3 q6 @+ v
54.         eStatus = MB_ENOREG;
    
55.     }
    
56. 
    
57.     return eStatus;
    
58. }
    
59. 
    
60. /****************************************************************************
    : F! Q7 U9 _. r" k
61. * 名          称：eMBRegHoldingCB
    
62. * 功    能：对应功能码有：06 写保持寄存器 eMBFuncWriteHoldingRegister
    
63. *                                                                                                        16 写多个保持寄存器 eMBFuncWriteMultipleHoldingRegister
    
64. *                                                                                                        03 读保持寄存器 eMBFuncReadHoldingRegister
    
65. *                                                                                                        23 读写多个保持寄存器 eMBFuncReadWriteMultipleHoldingRegister
    
66. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
    7 M  i1 X1 q/ Z9 @/ i  N3 p$ Q( \# P
67. *                                                usAddress: 寄存器地址
    ( E, ~, t! U; r! F# ~* ~
68. *                                                usNRegs: 要读写的寄存器个数
    
69. *                                                eMode: 功能码
    ' _/ t$ n9 A+ ^; t2 L4 G
70. * 出口参数：
    & [; V* D0 K8 N
71. * 注          意：4 区
    
72. ****************************************************************************/
    - K- @" J  O5 F. M. o* |
73. eMBErrorCode
    
74. eMBRegHoldingCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs, eMBRegisterMode eMode )
      y2 w- i3 {) N* l, y( `$ z( l2 i
75. {
    
76.         eMBErrorCode    eStatus = MB_ENOERR;
    + v: u( J% W' M! b
77.         int             iRegIndex;
    + \: e% C3 V6 n0 x8 O0 \
78. 
    
79. 
    
80.         if((usAddress >= REG_HOLDING_START)&&\
    ) T# U6 s6 T: T0 k( [
81.                 ((usAddress+usNRegs) <= (REG_HOLDING_START + REG_HOLDING_NREGS)))
    
82.         {
    
83.                 iRegIndex = (int)(usAddress - REG_HOLDING_START);
    
84.                 switch(eMode)
    / |0 k9 v" O% h
85.                 {                                       
    4 r. C  R. \, c' h8 `2 N% Y
86.                         case MB_REG_READ://读 MB_REG_READ = 0
    8 p( t0 Z0 T) L
87.                                 while(usNRegs > 0)
    
88.                                 {
    3 j% i, _; a6 J- v% w9 h
89.                                         *pucRegBuffer++ = (u8)(usRegHoldingBuf[iRegIndex] >> 8);            
    ; l' G# B4 o( U; k& h$ l; \0 v
90.                                         *pucRegBuffer++ = (u8)(usRegHoldingBuf[iRegIndex] & 0xFF);
    ! c, J: {, T$ t6 s9 u
91.                                         iRegIndex++;
    # k- F  ]+ ~' o% o2 g8 X+ P
92.                                         usNRegs--;                                       
    
93.                                 }                           
    6 m: c$ v  M5 i+ Q
94.                         break;
    
95.                         case MB_REG_WRITE://写 MB_REG_WRITE = 0
    ) ]( w+ T+ ~) H0 y  d0 Z# m/ r
96.                                 while(usNRegs > 0)
    ' i, |! L' d) Z. A$ G% E- v2 e+ v
97.                                 {         
    
98.                                         usRegHoldingBuf[iRegIndex] = *pucRegBuffer++ << 8;
    
99.                                         usRegHoldingBuf[iRegIndex] |= *pucRegBuffer++;
    
100.                                         iRegIndex++;
     ' r" U" a: r# D( a. K# i/ f
101.                                         usNRegs--;
     . S( Z# |0 X3 i& \
102.                                 }
     
103.                         break;                                
     1 i- u, `3 ]9 l$ X! w$ W
104.                 }
     ' ?1 [0 p9 |& E( ?! }
105.         }
     
106.         else//错误
     
107.         {
     
108.                 eStatus = MB_ENOREG;
     
109.         }        
     
110.         
     : m$ \4 D5 @" C* C% H
111.         return eStatus;
     4 ]+ ?& I9 o& c, D/ j8 X
112. }
     7 k7 X# t: R: G2 t/ Y( l7 R5 f
113. 
     , y  @& O1 t* V
114. /****************************************************************************
     ! a8 r% f+ D. a9 _
115. * 名          称：eMBRegCoilsCB
     - ^) Z  `( @- i$ w$ `! U, m# E
116. * 功    能：对应功能码有：01 读线圈 eMBFuncReadCoils
     
117. *                                                  05 写线圈 eMBFuncWriteCoil
     
118. *                                                  15 写多个线圈 eMBFuncWriteMultipleCoils
     
119. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
     ; T5 {' K& p# Y4 m
120. *                                                usAddress: 线圈地址
     7 ?" Z  a% O6 i5 `. ?
121. *                                                usNCoils: 要读写的线圈个数
     
122. *                                                eMode: 功能码
     
123. * 出口参数：
     
124. * 注          意：如继电器
     
125. *                                                0 区
     
126. ****************************************************************************/
     $ e% K+ U1 f& ?+ s( M7 H( o
127. eMBErrorCode
     
128. eMBRegCoilsCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNCoils, eMBRegisterMode eMode )
     
129. {
     ' V2 E6 c8 O+ e. u- e% b* ~# B
130.         eMBErrorCode    eStatus = MB_ENOERR;
     
131.         int             iRegIndex;
     
132.         u8 i;
     0 c. F4 t' q: X1 z' c- ~. g
133.         USHORT readNumber=usNCoils;
     2 f  z/ z( G: Q0 o! @
134.         USHORT coilValue=0x0000;
     
135.         if((usAddress >= REG_COILS_START)&&\
     * k* k& W7 J+ B# E# I
136.         ((usAddress+usNCoils) <= (REG_COILS_START + REG_COILS_SIZE)))
     
137.         {
     
138.                 iRegIndex = (int)(usAddress + usNCoils-REG_COILS_START);
     
139.                 switch(eMode)
     
140.                 {                                       
     
141.                         case MB_REG_READ://读 MB_REG_READ = 0
     
142.                                 for(i=0;i<usNCoils;i++)
     
143.                                 {
     
144.                                         readNumber--;
     0 _* r6 ?8 q7 f" v* c
145.                                         iRegIndex--;
     % Z* C! W2 `2 ~1 T. L  U2 c  Y
146.                                         coilValue|=ucRegCoilsBuf[iRegIndex]<<readNumber;
     
147.                                 }
     
148.                                 if(usNCoils<=8)
     
149.                                 {
     6 V+ K. O% G) y' P' b, a# b
150.                                         * pucRegBuffer=coilValue;
     
151.                                 }
     ) [' O3 }, F( r9 p- f9 P' h) P
152.                                 else
     3 N5 A8 W  r  e5 v4 X
153.                                 {
     2 @& W+ ^- }( a: w5 U% e: P5 f, `, M
154.                                         * pucRegBuffer++ = (coilValue)&0x00ff;
     
155.                                         * pucRegBuffer++ = (coilValue>>8)&0x00ff;
     
156.                                 }
     " a. P; T2 s4 r% Q+ d) Q
157.                         break;                           
     
158.                         case MB_REG_WRITE://写 MB_REG_WRITE = 1
     8 x/ O7 L9 y( F
159.                                 while(usNCoils > 0)
     . M7 A) w. F6 ~2 `
160.                                 {         
     
161.                                         //                         usRegHoldingBuf[iRegIndex] = *pucRegBuffer++ << 8;
     # K% z8 X6 s9 m
162.                                         //           usRegHoldingBuf[iRegIndex] |= *pucRegBuffer++;
     % b+ g. T$ M. }. x: v4 u
163.                                                 iRegIndex++;
     ; A$ G9 u# W, M6 J
164.                                                 usNCoils--;
     / v2 a6 P( P, v# c% \
165.                                 }
     
166.                         break;
     
167.                 }
     
168.         }
     
169.         else//错误
     
170.         {
     
171.                 eStatus = MB_ENOREG;
     
172.         }        
     9 F/ [/ ~1 E& A* B) x' {
173. 
     % Z2 Z+ J+ J7 r
174.         return eStatus;
     4 d2 H! e1 ^; u& |2 }* o
175. }
     
176. /****************************************************************************
     
177. * 名          称：eMBRegDiscreteCB
     
178. * 功    能：读取离散寄存器，对应功能码有：02 读离散寄存器 eMBFuncReadDiscreteInputs
     " _" {; v" u* F0 b
179. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
     
180. *                                                usAddress: 寄存器地址
     0 k& T( l$ P1 H1 }5 `5 o: m
181. *                                                usNDiscrete: 要读取的寄存器个数
     2 `4 U" n- B9 O  k) \, B
182. * 出口参数：
     
183. * 注          意：1 区
     / g" ?6 j) ~% F/ J
184. ****************************************************************************/
     
185. eMBErrorCode
     
186. eMBRegDiscreteCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNDiscrete )
     
187. {
     & j+ ~: Y/ m' n6 d
188.         eMBErrorCode    eStatus = MB_ENOERR;
     0 M/ k1 N+ y; L, ^2 ]7 [+ N
189.         int             iRegIndex;
     5 u6 M* W' G; U" R5 R$ I9 V
190.         u8 i;
     + U& ^* E2 g$ F. Z- _1 {
191.         USHORT readNumber=usNDiscrete;
     
192.         USHORT coilValue=0x0000;
     
193.         iRegIndex = (int)(usAddress + usNDiscrete-REG_DISCRETE_START);
     
194.         if((usAddress >= REG_DISCRETE_START)&&\
     
195.         ((usAddress+usNDiscrete) <= (REG_DISCRETE_START + REG_DISCRETE_SIZE)))
       S2 a  f6 \4 I) R% F, a
196.         {
     4 q/ j& b5 ?$ Y8 B/ z9 w; H
197.                 for(i=0;i<usNDiscrete;i++)
     
198.                 {
     
199.                         readNumber--;
     - y& S" ~; j3 s- n  y( N- C4 I+ R
200.                         iRegIndex--;
     
201.                         coilValue|=ucRegDiscreteBuf[iRegIndex]<<readNumber;
     5 d4 I) {5 x; w/ U6 g5 w! ~
202.                 }
     
203.                 if(usNDiscrete<=8)
     % H" E! T8 F+ S
204.                 {
     
205.                         * pucRegBuffer=coilValue;
     7 h& s5 R! [4 l. Z4 D
206.                 }
     & h5 X7 X# L. a$ c
207.                 else
     + s7 h( T0 A0 {  F7 Q7 u
208.                 {
     ! k' B$ t7 c6 Z/ z+ b
209.                         * pucRegBuffer++ = (coilValue)&0x00ff;
       R3 i; j' C: Q5 w
210.                         * pucRegBuffer++ = (coilValue>>8)&0x00ff;
     
211.                 }
     0 v* l4 \; e) a, C. r9 u
212.         }
     
213.         else
     / ]/ b, C; B, S
214.         {
     # @- f; o9 A& b5 E, k8 Q6 E
215.                 eStatus = MB_ENOREG;
     7 @0 [9 c7 p, Q7 \% S' m
216.         }
     
217.     return eStatus;
     
218. }
     
219. 
     , A9 {, j( I" }( e* {. p) O+ F& q8 D
220. 
     
221. 
     . J, ]9 Q9 O- U9 v8 H% u
222. 
     

复制代码

; }- U  E6 @2 V% O
, a' t4 k) G* K* E+ q