LXR linux/drivers/input/misc/adxl34x-i2c.c

   1/*
   2 * ADLX345/346 Three-Axis Digital Accelerometers (I2C Interface)
   3 *
   4 * Enter bugs at http://blackfin.uclinux.org/
   5 *
   6 * Copyright (C) 2009 Michael Hennerich, Analog Devices Inc.
   7 * Licensed under the GPL-2 or later.
   8 */
   9
  10#include <linux/input.h>        /* BUS_I2C */
  11#include <linux/i2c.h>
  12#include <linux/module.h>
  13#include <linux/of.h>
  14#include <linux/types.h>
  15#include <linux/pm.h>
  16#include "adxl34x.h"
  17
  18static int adxl34x_smbus_read(struct device *dev, unsigned char reg)
  19{
  20        struct i2c_client *client = to_i2c_client(dev);
  21
  22        return i2c_smbus_read_byte_data(client, reg);
  23}
  24
  25static int adxl34x_smbus_write(struct device *dev,
  26                               unsigned char reg, unsigned char val)
  27{
  28        struct i2c_client *client = to_i2c_client(dev);
  29
  30        return i2c_smbus_write_byte_data(client, reg, val);
  31}
  32
  33static int adxl34x_smbus_read_block(struct device *dev,
  34                                    unsigned char reg, int count,
  35                                    void *buf)
  36{
  37        struct i2c_client *client = to_i2c_client(dev);
  38
  39        return i2c_smbus_read_i2c_block_data(client, reg, count, buf);
  40}
  41
  42static int adxl34x_i2c_read_block(struct device *dev,
  43                                  unsigned char reg, int count,
  44                                  void *buf)
  45{
  46        struct i2c_client *client = to_i2c_client(dev);
  47        int ret;
  48
  49        ret = i2c_master_send(client, &reg, 1);
  50        if (ret < 0)
  51                return ret;
  52
  53        ret = i2c_master_recv(client, buf, count);
  54        if (ret < 0)
  55                return ret;
  56
  57        if (ret != count)
  58                return -EIO;
  59
  60        return 0;
  61}
  62
  63static const struct adxl34x_bus_ops adxl34x_smbus_bops = {
  64        .bustype        = BUS_I2C,
  65        .write          = adxl34x_smbus_write,
  66        .read           = adxl34x_smbus_read,
  67        .read_block     = adxl34x_smbus_read_block,
  68};
  69
  70static const struct adxl34x_bus_ops adxl34x_i2c_bops = {
  71        .bustype        = BUS_I2C,
  72        .write          = adxl34x_smbus_write,
  73        .read           = adxl34x_smbus_read,
  74        .read_block     = adxl34x_i2c_read_block,
  75};
  76
  77static int adxl34x_i2c_probe(struct i2c_client *client,
  78                                       const struct i2c_device_id *id)
  79{
  80        struct adxl34x *ac;
  81        int error;
  82
  83        error = i2c_check_functionality(client->adapter,
  84                        I2C_FUNC_SMBUS_BYTE_DATA);
  85        if (!error) {
  86                dev_err(&client->dev, "SMBUS Byte Data not Supported\n");
  87                return -EIO;
  88        }
  89
  90        ac = adxl34x_probe(&client->dev, client->irq, false,
  91                           i2c_check_functionality(client->adapter,
  92                                                   I2C_FUNC_SMBUS_READ_I2C_BLOCK) ?
  93                                &adxl34x_smbus_bops : &adxl34x_i2c_bops);
  94        if (IS_ERR(ac))
  95                return PTR_ERR(ac);
  96
  97        i2c_set_clientdata(client, ac);
  98
  99        return 0;
 100}
 101
 102static int adxl34x_i2c_remove(struct i2c_client *client)
 103{
 104        struct adxl34x *ac = i2c_get_clientdata(client);
 105
 106        return adxl34x_remove(ac);
 107}
 108
 109static int __maybe_unused adxl34x_i2c_suspend(struct device *dev)
 110{
 111        struct i2c_client *client = to_i2c_client(dev);
 112        struct adxl34x *ac = i2c_get_clientdata(client);
 113
 114        adxl34x_suspend(ac);
 115
 116        return 0;
 117}
 118
 119static int __maybe_unused adxl34x_i2c_resume(struct device *dev)
 120{
 121        struct i2c_client *client = to_i2c_client(dev);
 122        struct adxl34x *ac = i2c_get_clientdata(client);
 123
 124        adxl34x_resume(ac);
 125
 126        return 0;
 127}
 128
 129static SIMPLE_DEV_PM_OPS(adxl34x_i2c_pm, adxl34x_i2c_suspend,
 130                         adxl34x_i2c_resume);
 131
 132static const struct i2c_device_id adxl34x_id[] = {
 133        { "adxl34x", 0 },
 134        { }
 135};
 136
 137MODULE_DEVICE_TABLE(i2c, adxl34x_id);
 138
 139#ifdef CONFIG_OF
 140static const struct of_device_id adxl34x_of_id[] = {
 141        /*
 142         * The ADXL346 is backward-compatible with the ADXL345. Differences are
 143         * handled by runtime detection of the device model, there's thus no
 144         * need for listing the "adi,adxl346" compatible value explicitly.
 145         */
 146        { .compatible = "adi,adxl345", },
 147        /*
 148         * Deprecated, DT nodes should use one or more of the device-specific
 149         * compatible values "adi,adxl345" and "adi,adxl346".
 150         */
 151        { .compatible = "adi,adxl34x", },
 152        { }
 153};
 154
 155MODULE_DEVICE_TABLE(of, adxl34x_of_id);
 156#endif
 157
 158static struct i2c_driver adxl34x_driver = {
 159        .driver = {
 160                .name = "adxl34x",
 161                .pm = &adxl34x_i2c_pm,
 162                .of_match_table = of_match_ptr(adxl34x_of_id),
 163        },
 164        .probe    = adxl34x_i2c_probe,
 165        .remove   = adxl34x_i2c_remove,
 166        .id_table = adxl34x_id,
 167};
 168
 169module_i2c_driver(adxl34x_driver);
 170
 171MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
 172MODULE_DESCRIPTION("ADXL345/346 Three-Axis Digital Accelerometer I2C Bus Driver");
 173MODULE_LICENSE("GPL");
 174