prism: mux'ed led pins to gpios in 'leds' diag.
GE LEDs are mux'ed to the LED function, but the 'leds' diag needs them to be
mux'ed to the GPIO function.
GPIO function is 0.
Change-Id: Ie97a72fe7f69d7561d3403941c897b559ba4d3e7
diff --git a/board/mv_feroceon/mv_kw2/prism_cmd.c b/board/mv_feroceon/mv_kw2/prism_cmd.c
index b3ee087..324ee1c 100644
--- a/board/mv_feroceon/mv_kw2/prism_cmd.c
+++ b/board/mv_feroceon/mv_kw2/prism_cmd.c
@@ -566,6 +566,15 @@
}
}
+static void mux_led(MV_U8 mpp)
+{
+ MV_U32 reg = mvCtrlMppRegGet(mpp / 8);
+ MV_U32 val = MV_REG_READ(reg);
+
+ val &= ~(0xf << ((mpp % 8) * 4));
+ MV_REG_WRITE(reg, val);
+}
+
static int do_prism_diag_leds(int level, int argc, char *argv[])
{
int hz = 1;
@@ -607,9 +616,11 @@
&& (!name || (gpp->name && !strcmp(name, gpp->name)))) {
if (mode == LEDS_MODE_LIST)
printf("%s\n", gpp->name);
- else
+ else {
+ mux_led(gpp->gppPinNum);
config_led(gpp->gppPinNum, !gpp->activeLow,
mode, hz);
+ }
}
}
