release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/hwmon/lis3lv02d_i2c.c

   1 /*
   2  * drivers/hwmon/lis3lv02d_i2c.c
   3  *
   4  * Implements I2C interface for lis3lv02d (STMicroelectronics) accelerometer.
   5  * Driver is based on corresponding SPI driver written by Daniel Mack
   6  * (lis3lv02d_spi.c (C) 2009 Daniel Mack <daniel@caiaq.de> ).
   7  *
   8  * Copyright (C) 2009 Nokia Corporation and/or its subsidiary(-ies).
   9  *
  10  * Contact: Samu Onkalo <samu.p.onkalo@nokia.com>
  11  *
  12  * This program is free software; you can redistribute it and/or
  13  * modify it under the terms of the GNU General Public License
  14  * version 2 as published by the Free Software Foundation.
  15  *
  16  * This program is distributed in the hope that it will be useful, but
  17  * WITHOUT ANY WARRANTY; without even the implied warranty of
  18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  19  * General Public License for more details.
  20  *
  21  * You should have received a copy of the GNU General Public License
  22  * along with this program; if not, write to the Free Software
  23  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  24  * 02110-1301 USA
  25  */
  26
  27 #include <linux/module.h>
  28 #include <linux/kernel.h>
  29 #include <linux/init.h>
  30 #include <linux/err.h>
  31 #include <linux/i2c.h>
  32 #include "lis3lv02d.h"
  33
  34 #define DRV_NAME        "lis3lv02d_i2c"
  35
  36 static inline s32 lis3_i2c_write(struct lis3lv02d *lis3, int reg, u8 value)
  37 {
  38         struct i2c_client *c = lis3->bus_priv;
  39         return i2c_smbus_write_byte_data(c, reg, value);
  40 }
  41
  42 static inline s32 lis3_i2c_read(struct lis3lv02d *lis3, int reg, u8 *v)
  43 {
  44         struct i2c_client *c = lis3->bus_priv;
  45         *v = i2c_smbus_read_byte_data(c, reg);
  46         return 0;
  47 }
  48
  49 static int lis3_i2c_init(struct lis3lv02d *lis3)
  50 {
  51         u8 reg;
  52         int ret;
  53
  54         /* power up the device */
  55         ret = lis3->read(lis3, CTRL_REG1, &reg);
  56         if (ret < 0)
  57                 return ret;
  58
  59         reg |= CTRL1_PD0;
  60         return lis3->write(lis3, CTRL_REG1, reg);
  61 }
  62
  63 /* Default axis mapping but it can be overwritten by platform data */
  64 static struct axis_conversion lis3lv02d_axis_map = { LIS3_DEV_X,
  65                                                      LIS3_DEV_Y,
  66                                                      LIS3_DEV_Z };
  67
  68 static int __devinit lis3lv02d_i2c_probe(struct i2c_client *client,
  69                                         const struct i2c_device_id *id)
  70 {
  71         int ret = 0;
  72         struct lis3lv02d_platform_data *pdata = client->dev.platform_data;
  73
  74         if (pdata) {
  75                 if (pdata->axis_x)
  76                         lis3lv02d_axis_map.x = pdata->axis_x;
  77
  78                 if (pdata->axis_y)
  79                         lis3lv02d_axis_map.y = pdata->axis_y;
  80
  81                 if (pdata->axis_z)
  82                         lis3lv02d_axis_map.z = pdata->axis_z;
  83
  84                 if (pdata->setup_resources)
  85                         ret = pdata->setup_resources();
  86
  87                 if (ret)
  88                         goto fail;
  89         }
  90
  91         lis3_dev.pdata    = pdata;
  92         lis3_dev.bus_priv = client;
  93         lis3_dev.init     = lis3_i2c_init;
  94         lis3_dev.read     = lis3_i2c_read;
  95         lis3_dev.write    = lis3_i2c_write;
  96         lis3_dev.irq      = client->irq;
  97         lis3_dev.ac       = lis3lv02d_axis_map;
  98
  99         i2c_set_clientdata(client, &lis3_dev);
 100         ret = lis3lv02d_init_device(&lis3_dev);
 101 fail:
 102         return ret;
 103 }
 104
 105 static int __devexit lis3lv02d_i2c_remove(struct i2c_client *client)
 106 {
 107         struct lis3lv02d *lis3 = i2c_get_clientdata(client);
 108         struct lis3lv02d_platform_data *pdata = client->dev.platform_data;
 109
 110         if (pdata && pdata->release_resources)
 111                 pdata->release_resources();
 112
 113         lis3lv02d_joystick_disable();
 114         lis3lv02d_poweroff(lis3);
 115
 116         return lis3lv02d_remove_fs(&lis3_dev);
 117 }
 118
 119 #ifdef CONFIG_PM
 120 static int lis3lv02d_i2c_suspend(struct i2c_client *client, pm_message_t mesg)
 121 {
 122         struct lis3lv02d *lis3 = i2c_get_clientdata(client);
 123
 124         if (!lis3->pdata || !lis3->pdata->wakeup_flags)
 125                 lis3lv02d_poweroff(lis3);
 126         return 0;
 127 }
 128
 129 static int lis3lv02d_i2c_resume(struct i2c_client *client)
 130 {
 131         struct lis3lv02d *lis3 = i2c_get_clientdata(client);
 132
 133         if (!lis3->pdata || !lis3->pdata->wakeup_flags)
 134                 lis3lv02d_poweron(lis3);
 135         return 0;
 136 }
 137
 138 static void lis3lv02d_i2c_shutdown(struct i2c_client *client)
 139 {
 140         lis3lv02d_i2c_suspend(client, PMSG_SUSPEND);
 141 }
 142 #else
 143 #define lis3lv02d_i2c_suspend   NULL
 144 #define lis3lv02d_i2c_resume    NULL
 145 #define lis3lv02d_i2c_shutdown  NULL
 146 #endif
 147
 148 static const struct i2c_device_id lis3lv02d_id[] = {
 149         {"lis3lv02d", 0 },
 150         {}
 151 };
 152
 153 MODULE_DEVICE_TABLE(i2c, lis3lv02d_id);
 154
 155 static struct i2c_driver lis3lv02d_i2c_driver = {
 156         .driver  = {
 157                 .name   = DRV_NAME,
 158                 .owner  = THIS_MODULE,
 159         },
 160         .suspend = lis3lv02d_i2c_suspend,
 161         .shutdown = lis3lv02d_i2c_shutdown,
 162         .resume = lis3lv02d_i2c_resume,
 163         .probe  = lis3lv02d_i2c_probe,
 164         .remove = __devexit_p(lis3lv02d_i2c_remove),
 165         .id_table = lis3lv02d_id,
 166 };
 167
 168 static int __init lis3lv02d_init(void)
 169 {
 170         return i2c_add_driver(&lis3lv02d_i2c_driver);
 171 }
 172
 173 static void __exit lis3lv02d_exit(void)
 174 {
 175         i2c_del_driver(&lis3lv02d_i2c_driver);
 176 }
 177
 178 MODULE_AUTHOR("Nokia Corporation");
 179 MODULE_DESCRIPTION("lis3lv02d I2C interface");
 180 MODULE_LICENSE("GPL");
 181
 182 module_init(lis3lv02d_init);
 183 module_exit(lis3lv02d_exit);