[rfc] lpc4322: swd using sgpio

Signed-off-by: Adrian Negreanu <[email protected]>
ARMmbed · Dec 7, 2021 · a84162b · a84162b
1 parent 43e7e42
commit a84162b
Show file tree

Hide file tree

Showing 4 changed files with 1,125 additions and 0 deletions.
diff --git a/records/board/mimxrt1170_evk_qspi.yaml b/records/board/mimxrt1170_evk_qspi.yaml
@@ -3,6 +3,7 @@ common:
         - DAPLINK_MIMXRT_TARGET
         - SOFT_RESET=VECTRESET
         - SWO_UART=1
+        - SWDP_SGPIO=1
     sources:
         board:
             - source/board/mimxrt1170_evk.c

diff --git a/source/hic_hal/nxp/lpc4322/DAP_config.h b/source/hic_hal/nxp/lpc4322/DAP_config.h
@@ -300,11 +300,13 @@ __STATIC_FORCEINLINE uint32_t PIN_SWDIO_IN(void)
 */
 __STATIC_FORCEINLINE void     PIN_SWDIO_OUT(uint32_t bit)
 {
+#ifndef SWDP_SGPIO
     if (bit & 0x1) {
         X_SET(SWDIO);
     } else {
         X_CLR(SWDIO);
     }
+#endif
 }
 
 /** SWDIO I/O pin: Switch to Output mode (used in SWD mode only).
@@ -313,8 +315,10 @@ called prior \ref PIN_SWDIO_OUT function calls.
 */
 __STATIC_FORCEINLINE void     PIN_SWDIO_OUT_ENABLE(void)
 {
+#ifndef SWDP_SGPIO
     X_SET(SWDIO_TXE);
     X_DIR_OUT(SWDIO);
+#endif
 }
 
 /** SWDIO I/O pin: Switch to Input mode (used in SWD mode only).
@@ -323,8 +327,10 @@ called prior \ref PIN_SWDIO_IN function calls.
 */
 __STATIC_FORCEINLINE void     PIN_SWDIO_OUT_DISABLE(void)
 {
+#ifndef SWDP_SGPIO
     X_DIR_IN(SWDIO);
     X_CLR(SWDIO_TXE);
+#endif
 }
 
 
@@ -506,11 +512,21 @@ __STATIC_INLINE void DAP_SETUP(void)
 
     while (!(LPC_CCU1->CLK_M4_GPIO_STAT & CCU_CLK_STAT_RUN));
 
+#ifdef SWDP_SGPIO
+    /* Table 186. Pin multiplexing. */
+    /* SWCLK/TCK:  PIN(P1_17)  FUNC6(SGPIO11). TCK_SWCLK. Table 189. */
+    scu_pinmux(1, 17, CLK_OUT, FUNC6);
+    /* SWDIO/TMS:  PIN(P1_6)   FUNC6(SGPIO14). TMS_SWDIO. Table 188. */
+    scu_pinmux(1,  6, INBUF_ENABLE | PUP_DISABLE | SLEWRATE_FAST, FUNC6);
+    /* SWDIO/TXEN: PIN(P1_5)   FUNC6(SGPIO15). TMS_SWDIO_TXEN. */
+    scu_pinmux(1,  5, PUP_DISABLE | SLEWRATE_FAST, FUNC6);
+#else
     /* Configure I/O pins: function number, input buffer enabled,    */
     /*                     no pull-up/down                           */
     scu_pinmux(1, 17, GPIO_NOPULL, FUNC0);   /* SWCLK/TCK: GPIO0[12] */
     scu_pinmux(1,  6, GPIO_NOPULL, FUNC0);   /* SWDIO/TMS: GPIO1[9]  */
     scu_pinmux(1,  5, GPIO_NOPULL, FUNC0);   /* SWDIO_OE:  GPIO1[8]  */
+#endif
 }
 
 /** Reset Target Device with custom specific I/O pin or command sequence.

diff --git a/source/hic_hal/nxp/lpc4322/gpio.c b/source/hic_hal/nxp/lpc4322/gpio.c
@@ -89,6 +89,11 @@ void gpio_init(void)
     X_DIR_IN(SWO);
 #endif
 
+#ifdef SWDP_SGPIO
+    extern void sgpio_init(void);
+    sgpio_init();
+#endif
+
     busy_wait(10000);
 }