Skip to content

Commit

Permalink
staging: iio: adis16260 add suppport for adis16255 and adis16250.
Browse files Browse the repository at this point in the history 
Unusual element is addition of 'negate' and 'axis' platform data
to ensure we support all the functionality of the adis16255 driver
currently in staging.

Signed-off-by: Jonathan Cameron <jic23@cam.ac.uk>
Acked-by: Matthias Brugger <mensch0815@gmail.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
  • Loading branch information
Jonathan Cameron authored and Greg Kroah-Hartman committed Nov 29, 2010
1 parent a967295 commit fe34604
Show file tree
Hide file tree
Showing 4 changed files with 125 additions and 39 deletions.
3 changes: 3 additions & 0 deletions drivers/staging/iio/gyro/adis16260.h
View file
Original file line number Diff line number Diff line change
@@ -1,5 +1,6 @@
#ifndef SPI_ADIS16260_H_
#define SPI_ADIS16260_H_
#include "adis16260_platform_data.h"

#define ADIS16260_STARTUP_DELAY 220 /* ms */

Expand Down Expand Up @@ -92,6 +93,7 @@
* @tx: transmit buffer
* @rx: recieve buffer
* @buf_lock: mutex to protect tx and rx
* @negate: negate the scale parameter
**/
struct adis16260_state {
struct spi_device *us;
Expand All @@ -102,6 +104,7 @@ struct adis16260_state {
u8 *tx;
u8 *rx;
struct mutex buf_lock;
unsigned negate:1;
};

int adis16260_set_irq(struct device *dev, bool enable);
Expand Down
133 changes: 94 additions & 39 deletions drivers/staging/iio/gyro/adis16260_core.c
View file
Original file line number Diff line number Diff line change
Expand Up @@ -134,8 +134,6 @@ static int adis16260_spi_read_reg_16(struct device *dev,
mutex_lock(&st->buf_lock);
st->tx[0] = ADIS16260_READ_REG(lower_reg_address);
st->tx[1] = 0;
st->tx[2] = 0;
st->tx[3] = 0;

spi_message_init(&msg);
spi_message_add_tail(&xfers[0], &msg);
Expand Down Expand Up @@ -293,6 +291,22 @@ static ssize_t adis16260_write_frequency(struct device *dev,
return ret ? ret : len;
}

static ssize_t adis16260_read_gyro_scale(struct device *dev,
struct device_attribute *attr,
char *buf)
{
struct iio_dev *indio_dev = dev_get_drvdata(dev);
struct adis16260_state *st = iio_dev_get_devdata(indio_dev);
ssize_t ret = 0;

if (st->negate)
ret = sprintf(buf, "-");
/* Take the iio_dev status lock */
ret += sprintf(buf + ret, "%s\n", "0.00127862821");

return ret;
}

static int adis16260_reset(struct device *dev)
{
int ret;
Expand Down Expand Up @@ -447,18 +461,6 @@ static IIO_DEV_ATTR_IN_NAMED_RAW(0, supply,
ADIS16260_SUPPLY_OUT);
static IIO_CONST_ATTR_IN_NAMED_SCALE(0, supply, "0.0018315");

static IIO_DEV_ATTR_GYRO(adis16260_read_14bit_signed,
ADIS16260_GYRO_OUT);
static IIO_CONST_ATTR_GYRO_SCALE("0.00127862821");
static IIO_DEV_ATTR_GYRO_CALIBSCALE(S_IWUSR | S_IRUGO,
adis16260_read_14bit_signed,
adis16260_write_16bit,
ADIS16260_GYRO_SCALE);
static IIO_DEV_ATTR_GYRO_CALIBBIAS(S_IWUSR | S_IRUGO,
adis16260_read_12bit_signed,
adis16260_write_16bit,
ADIS16260_GYRO_OFF);

static IIO_DEV_ATTR_TEMP_RAW(adis16260_read_12bit_unsigned);
static IIO_CONST_ATTR_TEMP_OFFSET("25");
static IIO_CONST_ATTR_TEMP_SCALE("0.1453");
Expand All @@ -470,8 +472,6 @@ static IIO_CONST_ATTR(in1_scale, "0.0006105");
static IIO_DEV_ATTR_SAMP_FREQ(S_IWUSR | S_IRUGO,
adis16260_read_frequency,
adis16260_write_frequency);
static IIO_DEV_ATTR_ANGL(adis16260_read_14bit_signed,
ADIS16260_ANGL_OUT);

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

Expand All @@ -487,38 +487,70 @@ static struct attribute_group adis16260_event_attribute_group = {
.attrs = adis16260_event_attributes,
};

static struct attribute *adis16260_attributes[] = {
&iio_dev_attr_in0_supply_raw.dev_attr.attr,
&iio_const_attr_in0_supply_scale.dev_attr.attr,
&iio_dev_attr_gyro_raw.dev_attr.attr,
&iio_const_attr_gyro_scale.dev_attr.attr,
&iio_dev_attr_gyro_calibscale.dev_attr.attr,
&iio_dev_attr_gyro_calibbias.dev_attr.attr,
&iio_dev_attr_angl_raw.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_in1_raw.dev_attr.attr,
&iio_const_attr_in1_scale.dev_attr.attr,
&iio_dev_attr_sampling_frequency.dev_attr.attr,
&iio_const_attr_sampling_frequency_available.dev_attr.attr,
&iio_dev_attr_reset.dev_attr.attr,
&iio_const_attr_name.dev_attr.attr,
NULL
};
#define ADIS16260_GYRO_ATTR_SET(axis) \
IIO_DEV_ATTR_GYRO##axis(adis16260_read_14bit_signed, \
ADIS16260_GYRO_OUT); \
static IIO_DEV_ATTR_GYRO##axis##_SCALE(S_IRUGO, \
adis16260_read_gyro_scale, \
NULL, \
0); \
static IIO_DEV_ATTR_GYRO##axis##_CALIBSCALE(S_IRUGO | S_IWUSR, \
adis16260_read_12bit_unsigned, \
adis16260_write_16bit, \
ADIS16260_GYRO_SCALE); \
static IIO_DEV_ATTR_GYRO##axis##_CALIBBIAS(S_IWUSR | S_IRUGO, \
adis16260_read_12bit_signed, \
adis16260_write_16bit, \
ADIS16260_GYRO_OFF); \
static IIO_DEV_ATTR_ANGL##axis(adis16260_read_14bit_signed, \
ADIS16260_ANGL_OUT);

