1 /* SPDX-License-Identifier: GPL-2.0-or-later */
2 /*
3 * Copyright (C) 2020 Invensense, Inc.
4 */
5
6 #ifndef INV_ICM42600_BUFFER_H_
7 #define INV_ICM42600_BUFFER_H_
8
9 #include <linux/kernel.h>
10 #include <linux/bits.h>
11
12 struct inv_icm42600_state;
13
14 #define INV_ICM42600_SENSOR_GYRO BIT(0)
15 #define INV_ICM42600_SENSOR_ACCEL BIT(1)
16 #define INV_ICM42600_SENSOR_TEMP BIT(2)
17
18 /**
19 * struct inv_icm42600_fifo - FIFO state variables
20 * @on: reference counter for FIFO on.
21 * @en: bits field of INV_ICM42600_SENSOR_* for FIFO EN bits.
22 * @period: FIFO internal period.
23 * @watermark: watermark configuration values for accel and gyro.
24 * @count: number of bytes in the FIFO data buffer.
25 * @nb: gyro, accel and total samples in the FIFO data buffer.
26 * @data: FIFO data buffer aligned for DMA (2kB + 32 bytes of read cache).
27 */
28 struct inv_icm42600_fifo {
29 unsigned int on;
30 unsigned int en;
31 uint32_t period;
32 struct {
33 unsigned int gyro;
34 unsigned int accel;
35 unsigned int eff_gyro;
36 unsigned int eff_accel;
37 } watermark;
38 size_t count;
39 struct {
40 size_t gyro;
41 size_t accel;
42 size_t total;
43 } nb;
44 uint8_t data[2080] __aligned(IIO_DMA_MINALIGN);
45 };
46
47 /* FIFO data packet */
48 struct inv_icm42600_fifo_sensor_data {
49 __be16 x;
50 __be16 y;
51 __be16 z;
52 } __packed;
53 #define INV_ICM42600_FIFO_DATA_INVALID -32768
54
inv_icm42600_fifo_get_sensor_data(__be16 d)55 static inline int16_t inv_icm42600_fifo_get_sensor_data(__be16 d)
56 {
57 return be16_to_cpu(d);
58 }
59
60 static inline bool
inv_icm42600_fifo_is_data_valid(const struct inv_icm42600_fifo_sensor_data * s)61 inv_icm42600_fifo_is_data_valid(const struct inv_icm42600_fifo_sensor_data *s)
62 {
63 int16_t x, y, z;
64
65 x = inv_icm42600_fifo_get_sensor_data(s->x);
66 y = inv_icm42600_fifo_get_sensor_data(s->y);
67 z = inv_icm42600_fifo_get_sensor_data(s->z);
68
69 if (x == INV_ICM42600_FIFO_DATA_INVALID &&
70 y == INV_ICM42600_FIFO_DATA_INVALID &&
71 z == INV_ICM42600_FIFO_DATA_INVALID)
72 return false;
73
74 return true;
75 }
76
77 ssize_t inv_icm42600_fifo_decode_packet(const void *packet, const void **accel,
78 const void **gyro, const int8_t **temp,
79 const void **timestamp, unsigned int *odr);
80
81 extern const struct iio_buffer_setup_ops inv_icm42600_buffer_ops;
82
83 int inv_icm42600_buffer_init(struct inv_icm42600_state *st);
84
85 void inv_icm42600_buffer_update_fifo_period(struct inv_icm42600_state *st);
86
87 int inv_icm42600_buffer_set_fifo_en(struct inv_icm42600_state *st,
88 unsigned int fifo_en);
89
90 int inv_icm42600_buffer_update_watermark(struct inv_icm42600_state *st);
91
92 int inv_icm42600_buffer_fifo_read(struct inv_icm42600_state *st,
93 unsigned int max);
94
95 int inv_icm42600_buffer_fifo_parse(struct inv_icm42600_state *st);
96
97 int inv_icm42600_buffer_hwfifo_flush(struct inv_icm42600_state *st,
98 unsigned int count);
99
100 #endif
101