void pm8xxx_led_current_set_for_key(int brightness_key)
{
int rc, offset;
static u8 level, register_key;
LED_INFO("%s brightness_key: %d\n", __func__,brightness_key);
#ifdef CONFIG_BB_MOD
printk("[BB] current_set_for_key %d \n", brightness_key);
#endif
if (brightness_key) {
flag_hold_virtual_key = 1;
level = (40 << PM8XXX_DRV_LED_CTRL_SHIFT) & PM8XXX_DRV_LED_CTRL_MASK;
offset = PM8XXX_LED_OFFSET(for_key_led_data->id);
register_key = pm8xxxx_led_pwm_mode(for_key_led_data->id);
register_key &= ~PM8XXX_DRV_LED_CTRL_MASK;
register_key |= level;
rc = pm8xxx_writeb(for_key_led_data->dev->parent, SSBI_REG_ADDR_LED_CTRL(offset), register_key);
if (rc)
LED_ERR("%s can't set (%d) led value rc=%d\n", __func__, PM8XXX_ID_LED_0, rc);
pwm_config(for_key_led_data->pwm_led, 320000, 640000);
pwm_enable(for_key_led_data->pwm_led);
} else {
pwm_disable(for_key_led_data->pwm_led);
level = (0 << PM8XXX_DRV_LED_CTRL_SHIFT) & PM8XXX_DRV_LED_CTRL_MASK;
offset = PM8XXX_LED_OFFSET(for_key_led_data->id);
register_key = pm8xxxx_led_pwm_mode(for_key_led_data->id);
register_key &= ~PM8XXX_DRV_LED_CTRL_MASK;
register_key |= level;
rc = pm8xxx_writeb(for_key_led_data->dev->parent, SSBI_REG_ADDR_LED_CTRL(offset), register_key);
if (rc)
LED_ERR("%s can't set (%d) led value rc=%d\n", __func__, PM8XXX_ID_LED_0, rc);
if (virtual_key_state != 0){
level = 0;
register_key = 0;
level = (40 << PM8XXX_DRV_LED_CTRL_SHIFT) & PM8XXX_DRV_LED_CTRL_MASK;
offset = PM8XXX_LED_OFFSET(for_key_led_data->id);
register_key = pm8xxxx_led_pwm_mode(for_key_led_data->id);
register_key &= ~PM8XXX_DRV_LED_CTRL_MASK;
register_key |= level;
rc = pm8xxx_writeb(for_key_led_data->dev->parent, SSBI_REG_ADDR_LED_CTRL(offset), register_key);
if (rc)
LED_ERR("%s can't set (%d) led value rc=%d\n", __func__, PM8XXX_ID_LED_0, rc);
pwm_config(for_key_led_data->pwm_led, 64000, 64000);
pwm_enable(for_key_led_data->pwm_led);
}
flag_hold_virtual_key = 0;
}
}
static int __devinit pm8xxx_led_probe(struct platform_device *pdev)
{
const struct pm8xxx_led_platform_data *pdata = pdev->dev.platform_data;
struct pm8xxx_led_configure *curr_led;
struct pm8xxx_led_data *led, *led_dat;
int i, j, ret = -ENOMEM;
if (pdata == NULL) {
LED_ERR("platform data not supplied\n");
return -EINVAL;
}
led = kcalloc(pdata->num_leds + 1, sizeof(*led), GFP_KERNEL);
if (led == NULL) {
LED_ERR("failed to alloc memory\n");
return -ENOMEM;
}
wake_lock_init(&pmic_led_wake_lock, WAKE_LOCK_SUSPEND, "pmic_led");
g_led_work_queue = create_workqueue("pm8xxx-led");
if (g_led_work_queue == NULL) {
LED_ERR("failed to create workqueue\n");
goto err_create_work_queue;
}
for (i = 0; i < pdata->num_leds; i++) {
curr_led = &pdata->leds[i];
led_dat = &led[i];
led_dat->cdev.name = curr_led->name;
led_dat->id = curr_led->flags;
led_dat->bank = curr_led->flags;
led_dat->function_flags = curr_led->function_flags;
led_dat->start_index = curr_led->start_index;
led_dat->duty_time_ms = curr_led->duty_time_ms;
led_dat->period_us = curr_led->period_us;
led_dat->duites_size = curr_led->duites_size;
led_dat->lut_flag = curr_led->lut_flag;
led_dat->out_current = curr_led->out_current;
led_dat->duties = &(curr_led->duties[0]);
led_dat->led_sync = curr_led->led_sync;
led_dat->pwm_led = pwm_request(led_dat->bank, led_dat->cdev.name);
led_dat->lpm_power = curr_led->lpm_power;
if (curr_led->duties[1]) {
for (j = 0; j < 64; j++)
dutys_array[j] = *(led_dat->duties + j);
}
if( curr_led->pwm_coefficient > 0 )
led_dat->pwm_coefficient = curr_led->pwm_coefficient;
else
led_dat->pwm_coefficient = 100;
if (curr_led->blink_duty_per_2sec > 0)
led_dat->blink_duty_per_2sec = curr_led->blink_duty_per_2sec;
else
led_dat->blink_duty_per_2sec = 64000;
switch (led_dat->id) {
case PM8XXX_ID_GPIO24:
case PM8XXX_ID_GPIO25:
case PM8XXX_ID_GPIO26:
led_dat->cdev.brightness_set = pm8xxx_led_gpio_set;
if (curr_led->gpio_status_switch != NULL)
led_dat->gpio_status_switch = curr_led->gpio_status_switch;
break;
case PM8XXX_ID_LED_0:
case PM8XXX_ID_LED_1:
case PM8XXX_ID_LED_2:
led_dat->cdev.brightness_set = pm8xxx_led_current_set;
if (led_dat->function_flags & LED_PWM_FUNCTION) {
led_dat->reg = pm8xxxx_led_pwm_mode(led_dat->id);
INIT_DELAYED_WORK(&led[i].fade_delayed_work, led_fade_do_work);
} else
led_dat->reg = PM8XXX_LED_MODE_MANUAL;
break;
case PM8XXX_ID_LED_KB_LIGHT:
break;
}
led_dat->cdev.brightness = LED_OFF;
led_dat->dev = &pdev->dev;
ret = led_classdev_register(&pdev->dev, &led_dat->cdev);
if (ret) {
LED_ERR("unable to register led %d,ret=%d\n", led_dat->id, ret);
goto err_register_led_cdev;
}
// blink buttons
if (led_dat->id == PM8XXX_ID_LED_0) {
// storing buttons light dev for blinking
led_cdev_buttons = &led_dat->cdev;
ret = device_create_file(led_dat->cdev.dev, &dev_attr_blink_buttons);
if (ret < 0) {
LED_ERR("%s: Failed to create %d attr blink_buttons\n", __func__, i);
goto err_register_attr_currents;
}
}
// blink buttons end
if (led_dat->id >= PM8XXX_ID_LED_2 && led_dat->id <= PM8XXX_ID_LED_0) {
ret = device_create_file(led_dat->cdev.dev, &dev_attr_currents);
if (ret < 0) {
LED_ERR("%s: Failed to create %d attr currents\n", __func__, i);
goto err_register_attr_currents;
}
}
if (led_dat->id >= PM8XXX_ID_LED_2 && led_dat->id <= PM8XXX_ID_LED_0) {
ret = device_create_file(led_dat->cdev.dev, &dev_attr_lut_coefficient);
if (ret < 0) {
LED_ERR("%s: Failed to create %d attr lut_coefficient\n", __func__, i);
goto err_register_attr_lut_coefficient;
}
}
if ((led_dat->id <= PM8XXX_ID_GPIO26) || (led_dat->id <= PM8XXX_ID_LED_2) ||
(led_dat->id <= PM8XXX_ID_LED_1)) {
ret = device_create_file(led_dat->cdev.dev, &dev_attr_pwm_coefficient);
if (ret < 0) {
LED_ERR("%s: Failed to create %d attr pwm_coefficient\n", __func__, i);
goto err_register_attr_pwm_coefficient;
}
}
if (led_dat->function_flags & LED_BLINK_FUNCTION) {
INIT_DELAYED_WORK(&led[i].blink_delayed_work, led_blink_do_work);
ret = device_create_file(led_dat->cdev.dev, &dev_attr_blink);
if (ret < 0) {
LED_ERR("%s: Failed to create %d attr blink\n", __func__, i);
goto err_register_attr_blink;
}
ret = device_create_file(led_dat->cdev.dev, &dev_attr_off_timer);
if (ret < 0) {
LED_ERR("%s: Failed to create %d attr off timer\n", __func__, i);
goto err_register_attr_off_timer;
}
alarm_init(&led[i].led_alarm, ANDROID_ALARM_ELAPSED_REALTIME_WAKEUP, led_alarm_handler);
INIT_WORK(&led[i].led_work, led_work_func);
}
if (!strcmp(led_dat->cdev.name, "button-backlight")) {
for_key_led_data = led_dat;
}
if (!strcmp(led_dat->cdev.name, "green-back")) {
LED_INFO("%s: green-back, 000 probe, led_dat = %x\n", __func__, (unsigned int)led_dat);
green_back_led_data = led_dat;
}
if (!strcmp(led_dat->cdev.name, "amber-back")) {
LED_INFO("%s: amber-back\n", __func__);
amber_back_led_data = led_dat;
}
}
pm8xxx_leds = led;
platform_set_drvdata(pdev, led);
return 0;
err_register_attr_off_timer:
if (i > 0) {
for (i = i - 1; i >= 0; i--) {
if (led[i].function_flags & LED_BLINK_FUNCTION)
device_remove_file(led[i].cdev.dev, &dev_attr_off_timer);
}
}
i = pdata->num_leds;
err_register_attr_blink:
if (i > 0) {
for (i = i - 1; i >= 0; i--) {
if (led[i].function_flags & LED_BLINK_FUNCTION)
device_remove_file(led[i].cdev.dev, &dev_attr_blink);
}
}
i = pdata->num_leds;
err_register_attr_pwm_coefficient:
if (i > 0) {
for (i = i - 1; i >= 0; i--) {
if (led[i].function_flags <= PM8XXX_ID_GPIO26)
device_remove_file(led[i].cdev.dev, &dev_attr_pwm_coefficient);
}
}
i = pdata->num_leds;
err_register_attr_lut_coefficient:
if (i > 0) {
for (i = i - 1; i >= 0; i--) {
if (led[i].function_flags >= PM8XXX_ID_LED_2 && led[i].function_flags <= PM8XXX_ID_LED_0)
device_remove_file(led[i].cdev.dev, &dev_attr_lut_coefficient);
}
}
i = pdata->num_leds;
err_register_attr_currents:
if (i > 0) {
for (i = i - 1; i >= 0; i--) {
if (led[i].function_flags >= PM8XXX_ID_LED_2 && led[i].function_flags <= PM8XXX_ID_LED_0)
device_remove_file(led[i].cdev.dev, &dev_attr_currents);
}
}
i = pdata->num_leds;
err_register_led_cdev:
if (i > 0) {
for (i = i - 1; i >= 0; i--) {
pwm_free(led[i].pwm_led);
led_classdev_unregister(&led[i].cdev);
}
}
destroy_workqueue(g_led_work_queue);
err_create_work_queue:
kfree(led);
wake_lock_destroy(&pmic_led_wake_lock);
return ret;
}
static int __devinit pm8xxx_led_probe(struct platform_device *pdev)
{
const struct pm8xxx_led_platform_data *pdata = pdev->dev.platform_data;
struct pm8xxx_led_configure *curr_led;
struct pm8xxx_led_data *led, *led_dat;
int i, ret = -ENOMEM;
if (pdata == NULL) {
LED_ERR("platform data not supplied\n");
return -EINVAL;
}
/* Let the last member of the list be zero to
* mark the end of the list.
*/
led = kcalloc(pdata->num_leds + 1, sizeof(*led), GFP_KERNEL);
if (led == NULL) {
LED_ERR("failed to alloc memory\n");
return -ENOMEM;
}
g_led_work_queue = create_workqueue("pm8xxx-led");
if (g_led_work_queue == NULL) {
LED_ERR("failed to create workqueue\n");
goto err_create_work_queue;
}
for (i = 0; i < pdata->num_leds; i++) {
curr_led = &pdata->leds[i];
led_dat = &led[i];
led_dat->cdev.name = curr_led->name;
led_dat->id = curr_led->flags;
led_dat->bank = curr_led->flags;
led_dat->function_flags = curr_led->function_flags;
led_dat->start_index = curr_led->start_index;
led_dat->duty_time_ms = curr_led->duty_time_ms;
led_dat->period_us = curr_led->period_us;
led_dat->duites_size = curr_led->duites_size;
led_dat->lut_flag = curr_led->lut_flag;
led_dat->out_current = curr_led->out_current;
led_dat->duties = &(curr_led->duties[0]);
led_dat->pwm_led = pwm_request(led_dat->bank, led_dat->cdev.name);
switch (led_dat->id) {
case PM8XXX_ID_GPIO24:
case PM8XXX_ID_GPIO25:
case PM8XXX_ID_GPIO26:
led_dat->cdev.brightness_set = pm8xxx_led_gpio_set;
if (curr_led->gpio_status_switch != NULL)
led_dat->gpio_status_switch = curr_led->gpio_status_switch;
break;
case PM8XXX_ID_LED_0:
case PM8XXX_ID_LED_1:
case PM8XXX_ID_LED_2:
led_dat->cdev.brightness_set = pm8xxx_led_current_set;
if (led_dat->function_flags & LED_PWM_FUNCTION) {
led_dat->reg = pm8xxxx_led_pwm_mode(led_dat->id);
INIT_DELAYED_WORK(&led[i].fade_delayed_work, led_fade_do_work);
} else
led_dat->reg = PM8XXX_LED_MODE_MANUAL;
break;
case PM8XXX_ID_LED_KB_LIGHT:
break;
}
led_dat->cdev.brightness = LED_OFF;
led_dat->dev = &pdev->dev;
ret = led_classdev_register(&pdev->dev, &led_dat->cdev);
if (ret) {
LED_ERR("unable to register led %d,ret=%d\n", led_dat->id, ret);
goto err_register_led_cdev;
}
if (led_dat->id >= PM8XXX_ID_LED_2 && led_dat->id <= PM8XXX_ID_LED_0) {
ret = device_create_file(led_dat->cdev.dev, &dev_attr_currents);
if (ret < 0) {
LED_ERR("%s: Failed to create %d attr currents\n", __func__, i);
goto err_register_attr_currents;
}
}
if (led_dat->function_flags & LED_BLINK_FUNCTION) {
INIT_DELAYED_WORK(&led[i].blink_delayed_work, led_blink_do_work);
ret = device_create_file(led_dat->cdev.dev, &dev_attr_blink);
if (ret < 0) {
LED_ERR("%s: Failed to create %d attr blink\n", __func__, i);
goto err_register_attr_blink;
}
ret = device_create_file(led_dat->cdev.dev, &dev_attr_off_timer);
if (ret < 0) {
LED_ERR("%s: Failed to create %d attr off timer\n", __func__, i);
goto err_register_attr_off_timer;
}
alarm_init(&led[i].led_alarm, ANDROID_ALARM_ELAPSED_REALTIME_WAKEUP, led_alarm_handler);
INIT_WORK(&led[i].led_work, led_work_func); /*Off blink after alarm*/
}
if(led_dat->id == PM8XXX_ID_LED_0)
{
for_key_led_data = led_dat;
}
}
pm8xxx_leds = led;
platform_set_drvdata(pdev, led);
return 0;
err_register_attr_off_timer:
if (i > 0) {
for (i = i - 1; i >= 0; i--) {
if (led[i].function_flags & LED_BLINK_FUNCTION)
device_remove_file(led[i].cdev.dev, &dev_attr_off_timer);
}
}
i = pdata->num_leds;
err_register_attr_blink:
if (i > 0) {
for (i = i - 1; i >= 0; i--) {
if (led[i].function_flags & LED_BLINK_FUNCTION)
device_remove_file(led[i].cdev.dev, &dev_attr_blink);
}
}
i = pdata->num_leds;
err_register_attr_currents:
if (i > 0) {
for (i = i - 1; i >= 0; i--) {
if (led[i].function_flags >= PM8XXX_ID_LED_2 && led[i].function_flags <= PM8XXX_ID_LED_0)
device_remove_file(led[i].cdev.dev, &dev_attr_currents);
}
}
i = pdata->num_leds;
err_register_led_cdev:
if (i > 0) {
for (i = i - 1; i >= 0; i--) {
pwm_free(led[i].pwm_led);
led_classdev_unregister(&led[i].cdev);
}
}
destroy_workqueue(g_led_work_queue);
err_create_work_queue:
kfree(led);
return ret;
}
