1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
|
/*
ChibiOS - Copyright (C) 2016..2019 Rocco Marco Guglielmi
This file is part of ChibiOS.
ChibiOS is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 3 of the License, or
(at your option) any later version.
ChibiOS is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program. If not, see <http://www.gnu.org/licenses/>.
*/
/**
* @file lis302dl.h
* @brief LIS302DL MEMS interface module header.
*
* @addtogroup LIS302DL
* @ingroup EX_ST
* @{
*/
#ifndef _LIS302DL_H_
#define _LIS302DL_H_
#include "ex_accelerometer.h"
/*===========================================================================*/
/* Driver constants. */
/*===========================================================================*/
/**
* @name Version identification
* @{
*/
/**
* @brief LIS302DL driver version string.
*/
#define EX_LIS302DL_VERSION "1.1.1"
/**
* @brief LIS302DL driver version major number.
*/
#define EX_LIS302DL_MAJOR 1
/**
* @brief LIS302DL driver version minor number.
*/
#define EX_LIS302DL_MINOR 1
/**
* @brief LIS302DL driver version patch number.
*/
#define EX_LIS302DL_PATCH 1
/** @} */
/**
* @brief LIS302DL accelerometer subsystem characteristics.
* @note Sensitivity is expressed as milli-G/LSB whereas
* 1 milli-G = 0.00980665 m/s^2.
* @note Bias is expressed as milli-G.
*
* @{
*/
#define LIS302DL_ACC_NUMBER_OF_AXES 3U
#define LIS302DL_ACC_2G 2.0f
#define LIS302DL_ACC_8G 8.0f
#define LIS302DL_ACC_SENS_2G 18.0f
#define LIS302DL_ACC_SENS_8G 72.0f
#define LIS302DL_ACC_BIAS 0.0f
/** @} */
/**
* @name LIS302DL communication interfaces related bit masks
* @{
*/
#define LIS302DL_DI_MASK 0xFF
#define LIS302DL_DI(n) (1 << n)
#define LIS302DL_AD_MASK 0x3F
#define LIS302DL_AD(n) (1 << n)
#define LIS302DL_MS (1 << 6)
#define LIS302DL_RW (1 << 7)
/** @} */
/**
* @name LIS302DL register addresses
* @{
*/
#define LIS302DL_AD_WHO_AM_I 0x0F
#define LIS302DL_AD_CTRL_REG1 0x20
#define LIS302DL_AD_CTRL_REG2 0x21
#define LIS302DL_AD_CTRL_REG3 0x22
#define LIS302DL_AD_HP_FILER_RESET 0x23
#define LIS302DL_AD_STATUS_REG 0x27
#define LIS302DL_AD_OUT_X 0x29
#define LIS302DL_AD_OUT_Y 0x2B
#define LIS302DL_AD_OUT_Z 0x2D
#define LIS302DL_AD_FF_WU_CFG_1 0x30
#define LIS302DL_AD_FF_WU_SRC_1 0x31
#define LIS302DL_AD_FF_WU_THS_1 0x32
#define LIS302DL_AD_FF_WU_DURATION_1 0x33
#define LIS302DL_AD_FF_WU_CFG_2 0x34
#define LIS302DL_AD_FF_WU_SRC_2 0x35
#define LIS302DL_AD_FF_WU_THS_2 0x36
#define LIS302DL_AD_FF_WU_DURATION_2 0x37
#define LIS302DL_AD_CLICK_CFG 0x38
#define LIS302DL_AD_CLICK_SRC 0x39
#define LIS302DL_AD_CLICK_THSY_X 0x3B
#define LIS302DL_AD_CLICK_THSZ 0x3C
#define LIS302DL_AD_CLICK_TIME_LIMIT 0x3D
#define LIS302DL_AD_CLICK_LATENCY 0x3E
#define LIS302DL_AD_CLICK_WINDOW 0x3F
/** @} */
/**
* @name LIS302DL_CTRL_REG1 register bits definitions
* @{
*/
#define LIS302DL_CTRL_REG1_MASK 0xFF
#define LIS302DL_CTRL_REG1_XEN (1 << 0)
#define LIS302DL_CTRL_REG1_YEN (1 << 1)
#define LIS302DL_CTRL_REG1_ZEN (1 << 2)
#define LIS302DL_CTRL_REG1_STM (1 << 3)
#define LIS302DL_CTRL_REG1_STP (1 << 4)
#define LIS302DL_CTRL_REG1_FS_MASK 0x20
#define LIS302DL_CTRL_REG1_FS (1 << 5)
#define LIS302DL_CTRL_REG1_PD (1 << 6)
#define LIS302DL_CTRL_REG1_DR (1 << 7)
/** @} */
/**
* @name LIS302DL_CTRL_REG2 register bits definitions
* @{
*/
#define LIS302DL_CTRL_REG2_MASK 0xDF
#define LIS302DL_CTRL_REG2_HPCF1 (1 << 0)
#define LIS302DL_CTRL_REG2_HPCF2 (1 << 1)
#define LIS302DL_CTRL_REG2_HPFFWU1 (1 << 2)
#define LIS302DL_CTRL_REG2_HPFFWU2 (1 << 3)
#define LIS302DL_CTRL_REG2_FDS (1 << 4)
#define LIS302DL_CTRL_REG2_BOOT (1 << 6)
#define LIS302DL_CTRL_REG2_SIM (1 << 7)
/** @} */
/**
* @name LIS302DL_CTRL_REG3 register bits definitions
* @{
*/
#define LIS302DL_CTRL_REG3_MASK 0xFF
#define LIS302DL_CTRL_REG3_I1CFG0 (1 << 0)
#define LIS302DL_CTRL_REG3_I1CFG1 (1 << 1)
#define LIS302DL_CTRL_REG3_I1CFG2 (1 << 2)
#define LIS302DL_CTRL_REG3_I2CFG0 (1 << 3)
#define LIS302DL_CTRL_REG3_I2CFG1 (1 << 4)
#define LIS302DL_CTRL_REG3_I2CFG2 (1 << 5)
#define LIS302DL_CTRL_REG3_PP_OD (1 << 6)
#define LIS302DL_CTRL_REG3_IHL (1 << 7)
/** @} */
/*===========================================================================*/
/* Driver pre-compile time settings. */
/*===========================================================================*/
/**
* @name Configuration options
* @{
*/
/**
* @brief LIS302DL SPI interface switch.
* @details If set to @p TRUE the support for SPI is included.
* @note The default is @p TRUE.
*/
#if !defined(LIS302DL_USE_SPI) || defined(__DOXYGEN__)
#define LIS302DL_USE_SPI TRUE
#endif
/**
* @brief LIS302DL shared SPI switch.
* @details If set to @p TRUE the device acquires SPI bus ownership
* on each transaction.
* @note The default is @p FALSE. Requires SPI_USE_MUTUAL_EXCLUSION.
*/
#if !defined(LIS302DL_SHARED_SPI) || defined(__DOXYGEN__)
#define LIS302DL_SHARED_SPI FALSE
#endif
/**
* @brief LIS302DL I2C interface switch.
* @details If set to @p TRUE the support for I2C is included.
* @note The default is @p FALSE.
*/
#if !defined(LIS302DL_USE_I2C) || defined(__DOXYGEN__)
#define LIS302DL_USE_I2C FALSE
#endif
/**
* @brief LIS302DL shared I2C switch.
* @details If set to @p TRUE the device acquires I2C bus ownership
* on each transaction.
* @note The default is @p FALSE. Requires I2C_USE_MUTUAL_EXCLUSION.
*/
#if !defined(LIS302DL_SHARED_I2C) || defined(__DOXYGEN__)
#define LIS302DL_SHARED_I2C FALSE
#endif
/**
* @brief LIS302DL advanced configurations switch.
* @details If set to @p TRUE more configurations are available.
* @note The default is @p FALSE.
*/
#if !defined(LIS302DL_USE_ADVANCED) || defined(__DOXYGEN__)
#define LIS302DL_USE_ADVANCED FALSE
#endif
/** @} */
/*===========================================================================*/
/* Derived constants and error checks. */
/*===========================================================================*/
#if !(LIS302DL_USE_SPI ^ LIS302DL_USE_I2C)
#error "LIS302DL_USE_SPI and LIS302DL_USE_I2C cannot be both true or both false"
#endif
#if LIS302DL_USE_SPI && !HAL_USE_SPI
#error "LIS302DL_USE_SPI requires HAL_USE_SPI"
#endif
#if LIS302DL_SHARED_SPI && !SPI_USE_MUTUAL_EXCLUSION
#error "LIS302DL_SHARED_SPI requires SPI_USE_MUTUAL_EXCLUSION"
#endif
#if LIS302DL_USE_I2C && !HAL_USE_I2C
#error "LIS302DL_USE_I2C requires HAL_USE_I2C"
#endif
#if LIS302DL_SHARED_I2C && !I2C_USE_MUTUAL_EXCLUSION
#error "LIS302DL_SHARED_I2C requires I2C_USE_MUTUAL_EXCLUSION"
#endif
/*
* CHTODO: Add support for LIS302DL over I2C.
*/
#if LIS302DL_USE_I2C
#error "LIS302DL over I2C still not supported"
#endif
/*===========================================================================*/
/* Driver data structures and types. */
/*===========================================================================*/
/**
* @name LIS302DL data structures and types
* @{
*/
/**
* @brief Structure representing a LIS302DL driver.
*/
typedef struct LIS302DLDriver LIS302DLDriver;
/**
* @brief LIS302DL full scale.
*/
typedef enum {
LIS302DL_ACC_FS_2G = 0x00, /**< Full scale �2g. */
LIS302DL_ACC_FS_8G = 0x20 /**< Full scale �8g. */
}lis302dl_acc_fs_t;
/**
* @brief LIS302DL output data rate and bandwidth.
*/
typedef enum {
LIS302DL_ACC_ODR_100HZ = 0x00, /**< ODR 100 Hz. */
LIS302DL_ACC_ODR_400HZ = 0x80 /**< ODR 400 Hz. */
}lis302dl_acc_odr_t;
/**
* @brief LIS302DL high pass filtering.
*/
typedef enum {
LIS302DL_ACC_HP_DISABLED = 0x00, /**< HP bypassed. */
LIS302DL_ACC_HP_0 = 0x10, /**< HP cutoff 2Hz (ODR 100Hz) or 8Hz */
LIS302DL_ACC_HP_1 = 0x11, /**< HP cutoff 1Hz or 4Hz */
LIS302DL_ACC_HP_2 = 0x12, /**< HP cutoff 0.5Hz or 2Hz */
LIS302DL_ACC_HP_3 = 0x13 /**< HP cutoff 0.25Hz or 1Hz */
}lis302dl_acc_hp_t;
/**
* @brief Driver state machine possible states.
*/
typedef enum {
LIS302DL_UNINIT = 0, /**< Not initialized. */
LIS302DL_STOP = 1, /**< Stopped. */
LIS302DL_READY = 2, /**< Ready. */
} lis302dl_state_t;
/**
* @brief LIS302DL configuration structure.
*/
typedef struct {
#if (LIS302DL_USE_SPI) || defined(__DOXYGEN__)
/**
* @brief SPI driver associated to this LIS302DL.
*/
SPIDriver *spip;
/**
* @brief SPI configuration associated to this LIS302DL.
*/
const SPIConfig *spicfg;
#endif /* LIS302DL_USE_SPI */
#if (LIS302DL_USE_I2C) || defined(__DOXYGEN__)
/**
* @brief I2C driver associated to this LIS302DL.
*/
I2CDriver *i2cp;
/**
* @brief I2C configuration associated to this LIS302DL.
*/
const I2CConfig *i2ccfg;
#endif /* LIS302DL_USE_I2C */
/**
* @brief LIS302DL accelerometer subsystem initial sensitivity.
*/
float *accsensitivity;
/**
* @brief LIS302DL accelerometer subsystem initial bias.
*/
float *accbias;
/**
* @brief LIS302DL accelerometer subsystem initial full scale.
*/
lis302dl_acc_fs_t accfullscale;
/**
* @brief LIS302DL output data rate selection.
*/
lis302dl_acc_odr_t accoutputdatarate;
#if LIS302DL_USE_ADVANCED || defined(__DOXYGEN__)
/**
* @brief LIS302DL high pass filtering.
*/
lis302dl_acc_hp_t acchighpass;
#endif
} LIS302DLConfig;
/**
* @brief @p LIS302DL specific methods.
*/
#define _lis302dl_methods_alone \
/* Change full scale value of LIS302DL .*/ \
msg_t (*set_full_scale)(LIS302DLDriver *devp, lis302dl_acc_fs_t fs);
/**
* @brief @p LIS302DL specific methods with inherited ones.
*/
#define _lis302dl_methods \
_base_object_methods \
_lis302dl_methods_alone
/**
* @extends BaseObjectVMT
*
* @brief @p LIS302DL accelerometer virtual methods table.
*/
struct LIS302DLVMT {
_lis302dl_methods
};
/**
* @brief @p LIS302DLDriver specific data.
*/
#define _lis302dl_data \
/* Driver state.*/ \
lis302dl_state_t state; \
/* Current configuration data.*/ \
const LIS302DLConfig *config; \
/* Accelerometer subsystem axes number.*/ \
size_t accaxes; \
/* Current sensitivity.*/ \
float accsensitivity[LIS302DL_ACC_NUMBER_OF_AXES]; \
/* Bias data.*/ \
int32_t accbias[LIS302DL_ACC_NUMBER_OF_AXES]; \
/* Current full scale value.*/ \
float accfullscale;
/**
* @brief LIS302DL 3-axis accelerometer class.
*/
struct LIS302DLDriver {
/** @brief Virtual Methods Table.*/
const struct LIS302DLVMT *vmt;
/** @brief Base accelerometer interface.*/
BaseAccelerometer acc_if;
_lis302dl_data
};
/** @} */
/*===========================================================================*/
/* Driver macros. */
/*===========================================================================*/
/**
* @brief Return the number of axes of the BaseAccelerometer.
*
* @param[in] devp pointer to @p LIS302DLDriver.
*
* @return the number of axes.
*
* @api
*/
#define lis302dlAccelerometerGetAxesNumber(devp) \
accelerometerGetAxesNumber(&((devp)->acc_if))
/**
* @brief Retrieves raw data from the BaseAccelerometer.
* @note This data is retrieved from MEMS register without any algebraical
* manipulation.
* @note The axes array must be at least the same size of the
* BaseAccelerometer axes number.
*
* @param[in] devp pointer to @p LIS302DLDriver.
* @param[out] axes a buffer which would be filled with raw data.
*
* @return The operation status.
* @retval MSG_OK if the function succeeded.
* @retval MSG_RESET if one or more I2C errors occurred, the errors can
* be retrieved using @p i2cGetErrors().
* @retval MSG_TIMEOUT if a timeout occurred before operation end.
*
* @api
*/
#define lis302dlAccelerometerReadRaw(devp, axes) \
accelerometerReadRaw(&((devp)->acc_if), axes)
/**
* @brief Retrieves cooked data from the BaseAccelerometer.
* @note This data is manipulated according to the formula
* cooked = (raw * sensitivity) - bias.
* @note Final data is expressed as milli-G.
* @note The axes array must be at least the same size of the
* BaseAccelerometer axes number.
*
* @param[in] devp pointer to @p LIS302DLDriver.
* @param[out] axes a buffer which would be filled with cooked data.
*
* @return The operation status.
* @retval MSG_OK if the function succeeded.
* @retval MSG_RESET if one or more I2C errors occurred, the errors can
* be retrieved using @p i2cGetErrors().
* @retval MSG_TIMEOUT if a timeout occurred before operation end.
*
* @api
*/
#define lis302dlAccelerometerReadCooked(devp, axes) \
accelerometerReadCooked(&((devp)->acc_if), axes)
/**
* @brief Set bias values for the BaseAccelerometer.
* @note Bias must be expressed as milli-G.
* @note The bias buffer must be at least the same size of the
* BaseAccelerometer axes number.
*
* @param[in] devp pointer to @p LIS302DLDriver.
* @param[in] bp a buffer which contains biases.
*
* @return The operation status.
* @retval MSG_OK if the function succeeded.
*
* @api
*/
#define lis302dlAccelerometerSetBias(devp, bp) \
accelerometerSetBias(&((devp)->acc_if), bp)
/**
* @brief Reset bias values for the BaseAccelerometer.
* @note Default biases value are obtained from device datasheet when
* available otherwise they are considered zero.
*
* @param[in] devp pointer to @p LIS302DLDriver.
*
* @return The operation status.
* @retval MSG_OK if the function succeeded.
*
* @api
*/
#define lis302dlAccelerometerResetBias(devp) \
accelerometerResetBias(&((devp)->acc_if))
/**
* @brief Set sensitivity values for the BaseAccelerometer.
* @note Sensitivity must be expressed as milli-G/LSB.
* @note The sensitivity buffer must be at least the same size of the
* BaseAccelerometer axes number.
*
* @param[in] devp pointer to @p LIS302DLDriver.
* @param[in] sp a buffer which contains sensitivities.
*
* @return The operation status.
* @retval MSG_OK if the function succeeded.
*
* @api
*/
#define lis302dlAccelerometerSetSensitivity(devp, sp) \
accelerometerSetSensitivity(&((devp)->acc_if), sp)
/**
* @brief Reset sensitivity values for the BaseAccelerometer.
* @note Default sensitivities value are obtained from device datasheet.
*
* @param[in] devp pointer to @p LIS302DLDriver.
*
* @return The operation status.
* @retval MSG_OK if the function succeeded.
* @retval MSG_RESET otherwise.
*
* @api
*/
#define lis302dlAccelerometerResetSensitivity(devp) \
accelerometerResetSensitivity(&((devp)->acc_if))
/**
* @brief Changes the LIS302DLDriver accelerometer fullscale value.
* @note This function also rescale sensitivities and biases based on
* previous and next fullscale value.
* @note A recalibration is highly suggested after calling this function.
*
* @param[in] devp pointer to @p LIS302DLDriver.
* @param[in] fs new fullscale value.
*
* @return The operation status.
* @retval MSG_OK if the function succeeded.
* @retval MSG_RESET otherwise.
*
* @api
*/
#define lis302dlAccelerometerSetFullScale(devp, fs) \
(devp)->vmt->acc_set_full_scale(devp, fs)
/*===========================================================================*/
/* External declarations. */
/*===========================================================================*/
#ifdef __cplusplus
extern "C" {
#endif
void lis302dlObjectInit(LIS302DLDriver *devp);
void lis302dlStart(LIS302DLDriver *devp, const LIS302DLConfig *config);
void lis302dlStop(LIS302DLDriver *devp);
#ifdef __cplusplus
}
#endif
#endif /* _LIS302DL_H_ */
/** @} */
|