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/types.h> 14 #include <linux/pm.h> 15 #include "adxl34x.h" 16 17 static int adxl34x_smbus_read(struct device *dev, unsigned char reg) 18 { 19 struct i2c_client *client = to_i2c_client(dev); 20 21 return i2c_smbus_read_byte_data(client, reg); 22 } 23 24 static int adxl34x_smbus_write(struct device *dev, 25 unsigned char reg, unsigned char val) 26 { 27 struct i2c_client *client = to_i2c_client(dev); 28 29 return i2c_smbus_write_byte_data(client, reg, val); 30 } 31 32 static int adxl34x_smbus_read_block(struct device *dev, 33 unsigned char reg, int count, 34 void *buf) 35 { 36 struct i2c_client *client = to_i2c_client(dev); 37 38 return i2c_smbus_read_i2c_block_data(client, reg, count, buf); 39 } 40 41 static int adxl34x_i2c_read_block(struct device *dev, 42 unsigned char reg, int count, 43 void *buf) 44 { 45 struct i2c_client *client = to_i2c_client(dev); 46 int ret; 47 48 ret = i2c_master_send(client, ®, 1); 49 if (ret < 0) 50 return ret; 51 52 ret = i2c_master_recv(client, buf, count); 53 if (ret < 0) 54 return ret; 55 56 if (ret != count) 57 return -EIO; 58 59 return 0; 60 } 61 62 static const struct adxl34x_bus_ops adxl34x_smbus_bops = { 63 .bustype = BUS_I2C, 64 .write = adxl34x_smbus_write, 65 .read = adxl34x_smbus_read, 66 .read_block = adxl34x_smbus_read_block, 67 }; 68 69 static const struct adxl34x_bus_ops adxl34x_i2c_bops = { 70 .bustype = BUS_I2C, 71 .write = adxl34x_smbus_write, 72 .read = adxl34x_smbus_read, 73 .read_block = adxl34x_i2c_read_block, 74 }; 75 76 static int __devinit adxl34x_i2c_probe(struct i2c_client *client, 77 const struct i2c_device_id *id) 78 { 79 struct adxl34x *ac; 80 int error; 81 82 error = i2c_check_functionality(client->adapter, 83 I2C_FUNC_SMBUS_BYTE_DATA); 84 if (!error) { 85 dev_err(&client->dev, "SMBUS Byte Data not Supported\n"); 86 return -EIO; 87 } 88 89 ac = adxl34x_probe(&client->dev, client->irq, false, 90 i2c_check_functionality(client->adapter, 91 I2C_FUNC_SMBUS_READ_I2C_BLOCK) ? 92 &adxl34x_smbus_bops : &adxl34x_i2c_bops); 93 if (IS_ERR(ac)) 94 return PTR_ERR(ac); 95 96 i2c_set_clientdata(client, ac); 97 98 return 0; 99 } 100 101 static int __devexit adxl34x_i2c_remove(struct i2c_client *client) 102 { 103 struct adxl34x *ac = i2c_get_clientdata(client); 104 105 return adxl34x_remove(ac); 106 } 107 108 #ifdef CONFIG_PM 109 static int 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 119 static int 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 #endif 129 130 static SIMPLE_DEV_PM_OPS(adxl34x_i2c_pm, adxl34x_i2c_suspend, 131 adxl34x_i2c_resume); 132 133 static const struct i2c_device_id adxl34x_id[] = { 134 { "adxl34x", 0 }, 135 { } 136 }; 137 138 MODULE_DEVICE_TABLE(i2c, adxl34x_id); 139 140 static struct i2c_driver adxl34x_driver = { 141 .driver = { 142 .name = "adxl34x", 143 .owner = THIS_MODULE, 144 .pm = &adxl34x_i2c_pm, 145 }, 146 .probe = adxl34x_i2c_probe, 147 .remove = __devexit_p(adxl34x_i2c_remove), 148 .id_table = adxl34x_id, 149 }; 150 151 module_i2c_driver(adxl34x_driver); 152 153 MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>"); 154 MODULE_DESCRIPTION("ADXL345/346 Three-Axis Digital Accelerometer I2C Bus Driver"); 155 MODULE_LICENSE("GPL"); 156