13
13
#ifdef CONFIG_IIS2DLPC_TRIGGER
14
14
static int iis2dlpc_trig_cnt ;
15
15
16
- static void iis2dlpc_trigger_handler (const struct device * dev ,
17
- const struct sensor_trigger * trig )
16
+ static void iis2dlpc_trigger_handler (const struct device * dev , const struct sensor_trigger * trig )
18
17
{
19
18
sensor_sample_fetch_chan (dev , SENSOR_CHAN_ACCEL_XYZ );
20
19
iis2dlpc_trig_cnt ++ ;
@@ -24,8 +23,7 @@ static void iis2dlpc_trigger_handler(const struct device *dev,
24
23
#ifdef CONFIG_IIS2MDC_TRIGGER
25
24
static int iis2mdc_trig_cnt ;
26
25
27
- static void iis2mdc_trigger_handler (const struct device * dev ,
28
- const struct sensor_trigger * trig )
26
+ static void iis2mdc_trigger_handler (const struct device * dev , const struct sensor_trigger * trig )
29
27
{
30
28
sensor_sample_fetch_chan (dev , SENSOR_CHAN_ALL );
31
29
iis2mdc_trig_cnt ++ ;
@@ -59,16 +57,16 @@ static void iis2dlpc_config(const struct device *iis2dlpc)
59
57
odr_attr .val1 = 100 ;
60
58
odr_attr .val2 = 0 ;
61
59
62
- if (sensor_attr_set (iis2dlpc , SENSOR_CHAN_ACCEL_XYZ ,
63
- SENSOR_ATTR_SAMPLING_FREQUENCY , & odr_attr ) < 0 ) {
60
+ if (sensor_attr_set (iis2dlpc , SENSOR_CHAN_ACCEL_XYZ , SENSOR_ATTR_SAMPLING_FREQUENCY ,
61
+ & odr_attr ) < 0 ) {
64
62
printk ("Cannot set sampling frequency for IIS2DLPC accel\n" );
65
63
return ;
66
64
}
67
65
68
66
sensor_g_to_ms2 (16 , & fs_attr );
69
67
70
- if (sensor_attr_set (iis2dlpc , SENSOR_CHAN_ACCEL_XYZ ,
71
- SENSOR_ATTR_FULL_SCALE , & fs_attr ) < 0 ) {
68
+ if (sensor_attr_set (iis2dlpc , SENSOR_CHAN_ACCEL_XYZ , SENSOR_ATTR_FULL_SCALE , & fs_attr ) <
69
+ 0 ) {
72
70
printk ("Cannot set sampling frequency for IIS2DLPC gyro\n" );
73
71
return ;
74
72
}
@@ -90,8 +88,8 @@ static void iis2mdc_config(const struct device *iis2mdc)
90
88
odr_attr .val1 = 100 ;
91
89
odr_attr .val2 = 0 ;
92
90
93
- if (sensor_attr_set (iis2mdc , SENSOR_CHAN_ALL ,
94
- SENSOR_ATTR_SAMPLING_FREQUENCY , & odr_attr ) < 0 ) {
91
+ if (sensor_attr_set (iis2mdc , SENSOR_CHAN_ALL , SENSOR_ATTR_SAMPLING_FREQUENCY , & odr_attr ) <
92
+ 0 ) {
95
93
printk ("Cannot set sampling frequency for IIS2MDC\n" );
96
94
return ;
97
95
}
@@ -113,16 +111,16 @@ static void ism330dhcx_config(const struct device *ism330dhcx)
113
111
odr_attr .val1 = 416 ;
114
112
odr_attr .val2 = 0 ;
115
113
116
- if (sensor_attr_set (ism330dhcx , SENSOR_CHAN_ACCEL_XYZ ,
117
- SENSOR_ATTR_SAMPLING_FREQUENCY , & odr_attr ) < 0 ) {
114
+ if (sensor_attr_set (ism330dhcx , SENSOR_CHAN_ACCEL_XYZ , SENSOR_ATTR_SAMPLING_FREQUENCY ,
115
+ & odr_attr ) < 0 ) {
118
116
printk ("Cannot set sampling frequency for ISM330DHCX accel\n" );
119
117
return ;
120
118
}
121
119
122
120
sensor_g_to_ms2 (16 , & fs_attr );
123
121
124
- if (sensor_attr_set (ism330dhcx , SENSOR_CHAN_ACCEL_XYZ ,
125
- SENSOR_ATTR_FULL_SCALE , & fs_attr ) < 0 ) {
122
+ if (sensor_attr_set (ism330dhcx , SENSOR_CHAN_ACCEL_XYZ , SENSOR_ATTR_FULL_SCALE , & fs_attr ) <
123
+ 0 ) {
126
124
printk ("Cannot set sampling frequency for ISM330DHCX accel\n" );
127
125
return ;
128
126
}
@@ -131,16 +129,16 @@ static void ism330dhcx_config(const struct device *ism330dhcx)
131
129
odr_attr .val1 = 208 ;
132
130
odr_attr .val2 = 0 ;
133
131
134
- if (sensor_attr_set (ism330dhcx , SENSOR_CHAN_GYRO_XYZ ,
135
- SENSOR_ATTR_SAMPLING_FREQUENCY , & odr_attr ) < 0 ) {
132
+ if (sensor_attr_set (ism330dhcx , SENSOR_CHAN_GYRO_XYZ , SENSOR_ATTR_SAMPLING_FREQUENCY ,
133
+ & odr_attr ) < 0 ) {
136
134
printk ("Cannot set sampling frequency for ISM330DHCX gyro\n" );
137
135
return ;
138
136
}
139
137
140
138
sensor_degrees_to_rad (250 , & fs_attr );
141
139
142
- if (sensor_attr_set (ism330dhcx , SENSOR_CHAN_GYRO_XYZ ,
143
- SENSOR_ATTR_FULL_SCALE , & fs_attr ) < 0 ) {
140
+ if (sensor_attr_set (ism330dhcx , SENSOR_CHAN_GYRO_XYZ , SENSOR_ATTR_FULL_SCALE , & fs_attr ) <
141
+ 0 ) {
144
142
printk ("Cannot set fs for ISM330DHCX gyro\n" );
145
143
return ;
146
144
}
@@ -224,27 +222,23 @@ int main(void)
224
222
printf ("X-NUCLEO-IKS02A1 sensor Mode 1 dashboard\n\n" );
225
223
226
224
printf ("IIS2DLPC: Accel (m.s-2): x: %.3f, y: %.3f, z: %.3f\n" ,
227
- sensor_value_to_double (& accel2 [0 ]),
228
- sensor_value_to_double (& accel2 [1 ]),
229
- sensor_value_to_double (& accel2 [2 ]));
225
+ sensor_value_to_double (& accel2 [0 ]), sensor_value_to_double (& accel2 [1 ]),
226
+ sensor_value_to_double (& accel2 [2 ]));
230
227
231
228
/* iis2mdc */
232
229
printf ("IIS2MDC: Magn (gauss): x: %.3f, y: %.3f, z: %.3f\n" ,
233
- sensor_value_to_double (& magn [0 ]),
234
- sensor_value_to_double (& magn [1 ]),
230
+ sensor_value_to_double (& magn [0 ]), sensor_value_to_double (& magn [1 ]),
235
231
sensor_value_to_double (& magn [2 ]));
236
232
237
233
printf ("IIS2MDC: Temperature: %.1f C\n" , sensor_value_to_double (& die_temp ));
238
234
239
235
printf ("ISM330DHCX: Accel (m.s-2): x: %.3f, y: %.3f, z: %.3f\n" ,
240
- sensor_value_to_double (& accel1 [0 ]),
241
- sensor_value_to_double (& accel1 [1 ]),
242
- sensor_value_to_double (& accel1 [2 ]));
236
+ sensor_value_to_double (& accel1 [0 ]), sensor_value_to_double (& accel1 [1 ]),
237
+ sensor_value_to_double (& accel1 [2 ]));
243
238
244
239
printf ("ISM330DHCX: GYro (dps): x: %.3f, y: %.3f, z: %.3f\n" ,
245
- sensor_value_to_double (& gyro [0 ]),
246
- sensor_value_to_double (& gyro [1 ]),
247
- sensor_value_to_double (& gyro [2 ]));
240
+ sensor_value_to_double (& gyro [0 ]), sensor_value_to_double (& gyro [1 ]),
241
+ sensor_value_to_double (& gyro [2 ]));
248
242
#ifdef CONFIG_IIS2DLPC_TRIGGER
249
243
printk ("%d:: iis2dlpc trig %d\n" , cnt , iis2dlpc_trig_cnt );
250
244
#endif
@@ -258,7 +252,6 @@ int main(void)
258
252
printk ("%d:: ism330dhcx gyr trig %d\n" , cnt , ism330dhcx_gyr_trig_cnt );
259
253
#endif
260
254
261
-
262
255
cnt ++ ;
263
256
k_sleep (K_MSEC (2000 ));
264
257
}
0 commit comments