path: root/drivers/leds/leds-genesis.c

/* LEDs driver for WM8880 Platform
*
* Copyright (c) 2014 WonderMedia Technologies, Inc.
*
* 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.
*
*/
/*********************************** History ***********************************
* Version 1.0 , HowayHuo, 2013/5/7
* First version: Created by Howayhuo
*
********************************************************************************/
#include <linux/init.h>
#include <linux/module.h>
#include <linux/types.h>
#include <linux/slab.h>
#include <linux/leds.h>
#include <linux/gpio.h>
#include <mach/wmt_iomux.h>
#include <linux/platform_device.h>
#include "../char/wmt-pwm.h"

#define ENV_GENESIS_LED "wmt.gpo.logoled"
#define ENV_LOGO_LED    "wmt.logo.led"
#define PWM2_GPIO_NO         200

extern int wmt_getsyspara(char *varname, unsigned char *varval, int *varlen);

struct led_operation_t {
	unsigned int light;
	unsigned int gpiono;
	unsigned int act;
};

static struct led_operation_t *led_gpio_pin;
static int logo_led_enable;

static void led_set_pwm(int no, int level, int freq, int active, int init)
{
	int clock;
	int period, duty, scalar;

	if(init) {
		clock = auto_pll_divisor(DEV_PWM,GET_FREQ, 0, 0);
		clock = clock / freq;
		scalar = 0;
		period = 2000;

		while(period > 1023) {
			scalar++;
			period = clock / scalar;
		}

		duty = (period*level)/100;
		duty = (duty)? (duty-1):0;
		scalar = scalar-1;
		period = period -1;

		pwm_set_period(no,period);
		pwm_set_duty(no,duty);
		pwm_set_scalar(no,scalar);
		REG32_VAL(PIN_SHARING_SEL_4BYTE_ADDR) &= ~0x80;
	}

	if (active == 0)
		pwm_set_control(no,(level)? 0x37:0x8);
	else
		pwm_set_control(no,(level)? 0x35:0x8);
}

static void logo_led_light(int is_light)
{
	if(!led_gpio_pin)
		return;

	if(led_gpio_pin->gpiono == PWM2_GPIO_NO) {
		if(is_light)
			led_set_pwm(2, 100, 22000, led_gpio_pin->act, 1);
		else
			led_set_pwm(2, 100, 22000, !led_gpio_pin->act, 0);
		return;
	}

	if(is_light) {
		if(led_gpio_pin->act)
			gpio_direction_output(led_gpio_pin->gpiono, 1);
		else
			gpio_direction_output(led_gpio_pin->gpiono, 0);
	}else {
		if(led_gpio_pin->act)
			gpio_direction_output(led_gpio_pin->gpiono, 0);
		else
			gpio_direction_output(led_gpio_pin->gpiono, 1);
	}
}

static void logo_led_turn_on(int on)
{
	if(logo_led_enable)
		logo_led_light(on);
}

static void set_led_brightness(struct led_classdev *cdev, enum led_brightness b)
{
	logo_led_turn_on(b);
}

static ssize_t attr_led_enable_show(struct device *dev,
			       struct device_attribute *attr, char *buf)
{
	return sprintf(buf, "%d\n", logo_led_enable);
}

static ssize_t attr_led_enable_store(struct device *dev,
			       struct device_attribute *attr,
			       const char *buf, size_t size)
{
	unsigned long val;

	if (strict_strtoul(buf, 10, &val))
		return -EINVAL;

	logo_led_enable = val;

	if(logo_led_enable)
		logo_led_light(1);
	else
		logo_led_light(0);

	return size;
}

static DEVICE_ATTR(enable, 0644, attr_led_enable_show, attr_led_enable_store);

