staging: iio: new adis16203 driver (f11ba4f5) · Commits · e / devices / android_kernel_oneplus_sm7250

drivers/staging/iio/accel/Kconfig

+9 −0

Original line number	Diff line number	Diff line
		@@ -12,6 +12,15 @@ config ADIS16201
		Say yes here to build support for Analog Devices adis16201 dual-axis
		digital inclinometer and accelerometer.

		config ADIS16203
		tristate "Analog Devices ADIS16203 Programmable 360 Degrees Inclinometer"
		depends on SPI
		select IIO_TRIGGER if IIO_RING_BUFFER
		select IIO_SW_RING if IIO_RING_BUFFER
		help
		Say yes here to build support for Analog Devices adis16203 Programmable
		360 Degrees Inclinometer.

		config ADIS16209
		tristate "Analog Devices ADIS16209 Dual-Axis Digital Inclinometer and Accelerometer"
		depends on SPI

drivers/staging/iio/accel/Makefile

+4 −0

Original line number	Diff line number	Diff line
		@@ -6,6 +6,10 @@ adis16201-y := adis16201_core.o
		adis16201-$(CONFIG_IIO_RING_BUFFER) += adis16201_ring.o adis16201_trigger.o
		obj-$(CONFIG_ADIS16201) += adis16201.o

		adis16203-y := adis16203_core.o
		adis16203-$(CONFIG_IIO_RING_BUFFER) += adis16203_ring.o adis16203_trigger.o
		obj-$(CONFIG_ADIS16203) += adis16203.o

		adis16209-y := adis16209_core.o
		adis16209-$(CONFIG_IIO_RING_BUFFER) += adis16209_ring.o adis16209_trigger.o
		obj-$(CONFIG_ADIS16209) += adis16209.o

drivers/staging/iio/accel/adis16203.h

0 → 100644

+143 −0

