mirror of
https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
synced 2025-09-09 01:28:05 -04:00
Fixed MTP to work with TWRP
This commit is contained in:
awab228
commit
f6dfaef42e
50820 changed files with 20846062 additions and 0 deletions
388
drivers/leds/leds-ktd2692.c
Executable file
388
drivers/leds/leds-ktd2692.c
Executable file
|
|
@ -0,0 +1,388 @@
|
|||
/*
|
||||
* LED driver - leds-ktd2692.c
|
||||
*
|
||||
* Copyright (C) 2013 Sunggeun Yim <sunggeun.yim@samsung.com>
|
||||
*
|
||||
* 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/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/pwm.h>
|
||||
#include <linux/vmalloc.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/gpio.h>
|
||||
#include <linux/leds-ktd2692.h>
|
||||
#ifdef CONFIG_OF
|
||||
#include <linux/of.h>
|
||||
#include <linux/of_gpio.h>
|
||||
#endif
|
||||
|
||||
extern struct class *camera_class; /*sys/class/camera*/
|
||||
struct device *ktd2692_dev;
|
||||
|
||||
struct ktd2692_platform_data *global_ktd2692data = NULL;
|
||||
struct device *global_dev;
|
||||
|
||||
void ktd2692_setGpio(int onoff)
|
||||
{
|
||||
if (onoff) {
|
||||
__gpio_set_value(global_ktd2692data->flash_control, 1);
|
||||
} else {
|
||||
__gpio_set_value(global_ktd2692data->flash_control, 0);
|
||||
}
|
||||
}
|
||||
|
||||
void ktd2692_set_low_bit(void)
|
||||
{
|
||||
__gpio_set_value(global_ktd2692data->flash_control, 0);
|
||||
ndelay(T_L_LB*1000); /* 12ms */
|
||||
__gpio_set_value(global_ktd2692data->flash_control, 1);
|
||||
ndelay(T_H_LB*1000); /* 4ms */
|
||||
}
|
||||
|
||||
void ktd2692_set_high_bit(void)
|
||||
{
|
||||
__gpio_set_value(global_ktd2692data->flash_control, 0);
|
||||
ndelay(T_L_HB*1000); /* 4ms */
|
||||
__gpio_set_value(global_ktd2692data->flash_control, 1);
|
||||
ndelay(T_H_HB*1000); /* 12ms */
|
||||
}
|
||||
|
||||
static int ktd2692_set_bit(unsigned int bit)
|
||||
{
|
||||
if (bit) {
|
||||
ktd2692_set_high_bit();
|
||||
} else {
|
||||
ktd2692_set_low_bit();
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ktd2692_write_data(unsigned data)
|
||||
{
|
||||
int err = 0;
|
||||
unsigned int bit = 0;
|
||||
|
||||
/* Data Start Condition */
|
||||
__gpio_set_value(global_ktd2692data->flash_control, 1);
|
||||
ndelay(T_SOD*1000); //15us
|
||||
|
||||
/* BIT 7*/
|
||||
bit = ((data>> 7) & 0x01);
|
||||
ktd2692_set_bit(bit);
|
||||
|
||||
/* BIT 6 */
|
||||
bit = ((data>> 6) & 0x01);
|
||||
ktd2692_set_bit(bit);
|
||||
|
||||
/* BIT 5*/
|
||||
bit = ((data>> 5) & 0x01);
|
||||
ktd2692_set_bit(bit);
|
||||
|
||||
/* BIT 4 */
|
||||
bit = ((data>> 4) & 0x01);
|
||||
ktd2692_set_bit(bit);
|
||||
|
||||
/* BIT 3*/
|
||||
bit = ((data>> 3) & 0x01);
|
||||
ktd2692_set_bit(bit);
|
||||
|
||||
/* BIT 2 */
|
||||
bit = ((data>> 2) & 0x01);
|
||||
ktd2692_set_bit(bit);
|
||||
|
||||
/* BIT 1*/
|
||||
bit = ((data>> 1) & 0x01);
|
||||
ktd2692_set_bit(bit);
|
||||
|
||||
/* BIT 0 */
|
||||
bit = ((data>> 0) & 0x01);
|
||||
ktd2692_set_bit(bit);
|
||||
|
||||
__gpio_set_value(global_ktd2692data->flash_control, 0);
|
||||
ndelay(T_EOD_L*1000); //4us
|
||||
|
||||
/* Data End Condition */
|
||||
__gpio_set_value(global_ktd2692data->flash_control, 1);
|
||||
udelay(T_EOD_H);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
#if defined(CONFIG_LEDS_SUPPORT_FRONT_FLASH)
|
||||
int ktd2692_led_mode_ctrl(int mode)
|
||||
{
|
||||
int ret = 0;
|
||||
unsigned long flags = 0;
|
||||
struct pinctrl *pinctrl;
|
||||
|
||||
LED_INFO("KTD2692 - mode = %d\n", mode);
|
||||
|
||||
if(global_ktd2692data == NULL){
|
||||
LED_INFO("KTD2692 global_ktd2692data is not initialized.\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
switch(mode) {
|
||||
case 1 : //CAM2_FLASH_MODE_OFF
|
||||
ret = gpio_request(global_ktd2692data->flash_control, "ktd2692_led_control");
|
||||
if (ret) {
|
||||
LED_ERROR("Failed to requeset ktd2692_led_control\n");
|
||||
} else {
|
||||
LED_INFO("KTD2692-TORCH OFF. : E(%d)\n", mode);
|
||||
|
||||
global_ktd2692data->mode_status = KTD2692_DISABLES_MOVIE_FLASH_MODE;
|
||||
spin_lock_irqsave(&global_ktd2692data->int_lock, flags);
|
||||
ktd2692_write_data(global_ktd2692data->mode_status|
|
||||
KTD2692_ADDR_MOVIE_FLASHMODE_CONTROL);
|
||||
spin_unlock_irqrestore(&global_ktd2692data->int_lock, flags);
|
||||
|
||||
ktd2692_setGpio(0);
|
||||
gpio_free(global_ktd2692data->flash_control);
|
||||
LED_INFO("KTD2692-TORCH OFF. : X(%d)\n", mode);
|
||||
}
|
||||
|
||||
pinctrl = devm_pinctrl_get_select(global_dev, "is");
|
||||
if (IS_ERR(pinctrl))
|
||||
pr_err("%s: flash %s pins are not configured\n", __func__, "is");
|
||||
break;
|
||||
case 2 : //CAM2_FLASH_MODE_SINGLE
|
||||
pinctrl = devm_pinctrl_get_select(global_dev, "host");
|
||||
if (IS_ERR(pinctrl))
|
||||
pr_err("%s: flash %s pins are not configured\n", __func__, "host");
|
||||
|
||||
ret = gpio_request(global_ktd2692data->flash_control, "ktd2692_led_control");
|
||||
if (ret) {
|
||||
LED_ERROR("Failed to requeset ktd2692_led_control\n");
|
||||
} else {
|
||||
LED_INFO("KTD2692-TORCH ON. : E(%d)\n", mode);
|
||||
|
||||
global_ktd2692data->mode_status = KTD2692_ENABLE_MOVIE_MODE;
|
||||
spin_lock_irqsave(&global_ktd2692data->int_lock, flags);
|
||||
ktd2692_write_data(global_ktd2692data->LVP_Voltage|
|
||||
KTD2692_ADDR_LVP_SETTING);
|
||||
ktd2692_write_data(global_ktd2692data->movie_current_value|
|
||||
KTD2692_ADDR_MOVIE_CURRENT_SETTING);
|
||||
ktd2692_write_data(global_ktd2692data->mode_status|
|
||||
KTD2692_ADDR_MOVIE_FLASHMODE_CONTROL);
|
||||
spin_unlock_irqrestore(&global_ktd2692data->int_lock, flags);
|
||||
|
||||
gpio_free(global_ktd2692data->flash_control);
|
||||
LED_INFO("KTD2692-TORCH ON. : X(%d)\n", mode);
|
||||
}
|
||||
break;
|
||||
default :
|
||||
break;
|
||||
}
|
||||
if (!IS_ERR(pinctrl))
|
||||
devm_pinctrl_put(pinctrl);
|
||||
|
||||
return ret;
|
||||
}
|
||||
#endif
|
||||
|
||||
#ifndef CONFIG_LEDS_SUPPORT_FRONT_FLASH
|
||||
ssize_t ktd2692_store(struct device *dev,
|
||||
struct device_attribute *attr, const char *buf,
|
||||
size_t count)
|
||||
{
|
||||
int value = 0;
|
||||
int ret = 0;
|
||||
unsigned long flags = 0;
|
||||
struct pinctrl *pinctrl;
|
||||
|
||||
if ((buf == NULL) || kstrtouint(buf, 10, &value)) {
|
||||
return -1;
|
||||
}
|
||||
|
||||
global_ktd2692data->sysfs_input_data = value;
|
||||
|
||||
if (value <= 0) {
|
||||
ret = gpio_request(global_ktd2692data->flash_control, "ktd2692_led_control");
|
||||
if (ret) {
|
||||
LED_ERROR("Failed to requeset ktd2692_led_control\n");
|
||||
} else {
|
||||
LED_INFO("KTD2692-TORCH OFF. : E(%d)\n", value);
|
||||
|
||||
global_ktd2692data->mode_status = KTD2692_DISABLES_MOVIE_FLASH_MODE;
|
||||
spin_lock_irqsave(&global_ktd2692data->int_lock, flags);
|
||||
ktd2692_write_data(global_ktd2692data->mode_status|
|
||||
KTD2692_ADDR_MOVIE_FLASHMODE_CONTROL);
|
||||
spin_unlock_irqrestore(&global_ktd2692data->int_lock, flags);
|
||||
|
||||
ktd2692_setGpio(0);
|
||||
gpio_free(global_ktd2692data->flash_control);
|
||||
LED_INFO("KTD2692-TORCH OFF. : X(%d)\n", value);
|
||||
}
|
||||
|
||||
pinctrl = devm_pinctrl_get_select(global_dev, "is");
|
||||
if (IS_ERR(pinctrl))
|
||||
pr_err("%s: flash %s pins are not configured\n", __func__, "is");
|
||||
|
||||
} else {
|
||||
pinctrl = devm_pinctrl_get_select(global_dev, "host");
|
||||
if (IS_ERR(pinctrl))
|
||||
pr_err("%s: flash %s pins are not configured\n", __func__, "host");
|
||||
|
||||
ret = gpio_request(global_ktd2692data->flash_control, "ktd2692_led_control");
|
||||
if (ret) {
|
||||
LED_ERROR("Failed to requeset ktd2692_led_control\n");
|
||||
} else {
|
||||
LED_INFO("KTD2692-TORCH ON. : E(%d)\n", value);
|
||||
|
||||
global_ktd2692data->mode_status = KTD2692_ENABLE_MOVIE_MODE;
|
||||
spin_lock_irqsave(&global_ktd2692data->int_lock, flags);
|
||||
ktd2692_write_data(global_ktd2692data->LVP_Voltage|
|
||||
KTD2692_ADDR_LVP_SETTING);
|
||||
#if 0 /* use the internel defualt setting */
|
||||
ktd2692_write_data(global_ktd2692data->flash_timeout|
|
||||
KTD2692_ADDR_FLASH_TIMEOUT_SETTING);
|
||||
#endif
|
||||
ktd2692_write_data(global_ktd2692data->movie_current_value|
|
||||
KTD2692_ADDR_MOVIE_CURRENT_SETTING);
|
||||
ktd2692_write_data(global_ktd2692data->mode_status|
|
||||
KTD2692_ADDR_MOVIE_FLASHMODE_CONTROL);
|
||||
spin_unlock_irqrestore(&global_ktd2692data->int_lock, flags);
|
||||
|
||||
gpio_free(global_ktd2692data->flash_control);
|
||||
LED_INFO("KTD2692-TORCH ON. : X(%d)\n", value);
|
||||
}
|
||||
}
|
||||
|
||||
if (!IS_ERR(pinctrl))
|
||||
devm_pinctrl_put(pinctrl);
|
||||
|
||||
return count;
|
||||
}
|
||||
|
||||
ssize_t ktd2692_show(struct device *dev,
|
||||
struct device_attribute *attr, char *buf)
|
||||
{
|
||||
return sprintf(buf, "%d\n", global_ktd2692data->sysfs_input_data);
|
||||
}
|
||||
|
||||
static DEVICE_ATTR(rear_flash, S_IRUSR|S_IWUSR|S_IRGRP|S_IWGRP|S_IROTH,
|
||||
ktd2692_show, ktd2692_store);
|
||||
#endif
|
||||
|
||||
static int ktd2692_parse_dt(struct device *dev,
|
||||
struct ktd2692_platform_data *pdata)
|
||||
{
|
||||
struct device_node *dnode = dev->of_node;
|
||||
int ret = 0;
|
||||
|
||||
/* Defulat Value */
|
||||
pdata->LVP_Voltage = KTD2692_DISABLE_LVP;
|
||||
pdata->flash_timeout = KTD2692_TIMER_1049ms; /* default */
|
||||
pdata->min_current_value = KTD2692_MIN_CURRENT_240mA;
|
||||
pdata->movie_current_value = KTD2692_MOVIE_CURRENT5;
|
||||
pdata->flash_current_value = KTD2692_FLASH_CURRENT16;
|
||||
pdata->mode_status = KTD2692_DISABLES_MOVIE_FLASH_MODE;
|
||||
|
||||
/* get gpio */
|
||||
pdata->flash_control = of_get_named_gpio(dnode, "flash_control", 0);
|
||||
if (!gpio_is_valid(pdata->flash_control)) {
|
||||
dev_err(dev, "failed to get flash_control\n");
|
||||
return -1;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int ktd2692_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct ktd2692_platform_data *pdata;
|
||||
int ret = 0;
|
||||
|
||||
LED_INFO("KTD2692_LED Probe\n");
|
||||
|
||||
if (pdev->dev.of_node) {
|
||||
pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
|
||||
if (!pdata) {
|
||||
dev_err(&pdev->dev, "Failed to allocate memory\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
ret = ktd2692_parse_dt(&pdev->dev, pdata);
|
||||
if (ret < 0) {
|
||||
return -EFAULT;
|
||||
}
|
||||
} else {
|
||||
pdata = pdev->dev.platform_data;
|
||||
if (pdata == NULL) {
|
||||
return -EFAULT;
|
||||
}
|
||||
}
|
||||
|
||||
global_ktd2692data = pdata;
|
||||
global_dev = &pdev->dev;
|
||||
|
||||
LED_INFO("KTD2692_LED Probed\n");
|
||||
|
||||
#ifndef CONFIG_LEDS_SUPPORT_FRONT_FLASH
|
||||
ktd2692_dev = device_create(camera_class, NULL, 0, NULL, "flash");
|
||||
if (IS_ERR(ktd2692_dev)) {
|
||||
LED_ERROR("Failed to create device(flash)!\n");
|
||||
}
|
||||
|
||||
if (device_create_file(ktd2692_dev, &dev_attr_rear_flash) < 0) {
|
||||
LED_ERROR("failed to create device file, %s\n",
|
||||
dev_attr_rear_flash.attr.name);
|
||||
}
|
||||
#endif
|
||||
spin_lock_init(&pdata->int_lock);
|
||||
|
||||
return 0;
|
||||
}
|
||||
static int __devexit ktd2692_remove(struct platform_device *pdev)
|
||||
{
|
||||
#ifndef CONFIG_LEDS_SUPPORT_FRONT_FLASH
|
||||
device_remove_file(ktd2692_dev, &dev_attr_rear_flash);
|
||||
device_destroy(camera_class, 0);
|
||||
class_destroy(camera_class);
|
||||
#endif
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_OF
|
||||
static struct of_device_id ktd2692_dt_ids[] = {
|
||||
{ .compatible = "ktd2692",},
|
||||
{},
|
||||
};
|
||||
/*MODULE_DEVICE_TABLE(of, ktd2692_dt_ids);*/
|
||||
#endif
|
||||
|
||||
static struct platform_driver ktd2692_driver = {
|
||||
.driver = {
|
||||
.name = ktd2692_NAME,
|
||||
.owner = THIS_MODULE,
|
||||
#ifdef CONFIG_OF
|
||||
.of_match_table = ktd2692_dt_ids,
|
||||
#endif
|
||||
},
|
||||
.probe = ktd2692_probe,
|
||||
.remove = ktd2692_remove,
|
||||
};
|
||||
|
||||
static int __init ktd2692_init(void)
|
||||
{
|
||||
return platform_driver_register(&ktd2692_driver);
|
||||
}
|
||||
|
||||
static void __exit ktd2692_exit(void)
|
||||
{
|
||||
platform_driver_unregister(&ktd2692_driver);
|
||||
}
|
||||
|
||||
module_init(ktd2692_init);
|
||||
module_exit(ktd2692_exit);
|
||||
|
||||
MODULE_AUTHOR("sunggeun yim <sunggeun.yim@samsung.com.com>");
|
||||
MODULE_DESCRIPTION("KTD2692 driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
|
||||
|
||||
Loading…
Add table
Add a link
Reference in a new issue