linux/drivers/mfd/pcf50633-core.c
<<
>>
Prefs
   1/* NXP PCF50633 Power Management Unit (PMU) driver
   2 *
   3 * (C) 2006-2008 by Openmoko, Inc.
   4 * Author: Harald Welte <laforge@openmoko.org>
   5 *         Balaji Rao <balajirrao@openmoko.org>
   6 * All rights reserved.
   7 *
   8 *  This program is free software; you can redistribute  it and/or modify it
   9 *  under  the terms of  the GNU General  Public License as published by the
  10 *  Free Software Foundation;  either version 2 of the  License, or (at your
  11 *  option) any later version.
  12 *
  13 */
  14
  15#include <linux/kernel.h>
  16#include <linux/device.h>
  17#include <linux/sysfs.h>
  18#include <linux/module.h>
  19#include <linux/types.h>
  20#include <linux/interrupt.h>
  21#include <linux/workqueue.h>
  22#include <linux/platform_device.h>
  23#include <linux/i2c.h>
  24#include <linux/pm.h>
  25#include <linux/slab.h>
  26#include <linux/regmap.h>
  27#include <linux/err.h>
  28
  29#include <linux/mfd/pcf50633/core.h>
  30
  31/* Read a block of up to 32 regs  */
  32int pcf50633_read_block(struct pcf50633 *pcf, u8 reg,
  33                                        int nr_regs, u8 *data)
  34{
  35        int ret;
  36
  37        ret = regmap_raw_read(pcf->regmap, reg, data, nr_regs);
  38        if (ret != 0)
  39                return ret;
  40
  41        return nr_regs;
  42}
  43EXPORT_SYMBOL_GPL(pcf50633_read_block);
  44
  45/* Write a block of up to 32 regs  */
  46int pcf50633_write_block(struct pcf50633 *pcf , u8 reg,
  47                                        int nr_regs, u8 *data)
  48{
  49        return regmap_raw_write(pcf->regmap, reg, data, nr_regs);
  50}
  51EXPORT_SYMBOL_GPL(pcf50633_write_block);
  52
  53u8 pcf50633_reg_read(struct pcf50633 *pcf, u8 reg)
  54{
  55        unsigned int val;
  56        int ret;
  57
  58        ret = regmap_read(pcf->regmap, reg, &val);
  59        if (ret < 0)
  60                return -1;
  61
  62        return val;
  63}
  64EXPORT_SYMBOL_GPL(pcf50633_reg_read);
  65
  66int pcf50633_reg_write(struct pcf50633 *pcf, u8 reg, u8 val)
  67{
  68        return regmap_write(pcf->regmap, reg, val);
  69}
  70EXPORT_SYMBOL_GPL(pcf50633_reg_write);
  71
  72int pcf50633_reg_set_bit_mask(struct pcf50633 *pcf, u8 reg, u8 mask, u8 val)
  73{
  74        return regmap_update_bits(pcf->regmap, reg, mask, val);
  75}
  76EXPORT_SYMBOL_GPL(pcf50633_reg_set_bit_mask);
  77
  78int pcf50633_reg_clear_bits(struct pcf50633 *pcf, u8 reg, u8 val)
  79{
  80        return regmap_update_bits(pcf->regmap, reg, val, 0);
  81}
  82EXPORT_SYMBOL_GPL(pcf50633_reg_clear_bits);
  83
  84/* sysfs attributes */
  85static ssize_t show_dump_regs(struct device *dev, struct device_attribute *attr,
  86                            char *buf)
  87{
  88        struct pcf50633 *pcf = dev_get_drvdata(dev);
  89        u8 dump[16];
  90        int n, n1, idx = 0;
  91        char *buf1 = buf;
  92        static u8 address_no_read[] = { /* must be ascending */
  93                PCF50633_REG_INT1,
  94                PCF50633_REG_INT2,
  95                PCF50633_REG_INT3,
  96                PCF50633_REG_INT4,
  97                PCF50633_REG_INT5,
  98                0 /* terminator */
  99        };
 100
 101        for (n = 0; n < 256; n += sizeof(dump)) {
 102                for (n1 = 0; n1 < sizeof(dump); n1++)
 103                        if (n == address_no_read[idx]) {
 104                                idx++;
 105                                dump[n1] = 0x00;
 106                        } else
 107                                dump[n1] = pcf50633_reg_read(pcf, n + n1);
 108
 109                hex_dump_to_buffer(dump, sizeof(dump), 16, 1, buf1, 128, 0);
 110                buf1 += strlen(buf1);
 111                *buf1++ = '\n';
 112                *buf1 = '\0';
 113        }
 114
 115        return buf1 - buf;
 116}
 117static DEVICE_ATTR(dump_regs, 0400, show_dump_regs, NULL);
 118
 119static ssize_t show_resume_reason(struct device *dev,
 120                                struct device_attribute *attr, char *buf)
 121{
 122        struct pcf50633 *pcf = dev_get_drvdata(dev);
 123        int n;
 124
 125        n = sprintf(buf, "%02x%02x%02x%02x%02x\n",
 126                                pcf->resume_reason[0],
 127                                pcf->resume_reason[1],
 128                                pcf->resume_reason[2],
 129                                pcf->resume_reason[3],
 130                                pcf->resume_reason[4]);
 131
 132        return n;
 133}
 134static DEVICE_ATTR(resume_reason, 0400, show_resume_reason, NULL);
 135
 136static struct attribute *pcf_sysfs_entries[] = {
 137        &dev_attr_dump_regs.attr,
 138        &dev_attr_resume_reason.attr,
 139        NULL,
 140};
 141
 142static struct attribute_group pcf_attr_group = {
 143        .name   = NULL,                 /* put in device directory */
 144        .attrs  = pcf_sysfs_entries,
 145};
 146
 147static void
 148pcf50633_client_dev_register(struct pcf50633 *pcf, const char *name,
 149                                                struct platform_device **pdev)
 150{
 151        int ret;
 152
 153        *pdev = platform_device_alloc(name, -1);
 154        if (!*pdev) {
 155                dev_err(pcf->dev, "Falied to allocate %s\n", name);
 156                return;
 157        }
 158
 159        (*pdev)->dev.parent = pcf->dev;
 160
 161        ret = platform_device_add(*pdev);
 162        if (ret) {
 163                dev_err(pcf->dev, "Failed to register %s: %d\n", name, ret);
 164                platform_device_put(*pdev);
 165                *pdev = NULL;
 166        }
 167}
 168
 169#ifdef CONFIG_PM_SLEEP
 170static int pcf50633_suspend(struct device *dev)
 171{
 172        struct i2c_client *client = to_i2c_client(dev);
 173        struct pcf50633 *pcf = i2c_get_clientdata(client);
 174
 175        return pcf50633_irq_suspend(pcf);
 176}
 177
 178static int pcf50633_resume(struct device *dev)
 179{
 180        struct i2c_client *client = to_i2c_client(dev);
 181        struct pcf50633 *pcf = i2c_get_clientdata(client);
 182
 183        return pcf50633_irq_resume(pcf);
 184}
 185#endif
 186
 187static SIMPLE_DEV_PM_OPS(pcf50633_pm, pcf50633_suspend, pcf50633_resume);
 188
 189static struct regmap_config pcf50633_regmap_config = {
 190        .reg_bits = 8,
 191        .val_bits = 8,
 192};
 193
 194static int pcf50633_probe(struct i2c_client *client,
 195                                const struct i2c_device_id *ids)
 196{
 197        struct pcf50633 *pcf;
 198        struct pcf50633_platform_data *pdata = dev_get_platdata(&client->dev);
 199        int i, ret;
 200        int version, variant;
 201
 202        if (!client->irq) {
 203                dev_err(&client->dev, "Missing IRQ\n");
 204                return -ENOENT;
 205        }
 206
 207        pcf = devm_kzalloc(&client->dev, sizeof(*pcf), GFP_KERNEL);
 208        if (!pcf)
 209                return -ENOMEM;
 210
 211        i2c_set_clientdata(client, pcf);
 212        pcf->dev = &client->dev;
 213        pcf->pdata = pdata;
 214
 215        mutex_init(&pcf->lock);
 216
 217        pcf->regmap = devm_regmap_init_i2c(client, &pcf50633_regmap_config);
 218        if (IS_ERR(pcf->regmap)) {
 219                ret = PTR_ERR(pcf->regmap);
 220                dev_err(pcf->dev, "Failed to allocate register map: %d\n", ret);
 221                return ret;
 222        }
 223
 224        version = pcf50633_reg_read(pcf, 0);
 225        variant = pcf50633_reg_read(pcf, 1);
 226        if (version < 0 || variant < 0) {
 227                dev_err(pcf->dev, "Unable to probe pcf50633\n");
 228                ret = -ENODEV;
 229                return ret;
 230        }
 231
 232        dev_info(pcf->dev, "Probed device version %d variant %d\n",
 233                                                        version, variant);
 234
 235        pcf50633_irq_init(pcf, client->irq);
 236
 237        /* Create sub devices */
 238        pcf50633_client_dev_register(pcf, "pcf50633-input", &pcf->input_pdev);
 239        pcf50633_client_dev_register(pcf, "pcf50633-rtc", &pcf->rtc_pdev);
 240        pcf50633_client_dev_register(pcf, "pcf50633-mbc", &pcf->mbc_pdev);
 241        pcf50633_client_dev_register(pcf, "pcf50633-adc", &pcf->adc_pdev);
 242        pcf50633_client_dev_register(pcf, "pcf50633-backlight", &pcf->bl_pdev);
 243
 244
 245        for (i = 0; i < PCF50633_NUM_REGULATORS; i++) {
 246                struct platform_device *pdev;
 247
 248                pdev = platform_device_alloc("pcf50633-regltr", i);
 249                if (!pdev) {
 250                        dev_err(pcf->dev, "Cannot create regulator %d\n", i);
 251                        continue;
 252                }
 253
 254                pdev->dev.parent = pcf->dev;
 255                if (platform_device_add_data(pdev, &pdata->reg_init_data[i],
 256                                        sizeof(pdata->reg_init_data[i])) < 0) {
 257                        platform_device_put(pdev);
 258                        dev_err(pcf->dev, "Out of memory for regulator parameters %d\n",
 259                                                                        i);
 260                        continue;
 261                }
 262                pcf->regulator_pdev[i] = pdev;
 263
 264                platform_device_add(pdev);
 265        }
 266
 267        ret = sysfs_create_group(&client->dev.kobj, &pcf_attr_group);
 268        if (ret)
 269                dev_err(pcf->dev, "error creating sysfs entries\n");
 270
 271        if (pdata->probe_done)
 272                pdata->probe_done(pcf);
 273
 274        return 0;
 275}
 276
 277static int pcf50633_remove(struct i2c_client *client)
 278{
 279        struct pcf50633 *pcf = i2c_get_clientdata(client);
 280        int i;
 281
 282        sysfs_remove_group(&client->dev.kobj, &pcf_attr_group);
 283        pcf50633_irq_free(pcf);
 284
 285        platform_device_unregister(pcf->input_pdev);
 286        platform_device_unregister(pcf->rtc_pdev);
 287        platform_device_unregister(pcf->mbc_pdev);
 288        platform_device_unregister(pcf->adc_pdev);
 289        platform_device_unregister(pcf->bl_pdev);
 290
 291        for (i = 0; i < PCF50633_NUM_REGULATORS; i++)
 292                platform_device_unregister(pcf->regulator_pdev[i]);
 293
 294        return 0;
 295}
 296
 297static const struct i2c_device_id pcf50633_id_table[] = {
 298        {"pcf50633", 0x73},
 299        {/* end of list */}
 300};
 301MODULE_DEVICE_TABLE(i2c, pcf50633_id_table);
 302
 303static struct i2c_driver pcf50633_driver = {
 304        .driver = {
 305                .name   = "pcf50633",
 306                .pm     = &pcf50633_pm,
 307        },
 308        .id_table = pcf50633_id_table,
 309        .probe = pcf50633_probe,
 310        .remove = pcf50633_remove,
 311};
 312
 313static int __init pcf50633_init(void)
 314{
 315        return i2c_add_driver(&pcf50633_driver);
 316}
 317
 318static void __exit pcf50633_exit(void)
 319{
 320        i2c_del_driver(&pcf50633_driver);
 321}
 322
 323MODULE_DESCRIPTION("I2C chip driver for NXP PCF50633 PMU");
 324MODULE_AUTHOR("Harald Welte <laforge@openmoko.org>");
 325MODULE_LICENSE("GPL");
 326
 327subsys_initcall(pcf50633_init);
 328module_exit(pcf50633_exit);
 329
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.