linux-imx

/*

 *  Copyright (C) 2014, Samsung Electronics Co. Ltd. All Rights Reserved.

 *

 *  This program is free software; you can redistribute it and/or modify

 *  it under the terms of the GNU General Public License as published by

 *  the Free Software Foundation; either version 2 of the License, or

 *  (at your option) any later version.

 *

 *  This program is distributed in the hope that it will be useful,

 *  but WITHOUT ANY WARRANTY; without even the implied warranty of

 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 *  GNU General Public License for more details.

 *

 */

​

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

#include <linux/iio/iio.h>

#include <linux/iio/buffer.h>

#include <linux/iio/kfifo_buf.h>

#include <linux/module.h>

#include <linux/platform_device.h>

#include <linux/slab.h>

#include "../common/ssp_sensors/ssp_iio_sensor.h"

​

#define SSP_CHANNEL_COUNT 3

​

#define SSP_ACCEL_NAME "ssp-accelerometer"

static const char ssp_accel_device_name[] = SSP_ACCEL_NAME;

​

enum ssp_accel_3d_channel {

    SSP_CHANNEL_SCAN_INDEX_X,

    SSP_CHANNEL_SCAN_INDEX_Y,

    SSP_CHANNEL_SCAN_INDEX_Z,

    SSP_CHANNEL_SCAN_INDEX_TIME,

};

​

static int ssp_accel_read_raw(struct iio_dev *indio_dev,

                  struct iio_chan_spec const *chan,  int *val,

                  int *val2, long mask)

{

    u32 t;

    struct ssp_data *data = dev_get_drvdata(indio_dev->dev.parent->parent);

​

    switch (mask) {

    case IIO_CHAN_INFO_SAMP_FREQ:

        t = ssp_get_sensor_delay(data, SSP_ACCELEROMETER_SENSOR);

        ssp_convert_to_freq(t, val, val2);

        return IIO_VAL_INT_PLUS_MICRO;

    default:

        break;

    }

​

    return -EINVAL;

}

​

static int ssp_accel_write_raw(struct iio_dev *indio_dev,

                   struct iio_chan_spec const *chan, int val,

                   int val2, long mask)

{

    int ret;

    struct ssp_data *data = dev_get_drvdata(indio_dev->dev.parent->parent);

​

    switch (mask) {