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

0 g, ^0 `9 x# n" g) h
7 e  P% ^9 i9 _& f然后修改portserial.c和porttimer.c文件：
0 d; W9 O3 }0 b: T3 \: n0 X/ Yportserial.c
& t) S  ^+ E4 Q( Y2 E, y6 ?/ M

1. /*
   
2. * FreeModbus Libary: BARE Port
   ) d! E$ n# }  F, O8 Q, x* [" [
3. * Copyright (C) 2006 Christian Walter
   
4. *
   / J' E5 n4 ^" z) y( X
5. * This library is free software; you can redistribute it and/or
   6 f) C! l8 e5 |* C1 B' n8 m& I/ q; m
6. * modify it under the terms of the GNU Lesser General Public
   
7. * License as published by the Free Software Foundation; either
   ) G! {; n9 J" P0 b$ ]
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,
    + _+ _! E: v, O4 {9 e
11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
    
12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
    " N6 [1 b' Q" @# X
13. * Lesser General Public License for more details.
    0 G( E( g4 r( L% [* B
14. *
    * I+ \; j: y( r) O' m) H
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
    - p' \4 K- B1 V. P' _7 A
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 $
    % q) g" T$ F2 y8 e' D7 ]
20. */
    
21. 
    & P8 T3 m5 A  v6 a* ~
22. #include "port.h"
    + z, |  P! X- m$ x& \1 j; L  |" I4 G
23. #include "stm32f10x.h"
    4 h) R- g, h# n- m3 }6 `# u; q; i
24. #include "modbus.h"
    
