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 { 79 struct adxl34x *ac; 80 81 if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA)) { 82 dev_err(&client->dev, "SMBUS Byte Data not Supported\n"); 83 return -EIO; 84 } 85 86 ac = adxl34x_probe(&client->dev, client->irq, false, 87 i2c_check_functionality(client->adapter, 88 I2C_FUNC_SMBUS_READ_I2C_BLOCK) ? 89 &adxl34x_smbus_bops : &adxl34x_i2c_bops); 90 if (IS_ERR(ac)) 91 return PTR_ERR(ac); 92 93 i2c_set_clientdata(client, ac); 94 95 return 0; 96 } 97 98 static const struct i2c_device_id adxl34x_id[] = { 99 { "adxl34x" }, 100 { } 101 }; 102 103 MODULE_DEVICE_TABLE(i2c, adxl34x_id); 104 105 static const struct of_device_id adxl34x_of_id[] = { 106 /* 107 * The ADXL346 is backward-compatible with the ADXL345. Differences are 108 * handled by runtime detection of the device model, there's thus no 109 * need for listing the "adi,adxl346" compatible value explicitly. 110 */ 111 { .compatible = "adi,adxl345", }, 112 /* 113 * Deprecated, DT nodes should use one or more of the device-specific 114 * compatible values "adi,adxl345" and "adi,adxl346". 115 */ 116 { .compatible = "adi,adxl34x", }, 117 { } 118 }; 119 120 MODULE_DEVICE_TABLE(of, adxl34x_of_id); 121 122 static struct i2c_driver adxl34x_driver = { 123 .driver = { 124 .name = "adxl34x", 125 .dev_groups = adxl34x_groups, 126 .pm = pm_sleep_ptr(&adxl34x_pm), 127 .of_match_table = adxl34x_of_id, 128 }, 129 .probe = adxl34x_i2c_probe, 130 .id_table = adxl34x_id, 131 }; 132 133 module_i2c_driver(adxl34x_driver); 134 135 MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>"); 136 MODULE_DESCRIPTION("ADXL345/346 Three-Axis Digital Accelerometer I2C Bus Driver"); 137 MODULE_LICENSE("GPL"); 138