1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * ADLX345/346 Three-Axis Digital Accelerometers (I2C Interface) 4 * 5 * Enter bugs at http://blackfin.uclinux.org/ 6 * 7 * Copyright (C) 2009 Michael Hennerich, Analog Devices Inc. 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 18 static 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 25 static 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 33 static 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 42 static 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, ®, 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 63 static 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 70 static 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 77 static 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 102 static void adxl34x_i2c_remove(struct i2c_client *client) 103 { 104 struct adxl34x *ac = i2c_get_clientdata(client); 105 106 adxl34x_remove(ac); 107 } 108 109 static 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 119 static 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 129 static SIMPLE_DEV_PM_OPS(adxl34x_i2c_pm, adxl34x_i2c_suspend, 130 adxl34x_i2c_resume); 131 132 static const struct i2c_device_id adxl34x_id[] = { 133 { "adxl34x", 0 }, 134 { } 135 }; 136 137 MODULE_DEVICE_TABLE(i2c, adxl34x_id); 138 139 static const struct of_device_id adxl34x_of_id[] = { 140 /* 141 * The ADXL346 is backward-compatible with the ADXL345. Differences are 142 * handled by runtime detection of the device model, there's thus no 143 * need for listing the "adi,adxl346" compatible value explicitly. 144 */ 145 { .compatible = "adi,adxl345", }, 146 /* 147 * Deprecated, DT nodes should use one or more of the device-specific 148 * compatible values "adi,adxl345" and "adi,adxl346". 149 */ 150 { .compatible = "adi,adxl34x", }, 151 { } 152 }; 153 154 MODULE_DEVICE_TABLE(of, adxl34x_of_id); 155 156 static struct i2c_driver adxl34x_driver = { 157 .driver = { 158 .name = "adxl34x", 159 .pm = &adxl34x_i2c_pm, 160 .of_match_table = adxl34x_of_id, 161 }, 162 .probe = adxl34x_i2c_probe, 163 .remove = adxl34x_i2c_remove, 164 .id_table = adxl34x_id, 165 }; 166 167 module_i2c_driver(adxl34x_driver); 168 169 MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>"); 170 MODULE_DESCRIPTION("ADXL345/346 Three-Axis Digital Accelerometer I2C Bus Driver"); 171 MODULE_LICENSE("GPL"); 172