66
77#include <stdlib.h>
88
9+ // clang-format off
910#ifndef _MSC_VER
1011# include <stdint.h>
1112#else
@@ -69,21 +70,24 @@ static inline uint32_t bswap_32(uint32_t x)
6970 return (bswap_16 (x & 0xffff ) << 16 ) | (bswap_16 (x >> 16 ));
7071}
7172#endif
73+ // clang-format on
7274
7375/* Sets many bits from a single byte value (all 8 bits of the byte value are
7476 set) */
7577void modbus_set_bits_from_byte (uint8_t * dest , int idx , const uint8_t value )
7678{
7779 int i ;
7880
79- for (i = 0 ; i < 8 ; i ++ ) {
80- dest [idx + i ] = (value & (1 << i )) ? 1 : 0 ;
81+ for (i = 0 ; i < 8 ; i ++ ) {
82+ dest [idx + i ] = (value & (1 << i )) ? 1 : 0 ;
8183 }
8284}
8385
8486/* Sets many bits from a table of bytes (only the bits between idx and
8587 idx + nb_bits are set) */
86- void modbus_set_bits_from_bytes (uint8_t * dest , int idx , unsigned int nb_bits ,
88+ void modbus_set_bits_from_bytes (uint8_t * dest ,
89+ int idx ,
90+ unsigned int nb_bits ,
8791 const uint8_t * tab_byte )
8892{
8993 unsigned int i ;
@@ -99,8 +103,7 @@ void modbus_set_bits_from_bytes(uint8_t *dest, int idx, unsigned int nb_bits,
99103
100104/* Gets the byte value from many bits.
101105 To obtain a full byte, set nb_bits to 8. */
102- uint8_t modbus_get_byte_from_bits (const uint8_t * src , int idx ,
103- unsigned int nb_bits )
106+ uint8_t modbus_get_byte_from_bits (const uint8_t * src , int idx , unsigned int nb_bits )
104107{
105108 unsigned int i ;
106109 uint8_t value = 0 ;
@@ -111,8 +114,8 @@ uint8_t modbus_get_byte_from_bits(const uint8_t *src, int idx,
111114 nb_bits = 8 ;
112115 }
113116
114- for (i = 0 ; i < nb_bits ; i ++ ) {
115- value |= (src [idx + i ] << i );
117+ for (i = 0 ; i < nb_bits ; i ++ ) {
118+ value |= (src [idx + i ] << i );
116119 }
117120
118121 return value ;
@@ -130,10 +133,7 @@ float modbus_get_float_abcd(const uint16_t *src)
130133 c = (src [1 ] >> 8 ) & 0xFF ;
131134 d = (src [1 ] >> 0 ) & 0xFF ;
132135
133- i = (a << 24 ) |
134- (b << 16 ) |
135- (c << 8 ) |
136- (d << 0 );
136+ i = (a << 24 ) | (b << 16 ) | (c << 8 ) | (d << 0 );
137137 memcpy (& f , & i , 4 );
138138
139139 return f ;
@@ -151,10 +151,7 @@ float modbus_get_float_dcba(const uint16_t *src)
151151 c = (src [1 ] >> 8 ) & 0xFF ;
152152 d = (src [1 ] >> 0 ) & 0xFF ;
153153
154- i = (d << 24 ) |
155- (c << 16 ) |
156- (b << 8 ) |
157- (a << 0 );
154+ i = (d << 24 ) | (c << 16 ) | (b << 8 ) | (a << 0 );
158155 memcpy (& f , & i , 4 );
159156
160157 return f ;
@@ -172,10 +169,7 @@ float modbus_get_float_badc(const uint16_t *src)
172169 c = (src [1 ] >> 8 ) & 0xFF ;
173170 d = (src [1 ] >> 0 ) & 0xFF ;
174171
175- i = (b << 24 ) |
176- (a << 16 ) |
177- (d << 8 ) |
178- (c << 0 );
172+ i = (b << 24 ) | (a << 16 ) | (d << 8 ) | (c << 0 );
179173 memcpy (& f , & i , 4 );
180174
181175 return f ;
@@ -193,10 +187,7 @@ float modbus_get_float_cdab(const uint16_t *src)
193187 c = (src [1 ] >> 8 ) & 0xFF ;
194188 d = (src [1 ] >> 0 ) & 0xFF ;
195189
196- i = (c << 24 ) |
197- (d << 16 ) |
198- (a << 8 ) |
199- (b << 0 );
190+ i = (c << 24 ) | (d << 16 ) | (a << 8 ) | (b << 0 );
200191 memcpy (& f , & i , 4 );
201192
202193 return f ;
@@ -208,18 +199,17 @@ float modbus_get_float(const uint16_t *src)
208199 float f ;
209200 uint32_t i ;
210201
211- i = (((uint32_t )src [1 ]) << 16 ) + src [0 ];
202+ i = (((uint32_t ) src [1 ]) << 16 ) + src [0 ];
212203 memcpy (& f , & i , sizeof (float ));
213204
214205 return f ;
215-
216206}
217207
218208/* Set a float to 4 bytes for Modbus w/o any conversion (ABCD) */
219209void modbus_set_float_abcd (float f , uint16_t * dest )
220210{
221211 uint32_t i ;
222- uint8_t * out = (uint8_t * ) dest ;
212+ uint8_t * out = (uint8_t * ) dest ;
223213 uint8_t a , b , c , d ;
224214
225215 memcpy (& i , & f , sizeof (uint32_t ));
@@ -238,7 +228,7 @@ void modbus_set_float_abcd(float f, uint16_t *dest)
238228void modbus_set_float_dcba (float f , uint16_t * dest )
239229{
240230 uint32_t i ;
241- uint8_t * out = (uint8_t * ) dest ;
231+ uint8_t * out = (uint8_t * ) dest ;
242232 uint8_t a , b , c , d ;
243233
244234 memcpy (& i , & f , sizeof (uint32_t ));
@@ -251,14 +241,13 @@ void modbus_set_float_dcba(float f, uint16_t *dest)
251241 out [1 ] = c ;
252242 out [2 ] = b ;
253243 out [3 ] = a ;
254-
255244}
256245
257246/* Set a float to 4 bytes for Modbus with byte swap conversion (BADC) */
258247void modbus_set_float_badc (float f , uint16_t * dest )
259248{
260249 uint32_t i ;
261- uint8_t * out = (uint8_t * ) dest ;
250+ uint8_t * out = (uint8_t * ) dest ;
262251 uint8_t a , b , c , d ;
263252
264253 memcpy (& i , & f , sizeof (uint32_t ));
@@ -277,7 +266,7 @@ void modbus_set_float_badc(float f, uint16_t *dest)
277266void modbus_set_float_cdab (float f , uint16_t * dest )
278267{
279268 uint32_t i ;
280- uint8_t * out = (uint8_t * ) dest ;
269+ uint8_t * out = (uint8_t * ) dest ;
281270 uint8_t a , b , c , d ;
282271
283272 memcpy (& i , & f , sizeof (uint32_t ));
@@ -298,6 +287,6 @@ void modbus_set_float(float f, uint16_t *dest)
298287 uint32_t i ;
299288
300289 memcpy (& i , & f , sizeof (uint32_t ));
301- dest [0 ] = (uint16_t )i ;
302- dest [1 ] = (uint16_t )(i >> 16 );
290+ dest [0 ] = (uint16_t ) i ;
291+ dest [1 ] = (uint16_t ) (i >> 16 );
303292}
0 commit comments