[ARM] 4981/1: [KS8695] Simple LED driver (fdb72fd8) · Commits · 戴 / test

arch/arm/mach-ks8695/Makefile

+3 −0

Original line number	Diff line number	Diff line
		@@ -11,5 +11,8 @@ obj- :=
		# PCI support is optional
		obj-$(CONFIG_PCI) += pci.o

		# LEDs
		obj-$(CONFIG_LEDS) += leds.o

		# Board-specific support
		obj-$(CONFIG_MACH_KS8695) += board-micrel.o

arch/arm/mach-ks8695/devices.c

+21 −0

Original line number	Diff line number	Diff line
		@@ -176,6 +176,27 @@ static void __init ks8695_add_device_watchdog(void) {}
		#endif


		/* --------------------------------------------------------------------
		* LEDs
		* -------------------------------------------------------------------- */

		#if defined(CONFIG_LEDS)
		short ks8695_leds_cpu = -1;
		short ks8695_leds_timer = -1;

		void __init ks8695_init_leds(u8 cpu_led, u8 timer_led)
		{
		/* Enable GPIO to access the LEDs */
		gpio_direction_output(cpu_led, 1);
		gpio_direction_output(timer_led, 1);

		ks8695_leds_cpu = cpu_led;
		ks8695_leds_timer = timer_led;
		}
		#else
		void __init ks8695_init_leds(u8 cpu_led, u8 timer_led) {}
		#endif

		/* -------------------------------------------------------------------- */

		/*

arch/arm/mach-ks8695/leds.c

0 → 100644

+94 −0

Original line number	Diff line number	Diff line
		/*
		* LED driver for KS8695-based boards.
		*
		* Copyright (C) Andrew Victor
		*
		* 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/module.h>
		#include <linux/init.h>

		#include <asm/mach-types.h>
		#include <asm/leds.h>
		#include <asm/arch/devices.h>
		#include <asm/arch/gpio.h>


		static inline void ks8695_led_on(unsigned int led)
		{
		gpio_set_value(led, 0);
		}

		static inline void ks8695_led_off(unsigned int led)
		{
		gpio_set_value(led, 1);
		}

		static inline void ks8695_led_toggle(unsigned int led)
		{
		unsigned long is_off = gpio_get_value(led);
		if (is_off)
		ks8695_led_on(led);
		else
		ks8695_led_off(led);
		}


		/*
		* Handle LED events.
		*/
		static void ks8695_leds_event(led_event_t evt)
		{
		unsigned long flags;

		local_irq_save(flags);

		switch(evt) {
		case led_start: /* System startup */
		ks8695_led_on(ks8695_leds_cpu);
		break;

		case led_stop: /* System stop / suspend */
		ks8695_led_off(ks8695_leds_cpu);
		break;

		#ifdef CONFIG_LEDS_TIMER
		case led_timer: /* Every 50 timer ticks */
		ks8695_led_toggle(ks8695_leds_timer);
		break;
		#endif

		#ifdef CONFIG_LEDS_CPU
		case led_idle_start: /* Entering idle state */
		ks8695_led_off(ks8695_leds_cpu);
		break;

		case led_idle_end: /* Exit idle state */
		ks8695_led_on(ks8695_leds_cpu);
		break;
		#endif

		default:
		break;
		}

		local_irq_restore(flags);
		}


		static int __init leds_init(void)
		{
		if ((ks8695_leds_timer == -1) \|\| (ks8695_leds_cpu == -1))
		return -ENODEV;

		leds_event = ks8695_leds_event;

		leds_event(led_start);
		return 0;
		}

		__initcall(leds_init);

include/asm-arm/arch-ks8695/devices.h

+5 −0

Original line number	Diff line number	Diff line
		@@ -18,6 +18,11 @@ extern void __init ks8695_add_device_wan(void);
		extern void __init ks8695_add_device_lan(void);
		extern void __init ks8695_add_device_hpna(void);

		/* LEDs */
		extern short ks8695_leds_cpu;
		extern short ks8695_leds_timer;
		extern void __init ks8695_init_leds(u8 cpu_led, u8 timer_led);

		/* PCI */
		#define KS8695_MODE_PCI 0
		#define KS8695_MODE_MINIPCI 1

Admin message