bootmode: initial commit

Let the user (and another use case the failsafe mode) configure the
bootmode.

Signed-off-by: Michael Walle <[email protected]>

Author: mwalle

Makefile

@@ -30,7 +30,7 @@ LIBS += -lgcc
 
 OBJECTS  = startup.o main.o miniprintf.o uart.o systick.o adc.o vref.o misc.o
 OBJECTS += iomux.o sysctl.o gpio.o cp.o i2c.o nvic.o nvm.o config.o wdt.o led.o
-OBJECTS += ticks.o sl28wdt.o
+OBJECTS += ticks.o sl28wdt.o bootmode.o
 
 DEPS := $(shell find -name '*.d')
 

bootmode.c

@@ -0,0 +1,71 @@
+// SPDX-License-Identifier: BSD-2-Clause
+/*
+ * Copyright (c) 2025 Kontron Europe GmbH
+ */
+
+#include "bootmode.h"
+#include "config.h"
+#include "gpio.h"
+#include "misc.h"
+
+#define BOOTMODE_PIN_FAILSAFE	0x0000000c
+#define BOOTMODE_PIN_MASK	0x00c007fc
+
+static unsigned short bootmode;
+
+void bootmode_enable(unsigned short mode)
+{
+	unsigned int mask;
+
+	printf("%s mode=%04x\n", __func__, mode);
+
+	gpio_mask_clr(BOOTMODE_PIN_MASK);
+	/* PA8 .. PA2 */
+	mask  = ((unsigned int)mode >>  1) & 0x000001fc;
+	/* PA23 */
+	mask |= ((unsigned int)mode << 13) & 0x00800000;
+	/* PA22 */
+	mask |= ((unsigned int)mode << 11) & 0x00400000;
+	/* PA10 .. PA9 */
+	mask |= ((unsigned int)mode >>  3) & 0x00000600;
+	gpio_mask_set(mask);
+	gpio_out_mask(BOOTMODE_PIN_MASK);
+}
+
+void bootmode_write(unsigned char offset, unsigned char value)
+{
+	switch (offset) {
+	case 0:
+		bootmode = (bootmode & 0x00ff) | (value << 8);
+		break;
+	case 1:
+		bootmode = (bootmode & 0xff00) | value;
+		bootmode_enable(bootmode);
+		break;
+	}
+}
+
+unsigned char bootmode_read(unsigned char offset)
+{
+	switch (offset) {
+	case 0:
+		return bootmode & 0xff;
+	case 1:
+		return bootmode >> 8;
+	default:
+		return 0xff;
+	}
+}
+
+void bootmode_disable(void)
+{
+	gpio_in_mask(BOOTMODE_PIN_MASK);
+}
+
+void bootmode_init(void)
+{
+	if (config->flags & CFG_F_DRIVE_BOOTMODE)
+		bootmode_enable(config->bootmode);
+	else
+		bootmode_disable();
+}

bootmode.h

@@ -0,0 +1,20 @@
+// SPDX-License-Identifier: BSD-2-Clause
+/*
+ * Copyright (c) 2025 Kontron Europe GmbH
+ */
+
+#ifndef __BOOTMODE_H
+#define __BOOTMODE_H
+
+#define BOOTMODE_FAILSAFE	0x00000018
+
+void bootmode_write(unsigned char offset, unsigned char value);
+unsigned char bootmode_read(unsigned char offset);
+
+void bootmode_enable(unsigned short mode);
+void bootmode_write(unsigned char offset, unsigned char value);
+unsigned char bootmode_read(unsigned char offset);
+void bootmode_disable(void);
+void bootmode_init(void);
+
+#endif /* __BOOTMODE_H */

i2c.c

@@ -4,6 +4,7 @@
  *
  */
 
+#include "bootmode.h"
 #include "config.h"
 #include "gpio.h"
 #include "i2c.h"
@@ -325,6 +326,8 @@ static void i2c_rxdata(unsigned char offset, unsigned char value)
 		return config_write(offset - 0, value);
 	case 4 ... 7:
 		return sl28wdt_write(offset - 4, value);
+	case 16 ... 17:
+		return bootmode_write(offset - 16, value);
 	}
 }
 

main.c

@@ -6,6 +6,7 @@
 #include <stdbool.h>
 #include <stddef.h>
 #include "adc.h"
+#include "bootmode.h"
 #include "config.h"
 #include "cp.h"
 #include "gpio.h"
@@ -49,6 +50,28 @@ const struct iomux_config iomux_default_config[] = {
 	{ 17, PINCM_PC | PINCM17_PF_TIMG0_C0 },
 	/* PA18 (healthy LED) */
 	{ 19, PINCM_PC | PINCM19_PF_TIMG4_C1 },
+	/* PA2 (BOOTMODE03) */
+	{ 3, PINCM_PC | PINCM_PF_GPIO },
+	/* PA3 (BOOTMODE04) */
+	{ 4, PINCM_PC | PINCM_PF_GPIO },
+	/* PA4 (BOOTMODE05) */
+	{ 5, PINCM_PC | PINCM_PF_GPIO },
+	/* PA5 (BOOTMODE06) */
+	{ 6, PINCM_PC | PINCM_PF_GPIO },
+	/* PA6 (BOOTMODE07) */
+	{ 7, PINCM_PC | PINCM_PF_GPIO },
+	/* PA7 (BOOTMODE08) */
+	{ 8, PINCM_PC | PINCM_PF_GPIO },
+	/* PA8 (BOOTMODE09) */
+	{ 9, PINCM_PC | PINCM_PF_GPIO },
+	/* PA23 (BOOTMODE10) */
+	{ 24, PINCM_PC | PINCM_PF_GPIO },
+	/* PA22 (BOOTMODE11) */
+	{ 23, PINCM_PC | PINCM_PF_GPIO },
+	/* PA9 (BOOTMODE12) */
+	{ 10, PINCM_PC | PINCM_PF_GPIO },
+	/* PA10 (BOOTMODE13) */
+	{ 11, PINCM_PC | PINCM_PF_GPIO },
 	{ 0 }
 };
 
@@ -91,6 +114,7 @@ int main(void)
 	i2c_init();
 	wdt_init();
 	led_init();
+	bootmode_init();
 
 	i2c_bus_reset();