9f3519d2ed
w1_bq27000 adds a bq27000-battery platform device but does not provide platform data for it. This causes the bq27x00 driver to dereference a NULL pointer. So provide the appropriate platform data. This requires modifying w1_bq27000_read so that it find the w1 device as the parent of the bq device. Also there is no point exporting w1_bq27000_read as nothing else uses it or could use it. So make it static. Finally, as there is no way to track how many batteries have been found, and we will probably only find one, use an id number of '-1' to assert that this is a unique instance. Signed-off-by: NeilBrown <neilb@suse.de> Tested-by: Thomas Weber <weber@corscience.de> Acked-by: Evgeniy Polyakov <zbr@ioremap.net> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
131 lines
2.7 KiB
C
131 lines
2.7 KiB
C
/*
|
|
* drivers/w1/slaves/w1_bq27000.c
|
|
*
|
|
* Copyright (C) 2007 Texas Instruments, Inc.
|
|
*
|
|
* This file is licensed under the terms of the GNU General Public License
|
|
* version 2. This program is licensed "as is" without any warranty of any
|
|
* kind, whether express or implied.
|
|
*
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/device.h>
|
|
#include <linux/types.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/power/bq27x00_battery.h>
|
|
|
|
#include "../w1.h"
|
|
#include "../w1_int.h"
|
|
#include "../w1_family.h"
|
|
|
|
#define HDQ_CMD_READ (0)
|
|
#define HDQ_CMD_WRITE (1<<7)
|
|
|
|
static int F_ID;
|
|
|
|
void w1_bq27000_write(struct device *dev, u8 buf, u8 reg)
|
|
{
|
|
struct w1_slave *sl = container_of(dev, struct w1_slave, dev);
|
|
|
|
if (!dev) {
|
|
pr_info("Could not obtain slave dev ptr\n");
|
|
return;
|
|
}
|
|
|
|
w1_write_8(sl->master, HDQ_CMD_WRITE | reg);
|
|
w1_write_8(sl->master, buf);
|
|
}
|
|
EXPORT_SYMBOL(w1_bq27000_write);
|
|
|
|
static int w1_bq27000_read(struct device *dev, unsigned int reg)
|
|
{
|
|
u8 val;
|
|
struct w1_slave *sl = container_of(dev->parent, struct w1_slave, dev);
|
|
|
|
if (!dev)
|
|
return 0;
|
|
|
|
w1_write_8(sl->master, HDQ_CMD_READ | reg);
|
|
val = w1_read_8(sl->master);
|
|
|
|
return val;
|
|
}
|
|
|
|
static struct bq27000_platform_data bq27000_battery_info = {
|
|
.read = w1_bq27000_read,
|
|
.name = "bq27000-battery",
|
|
};
|
|
|
|
static int w1_bq27000_add_slave(struct w1_slave *sl)
|
|
{
|
|
int ret;
|
|
struct platform_device *pdev;
|
|
|
|
pdev = platform_device_alloc("bq27000-battery", -1);
|
|
if (!pdev) {
|
|
ret = -ENOMEM;
|
|
return ret;
|
|
}
|
|
ret = platform_device_add_data(pdev,
|
|
&bq27000_battery_info,
|
|
sizeof(bq27000_battery_info));
|
|
pdev->dev.parent = &sl->dev;
|
|
|
|
ret = platform_device_add(pdev);
|
|
if (ret)
|
|
goto pdev_add_failed;
|
|
|
|
dev_set_drvdata(&sl->dev, pdev);
|
|
|
|
goto success;
|
|
|
|
pdev_add_failed:
|
|
platform_device_unregister(pdev);
|
|
success:
|
|
return ret;
|
|
}
|
|
|
|
static void w1_bq27000_remove_slave(struct w1_slave *sl)
|
|
{
|
|
struct platform_device *pdev = dev_get_drvdata(&sl->dev);
|
|
|
|
platform_device_unregister(pdev);
|
|
}
|
|
|
|
static struct w1_family_ops w1_bq27000_fops = {
|
|
.add_slave = w1_bq27000_add_slave,
|
|
.remove_slave = w1_bq27000_remove_slave,
|
|
};
|
|
|
|
static struct w1_family w1_bq27000_family = {
|
|
.fid = 1,
|
|
.fops = &w1_bq27000_fops,
|
|
};
|
|
|
|
static int __init w1_bq27000_init(void)
|
|
{
|
|
if (F_ID)
|
|
w1_bq27000_family.fid = F_ID;
|
|
|
|
return w1_register_family(&w1_bq27000_family);
|
|
}
|
|
|
|
static void __exit w1_bq27000_exit(void)
|
|
{
|
|
w1_unregister_family(&w1_bq27000_family);
|
|
}
|
|
|
|
|
|
module_init(w1_bq27000_init);
|
|
module_exit(w1_bq27000_exit);
|
|
|
|
module_param(F_ID, int, S_IRUSR);
|
|
MODULE_PARM_DESC(F_ID, "1-wire slave FID for BQ device");
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_AUTHOR("Texas Instruments Ltd");
|
|
MODULE_DESCRIPTION("HDQ/1-wire slave driver bq27000 battery monitor chip");
|