1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * STMicroelectronics gyroscopes driver
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright 2012-2013 STMicroelectronics Inc.
6*4882a593Smuzhiyun *
7*4882a593Smuzhiyun * Denis Ciocca <denis.ciocca@st.com>
8*4882a593Smuzhiyun */
9*4882a593Smuzhiyun
10*4882a593Smuzhiyun #include <linux/module.h>
11*4882a593Smuzhiyun #include <linux/kernel.h>
12*4882a593Smuzhiyun #include <linux/slab.h>
13*4882a593Smuzhiyun #include <linux/stat.h>
14*4882a593Smuzhiyun #include <linux/interrupt.h>
15*4882a593Smuzhiyun #include <linux/i2c.h>
16*4882a593Smuzhiyun #include <linux/delay.h>
17*4882a593Smuzhiyun #include <linux/iio/iio.h>
18*4882a593Smuzhiyun #include <linux/iio/buffer.h>
19*4882a593Smuzhiyun #include <linux/iio/trigger_consumer.h>
20*4882a593Smuzhiyun #include <linux/iio/triggered_buffer.h>
21*4882a593Smuzhiyun
22*4882a593Smuzhiyun #include <linux/iio/common/st_sensors.h>
23*4882a593Smuzhiyun #include "st_gyro.h"
24*4882a593Smuzhiyun
st_gyro_trig_set_state(struct iio_trigger * trig,bool state)25*4882a593Smuzhiyun int st_gyro_trig_set_state(struct iio_trigger *trig, bool state)
26*4882a593Smuzhiyun {
27*4882a593Smuzhiyun struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun return st_sensors_set_dataready_irq(indio_dev, state);
30*4882a593Smuzhiyun }
31*4882a593Smuzhiyun
st_gyro_buffer_postenable(struct iio_dev * indio_dev)32*4882a593Smuzhiyun static int st_gyro_buffer_postenable(struct iio_dev *indio_dev)
33*4882a593Smuzhiyun {
34*4882a593Smuzhiyun int err;
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun err = st_sensors_set_axis_enable(indio_dev, indio_dev->active_scan_mask[0]);
37*4882a593Smuzhiyun if (err < 0)
38*4882a593Smuzhiyun return err;
39*4882a593Smuzhiyun
40*4882a593Smuzhiyun err = st_sensors_set_enable(indio_dev, true);
41*4882a593Smuzhiyun if (err < 0)
42*4882a593Smuzhiyun goto st_gyro_buffer_enable_all_axis;
43*4882a593Smuzhiyun
44*4882a593Smuzhiyun return 0;
45*4882a593Smuzhiyun
46*4882a593Smuzhiyun st_gyro_buffer_enable_all_axis:
47*4882a593Smuzhiyun st_sensors_set_axis_enable(indio_dev, ST_SENSORS_ENABLE_ALL_AXIS);
48*4882a593Smuzhiyun return err;
49*4882a593Smuzhiyun }
50*4882a593Smuzhiyun
st_gyro_buffer_predisable(struct iio_dev * indio_dev)51*4882a593Smuzhiyun static int st_gyro_buffer_predisable(struct iio_dev *indio_dev)
52*4882a593Smuzhiyun {
53*4882a593Smuzhiyun int err;
54*4882a593Smuzhiyun
55*4882a593Smuzhiyun err = st_sensors_set_enable(indio_dev, false);
56*4882a593Smuzhiyun if (err < 0)
57*4882a593Smuzhiyun return err;
58*4882a593Smuzhiyun
59*4882a593Smuzhiyun return st_sensors_set_axis_enable(indio_dev, ST_SENSORS_ENABLE_ALL_AXIS);
60*4882a593Smuzhiyun }
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun static const struct iio_buffer_setup_ops st_gyro_buffer_setup_ops = {
63*4882a593Smuzhiyun .postenable = &st_gyro_buffer_postenable,
64*4882a593Smuzhiyun .predisable = &st_gyro_buffer_predisable,
65*4882a593Smuzhiyun };
66*4882a593Smuzhiyun
st_gyro_allocate_ring(struct iio_dev * indio_dev)67*4882a593Smuzhiyun int st_gyro_allocate_ring(struct iio_dev *indio_dev)
68*4882a593Smuzhiyun {
69*4882a593Smuzhiyun return iio_triggered_buffer_setup(indio_dev, NULL,
70*4882a593Smuzhiyun &st_sensors_trigger_handler, &st_gyro_buffer_setup_ops);
71*4882a593Smuzhiyun }
72*4882a593Smuzhiyun
st_gyro_deallocate_ring(struct iio_dev * indio_dev)73*4882a593Smuzhiyun void st_gyro_deallocate_ring(struct iio_dev *indio_dev)
74*4882a593Smuzhiyun {
75*4882a593Smuzhiyun iio_triggered_buffer_cleanup(indio_dev);
76*4882a593Smuzhiyun }
77*4882a593Smuzhiyun
78*4882a593Smuzhiyun MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
79*4882a593Smuzhiyun MODULE_DESCRIPTION("STMicroelectronics gyroscopes buffer");
80*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
81