X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fcsm84clio-v0.1%2Fao_csm84clio.c;fp=src%2Fcsm84clio-v0.1%2Fao_csm84clio.c;h=e3562afc7a2b8d79de07139e7718f7f00706d7c9;hb=7b24be27f67f95d909d19d767e4ac5376ea670cf;hp=0000000000000000000000000000000000000000;hpb=58d13bd9bd0af42ebb3770038cd531e6ca5e9d30;p=fw%2Faltos

diff --git a/src/csm84clio-v0.1/ao_csm84clio.c b/src/csm84clio-v0.1/ao_csm84clio.c
new file mode 100644
index 00000000..e3562afc
--- /dev/null
+++ b/src/csm84clio-v0.1/ao_csm84clio.c
@@ -0,0 +1,165 @@
+/*
+ * Copyright © 2023 Bdale Garbee <bdale@gag.com>
+ *
+ * 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; 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
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License along
+ * with this program; if not, write to the Free Software Foundation, Inc.,
+ * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
+ */
+
+#include <ao.h>
+
+/*
+ * define the FET outputs
+ */
+
+typedef struct 
+{
+	struct stm_gpio *	port;
+	int			pin;
+} fet;
+
+fet outputs[] = {
+	{&stm_gpioe, 9},	/* step_0 */
+	{&stm_gpioe, 13},	/* step_1 */
+	{&stm_gpiob, 11},	/* step_2 */
+	{&stm_gpioe, 8},	/* step_3 */
+	{&stm_gpioe, 12},	/* step_4 */
+	{&stm_gpioe, 10},	/* step_5 */
+	{&stm_gpioe, 14},	/* step_6 */
+	{&stm_gpiob, 10},	/* step_7 */
+	{&stm_gpioe, 11},	/* step_8 */
+	{&stm_gpioe, 15},	/* step_9 */
+	{&stm_gpioa, 5},	/* step_10 */
+	{&stm_gpioc, 5},	/* step_11 */
+	{&stm_gpioe, 7},	/* step_12 */
+	{&stm_gpioa, 6},	/* step_13 */
+	{&stm_gpiob, 0},	/* step_14 */
+	{&stm_gpioa, 3},	/* step_15 */
+	{&stm_gpioa, 7},	/* step_16 */
+	{&stm_gpiob, 1},	/* step_17 */
+	{&stm_gpioa, 4},	/* step_18 */
+	{&stm_gpioc, 4},	/* step_19 */
+	{&stm_gpioe, 4},	/* step_20 */
+	{&stm_gpioc, 0},	/* step_21 */
+	{&stm_gpioc, 3},	/* step_22 */
+	{&stm_gpioe, 5},	/* step_23 */
+	{&stm_gpioc, 1},	/* step_24 */
+	{&stm_gpioe, 2},	/* step_25 */
+	{&stm_gpioc, 14},	/* step_26 */
+	{&stm_gpioc, 2},	/* step_27 */
+	{&stm_gpioe, 3},	/* step_28 */
+	{&stm_gpioc, 15},	/* step_29 */
+	{&stm_gpiob, 3},	/* step_30 */
+	{&stm_gpiob, 5},	/* step_31 */
+	{&stm_gpiob, 9},	/* step_32 */
+	{&stm_gpiob, 4},	/* step_33 */
+	{&stm_gpiob, 6},	/* step_34 */
+	{&stm_gpiod, 7},	/* step_35 */
+	{&stm_gpiob, 7},	/* step_36 */
+	{&stm_gpioe, 0},	/* step_37 */
+	{&stm_gpiod, 6},	/* step_38 */
+	{&stm_gpiob, 8},	/* step_39 */
+	{&stm_gpioc, 7},	/* step_40 */
+	{&stm_gpiod, 1},	/* step_41 */
+	{&stm_gpiod, 4},	/* step_42 */
+	{&stm_gpioc, 6},	/* step_43 */
+	{&stm_gpiod, 0},	/* step_44 */
+	{&stm_gpioc, 8},	/* step_45 */
+	{&stm_gpiod, 2},	/* step_46 */
+	{&stm_gpiod, 5},	/* step_47 */
+	{&stm_gpioc, 9},	/* step_48 */
+	{&stm_gpiod, 3}};	/* step_49 */
+
+static void
+ao_fet_control(uint32_t output, uint8_t value)
+{
+	/* map output 1-50 to corresponding GPIO port and pin, set to value */
+	ao_gpio_set(outputs[output - 1].port, outputs[output - 1].pin, value);
+}
+
+static void
+ao_fet_init(void)
+{
+	int i;
+
+	/* initialize GPIO outputs and turn them all off */
+	for (i = 0; i < 50; i++) 
+	{
+		ao_enable_output(outputs[i].port, outputs[i].pin, 0);
+	}
+}
+
+static void
+ao_fet_on(void)
+{
+	uint32_t output;
+
+	output = ao_cmd_decimal();
+        if (ao_cmd_status != ao_cmd_success)
+                return;
+	if ((output < 1) || (output > 50))
+		printf ("Invalid FET selection %lu, must be 1..50\n", output);
+	else {
+		ao_fet_control(output, 1);
+		ao_led_on(AO_LED_RED);
+	}
+}
+
+static void
+ao_fet_off(void)
+{
+	uint32_t output;
+
+	output = ao_cmd_decimal();
+        if (ao_cmd_status != ao_cmd_success)
+                return;
+	if ((output < 1) || (output > 50))
+		printf ("Invalid FET selection %lu, must be 1..50\n", output);
+	else {
+		ao_fet_control(output, 0);
+		ao_led_off(AO_LED_RED);
+	}
+}
+
+static const struct ao_cmds ao_fet_cmds[] = {
+	{ ao_fet_on,  "S <output>\0Set (turn on) FET" },
+	{ ao_fet_off, "R <output>\0Reset (turn off) FET" },
+	{ 0, NULL }
+};
+
+int
+main(void)
+{
+	ao_fet_init();		/* turn all outputs off ASAP */
+	ao_clock_init();
+
+	ao_task_init();
+	ao_led_init();
+
+	/* both LEDs on briefly as system test */
+	ao_led_on(LEDS_AVAILABLE);
+
+	ao_serial_init();
+	ao_timer_init();
+	ao_dma_init();
+	ao_adc_init();
+	ao_cmd_init();
+	ao_usb_init();
+
+	ao_cmd_register(ao_fet_cmds);
+
+	/* turn red off, leave green on as a "power indicator" */
+	ao_led_off(AO_LED_RED);
+
+	ao_start_scheduler();
+}