forked from luck/tmp_suning_uos_patched
fbae3fb154
I2C drivers can use the clientdata-pointer to point to private data. As I2C
devices are not really unregistered, but merely detached from their driver, it
used to be the drivers obligation to clear this pointer during remove() or a
failed probe(). As a couple of drivers forgot to do this, it was agreed that it
was cleaner if the i2c-core does this clearance when appropriate, as there is
no guarantee for the lifetime of the clientdata-pointer after remove() anyhow.
This feature was added to the core with commit
e4a7b9b04d to fix the faulty drivers.
As there is no need anymore to clear the clientdata-pointer, remove all current
occurrences in the drivers to simplify the code and prevent confusion.
Signed-off-by: Wolfram Sang <w.sang@pengutronix.de>
Acked-by: Mark Brown <broonie@opensource.wolfsonmicro.com>
Acked-by: Greg Kroah-Hartman <gregkh@suse.de>
Acked-by: Richard Purdie <rpurdie@linux.intel.com>
Acked-by: Dmitry Torokhov <dtor@mail.ru>
Signed-off-by: Jean Delvare <khali@linux-fr.org>
396 lines
8.5 KiB
C
396 lines
8.5 KiB
C
/* NXP PCF50633 Power Management Unit (PMU) driver
|
|
*
|
|
* (C) 2006-2008 by Openmoko, Inc.
|
|
* Author: Harald Welte <laforge@openmoko.org>
|
|
* Balaji Rao <balajirrao@openmoko.org>
|
|
* All rights reserved.
|
|
*
|
|
* 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; either version 2 of the License, or (at your
|
|
* option) any later version.
|
|
*
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/device.h>
|
|
#include <linux/sysfs.h>
|
|
#include <linux/module.h>
|
|
#include <linux/types.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/workqueue.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/slab.h>
|
|
|
|
#include <linux/mfd/pcf50633/core.h>
|
|
|
|
int pcf50633_irq_init(struct pcf50633 *pcf, int irq);
|
|
void pcf50633_irq_free(struct pcf50633 *pcf);
|
|
#ifdef CONFIG_PM
|
|
int pcf50633_irq_suspend(struct pcf50633 *pcf);
|
|
int pcf50633_irq_resume(struct pcf50633 *pcf);
|
|
#endif
|
|
|
|
static int __pcf50633_read(struct pcf50633 *pcf, u8 reg, int num, u8 *data)
|
|
{
|
|
int ret;
|
|
|
|
ret = i2c_smbus_read_i2c_block_data(pcf->i2c_client, reg,
|
|
num, data);
|
|
if (ret < 0)
|
|
dev_err(pcf->dev, "Error reading %d regs at %d\n", num, reg);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int __pcf50633_write(struct pcf50633 *pcf, u8 reg, int num, u8 *data)
|
|
{
|
|
int ret;
|
|
|
|
ret = i2c_smbus_write_i2c_block_data(pcf->i2c_client, reg,
|
|
num, data);
|
|
if (ret < 0)
|
|
dev_err(pcf->dev, "Error writing %d regs at %d\n", num, reg);
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
/* Read a block of upto 32 regs */
|
|
int pcf50633_read_block(struct pcf50633 *pcf, u8 reg,
|
|
int nr_regs, u8 *data)
|
|
{
|
|
int ret;
|
|
|
|
mutex_lock(&pcf->lock);
|
|
ret = __pcf50633_read(pcf, reg, nr_regs, data);
|
|
mutex_unlock(&pcf->lock);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pcf50633_read_block);
|
|
|
|
/* Write a block of upto 32 regs */
|
|
int pcf50633_write_block(struct pcf50633 *pcf , u8 reg,
|
|
int nr_regs, u8 *data)
|
|
{
|
|
int ret;
|
|
|
|
mutex_lock(&pcf->lock);
|
|
ret = __pcf50633_write(pcf, reg, nr_regs, data);
|
|
mutex_unlock(&pcf->lock);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pcf50633_write_block);
|
|
|
|
u8 pcf50633_reg_read(struct pcf50633 *pcf, u8 reg)
|
|
{
|
|
u8 val;
|
|
|
|
mutex_lock(&pcf->lock);
|
|
__pcf50633_read(pcf, reg, 1, &val);
|
|
mutex_unlock(&pcf->lock);
|
|
|
|
return val;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pcf50633_reg_read);
|
|
|
|
int pcf50633_reg_write(struct pcf50633 *pcf, u8 reg, u8 val)
|
|
{
|
|
int ret;
|
|
|
|
mutex_lock(&pcf->lock);
|
|
ret = __pcf50633_write(pcf, reg, 1, &val);
|
|
mutex_unlock(&pcf->lock);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pcf50633_reg_write);
|
|
|
|
int pcf50633_reg_set_bit_mask(struct pcf50633 *pcf, u8 reg, u8 mask, u8 val)
|
|
{
|
|
int ret;
|
|
u8 tmp;
|
|
|
|
val &= mask;
|
|
|
|
mutex_lock(&pcf->lock);
|
|
ret = __pcf50633_read(pcf, reg, 1, &tmp);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
tmp &= ~mask;
|
|
tmp |= val;
|
|
ret = __pcf50633_write(pcf, reg, 1, &tmp);
|
|
|
|
out:
|
|
mutex_unlock(&pcf->lock);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pcf50633_reg_set_bit_mask);
|
|
|
|
int pcf50633_reg_clear_bits(struct pcf50633 *pcf, u8 reg, u8 val)
|
|
{
|
|
int ret;
|
|
u8 tmp;
|
|
|
|
mutex_lock(&pcf->lock);
|
|
ret = __pcf50633_read(pcf, reg, 1, &tmp);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
tmp &= ~val;
|
|
ret = __pcf50633_write(pcf, reg, 1, &tmp);
|
|
|
|
out:
|
|
mutex_unlock(&pcf->lock);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(pcf50633_reg_clear_bits);
|
|
|
|
/* sysfs attributes */
|
|
static ssize_t show_dump_regs(struct device *dev, struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct pcf50633 *pcf = dev_get_drvdata(dev);
|
|
u8 dump[16];
|
|
int n, n1, idx = 0;
|
|
char *buf1 = buf;
|
|
static u8 address_no_read[] = { /* must be ascending */
|
|
PCF50633_REG_INT1,
|
|
PCF50633_REG_INT2,
|
|
PCF50633_REG_INT3,
|
|
PCF50633_REG_INT4,
|
|
PCF50633_REG_INT5,
|
|
0 /* terminator */
|
|
};
|
|
|
|
for (n = 0; n < 256; n += sizeof(dump)) {
|
|
for (n1 = 0; n1 < sizeof(dump); n1++)
|
|
if (n == address_no_read[idx]) {
|
|
idx++;
|
|
dump[n1] = 0x00;
|
|
} else
|
|
dump[n1] = pcf50633_reg_read(pcf, n + n1);
|
|
|
|
hex_dump_to_buffer(dump, sizeof(dump), 16, 1, buf1, 128, 0);
|
|
buf1 += strlen(buf1);
|
|
*buf1++ = '\n';
|
|
*buf1 = '\0';
|
|
}
|
|
|
|
return buf1 - buf;
|
|
}
|
|
static DEVICE_ATTR(dump_regs, 0400, show_dump_regs, NULL);
|
|
|
|
static ssize_t show_resume_reason(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct pcf50633 *pcf = dev_get_drvdata(dev);
|
|
int n;
|
|
|
|
n = sprintf(buf, "%02x%02x%02x%02x%02x\n",
|
|
pcf->resume_reason[0],
|
|
pcf->resume_reason[1],
|
|
pcf->resume_reason[2],
|
|
pcf->resume_reason[3],
|
|
pcf->resume_reason[4]);
|
|
|
|
return n;
|
|
}
|
|
static DEVICE_ATTR(resume_reason, 0400, show_resume_reason, NULL);
|
|
|
|
static struct attribute *pcf_sysfs_entries[] = {
|
|
&dev_attr_dump_regs.attr,
|
|
&dev_attr_resume_reason.attr,
|
|
NULL,
|
|
};
|
|
|
|
static struct attribute_group pcf_attr_group = {
|
|
.name = NULL, /* put in device directory */
|
|
.attrs = pcf_sysfs_entries,
|
|
};
|
|
|
|
static void
|
|
pcf50633_client_dev_register(struct pcf50633 *pcf, const char *name,
|
|
struct platform_device **pdev)
|
|
{
|
|
int ret;
|
|
|
|
*pdev = platform_device_alloc(name, -1);
|
|
if (!*pdev) {
|
|
dev_err(pcf->dev, "Falied to allocate %s\n", name);
|
|
return;
|
|
}
|
|
|
|
(*pdev)->dev.parent = pcf->dev;
|
|
|
|
ret = platform_device_add(*pdev);
|
|
if (ret) {
|
|
dev_err(pcf->dev, "Failed to register %s: %d\n", name, ret);
|
|
platform_device_put(*pdev);
|
|
*pdev = NULL;
|
|
}
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int pcf50633_suspend(struct i2c_client *client, pm_message_t state)
|
|
{
|
|
struct pcf50633 *pcf;
|
|
pcf = i2c_get_clientdata(client);
|
|
|
|
return pcf50633_irq_suspend(pcf);
|
|
}
|
|
|
|
static int pcf50633_resume(struct i2c_client *client)
|
|
{
|
|
struct pcf50633 *pcf;
|
|
pcf = i2c_get_clientdata(client);
|
|
|
|
return pcf50633_irq_resume(pcf);
|
|
}
|
|
#else
|
|
#define pcf50633_suspend NULL
|
|
#define pcf50633_resume NULL
|
|
#endif
|
|
|
|
static int __devinit pcf50633_probe(struct i2c_client *client,
|
|
const struct i2c_device_id *ids)
|
|
{
|
|
struct pcf50633 *pcf;
|
|
struct pcf50633_platform_data *pdata = client->dev.platform_data;
|
|
int i, ret;
|
|
int version, variant;
|
|
|
|
if (!client->irq) {
|
|
dev_err(&client->dev, "Missing IRQ\n");
|
|
return -ENOENT;
|
|
}
|
|
|
|
pcf = kzalloc(sizeof(*pcf), GFP_KERNEL);
|
|
if (!pcf)
|
|
return -ENOMEM;
|
|
|
|
pcf->pdata = pdata;
|
|
|
|
mutex_init(&pcf->lock);
|
|
|
|
i2c_set_clientdata(client, pcf);
|
|
pcf->dev = &client->dev;
|
|
pcf->i2c_client = client;
|
|
|
|
version = pcf50633_reg_read(pcf, 0);
|
|
variant = pcf50633_reg_read(pcf, 1);
|
|
if (version < 0 || variant < 0) {
|
|
dev_err(pcf->dev, "Unable to probe pcf50633\n");
|
|
ret = -ENODEV;
|
|
goto err_free;
|
|
}
|
|
|
|
dev_info(pcf->dev, "Probed device version %d variant %d\n",
|
|
version, variant);
|
|
|
|
pcf50633_irq_init(pcf, client->irq);
|
|
|
|
/* Create sub devices */
|
|
pcf50633_client_dev_register(pcf, "pcf50633-input",
|
|
&pcf->input_pdev);
|
|
pcf50633_client_dev_register(pcf, "pcf50633-rtc",
|
|
&pcf->rtc_pdev);
|
|
pcf50633_client_dev_register(pcf, "pcf50633-mbc",
|
|
&pcf->mbc_pdev);
|
|
pcf50633_client_dev_register(pcf, "pcf50633-adc",
|
|
&pcf->adc_pdev);
|
|
pcf50633_client_dev_register(pcf, "pcf50633-backlight",
|
|
&pcf->bl_pdev);
|
|
|
|
|
|
for (i = 0; i < PCF50633_NUM_REGULATORS; i++) {
|
|
struct platform_device *pdev;
|
|
|
|
pdev = platform_device_alloc("pcf50633-regltr", i);
|
|
if (!pdev) {
|
|
dev_err(pcf->dev, "Cannot create regulator %d\n", i);
|
|
continue;
|
|
}
|
|
|
|
pdev->dev.parent = pcf->dev;
|
|
platform_device_add_data(pdev, &pdata->reg_init_data[i],
|
|
sizeof(pdata->reg_init_data[i]));
|
|
pcf->regulator_pdev[i] = pdev;
|
|
|
|
platform_device_add(pdev);
|
|
}
|
|
|
|
ret = sysfs_create_group(&client->dev.kobj, &pcf_attr_group);
|
|
if (ret)
|
|
dev_err(pcf->dev, "error creating sysfs entries\n");
|
|
|
|
if (pdata->probe_done)
|
|
pdata->probe_done(pcf);
|
|
|
|
return 0;
|
|
|
|
err_free:
|
|
kfree(pcf);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int __devexit pcf50633_remove(struct i2c_client *client)
|
|
{
|
|
struct pcf50633 *pcf = i2c_get_clientdata(client);
|
|
int i;
|
|
|
|
pcf50633_irq_free(pcf);
|
|
|
|
platform_device_unregister(pcf->input_pdev);
|
|
platform_device_unregister(pcf->rtc_pdev);
|
|
platform_device_unregister(pcf->mbc_pdev);
|
|
platform_device_unregister(pcf->adc_pdev);
|
|
|
|
for (i = 0; i < PCF50633_NUM_REGULATORS; i++)
|
|
platform_device_unregister(pcf->regulator_pdev[i]);
|
|
|
|
kfree(pcf);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct i2c_device_id pcf50633_id_table[] = {
|
|
{"pcf50633", 0x73},
|
|
{/* end of list */}
|
|
};
|
|
|
|
static struct i2c_driver pcf50633_driver = {
|
|
.driver = {
|
|
.name = "pcf50633",
|
|
},
|
|
.id_table = pcf50633_id_table,
|
|
.probe = pcf50633_probe,
|
|
.remove = __devexit_p(pcf50633_remove),
|
|
.suspend = pcf50633_suspend,
|
|
.resume = pcf50633_resume,
|
|
};
|
|
|
|
static int __init pcf50633_init(void)
|
|
{
|
|
return i2c_add_driver(&pcf50633_driver);
|
|
}
|
|
|
|
static void __exit pcf50633_exit(void)
|
|
{
|
|
i2c_del_driver(&pcf50633_driver);
|
|
}
|
|
|
|
MODULE_DESCRIPTION("I2C chip driver for NXP PCF50633 PMU");
|
|
MODULE_AUTHOR("Harald Welte <laforge@openmoko.org>");
|
|
MODULE_LICENSE("GPL");
|
|
|
|
subsys_initcall(pcf50633_init);
|
|
module_exit(pcf50633_exit);
|