25. /* ----------------------- Modbus includes ----------------------------------*/
    . C8 o( r7 u3 s1 [
26. #include "mb.h"
    
27. #include "mbport.h"
    
28. 
    
29. /* ----------------------- static functions ---------------------------------*/
    
30. static void prvvUARTTxReadyISR( void );
    
31. static void prvvUARTRxISR( void );
    
32. 
    % x( g6 {, k6 R% g! G" H
33. /* ----------------------- Start implementation -----------------------------*/
    & d, W! j- K. ^; m
34. void
    
35. vMBPortSerialEnable( BOOL xRxEnable, BOOL xTxEnable )
      C5 M: |: C0 t  [# b
36. {
    
37.     /* If xRXEnable enable serial receive interrupts. If xTxENable enable
    
38.      * transmitter empty interrupts.
    - G1 o( |5 K+ ~3 X& i# b4 l
39.      */
    * f, T" y4 v' L" ?) a& L+ [
40.         if(xRxEnable == TRUE)
      Q1 Z9 x  O2 F
41.         {
    . b) g8 j" p) y- z' V0 ~
42.                 USART_ITConfig(USART2, USART_IT_RXNE, ENABLE);
    
43.         }
    
44.         else
    
45.         {
    
46.                 USART_ITConfig(USART2, USART_IT_RXNE, DISABLE);
    * D( {4 B0 ]0 @- o% y% S* g$ b
47.         }
    $ L+ h# Q3 ]+ I9 s% G
48.         
    
49.         if(xTxEnable == TRUE)
    6 S* u9 X! q. i7 x
50.         {
    , {8 M3 }. O" n' ]/ ~' E
51.                 USART_ITConfig(USART2, USART_IT_TC, ENABLE);
    
52.         }
    2 L( e2 |6 S3 o3 k. ^" G
53.         else
    
54.         {
    
55.                 USART_ITConfig(USART2, USART_IT_TC, DISABLE);
    
56.         }
    
57. }
    1 W% n1 \: t  U) A2 O) j
58. 
      u4 ~" r! u4 |0 ?
59. BOOL
    
60. xMBPortSerialInit( UCHAR ucPORT, ULONG ulBaudRate, UCHAR ucDataBits, eMBParity eParity )
    
61. {
    4 K: U- p5 D3 i* n
62.         modbus_uart_init((uint16_t)ulBaudRate);  
      J+ H  q% g- ^% W, \$ W; O
63. 
    
64.         return TRUE;
    
65. }
    
66. 
    
67. BOOL
    9 {0 {3 D! c8 f8 U/ I
68. xMBPortSerialPutByte( CHAR ucByte )
    
69. {
    1 x5 F. U4 t( c: X( P  ^7 x1 h3 Z  r1 {
70.     /* Put a byte in the UARTs transmit buffer. This function is called
    ) ?) u+ l3 @' [" i$ [' B
71.      * by the protocol stack if pxMBFrameCBTransmitterEmpty( ) has been
    ' I5 O0 k. u. y3 X' U
72.      * called. */
    
73.         
    9 Q& F9 y5 \, l' @# ]9 ?
74.         USART_SendData(USART2, ucByte);
    ' U  P  A7 U4 O% @8 ~
75.     return TRUE;
    
76. }
    
77. 
    
78. BOOL
    1 e0 A8 k7 c: |; Q
79. xMBPortSerialGetByte( CHAR * pucByte )
    
80. {
    $ k- T8 h0 N" F  z( ]0 U
81.     /* Return the byte in the UARTs receive buffer. This function is called
    
82.      * by the protocol stack after pxMBFrameCBByteReceived( ) has been called.
    & S* z: N; l! X+ S
83.      */
    
84.   *pucByte = USART_ReceiveData(USART2);
    . A/ q$ r: z4 i2 S
85.         return TRUE;
    1 ^6 x: ^4 M2 Q* v
86. }
    9 Y8 K* H+ _) S8 r
87. 
    1 T& z6 ~: J8 u5 U+ F
88. /* Create an interrupt handler for the transmit buffer empty interrupt
    : J8 B  q( S" ~1 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
    
92. * xMBPortSerialPutByte( ) to send the character.
    
93. */
    
94. static void prvvUARTTxReadyISR( void )
    9 w! l' K2 V* C3 K5 f; |5 p8 k+ w! ]
95. {
    & [# {0 d8 S2 W
96.     pxMBFrameCBTransmitterEmpty(  );
    
97. }
    
98. 
    $ t5 L$ _& {2 z+ n  h7 T6 r
99. /* Create an interrupt handler for the receive interrupt for your target
    6 w! |, o4 D# [% p2 g0 F
100. * processor. This function should then call pxMBFrameCBByteReceived( ). The
     
101. * protocol stack will then call xMBPortSerialGetByte( ) to retrieve the
     
102. * character.
     
103. */
     
104. static void prvvUARTRxISR( void )
     
105. {
     " X- }3 P# ^( ?& J
106.     pxMBFrameCBByteReceived(  );
     # ?1 ~1 t3 k/ W1 t, l: h" Z6 H* u
107. }
     
108. 
     
109. /**
     
110.   * @brief  This function handles usart1 Handler.
     
111.   * @param  None
     
112.   * @retval None
     0 N1 L; B3 A3 e( A7 c/ k
113.   */
     
114. void USART2_IRQHandler(void)
     
115. {
     / s" ^6 [- H$ s& \3 E% [
116.         //发生接收中断
     
117.         if(USART_GetITStatus(USART2, USART_IT_RXNE) == SET)
     : ]6 L; @7 L4 a
118.         {
     3 c  |, t' }$ F
119.                 prvvUARTRxISR();
     3 ?: ]! O0 ]* `$ \8 @
120.                 //清除中断标志位   
     
121.                 USART_ClearITPendingBit(USART2, USART_IT_RXNE);   
     * G' I' E9 r; d6 v3 G: r  J
122.         }
     ) v& U! ~5 `$ b( e. O' x
123. 
     3 m. W6 \5 Z* o# Z0 }. Z* T
124.         if(USART_GetITStatus(USART2, USART_IT_ORE) == SET)
     ) a5 M" p! S% ?9 i+ d: m
125.         {  
     8 X  D% }7 {) Q& `4 e9 g1 Y
126.                 USART_ClearITPendingBit(USART2, USART_IT_ORE);
     
127.                 prvvUARTRxISR();         
     ( u7 q2 A% H$ L% D
128.         }
     0 ~* S! D; R  ?5 K/ M1 d# p
129. 
     
130.         //发生完成中断
     
131.         if(USART_GetITStatus(USART2, USART_IT_TC) == SET)
     
132.         {
     
133.                 prvvUARTTxReadyISR();
     : N; B1 V7 R* `1 {3 G
134.                 //清除中断标志
     ' P, f4 q7 A, `# o! Y
135.                 USART_ClearITPendingBit(USART2, USART_IT_TC);
     
136.         }
     
137. }
     

复制代码

* U4 p! Z8 m# ?$ l# {; Kporttimer.c

' h* X  Q+ {3 ~3 p/ p6 @# |

1. 
   ( _$ m1 g: t' F' |  H
2. ```c
   ! F, m4 z+ }' `0 V$ w/ M  ^) c; C
3. /*
   
4. * FreeModbus Libary: BARE Port
   
5. * Copyright (C) 2006 Christian Walter <<a href="mailto:wolti@sil.at">wolti@sil.at</a>>
   
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
   * L" ?$ B9 h+ s  }
9. * License as published by the Free Software Foundation; either
   / _( D4 S( b/ u; W6 H( o2 M- R
10. * version 2.1 of the License, or (at your option) any later version.
    " Q# E( d' J" x4 [. ?
11. *
    $ \( n& G0 t' N9 U( c; _+ Z4 N; B1 s
12. * This library is distributed in the hope that it will be useful,
    
13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
    
14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
    7 O3 ]# A4 j/ Q; m0 W
15. * Lesser General Public License for more details.
    ! R3 T: p3 _" i& L, Y0 y
16. *
    
17. * You should have received a copy of the GNU Lesser General Public
    
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
    1 @% K* `; i. N1 ]9 o/ Z- [
20. *
    0 b! Q2 G0 _+ |9 W
21. * File: $Id: porttimer.c,v 1.1 2006/08/22 21:35:13 wolti Exp $
    5 ?1 O# i/ R2 ]2 [$ L
22. */
    
23. 
    
24. /* ----------------------- Platform includes --------------------------------*/
    , C; e- n2 v! A' V
25. #include "port.h"
    : d/ b4 l( R. m* G$ g" y
26. #include "modbus.h"
    1 a% u5 l/ c# K, A( Y9 L
27. /* ----------------------- Modbus includes ----------------------------------*/
    ! R. \0 I1 ]! ~5 g( S' a2 K" C% [
28. #include "mb.h"
    ; l  k$ H1 V) P. F% D3 i2 M
29. #include "mbport.h"
    , @  @( L# Q/ _1 p4 k& v0 B
30. 
    
31. /* ----------------------- static functions ---------------------------------*/
    
32. static void prvvTIMERExpiredISR( void );
    
33. 
    # f0 E- t3 @! Y9 [: j
34. /* ----------------------- Start implementation -----------------------------*/
    5 w# l3 D5 ]  [1 T: [# ?+ L) D
35. BOOL
    , G# I9 l4 E' v/ o: y
36. xMBPortTimersInit( USHORT usTim1Timerout50us )
    
37. {
    
38.         modbus_timer_init(usTim1Timerout50us);
    
39. 
    9 Y8 Y9 Z; X" [, N/ N5 H
40.         return TRUE;
    
41. }
    , J% m( A, ]) k6 X7 o
42. 
    
43. 
    0 `, g4 D8 U$ y
44. void
    5 Y; l, ^" o9 Z; t9 U
45. vMBPortTimersEnable(  )
    * D3 K! T4 M  t/ O
46. {
    2 I% e  f6 E0 }* Z$ L& V
47.     /* Enable the timer with the timeout passed to xMBPortTimersInit( ) */
    ! B9 l  w. [. ~) n- k
48.         TIM_ClearITPendingBit(TIM3, TIM_IT_Update);
    4 A7 J4 A' A3 a+ c5 O; [
49.         TIM_ITConfig(TIM3, TIM_IT_Update, ENABLE);
    % D2 K( ~# m6 V- p: A/ X
50.         TIM_SetCounter(TIM3,0x0000);
    ( K5 x5 `+ [( w1 L8 m. x
51.         TIM_Cmd(TIM3, ENABLE);
    1 v& N% u' w6 v- [
52. }
    2 E; V! |" w- y* F
53. 
    $ k+ W9 s; W  n( W- i
54. void
    
55. vMBPortTimersDisable(  )
    
56. {
    ' a" s; \  c" T2 `
57.     /* Disable any pending timers. */
    0 f* j( \1 B9 F  @0 ?8 U* x! r0 S
58.   TIM_ClearITPendingBit(TIM3, TIM_IT_Update);
    3 [! c( d- ]2 Z
59.   TIM_ITConfig(TIM3, TIM_IT_Update, DISABLE);
    + N& y3 p4 p4 T( V0 Q% ~
60.   TIM_SetCounter(TIM3,0x0000);
    . N( k5 k* t% R' T
61.   TIM_Cmd(TIM3, DISABLE);
    ; D. x7 j7 D: v& ?
62. }
    
63. 
    2 ^7 m( R4 a( i
64. /* Create an ISR which is called whenever the timer has expired. This function
    & L- s( j9 N) h+ w( t+ W# E
65. * must then call pxMBPortCBTimerExpired( ) to notify the protocol stack that
    
66. * the timer has expired.
    " @) J  w* G5 J4 f6 f# t
67. */
    
68. static void prvvTIMERExpiredISR( void )
    
69. {
    # B& V- X8 ^' I
70.     ( void )pxMBPortCBTimerExpired(  );
    
71. }
      d: C( Y9 V+ }! @
72. 
    
73. void TIM3_IRQHandler(void)
    
74. {
    6 H" P9 N! _+ n3 _
75.         if(TIM_GetITStatus(TIM3, TIM_IT_Update) != RESET)
    3 e% j- a' y7 N- j  d
76.         {
    ( c% {& m3 q- o- n# u: ^$ H0 H! W
77.                 prvvTIMERExpiredISR();
    # @5 d, s  ^# a7 M8 X' m9 |  m5 ^
78.                 TIM_ClearITPendingBit(TIM3, TIM_IT_Update);
    
79.         }
    
80. }

复制代码

然后主函数中调用
0 P' j" H" r( }) @1 Q- D0 ]  }3 D
  d& F; G  _* u" g! E! i+ e5 f1 I

1. 
   7 S) B: o$ L8 O" t3 S
2. int main(void)
   
3. {               
   ; T: o4 a: [& E# C7 V, w# |
4.         delay_init();                     //延时函数初始化         
   
5.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //设置NVIC中断分组2:2位抢占优先级，2位响应优先级
   
6.         uart_init(115200);
   ' J$ h8 X+ c) M/ r1 k
7.         eMBInit(MB_RTU, 0x01, 0x01, 9600, MB_PAR_NONE);
   
8.         eMBEnable();  
   4 K- E* A4 q1 q" _! |; P
9.          while(1)
   $ P7 ~+ L' C7 D, g0 f
10.         {
    ( u* V6 l( _3 Z& p4 m3 N3 l$ E
11.                 (void)eMBPoll();
    
12.                 delay_ms(5);
    1 i$ y) `+ l: @) j9 c& T1 ~; P
13.                
    
14.         }         
    
15. }

复制代码

% U6 w1 S' X- o. M1 Y7 x  z3 }9 T; y8 w其次还要实现读线圈、写线圈、读离散输入、写保持寄存器、读保持寄存器、读输入寄存器等功能，如下：

; v# V/ a* [! I9 f# ]: \' {/ ]

1. #define REG_INPUT_START       0x0001        //输入寄存器起始地址
   
2. #define REG_INPUT_NREGS       8                        //输入寄存器数量
   ' ?4 C( C" e9 \; v  G- q6 r
3. 
   + g4 ^0 e. N+ j# d! ?- N7 a- `9 w
4. #define REG_HOLDING_START     0x0001        //保持寄存器起始地址
   
5. #define REG_HOLDING_NREGS     8                        //保持寄存器数量
   
6. 
   
7. #define REG_COILS_START       0x0001        //线圈起始地址
   
8. #define REG_COILS_SIZE        16                        //线圈数量
   
9. 
   
10. #define REG_DISCRETE_START    0x0001        //开关寄存器其实地址
    2 H1 B$ ^, }6 D
11. #define REG_DISCRETE_SIZE     16                        //开关寄存器数量
    ) `/ O3 V6 v/ y6 N) n& S! y8 E
12. //输入寄存器内容
    # M$ }% v& ?# W$ W1 M% T  R
13. uint16_t usRegInputBuf[REG_INPUT_NREGS] = {0x1000,0x1001,0x1002,0x1003,0x1004,0x1005,0x1006,0x1007};
    
14. //保持寄存器内容               
    , D4 N) Z' s/ }) w1 _+ ^* G
15. uint16_t usRegHoldingBuf[REG_HOLDING_NREGS] = {0x2000,0x2001,0x2002,0x2003,0x2004,0x2005,0x2006,0x2007};                                       
    ) K+ \; A. P5 B
16. //线圈状态
    , w% e3 ~. b* S7 H
17. uint8_t ucRegCoilsBuf[REG_COILS_SIZE] = {0x01,0x01,0x00,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00};
    ) }% }# _  I0 h, k+ @# o
18. //离散寄存器内容
    2 O9 T) R- [: D
19. uint8_t ucRegDiscreteBuf[REG_DISCRETE_SIZE] = {0x01,0x01,0x00,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x00,0x01,0x01};
    6 A+ c) A8 W7 r& B* Y
20. 
    ; _0 j0 h1 E, Q! D: `
21. /****************************************************************************
    0 [# M: `2 B2 o% z$ J
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)
    
30. *                                                                +LenAddrHiByte(1 Byte)+LenAddrLoByte(1 Byte)+
    3 H, p1 M- q5 K( U/ j
31. *                                                                +CRCAddrHiByte(1 Byte)+CRCAddrLoByte(1 Byte)
    
32. *                                                        3 区
    
33. ****************************************************************************/
    
34. eMBErrorCode
    ( L& K  Y/ `. }; H4 c% ?
35. eMBRegInputCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs )
    
36. {
    % l# s) ?0 G9 \$ i& v
37.     eMBErrorCode    eStatus = MB_ENOERR;
    
38.     int             iRegIndex;
    0 _% L, _7 B0 {) c, b
39. 
    , }# |3 S: n! B
40.     if( ( usAddress >= REG_INPUT_START )
    
41.         && ( usAddress + usNRegs <= REG_INPUT_START + REG_INPUT_NREGS ) )
    
42.     {
    
43.         iRegIndex = ( int )( usAddress - REG_INPUT_START );
    
44.         while( usNRegs > 0 )
    . j# |7 ^7 w9 D) Y/ U9 ?" ]
45.         {
    
46.             *pucRegBuffer++ = ( UCHAR )( usRegInputBuf[iRegIndex] >> 8 );
      g4 s/ I- i- M9 y- U
47.             *pucRegBuffer++ = ( UCHAR )( usRegInputBuf[iRegIndex] & 0xFF );
    - N& K( c% ^! P( T7 ]8 i
48.             iRegIndex++;
    5 t# c4 G  ~; a' H! R4 u
49.             usNRegs--;
    0 j: L6 j. d9 t; |* L
50.         }
    
51.     }
    , k9 G; r6 j1 u
52.     else
    3 J9 w) c# j1 o  x! N6 U: t% F: g
53.     {
    
54.         eStatus = MB_ENOREG;
    
55.     }
    4 d, _% [! x  a0 V
56. 
    
57.     return eStatus;
    $ P: j; R! q8 s! [
58. }
    9 v/ M9 P/ Y) P* e
59. 
    
60. /****************************************************************************
    
61. * 名          称：eMBRegHoldingCB
    ) {; [, z0 o# |1 W- r
62. * 功    能：对应功能码有：06 写保持寄存器 eMBFuncWriteHoldingRegister
    
63. *                                                                                                        16 写多个保持寄存器 eMBFuncWriteMultipleHoldingRegister
    ( U4 Y( N" T  \, g+ c
64. *                                                                                                        03 读保持寄存器 eMBFuncReadHoldingRegister
    2 }; U# \; u' t" l0 z
65. *                                                                                                        23 读写多个保持寄存器 eMBFuncReadWriteMultipleHoldingRegister
    
66. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
      x" d& C9 y. a2 F
67. *                                                usAddress: 寄存器地址
    
68. *                                                usNRegs: 要读写的寄存器个数
    ( B4 f. O8 u7 R
69. *                                                eMode: 功能码
    - \- m' g; o7 l' q  L" m: G) G0 M
70. * 出口参数：
    5 f: j" z6 R9 v' W, k  g  Z5 x
71. * 注          意：4 区
    
72. ****************************************************************************/
    
73. eMBErrorCode
    5 N6 K. Q/ L6 H7 p0 t7 L) g' ~
74. eMBRegHoldingCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNRegs, eMBRegisterMode eMode )
    
75. {
    2 c% r* C2 l5 K0 i% r1 s: ?
76.         eMBErrorCode    eStatus = MB_ENOERR;
    
77.         int             iRegIndex;
    * m- n0 Q4 h+ B4 @+ g: `5 H
78. 
    
79. 
    
80.         if((usAddress >= REG_HOLDING_START)&&\
    
81.                 ((usAddress+usNRegs) <= (REG_HOLDING_START + REG_HOLDING_NREGS)))
    
82.         {
    : |, N/ O5 m- R/ ~+ s$ J: d
83.                 iRegIndex = (int)(usAddress - REG_HOLDING_START);
    ) o% w' Y) N, B* e# ^0 B$ h1 ]2 ]
84.                 switch(eMode)
    . a+ M& l7 ^8 u4 E
85.                 {                                       
    
86.                         case MB_REG_READ://读 MB_REG_READ = 0
    
87.                                 while(usNRegs > 0)
    
88.                                 {
    4 b9 a: J* V6 U/ V" L1 w9 N
89.                                         *pucRegBuffer++ = (u8)(usRegHoldingBuf[iRegIndex] >> 8);            
    / h: v! `& d% l! ?0 I* `8 t
90.                                         *pucRegBuffer++ = (u8)(usRegHoldingBuf[iRegIndex] & 0xFF);
    ; F) M( z- J- _* h: |/ [& }  @( K
91.                                         iRegIndex++;
    
92.                                         usNRegs--;                                       
    7 T5 s' F8 [8 j* x/ {+ k
93.                                 }                           
    
94.                         break;
      c5 S3 W5 ^: B' p- ?! o) |
95.                         case MB_REG_WRITE://写 MB_REG_WRITE = 0
    # i+ r' x8 c: m# x! _! q4 G) ?
96.                                 while(usNRegs > 0)
    
97.                                 {         
    / ^! b( s% r1 J' [
98.                                         usRegHoldingBuf[iRegIndex] = *pucRegBuffer++ << 8;
    
99.                                         usRegHoldingBuf[iRegIndex] |= *pucRegBuffer++;
    " N- P, r0 y4 b: _% E8 t
100.                                         iRegIndex++;
     6 ~4 A6 L0 a% `8 x+ B" T
101.                                         usNRegs--;
     
102.                                 }
     ) I: S" z. E1 z2 k( e. s! U) S  w
103.                         break;                                
     
104.                 }
     
105.         }
     
106.         else//错误
     5 g0 L  Z: t7 }, v# P# U
107.         {
     
108.                 eStatus = MB_ENOREG;
     - [& e. C4 E  k
109.         }        
     
110.         
     8 K$ ~1 @# {8 }8 W
111.         return eStatus;
     5 j/ `' M) H4 ~  d2 U% N' j
112. }
     7 o* T% O6 d1 g- T
113. 
     
114. /****************************************************************************
     $ F; E# Z: |/ K* Q" u
115. * 名          称：eMBRegCoilsCB
     - K9 e5 y4 U6 @8 @* Y7 e1 ]4 Y
116. * 功    能：对应功能码有：01 读线圈 eMBFuncReadCoils
     # N9 Q9 P0 l) V" L5 Q3 A. l
117. *                                                  05 写线圈 eMBFuncWriteCoil
     : g( j1 z+ |8 l3 d& q6 e  M3 A
118. *                                                  15 写多个线圈 eMBFuncWriteMultipleCoils
     
119. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
     
120. *                                                usAddress: 线圈地址
     8 ]9 ^. e; L* j: H1 y4 s9 y
121. *                                                usNCoils: 要读写的线圈个数
     
122. *                                                eMode: 功能码
     
123. * 出口参数：
     1 b5 R( L, w* ?. T5 Q3 l' v
124. * 注          意：如继电器
     
125. *                                                0 区
     
126. ****************************************************************************/
     " X, n; v& d4 p- |$ x1 T, j
127. eMBErrorCode
     
128. eMBRegCoilsCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNCoils, eMBRegisterMode eMode )
     
129. {
     
130.         eMBErrorCode    eStatus = MB_ENOERR;
     
131.         int             iRegIndex;
     
132.         u8 i;
     + k" `1 d- `6 r
133.         USHORT readNumber=usNCoils;
     # E0 C& P5 ~! r# Z  Q* t
134.         USHORT coilValue=0x0000;
     % m0 e; I  e! g. T( M" d
135.         if((usAddress >= REG_COILS_START)&&\
     
136.         ((usAddress+usNCoils) <= (REG_COILS_START + REG_COILS_SIZE)))
     ! [, g4 Q! W. W0 S% ]0 Y  I! C" T2 y
137.         {
     
138.                 iRegIndex = (int)(usAddress + usNCoils-REG_COILS_START);
     , N$ _3 g5 a' T: T1 P
139.                 switch(eMode)
     
140.                 {                                       
     
141.                         case MB_REG_READ://读 MB_REG_READ = 0
     / A: c; _8 k( [, @: h+ A) V* R
142.                                 for(i=0;i<usNCoils;i++)
     # q: }6 J) K! r8 O6 m, L
143.                                 {
     
144.                                         readNumber--;
     
145.                                         iRegIndex--;
     
146.                                         coilValue|=ucRegCoilsBuf[iRegIndex]<<readNumber;
     
147.                                 }
     5 ]( w% K5 X3 d) V
148.                                 if(usNCoils<=8)
     " j5 N5 G/ a+ |
149.                                 {
     
150.                                         * pucRegBuffer=coilValue;
     ; t% H1 ]/ w6 g) r; a; J
151.                                 }
     ) X" s8 l7 {# ~9 v
152.                                 else
     
153.                                 {
     , p( l4 O! e  ]0 C* _
154.                                         * pucRegBuffer++ = (coilValue)&0x00ff;
     
155.                                         * pucRegBuffer++ = (coilValue>>8)&0x00ff;
     
156.                                 }
     + S7 G; m0 Z1 b" _. h$ V3 F# D1 ^; x
157.                         break;                           
     5 t5 N7 D5 ]' i3 X, x
158.                         case MB_REG_WRITE://写 MB_REG_WRITE = 1
     , I* E, U; q3 L# w; D+ |* h
159.                                 while(usNCoils > 0)
     
160.                                 {         
     
161.                                         //                         usRegHoldingBuf[iRegIndex] = *pucRegBuffer++ << 8;
     
162.                                         //           usRegHoldingBuf[iRegIndex] |= *pucRegBuffer++;
     : l" N6 t' e( {9 K
163.                                                 iRegIndex++;
     
164.                                                 usNCoils--;
     
165.                                 }
     ' X. U& s% ]$ W$ b. L3 i
166.                         break;
     / D! q9 H+ w, {1 d8 H- [1 W" U
167.                 }
     
168.         }
     
169.         else//错误
     . V! G: p! f7 r) t1 n4 Y3 {
170.         {
     
171.                 eStatus = MB_ENOREG;
     
172.         }        
     
173. 
     ! t6 m* e) {' h* q8 P
174.         return eStatus;
     ) H$ d" f+ b$ E2 o) _9 V; }% ^
175. }
     $ {. U0 F3 D/ D* d" a
176. /****************************************************************************
     . p; E3 ?9 w" I/ a( D- q) J
177. * 名          称：eMBRegDiscreteCB
     
178. * 功    能：读取离散寄存器，对应功能码有：02 读离散寄存器 eMBFuncReadDiscreteInputs
     
179. * 入口参数：pucRegBuffer: 数据缓存区，用于响应主机   
     6 n& Z* V* F$ w: W0 d$ R
180. *                                                usAddress: 寄存器地址
     1 K/ W6 H& H, u: M4 c* h
181. *                                                usNDiscrete: 要读取的寄存器个数
     3 ]: D- G1 t2 X8 Y! `
182. * 出口参数：
     & }; V/ J8 H/ E& u( u  x5 ]9 z# u
183. * 注          意：1 区
     
184. ****************************************************************************/
     , m, ]1 E$ a. d7 ~( V
185. eMBErrorCode
     
186. eMBRegDiscreteCB( UCHAR * pucRegBuffer, USHORT usAddress, USHORT usNDiscrete )
     ( o  L. z5 B& y
187. {
     
188.         eMBErrorCode    eStatus = MB_ENOERR;
     
189.         int             iRegIndex;
     
190.         u8 i;
     
191.         USHORT readNumber=usNDiscrete;
       O: i& g: Y7 e5 |+ G( Z  U7 m
192.         USHORT coilValue=0x0000;
     / j. M2 ^& r) B3 {. a
193.         iRegIndex = (int)(usAddress + usNDiscrete-REG_DISCRETE_START);
     
194.         if((usAddress >= REG_DISCRETE_START)&&\
     
195.         ((usAddress+usNDiscrete) <= (REG_DISCRETE_START + REG_DISCRETE_SIZE)))
     
196.         {
     / K- g. k/ e8 `/ e* W! P/ W, ]
197.                 for(i=0;i<usNDiscrete;i++)
     
198.                 {
     $ a- g( y0 G2 V+ y
199.                         readNumber--;
       r; ]" L4 g. @
200.                         iRegIndex--;
     
201.                         coilValue|=ucRegDiscreteBuf[iRegIndex]<<readNumber;
     
202.                 }
     ; R% W! x* Y8 I- W* M! ^$ S
203.                 if(usNDiscrete<=8)
     
204.                 {
     
205.                         * pucRegBuffer=coilValue;
     # z4 W% r3 P* g  R% e$ r
206.                 }
     
207.                 else
     
208.                 {
     
209.                         * pucRegBuffer++ = (coilValue)&0x00ff;
     / p% T. w  A8 ?8 I5 u) X
210.                         * pucRegBuffer++ = (coilValue>>8)&0x00ff;
     : D+ \5 o. L7 N! `
211.                 }
     $ H% G  {* ]9 z4 [/ e  ]
212.         }
     - z4 G, W6 J* K0 {: z
213.         else
     
214.         {
     
215.                 eStatus = MB_ENOREG;
     
216.         }
     $ L+ r& i8 u1 E1 O9 y2 g
217.     return eStatus;
     ' v4 L# b/ a1 y) a/ k3 {% |: U2 H( `5 x
218. }
     
219. 
     
220. 
     
221. 
     $ T+ D" o& l+ I
222. 
     % a) y* i+ w6 {7 P6 u; f3 z

复制代码

6 ?: Z1 q6 B2 Q; W8 |4 R4 a