| /* |
| * tps65217.c |
| * |
| * TPS65217 chip family multi-function driver |
| * |
| * Copyright (C) 2011 Texas Instruments Incorporated - http://www.ti.com/ |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License as |
| * published by the Free Software Foundation version 2. |
| * |
| * This program is distributed "as is" WITHOUT ANY WARRANTY of any |
| * kind, whether express or implied; without even the implied warranty |
| * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/device.h> |
| #include <linux/module.h> |
| #include <linux/platform_device.h> |
| #include <linux/init.h> |
| #include <linux/i2c.h> |
| #include <linux/slab.h> |
| #include <linux/regmap.h> |
| #include <linux/err.h> |
| |
| #include <linux/mfd/core.h> |
| #include <linux/mfd/tps65217.h> |
| |
| /** |
| * tps65217_reg_read: Read a single tps65217 register. |
| * |
| * @tps: Device to read from. |
| * @reg: Register to read. |
| * @val: Contians the value |
| */ |
| int tps65217_reg_read(struct tps65217 *tps, unsigned int reg, |
| unsigned int *val) |
| { |
| return regmap_read(tps->regmap, reg, val); |
| } |
| EXPORT_SYMBOL_GPL(tps65217_reg_read); |
| |
| /** |
| * tps65217_reg_write: Write a single tps65217 register. |
| * |
| * @tps65217: Device to write to. |
| * @reg: Register to write to. |
| * @val: Value to write. |
| * @level: Password protected level |
| */ |
| int tps65217_reg_write(struct tps65217 *tps, unsigned int reg, |
| unsigned int val, unsigned int level) |
| { |
| int ret; |
| unsigned int xor_reg_val; |
| |
| switch (level) { |
| case TPS65217_PROTECT_NONE: |
| return regmap_write(tps->regmap, reg, val); |
| case TPS65217_PROTECT_L1: |
| xor_reg_val = reg ^ TPS65217_PASSWORD_REGS_UNLOCK; |
| ret = regmap_write(tps->regmap, TPS65217_REG_PASSWORD, |
| xor_reg_val); |
| if (ret < 0) |
| return ret; |
| |
| return regmap_write(tps->regmap, reg, val); |
| case TPS65217_PROTECT_L2: |
| xor_reg_val = reg ^ TPS65217_PASSWORD_REGS_UNLOCK; |
| ret = regmap_write(tps->regmap, TPS65217_REG_PASSWORD, |
| xor_reg_val); |
| if (ret < 0) |
| return ret; |
| ret = regmap_write(tps->regmap, reg, val); |
| if (ret < 0) |
| return ret; |
| ret = regmap_write(tps->regmap, TPS65217_REG_PASSWORD, |
| xor_reg_val); |
| if (ret < 0) |
| return ret; |
| return regmap_write(tps->regmap, reg, val); |
| default: |
| return -EINVAL; |
| } |
| } |
| EXPORT_SYMBOL_GPL(tps65217_reg_write); |
| |
| /** |
| * tps65217_update_bits: Modify bits w.r.t mask, val and level. |
| * |
| * @tps65217: Device to write to. |
| * @reg: Register to read-write to. |
| * @mask: Mask. |
| * @val: Value to write. |
| * @level: Password protected level |
| */ |
| int tps65217_update_bits(struct tps65217 *tps, unsigned int reg, |
| unsigned int mask, unsigned int val, unsigned int level) |
| { |
| int ret; |
| unsigned int data; |
| |
| ret = tps65217_reg_read(tps, reg, &data); |
| if (ret) { |
| dev_err(tps->dev, "Read from reg 0x%x failed\n", reg); |
| return ret; |
| } |
| |
| data &= ~mask; |
| data |= val & mask; |
| |
| ret = tps65217_reg_write(tps, reg, data, level); |
| if (ret) |
| dev_err(tps->dev, "Write for reg 0x%x failed\n", reg); |
| |
| return ret; |
| } |
| |
| int tps65217_set_bits(struct tps65217 *tps, unsigned int reg, |
| unsigned int mask, unsigned int val, unsigned int level) |
| { |
| return tps65217_update_bits(tps, reg, mask, val, level); |
| } |
| EXPORT_SYMBOL_GPL(tps65217_set_bits); |
| |
| int tps65217_clear_bits(struct tps65217 *tps, unsigned int reg, |
| unsigned int mask, unsigned int level) |
| { |
| return tps65217_update_bits(tps, reg, mask, 0, level); |
| } |
| EXPORT_SYMBOL_GPL(tps65217_clear_bits); |
| |
| static struct regmap_config tps65217_regmap_config = { |
| .reg_bits = 8, |
| .val_bits = 8, |
| }; |
| |
| static int __devinit tps65217_probe(struct i2c_client *client, |
| const struct i2c_device_id *ids) |
| { |
| struct tps65217 *tps; |
| struct tps65217_board *pdata = client->dev.platform_data; |
| int i, ret; |
| unsigned int version; |
| |
| tps = devm_kzalloc(&client->dev, sizeof(*tps), GFP_KERNEL); |
| if (!tps) |
| return -ENOMEM; |
| |
| tps->pdata = pdata; |
| tps->regmap = devm_regmap_init_i2c(client, &tps65217_regmap_config); |
| if (IS_ERR(tps->regmap)) { |
| ret = PTR_ERR(tps->regmap); |
| dev_err(tps->dev, "Failed to allocate register map: %d\n", |
| ret); |
| return ret; |
| } |
| |
| i2c_set_clientdata(client, tps); |
| tps->dev = &client->dev; |
| |
| ret = tps65217_reg_read(tps, TPS65217_REG_CHIPID, &version); |
| if (ret < 0) { |
| dev_err(tps->dev, "Failed to read revision register: %d\n", |
| ret); |
| return ret; |
| } |
| |
| dev_info(tps->dev, "TPS65217 ID %#x version 1.%d\n", |
| (version & TPS65217_CHIPID_CHIP_MASK) >> 4, |
| version & TPS65217_CHIPID_REV_MASK); |
| |
| for (i = 0; i < TPS65217_NUM_REGULATOR; i++) { |
| struct platform_device *pdev; |
| |
| pdev = platform_device_alloc("tps65217-pmic", i); |
| if (!pdev) { |
| dev_err(tps->dev, "Cannot create regulator %d\n", i); |
| continue; |
| } |
| |
| pdev->dev.parent = tps->dev; |
| platform_device_add_data(pdev, &pdata->tps65217_init_data[i], |
| sizeof(pdata->tps65217_init_data[i])); |
| tps->regulator_pdev[i] = pdev; |
| |
| platform_device_add(pdev); |
| } |
| |
| return 0; |
| } |
| |
| static int __devexit tps65217_remove(struct i2c_client *client) |
| { |
| struct tps65217 *tps = i2c_get_clientdata(client); |
| int i; |
| |
| for (i = 0; i < TPS65217_NUM_REGULATOR; i++) |
| platform_device_unregister(tps->regulator_pdev[i]); |
| |
| return 0; |
| } |
| |
| static const struct i2c_device_id tps65217_id_table[] = { |
| {"tps65217", 0xF0}, |
| {/* end of list */} |
| }; |
| MODULE_DEVICE_TABLE(i2c, tps65217_id_table); |
| |
| static struct i2c_driver tps65217_driver = { |
| .driver = { |
| .name = "tps65217", |
| }, |
| .id_table = tps65217_id_table, |
| .probe = tps65217_probe, |
| .remove = __devexit_p(tps65217_remove), |
| }; |
| |
| static int __init tps65217_init(void) |
| { |
| return i2c_add_driver(&tps65217_driver); |
| } |
| subsys_initcall(tps65217_init); |
| |
| static void __exit tps65217_exit(void) |
| { |
| i2c_del_driver(&tps65217_driver); |
| } |
| module_exit(tps65217_exit); |
| |
| MODULE_AUTHOR("AnilKumar Ch <anilkumar@ti.com>"); |
| MODULE_DESCRIPTION("TPS65217 chip family multi-function driver"); |
| MODULE_LICENSE("GPL v2"); |