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 } watermark;
36 size_t count;
37 struct {
38 size_t gyro;
39 size_t accel;
40 size_t total;
41 } nb;
42 uint8_t data[2080] __aligned(IIO_DMA_MINALIGN);
43 };
44
45 /* FIFO data packet */
46 struct inv_icm42600_fifo_sensor_data {
47 __be16 x;
48 __be16 y;
49 __be16 z;
50 } __packed;
51 #define INV_ICM42600_FIFO_DATA_INVALID -32768
52
inv_icm42600_fifo_get_sensor_data(__be16 d)53 static inline int16_t inv_icm42600_fifo_get_sensor_data(__be16 d)
54 {
55 return be16_to_cpu(d);
56 }
57
58 static inline bool
inv_icm42600_fifo_is_data_valid(const struct inv_icm42600_fifo_sensor_data * s)59 inv_icm42600_fifo_is_data_valid(const struct inv_icm42600_fifo_sensor_data *s)
60 {
61 int16_t x, y, z;
62
63 x = inv_icm42600_fifo_get_sensor_data(s->x);
64 y = inv_icm42600_fifo_get_sensor_data(s->y);
65 z = inv_icm42600_fifo_get_sensor_data(s->z);
66
67 if (x == INV_ICM42600_FIFO_DATA_INVALID &&
68 y == INV_ICM42600_FIFO_DATA_INVALID &&
69 z == INV_ICM42600_FIFO_DATA_INVALID)
70 return false;
71
72 return true;
73 }
74
75 ssize_t inv_icm42600_fifo_decode_packet(const void *packet, const void **accel,
76 const void **gyro, const int8_t **temp,
77 const void **timestamp, unsigned int *odr);
78
79 extern const struct iio_buffer_setup_ops inv_icm42600_buffer_ops;
80
81 int inv_icm42600_buffer_init(struct inv_icm42600_state *st);
82
83 void inv_icm42600_buffer_update_fifo_period(struct inv_icm42600_state *st);
84
85 int inv_icm42600_buffer_set_fifo_en(struct inv_icm42600_state *st,
86 unsigned int fifo_en);
87
88 int inv_icm42600_buffer_update_watermark(struct inv_icm42600_state *st);
89
90 int inv_icm42600_buffer_fifo_read(struct inv_icm42600_state *st,
91 unsigned int max);
92
93 int inv_icm42600_buffer_fifo_parse(struct inv_icm42600_state *st);
94
95 int inv_icm42600_buffer_hwfifo_flush(struct inv_icm42600_state *st,
96 unsigned int count);
97
98 #endif
99