[deliverable/linux.git] / arch / arm / mach-omap1 / leds-h2p2-debug.c

/*
 * linux/arch/arm/mach-omap1/leds-h2p2-debug.c
 *
 * Copyright 2003 by Texas Instruments Incorporated
 *
 * There are 16 LEDs on the debug board (all green); four may be used
 * for logical 'green', 'amber', 'red', and 'blue' (after "claiming").
 *
 * The "surfer" expansion board and H2 sample board also have two-color
 * green+red LEDs (in parallel), used here for timer and idle indicators.
 */
#include <linux/gpio.h>
#include <linux/init.h>
#include <linux/kernel_stat.h>
#include <linux/sched.h>
#include <linux/io.h>
#include <linux/platform_data/gpio-omap.h>

#include <mach/hardware.h>
#include <asm/leds.h>
#include <asm/mach-types.h>

#include <plat/fpga.h>

#include "leds.h"


#define GPIO_LED_RED		3
#define GPIO_LED_GREEN		OMAP_MPUIO(4)


#define LED_STATE_ENABLED	0x01
#define LED_STATE_CLAIMED	0x02
#define LED_TIMER_ON		0x04

#define GPIO_IDLE		GPIO_LED_GREEN
#define GPIO_TIMER		GPIO_LED_RED


void h2p2_dbg_leds_event(led_event_t evt)
{
	unsigned long flags;

	static struct h2p2_dbg_fpga __iomem *fpga;
	static u16 led_state, hw_led_state;

	local_irq_save(flags);

	if (!(led_state & LED_STATE_ENABLED) && evt != led_start)
		goto done;

	switch (evt) {
	case led_start:
		if (!fpga)
			fpga = ioremap(H2P2_DBG_FPGA_START,
						H2P2_DBG_FPGA_SIZE);
		if (fpga) {
			led_state |= LED_STATE_ENABLED;
			__raw_writew(~0, &fpga->leds);
		}
		break;

	case led_stop:
	case led_halted:
		/* all leds off during suspend or shutdown */

		if (! machine_is_omap_perseus2()) {
			gpio_set_value(GPIO_TIMER, 0);
			gpio_set_value(GPIO_IDLE, 0);
		}

		led_state &= ~LED_STATE_ENABLED;
		if (fpga) {
			__raw_writew(~0, &fpga->leds);
			if (evt == led_halted) {
				iounmap(fpga);
				fpga = NULL;
			}
		}

		goto done;

	case led_claim:
		led_state |= LED_STATE_CLAIMED;
		hw_led_state = 0;
		break;

	case led_release:
		led_state &= ~LED_STATE_CLAIMED;
		break;

#ifdef CONFIG_LEDS_TIMER
	case led_timer:
		led_state ^= LED_TIMER_ON;

		if (machine_is_omap_perseus2())
			hw_led_state ^= H2P2_DBG_FPGA_P2_LED_TIMER;
		else {
			gpio_set_value(GPIO_TIMER, led_state & LED_TIMER_ON);
			goto done;
		}

		break;
#endif

#ifdef CONFIG_LEDS_CPU
	case led_idle_start:
		if (machine_is_omap_perseus2())
			hw_led_state |= H2P2_DBG_FPGA_P2_LED_IDLE;
		else {
			gpio_set_value(GPIO_IDLE, 1);
			goto done;
		}

		break;

	case led_idle_end:
		if (machine_is_omap_perseus2())
			hw_led_state &= ~H2P2_DBG_FPGA_P2_LED_IDLE;
		else {
			gpio_set_value(GPIO_IDLE, 0);
			goto done;
		}

		break;
#endif

	case led_green_on:
		hw_led_state |= H2P2_DBG_FPGA_LED_GREEN;
		break;
	case led_green_off:
		hw_led_state &= ~H2P2_DBG_FPGA_LED_GREEN;
		break;

	case led_amber_on:
		hw_led_state |= H2P2_DBG_FPGA_LED_AMBER;
		break;
	case led_amber_off:
		hw_led_state &= ~H2P2_DBG_FPGA_LED_AMBER;
		break;

	case led_red_on:
		hw_led_state |= H2P2_DBG_FPGA_LED_RED;
		break;
	case led_red_off:
		hw_led_state &= ~H2P2_DBG_FPGA_LED_RED;
		break;

	case led_blue_on:
		hw_led_state |= H2P2_DBG_FPGA_LED_BLUE;
		break;
	case led_blue_off:
		hw_led_state &= ~H2P2_DBG_FPGA_LED_BLUE;
		break;

	default:
		break;
	}


	/*
	 *  Actually burn the LEDs
	 */
	if (led_state & LED_STATE_ENABLED && fpga)
		__raw_writew(~hw_led_state, &fpga->leds);

done:
	local_irq_restore(flags);
}
Commit	Line	Data
1da177e4	1	/*
7c38cf02	2	* linux/arch/arm/mach-omap1/leds-h2p2-debug.c
1da177e4 LT	3	*
	4	* Copyright 2003 by Texas Instruments Incorporated
	5	*
	6	* There are 16 LEDs on the debug board (all green); four may be used
	7	* for logical 'green', 'amber', 'red', and 'blue' (after "claiming").
	8	*
	9	* The "surfer" expansion board and H2 sample board also have two-color
	10	* green+red LEDs (in parallel), used here for timer and idle indicators.
	11	*/
2f8163ba	12	#include <linux/gpio.h>
1da177e4 LT	13	#include <linux/init.h>
	14	#include <linux/kernel_stat.h>
	15	#include <linux/sched.h>