static ADIS16260_GYRO_ATTR_SET();
static ADIS16260_GYRO_ATTR_SET(_X);
static ADIS16260_GYRO_ATTR_SET(_Y);
static ADIS16260_GYRO_ATTR_SET(_Z);

#define ADIS16260_ATTR_GROUP(axis) \
struct attribute *adis16260_attributes##axis[] = { \
&iio_dev_attr_in0_supply_raw.dev_attr.attr, \
&iio_const_attr_in0_supply_scale.dev_attr.attr, \
&iio_dev_attr_gyro##axis##_raw.dev_attr.attr, \
&iio_dev_attr_gyro##axis##_scale.dev_attr.attr, \
&iio_dev_attr_gyro##axis##_calibscale.dev_attr.attr, \
&iio_dev_attr_gyro##axis##_calibbias.dev_attr.attr, \
&iio_dev_attr_angl##axis##_raw.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_in1_raw.dev_attr.attr, \
&iio_const_attr_in1_scale.dev_attr.attr, \
&iio_dev_attr_sampling_frequency.dev_attr.attr, \
&iio_const_attr_sampling_frequency_available.dev_attr.attr, \
&iio_dev_attr_reset.dev_attr.attr, \
&iio_const_attr_name.dev_attr.attr, \
NULL \
}; \
static const struct attribute_group adis16260_attribute_group##axis \
= { \
.attrs = adis16260_attributes##axis, \
};

