board: mt7621: enable set unused pins to gpio input mode

Signed-off-by: Shiji Yang <[email protected]>
DragonBluep · May 2, 2023 · ae2062c · ae2062c
1 parent 113bda4
commit ae2062c
Show file tree

Hide file tree

Showing 2 changed files with 52 additions and 0 deletions.
diff --git a/board/ralink/mt7621_nand_rfb/mt7621_nand_rfb.c b/board/ralink/mt7621_nand_rfb/mt7621_nand_rfb.c
@@ -53,9 +53,35 @@ static inline int gpio_input_init(unsigned gpio, const char *label)
 	return 0;
 }
 
+/* Set unused pins to gpio input mode */
+static int pins_unused_init(const int *pinlist, unsigned listsize)
+{
+	int cnt;
+	char label[10] = "";
+
+	for (cnt = 0; cnt < listsize; cnt ++) {
+		if (cnt < 0 || cnt > 48) {
+			printf("unsupported GPIO: gpio#%d", pinlist[cnt]);
+			return -1;
+		}
+
+		strcpy(label, "gpio#");
+		strcat(label, simple_itoa(pinlist[cnt]));
+		gpio_input_init(pinlist[cnt], label);
+	}
+
+	return 0;
+}
+
 #ifdef CONFIG_LAST_STAGE_INIT
 int last_stage_init(void)
 {
+	#define MT7621_UNUSED_PIN_LIST {}
+
+	int pinlist[] = MT7621_UNUSED_PIN_LIST;
+
+	pins_unused_init(pinlist, sizeof(pinlist)/sizeof(int));
+
 	return 0;
 }
 #endif // CONFIG_LAST_STAGE_INIT

diff --git a/board/ralink/mt7621_rfb/mt7621_rfb.c b/board/ralink/mt7621_rfb/mt7621_rfb.c
@@ -47,9 +47,35 @@ static inline int gpio_input_init(unsigned gpio, const char *label)
 	return 0;
 }
 
+/* Set unused pins to gpio input mode */
+static int pins_unused_init(const int *pinlist, unsigned listsize)
+{
+	int cnt;
+	char label[10] = "";
+
+	for (cnt = 0; cnt < listsize; cnt ++) {
+		if (cnt < 0 || cnt > 48) {
+			printf("unsupported GPIO: gpio#%d", pinlist[cnt]);
+			return -1;
+		}
+
+		strcpy(label, "gpio#");
+		strcat(label, simple_itoa(pinlist[cnt]));
+		gpio_input_init(pinlist[cnt], label);
+	}
+
+	return 0;
+}
+
 #ifdef CONFIG_LAST_STAGE_INIT
 int last_stage_init(void)
 {
+	#define MT7621_UNUSED_PIN_LIST {}
+
+	int pinlist[] = MT7621_UNUSED_PIN_LIST;
+
+	pins_unused_init(pinlist, sizeof(pinlist)/sizeof(int));
+
 	return 0;
 }
 #endif // CONFIG_LAST_STAGE_INIT