mirror of
https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
synced 2025-09-07 00:38:05 -04:00
758 lines
18 KiB
C
758 lines
18 KiB
C
/*
|
|
* leds-s2mu005.c - LED class driver for S2MU005 LEDs.
|
|
*
|
|
* 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 version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/err.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/workqueue.h>
|
|
#include <linux/leds.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/of_gpio.h>
|
|
#include <linux/mfd/samsung/s2mu005.h>
|
|
#include <linux/mfd/samsung/s2mu005-private.h>
|
|
#include <linux/leds-s2mu005.h>
|
|
#include <linux/platform_device.h>
|
|
|
|
struct s2mu005_led_data *g_led_datas[S2MU005_LED_MAX];
|
|
|
|
static u8 leds_cur_max[] = {
|
|
S2MU005_FLASH_OUT_I_1200MA,
|
|
S2MU005_TORCH_OUT_I_400MA,
|
|
};
|
|
|
|
static u8 leds_time_max[] = {
|
|
S2MU005_FLASH_TIMEOUT_992MS,
|
|
S2MU005_TORCH_TIMEOUT_15728MS,
|
|
};
|
|
|
|
struct s2mu005_led_data {
|
|
struct led_classdev cdev;
|
|
struct s2mu005_led *data;
|
|
struct notifier_block batt_nb;
|
|
struct i2c_client *i2c;
|
|
struct work_struct work;
|
|
struct mutex lock;
|
|
spinlock_t value_lock;
|
|
int brightness;
|
|
int test_brightness;
|
|
int attach_ta;
|
|
int attach_sdp;
|
|
bool enable;
|
|
int torch_pin;
|
|
int flash_pin;
|
|
};
|
|
|
|
u8 CH_FLASH_TORCH_EN = S2MU005_REG_FLED_RSVD;
|
|
|
|
#ifdef CONFIG_MUIC_NOTIFIER
|
|
static void attach_cable_check(muic_attached_dev_t attached_dev,
|
|
int *attach_ta, int *attach_sdp)
|
|
{
|
|
if (attached_dev == ATTACHED_DEV_USB_MUIC)
|
|
*attach_sdp = 1;
|
|
else
|
|
*attach_sdp = 0;
|
|
|
|
switch (attached_dev) {
|
|
case ATTACHED_DEV_TA_MUIC:
|
|
case ATTACHED_DEV_SMARTDOCK_TA_MUIC:
|
|
case ATTACHED_DEV_UNOFFICIAL_TA_MUIC:
|
|
case ATTACHED_DEV_UNOFFICIAL_ID_TA_MUIC:
|
|
case ATTACHED_DEV_CDP_MUIC:
|
|
case ATTACHED_DEV_USB_MUIC:
|
|
case ATTACHED_DEV_UNOFFICIAL_ID_CDP_MUIC:
|
|
*attach_ta = 1;
|
|
break;
|
|
default:
|
|
*attach_ta = 0;
|
|
break;
|
|
}
|
|
}
|
|
|
|
static int ta_notification(struct notifier_block *nb,
|
|
unsigned long action, void *data)
|
|
{
|
|
muic_attached_dev_t attached_dev = *(muic_attached_dev_t *)data;
|
|
#ifdef CONFIG_S2MU005_LEDS_I2C
|
|
u8 temp;
|
|
#endif
|
|
int ret = 0;
|
|
struct s2mu005_led_data *led_data =
|
|
container_of(nb, struct s2mu005_led_data, batt_nb);
|
|
|
|
switch (action) {
|
|
case MUIC_NOTIFY_CMD_DETACH:
|
|
case MUIC_NOTIFY_CMD_LOGICALLY_DETACH:
|
|
if (!led_data->attach_ta)
|
|
goto err;
|
|
|
|
led_data->attach_ta = 0;
|
|
|
|
if (!led_data->data->id) {
|
|
pr_info("%s : flash mode\n", __func__);
|
|
goto err;
|
|
}
|
|
#ifndef CONFIG_S2MU005_LEDS_I2C
|
|
if (gpio_is_valid(led_data->torch_pin)) {
|
|
ret = devm_gpio_request(led_data->cdev.dev,
|
|
led_data->torch_pin, "s2mu005_gpio");
|
|
if (ret) {
|
|
pr_err("%s : fail to assignment gpio\n",
|
|
__func__);
|
|
goto gpio_free_data;
|
|
}
|
|
}
|
|
if (gpio_get_value(led_data->torch_pin)) {
|
|
gpio_direction_output(led_data->torch_pin, 0);
|
|
gpio_direction_output(led_data->torch_pin, 1);
|
|
goto gpio_free_data;
|
|
}
|
|
#else
|
|
s2mu005_read_reg(led_data->i2c,
|
|
CH_FLASH_TORCH_EN, &temp);
|
|
if ((temp & S2MU005_TORCH_ON_I2C) == S2MU005_TORCH_ON_I2C) {
|
|
ret = s2mu005_update_reg(led_data->i2c,
|
|
CH_FLASH_TORCH_EN,
|
|
S2MU005_FLASH_TORCH_OFF,
|
|
S2MU005_TORCH_ENABLE_MASK);
|
|
|
|
pr_info("%s : LED OFF\n", __func__);
|
|
if (ret < 0)
|
|
goto err;
|
|
ret = s2mu005_update_reg(led_data->i2c,
|
|
S2MU005_REG_LED_CTRL4,
|
|
S2MU005_TORCH_ON_I2C,
|
|
S2MU005_TORCH_ENABLE_MASK);
|
|
|
|
pr_info("%s : LED ON\n", __func__);
|
|
if (ret < 0)
|
|
goto err;
|
|
}
|
|
#endif
|
|
break;
|
|
case MUIC_NOTIFY_CMD_ATTACH:
|
|
case MUIC_NOTIFY_CMD_LOGICALLY_ATTACH:
|
|
led_data->attach_ta = 0;
|
|
attach_cable_check(attached_dev, &led_data->attach_ta,
|
|
&led_data->attach_sdp);
|
|
return 0;
|
|
default:
|
|
goto err;
|
|
}
|
|
|
|
#ifndef CONFIG_S2MU005_LEDS_I2C
|
|
gpio_free_data:
|
|
gpio_free(led_data->torch_pin);
|
|
pr_info("%s : gpio free\n", __func__);
|
|
#endif
|
|
pr_info("%s : complete detached\n", __func__);
|
|
return 0;
|
|
err:
|
|
pr_err("%s : abandond access %d\n", __func__, led_data->attach_ta);
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
static void led_set(struct s2mu005_led_data *led_data)
|
|
{
|
|
int ret;
|
|
struct s2mu005_led *data = led_data->data;
|
|
int id = data->id;
|
|
u8 mask = 0, reg = 0;
|
|
|
|
#ifdef CONFIG_S2MU005_LEDS_I2C
|
|
u8 enable_mask, value;
|
|
#else
|
|
int gpio_pin;
|
|
#endif
|
|
if (id == S2MU005_FLASH_LED) {
|
|
pr_info("%s led mode is flash\n", __func__);
|
|
reg = S2MU005_REG_FLED_CH1_CTRL0;
|
|
mask = S2MU005_FLASH_IOUT_MASK;
|
|
#ifndef CONFIG_S2MU005_LEDS_I2C
|
|
pr_info("%s gpio_flash mode\n", __func__);
|
|
gpio_pin = led_data->flash_pin;
|
|
#endif
|
|
} else {
|
|
pr_info("%s led mode is torch\n", __func__);
|
|
reg = S2MU005_REG_FLED_CH1_CTRL1;
|
|
mask = S2MU005_TORCH_IOUT_MASK;
|
|
#ifndef CONFIG_S2MU005_LEDS_I2C
|
|
pr_info("%s gpio_torch mode\n", __func__);
|
|
gpio_pin = led_data->torch_pin;
|
|
#endif
|
|
}
|
|
|
|
|
|
#ifndef CONFIG_S2MU005_LEDS_I2C
|
|
if (gpio_is_valid(gpio_pin)) {
|
|
ret = devm_gpio_request(led_data->cdev.dev, gpio_pin,
|
|
"s2mu005_gpio");
|
|
if (ret) {
|
|
pr_err("%s : fail to assignment gpio\n", __func__);
|
|
goto gpio_free_data;
|
|
}
|
|
}
|
|
#endif
|
|
pr_info("%s start led_set\n", __func__);
|
|
|
|
if (led_data->test_brightness == LED_OFF) {
|
|
ret = s2mu005_update_reg(led_data->i2c, reg,
|
|
led_data->test_brightness, mask);
|
|
if (ret < 0)
|
|
goto error_set_bits;
|
|
|
|
#ifdef CONFIG_S2MU005_LEDS_I2C
|
|
value = S2MU005_FLASH_TORCH_OFF;
|
|
#else
|
|
gpio_direction_output(gpio_pin, 0);
|
|
#endif
|
|
/* torch mode off sequence */
|
|
if (id && led_data->attach_ta) {
|
|
ret = s2mu005_update_reg(led_data->i2c,
|
|
S2MU005_REG_FLED_CTRL1, 0x00, 0x80);
|
|
if (ret < 0)
|
|
goto error_set_bits;
|
|
}
|
|
#ifndef CONFIG_S2MU005_LEDS_I2C
|
|
goto gpio_free_data;
|
|
#endif
|
|
} else {
|
|
pr_info("%s led on\n", __func__);
|
|
/* torch mode on sequence */
|
|
if (id && led_data->attach_ta) {
|
|
ret = s2mu005_update_reg(led_data->i2c,
|
|
S2MU005_REG_FLED_CTRL1, 0x80, 0x80);
|
|
if (ret < 0)
|
|
goto error_set_bits;
|
|
/* ta attach & sdp mode : brightness limit 300mA */
|
|
if (led_data->attach_sdp)
|
|
led_data->test_brightness =
|
|
(led_data->test_brightness > S2MU005_TORCH_OUT_I_300MA) ?
|
|
S2MU005_TORCH_OUT_I_300MA : led_data->test_brightness;
|
|
}
|
|
pr_info("%s led brightness = %d\n", __func__,
|
|
led_data->test_brightness);
|
|
ret = s2mu005_update_reg(led_data->i2c,
|
|
reg, led_data->test_brightness, mask);
|
|
if (ret < 0)
|
|
goto error_set_bits;
|
|
|
|
#ifdef CONFIG_S2MU005_LEDS_I2C
|
|
value = id ? S2MU005_TORCH_ON_I2C : S2MU005_FLASH_ON_I2C;
|
|
#else
|
|
gpio_direction_output(gpio_pin, 1);
|
|
goto gpio_free_data;
|
|
|
|
#endif
|
|
}
|
|
#ifdef CONFIG_S2MU005_LEDS_I2C
|
|
enable_mask = id ? S2MU005_TORCH_ENABLE_MASK :
|
|
S2MU005_FLASH_ENABLE_MASK;
|
|
|
|
ret = s2mu005_update_reg(led_data->i2c,
|
|
CH_FLASH_TORCH_EN,
|
|
value, enable_mask);
|
|
|
|
if (ret < 0)
|
|
goto error_set_bits;
|
|
#endif
|
|
return;
|
|
|
|
#ifndef CONFIG_S2MU005_LEDS_I2C
|
|
gpio_free_data:
|
|
gpio_free(gpio_pin);
|
|
pr_info("%s : gpio free\n", __func__);
|
|
return;
|
|
#endif
|
|
error_set_bits:
|
|
pr_err("%s: can't set led level %d\n", __func__, ret);
|
|
}
|
|
|
|
static void s2mu005_led_set(struct led_classdev *led_cdev,
|
|
enum led_brightness value)
|
|
{
|
|
unsigned long flags;
|
|
struct s2mu005_led_data *led_data =
|
|
container_of(led_cdev, struct s2mu005_led_data, cdev);
|
|
u8 max;
|
|
|
|
max = led_cdev->max_brightness;
|
|
|
|
pr_info("%s value = %d, max = %d\n", __func__, value, max);
|
|
|
|
spin_lock_irqsave(&led_data->value_lock, flags);
|
|
led_data->test_brightness = min_t(int, (int)value, (int)max);
|
|
spin_unlock_irqrestore(&led_data->value_lock, flags);
|
|
|
|
led_set(led_data);
|
|
}
|
|
|
|
static void s2mu005_led_work(struct work_struct *work)
|
|
{
|
|
struct s2mu005_led_data *led_data
|
|
= container_of(work, struct s2mu005_led_data, work);
|
|
|
|
pr_debug("%s [led]\n", __func__);
|
|
|
|
mutex_lock(&led_data->lock);
|
|
led_set(led_data);
|
|
mutex_unlock(&led_data->lock);
|
|
}
|
|
|
|
static int s2mu005_led_setup(struct s2mu005_led_data *led_data)
|
|
{
|
|
int ret = 0;
|
|
int mask, value;
|
|
u8 temp;
|
|
|
|
/* EVT0 0x73[3:0] == 0x0 */
|
|
ret = s2mu005_read_reg(led_data->i2c, 0x73, &temp);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
if ((temp & 0xf) == 0x00) {
|
|
/* forced BATID recognition 0x89[1:0] = 0x3 */
|
|
ret = s2mu005_update_reg(led_data->i2c, 0x89, 0x03, 0x03);
|
|
if (ret < 0)
|
|
goto out;
|
|
ret = s2mu005_update_reg(led_data->i2c, 0x92, 0x80, 0x80);
|
|
if (ret < 0)
|
|
goto out;
|
|
}
|
|
|
|
/* Controlled Channel1, Channel2 independently */
|
|
ret = s2mu005_update_reg(led_data->i2c, S2MU005_REG_FLED_CTRL2,
|
|
0x00, S2MU005_EN_CHANNEL_SHARE_MASK);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
/* Boost vout flash 4.5V */
|
|
ret = s2mu005_update_reg(led_data->i2c, S2MU005_REG_FLED_CTRL2,
|
|
0x0A, S2MU005_BOOST_VOUT_FLASH_MASK);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
/* FLED_BOOST_EN */
|
|
ret = s2mu005_update_reg(led_data->i2c, S2MU005_REG_FLED_CTRL1,
|
|
0x40, S2MU005_FLASH_BOOST_EN_MASK);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
/* Flash timer Maximum mode */
|
|
ret = s2mu005_update_reg(led_data->i2c,
|
|
S2MU005_REG_FLED_CH1_CTRL3, 0x80, 0x80);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
if (led_data->data->id == S2MU005_FLASH_LED) {
|
|
/* flash timer Maximum set */
|
|
ret = s2mu005_update_reg(led_data->i2c,
|
|
S2MU005_REG_FLED_CH1_CTRL3, led_data->data->timeout,
|
|
S2MU005_TIMEOUT_MAX);
|
|
if (ret < 0)
|
|
goto out;
|
|
} else {
|
|
/* torch timer Maximum set */
|
|
ret = s2mu005_update_reg(led_data->i2c,
|
|
S2MU005_REG_FLED_CH1_CTRL2, led_data->data->timeout,
|
|
S2MU005_TIMEOUT_MAX);
|
|
if (ret < 0)
|
|
goto out;
|
|
}
|
|
|
|
/* flash brightness set */
|
|
ret = s2mu005_update_reg(led_data->i2c, S2MU005_REG_FLED_CH1_CTRL0,
|
|
S2MU005_FLASH_OUT_I_1000MA, S2MU005_FLASH_IOUT_MASK);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
/* torch brightness set */
|
|
ret = s2mu005_update_reg(led_data->i2c, S2MU005_REG_FLED_CH1_CTRL1,
|
|
S2MU005_TORCH_OUT_I_75MA, S2MU005_TORCH_IOUT_MASK);
|
|
if (ret < 0)
|
|
goto out;
|
|
|
|
#ifdef CONFIG_S2MU005_LEDS_I2C
|
|
value = S2MU005_FLASH_TORCH_OFF;
|
|
#else
|
|
value = S2MU005_FLASH_ON_GPIO | S2MU005_TORCH_ON_GPIO;
|
|
#endif
|
|
mask = S2MU005_TORCH_ENABLE_MASK | S2MU005_FLASH_ENABLE_MASK;
|
|
ret = s2mu005_update_reg(led_data->i2c, CH_FLASH_TORCH_EN,
|
|
value, mask);
|
|
if (ret < 0)
|
|
goto out;
|
|
pr_info("%s : led setup complete\n", __func__);
|
|
return ret;
|
|
|
|
out:
|
|
pr_err("%s : led setup fail\n", __func__);
|
|
return ret;
|
|
}
|
|
|
|
static ssize_t rear_flash_show(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct s2mu005_led_data *led_data = g_led_datas[S2MU005_TORCH_LED];
|
|
char *str;
|
|
|
|
switch (led_data->data->id) {
|
|
case S2MU005_FLASH_LED:
|
|
str = "FLASH";
|
|
break;
|
|
case S2MU005_TORCH_LED:
|
|
str = "TORCH";
|
|
break;
|
|
default:
|
|
str = "NONE";
|
|
break;
|
|
}
|
|
|
|
return snprintf(buf, 20, "%s\n", str);
|
|
}
|
|
|
|
static ssize_t rear_flash_store(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t size)
|
|
{
|
|
struct s2mu005_led_data *led_data = g_led_datas[S2MU005_TORCH_LED];
|
|
struct led_classdev *led_cdev = &led_data->cdev;
|
|
int value = 0;
|
|
int brightness = 0;
|
|
|
|
if ((buf == NULL) || kstrtouint(buf, 10, &value)) {
|
|
return -1;
|
|
}
|
|
|
|
pr_info("[LED]%s , value:%d\n", __func__, value);
|
|
mutex_lock(&led_data->lock);
|
|
|
|
if (led_data->data->id == S2MU005_FLASH_LED) {
|
|
pr_info("%s : flash is not controlled by sysfs", __func__);
|
|
goto err;
|
|
}
|
|
|
|
if (value == 0) {
|
|
/* Turn off Torch */
|
|
brightness = LED_OFF;
|
|
} else if (value == 1) {
|
|
/* Turn on Torch */
|
|
brightness = value;
|
|
} else {
|
|
pr_info("[LED]%s , Invalid value:%d\n", __func__, value);
|
|
goto err;
|
|
}
|
|
|
|
if (led_cdev->flags & LED_SUSPENDED) {
|
|
pr_info("%s : led suspended\n", __func__);
|
|
goto err;
|
|
}
|
|
|
|
s2mu005_led_set(led_cdev, brightness);
|
|
|
|
mutex_unlock(&led_data->lock);
|
|
return size;
|
|
|
|
err:
|
|
pr_err("%s : led abnormal end\n", __func__);
|
|
|
|
mutex_unlock(&led_data->lock);
|
|
return size;
|
|
}
|
|
|
|
static DEVICE_ATTR(rear_flash, 0644, rear_flash_show, rear_flash_store);
|
|
|
|
#if defined(CONFIG_OF)
|
|
static int s2mu005_led_dt_parse_pdata(struct s2mu005_dev *iodev,
|
|
struct s2mu005_fled_platform_data *pdata)
|
|
{
|
|
struct device_node *led_np, *np, *c_np;
|
|
int ret;
|
|
u32 temp;
|
|
const char *temp_str;
|
|
int index;
|
|
|
|
led_np = iodev->dev->of_node;
|
|
|
|
if (!led_np) {
|
|
pr_err("<%s> could not find led sub-node led_np\n", __func__);
|
|
return -ENODEV;
|
|
}
|
|
|
|
np = of_find_node_by_name(led_np, "leds");
|
|
if (!np) {
|
|
pr_err("%s : could not find led sub-node np\n", __func__);
|
|
return -EINVAL;
|
|
}
|
|
|
|
ret = pdata->torch_pin = of_get_named_gpio(np, "torch-gpio", 0);
|
|
if (ret < 0) {
|
|
pr_err("%s : can't get torch-gpio\n", __func__);
|
|
return ret;
|
|
}
|
|
|
|
ret = pdata->flash_pin = of_get_named_gpio(np, "flash-gpio", 0);
|
|
if (ret < 0) {
|
|
pr_err("%s : can't get flash-gpio\n", __func__);
|
|
return ret;
|
|
}
|
|
|
|
pdata->num_leds = of_get_child_count(np);
|
|
|
|
for_each_child_of_node(np, c_np) {
|
|
ret = of_property_read_u32(c_np, "id", &temp);
|
|
if (ret < 0)
|
|
goto dt_err;
|
|
index = temp;
|
|
pdata->leds[index].id = temp;
|
|
|
|
ret = of_property_read_string(c_np, "ledname", &temp_str);
|
|
if (ret)
|
|
goto dt_err;
|
|
pdata->leds[index].name = temp_str;
|
|
|
|
ret = of_property_read_u32(c_np, "brightness", &temp);
|
|
if (ret)
|
|
goto dt_err;
|
|
if (temp > leds_cur_max[index])
|
|
temp = leds_cur_max[index];
|
|
pdata->leds[index].brightness = temp;
|
|
|
|
ret = of_property_read_u32(c_np, "timeout", &temp);
|
|
if (ret)
|
|
goto dt_err;
|
|
if (temp > leds_time_max[index])
|
|
temp = leds_time_max[index];
|
|
pdata->leds[index].timeout = temp;
|
|
}
|
|
return 0;
|
|
dt_err:
|
|
pr_err("%s failed to get a timeout\n", __func__);
|
|
return ret;
|
|
}
|
|
#endif /* CONFIG_OF */
|
|
|
|
static int s2mu005_led_probe(struct platform_device *pdev)
|
|
{
|
|
int ret = 0, i = 0;
|
|
u8 temp = 0;
|
|
|
|
struct s2mu005_dev *s2mu005 = dev_get_drvdata(pdev->dev.parent);
|
|
#ifndef CONFIG_OF
|
|
struct s2mu005_mfd_platform_data *s2mu005_pdata = s2mu005->pdata;
|
|
#endif
|
|
struct s2mu005_fled_platform_data *pdata;
|
|
struct s2mu005_led_data *led_data;
|
|
struct s2mu005_led *data;
|
|
struct s2mu005_led_data **led_datas;
|
|
|
|
pr_info("[%s] s2mu005_fled start\n", __func__);
|
|
|
|
if (!s2mu005) {
|
|
dev_err(&pdev->dev, "drvdata->dev.parent not supplied\n");
|
|
return -ENODEV;
|
|
}
|
|
#ifdef CONFIG_OF
|
|
pdata = kzalloc(sizeof(struct s2mu005_fled_platform_data), GFP_KERNEL);
|
|
if (!pdata) {
|
|
pr_err("[%s] failed to allocate driver data\n", __func__);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
if (s2mu005->dev->of_node) {
|
|
ret = s2mu005_led_dt_parse_pdata(s2mu005, pdata);
|
|
if (ret < 0) {
|
|
pr_err("[%s] not found leds dt! ret[%d]\n",
|
|
__func__, ret);
|
|
kfree(pdata);
|
|
return -1;
|
|
}
|
|
}
|
|
#else
|
|
if (!s2mu005_pdata) {
|
|
dev_err(&pdev->dev, "platform data not supplied\n");
|
|
return -ENODEV;
|
|
}
|
|
pdata = s2mu005_pdata->fled_platform_data;
|
|
if (!pdata) {
|
|
pr_err("[%s] no platform data for this led is found\n",
|
|
__func__);
|
|
return -EFAULT;
|
|
}
|
|
#endif
|
|
|
|
led_datas = devm_kzalloc(s2mu005->dev,
|
|
sizeof(struct s2mu005_led_data *) *
|
|
S2MU005_LED_MAX, GFP_KERNEL);
|
|
if (!led_datas) {
|
|
pr_err("[%s] memory allocation error led_datas", __func__);
|
|
kfree(pdata);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
platform_set_drvdata(pdev, led_datas);
|
|
|
|
pr_info("%s %d leds\n", __func__, pdata->num_leds);
|
|
|
|
for (i = 0; i != pdata->num_leds; ++i) {
|
|
pr_info("%s led%d setup ...\n", __func__, i);
|
|
|
|
data = devm_kzalloc(s2mu005->dev, sizeof(struct s2mu005_led),
|
|
GFP_KERNEL);
|
|
if (!data) {
|
|
pr_err("[%s] memory allocation error data\n",
|
|
__func__);
|
|
ret = -ENOMEM;
|
|
continue;
|
|
}
|
|
|
|
memcpy(data, &(pdata->leds[i]), sizeof(struct s2mu005_led));
|
|
led_data = devm_kzalloc(&pdev->dev,
|
|
sizeof(struct s2mu005_led_data), GFP_KERNEL);
|
|
|
|
g_led_datas[i] = led_data;
|
|
led_datas[i] = led_data;
|
|
|
|
if (!led_data) {
|
|
pr_err("[%s] memory allocation error led_data\n",
|
|
__func__);
|
|
kfree(data);
|
|
ret = -ENOMEM;
|
|
continue;
|
|
}
|
|
|
|
led_data->i2c = s2mu005->i2c;
|
|
led_data->data = data;
|
|
led_data->cdev.name = data->name;
|
|
led_data->cdev.brightness_set = s2mu005_led_set;
|
|
led_data->cdev.flags = 0;
|
|
led_data->cdev.brightness = data->brightness;
|
|
led_data->cdev.max_brightness = led_data->data->id ?
|
|
S2MU005_TORCH_OUT_I_400MA : S2MU005_FLASH_OUT_I_1200MA;
|
|
|
|
mutex_init(&led_data->lock);
|
|
spin_lock_init(&led_data->value_lock);
|
|
INIT_WORK(&led_data->work, s2mu005_led_work);
|
|
ret = led_classdev_register(&pdev->dev, &led_data->cdev);
|
|
if (ret < 0) {
|
|
pr_err("unable to register LED\n");
|
|
cancel_work_sync(&led_data->work);
|
|
mutex_destroy(&led_data->lock);
|
|
kfree(data);
|
|
kfree(led_data);
|
|
led_datas[i] = NULL;
|
|
g_led_datas[i] = NULL;
|
|
ret = -EFAULT;
|
|
continue;
|
|
}
|
|
if (led_data->data->id == S2MU005_TORCH_LED) {
|
|
ret = device_create_file(led_data->cdev.dev,
|
|
&dev_attr_rear_flash);
|
|
if (ret < 0)
|
|
pr_err("%s :unable to create file\n", __func__);
|
|
}
|
|
#ifndef CONFIG_S2MU005_LEDS_I2C
|
|
if (gpio_is_valid(pdata->torch_pin) &&
|
|
gpio_is_valid(pdata->flash_pin)) {
|
|
if (ret < 0) {
|
|
pr_err("%s : s2mu005 fled gpio allocation error\n",
|
|
__func__);
|
|
} else {
|
|
led_data->torch_pin = pdata->torch_pin;
|
|
led_data->flash_pin = pdata->flash_pin;
|
|
gpio_request_one(pdata->torch_pin,
|
|
GPIOF_OUT_INIT_LOW, "LED_GPIO_OUTPUT_LOW");
|
|
gpio_request_one(pdata->flash_pin,
|
|
GPIOF_OUT_INIT_LOW, "LED_GPIO_OUTPUT_LOW");
|
|
gpio_free(pdata->torch_pin);
|
|
gpio_free(pdata->flash_pin);
|
|
}
|
|
}
|
|
#endif
|
|
/* EVT0 0x73[3:0] == 0x0 */
|
|
ret = s2mu005_read_reg(led_data->i2c, 0x73, &temp);
|
|
if (ret < 0)
|
|
pr_err("%s : s2mu005 reg fled read fail\n", __func__);
|
|
|
|
if ((temp & 0xf) == 0x00) {
|
|
/* FLED_CTRL4 = 0x3A */
|
|
CH_FLASH_TORCH_EN = S2MU005_REG_FLED_CTRL4;
|
|
}
|
|
|
|
#ifdef CONFIG_MUIC_NOTIFIER
|
|
muic_notifier_register(&led_data->batt_nb,
|
|
ta_notification,
|
|
MUIC_NOTIFY_DEV_CHARGER);
|
|
#endif
|
|
ret = s2mu005_led_setup(led_data);
|
|
if (ret < 0)
|
|
pr_err("%s : failed s2mu005 led reg init\n", __func__);
|
|
}
|
|
#ifdef CONFIG_OF
|
|
kfree(pdata);
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
static int s2mu005_led_remove(struct platform_device *pdev)
|
|
{
|
|
struct s2mu005_led_data **led_datas = platform_get_drvdata(pdev);
|
|
int i;
|
|
|
|
for (i = 0; i != S2MU005_LED_MAX; ++i) {
|
|
if (led_datas[i] == NULL)
|
|
continue;
|
|
|
|
cancel_work_sync(&led_datas[i]->work);
|
|
mutex_destroy(&led_datas[i]->lock);
|
|
led_classdev_unregister(&led_datas[i]->cdev);
|
|
kfree(led_datas[i]->data);
|
|
kfree(led_datas[i]);
|
|
g_led_datas[i] = NULL;
|
|
}
|
|
kfree(led_datas);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct platform_device_id s2mu005_leds_id[] = {
|
|
{"s2mu005-flash", 0},
|
|
{},
|
|
};
|
|
|
|
static struct platform_driver s2mu005_led_driver = {
|
|
.driver = {
|
|
.name = "s2mu005-flash",
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.probe = s2mu005_led_probe,
|
|
.remove = s2mu005_led_remove,
|
|
.id_table = s2mu005_leds_id,
|
|
};
|
|
|
|
static int __init s2mu005_led_driver_init(void)
|
|
{
|
|
return platform_driver_register(&s2mu005_led_driver);
|
|
}
|
|
module_init(s2mu005_led_driver_init);
|
|
|
|
static void __exit s2mu005_led_driver_exit(void)
|
|
{
|
|
platform_driver_unregister(&s2mu005_led_driver);
|
|
}
|
|
module_exit(s2mu005_led_driver_exit);
|
|
|
|
MODULE_AUTHOR("SUJI LEE <suji0908.lee@samsung.com>");
|
|
MODULE_DESCRIPTION("SAMSUNG s2mu005 LED Driver");
|
|
MODULE_LICENSE("GPL");
|