static const struct attribute_group adis16260_attribute_group = {
.attrs = adis16260_attributes,
};
static ADIS16260_ATTR_GROUP();
static ADIS16260_ATTR_GROUP(_x);
static ADIS16260_ATTR_GROUP(_y);
static ADIS16260_ATTR_GROUP(_z);

static int __devinit adis16260_probe(struct spi_device *spi)
{
int ret, regdone = 0;
struct adis16260_platform_data *pd = spi->dev.platform_data;
struct adis16260_state *st = kzalloc(sizeof *st, GFP_KERNEL);
if (!st) {
ret = -ENOMEM;
goto error_ret;
}
if (pd)
st->negate = pd->negate;
/* this is only used for removal purposes */
spi_set_drvdata(spi, st);

Expand All @@ -545,7 +577,24 @@ static int __devinit adis16260_probe(struct spi_device *spi)
st->indio_dev->dev.parent = &spi->dev;
st->indio_dev->num_interrupt_lines = 1;
st->indio_dev->event_attrs = &adis16260_event_attribute_group;
st->indio_dev->attrs = &adis16260_attribute_group;
if (pd && pd->direction)
switch (pd->direction) {
case 'x':
st->indio_dev->attrs = &adis16260_attribute_group_x;
break;
case 'y':
st->indio_dev->attrs = &adis16260_attribute_group_y;
break;
case 'z':
st->indio_dev->attrs = &adis16260_attribute_group_z;
break;
default:
st->indio_dev->attrs = &adis16260_attribute_group;
break;
}
else
st->indio_dev->attrs = &adis16260_attribute_group;

st->indio_dev->dev_data = (void *)(st);
st->indio_dev->driver_module = THIS_MODULE;
st->indio_dev->modes = INDIO_DIRECT_MODE;
Expand Down Expand Up @@ -635,9 +684,15 @@ static int adis16260_remove(struct spi_device *spi)
return ret;
}

/*
* These parts do not need to be differentiated until someone adds
* support for the on chip filtering.
*/
static const struct spi_device_id adis16260_id[] = {
{"adis16260", 0},
{"adis16265", 0},
{"adis16250", 0},
{"adis16255", 0},
{}
};

Expand Down
19 changes: 19 additions & 0 deletions drivers/staging/iio/gyro/adis16260_platform_data.h
View file
Original file line number Diff line number Diff line change
@@ -0,0 +1,19 @@
/*
* ADIS16260 Programmable Digital Gyroscope Sensor Driver Platform Data
*
* Based on adis16255.h Matthia Brugger <m_brugger&web.de>
*
* Copyright (C) 2010 Fraunhofer Institute for Integrated Circuits
*
* Licensed under the GPL-2 or later.
*/

/**
* struct adis16260_platform_data - instance specific data
* @direction: x y or z
* @negate: flag to indicate value should be inverted.
**/
struct adis16260_platform_data {
char direction;
unsigned negate:1;
};
9 changes: 9 additions & 0 deletions drivers/staging/iio/gyro/gyro.h
View file
Original file line number Diff line number Diff line change
Expand Up @@ -71,3 +71,12 @@

#define IIO_DEV_ATTR_ANGL(_show, _addr) \
IIO_DEVICE_ATTR(angl_raw, S_IRUGO, _show, NULL, _addr)

#define IIO_DEV_ATTR_ANGL_X(_show, _addr) \
IIO_DEVICE_ATTR(angl_x_raw, S_IRUGO, _show, NULL, _addr)

#define IIO_DEV_ATTR_ANGL_Y(_show, _addr) \
IIO_DEVICE_ATTR(angl_y_raw, S_IRUGO, _show, NULL, _addr)

#define IIO_DEV_ATTR_ANGL_Z(_show, _addr) \
IIO_DEVICE_ATTR(angl_z_raw, S_IRUGO, _show, NULL, _addr)

0 comments on commit fe34604

Please sign in to comment.