static int __devinit logo_led_probe(struct platform_device *pdev)
{
	int i, num;
	int ret = 0;
	const struct gpio_led_platform_data	*pdata;
	struct led_classdev	*leds;
	unsigned char buf[100];
	int buflen = 100;

	pdata = pdev->dev.platform_data;
	if (!pdata || pdata->num_leds < 1)
		return -ENODEV;

	leds = kzalloc(pdata->num_leds * sizeof(*leds), GFP_KERNEL);
	if (!leds)
		return -ENOMEM;

	for (i = 0; i < pdata->num_leds; i++) {
		struct led_classdev 	*led = leds + i;
		const struct gpio_led	*dat = pdata->leds + i;

		led->name = dat->name;
		led->brightness = 0;
		led->brightness_set = set_led_brightness;
		led->default_trigger = dat->default_trigger;

		ret = led_classdev_register(&pdev->dev, led);
		if (ret < 0)
			goto err0;

		ret = device_create_file(led->dev, &dev_attr_enable);
		if(ret)
			goto err0;
	}

	platform_set_drvdata(pdev, leds);

	if(wmt_getsyspara(ENV_GENESIS_LED, buf, &buflen)) {
		if(wmt_getsyspara(ENV_LOGO_LED, buf, &buflen))
		    goto exit0;
        else
            logo_led_enable = 1;
	}

	led_gpio_pin = kzalloc(sizeof(struct led_operation_t), GFP_KERNEL);
	if(!led_gpio_pin)
		goto exit0;

	num = sscanf(buf, "%d:%d:%d", &led_gpio_pin->light, &led_gpio_pin->gpiono,
		&led_gpio_pin->act);

	if(num != 3) {
		pr_err("the param of genesis-led is error. param num = %d\n", num);
		goto exit0;
	}

	if(led_gpio_pin->gpiono == PWM2_GPIO_NO) {
		if(led_gpio_pin->light) {
			logo_led_enable = 1;
			led_set_pwm(2, 100, 22000, led_gpio_pin->act, 1);
		}
		else
			led_set_pwm(2, 100, 22000, !led_gpio_pin->act, 1);
	} else {
	ret = gpio_request(led_gpio_pin->gpiono, "genesis-led");
	if(ret < 0) {
		pr_err("gpio(%d) request fail for genesis-led\n", led_gpio_pin->gpiono);
		goto exit0;
	}

		logo_led_light(led_gpio_pin->light);
	}

	return 0;

err0:
	if (i > 0) {
		for (i = i - 1; i >= 0; i--) {
			device_remove_file((leds + i)->dev, &dev_attr_enable);
			led_classdev_unregister(leds + i);
		}
	}

	kfree(leds);

	return ret;

exit0:
	if(led_gpio_pin) {
		kfree(led_gpio_pin);
		led_gpio_pin = NULL;
	}

	return 0;
}

static int __devexit logo_led_remove(struct platform_device *pdev)
{
	const struct gpio_led_platform_data	*pdata;
	struct led_classdev				*leds;
	unsigned				i;

	pdata = pdev->dev.platform_data;
	leds = platform_get_drvdata(pdev);

	for (i = 0; i < pdata->num_leds; i++) {
		struct led_classdev		*led = leds + i;
		device_remove_file(led->dev, &dev_attr_enable);
		led_classdev_unregister(led);
	}

	kfree(leds);
	platform_set_drvdata(pdev, NULL);

	if(led_gpio_pin) {
		logo_led_light(0);
		gpio_free(led_gpio_pin->gpiono);
		kfree(led_gpio_pin);
		led_gpio_pin = NULL;
	}

	return 0;
}

static int logo_led_suspend(struct platform_device *pdev,
	pm_message_t state)
{
	return 0;
}

static int logo_led_resume(struct platform_device *pdev)
{

	if(!led_gpio_pin)
		return 0;

	if(led_gpio_pin->gpiono == PWM2_GPIO_NO) {
		if(logo_led_enable)
			led_set_pwm(2, 100, 22000, led_gpio_pin->act, 1);
		else
			led_set_pwm(2, 100, 22000, !led_gpio_pin->act, 1);
	}

	gpio_re_enabled(led_gpio_pin->gpiono);

	return 0;
}

static void logo_led_release(struct device *device)
{
    return;
}


static struct gpio_led logo_leds[] = {
	{
		.name			= "genesis-led",
		.default_trigger	= "logoled",
	},
};

static struct gpio_led_platform_data lcd_backlight_data = {
	.leds		= logo_leds,
	.num_leds	= ARRAY_SIZE(logo_leds),
};

static struct platform_device logo_led_device = {
	.name           = "genesis-led",
	.id             = 0,
	.dev			= {
		.platform_data = &lcd_backlight_data,
		.release = logo_led_release,
	},
};

static struct platform_driver logo_led_driver = {
	.probe		= logo_led_probe,
	.remove		= __devexit_p(logo_led_remove),
	.suspend    = logo_led_suspend,
	.resume     = logo_led_resume,
	.driver		= {
		.name	= "genesis-led",
		.owner	= THIS_MODULE,
	},
};

static int __init logo_led_init(void)
{
	int ret;

	ret = platform_device_register(&logo_led_device);
	if(ret) {
		pr_err("Can not register logo led device\n");
		return ret;
	}

	ret = platform_driver_register(&logo_led_driver);
	if(ret) {
		pr_err("Can not register logo led driver\n");
		platform_device_unregister(&logo_led_device);
		return ret;
	}

	return 0;
}

static void __exit logo_led_exit(void)
{
	platform_driver_unregister(&logo_led_driver);
	platform_device_unregister(&logo_led_device);
}

module_init(logo_led_init);
module_exit(logo_led_exit);

MODULE_AUTHOR("WMT ShenZhen Driver Team");
MODULE_DESCRIPTION("LOGO LED driver");
MODULE_LICENSE("GPL");