lis3dh/README.md

356 lines
9.0 KiB
Markdown
Raw Normal View History

2023-12-19 10:21:40 +00:00
# LIS3DH
2023-12-27 19:54:47 +00:00
A C89 driver for the 3-axis accelerometer LIS3DH. Supports both i2c and SPI.
> ### Features
> - FIFO of varying watermark level, up to 32
2023-12-27 19:54:47 +00:00
> - HP filter (4 c/o freq)
> - 2G, 4G, 8G and 16G
> - All power modes
> - Interrupt generation (soon)
> - Free-fall detection (soon)
> - Single and double click detection (soon)
> - 4D/6D orientation detection (soon)
2023-12-27 20:59:47 +00:00
## Implementation
This driver requires the user to provide pointers to the following abstractely named functions:
2023-12-27 19:54:47 +00:00
2023-12-27 20:59:47 +00:00
This project has example interface code for I2C used on Raspberry Pi.
```c
/* initialise the "interface" */
int init(void);
/* read from device register `reg`, `size` amount of bytes and write them to `dst` */
int read(uint8_t reg, uint8_t *dst, uint32_t size);
/* write `value` to device register `reg` */
int write(uint8_t reg, uint8_t value);
/* sleep for `dur_us` microseconds */
int sleep(uint32_t dur_us);
/* deinitalise the "interface" */
int deinit(void);
```
All above functions return `0` on success.
2023-12-27 19:54:47 +00:00
## Usage
Simple example:
```c
#define _GNU_SOURCE
#include <unistd.h> /* usleep() */
#include <stdio.h>
#include "lis3dh.h"
#include "i2c.h"
int main() {
2023-12-27 19:59:29 +00:00
lis3dh_t lis;
2023-12-27 19:54:47 +00:00
2023-12-27 19:59:29 +00:00
lis.dev.init = i2c_init;
2023-12-27 19:54:47 +00:00
lis.dev.read = i2c_read;
lis.dev.write = i2c_write;
lis.dev.sleep = usleep;
lis.dev.deinit = i2c_deinit;
2023-12-27 19:59:29 +00:00
if (lis3dh_init(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
}
2023-12-27 19:59:29 +00:00
lis.cfg.mode = LIS3DH_MODE_HR;
2023-12-27 19:54:47 +00:00
lis.cfg.range = LIS3DH_FS_4G;
lis.cfg.rate = LIS3DH_ODR_100_HZ;
2023-12-21 23:29:22 +00:00
2023-12-27 19:59:29 +00:00
if (lis3dh_configure(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
}
2023-12-27 19:59:29 +00:00
if (lis3dh_poll(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
2023-12-27 19:59:29 +00:00
}
2023-12-27 19:54:47 +00:00
2023-12-27 19:59:29 +00:00
if (lis3dh_read(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
2023-12-27 19:59:29 +00:00
}
2023-12-27 19:54:47 +00:00
2023-12-27 19:59:29 +00:00
printf("x: %f, y: %f, z: %f\n", lis.acc.x, lis.acc.y, lis.acc.z);
2023-12-27 19:54:47 +00:00
2023-12-27 19:59:29 +00:00
if (lis3dh_deinit(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
2023-12-27 19:59:29 +00:00
}
2023-12-27 19:54:47 +00:00
2023-12-27 19:59:29 +00:00
return 0;
2023-12-27 19:54:47 +00:00
}
```
The output should be something similar to this:
2023-12-21 23:29:22 +00:00
```
$ ./lis3dh
2023-12-27 19:54:47 +00:00
x: 0.540000, y: -0.882000, z: -0.100000
2023-12-22 10:22:43 +00:00
```
2023-12-27 19:54:47 +00:00
poll() and read() can be indefinitely looped for a constant data stream, like this:
```c
#define _GNU_SOURCE
#include <unistd.h>
#include <stdio.h>
#include "lis3dh.h"
#include "i2c.h"
2023-12-26 07:42:55 +00:00
2023-12-27 19:54:47 +00:00
int main() {
2023-12-27 19:59:29 +00:00
lis3dh_t lis;
2023-12-27 19:54:47 +00:00
int i;
2023-12-27 19:59:29 +00:00
lis.dev.init = i2c_init;
2023-12-27 19:54:47 +00:00
lis.dev.read = i2c_read;
lis.dev.write = i2c_write;
lis.dev.sleep = usleep;
lis.dev.deinit = i2c_deinit;
2023-12-27 19:59:29 +00:00
if (lis3dh_init(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
}
2023-12-27 19:59:29 +00:00
lis.cfg.mode = LIS3DH_MODE_HR;
2023-12-27 19:54:47 +00:00
lis.cfg.range = LIS3DH_FS_4G;
lis.cfg.rate = LIS3DH_ODR_100_HZ;
2023-12-27 19:59:29 +00:00
if (lis3dh_configure(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
}
for(i=0; i<10; i++) {
if (lis3dh_poll(&lis)) {
/* error handling */
2023-12-27 19:59:29 +00:00
}
2023-12-27 19:54:47 +00:00
2023-12-27 19:59:29 +00:00
if (lis3dh_read(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
2023-12-27 19:59:29 +00:00
}
2023-12-27 19:54:47 +00:00
printf("x: %f, y: %f, z: %f\n", lis.acc.x, lis.acc.y, lis.acc.z);
}
2023-12-27 19:59:29 +00:00
if (lis3dh_deinit(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
2023-12-27 19:59:29 +00:00
}
2023-12-27 19:54:47 +00:00
2023-12-27 19:59:29 +00:00
return 0;
2023-12-27 19:54:47 +00:00
}
```
Output:
```
$ ./lis3dh
x: 0.534000, y: -0.882000, z: -0.102000
x: 0.538000, y: -0.866000, z: -0.136000
x: 0.518000, y: -0.846000, z: -0.100000
x: 0.518000, y: -0.840000, z: -0.098000
x: 0.542000, y: -0.876000, z: -0.098000
x: 0.518000, y: -0.834000, z: -0.146000
x: 0.512000, y: -0.854000, z: -0.106000
x: 0.574000, y: -0.870000, z: -0.122000
x: 0.518000, y: -0.846000, z: -0.098000
x: 0.516000, y: -0.852000, z: -0.112000
```
## Using FIFO
Instead of polling for every single [x y z] set, a FIFO with programmable capacity ("watermark") can be used like such:
2023-12-27 20:59:47 +00:00
All FIFO readings use 10-bit resolution regardless of the mode set in `lis.cfg.mode`.
The watermark level can also be adjusted to a value [0-32] inclusive by modifying the `lis.cfg.fifo.fth` property before calling configure().
2023-12-27 19:54:47 +00:00
```c
#define _GNU_SOURCE
#include <unistd.h>
#include <stdio.h>
#include "lis3dh.h"
#include "i2c.h"
int main() {
2023-12-27 19:59:29 +00:00
lis3dh_t lis;
2023-12-27 19:54:47 +00:00
struct lis3dh_fifo_data data;
int i;
2023-12-27 19:59:29 +00:00
lis.dev.init = i2c_init;
2023-12-27 19:54:47 +00:00
lis.dev.read = i2c_read;
lis.dev.write = i2c_write;
lis.dev.sleep = usleep;
lis.dev.deinit = i2c_deinit;
2023-12-27 19:59:29 +00:00
if (lis3dh_init(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
}
2023-12-27 19:59:29 +00:00
lis.cfg.mode = LIS3DH_MODE_HR;
2023-12-27 19:54:47 +00:00
lis.cfg.range = LIS3DH_FS_4G;
lis.cfg.rate = LIS3DH_ODR_100_HZ;
lis.cfg.fifo.mode = LIS3DH_FIFO_MODE_NORMAL;
2023-12-26 07:42:55 +00:00
2023-12-27 19:59:29 +00:00
if (lis3dh_configure(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
}
2023-12-26 22:57:02 +00:00
2023-12-27 19:54:47 +00:00
if (lis3dh_poll_fifo(&lis)) {
/* error handling */
}
2023-12-22 10:22:43 +00:00
2023-12-27 19:54:47 +00:00
if (lis3dh_read_fifo(&lis, &data)) {
/* error handling */
}
2023-12-27 19:54:47 +00:00
/* read out fifo buffer data */
for(i=0; i<data.size; i++) {
printf("x: %f, y: %f, z: %f\n", data.x[i], data.y[i], data.z[i]);
}
2023-12-27 19:59:29 +00:00
if (lis3dh_deinit(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
2023-12-27 19:59:29 +00:00
}
2023-12-27 19:54:47 +00:00
2023-12-27 19:59:29 +00:00
return 0;
2023-12-27 19:54:47 +00:00
}
```
Output:
```
$ ./lis3dh
x: 0.544000, y: -0.904000, z: -0.104000
x: 0.536000, y: -0.880000, z: -0.104000
x: 0.528000, y: -0.880000, z: -0.104000
x: 0.528000, y: -0.880000, z: -0.104000
x: 0.536000, y: -0.880000, z: -0.104000
x: 0.536000, y: -0.880000, z: -0.104000
x: 0.536000, y: -0.880000, z: -0.104000
x: 0.536000, y: -0.880000, z: -0.104000
x: 0.536000, y: -0.880000, z: -0.104000
x: 0.536000, y: -0.880000, z: -0.104000
x: 0.536000, y: -0.880000, z: -0.104000
x: 0.536000, y: -0.880000, z: -0.128000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.568000, y: -0.872000, z: -0.160000
x: 0.560000, y: -0.872000, z: -0.160000
```
## Using the HP filter
The LIS3DH can optionally apply a HP filter on the sample data. It can be used to greatly reduce the "DC acceleration" present.
```c
#define _GNU_SOURCE
#include <unistd.h>
#include <stdio.h>
#include "lis3dh.h"
#include "i2c.h"
2023-12-27 19:54:47 +00:00
int main() {
2023-12-27 19:59:29 +00:00
lis3dh_t lis;
2023-12-27 19:54:47 +00:00
struct lis3dh_fifo_data data;
int i;
2023-12-26 22:57:02 +00:00
2023-12-27 19:59:29 +00:00
lis.dev.init = i2c_init;
2023-12-27 19:54:47 +00:00
lis.dev.read = i2c_read;
lis.dev.write = i2c_write;
lis.dev.sleep = usleep;
lis.dev.deinit = i2c_deinit;
2023-12-27 19:59:29 +00:00
if (lis3dh_init(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
}
2023-12-27 19:59:29 +00:00
lis.cfg.mode = LIS3DH_MODE_HR;
2023-12-27 19:54:47 +00:00
lis.cfg.range = LIS3DH_FS_4G;
lis.cfg.rate = LIS3DH_ODR_100_HZ;
lis.cfg.fifo.mode = LIS3DH_FIFO_MODE_NORMAL;
lis.cfg.filter.mode = LIS3DH_FILTER_MODE_AUTORESET;
lis.cfg.filter.cutoff = LIS3DH_FILTER_CUTOFF_8;
2023-12-27 19:59:29 +00:00
if (lis3dh_configure(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
}
if (lis3dh_poll_fifo(&lis)) {
/* error handling */
}
if (lis3dh_read_fifo(&lis, &data)) {
/* error handling */
}
/* read out fifo buffer data */
for(i=0; i<data.size; i++) {
printf("x: %f, y: %f, z: %f\n", data.x[i], data.y[i], data.z[i]);
}
2023-12-27 19:59:29 +00:00
if (lis3dh_deinit(&lis)) {
2023-12-27 19:54:47 +00:00
/* error handling */
2023-12-27 19:59:29 +00:00
}
2023-12-27 19:54:47 +00:00
2023-12-27 19:59:29 +00:00
return 0;
2023-12-27 19:54:47 +00:00
}
```
Output:
```
$ ./lis3dh
x: 0.008000, y: 0.000000, z: 0.000000
x: 0.000000, y: 0.000000, z: 0.016000
x: -0.016000, y: -0.008000, z: -0.008000
x: -0.032000, y: 0.008000, z: 0.000000
x: 0.024000, y: -0.016000, z: -0.032000
x: 0.024000, y: -0.016000, z: -0.032000
x: 0.024000, y: -0.016000, z: -0.032000
x: 0.024000, y: -0.016000, z: -0.032000
x: 0.024000, y: -0.016000, z: -0.032000
x: 0.024000, y: -0.016000, z: -0.032000
x: 0.024000, y: -0.016000, z: -0.032000
x: 0.024000, y: -0.016000, z: -0.008000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.016000, y: -0.032000, z: -0.040000
x: -0.008000, y: -0.024000, z: -0.008000
```
### Using i2c on STM32
Simple example code
```c
#define LIS3DH_I2C_ADDR 0x18
int i2c_write(uint8_t reg, uint8_t value) {
2023-12-27 19:59:29 +00:00
uint8_t buf[2] = { reg, value };
HAL_I2C_Master_Transmit(&hi2c2, LIS3DH_I2C_ADDR << 1, buf, 2, HAL_MAX_DELAY);
return 0;
}
int i2c_read(uint8_t reg, uint8_t *dst, uint32_t size) {
2023-12-27 19:59:29 +00:00
uint8_t send[2] = { reg, 0x00 };
HAL_I2C_Master_Transmit(&hi2c2, LIS3DH_I2C_ADDR << 1, send, 2, HAL_MAX_DELAY);
HAL_I2C_Master_Receive(&hi2c2, LIS3DH_I2C_ADDR << 1, dst, size, HAL_MAX_DELAY);
return 0;
}
2023-12-27 19:54:47 +00:00
```