Original line number	Diff line number	Diff line
		#ifndef SPI_ADIS16203_H_
		#define SPI_ADIS16203_H_

		#define ADIS16203_STARTUP_DELAY 220 /* ms */

		#define ADIS16203_READ_REG(a) a
		#define ADIS16203_WRITE_REG(a) ((a) \| 0x80)

		#define ADIS16203_FLASH_CNT 0x00 /* Flash memory write count */
		#define ADIS16203_SUPPLY_OUT 0x02 /* Output, power supply */
		#define ADIS16203_AUX_ADC 0x08 /* Output, auxiliary ADC input */
		#define ADIS16203_TEMP_OUT 0x0A /* Output, temperature */
		#define ADIS16203_XINCL_OUT 0x0C /* Output, x-axis inclination */
		#define ADIS16203_YINCL_OUT 0x0E /* Output, y-axis inclination */
		#define ADIS16203_INCL_NULL 0x18 /* Incline null calibration */
		#define ADIS16203_ALM_MAG1 0x20 /* Alarm 1 amplitude threshold */
		#define ADIS16203_ALM_MAG2 0x22 /* Alarm 2 amplitude threshold */
		#define ADIS16203_ALM_SMPL1 0x24 /* Alarm 1, sample period */
		#define ADIS16203_ALM_SMPL2 0x26 /* Alarm 2, sample period */
		#define ADIS16203_ALM_CTRL 0x28 /* Alarm control */
		#define ADIS16203_AUX_DAC 0x30 /* Auxiliary DAC data */
		#define ADIS16203_GPIO_CTRL 0x32 /* General-purpose digital input/output control */
		#define ADIS16203_MSC_CTRL 0x34 /* Miscellaneous control */
		#define ADIS16203_SMPL_PRD 0x36 /* Internal sample period (rate) control */
		#define ADIS16203_AVG_CNT 0x38 /* Operation, filter configuration */
		#define ADIS16203_SLP_CNT 0x3A /* Operation, sleep mode control */
		#define ADIS16203_DIAG_STAT 0x3C /* Diagnostics, system status register */
		#define ADIS16203_GLOB_CMD 0x3E /* Operation, system command register */

		#define ADIS16203_OUTPUTS 5

		/* MSC_CTRL */
		#define ADIS16203_MSC_CTRL_PWRUP_SELF_TEST (1 << 10) /* Self-test at power-on: 1 = disabled, 0 = enabled */
		#define ADIS16203_MSC_CTRL_REVERSE_ROT_EN (1 << 9) /* Reverses rotation of both inclination outputs */
		#define ADIS16203_MSC_CTRL_SELF_TEST_EN (1 << 8) /* Self-test enable */
		#define ADIS16203_MSC_CTRL_DATA_RDY_EN (1 << 2) /* Data-ready enable: 1 = enabled, 0 = disabled */
		#define ADIS16203_MSC_CTRL_ACTIVE_HIGH (1 << 1) /* Data-ready polarity: 1 = active high, 0 = active low */
		#define ADIS16203_MSC_CTRL_DATA_RDY_DIO1 (1 << 0) /* Data-ready line selection: 1 = DIO1, 0 = DIO0 */

		/* DIAG_STAT */
		#define ADIS16203_DIAG_STAT_ALARM2 (1<<9) /* Alarm 2 status: 1 = alarm active, 0 = alarm inactive */
		#define ADIS16203_DIAG_STAT_ALARM1 (1<<8) /* Alarm 1 status: 1 = alarm active, 0 = alarm inactive */
		#define ADIS16203_DIAG_STAT_SELFTEST_FAIL (1<<5) /* Self-test diagnostic error flag */
		#define ADIS16203_DIAG_STAT_SPI_FAIL (1<<3) /* SPI communications failure */
		#define ADIS16203_DIAG_STAT_FLASH_UPT (1<<2) /* Flash update failure */
		#define ADIS16203_DIAG_STAT_POWER_HIGH (1<<1) /* Power supply above 3.625 V */
		#define ADIS16203_DIAG_STAT_POWER_LOW (1<<0) /* Power supply below 3.15 V */

		/* GLOB_CMD */
		#define ADIS16203_GLOB_CMD_SW_RESET (1<<7)
		#define ADIS16203_GLOB_CMD_CLEAR_STAT (1<<4)
		#define ADIS16203_GLOB_CMD_FACTORY_CAL (1<<1)

		#define ADIS16203_MAX_TX 12
		#define ADIS16203_MAX_RX 10

		#define ADIS16203_ERROR_ACTIVE (1<<14)

		/**
		* struct adis16203_state - device instance specific data
		* @us: actual spi_device
		* @work_trigger_to_ring: bh for triggered event handling
		* @inter: used to check if new interrupt has been triggered
		* @last_timestamp: passing timestamp from th to bh of interrupt handler
		* @indio_dev: industrial I/O device structure
		* @trig: data ready trigger registered with iio
		* @tx: transmit buffer
		* @rx: recieve buffer
		* @buf_lock: mutex to protect tx and rx
		**/
		struct adis16203_state {
		struct spi_device *us;
		struct work_struct work_trigger_to_ring;
		s64 last_timestamp;
		struct iio_dev *indio_dev;
		struct iio_trigger *trig;
		u8 *tx;
		u8 *rx;
		struct mutex buf_lock;
		};

		int adis16203_set_irq(struct device *dev, bool enable);

		#ifdef CONFIG_IIO_RING_BUFFER
		enum adis16203_scan {
		ADIS16203_SCAN_SUPPLY,
		ADIS16203_SCAN_AUX_ADC,
		ADIS16203_SCAN_TEMP,
		ADIS16203_SCAN_INCLI_X,
		ADIS16203_SCAN_INCLI_Y,
		};

		void adis16203_remove_trigger(struct iio_dev *indio_dev);
		int adis16203_probe_trigger(struct iio_dev *indio_dev);

		ssize_t adis16203_read_data_from_ring(struct device *dev,
		struct device_attribute *attr,
		char *buf);

		int adis16203_configure_ring(struct iio_dev *indio_dev);
		void adis16203_unconfigure_ring(struct iio_dev *indio_dev);

		int adis16203_initialize_ring(struct iio_ring_buffer *ring);
		void adis16203_uninitialize_ring(struct iio_ring_buffer *ring);
		#else /* CONFIG_IIO_RING_BUFFER */

		static inline void adis16203_remove_trigger(struct iio_dev *indio_dev)
		{
		}

		static inline int adis16203_probe_trigger(struct iio_dev *indio_dev)
		{
		return 0;
		}

		static inline ssize_t
		adis16203_read_data_from_ring(struct device *dev,
		struct device_attribute *attr,
		char *buf)
		{
		return 0;
		}

		static int adis16203_configure_ring(struct iio_dev *indio_dev)
		{
		return 0;
		}

		static inline void adis16203_unconfigure_ring(struct iio_dev *indio_dev)
		{
		}

		static inline int adis16203_initialize_ring(struct iio_ring_buffer *ring)
		{
		return 0;
		}

		static inline void adis16203_uninitialize_ring(struct iio_ring_buffer *ring)
		{
		}

		#endif /* CONFIG_IIO_RING_BUFFER */
		#endif /* SPI_ADIS16203_H_ */

