diff options
author | codeworkx <daniel.hillenbrand@codeworkx.de> | 2012-06-02 13:09:29 +0200 |
---|---|---|
committer | codeworkx <daniel.hillenbrand@codeworkx.de> | 2012-06-02 13:09:29 +0200 |
commit | c6da2cfeb05178a11c6d062a06f8078150ee492f (patch) | |
tree | f3b4021d252c52d6463a9b3c1bb7245e399b009c /drivers/mfd/max8698.c | |
parent | c6d7c4dbff353eac7919342ae6b3299a378160a6 (diff) | |
download | kernel_samsung_smdk4412-c6da2cfeb05178a11c6d062a06f8078150ee492f.zip kernel_samsung_smdk4412-c6da2cfeb05178a11c6d062a06f8078150ee492f.tar.gz kernel_samsung_smdk4412-c6da2cfeb05178a11c6d062a06f8078150ee492f.tar.bz2 |
samsung update 1
Diffstat (limited to 'drivers/mfd/max8698.c')
-rw-r--r-- | drivers/mfd/max8698.c | 161 |
1 files changed, 161 insertions, 0 deletions
diff --git a/drivers/mfd/max8698.c b/drivers/mfd/max8698.c new file mode 100644 index 0000000..9dd6004 --- /dev/null +++ b/drivers/mfd/max8698.c @@ -0,0 +1,161 @@ +/* + * max8698.c - mfd core driver for the Maxim 8698 + * + * Copyright (C) 2009-2010 Samsung Electronics + * Kyungmin Park <kyungmin.park@samsung.com> + * Marek Szyprowski <m.szyprowski@samsung.com> + * + * 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. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA + * + * 2010.10.26 + * Modified by Taekki Kim <taekki.kim@samsung.com> + */ + +#include <linux/module.h> +#include <linux/moduleparam.h> +#include <linux/init.h> +#include <linux/slab.h> +#include <linux/i2c.h> +#include <linux/mutex.h> +#include <linux/mfd/core.h> +#include <linux/mfd/max8698.h> +#include <linux/mfd/max8698-private.h> + +static struct mfd_cell max8698_devs[] = { + { + .name = "max8698-pmic", + } +}; + +static int max8698_i2c_device_read(struct max8698_dev *max8698, u8 reg, u8 *dest) +{ + struct i2c_client *client = max8698->i2c_client; + int ret; + + mutex_lock(&max8698->iolock); + ret = i2c_smbus_read_byte_data(client, reg); + mutex_unlock(&max8698->iolock); + if (ret < 0) + return ret; + + ret &= 0xff; + *dest = ret; + return 0; +} + +static int max8698_i2c_device_write(struct max8698_dev *max8698, u8 reg, u8 value) +{ + struct i2c_client *client = max8698->i2c_client; + int ret; + + mutex_lock(&max8698->iolock); + ret = i2c_smbus_write_byte_data(client, reg, value); + mutex_unlock(&max8698->iolock); + return ret; +} + +static int max8698_i2c_device_update(struct max8698_dev *max8698, u8 reg, + u8 val, u8 mask) +{ + struct i2c_client *client = max8698->i2c_client; + int ret; + + mutex_lock(&max8698->iolock); + ret = i2c_smbus_read_byte_data(client, reg); + if (ret >= 0) { + u8 old_val = ret & 0xff; + u8 new_val = (val & mask) | (old_val & (~mask)); + ret = i2c_smbus_write_byte_data(client, reg, new_val); + if (ret >= 0) + ret = 0; + } + mutex_unlock(&max8698->iolock); + return ret; +} + +static int max8698_i2c_probe(struct i2c_client *i2c, + const struct i2c_device_id *id) +{ + struct max8698_dev *max8698; + int ret = 0; + + max8698 = kzalloc(sizeof(struct max8698_dev), GFP_KERNEL); + if (max8698 == NULL) + return -ENOMEM; + + i2c_set_clientdata(i2c, max8698); + max8698->dev = &i2c->dev; + max8698->i2c_client = i2c; + max8698->dev_read = max8698_i2c_device_read; + max8698->dev_write = max8698_i2c_device_write; + max8698->dev_update = max8698_i2c_device_update; + mutex_init(&max8698->iolock); + + ret = mfd_add_devices(max8698->dev, -1, + max8698_devs, ARRAY_SIZE(max8698_devs), + NULL, 0); + if (ret < 0) + goto err; + + return ret; + +err: + mfd_remove_devices(max8698->dev); + kfree(max8698); + return ret; +} + +static int max8698_i2c_remove(struct i2c_client *i2c) +{ + struct max8698_dev *max8698 = i2c_get_clientdata(i2c); + + mfd_remove_devices(max8698->dev); + kfree(max8698); + + return 0; +} + +static const struct i2c_device_id max8698_i2c_id[] = { + { "max8698", 0 }, + { } +}; +MODULE_DEVICE_TABLE(i2c, max8698_i2c_id); + +static struct i2c_driver max8698_i2c_driver = { + .driver = { + .name = "max8698", + .owner = THIS_MODULE, + }, + .probe = max8698_i2c_probe, + .remove = max8698_i2c_remove, + .id_table = max8698_i2c_id, +}; + +static int __init max8698_i2c_init(void) +{ + return i2c_add_driver(&max8698_i2c_driver); +} +/* init early so consumer devices can complete system boot */ +subsys_initcall(max8698_i2c_init); + +static void __exit max8698_i2c_exit(void) +{ + i2c_del_driver(&max8698_i2c_driver); +} +module_exit(max8698_i2c_exit); + +MODULE_DESCRIPTION("MAXIM 8698 multi-function core driver"); +MODULE_AUTHOR("Kyungmin Park <kyungmin.park@samsung.com>"); +MODULE_LICENSE("GPL"); |