1 /* 2 * I2C access for DA9052 PMICs. 3 * 4 * Copyright(c) 2011 Dialog Semiconductor Ltd. 5 * 6 * Author: David Dajun Chen <dchen@diasemi.com> 7 * 8 * This program is free software; you can redistribute it and/or modify 9 * it under the terms of the GNU General Public License as published by 10 * the Free Software Foundation; either version 2 of the License, or 11 * (at your option) any later version. 12 * 13 */ 14 15 #include <linux/device.h> 16 #include <linux/module.h> 17 #include <linux/input.h> 18 #include <linux/mfd/core.h> 19 #include <linux/i2c.h> 20 #include <linux/err.h> 21 22 #include <linux/mfd/da9052/da9052.h> 23 #include <linux/mfd/da9052/reg.h> 24 25 static int da9052_i2c_enable_multiwrite(struct da9052 *da9052) 26 { 27 int reg_val, ret; 28 29 ret = regmap_read(da9052->regmap, DA9052_CONTROL_B_REG, ®_val); 30 if (ret < 0) 31 return ret; 32 33 if (reg_val & DA9052_CONTROL_B_WRITEMODE) { 34 reg_val &= ~DA9052_CONTROL_B_WRITEMODE; 35 ret = regmap_write(da9052->regmap, DA9052_CONTROL_B_REG, 36 reg_val); 37 if (ret < 0) 38 return ret; 39 } 40 41 return 0; 42 } 43 44 static int __devinit da9052_i2c_probe(struct i2c_client *client, 45 const struct i2c_device_id *id) 46 { 47 struct da9052 *da9052; 48 int ret; 49 50 da9052 = kzalloc(sizeof(struct da9052), GFP_KERNEL); 51 if (!da9052) 52 return -ENOMEM; 53 54 if (!i2c_check_functionality(client->adapter, 55 I2C_FUNC_SMBUS_BYTE_DATA)) { 56 dev_info(&client->dev, "Error in %s:i2c_check_functionality\n", 57 __func__); 58 ret = -ENODEV; 59 goto err; 60 } 61 62 da9052->dev = &client->dev; 63 da9052->chip_irq = client->irq; 64 65 i2c_set_clientdata(client, da9052); 66 67 da9052->regmap = regmap_init_i2c(client, &da9052_regmap_config); 68 if (IS_ERR(da9052->regmap)) { 69 ret = PTR_ERR(da9052->regmap); 70 dev_err(&client->dev, "Failed to allocate register map: %d\n", 71 ret); 72 goto err; 73 } 74 75 ret = da9052_i2c_enable_multiwrite(da9052); 76 if (ret < 0) 77 goto err_regmap; 78 79 ret = da9052_device_init(da9052, id->driver_data); 80 if (ret != 0) 81 goto err_regmap; 82 83 return 0; 84 85 err_regmap: 86 regmap_exit(da9052->regmap); 87 err: 88 kfree(da9052); 89 return ret; 90 } 91 92 static int __devexit da9052_i2c_remove(struct i2c_client *client) 93 { 94 struct da9052 *da9052 = i2c_get_clientdata(client); 95 96 da9052_device_exit(da9052); 97 regmap_exit(da9052->regmap); 98 kfree(da9052); 99 100 return 0; 101 } 102 103 static struct i2c_device_id da9052_i2c_id[] = { 104 {"da9052", DA9052}, 105 {"da9053-aa", DA9053_AA}, 106 {"da9053-ba", DA9053_BA}, 107 {"da9053-bb", DA9053_BB}, 108 {} 109 }; 110 111 static struct i2c_driver da9052_i2c_driver = { 112 .probe = da9052_i2c_probe, 113 .remove = __devexit_p(da9052_i2c_remove), 114 .id_table = da9052_i2c_id, 115 .driver = { 116 .name = "da9052", 117 .owner = THIS_MODULE, 118 }, 119 }; 120 121 static int __init da9052_i2c_init(void) 122 { 123 int ret; 124 125 ret = i2c_add_driver(&da9052_i2c_driver); 126 if (ret != 0) { 127 pr_err("DA9052 I2C registration failed %d\n", ret); 128 return ret; 129 } 130 131 return 0; 132 } 133 subsys_initcall(da9052_i2c_init); 134 135 static void __exit da9052_i2c_exit(void) 136 { 137 i2c_del_driver(&da9052_i2c_driver); 138 } 139 module_exit(da9052_i2c_exit); 140 141 MODULE_AUTHOR("David Dajun Chen <dchen@diasemi.com>"); 142 MODULE_DESCRIPTION("I2C driver for Dialog DA9052 PMIC"); 143 MODULE_LICENSE("GPL"); 144