leds: add driver for the iPAQ micro (4da498fc) · Commits · e / devices / android_kernel_fairphone_FP3

drivers/leds/Kconfig

+7 −0

Original line number	Diff line number	Diff line
		@@ -143,6 +143,13 @@ config LEDS_SUNFIRE
		This option enables support for the Left, Middle, and Right
		LEDs on the I/O and CPU boards of SunFire UltraSPARC servers.

		config LEDS_IPAQ_MICRO
		tristate "LED Support for the Compaq iPAQ h3xxx"
		depends on MFD_IPAQ_MICRO
		help
		Choose this option if you want to use the notification LED on
		Compaq/HP iPAQ h3100 and h3600.

		config LEDS_HP6XX
		tristate "LED Support for the HP Jornada 6xx"
		depends on LEDS_CLASS

drivers/leds/Makefile

+1 −0

Original line number	Diff line number	Diff line
		@@ -31,6 +31,7 @@ obj-$(CONFIG_LEDS_LP8501) += leds-lp8501.o
		obj-$(CONFIG_LEDS_LP8788) += leds-lp8788.o
		obj-$(CONFIG_LEDS_TCA6507) += leds-tca6507.o
		obj-$(CONFIG_LEDS_CLEVO_MAIL) += leds-clevo-mail.o
		obj-$(CONFIG_LEDS_IPAQ_MICRO) += leds-ipaq-micro.o
		obj-$(CONFIG_LEDS_HP6XX) += leds-hp6xx.o
		obj-$(CONFIG_LEDS_OT200) += leds-ot200.o
		obj-$(CONFIG_LEDS_FSG) += leds-fsg.o

drivers/leds/leds-ipaq-micro.c

0 → 100644

+141 −0

Original line number	Diff line number	Diff line
		/*
		* 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.
		*
		* h3xxx atmel micro companion support, notification LED subdevice
		*
		* Author : Linus Walleij <linus.walleij@linaro.org>
		*/

		#include <linux/module.h>
		#include <linux/platform_device.h>
		#include <linux/mfd/ipaq-micro.h>
		#include <linux/leds.h>

		#define LED_YELLOW 0x00
		#define LED_GREEN 0x01

		#define LED_EN (1 << 4) /* LED ON/OFF 0:off, 1:on */
		#define LED_AUTOSTOP (1 << 5) /* LED ON/OFF auto stop set 0:disable, 1:enable */
		#define LED_ALWAYS (1 << 6) /* LED Interrupt Mask 0:No mask, 1:mask */

		static void micro_leds_brightness_set(struct led_classdev *led_cdev,
		enum led_brightness value)
		{
		struct ipaq_micro *micro = dev_get_drvdata(led_cdev->dev->parent->parent);
		/*
		* In this message:
		* Byte 0 = LED color: 0 = yellow, 1 = green
		* yellow LED is always ~30 blinks per minute
		* Byte 1 = duration (flags?) appears to be ignored
		* Byte 2 = green ontime in 1/10 sec (deciseconds)
		* 1 = 1/10 second
		* 0 = 256/10 second
		* Byte 3 = green offtime in 1/10 sec (deciseconds)
		* 1 = 1/10 second
		* 0 = 256/10 seconds
		*/
		struct ipaq_micro_msg msg = {
		.id = MSG_NOTIFY_LED,
		.tx_len = 4,
		};

		msg.tx_data[0] = LED_GREEN;
		msg.tx_data[1] = 0;
		if (value) {
		msg.tx_data[2] = 0; /* Duty cycle 256 */
		msg.tx_data[3] = 1;
		} else {
		msg.tx_data[2] = 1;
		msg.tx_data[3] = 0; /* Duty cycle 256 */
		}
		ipaq_micro_tx_msg_sync(micro, &msg);
		}

		/* Maximum duty cycle in ms 256/10 sec = 25600 ms */
		#define IPAQ_LED_MAX_DUTY 25600

		static int micro_leds_blink_set(struct led_classdev *led_cdev,
		unsigned long *delay_on,
		unsigned long *delay_off)
		{
		struct ipaq_micro *micro = dev_get_drvdata(led_cdev->dev->parent->parent);
		/*
		* In this message:
		* Byte 0 = LED color: 0 = yellow, 1 = green
		* yellow LED is always ~30 blinks per minute
		* Byte 1 = duration (flags?) appears to be ignored
		* Byte 2 = green ontime in 1/10 sec (deciseconds)
		* 1 = 1/10 second
		* 0 = 256/10 second
		* Byte 3 = green offtime in 1/10 sec (deciseconds)
		* 1 = 1/10 second
		* 0 = 256/10 seconds
		*/
		struct ipaq_micro_msg msg = {
		.id = MSG_NOTIFY_LED,
		.tx_len = 4,
		};

		msg.tx_data[0] = LED_GREEN;
		if (*delay_on > IPAQ_LED_MAX_DUTY \|\|
		*delay_off > IPAQ_LED_MAX_DUTY)
		return -EINVAL;

		if (delay_on == 0 && delay_off == 0) {
		*delay_on = 100;
		*delay_off = 100;
		}

		msg.tx_data[1] = 0;
		if (*delay_on >= IPAQ_LED_MAX_DUTY)
		msg.tx_data[2] = 0;
		else
		msg.tx_data[2] = (u8) DIV_ROUND_CLOSEST(*delay_on, 100);
		if (*delay_off >= IPAQ_LED_MAX_DUTY)
		msg.tx_data[3] = 0;
		else
		msg.tx_data[3] = (u8) DIV_ROUND_CLOSEST(*delay_off, 100);
		return ipaq_micro_tx_msg_sync(micro, &msg);
		}

		static struct led_classdev micro_led = {
		.name = "led-ipaq-micro",
		.brightness_set = micro_leds_brightness_set,
		.blink_set = micro_leds_blink_set,
		.flags = LED_CORE_SUSPENDRESUME,
		};

		static int micro_leds_probe(struct platform_device *pdev)
		{
		int ret;

		ret = led_classdev_register(&pdev->dev, &micro_led);
		if (ret) {
		dev_err(&pdev->dev, "registering led failed: %d\n", ret);
		return ret;
		}
		dev_info(&pdev->dev, "iPAQ micro notification LED driver\n");

		return 0;
		}

		static int micro_leds_remove(struct platform_device *pdev)
		{
		led_classdev_unregister(&micro_led);
		return 0;
		}

		struct platform_driver micro_leds_device_driver = {
		.driver = {
		.name = "ipaq-micro-leds",
		},
		.probe = micro_leds_probe,
		.remove = micro_leds_remove,
		};
		module_platform_driver(micro_leds_device_driver);

		MODULE_LICENSE("GPL");
		MODULE_DESCRIPTION("driver for iPAQ Atmel micro leds");
		MODULE_ALIAS("platform:ipaq-micro-leds");