Skip to content

Commit ec4ab21

Browse files
committed
style code fixed
1 parent cd71ebb commit ec4ab21

File tree

1 file changed

+26
-38
lines changed

1 file changed

+26
-38
lines changed

examples/stm32/f4/stm32f4-discovery/lis3dsh_demo/lis3dsh_demo.c

Lines changed: 26 additions & 38 deletions
Original file line numberDiff line numberDiff line change
@@ -85,10 +85,10 @@
8585

8686
static void gpio_setup(void);
8787
static void spi_setup(void);
88-
static void LIS3DSH_init(void);
89-
static void LIS3DSH_write_reg(int, int);
90-
static int LIS3DSH_read_reg(int);
91-
static inline int twoComplToInt16(int);
88+
static void lis3dsh_init(void);
89+
static void lis3dsh_write_reg(int, int);
90+
static int lis3dsh_read_reg(int);
91+
static inline int two_compl_to_int16(int);
9292

9393

9494

@@ -156,37 +156,36 @@ static void spi_setup(void)
156156

157157

158158
/* Function to initialise the LIS3DSH */
159-
static void LIS3DSH_init(void)
159+
static void lis3dsh_init(void)
160160
{
161161
int int_reg_value;
162162

163163
/* init SPI1 */
164164
spi_setup();
165165

166166
/* get WHO AM I value */
167-
int_reg_value = LIS3DSH_read_reg(ADD_REG_WHO_AM_I);
167+
int_reg_value = lis3dsh_read_reg(ADD_REG_WHO_AM_I);
168168

169169
/* if WHO AM I value is the expected one */
170170
if (int_reg_value == UC_WHO_AM_I_DEFAULT_VALUE) {
171171
/* set output data rate to 400 Hz and enable X,Y,Z axis */
172-
LIS3DSH_write_reg(ADD_REG_CTRL_4, UC_ADD_REG_CTRL_4_CFG_VALUE);
172+
lis3dsh_write_reg(ADD_REG_CTRL_4, UC_ADD_REG_CTRL_4_CFG_VALUE);
173173
/* verify written value */
174-
int_reg_value = LIS3DSH_read_reg(ADD_REG_CTRL_4);
174+
int_reg_value = lis3dsh_read_reg(ADD_REG_CTRL_4);
175175
/* if written value is different */
176176
if (int_reg_value != UC_ADD_REG_CTRL_4_CFG_VALUE) {
177177
/* ERROR: stay here... */
178178
while (1);
179179
}
180-
}
181-
else {
180+
} else {
182181
/* ERROR: stay here... */
183182
while (1);
184183
}
185184
}
186185

187186

