*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; version 2 of the License.
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
*
* This program is distributed in the hope that it will be useful, but
* WITHOUT ANY WARRANTY; without even the implied warranty of
uint8_t relay_output;
+void
+ao_relay_init(void)
+{
+ lpc_scb.sysahbclkctrl |= (1 << LPC_SCB_SYSAHBCLKCTRL_GPIO);
+ lpc_gpio.dir[RELAY_PORT] |= RELAY_BIT;
+}
+
// switch relay to selected output, turn correct LED on as a side effect
static void
ao_relay_control(uint8_t output)
{
switch (output) {
case 1:
+ lpc_gpio.pin[RELAY_PORT] |= RELAY_BIT;
ao_led_on(AO_LED_RED);
ao_led_off(AO_LED_GREEN);
break;
default:
+ lpc_gpio.pin[RELAY_PORT] &= ~RELAY_BIT;
ao_led_off(AO_LED_RED);
ao_led_on(AO_LED_GREEN);
}
}
static void
-ao_relay_select(void) __reentrant
+ao_relay_select(void)
{
uint8_t output;
- ao_cmd_decimal();
+ output = ao_cmd_decimal();
if (ao_cmd_status != ao_cmd_success)
return;
- output = ao_cmd_lex_i;
-
- printf ("Relay control not implemented yet, %u selected\n", output);
- ao_relay_control(output);
+ if (output > 1)
+ printf ("Invalid relay position %u\n", output);
+ else
+ ao_relay_control(output);
}
-static __code struct ao_cmds ao_relay_cmds[] = {
+static const struct ao_cmds ao_relay_cmds[] = {
{ ao_relay_select, "R <output>\0Select relay output" },
{ 0, NULL }
};
ao_led_init(LEDS_AVAILABLE);
+ ao_relay_init();
+
// initialize to default output
relay_output = 0;
ao_relay_control(relay_output);