0001
0002
0003
0004
0005
0006
0007
0008
0009 #include <linux/module.h>
0010 #include <linux/i2c.h>
0011 #include <linux/input/cma3000.h>
0012 #include "cma3000_d0x.h"
0013
0014 static int cma3000_i2c_set(struct device *dev,
0015 u8 reg, u8 val, char *msg)
0016 {
0017 struct i2c_client *client = to_i2c_client(dev);
0018 int ret;
0019
0020 ret = i2c_smbus_write_byte_data(client, reg, val);
0021 if (ret < 0)
0022 dev_err(&client->dev,
0023 "%s failed (%s, %d)\n", __func__, msg, ret);
0024 return ret;
0025 }
0026
0027 static int cma3000_i2c_read(struct device *dev, u8 reg, char *msg)
0028 {
0029 struct i2c_client *client = to_i2c_client(dev);
0030 int ret;
0031
0032 ret = i2c_smbus_read_byte_data(client, reg);
0033 if (ret < 0)
0034 dev_err(&client->dev,
0035 "%s failed (%s, %d)\n", __func__, msg, ret);
0036 return ret;
0037 }
0038
0039 static const struct cma3000_bus_ops cma3000_i2c_bops = {
0040 .bustype = BUS_I2C,
0041 #define CMA3000_BUSI2C (0 << 4)
0042 .ctrl_mod = CMA3000_BUSI2C,
0043 .read = cma3000_i2c_read,
0044 .write = cma3000_i2c_set,
0045 };
0046
0047 static int cma3000_i2c_probe(struct i2c_client *client,
0048 const struct i2c_device_id *id)
0049 {
0050 struct cma3000_accl_data *data;
0051
0052 data = cma3000_init(&client->dev, client->irq, &cma3000_i2c_bops);
0053 if (IS_ERR(data))
0054 return PTR_ERR(data);
0055
0056 i2c_set_clientdata(client, data);
0057
0058 return 0;
0059 }
0060
0061 static int cma3000_i2c_remove(struct i2c_client *client)
0062 {
0063 struct cma3000_accl_data *data = i2c_get_clientdata(client);
0064
0065 cma3000_exit(data);
0066
0067 return 0;
0068 }
0069
0070 #ifdef CONFIG_PM
0071 static int cma3000_i2c_suspend(struct device *dev)
0072 {
0073 struct i2c_client *client = to_i2c_client(dev);
0074 struct cma3000_accl_data *data = i2c_get_clientdata(client);
0075
0076 cma3000_suspend(data);
0077
0078 return 0;
0079 }
0080
0081 static int cma3000_i2c_resume(struct device *dev)
0082 {
0083 struct i2c_client *client = to_i2c_client(dev);
0084 struct cma3000_accl_data *data = i2c_get_clientdata(client);
0085
0086 cma3000_resume(data);
0087
0088 return 0;
0089 }
0090
0091 static const struct dev_pm_ops cma3000_i2c_pm_ops = {
0092 .suspend = cma3000_i2c_suspend,
0093 .resume = cma3000_i2c_resume,
0094 };
0095 #endif
0096
0097 static const struct i2c_device_id cma3000_i2c_id[] = {
0098 { "cma3000_d01", 0 },
0099 { },
0100 };
0101
0102 MODULE_DEVICE_TABLE(i2c, cma3000_i2c_id);
0103
0104 static struct i2c_driver cma3000_i2c_driver = {
0105 .probe = cma3000_i2c_probe,
0106 .remove = cma3000_i2c_remove,
0107 .id_table = cma3000_i2c_id,
0108 .driver = {
0109 .name = "cma3000_i2c_accl",
0110 #ifdef CONFIG_PM
0111 .pm = &cma3000_i2c_pm_ops,
0112 #endif
0113 },
0114 };
0115
0116 module_i2c_driver(cma3000_i2c_driver);
0117
0118 MODULE_DESCRIPTION("CMA3000-D0x Accelerometer I2C Driver");
0119 MODULE_LICENSE("GPL");
0120 MODULE_AUTHOR("Hemanth V <hemanthv@ti.com>");