LXR linux/drivers/iio/pressure/st_pressure

   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
  25int 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
  32static int st_press_buffer_preenable(struct iio_dev *indio_dev)
  33{
  34        return st_sensors_set_enable(indio_dev, true);
  35}
  36
  37static 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
  54st_press_buffer_postenable_error:
  55        kfree(press_data->buffer_data);
  56allocate_memory_error:
  57        return err;
  58}
  59
  60static 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
  71st_press_buffer_predisable_error:
  72        kfree(press_data->buffer_data);
  73        return err;
  74}
  75
  76static 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
  82int 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
  88void st_press_deallocate_ring(struct iio_dev *indio_dev)
  89{
  90        iio_triggered_buffer_cleanup(indio_dev);
  91}
  92
  93MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
  94MODULE_DESCRIPTION("STMicroelectronics pressures buffer");
  95MODULE_LICENSE("GPL v2");
  96