mirror of
https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
synced 2025-09-07 08:48:05 -04:00
566 lines
14 KiB
C
566 lines
14 KiB
C
/*
|
|
* s2mpu06.c - mfd core driver for the s2mpu06
|
|
*
|
|
* Copyright (C) 2015 Samsung Electronics
|
|
*
|
|
* 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
|
|
*
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/irq.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/mfd/core.h>
|
|
#include <linux/mfd/samsung/s2mpu06.h>
|
|
#include <linux/mfd/samsung/s2mpu06-private.h>
|
|
#include <linux/regulator/machine.h>
|
|
#include <linux/rtc.h>
|
|
|
|
#if defined(CONFIG_OF)
|
|
#include <linux/of_device.h>
|
|
#include <linux/of_gpio.h>
|
|
#endif /* CONFIG_OF */
|
|
|
|
#define I2C_ADDR_TOP 0x00
|
|
#define I2C_ADDR_PMIC 0x01
|
|
#define I2C_ADDR_RTC 0x02
|
|
#define I2C_ADDR_CODEC 0x03
|
|
#define I2C_ADDR_CHG 0x04
|
|
#define I2C_ADDR_FG 0x05
|
|
#define I2C_ADDR_FLED 0x06
|
|
|
|
static struct mfd_cell s2mpu06_devs[] = {
|
|
{ .name = "s2mpu06-regulator", },
|
|
{ .name = "s2mp-rtc", },
|
|
#ifdef CONFIG_KEYBOARD_S2MPU06
|
|
{ .name = "s2mpu06-power-keys", },
|
|
#endif
|
|
#if defined(CONFIG_SEC_CHARGER_S2MPU06) || defined(CONFIG_CHARGER_S2MPU06)
|
|
{ .name = "s2mpu06-charger", },
|
|
#endif
|
|
#if defined(CONFIG_SEC_FUELGAUGE_S2MPU06) || defined(CONFIG_FUELGAUGE_S2MPU06)
|
|
{ .name = "s2mpu06-fuelgauge", },
|
|
#endif
|
|
};
|
|
|
|
int s2mpu06_read_codec_reg(struct i2c_client *i2c, u8 reg, u8 *dest)
|
|
{
|
|
int ret;
|
|
|
|
ret = i2c_smbus_read_byte_data(i2c, reg);
|
|
|
|
if (ret < 0) {
|
|
pr_info("%s:%s reg(0x%x), ret(%d)\n",
|
|
MFD_DEV_NAME, __func__, reg, ret);
|
|
return ret;
|
|
}
|
|
|
|
ret &= 0xff;
|
|
*dest = ret;
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(s2mpu06_read_codec_reg);
|
|
|
|
int s2mpu06_read_reg(struct i2c_client *i2c, u8 reg, u8 *dest)
|
|
{
|
|
struct s2mpu06_dev *s2mpu06 = i2c_get_clientdata(i2c);
|
|
int ret;
|
|
|
|
mutex_lock(&s2mpu06->i2c_lock);
|
|
ret = i2c_smbus_read_byte_data(i2c, reg);
|
|
mutex_unlock(&s2mpu06->i2c_lock);
|
|
if (ret < 0) {
|
|
pr_info("%s:%s reg(0x%x), ret(%d)\n",
|
|
MFD_DEV_NAME, __func__, reg, ret);
|
|
return ret;
|
|
}
|
|
|
|
ret &= 0xff;
|
|
*dest = ret;
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(s2mpu06_read_reg);
|
|
|
|
int s2mpu06_read_reg_non_mutex(struct i2c_client *i2c, u8 reg, u8 *dest)
|
|
{
|
|
int ret;
|
|
|
|
ret = i2c_smbus_read_byte_data(i2c, reg);
|
|
if (ret < 0) {
|
|
pr_info("%s:%s reg(0x%x), ret(%d)\n",
|
|
MFD_DEV_NAME, __func__, reg, ret);
|
|
return ret;
|
|
}
|
|
|
|
ret &= 0xff;
|
|
*dest = ret;
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(s2mpu06_read_reg_non_mutex);
|
|
|
|
int s2mpu06_bulk_read(struct i2c_client *i2c, u8 reg, int count, u8 *buf)
|
|
{
|
|
struct s2mpu06_dev *s2mpu06 = i2c_get_clientdata(i2c);
|
|
int ret;
|
|
|
|
mutex_lock(&s2mpu06->i2c_lock);
|
|
ret = i2c_smbus_read_i2c_block_data(i2c, reg, count, buf);
|
|
mutex_unlock(&s2mpu06->i2c_lock);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(s2mpu06_bulk_read);
|
|
|
|
int s2mpu06_read_word(struct i2c_client *i2c, u8 reg)
|
|
{
|
|
struct s2mpu06_dev *s2mpu06 = i2c_get_clientdata(i2c);
|
|
int ret;
|
|
|
|
mutex_lock(&s2mpu06->i2c_lock);
|
|
ret = i2c_smbus_read_word_data(i2c, reg);
|
|
mutex_unlock(&s2mpu06->i2c_lock);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(s2mpu06_read_word);
|
|
|
|
int s2mpu06_write_reg(struct i2c_client *i2c, u8 reg, u8 value)
|
|
{
|
|
struct s2mpu06_dev *s2mpu06 = i2c_get_clientdata(i2c);
|
|
int ret;
|
|
|
|
mutex_lock(&s2mpu06->i2c_lock);
|
|
ret = i2c_smbus_write_byte_data(i2c, reg, value);
|
|
mutex_unlock(&s2mpu06->i2c_lock);
|
|
if (ret < 0)
|
|
pr_info("%s:%s reg(0x%x), ret(%d)\n",
|
|
MFD_DEV_NAME, __func__, reg, ret);
|
|
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(s2mpu06_write_reg);
|
|
|
|
int s2mpu06_bulk_write(struct i2c_client *i2c, u8 reg, int count, u8 *buf)
|
|
{
|
|
struct s2mpu06_dev *s2mpu06 = i2c_get_clientdata(i2c);
|
|
int ret;
|
|
|
|
mutex_lock(&s2mpu06->i2c_lock);
|
|
ret = i2c_smbus_write_i2c_block_data(i2c, reg, count, buf);
|
|
mutex_unlock(&s2mpu06->i2c_lock);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(s2mpu06_bulk_write);
|
|
|
|
int s2mpu06_write_word(struct i2c_client *i2c, u8 reg, u16 value)
|
|
{
|
|
struct s2mpu06_dev *s2mpu06 = i2c_get_clientdata(i2c);
|
|
int ret;
|
|
|
|
mutex_lock(&s2mpu06->i2c_lock);
|
|
ret = i2c_smbus_write_word_data(i2c, reg, value);
|
|
mutex_unlock(&s2mpu06->i2c_lock);
|
|
if (ret < 0)
|
|
return ret;
|
|
return 0;
|
|
}
|
|
EXPORT_SYMBOL_GPL(s2mpu06_write_word);
|
|
|
|
int s2mpu06_update_reg(struct i2c_client *i2c, u8 reg, u8 val, u8 mask)
|
|
{
|
|
struct s2mpu06_dev *s2mpu06 = i2c_get_clientdata(i2c);
|
|
int ret;
|
|
u8 old_val, new_val;
|
|
|
|
mutex_lock(&s2mpu06->i2c_lock);
|
|
ret = i2c_smbus_read_byte_data(i2c, reg);
|
|
if (ret >= 0) {
|
|
old_val = ret & 0xff;
|
|
new_val = (val & mask) | (old_val & (~mask));
|
|
ret = i2c_smbus_write_byte_data(i2c, reg, new_val);
|
|
}
|
|
mutex_unlock(&s2mpu06->i2c_lock);
|
|
return ret;
|
|
}
|
|
EXPORT_SYMBOL_GPL(s2mpu06_update_reg);
|
|
|
|
#if defined(CONFIG_OF)
|
|
static int of_s2mpu06_dt(struct device *dev,
|
|
struct s2mpu06_platform_data *pdata,
|
|
struct s2mpu06_dev *s2mpu06)
|
|
{
|
|
struct device_node *np = dev->of_node;
|
|
struct device_node *codec_np;
|
|
struct i2c_client *i2c_codec;
|
|
int ret, strlen;
|
|
const char *status;
|
|
u32 val;
|
|
|
|
if (!np)
|
|
return -EINVAL;
|
|
|
|
pdata->irq_gpio = of_get_named_gpio(np, "s2mpu06,irq-gpio", 0);
|
|
|
|
status = of_get_property(np, "s2mpu06,wakeup", &strlen);
|
|
if (status == NULL)
|
|
return -EINVAL;
|
|
if (strlen > 0) {
|
|
if (!strcmp(status, "enabled") || !strcmp(status, "okay"))
|
|
pdata->wakeup = true;
|
|
else
|
|
pdata->wakeup = false;
|
|
}
|
|
|
|
codec_np = of_parse_phandle(np, "samsung,codec-interrupt", 0);
|
|
if(codec_np) {
|
|
i2c_codec = of_find_i2c_device_by_node(codec_np);
|
|
s2mpu06->codec = i2c_codec;
|
|
pr_err("[DEBUG] %s: codec node exist, name: %s\n", __func__, i2c_codec->name);
|
|
}
|
|
|
|
if (of_get_property(np, "i2c-speedy-address", NULL))
|
|
pdata->use_i2c_speedy = true;
|
|
|
|
pr_info("%s: irq-gpio: %u \n", __func__, pdata->irq_gpio);
|
|
|
|
ret = of_property_read_u32(np, "cache_data", &val);
|
|
if (ret)
|
|
return -EINVAL;
|
|
pdata->cache_data = !!val;
|
|
|
|
/* WTSR, SMPL */
|
|
pdata->wtsr_smpl = devm_kzalloc(dev, sizeof(*pdata->wtsr_smpl),
|
|
GFP_KERNEL);
|
|
if (!pdata->wtsr_smpl)
|
|
return -ENOMEM;
|
|
|
|
status = of_get_property(np, "wtsr_en", &strlen);
|
|
if (status == NULL)
|
|
return -EINVAL;
|
|
if (strlen > 0) {
|
|
if (!strcmp(status, "enabled") || !strcmp(status, "okay"))
|
|
pdata->wtsr_smpl->wtsr_en = true;
|
|
else
|
|
pdata->wtsr_smpl->wtsr_en = false;
|
|
}
|
|
|
|
status = of_get_property(np, "smpl_en", &strlen);
|
|
if (status == NULL)
|
|
return -EINVAL;
|
|
if (strlen > 0) {
|
|
if (!strcmp(status, "enabled") || !strcmp(status, "okay"))
|
|
pdata->wtsr_smpl->smpl_en = true;
|
|
else
|
|
pdata->wtsr_smpl->smpl_en = false;
|
|
}
|
|
|
|
ret = of_property_read_u32(np, "wtsr_timer_val",
|
|
&pdata->wtsr_smpl->wtsr_timer_val);
|
|
if (ret)
|
|
return -EINVAL;
|
|
|
|
ret = of_property_read_u32(np, "smpl_timer_val",
|
|
&pdata->wtsr_smpl->smpl_timer_val);
|
|
if (ret)
|
|
return -EINVAL;
|
|
|
|
ret = of_property_read_u32(np, "check_jigon", &val);
|
|
if (ret)
|
|
return -EINVAL;
|
|
pdata->wtsr_smpl->check_jigon = !!val;
|
|
|
|
/* init time */
|
|
pdata->init_time = devm_kzalloc(dev, sizeof(*pdata->init_time),
|
|
GFP_KERNEL);
|
|
if (!pdata->init_time)
|
|
return -ENOMEM;
|
|
|
|
ret = of_property_read_u32(np, "init_time,sec",
|
|
&pdata->init_time->tm_sec);
|
|
if (ret)
|
|
return -EINVAL;
|
|
|
|
ret = of_property_read_u32(np, "init_time,min",
|
|
&pdata->init_time->tm_min);
|
|
if (ret)
|
|
return -EINVAL;
|
|
|
|
ret = of_property_read_u32(np, "init_time,hour",
|
|
&pdata->init_time->tm_hour);
|
|
if (ret)
|
|
return -EINVAL;
|
|
|
|
ret = of_property_read_u32(np, "init_time,mday",
|
|
&pdata->init_time->tm_mday);
|
|
if (ret)
|
|
return -EINVAL;
|
|
|
|
ret = of_property_read_u32(np, "init_time,mon",
|
|
&pdata->init_time->tm_mon);
|
|
if (ret)
|
|
return -EINVAL;
|
|
|
|
ret = of_property_read_u32(np, "init_time,year",
|
|
&pdata->init_time->tm_year);
|
|
if (ret)
|
|
return -EINVAL;
|
|
|
|
ret = of_property_read_u32(np, "init_time,wday",
|
|
&pdata->init_time->tm_wday);
|
|
if (ret)
|
|
return -EINVAL;
|
|
return 0;
|
|
}
|
|
#else
|
|
static int of_s2mpu06_dt(struct device *dev,
|
|
struct max77834_platform_data *pdata)
|
|
{
|
|
return 0;
|
|
}
|
|
#endif /* CONFIG_OF */
|
|
|
|
static int s2mpu06_i2c_probe(struct i2c_client *i2c,
|
|
const struct i2c_device_id *dev_id)
|
|
{
|
|
struct s2mpu06_dev *s2mpu06;
|
|
struct s2mpu06_platform_data *pdata = i2c->dev.platform_data;
|
|
|
|
u8 reg_data;
|
|
int ret = 0;
|
|
|
|
pr_info("%s:%s\n", MFD_DEV_NAME, __func__);
|
|
|
|
s2mpu06 = kzalloc(sizeof(struct s2mpu06_dev), GFP_KERNEL);
|
|
if (!s2mpu06) {
|
|
dev_err(&i2c->dev, "%s: Failed to alloc mem for s2mpu06\n",
|
|
__func__);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
if (i2c->dev.of_node) {
|
|
pdata = devm_kzalloc(&i2c->dev,
|
|
sizeof(struct s2mpu06_platform_data), GFP_KERNEL);
|
|
if (!pdata) {
|
|
dev_err(&i2c->dev, "Failed to allocate memory\n");
|
|
ret = -ENOMEM;
|
|
goto err;
|
|
}
|
|
|
|
ret = of_s2mpu06_dt(&i2c->dev, pdata, s2mpu06);
|
|
if (ret < 0) {
|
|
dev_err(&i2c->dev, "Failed to get device of_node\n");
|
|
goto err;
|
|
}
|
|
|
|
i2c->dev.platform_data = pdata;
|
|
} else
|
|
pdata = i2c->dev.platform_data;
|
|
|
|
|
|
s2mpu06->dev = &i2c->dev;
|
|
s2mpu06->i2c = i2c;
|
|
s2mpu06->irq = i2c->irq;
|
|
|
|
if (pdata) {
|
|
s2mpu06->pdata = pdata;
|
|
|
|
pdata->irq_base = irq_alloc_descs(-1, 0, S2MPU06_IRQ_NR, -1);
|
|
if (pdata->irq_base < 0) {
|
|
pr_err("%s:%s irq_alloc_descs Fail! ret(%d)\n",
|
|
MFD_DEV_NAME, __func__, pdata->irq_base);
|
|
ret = -EINVAL;
|
|
goto err;
|
|
} else
|
|
s2mpu06->irq_base = pdata->irq_base;
|
|
|
|
s2mpu06->irq_gpio = pdata->irq_gpio;
|
|
s2mpu06->wakeup = pdata->wakeup;
|
|
} else {
|
|
ret = -EINVAL;
|
|
goto err;
|
|
}
|
|
mutex_init(&s2mpu06->i2c_lock);
|
|
|
|
i2c_set_clientdata(i2c, s2mpu06);
|
|
|
|
if (s2mpu06_read_reg(i2c, S2MPU06_PMIC_REG_PMICID, ®_data) < 0) {
|
|
dev_err(s2mpu06->dev,
|
|
"device not found on this channel (this is not an error)\n");
|
|
ret = -ENODEV;
|
|
goto err_w_lock;
|
|
} else {
|
|
/* print rev */
|
|
s2mpu06->pmic_rev = (reg_data & 0x0F);
|
|
s2mpu06->pmic_ver = (reg_data & 0xF0);
|
|
}
|
|
|
|
s2mpu06->pmic = i2c_new_dummy(i2c->adapter, I2C_ADDR_PMIC);
|
|
s2mpu06->rtc = i2c_new_dummy(i2c->adapter, I2C_ADDR_RTC);
|
|
s2mpu06->charger = i2c_new_dummy(i2c->adapter, I2C_ADDR_CHG);
|
|
s2mpu06->fuelgauge = i2c_new_dummy(i2c->adapter, I2C_ADDR_FG);
|
|
|
|
if (pdata->use_i2c_speedy) {
|
|
dev_err(s2mpu06->dev, "use_i2c_speedy was true\n");
|
|
s2mpu06->pmic->flags |= I2C_CLIENT_SPEEDY;
|
|
s2mpu06->rtc->flags |= I2C_CLIENT_SPEEDY;
|
|
s2mpu06->charger->flags |= I2C_CLIENT_SPEEDY;
|
|
s2mpu06->fuelgauge->flags |= I2C_CLIENT_SPEEDY;
|
|
}
|
|
|
|
i2c_set_clientdata(s2mpu06->pmic, s2mpu06);
|
|
i2c_set_clientdata(s2mpu06->rtc, s2mpu06);
|
|
i2c_set_clientdata(s2mpu06->charger, s2mpu06);
|
|
i2c_set_clientdata(s2mpu06->fuelgauge, s2mpu06);
|
|
|
|
s2mpu06_read_reg(s2mpu06->pmic, 0x0F, ®_data);
|
|
|
|
if (reg_data & 0x01)
|
|
s2mpu06->pmic_rev = 0x0;
|
|
else
|
|
s2mpu06->pmic_rev = 0x1;
|
|
pr_info("%s device found: rev.0x%2x, ver.0x%2x\n", __func__,
|
|
s2mpu06->pmic_rev, s2mpu06->pmic_ver);
|
|
|
|
ret = s2mpu06_irq_init(s2mpu06);
|
|
if (ret < 0)
|
|
goto err_irq_init;
|
|
|
|
ret = mfd_add_devices(s2mpu06->dev, -1, s2mpu06_devs,
|
|
ARRAY_SIZE(s2mpu06_devs), NULL, 0, NULL);
|
|
if (ret < 0)
|
|
goto err_mfd;
|
|
|
|
device_init_wakeup(s2mpu06->dev, pdata->wakeup);
|
|
|
|
return ret;
|
|
|
|
err_mfd:
|
|
mfd_remove_devices(s2mpu06->dev);
|
|
err_irq_init:
|
|
i2c_unregister_device(s2mpu06->i2c);
|
|
err_w_lock:
|
|
mutex_destroy(&s2mpu06->i2c_lock);
|
|
err:
|
|
kfree(s2mpu06);
|
|
return ret;
|
|
}
|
|
|
|
static int s2mpu06_i2c_remove(struct i2c_client *i2c)
|
|
{
|
|
struct s2mpu06_dev *s2mpu06 = i2c_get_clientdata(i2c);
|
|
|
|
mfd_remove_devices(s2mpu06->dev);
|
|
i2c_unregister_device(s2mpu06->i2c);
|
|
kfree(s2mpu06);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct i2c_device_id s2mpu06_i2c_id[] = {
|
|
{ MFD_DEV_NAME, TYPE_S2MPU06 },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(i2c, s2mpu06_i2c_id);
|
|
|
|
#if defined(CONFIG_OF)
|
|
static struct of_device_id s2mpu06_i2c_dt_ids[] = {
|
|
{ .compatible = "samsung,s2mpu06mfd" },
|
|
{ },
|
|
};
|
|
#endif /* CONFIG_OF */
|
|
|
|
#if defined(CONFIG_PM)
|
|
static int s2mpu06_suspend(struct device *dev)
|
|
{
|
|
struct i2c_client *i2c = container_of(dev, struct i2c_client, dev);
|
|
struct s2mpu06_dev *s2mpu06 = i2c_get_clientdata(i2c);
|
|
|
|
if (device_may_wakeup(dev))
|
|
enable_irq_wake(s2mpu06->irq);
|
|
|
|
disable_irq(s2mpu06->irq);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int s2mpu06_resume(struct device *dev)
|
|
{
|
|
struct i2c_client *i2c = container_of(dev, struct i2c_client, dev);
|
|
struct s2mpu06_dev *s2mpu06 = i2c_get_clientdata(i2c);
|
|
|
|
#if !defined(CONFIG_SAMSUNG_PRODUCT_SHIP)
|
|
pr_info("%s:%s\n", MFD_DEV_NAME, __func__);
|
|
#endif /* CONFIG_SAMSUNG_PRODUCT_SHIP */
|
|
|
|
if (device_may_wakeup(dev))
|
|
disable_irq_wake(s2mpu06->irq);
|
|
|
|
enable_irq(s2mpu06->irq);
|
|
|
|
return 0;
|
|
}
|
|
#else
|
|
#define s2mpu06_suspend NULL
|
|
#define s2mpu06_resume NULL
|
|
#endif /* CONFIG_PM */
|
|
|
|
const struct dev_pm_ops s2mpu06_pm = {
|
|
.suspend_late = s2mpu06_suspend,
|
|
.resume_early = s2mpu06_resume,
|
|
};
|
|
|
|
static struct i2c_driver s2mpu06_i2c_driver = {
|
|
.driver = {
|
|
.name = MFD_DEV_NAME,
|
|
.owner = THIS_MODULE,
|
|
#if defined(CONFIG_PM)
|
|
.pm = &s2mpu06_pm,
|
|
#endif /* CONFIG_PM */
|
|
#if defined(CONFIG_OF)
|
|
.of_match_table = s2mpu06_i2c_dt_ids,
|
|
#endif /* CONFIG_OF */
|
|
},
|
|
.probe = s2mpu06_i2c_probe,
|
|
.remove = s2mpu06_i2c_remove,
|
|
.id_table = s2mpu06_i2c_id,
|
|
};
|
|
|
|
static int __init s2mpu06_i2c_init(void)
|
|
{
|
|
pr_info("%s:%s\n", MFD_DEV_NAME, __func__);
|
|
return i2c_add_driver(&s2mpu06_i2c_driver);
|
|
}
|
|
/* init early so consumer devices can complete system boot */
|
|
subsys_initcall(s2mpu06_i2c_init);
|
|
|
|
static void __exit s2mpu06_i2c_exit(void)
|
|
{
|
|
i2c_del_driver(&s2mpu06_i2c_driver);
|
|
}
|
|
module_exit(s2mpu06_i2c_exit);
|
|
|
|
MODULE_DESCRIPTION("s2mpu06 multi-function core driver");
|
|
MODULE_AUTHOR("Samsung Electronics");
|
|
MODULE_LICENSE("GPL");
|