LXR linux/drivers/iio/gyro/st_gyro

   1/*
   2 * STMicroelectronics gyroscopes driver
   3 *
   4 * Copyright 2012-2013 STMicroelectronics Inc.
   5 *
   6 * Denis Ciocca <denis.ciocca@st.com>
   7 *
   8 * Licensed under the GPL-2.
   9 */
  10
  11#include <linux/kernel.h>
  12#include <linux/module.h>
  13#include <linux/slab.h>
  14#include <linux/i2c.h>
  15#include <linux/iio/iio.h>
  16
  17#include <linux/iio/common/st_sensors.h>
  18#include <linux/iio/common/st_sensors_i2c.h>
  19#include "st_gyro.h"
  20
  21#ifdef CONFIG_OF
  22static const struct of_device_id st_gyro_of_match[] = {
  23        {
  24                .compatible = "st,l3g4200d-gyro",
  25                .data = L3G4200D_GYRO_DEV_NAME,
  26        },
  27        {
  28                .compatible = "st,lsm330d-gyro",
  29                .data = LSM330D_GYRO_DEV_NAME,
  30        },
  31        {
  32                .compatible = "st,lsm330dl-gyro",
  33                .data = LSM330DL_GYRO_DEV_NAME,
  34        },
  35        {
  36                .compatible = "st,lsm330dlc-gyro",
  37                .data = LSM330DLC_GYRO_DEV_NAME,
  38        },
  39        {
  40                .compatible = "st,l3gd20-gyro",
  41                .data = L3GD20_GYRO_DEV_NAME,
  42        },
  43        {
  44                .compatible = "st,l3g4is-gyro",
  45                .data = L3G4IS_GYRO_DEV_NAME,
  46        },
  47        {
  48                .compatible = "st,lsm330-gyro",
  49                .data = LSM330_GYRO_DEV_NAME,
  50        },
  51        {},
  52};
  53MODULE_DEVICE_TABLE(of, st_gyro_of_match);
  54#else
  55#define st_gyro_of_match NULL
  56#endif
  57
  58static int st_gyro_i2c_probe(struct i2c_client *client,
  59                                                const struct i2c_device_id *id)
  60{
  61        struct iio_dev *indio_dev;
  62        struct st_sensor_data *gdata;
  63        int err;
  64
  65        indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*gdata));
  66        if (!indio_dev)
  67                return -ENOMEM;
  68
  69        gdata = iio_priv(indio_dev);
  70        st_sensors_of_i2c_probe(client, st_gyro_of_match);
  71
  72        st_sensors_i2c_configure(indio_dev, client, gdata);
  73
  74        err = st_gyro_common_probe(indio_dev);
  75        if (err < 0)
  76                return err;
  77
  78        return 0;
  79}
  80
  81static int st_gyro_i2c_remove(struct i2c_client *client)
  82{
  83        st_gyro_common_remove(i2c_get_clientdata(client));
  84
  85        return 0;
  86}
  87
  88static const struct i2c_device_id st_gyro_id_table[] = {
  89        { L3G4200D_GYRO_DEV_NAME },
  90        { LSM330D_GYRO_DEV_NAME },
  91        { LSM330DL_GYRO_DEV_NAME },
  92        { LSM330DLC_GYRO_DEV_NAME },
  93        { L3GD20_GYRO_DEV_NAME },
  94        { L3G4IS_GYRO_DEV_NAME },
  95        { LSM330_GYRO_DEV_NAME },
  96        {},
  97};
  98MODULE_DEVICE_TABLE(i2c, st_gyro_id_table);
  99
 100static struct i2c_driver st_gyro_driver = {
 101        .driver = {
 102                .owner = THIS_MODULE,
 103                .name = "st-gyro-i2c",
 104                .of_match_table = of_match_ptr(st_gyro_of_match),
 105        },
 106        .probe = st_gyro_i2c_probe,
 107        .remove = st_gyro_i2c_remove,
 108        .id_table = st_gyro_id_table,
 109};
 110module_i2c_driver(st_gyro_driver);
 111
 112MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
 113MODULE_DESCRIPTION("STMicroelectronics gyroscopes i2c driver");
 114MODULE_LICENSE("GPL v2");
 115