188187
/* Function to write a register to LIS3DSH through SPI */
189-
static void LIS3DSH_write_reg(int reg, int data)
188+
static void lis3dsh_write_reg(int reg, int data)
190189
{
191190
/* set CS low */
192191
gpio_clear(GPIOE, GPIO3);
@@ -199,7 +198,7 @@ static void LIS3DSH_write_reg(int reg, int data)
199198

200199

201200
/* Function to read a register from LIS3DSH through SPI */
202-
static int LIS3DSH_read_reg(int reg)
201+
static int lis3dsh_read_reg(int reg)
203202
{
204203
int reg_value;
205204
/* set CS low */
@@ -214,15 +213,14 @@ static int LIS3DSH_read_reg(int reg)
214213

215214

216215
/* Transform a two's complement value to 16-bit int value */
217-
static inline int twoComplToInt16(int two_compl_value)
216+
static inline int two_compl_to_int16(int two_compl_value)
218217
{
219218
int int16_value = 0;
220219

221220
/* conversion */
222221
if (two_compl_value > 32768) {
223222
int16_value = -(((~two_compl_value) & 0xFFFF) + 1);
224-
}
225-
else {
223+
} else {
226224
int16_value = two_compl_value;
227225
}
228226

@@ -233,37 +231,36 @@ static inline int twoComplToInt16(int two_compl_value)
233231
/* Main function */
234232
int main(void)
235233
{
236-
int i;
237234
int value_mg_x, value_mg_y, value_mg_z;
238235

239236
/* setup all GPIOs */
240237
gpio_setup();
241238

242239
/* initialise LIS3DSH */
243-
LIS3DSH_init();
240+
lis3dsh_init();
244241

245242
/* infinite loop */
246243
while (1) {
247244
/* get X, Y, Z values */
248-
value_mg_x = ((LIS3DSH_read_reg(ADD_REG_OUT_X_H) << 8) |
249-
LIS3DSH_read_reg(ADD_REG_OUT_X_L));
250-
value_mg_y = ((LIS3DSH_read_reg(ADD_REG_OUT_Y_H) << 8) |
251-
LIS3DSH_read_reg(ADD_REG_OUT_Y_L));
252-
value_mg_z = ((LIS3DSH_read_reg(ADD_REG_OUT_Z_H) << 8) |
253-
LIS3DSH_read_reg(ADD_REG_OUT_Z_L));
245+
value_mg_x = ((lis3dsh_read_reg(ADD_REG_OUT_X_H) << 8) |
246+
lis3dsh_read_reg(ADD_REG_OUT_X_L));
247+
value_mg_y = ((lis3dsh_read_reg(ADD_REG_OUT_Y_H) << 8) |
248+
lis3dsh_read_reg(ADD_REG_OUT_Y_L));
249+
value_mg_z = ((lis3dsh_read_reg(ADD_REG_OUT_Z_H) << 8) |
250+
lis3dsh_read_reg(ADD_REG_OUT_Z_L));
254251

255252
/* transform X value from two's complement to 16-bit int */
256-
value_mg_x = twoComplToInt16(value_mg_x);
253+
value_mg_x = two_compl_to_int16(value_mg_x);
257254
/* convert X absolute value to mg value */
258255
value_mg_x = value_mg_x * SENS_2G_RANGE_MG_PER_DIGIT;
259256

260257
/* transform Y value from two's complement to 16-bit int */
261-
value_mg_y = twoComplToInt16(value_mg_y);
258+
value_mg_y = two_compl_to_int16(value_mg_y);
262259
/* convert Y absolute value to mg value */
263260
value_mg_y = value_mg_y * SENS_2G_RANGE_MG_PER_DIGIT;
264261

265262
/* transform Z value from two's complement to 16-bit int */
266-
value_mg_z = twoComplToInt16(value_mg_z);
263+
value_mg_z = two_compl_to_int16(value_mg_z);
267264
/* convert Z absolute value to mg value */
268265
value_mg_z = value_mg_z * SENS_2G_RANGE_MG_PER_DIGIT;
269266

@@ -273,8 +270,7 @@ int main(void)
273270
LED_ORANGE_OFF();
274271
LED_GREEN_OFF();
275272
LED_RED_ON();
276-
}
277-
else if (value_mg_x <= -LED_TH_MG) {
273+
} else if (value_mg_x <= -LED_TH_MG) {
278274
LED_BLUE_OFF();
279275
LED_ORANGE_OFF();
280276
LED_RED_OFF();
@@ -287,8 +283,7 @@ int main(void)
287283
LED_RED_OFF();
288284
LED_GREEN_OFF();
289285
LED_ORANGE_ON();
290-
}
291-
else if (value_mg_y <= -LED_TH_MG) {
286+
} else if (value_mg_y <= -LED_TH_MG) {
292287
LED_RED_OFF();
293288
LED_GREEN_OFF();
294289
LED_ORANGE_OFF();
@@ -301,19 +296,12 @@ int main(void)
301296
LED_ORANGE_ON();
302297
LED_RED_ON();
303298
LED_GREEN_ON();
304-
}
305-
else if (value_mg_z <= -LED_TH_MG) {
299+
} else if (value_mg_z <= -LED_TH_MG) {
306300
LED_BLUE_OFF();
307301
LED_ORANGE_OFF();
308302
LED_RED_OFF();
309303
LED_GREEN_OFF();
310304
}
311-
312-
/* Wait a bit... */
313-
for (i = 0; i < 100; i++)
314-
{
315-
__asm__("nop");
316-
}
317305
}
318306

319307
return 0;

0 commit comments

Comments
 (0)