gpio_led.c

Boot code for ADM5120 with serial console for Edimax router.

/*****************************************************************************
;
;    Project : Edimax ADM5120
;    Creator : HH
;    File    : gpio_led.c
;    Abstract: Control the LEDs via the GPIO interface and ADM5120 registers
;
;*****************************************************************************/

#include <ctype.h>
#include <mips4kc.h>
#include "gpio_led.h"


void control_gpio_led(int iPort, int iLed, int iState)
{
	unsigned long ledcmd, u;
	char buf[16];
	int i;

	if ((iPort >= 0) && (iPort < 5) && (iLed >= 0) && (iLed < 3)
		&& (iState == LED_OFF || iState == LED_ON || iState == LED_FLASH)) {
		switch (iState) {
			case LED_OFF:
				ledcmd = LED_STATE(iLed, LED_COMMAND_OFF);
				break;
			case LED_ON:
				ledcmd = LED_STATE(iLed, LED_COMMAND_ON);
				break;
			case LED_FLASH:
			default:
				ledcmd = LED_STATE(iLed, LED_COMMAND_FLASH);
				break;
		}

		LED_PORT_REG(iPort) = ledcmd;

//		buart_print("\r\nWrote ");
//		for (i = 0; i < 16; i++) buf[i] = '\0';
//		ultoa(ledcmd, buf);
//		buart_print(buf);
//		u = LED_PORT_REG(iPort);
//		buart_print(" to ");
//		for (i = 0; i < 16; i++) buf[i] = '\0';
//		ultoa(u, buf);
//		buart_print(buf);
	}
}