marquis.c

来自「Boot code for ADM5120 with serial consol」· C语言 代码 · 共 52 行

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

int ultoa(unsigned long, char *);
void buart_print(char *);

void main()
{
	int c, port, ledno;
	char buf[16];

	while (1) {
		buart_print("\r\nEnter LED port (0..4): ");
		c = buart_getchar();
		buart_put(c);
		buart_nl();

		if (c == 'x')
			break;
		else
			port = c - '0';

		/* Check valid range */
		if ((c >= 0x30) && (c < 0x35)) {
			buart_print("Enter LED number (0..2): ");
			c = buart_getchar();
			buart_put(c);
			buart_nl();
			ledno = c - '0';

			/* Check valid range */
			if ((c >= 0x30) && (c < 0x33)) {
				buart_print("Enter state (0, 1 or f): ");
				c = buart_getchar();
				buart_put(c);
				buart_nl();

				/* Check valid range */
				if ((c == '0') || (c == '1') || (c == 'f') || (c == 'F')) {
					if (c == '0')
						control_gpio_led(port, ledno, LED_OFF);
					else if (c == '1')
						control_gpio_led(port, ledno, LED_ON);
					else
						control_gpio_led(port, ledno, LED_FLASH);
				}
			}
		}
	}
}