linux-imx

/*

 * Common library for ADIS16XXX devices

 *

 * Copyright 2012 Analog Devices Inc.

 *   Author: Lars-Peter Clausen <lars@metafoo.de>

 *

 * Licensed under the GPL-2 or later.

 */

​

#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/module.h>

#include <asm/unaligned.h>

​

#include <linux/iio/iio.h>

#include <linux/iio/sysfs.h>

#include <linux/iio/buffer.h>

#include <linux/iio/imu/adis.h>

​

#define ADIS_MSC_CTRL_DATA_RDY_EN   BIT(2)

#define ADIS_MSC_CTRL_DATA_RDY_POL_HIGH BIT(1)

#define ADIS_MSC_CTRL_DATA_RDY_DIO2 BIT(0)

#define ADIS_GLOB_CMD_SW_RESET      BIT(7)

​

int adis_write_reg(struct adis *adis, unsigned int reg,

    unsigned int value, unsigned int size)

{

    unsigned int page = reg / ADIS_PAGE_SIZE;

    int ret, i;

    struct spi_message msg;

    struct spi_transfer xfers[] = {

        {

            .tx_buf = adis->tx,

            .bits_per_word = 8,

            .len = 2,

            .cs_change = 1,

            .delay_usecs = adis->data->write_delay,

        }, {

            .tx_buf = adis->tx + 2,

            .bits_per_word = 8,

            .len = 2,

            .cs_change = 1,

            .delay_usecs = adis->data->write_delay,

        }, {

            .tx_buf = adis->tx + 4,

            .bits_per_word = 8,

            .len = 2,

            .cs_change = 1,

            .delay_usecs = adis->data->write_delay,

        }, {

            .tx_buf = adis->tx + 6,

            .bits_per_word = 8,

            .len = 2,

            .delay_usecs = adis->data->write_delay,

        }, {

            .tx_buf = adis->tx + 8,

            .bits_per_word = 8,

            .len = 2,

            .delay_usecs = adis->data->write_delay,

        },

    };

​

    mutex_lock(&adis->txrx_lock);

​

    spi_message_init(&msg);

​

    if (adis->current_page != page) {

        adis->tx[0] = ADIS_WRITE_REG(ADIS_REG_PAGE_ID);

        adis->tx[1] = page;

        spi_message_add_tail(&xfers[0], &msg);

    }

​

    switch (size) {

    case 4:

        adis->tx[8] = ADIS_WRITE_REG(reg + 3);

        adis->tx[9] = (value >> 24) & 0xff;

        adis->tx[6] = ADIS_WRITE_REG(reg + 2);

        adis->tx[7] = (value >> 16) & 0xff;

        /* fall through */

    case 2:

        adis->tx[4] = ADIS_WRITE_REG(reg + 1);

        adis->tx[5] = (value >> 8) & 0xff;

        /* fall through */

    case 1:

        adis->tx[2] = ADIS_WRITE_REG(reg);

        adis->tx[3] = value & 0xff;

        break;