| /* |
| * linux/arch/arm/mach-omap/leds-h2p2-debug.c |
| * |
| * Copyright 2003 by Texas Instruments Incorporated |
| * |
| */ |
| #include <linux/config.h> |
| #include <linux/init.h> |
| #include <linux/kernel_stat.h> |
| #include <linux/sched.h> |
| #include <linux/version.h> |
| |
| #include <asm/io.h> |
| #include <asm/hardware.h> |
| #include <asm/leds.h> |
| #include <asm/system.h> |
| |
| #include <asm/arch/fpga.h> |
| |
| #include "leds.h" |
| |
| void h2p2_dbg_leds_event(led_event_t evt) |
| { |
| unsigned long flags; |
| static unsigned long hw_led_state = 0; |
| |
| local_irq_save(flags); |
| |
| switch (evt) { |
| case led_start: |
| hw_led_state |= H2P2_DBG_FPGA_LED_STARTSTOP; |
| break; |
| |
| case led_stop: |
| hw_led_state &= ~H2P2_DBG_FPGA_LED_STARTSTOP; |
| break; |
| |
| case led_claim: |
| hw_led_state |= H2P2_DBG_FPGA_LED_CLAIMRELEASE; |
| break; |
| |
| case led_release: |
| hw_led_state &= ~H2P2_DBG_FPGA_LED_CLAIMRELEASE; |
| break; |
| |
| #ifdef CONFIG_LEDS_TIMER |
| case led_timer: |
| /* |
| * Toggle Timer LED |
| */ |
| if (hw_led_state & H2P2_DBG_FPGA_LED_TIMER) |
| hw_led_state &= ~H2P2_DBG_FPGA_LED_TIMER; |
| else |
| hw_led_state |= H2P2_DBG_FPGA_LED_TIMER; |
| break; |
| #endif |
| |
| #ifdef CONFIG_LEDS_CPU |
| case led_idle_start: |
| hw_led_state |= H2P2_DBG_FPGA_LED_IDLE; |
| break; |
| |
| case led_idle_end: |
| hw_led_state &= ~H2P2_DBG_FPGA_LED_IDLE; |
| break; |
| #endif |
| |
| case led_halted: |
| if (hw_led_state & H2P2_DBG_FPGA_LED_HALTED) |
| hw_led_state &= ~H2P2_DBG_FPGA_LED_HALTED; |
| else |
| hw_led_state |= H2P2_DBG_FPGA_LED_HALTED; |
| break; |
| |
| case led_green_on: |
| break; |
| |
| case led_green_off: |
| break; |
| |
| case led_amber_on: |
| break; |
| |
| case led_amber_off: |
| break; |
| |
| case led_red_on: |
| break; |
| |
| case led_red_off: |
| break; |
| |
| default: |
| break; |
| } |
| |
| |
| /* |
| * Actually burn the LEDs |
| */ |
| __raw_writew(~hw_led_state & 0xffff, H2P2_DBG_FPGA_LEDS); |
| |
| local_irq_restore(flags); |
| } |