| | 1 | // SPDX-License-Identifier: GPL-2.0-only |
| | 2 | /* |
| | 3 | * STMicroelectronics pressures driver |
| | 4 | * |
| | 5 | * Copyright 2013 STMicroelectronics Inc. |
| | 6 | * |
| | 7 | * Denis Ciocca <denis.ciocca@st.com> |
| | 8 | */ |
| | 9 | |
| | 10 | #include <linux/module.h> |
| | 11 | #include <linux/kernel.h> |
| | 12 | #include <linux/slab.h> |
| | 13 | #include <linux/stat.h> |
| | 14 | #include <linux/interrupt.h> |
| | 15 | #include <linux/i2c.h> |
| | 16 | #include <linux/delay.h> |
| | 17 | #include <linux/iio/iio.h> |
| | 18 | #include <linux/iio/buffer.h> |
| | 19 | #include <linux/iio/trigger_consumer.h> |
| | 20 | #include <linux/iio/triggered_buffer.h> |
| | 21 | |
| | 22 | #include <linux/iio/common/st_sensors.h> |
| | 23 | #include "st_pressure.h" |
| | 24 | |
| | 25 | int st_press_trig_set_state(struct iio_trigger *trig, bool state) |
| | 26 | { |
| | 27 | struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig); |
| | 28 | |
| | 29 | return st_sensors_set_dataready_irq(indio_dev, state); |
| | 30 | } |
| | 31 | |
| | 32 | static int st_press_buffer_preenable(struct iio_dev *indio_dev) |
| | 33 | { |
| | 34 | return st_sensors_set_enable(indio_dev, true); |
| | 35 | } |
| | 36 | |
| | 37 | static int st_press_buffer_postenable(struct iio_dev *indio_dev) |
| | 38 | { |
| | 39 | int err; |
| | 40 | struct st_sensor_data *press_data = iio_priv(indio_dev); |
| | 41 | |
| | 42 | press_data->buffer_data = kmalloc(indio_dev->scan_bytes, GFP_KERNEL); |
| | 43 | if (press_data->buffer_data == NULL) { |
| | 44 | err = -ENOMEM; |
| | 45 | goto allocate_memory_error; |
| | 46 | } |
| | 47 | |
| | 48 | err = iio_triggered_buffer_postenable(indio_dev); |
| | 49 | if (err < 0) |
| | 50 | goto st_press_buffer_postenable_error; |
| | 51 | |
| | 52 | return err; |
| | 53 | |
| | 54 | st_press_buffer_postenable_error: |
| | 55 | kfree(press_data->buffer_data); |
| | 56 | allocate_memory_error: |
| | 57 | return err; |
| | 58 | } |
| | 59 | |
| | 60 | static int st_press_buffer_predisable(struct iio_dev *indio_dev) |
| | 61 | { |
| | 62 | int err; |
| | 63 | struct st_sensor_data *press_data = iio_priv(indio_dev); |
| | 64 | |
| | 65 | err = iio_triggered_buffer_predisable(indio_dev); |
| | 66 | if (err < 0) |
| | 67 | goto st_press_buffer_predisable_error; |
| | 68 | |
| | 69 | err = st_sensors_set_enable(indio_dev, false); |
| | 70 | |
| | 71 | st_press_buffer_predisable_error: |
| | 72 | kfree(press_data->buffer_data); |
| | 73 | return err; |
| | 74 | } |
| | 75 | |
| | 76 | static const struct iio_buffer_setup_ops st_press_buffer_setup_ops = { |
| | 77 | .preenable = &st_press_buffer_preenable, |
| | 78 | .postenable = &st_press_buffer_postenable, |
| | 79 | .predisable = &st_press_buffer_predisable, |
| | 80 | }; |
| | 81 | |
| | 82 | int st_press_allocate_ring(struct iio_dev *indio_dev) |
| | 83 | { |
| | 84 | return iio_triggered_buffer_setup(indio_dev, NULL, |
| | 85 | &st_sensors_trigger_handler, &st_press_buffer_setup_ops); |
| | 86 | } |
| | 87 | |
| | 88 | void st_press_deallocate_ring(struct iio_dev *indio_dev) |
| | 89 | { |
| | 90 | iio_triggered_buffer_cleanup(indio_dev); |
| | 91 | } |
| | 92 | |
| | 93 | MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>"); |
| | 94 | MODULE_DESCRIPTION("STMicroelectronics pressures buffer"); |
| | 95 | MODULE_LICENSE("GPL v2"); |
projects / mirror_ubuntu-eoan-kernel.git / blame_incremental