linux/drivers/mfd/da9052-i2c.c
<<
>>
Prefs
   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#ifdef CONFIG_OF
  26#include <linux/of.h>
  27#include <linux/of_device.h>
  28#endif
  29
  30static int da9052_i2c_enable_multiwrite(struct da9052 *da9052)
  31{
  32        int reg_val, ret;
  33
  34        ret = regmap_read(da9052->regmap, DA9052_CONTROL_B_REG, &reg_val);
  35        if (ret < 0)
  36                return ret;
  37
  38        if (reg_val & DA9052_CONTROL_B_WRITEMODE) {
  39                reg_val &= ~DA9052_CONTROL_B_WRITEMODE;
  40                ret = regmap_write(da9052->regmap, DA9052_CONTROL_B_REG,
  41                                   reg_val);
  42                if (ret < 0)
  43                        return ret;
  44        }
  45
  46        return 0;
  47}
  48
  49static const struct i2c_device_id da9052_i2c_id[] = {
  50        {"da9052", DA9052},
  51        {"da9053-aa", DA9053_AA},
  52        {"da9053-ba", DA9053_BA},
  53        {"da9053-bb", DA9053_BB},
  54        {}
  55};
  56
  57#ifdef CONFIG_OF
  58static const struct of_device_id dialog_dt_ids[] = {
  59        { .compatible = "dlg,da9052", .data = &da9052_i2c_id[0] },
  60        { .compatible = "dlg,da9053-aa", .data = &da9052_i2c_id[1] },
  61        { .compatible = "dlg,da9053-ab", .data = &da9052_i2c_id[2] },
  62        { .compatible = "dlg,da9053-bb", .data = &da9052_i2c_id[3] },
  63        { /* sentinel */ }
  64};
  65#endif
  66
  67static int __devinit da9052_i2c_probe(struct i2c_client *client,
  68                                       const struct i2c_device_id *id)
  69{
  70        struct da9052 *da9052;
  71        int ret;
  72
  73        da9052 = devm_kzalloc(&client->dev, sizeof(struct da9052), GFP_KERNEL);
  74        if (!da9052)
  75                return -ENOMEM;
  76
  77        if (!i2c_check_functionality(client->adapter,
  78                                     I2C_FUNC_SMBUS_BYTE_DATA)) {
  79                dev_info(&client->dev, "Error in %s:i2c_check_functionality\n",
  80                         __func__);
  81                return  -ENODEV;
  82        }
  83
  84        da9052->dev = &client->dev;
  85        da9052->chip_irq = client->irq;
  86
  87        i2c_set_clientdata(client, da9052);
  88
  89        da9052->regmap = devm_regmap_init_i2c(client, &da9052_regmap_config);
  90        if (IS_ERR(da9052->regmap)) {
  91                ret = PTR_ERR(da9052->regmap);
  92                dev_err(&client->dev, "Failed to allocate register map: %d\n",
  93                        ret);
  94                return ret;
  95        }
  96
  97        ret = da9052_i2c_enable_multiwrite(da9052);
  98        if (ret < 0)
  99                return ret;
 100
 101#ifdef CONFIG_OF
 102        if (!id) {
 103                struct device_node *np = client->dev.of_node;
 104                const struct of_device_id *deviceid;
 105
 106                deviceid = of_match_node(dialog_dt_ids, np);
 107                id = deviceid->data;
 108        }
 109#endif
 110
 111        if (!id) {
 112                ret = -ENODEV;
 113                dev_err(&client->dev, "id is null.\n");
 114                return ret;
 115        }
 116
 117        ret = da9052_device_init(da9052, id->driver_data);
 118        if (ret != 0)
 119                return ret;
 120
 121        return 0;
 122}
 123
 124static int __devexit da9052_i2c_remove(struct i2c_client *client)
 125{
 126        struct da9052 *da9052 = i2c_get_clientdata(client);
 127
 128        da9052_device_exit(da9052);
 129        return 0;
 130}
 131
 132static struct i2c_driver da9052_i2c_driver = {
 133        .probe = da9052_i2c_probe,
 134        .remove = __devexit_p(da9052_i2c_remove),
 135        .id_table = da9052_i2c_id,
 136        .driver = {
 137                .name = "da9052",
 138                .owner = THIS_MODULE,
 139#ifdef CONFIG_OF
 140                .of_match_table = dialog_dt_ids,
 141#endif
 142        },
 143};
 144
 145static int __init da9052_i2c_init(void)
 146{
 147        int ret;
 148
 149        ret = i2c_add_driver(&da9052_i2c_driver);
 150        if (ret != 0) {
 151                pr_err("DA9052 I2C registration failed %d\n", ret);
 152                return ret;
 153        }
 154
 155        return 0;
 156}
 157subsys_initcall(da9052_i2c_init);
 158
 159static void __exit da9052_i2c_exit(void)
 160{
 161        i2c_del_driver(&da9052_i2c_driver);
 162}
 163module_exit(da9052_i2c_exit);
 164
 165MODULE_AUTHOR("David Dajun Chen <dchen@diasemi.com>");
 166MODULE_DESCRIPTION("I2C driver for Dialog DA9052 PMIC");
 167MODULE_LICENSE("GPL");
 168
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.