mirror of
https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
synced 2025-09-07 08:48:05 -04:00
Fixed MTP to work with TWRP
This commit is contained in:
commit
f6dfaef42e
50820 changed files with 20846062 additions and 0 deletions
112
drivers/mfd/smsc-ece1099.c
Normal file
112
drivers/mfd/smsc-ece1099.c
Normal file
|
@ -0,0 +1,112 @@
|
|||
/*
|
||||
* TI SMSC MFD Driver
|
||||
*
|
||||
* Copyright (C) 2012 Texas Instruments Incorporated - http://www.ti.com
|
||||
*
|
||||
* Author: Sourav Poddar <sourav.poddar@ti.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; GPL v2.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/module.h>
|
||||
#include <linux/moduleparam.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/gpio.h>
|
||||
#include <linux/workqueue.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/regmap.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/mfd/core.h>
|
||||
#include <linux/mfd/smsc.h>
|
||||
#include <linux/of_platform.h>
|
||||
|
||||
static struct regmap_config smsc_regmap_config = {
|
||||
.reg_bits = 8,
|
||||
.val_bits = 8,
|
||||
.max_register = SMSC_VEN_ID_H,
|
||||
.cache_type = REGCACHE_RBTREE,
|
||||
};
|
||||
|
||||
static int smsc_i2c_probe(struct i2c_client *i2c,
|
||||
const struct i2c_device_id *id)
|
||||
{
|
||||
struct smsc *smsc;
|
||||
int devid, rev, venid_l, venid_h;
|
||||
int ret = 0;
|
||||
|
||||
smsc = devm_kzalloc(&i2c->dev, sizeof(struct smsc),
|
||||
GFP_KERNEL);
|
||||
if (!smsc) {
|
||||
dev_err(&i2c->dev, "smsc mfd driver memory allocation failed\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
smsc->regmap = devm_regmap_init_i2c(i2c, &smsc_regmap_config);
|
||||
if (IS_ERR(smsc->regmap)) {
|
||||
ret = PTR_ERR(smsc->regmap);
|
||||
goto err;
|
||||
}
|
||||
|
||||
i2c_set_clientdata(i2c, smsc);
|
||||
smsc->dev = &i2c->dev;
|
||||
|
||||
#ifdef CONFIG_OF
|
||||
of_property_read_u32(i2c->dev.of_node, "clock", &smsc->clk);
|
||||
#endif
|
||||
|
||||
regmap_read(smsc->regmap, SMSC_DEV_ID, &devid);
|
||||
regmap_read(smsc->regmap, SMSC_DEV_REV, &rev);
|
||||
regmap_read(smsc->regmap, SMSC_VEN_ID_L, &venid_l);
|
||||
regmap_read(smsc->regmap, SMSC_VEN_ID_H, &venid_h);
|
||||
|
||||
dev_info(&i2c->dev, "SMSCxxx devid: %02x rev: %02x venid: %02x\n",
|
||||
devid, rev, (venid_h << 8) | venid_l);
|
||||
|
||||
ret = regmap_write(smsc->regmap, SMSC_CLK_CTRL, smsc->clk);
|
||||
if (ret)
|
||||
goto err;
|
||||
|
||||
#ifdef CONFIG_OF
|
||||
if (i2c->dev.of_node)
|
||||
ret = of_platform_populate(i2c->dev.of_node,
|
||||
NULL, NULL, &i2c->dev);
|
||||
#endif
|
||||
|
||||
err:
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int smsc_i2c_remove(struct i2c_client *i2c)
|
||||
{
|
||||
struct smsc *smsc = i2c_get_clientdata(i2c);
|
||||
|
||||
mfd_remove_devices(smsc->dev);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct i2c_device_id smsc_i2c_id[] = {
|
||||
{ "smscece1099", 0},
|
||||
{},
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, smsc_i2c_id);
|
||||
|
||||
static struct i2c_driver smsc_i2c_driver = {
|
||||
.driver = {
|
||||
.name = "smsc",
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.probe = smsc_i2c_probe,
|
||||
.remove = smsc_i2c_remove,
|
||||
.id_table = smsc_i2c_id,
|
||||
};
|
||||
|
||||
module_i2c_driver(smsc_i2c_driver);
|
||||
|
||||
MODULE_AUTHOR("Sourav Poddar <sourav.poddar@ti.com>");
|
||||
MODULE_DESCRIPTION("SMSC chip multi-function driver");
|
||||
MODULE_LICENSE("GPL v2");
|
Loading…
Add table
Add a link
Reference in a new issue