pistachio: marduk: Switch on heartbeat LED

Signed-off-by: Francois Berder <[email protected]>

Author: francois-berder

board/imgtec/pistachio_bub/mfio.c

@@ -103,16 +103,22 @@ static struct pistachio_mfio_reg pistachio_mfio_regs[] =
 	{MFIO_89_FUNC_SEL_START, MFIO_89_FUNC_SEL_END},
 };
 
+static void pistachio_select_gpio(u32 mfio, bool output)
+{
+	u32 reg, val;
+	reg = PISTACHIO_GPIO + 0x204 + (((mfio) / 16) * 0x24);
+	val = 0x10000 | ((output) ? (1) : (0));
+	val <<= (mfio % 16);
+	__raw_writel(val, reg);
+}
+
 static void pistachio_select_gpio_input(u32 mfio, bool gpio)
 {
 	u32 reg, val;
 
-	if(gpio)
-	{
-	/* make GPIO input */
-		reg = PISTACHIO_GPIO + 0x204 + (((mfio) / 16) * 0x24);
-		val = 0x10000 << (mfio % 16);
-		__raw_writel(val, reg);
+	if (gpio) {
+		/* make GPIO input */
+		pistachio_select_gpio(mfio, 0);
 	}
 
 	reg = PISTACHIO_GPIO + 0x200 + (((mfio) / 16) * 0x24);
@@ -308,3 +314,23 @@ void mfio_setup_usb_pwr(void)
 	__raw_writel(val, USBPHYCONTROL0_ADDR);
 }
 #endif
+
+#if defined(CONFIG_TARGET_PISTACHIO_MARDUK)
+/*
+ * On Marduk, gpio 76 controls the heartbeat led.
+ * This function configures it as an output and sets it to 1.
+ */
+void mfio_setup_led(void)
+{
+	u32 reg, val;
+
+	/* make GPIO output */
+	pistachio_select_gpio(76, 1);
+
+	/* Switch on LED */
+	reg = PISTACHIO_GPIO + 0x208 + (((76) / 16) * 0x24);
+	val = 0x10001;
+	val <<= (76 % 16);
+	__raw_writel(val, reg);
+}
+#endif

board/imgtec/pistachio_bub/mfio.h

@@ -185,3 +185,7 @@ void mfio_setup_i2c(u8 interface);
 	defined(CONFIG_TARGET_PISTACHIO_BEETLE)
 void mfio_setup_usb_pwr(void);
 #endif
+
+#if defined(CONFIG_TARGET_PISTACHIO_MARDUK)
+void mfio_setup_led(void);
+#endif

board/imgtec/pistachio_bub/spl_pistachio.c

@@ -65,6 +65,11 @@ void spl_lowlevel_init(void) {
 	 */
 	setup_clk_gate_defaults();
 
+#if defined(CONFIG_TARGET_PISTACHIO_MARDUK)
+	/* Setup LED */
+	mfio_setup_led();
+#endif
+
 	/* Setup SPIM1 MFIOs */
 	mfio_setup_spim1();