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 union axis_conversion lis3lv02d_axis_map =
  65         { .as_array = { LIS3_DEV_X, LIS3_DEV_Y, LIS3_DEV_Z } };
  66
  67 static int __devinit lis3lv02d_i2c_probe(struct i2c_client *client,
  68                                         const struct i2c_device_id *id)
  69 {
  70         int ret = 0;
  71         struct lis3lv02d_platform_data *pdata = client->dev.platform_data;
  72
  73         if (pdata) {
  74                 if (pdata->axis_x)
  75                         lis3lv02d_axis_map.x = pdata->axis_x;
  76
  77                 if (pdata->axis_y)
  78                         lis3lv02d_axis_map.y = pdata->axis_y;
  79
  80                 if (pdata->axis_z)
  81                         lis3lv02d_axis_map.z = pdata->axis_z;
  82
  83                 if (pdata->setup_resources)
  84                         ret = pdata->setup_resources();
  85
  86                 if (ret)
  87                         goto fail;
  88         }
  89
  90         lis3_dev.pdata    = pdata;
  91         lis3_dev.bus_priv = client;
  92         lis3_dev.init     = lis3_i2c_init;
  93         lis3_dev.read     = lis3_i2c_read;
  94         lis3_dev.write    = lis3_i2c_write;
  95         lis3_dev.irq      = client->irq;
  96         lis3_dev.ac       = lis3lv02d_axis_map;
  97
  98         i2c_set_clientdata(client, &lis3_dev);
  99         ret = lis3lv02d_init_device(&lis3_dev);
 100 fail:
 101         return ret;
 102 }
 103
 104 static int __devexit lis3lv02d_i2c_remove(struct i2c_client *client)
 105 {
 106         struct lis3lv02d *lis3 = i2c_get_clientdata(client);
 107         struct lis3lv02d_platform_data *pdata = client->dev.platform_data;
 108
 109         if (pdata && pdata->release_resources)
 110                 pdata->release_resources();
 111
 112         lis3lv02d_joystick_disable();
 113         lis3lv02d_poweroff(lis3);
 114
 115         return lis3lv02d_remove_fs(&lis3_dev);
 116 }
 117
 118 #ifdef CONFIG_PM
 119 static int lis3lv02d_i2c_suspend(struct i2c_client *client, pm_message_t mesg)
 120 {
 121         struct lis3lv02d *lis3 = i2c_get_clientdata(client);
 122
 123         if (!lis3->pdata || !lis3->pdata->wakeup_flags)
 124                 lis3lv02d_poweroff(lis3);
 125         return 0;
 126 }
 127
 128 static int lis3lv02d_i2c_resume(struct i2c_client *client)
 129 {
 130         struct lis3lv02d *lis3 = i2c_get_clientdata(client);
 131
 132         if (!lis3->pdata || !lis3->pdata->wakeup_flags)
 133                 lis3lv02d_poweron(lis3);
 134         return 0;
 135 }
 136
 137 static void lis3lv02d_i2c_shutdown(struct i2c_client *client)
 138 {
 139         lis3lv02d_i2c_suspend(client, PMSG_SUSPEND);
 140 }
 141 #else
 142 #define lis3lv02d_i2c_suspend   NULL
 143 #define lis3lv02d_i2c_resume    NULL
 144 #define lis3lv02d_i2c_shutdown  NULL
 145 #endif
 146
 147 static const struct i2c_device_id lis3lv02d_id[] = {
 148         {"lis3lv02d", 0 },
 149         {}
 150 };
 151
 152 MODULE_DEVICE_TABLE(i2c, lis3lv02d_id);
 153
 154 static struct i2c_driver lis3lv02d_i2c_driver = {
 155         .driver  = {
 156                 .name   = DRV_NAME,
 157                 .owner  = THIS_MODULE,
 158         },
 159         .suspend = lis3lv02d_i2c_suspend,
 160         .shutdown = lis3lv02d_i2c_shutdown,
 161         .resume = lis3lv02d_i2c_resume,
 162         .probe  = lis3lv02d_i2c_probe,
 163         .remove = __devexit_p(lis3lv02d_i2c_remove),
 164         .id_table = lis3lv02d_id,
 165 };
 166
 167 static int __init lis3lv02d_init(void)
 168 {
 169         return i2c_add_driver(&lis3lv02d_i2c_driver);
 170 }
 171
 172 static void __exit lis3lv02d_exit(void)
 173 {
 174         i2c_del_driver(&lis3lv02d_i2c_driver);
 175 }
 176
 177 MODULE_AUTHOR("Nokia Corporation");
 178 MODULE_DESCRIPTION("lis3lv02d I2C interface");
 179 MODULE_LICENSE("GPL");
 180
 181 module_init(lis3lv02d_init);
 182 module_exit(lis3lv02d_exit);