lkml.org 
[lkml]   [2011]   [Jun]   [22]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
    Patch in this message
    /
    From
    Subject[PATCH 3/3] mfd: Add I2C control support for S5M8751
    Date
    Implement the I2C control interface for the S5M8751.

    Signed-off-by: Sangbeom Kim <sbkim73@samsung.com>
    ---
    drivers/mfd/Kconfig | 9 +++
    drivers/mfd/Makefile | 2 +
    drivers/mfd/s5m8751-i2c.c | 141 +++++++++++++++++++++++++++++++++++++++++++++
    3 files changed, 152 insertions(+), 0 deletions(-)
    create mode 100644 drivers/mfd/s5m8751-i2c.c

    diff --git a/drivers/mfd/Kconfig b/drivers/mfd/Kconfig
    index 85c91ac..4a8468c 100644
    --- a/drivers/mfd/Kconfig
    +++ b/drivers/mfd/Kconfig
    @@ -388,6 +388,15 @@ config MFD_WM831X_SPI
    config MFD_S5M8751
    tristate

    +config MFD_S5M8751_I2C
    + tristate "Support Samsung S5M8751 PMIC/Audio DAC with I2C"
    + select MFD_S5M8751
    + select MFD_CORE
    + depends on I2C
    + help
    + S5M8751 is an advanced power management with AUDIO DAC. This option
    + enables chip support for the S5M8751 with I2C as the control interface.
    +
    config MFD_WM8350
    bool
    depends on GENERIC_HARDIRQS
    diff --git a/drivers/mfd/Makefile b/drivers/mfd/Makefile
    index 27f99bb..b94476e 100644
    --- a/drivers/mfd/Makefile
    +++ b/drivers/mfd/Makefile
    @@ -96,3 +96,5 @@ obj-$(CONFIG_MFD_PM8XXX_IRQ) += pm8xxx-irq.o
    obj-$(CONFIG_MFD_TPS65910) += tps65910.o tps65910-irq.o
    s5m8751-objs += s5m8751-core.o
    obj-$(CONFIG_MFD_S5M8751) += s5m8751.o
    +obj-$(CONFIG_MFD_S5M8751_I2C) += s5m8751-i2c.o
    +
    diff --git a/drivers/mfd/s5m8751-i2c.c b/drivers/mfd/s5m8751-i2c.c
    new file mode 100644
    index 0000000..4ca680b
    --- /dev/null
    +++ b/drivers/mfd/s5m8751-i2c.c
    @@ -0,0 +1,141 @@
    +/* linux/drivers/mfd/s5m8751-i2s.c
    + *
    + * Copyright (c) 2010-2011 Samsung Electronics Co., Ltd.
    + * http://www.samsung.com
    + *
    + * I2C driver for S5M8751
    + *
    + * This program is free software; you can redistribute it and/or modify
    + * it under the terms of the GNU General Public License version 2 as
    + * published by the Free Software Foundation.
    +*/
    +
    +#include <linux/module.h>
    +#include <linux/moduleparam.h>
    +#include <linux/init.h>
    +#include <linux/interrupt.h>
    +#include <linux/platform_device.h>
    +#include <linux/i2c.h>
    +#include <linux/mfd/s5m8751.h>
    +#include <linux/slab.h>
    +
    +static int s5m8751_i2c_read_device(struct s5m8751 *s5m8751, uint8_t reg,
    + uint8_t *val)
    +{
    + int ret;
    + ret = i2c_smbus_read_byte_data(s5m8751->i2c_client, reg);
    + if (ret < 0) {
    + dev_err(s5m8751->dev, "failed reading at 0x%02x\n", reg);
    + return ret;
    + }
    + *val = (uint8_t)ret;
    + return 0;
    +}
    +
    +static int s5m8751_i2c_write_device(struct s5m8751 *s5m8751, uint8_t reg,
    + uint8_t val)
    +{
    + int ret;
    + ret = i2c_smbus_write_byte_data(s5m8751->i2c_client, reg, val);
    + if (ret < 0) {
    + dev_err(s5m8751->dev, "failed writing 0x%02x to 0x%02x\n",
    + val, reg);
    + return ret;
    + }
    + return 0;
    +}
    +
    +static int s5m8751_i2c_write_block_device(struct s5m8751 *s5m8751, uint8_t reg,
    + int len, uint8_t *val)
    +{
    + int ret;
    + ret = i2c_smbus_write_i2c_block_data(s5m8751->i2c_client, reg, len,
    + val);
    + if (ret < 0) {
    + dev_err(s5m8751->dev, "failed writings to 0x%02x\n", reg);
    + return ret;
    + }
    + return 0;
    +}
    +
    +static int s5m8751_i2c_read_block_device(struct s5m8751 *s5m8751, uint8_t reg,
    + int len, uint8_t *val)
    +{
    + int ret;
    + ret = i2c_smbus_read_i2c_block_data(s5m8751->i2c_client, reg, len, val);
    + if (ret < 0) {
    + dev_err(s5m8751->dev, "failed reading from 0x%02x\n", reg);
    + return ret;
    + }
    + return 0;
    +}
    +
    +static int s5m8751_probe(struct i2c_client *i2c,
    + const struct i2c_device_id *id)
    +{
    + struct s5m8751 *s5m8751;
    + int ret = 0;
    +
    + s5m8751 = kzalloc(sizeof(struct s5m8751), GFP_KERNEL);
    + if (s5m8751 == NULL)
    + goto err;
    +
    + i2c_set_clientdata(i2c, s5m8751);
    +
    + s5m8751->dev = &i2c->dev;
    + s5m8751->i2c_client = i2c;
    + s5m8751->read_dev = s5m8751_i2c_read_device;
    + s5m8751->write_dev = s5m8751_i2c_write_device;
    + s5m8751->read_block_dev = s5m8751_i2c_read_block_device;
    + s5m8751->write_block_dev = s5m8751_i2c_write_block_device;
    +
    + ret = s5m8751_device_init(s5m8751, i2c->irq, i2c->dev.platform_data);
    + if (ret < 0)
    + goto err;
    +
    + return 0;
    +
    +err:
    + return ret;
    +}
    +
    +static int s5m8751_remove(struct i2c_client *i2c)
    +{
    + struct s5m8751 *s5m8751 = i2c_get_clientdata(i2c);
    +
    + s5m8751_device_exit(s5m8751);
    +
    + return 0;
    +}
    +
    +static const struct i2c_device_id s5m8751_i2c_id[] = {
    + { "s5m8751", 0 },
    + { }
    +};
    +MODULE_DEVICE_TABLE(i2c, s5m8751_i2c_id);
    +
    +static struct i2c_driver s5m8751_driver = {
    + .driver = {
    + .name = "s5m8751",
    + .owner = THIS_MODULE,
    + },
    + .probe = s5m8751_probe,
    + .remove = s5m8751_remove,
    + .id_table = s5m8751_i2c_id,
    +};
    +
    +static int __init s5m8751_init(void)
    +{
    + return i2c_add_driver(&s5m8751_driver);
    +}
    +module_init(s5m8751_init);
    +
    +static void __exit s5m8751_exit(void)
    +{
    + i2c_del_driver(&s5m8751_driver);
    +}
    +module_exit(s5m8751_exit);
    +
    +MODULE_DESCRIPTION("I2C Driver for Samsung S5M8751");
    +MODULE_AUTHOR("Sangbeom Kim <sbkim73@samsung.com>");
    +MODULE_LICENSE("GPL");
    --
    1.7.1


    \
     
     \ /
      Last update: 2011-06-22 08:05    [W:0.029 / U:30.036 seconds]
    ©2003-2016 Jasper Spaans. hosted at Digital OceanAdvertise on this site