mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-19 08:28:51 +09:00
57 lines
1.4 KiB
C
57 lines
1.4 KiB
C
/*
|
|
* U-boot - status leds
|
|
*
|
|
* Copyright (c) 2005-2009 Analog Devices Inc.
|
|
*
|
|
* Licensed under the GPL-2 or later.
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <config.h>
|
|
#include <command.h>
|
|
#include <status_led.h>
|
|
|
|
static void set_led_f(int pf, int state)
|
|
{
|
|
switch (state) {
|
|
case STATUS_LED_OFF: bfin_write_PORTFIO_CLEAR(pf); break;
|
|
case STATUS_LED_BLINKING: bfin_write_PORTFIO_TOGGLE(pf); break;
|
|
case STATUS_LED_ON: bfin_write_PORTFIO_SET(pf); break;
|
|
}
|
|
}
|
|
static void set_led_g(int pf, int state)
|
|
{
|
|
switch (state) {
|
|
case STATUS_LED_OFF: bfin_write_PORTGIO_CLEAR(pf); break;
|
|
case STATUS_LED_BLINKING: bfin_write_PORTGIO_TOGGLE(pf); break;
|
|
case STATUS_LED_ON: bfin_write_PORTGIO_SET(pf); break;
|
|
}
|
|
}
|
|
|
|
static void set_leds(led_id_t mask, int state)
|
|
{
|
|
if (mask & 0x1) set_led_f(PF8, state);
|
|
if (mask & 0x2) set_led_g(PG11, state);
|
|
if (mask & 0x4) set_led_g(PG12, state);
|
|
}
|
|
|
|
void __led_init(led_id_t mask, int state)
|
|
{
|
|
bfin_write_PORTF_FER(bfin_read_PORTF_FER() & ~(PF8));
|
|
bfin_write_PORTG_FER(bfin_read_PORTG_FER() & ~(PG11 | PG12));
|
|
bfin_write_PORTFIO_INEN(bfin_read_PORTFIO_INEN() & ~(PF8));
|
|
bfin_write_PORTGIO_INEN(bfin_read_PORTGIO_INEN() & ~(PG11 | PG12));
|
|
bfin_write_PORTFIO_DIR(bfin_read_PORTFIO_DIR() | (PF8));
|
|
bfin_write_PORTGIO_DIR(bfin_read_PORTGIO_DIR() | (PG11 | PG12));
|
|
}
|
|
|
|
void __led_set(led_id_t mask, int state)
|
|
{
|
|
set_leds(mask, state);
|
|
}
|
|
|
|
void __led_toggle(led_id_t mask)
|
|
{
|
|
set_leds(mask, STATUS_LED_BLINKING);
|
|
}
|