fced80c7	16	#include <linux/io.h>
4b25408f	17	#include <linux/platform_data/gpio-omap.h>
1da177e4	18
a09e64fb	19	#include <mach/hardware.h>
1da177e4	20	#include <asm/leds.h>
3179a019	21	#include <asm/mach-types.h>
1da177e4	22
ce491cf8	23	#include <plat/fpga.h>
1da177e4 LT	24
	25	#include "leds.h"
	26
	27
	28	#define GPIO_LED_RED 3
	29	#define GPIO_LED_GREEN OMAP_MPUIO(4)
	30
	31
	32	#define LED_STATE_ENABLED 0x01
	33	#define LED_STATE_CLAIMED 0x02
	34	#define LED_TIMER_ON 0x04
	35
	36	#define GPIO_IDLE GPIO_LED_GREEN
	37	#define GPIO_TIMER GPIO_LED_RED
	38
	39
	40	void h2p2_dbg_leds_event(led_event_t evt)
	41	{
	42	unsigned long flags;
	43
	44	static struct h2p2_dbg_fpga __iomem *fpga;
	45	static u16 led_state, hw_led_state;
	46
	47	local_irq_save(flags);
	48
	49	if (!(led_state & LED_STATE_ENABLED) && evt != led_start)
	50	goto done;
	51
	52	switch (evt) {
	53	case led_start:
	54	if (!fpga)
	55	fpga = ioremap(H2P2_DBG_FPGA_START,
	56	H2P2_DBG_FPGA_SIZE);
	57	if (fpga) {
	58	led_state \|= LED_STATE_ENABLED;
	59	__raw_writew(~0, &fpga->leds);
	60	}
	61	break;
	62
	63	case led_stop:
	64	case led_halted:
	65	/* all leds off during suspend or shutdown */
3179a019 TL	66
3179a019 TL	67	if (! machine_is_omap_perseus2()) {
0b84b5ca DB	68	gpio_set_value(GPIO_TIMER, 0);
0b84b5ca DB	69	gpio_set_value(GPIO_IDLE, 0);
3179a019 TL	70	}
3179a019 TL	71
1da177e4	72	led_state &= ~LED_STATE_ENABLED;
a032d33b PW	73	if (fpga) {
	74	__raw_writew(~0, &fpga->leds);
	75	if (evt == led_halted) {
	76	iounmap(fpga);
	77	fpga = NULL;
	78	}
1da177e4	79	}
3179a019	80
1da177e4 LT	81	goto done;
	82
	83	case led_claim:
	84	led_state \|= LED_STATE_CLAIMED;
	85	hw_led_state = 0;
	86	break;
	87
	88	case led_release:
	89	led_state &= ~LED_STATE_CLAIMED;
	90	break;
	91
	92	#ifdef CONFIG_LEDS_TIMER
	93	case led_timer:
	94	led_state ^= LED_TIMER_ON;
3179a019 TL	95
	96	if (machine_is_omap_perseus2())
	97	hw_led_state ^= H2P2_DBG_FPGA_P2_LED_TIMER;
	98	else {
0b84b5ca	99	gpio_set_value(GPIO_TIMER, led_state & LED_TIMER_ON);
3179a019 TL	100	goto done;
	101	}
	102
	103	break;
1da177e4 LT	104	#endif
	105
	106	#ifdef CONFIG_LEDS_CPU
	107	case led_idle_start:
3179a019 TL	108	if (machine_is_omap_perseus2())
	109	hw_led_state \|= H2P2_DBG_FPGA_P2_LED_IDLE;
	110	else {
0b84b5ca	111	gpio_set_value(GPIO_IDLE, 1);
3179a019 TL	112	goto done;
	113	}
	114
	115	break;
1da177e4 LT	116
1da177e4 LT	117	case led_idle_end:
3179a019 TL	118	if (machine_is_omap_perseus2())
	119	hw_led_state &= ~H2P2_DBG_FPGA_P2_LED_IDLE;
	120	else {
0b84b5ca	121	gpio_set_value(GPIO_IDLE, 0);
3179a019 TL	122	goto done;
	123	}
	124
	125	break;
1da177e4 LT	126	#endif
	127
	128	case led_green_on:
	129	hw_led_state \|= H2P2_DBG_FPGA_LED_GREEN;
	130	break;
	131	case led_green_off:
	132	hw_led_state &= ~H2P2_DBG_FPGA_LED_GREEN;
	133	break;
	134
	135	case led_amber_on:
	136	hw_led_state \|= H2P2_DBG_FPGA_LED_AMBER;
	137	break;
	138	case led_amber_off:
	139	hw_led_state &= ~H2P2_DBG_FPGA_LED_AMBER;
	140	break;
	141
	142	case led_red_on:
	143	hw_led_state \|= H2P2_DBG_FPGA_LED_RED;
	144	break;
	145	case led_red_off:
	146	hw_led_state &= ~H2P2_DBG_FPGA_LED_RED;
	147	break;
	148
	149	case led_blue_on:
	150	hw_led_state \|= H2P2_DBG_FPGA_LED_BLUE;
	151	break;
	152	case led_blue_off:
	153	hw_led_state &= ~H2P2_DBG_FPGA_LED_BLUE;
	154	break;
	155
	156	default:
	157	break;
	158	}
	159
	160
	161	/*
	162	* Actually burn the LEDs
	163	*/
a032d33b	164	if (led_state & LED_STATE_ENABLED && fpga)
1da177e4 LT	165	__raw_writew(~hw_led_state, &fpga->leds);
	166
	167	done:
	168	local_irq_restore(flags);
	169	}