drivers/staging/iio/accel/adis16203_core.c

0 → 100644

+568 −0

Original line number	Diff line number	Diff line
		/*
		* ADIS16203 Programmable Digital Vibration Sensor driver
		*
		* Copyright 2010 Analog Devices Inc.
		*
		* Licensed under the GPL-2 or later.
		*/

		#include <linux/interrupt.h>
		#include <linux/irq.h>
		#include <linux/gpio.h>
		#include <linux/delay.h>
		#include <linux/mutex.h>
		#include <linux/device.h>
		#include <linux/kernel.h>
		#include <linux/spi/spi.h>
		#include <linux/slab.h>
		#include <linux/sysfs.h>
		#include <linux/list.h>

		#include "../iio.h"
		#include "../sysfs.h"
		#include "accel.h"
		#include "inclinometer.h"
		#include "../gyro/gyro.h"
		#include "../adc/adc.h"

		#include "adis16203.h"

		#define DRIVER_NAME "adis16203"

		static int adis16203_check_status(struct device *dev);

		/**
		* adis16203_spi_write_reg_8() - write single byte to a register
		* @dev: device associated with child of actual device (iio_dev or iio_trig)
		* @reg_address: the address of the register to be written
		* @val: the value to write
		**/
		static int adis16203_spi_write_reg_8(struct device *dev,
		u8 reg_address,
		u8 val)
		{
		int ret;
		struct iio_dev *indio_dev = dev_get_drvdata(dev);
		struct adis16203_state *st = iio_dev_get_devdata(indio_dev);

		mutex_lock(&st->buf_lock);
		st->tx[0] = ADIS16203_WRITE_REG(reg_address);
		st->tx[1] = val;

		ret = spi_write(st->us, st->tx, 2);
		mutex_unlock(&st->buf_lock);

		return ret;
		}

		/**
		* adis16203_spi_write_reg_16() - write 2 bytes to a pair of registers
		* @dev: device associated with child of actual device (iio_dev or iio_trig)
		* @reg_address: the address of the lower of the two registers. Second register
		* is assumed to have address one greater.
		* @val: value to be written
		**/
		static int adis16203_spi_write_reg_16(struct device *dev,
		u8 lower_reg_address,
		u16 value)
		{
		int ret;
		struct spi_message msg;
		struct iio_dev *indio_dev = dev_get_drvdata(dev);
		struct adis16203_state *st = iio_dev_get_devdata(indio_dev);
		struct spi_transfer xfers[] = {
		{
		.tx_buf = st->tx,
		.bits_per_word = 8,
		.len = 2,
		.cs_change = 1,
		}, {
		.tx_buf = st->tx + 2,
		.bits_per_word = 8,
		.len = 2,
		.cs_change = 1,
		},
		};

		mutex_lock(&st->buf_lock);
		st->tx[0] = ADIS16203_WRITE_REG(lower_reg_address);
		st->tx[1] = value & 0xFF;
		st->tx[2] = ADIS16203_WRITE_REG(lower_reg_address + 1);
		st->tx[3] = (value >> 8) & 0xFF;

		spi_message_init(&msg);
		spi_message_add_tail(&xfers[0], &msg);
		spi_message_add_tail(&xfers[1], &msg);
		ret = spi_sync(st->us, &msg);
		mutex_unlock(&st->buf_lock);

		return ret;
		}

		/**
		* adis16203_spi_read_reg_16() - read 2 bytes from a 16-bit register
		* @dev: device associated with child of actual device (iio_dev or iio_trig)
		* @reg_address: the address of the lower of the two registers. Second register
		* is assumed to have address one greater.
		* @val: somewhere to pass back the value read
		**/
		static int adis16203_spi_read_reg_16(struct device *dev,
		u8 lower_reg_address,
		u16 *val)
		{
		struct spi_message msg;
		struct iio_dev *indio_dev = dev_get_drvdata(dev);
		struct adis16203_state *st = iio_dev_get_devdata(indio_dev);
		int ret;
		struct spi_transfer xfers[] = {
		{
		.tx_buf = st->tx,
		.bits_per_word = 8,
		.len = 2,
		.cs_change = 1,
		.delay_usecs = 20,
		}, {
		.rx_buf = st->rx,
		.bits_per_word = 8,
		.len = 2,
		.cs_change = 1,
		.delay_usecs = 20,
		},
		};

		mutex_lock(&st->buf_lock);
		st->tx[0] = ADIS16203_READ_REG(lower_reg_address);
		st->tx[1] = 0;

		spi_message_init(&msg);
		spi_message_add_tail(&xfers[0], &msg);
		spi_message_add_tail(&xfers[1], &msg);
		ret = spi_sync(st->us, &msg);
		if (ret) {
		dev_err(&st->us->dev, "problem when reading 16 bit register 0x%02X",
		lower_reg_address);
		goto error_ret;
		}
		*val = (st->rx[0] << 8) \| st->rx[1];

		error_ret:
		mutex_unlock(&st->buf_lock);
		return ret;
		}

		static ssize_t adis16203_read_12bit_unsigned(struct device *dev,
		struct device_attribute *attr,
		char *buf)
		{
		int ret;
		u16 val = 0;
		struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);

		ret = adis16203_spi_read_reg_16(dev, this_attr->address, &val);
		if (ret)
		return ret;

		if (val & ADIS16203_ERROR_ACTIVE)
		adis16203_check_status(dev);

		return sprintf(buf, "%u\n", val & 0x0FFF);
		}

		static ssize_t adis16203_read_temp(struct device *dev,
		struct device_attribute *attr,
		char *buf)
		{
		struct iio_dev *indio_dev = dev_get_drvdata(dev);
		ssize_t ret;
		u16 val;

		/* Take the iio_dev status lock */
		mutex_lock(&indio_dev->mlock);

		ret = adis16203_spi_read_reg_16(dev, ADIS16203_TEMP_OUT, (u16 *)&val);
		if (ret)
		goto error_ret;

		if (val & ADIS16203_ERROR_ACTIVE)
		adis16203_check_status(dev);

		val &= 0xFFF;
		ret = sprintf(buf, "%d\n", val);

		error_ret:
		mutex_unlock(&indio_dev->mlock);
		return ret;
		}

		static ssize_t adis16203_read_14bit_signed(struct device *dev,
		struct device_attribute *attr,
		char *buf)
		{
		struct iio_dev *indio_dev = dev_get_drvdata(dev);
		struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
		s16 val = 0;
		ssize_t ret;

		mutex_lock(&indio_dev->mlock);

		ret = adis16203_spi_read_reg_16(dev, this_attr->address, (u16 *)&val);
		if (!ret) {
		if (val & ADIS16203_ERROR_ACTIVE)
		adis16203_check_status(dev);

		val = ((s16)(val << 2) >> 2);
		ret = sprintf(buf, "%d\n", val);
		}

		mutex_unlock(&indio_dev->mlock);

		return ret;
		}

		static ssize_t adis16203_write_16bit(struct device *dev,
		struct device_attribute *attr,
		const char *buf,
		size_t len)
		{
		struct iio_dev_attr *this_attr = to_iio_dev_attr(attr);
		int ret;
		long val;

		ret = strict_strtol(buf, 10, &val);
		if (ret)
		goto error_ret;
		ret = adis16203_spi_write_reg_16(dev, this_attr->address, val);

		error_ret:
		return ret ? ret : len;
		}

		static int adis16203_reset(struct device *dev)
		{
		int ret;
		ret = adis16203_spi_write_reg_8(dev,
		ADIS16203_GLOB_CMD,
		ADIS16203_GLOB_CMD_SW_RESET);
		if (ret)
		dev_err(dev, "problem resetting device");

		return ret;
		}

		static ssize_t adis16203_write_reset(struct device *dev,
		struct device_attribute *attr,
		const char *buf, size_t len)
		{
		if (len < 1)
		return -EINVAL;
		switch (buf[0]) {
		case '1':
		case 'y':
		case 'Y':
		return adis16203_reset(dev);
		}
		return -EINVAL;
		}

		int adis16203_set_irq(struct device *dev, bool enable)
		{
		int ret = 0;
		u16 msc;

		ret = adis16203_spi_read_reg_16(dev, ADIS16203_MSC_CTRL, &msc);
		if (ret)
		goto error_ret;

		msc \|= ADIS16203_MSC_CTRL_ACTIVE_HIGH;
		msc &= ~ADIS16203_MSC_CTRL_DATA_RDY_DIO1;
		if (enable)
		msc \|= ADIS16203_MSC_CTRL_DATA_RDY_EN;
		else
		msc &= ~ADIS16203_MSC_CTRL_DATA_RDY_EN;

		ret = adis16203_spi_write_reg_16(dev, ADIS16203_MSC_CTRL, msc);

		error_ret:
		return ret;
		}

		static int adis16203_check_status(struct device *dev)
		{
		u16 status;
		int ret;

		ret = adis16203_spi_read_reg_16(dev, ADIS16203_DIAG_STAT, &status);
		if (ret < 0) {
		dev_err(dev, "Reading status failed\n");
		goto error_ret;
		}
		ret = status & 0x1F;

		if (status & ADIS16203_DIAG_STAT_SELFTEST_FAIL)
		dev_err(dev, "Self test failure\n");
		if (status & ADIS16203_DIAG_STAT_SPI_FAIL)
		dev_err(dev, "SPI failure\n");
		if (status & ADIS16203_DIAG_STAT_FLASH_UPT)
		dev_err(dev, "Flash update failed\n");
		if (status & ADIS16203_DIAG_STAT_POWER_HIGH)
		dev_err(dev, "Power supply above 3.625V\n");
		if (status & ADIS16203_DIAG_STAT_POWER_LOW)
		dev_err(dev, "Power supply below 3.15V\n");

		error_ret:
		return ret;
		}

		static int adis16203_self_test(struct device *dev)
		{
		int ret;
		ret = adis16203_spi_write_reg_16(dev,
		ADIS16203_MSC_CTRL,
		ADIS16203_MSC_CTRL_SELF_TEST_EN);
		if (ret) {
		dev_err(dev, "problem starting self test");
		goto err_ret;
		}

		adis16203_check_status(dev);

		err_ret:
		return ret;
		}

		static int adis16203_initial_setup(struct adis16203_state *st)
		{
		int ret;
		struct device *dev = &st->indio_dev->dev;

		/* Disable IRQ */
		ret = adis16203_set_irq(dev, false);
		if (ret) {
		dev_err(dev, "disable irq failed");
		goto err_ret;
		}

		/* Do self test */
		ret = adis16203_self_test(dev);
		if (ret) {
		dev_err(dev, "self test failure");
		goto err_ret;
		}

		/* Read status register to check the result */
		ret = adis16203_check_status(dev);
		if (ret) {
		adis16203_reset(dev);
		dev_err(dev, "device not playing ball -> reset");
		msleep(ADIS16203_STARTUP_DELAY);
		ret = adis16203_check_status(dev);
		if (ret) {
		dev_err(dev, "giving up");
		goto err_ret;
		}
		}

		printk(KERN_INFO DRIVER_NAME ": at CS%d (irq %d)\n",
		st->us->chip_select, st->us->irq);

		err_ret:
		return ret;
		}

		static IIO_DEV_ATTR_IN_NAMED_RAW(0, supply, adis16203_read_12bit_unsigned,
		ADIS16203_SUPPLY_OUT);
		static IIO_CONST_ATTR(in0_supply_scale, "0.00122");
		static IIO_DEV_ATTR_IN_RAW(1, adis16203_read_12bit_unsigned,
		ADIS16203_AUX_ADC);
		static IIO_CONST_ATTR(in1_scale, "0.00061");

		static IIO_DEV_ATTR_INCLI_X(adis16203_read_14bit_signed,
		ADIS16203_XINCL_OUT);
		static IIO_DEV_ATTR_INCLI_Y(adis16203_read_14bit_signed,
		ADIS16203_YINCL_OUT);
		static IIO_DEV_ATTR_INCLI_X_OFFSET(S_IWUSR \| S_IRUGO,
		adis16203_read_14bit_signed,
		adis16203_write_16bit,
		ADIS16203_INCL_NULL);
		static IIO_CONST_ATTR(incli_scale, "0.025");

		static IIO_DEV_ATTR_TEMP_RAW(adis16203_read_temp);
		static IIO_CONST_ATTR(temp_offset, "25");
		static IIO_CONST_ATTR(temp_scale, "-0.47");

		static IIO_DEVICE_ATTR(reset, S_IWUSR, NULL, adis16203_write_reset, 0);

		static IIO_CONST_ATTR(name, "adis16203");

		static struct attribute *adis16203_event_attributes[] = {
		NULL
		};

		static struct attribute_group adis16203_event_attribute_group = {
		.attrs = adis16203_event_attributes,
		};

		static struct attribute *adis16203_attributes[] = {
		&iio_dev_attr_in0_supply_raw.dev_attr.attr,
		&iio_const_attr_in0_supply_scale.dev_attr.attr,
		&iio_dev_attr_temp_raw.dev_attr.attr,
		&iio_const_attr_temp_offset.dev_attr.attr,
		&iio_const_attr_temp_scale.dev_attr.attr,
		&iio_dev_attr_reset.dev_attr.attr,
		&iio_const_attr_name.dev_attr.attr,
		&iio_dev_attr_in1_raw.dev_attr.attr,
		&iio_const_attr_in1_scale.dev_attr.attr,
		&iio_dev_attr_incli_x_raw.dev_attr.attr,
		&iio_dev_attr_incli_y_raw.dev_attr.attr,
		&iio_dev_attr_incli_x_offset.dev_attr.attr,
		&iio_const_attr_incli_scale.dev_attr.attr,
		NULL
		};

		static const struct attribute_group adis16203_attribute_group = {
		.attrs = adis16203_attributes,
		};

		static int __devinit adis16203_probe(struct spi_device *spi)
		{
		int ret, regdone = 0;
		struct adis16203_state st = kzalloc(sizeof st, GFP_KERNEL);
		if (!st) {
		ret = -ENOMEM;
		goto error_ret;
		}
		/* this is only used for removal purposes */
		spi_set_drvdata(spi, st);

		/* Allocate the comms buffers */
		st->rx = kzalloc(sizeof(st->rx)ADIS16203_MAX_RX, GFP_KERNEL);
		if (st->rx == NULL) {
		ret = -ENOMEM;
		goto error_free_st;
		}
		st->tx = kzalloc(sizeof(st->tx)ADIS16203_MAX_TX, GFP_KERNEL);
		if (st->tx == NULL) {
		ret = -ENOMEM;
		goto error_free_rx;
		}
		st->us = spi;
		mutex_init(&st->buf_lock);
		/* setup the industrialio driver allocated elements */
		st->indio_dev = iio_allocate_device();
		if (st->indio_dev == NULL) {
		ret = -ENOMEM;
		goto error_free_tx;
		}

		st->indio_dev->dev.parent = &spi->dev;
		st->indio_dev->num_interrupt_lines = 1;
		st->indio_dev->event_attrs = &adis16203_event_attribute_group;
		st->indio_dev->attrs = &adis16203_attribute_group;
		st->indio_dev->dev_data = (void *)(st);
		st->indio_dev->driver_module = THIS_MODULE;
		st->indio_dev->modes = INDIO_DIRECT_MODE;

		ret = adis16203_configure_ring(st->indio_dev);
		if (ret)
		goto error_free_dev;

		ret = iio_device_register(st->indio_dev);
		if (ret)
		goto error_unreg_ring_funcs;
		regdone = 1;

		ret = adis16203_initialize_ring(st->indio_dev->ring);
		if (ret) {
		printk(KERN_ERR "failed to initialize the ring\n");
		goto error_unreg_ring_funcs;
		}

		if (spi->irq) {
		ret = iio_register_interrupt_line(spi->irq,
		st->indio_dev,
		0,
		IRQF_TRIGGER_RISING,
		"adis16203");
		if (ret)
		goto error_uninitialize_ring;

		ret = adis16203_probe_trigger(st->indio_dev);
		if (ret)
		goto error_unregister_line;
		}

		/* Get the device into a sane initial state */
		ret = adis16203_initial_setup(st);
		if (ret)
		goto error_remove_trigger;
		return 0;

		error_remove_trigger:
		adis16203_remove_trigger(st->indio_dev);
		error_unregister_line:
		if (spi->irq)
		iio_unregister_interrupt_line(st->indio_dev, 0);
		error_uninitialize_ring:
		adis16203_uninitialize_ring(st->indio_dev->ring);
		error_unreg_ring_funcs:
		adis16203_unconfigure_ring(st->indio_dev);
		error_free_dev:
		if (regdone)
		iio_device_unregister(st->indio_dev);
		else
		iio_free_device(st->indio_dev);
		error_free_tx:
		kfree(st->tx);
		error_free_rx:
		kfree(st->rx);
		error_free_st:
		kfree(st);
		error_ret:
		return ret;
		}

		static int adis16203_remove(struct spi_device *spi)
		{
		struct adis16203_state *st = spi_get_drvdata(spi);
		struct iio_dev *indio_dev = st->indio_dev;

		flush_scheduled_work();

		adis16203_remove_trigger(indio_dev);
		if (spi->irq)
		iio_unregister_interrupt_line(indio_dev, 0);

		adis16203_uninitialize_ring(indio_dev->ring);
		iio_device_unregister(indio_dev);
		adis16203_unconfigure_ring(indio_dev);
		kfree(st->tx);
		kfree(st->rx);
		kfree(st);

		return 0;
		}

		static struct spi_driver adis16203_driver = {
		.driver = {
		.name = "adis16203",
		.owner = THIS_MODULE,
		},
		.probe = adis16203_probe,
		.remove = __devexit_p(adis16203_remove),
		};

		static __init int adis16203_init(void)
		{
		return spi_register_driver(&adis16203_driver);
		}
		module_init(adis16203_init);

		static __exit void adis16203_exit(void)
		{
		spi_unregister_driver(&adis16203_driver);
		}
		module_exit(adis16203_exit);

		MODULE_AUTHOR("Barry Song <21cnbao@gmail.com>");
		MODULE_DESCRIPTION("Analog Devices ADIS16203 Programmable Digital Vibration Sensor driver");
		MODULE_LICENSE("GPL v2");

drivers/staging/iio/accel/adis16203_ring.c

0 → 100644

+211 −0

File added.

Preview size limit exceeded, changes collapsed.