Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 23491b51 authored by Denis Ciocca's avatar Denis Ciocca Committed by Jonathan Cameron
Browse files

iio:common: Add STMicroelectronics common library 



This patch add a generic library for STMicroelectronics 3-axis sensors.

Signed-off-by: default avatarDenis Ciocca <denis.ciocca@st.com>
Reviewed-by: default avatarLars-Peter Clausen <lars@metafoo.de>
Signed-off-by: default avatarJonathan Cameron <jic23@kernel.org>
parent 085494ac

drivers/iio/common/Kconfig

+1 −0
Original line number Diff line number Diff line
@@ -3,3 +3,4 @@ 
#



source "drivers/iio/common/hid-sensors/Kconfig"

source "drivers/iio/common/st_sensors/Kconfig"

drivers/iio/common/Makefile

+1 −0
Original line number Diff line number Diff line
@@ -7,3 +7,4 @@ 
#



obj-y += hid-sensors/

obj-y += st_sensors/

drivers/iio/common/st_sensors/Kconfig

0 → 100644
+14 −0
Original line number Diff line number Diff line 
#

# STMicroelectronics sensors common library

#



config IIO_ST_SENSORS_I2C

	tristate



config IIO_ST_SENSORS_SPI

	tristate



config IIO_ST_SENSORS_CORE

	tristate

	select IIO_ST_SENSORS_I2C if I2C

	select IIO_ST_SENSORS_SPI if SPI_MASTER

drivers/iio/common/st_sensors/Makefile

0 → 100644
+10 −0
Original line number Diff line number Diff line 
#

# Makefile for the STMicroelectronics sensor common modules.

#



obj-$(CONFIG_IIO_ST_SENSORS_I2C) += st_sensors_i2c.o

obj-$(CONFIG_IIO_ST_SENSORS_SPI) += st_sensors_spi.o

obj-$(CONFIG_IIO_ST_SENSORS_CORE) += st_sensors.o

st_sensors-y := st_sensors_core.o

st_sensors-$(CONFIG_IIO_BUFFER) += st_sensors_buffer.o

st_sensors-$(CONFIG_IIO_TRIGGER) += st_sensors_trigger.o

drivers/iio/common/st_sensors/st_sensors_buffer.c

0 → 100644
+116 −0
Original line number Diff line number Diff line 
/*

 * STMicroelectronics sensors buffer library driver

 *

 * Copyright 2012-2013 STMicroelectronics Inc.

 *

 * Denis Ciocca <denis.ciocca@st.com>

 *

 * Licensed under the GPL-2.

 */



#include <linux/kernel.h>

#include <linux/module.h>

#include <linux/slab.h>

#include <linux/iio/iio.h>

#include <linux/iio/trigger.h>

#include <linux/interrupt.h>

#include <linux/iio/buffer.h>

#include <linux/iio/trigger_consumer.h>

#include <linux/iio/triggered_buffer.h>

#include <linux/irqreturn.h>



#include <linux/iio/common/st_sensors.h>





int st_sensors_get_buffer_element(struct iio_dev *indio_dev, u8 *buf)

{

	int i, n = 0, len;

	u8 addr[ST_SENSORS_NUMBER_DATA_CHANNELS];

	struct st_sensor_data *sdata = iio_priv(indio_dev);



	for (i = 0; i < ST_SENSORS_NUMBER_DATA_CHANNELS; i++) {

		if (test_bit(i, indio_dev->active_scan_mask)) {

			addr[n] = indio_dev->channels[i].address;

			n++;

		}

	}

	switch (n) {

	case 1:

		len = sdata->tf->read_multiple_byte(&sdata->tb, sdata->dev,

			addr[0], ST_SENSORS_BYTE_FOR_CHANNEL, buf,

			sdata->multiread_bit);

		break;

	case 2:

		if ((addr[1] - addr[0]) == ST_SENSORS_BYTE_FOR_CHANNEL) {

			len = sdata->tf->read_multiple_byte(&sdata->tb,

					sdata->dev, addr[0],

					ST_SENSORS_BYTE_FOR_CHANNEL*n,

					buf, sdata->multiread_bit);

		} else {

			u8 rx_array[ST_SENSORS_BYTE_FOR_CHANNEL*

				    ST_SENSORS_NUMBER_DATA_CHANNELS];

			len = sdata->tf->read_multiple_byte(&sdata->tb,

				sdata->dev, addr[0],

				ST_SENSORS_BYTE_FOR_CHANNEL*

				ST_SENSORS_NUMBER_DATA_CHANNELS,

				rx_array, sdata->multiread_bit);

			if (len < 0)

				goto read_data_channels_error;



			for (i = 0; i < n * ST_SENSORS_NUMBER_DATA_CHANNELS;

									i++) {

				if (i < n)

					buf[i] = rx_array[i];

				else

					buf[i] = rx_array[n + i];

			}

			len = ST_SENSORS_BYTE_FOR_CHANNEL*n;

		}

		break;

	case 3:

		len = sdata->tf->read_multiple_byte(&sdata->tb, sdata->dev,

			addr[0], ST_SENSORS_BYTE_FOR_CHANNEL*

			ST_SENSORS_NUMBER_DATA_CHANNELS,

			buf, sdata->multiread_bit);

		break;

	default:

		len = -EINVAL;

		goto read_data_channels_error;

	}

	if (len != ST_SENSORS_BYTE_FOR_CHANNEL*n) {

		len = -EIO;

		goto read_data_channels_error;

	}



read_data_channels_error:

	return len;

}

EXPORT_SYMBOL(st_sensors_get_buffer_element);



irqreturn_t st_sensors_trigger_handler(int irq, void *p)

{

	int len;

	struct iio_poll_func *pf = p;

	struct iio_dev *indio_dev = pf->indio_dev;

	struct st_sensor_data *sdata = iio_priv(indio_dev);



	len = st_sensors_get_buffer_element(indio_dev, sdata->buffer_data);

	if (len < 0)

		goto st_sensors_get_buffer_element_error;



	if (indio_dev->scan_timestamp)

		*(s64 *)((u8 *)sdata->buffer_data +

				ALIGN(len, sizeof(s64))) = pf->timestamp;



	iio_push_to_buffers(indio_dev, sdata->buffer_data);



st_sensors_get_buffer_element_error:

	iio_trigger_notify_done(indio_dev->trig);



	return IRQ_HANDLED;

}

EXPORT_SYMBOL(st_sensors_trigger_handler);



MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");

MODULE_DESCRIPTION("STMicroelectronics ST-sensors buffer");

MODULE_LICENSE("GPL v2");