lis3dh/example/fifo.c

56 lines
1.2 KiB
C
Raw Normal View History

2023-12-30 13:10:40 +00:00
#define _GNU_SOURCE
#include <unistd.h>
#include <stdio.h>
#include "lis3dh.h"
#include "i2c.h"
int main() {
lis3dh_t lis;
2024-01-06 17:49:36 +00:00
struct lis3dh_fifo_data fifo;
2023-12-30 13:10:40 +00:00
int i;
lis.dev.init = i2c_init;
lis.dev.read = i2c_read;
lis.dev.write = i2c_write;
lis.dev.sleep = usleep;
lis.dev.deinit = i2c_deinit;
2024-01-02 15:35:35 +00:00
/* initialise LIS3DH struct */
2023-12-30 13:10:40 +00:00
if (lis3dh_init(&lis)) {
/* error handling */
}
2024-01-02 15:35:35 +00:00
/* reset device just in case */
if (lis3dh_reset(&lis)) {
/* error handling */
}
2023-12-30 13:10:40 +00:00
lis.cfg.mode = LIS3DH_MODE_HR;
lis.cfg.range = LIS3DH_FS_4G;
lis.cfg.rate = LIS3DH_ODR_100_HZ;
lis.cfg.fifo.mode = LIS3DH_FIFO_MODE_NORMAL;
2024-01-02 15:35:35 +00:00
/* write device config */
2023-12-30 13:10:40 +00:00
if (lis3dh_configure(&lis)) {
/* error handling */
}
2024-01-06 17:49:36 +00:00
/* read as many [x y z] sets as specified by watermark level (size) default (max/32) */
/* copy them to the fifo data struct `fifo' */
if (lis3dh_read_fifo(&lis, &fifo)) {
2023-12-30 13:10:40 +00:00
/* error handling */
}
/* read out fifo buffer data */
2024-01-06 17:49:36 +00:00
for(i=0; i<fifo.size; i++) {
printf("x: %d mg, y: %d mg, z: %d mg\n", fifo.x[i], fifo.y[i], fifo.z[i]);
2023-12-30 13:10:40 +00:00
}
2024-01-02 15:35:35 +00:00
/* deinitialise struct */
2023-12-30 13:10:40 +00:00
if (lis3dh_deinit(&lis)) {
/* error handling */
}
return 0;
}