work + update swlink

Author: mean

cross-file/swlink-riscv.ini

@@ -19,8 +19,8 @@ cpu = 'arm'
 endian = 'little'
 
 [project options]
-probe = 'native'
-targets = 'riscv32,riscv64,gd32,rp,ch32v'
+probe = 'swlink'
+targets = 'riscv32,riscv64,gd32,ch32v'
 rtt_support = false
-bmd_bootloader = true
+bmd_bootloader = false
 rvswd_support = true

src/platforms/common/rvswdptap.c

@@ -39,13 +39,22 @@ static bool rv_end_frame(uint32_t *status);
 	{                                                                                    \
 		gpio_clear(SWCLK_PORT, SWCLK_PIN);                                               \
 		for (volatile uint32_t counter = target_clk_divider + 1; counter > 0; --counter) \
-			continue;                                                                    \
+			__asm__("nop");                                                              \
 	}
 #define CLK_ON()                                                                         \
 	{                                                                                    \
 		gpio_set(SWCLK_PORT, SWCLK_PIN);                                                 \
 		for (volatile uint32_t counter = target_clk_divider + 1; counter > 0; --counter) \
-			continue;                                                                    \
+			__asm__("nop");                                                              \
+	}
+
+#define IO_OFF()                           \
+	{                                      \
+		gpio_clear(SWDIO_PORT, SWDIO_PIN); \
+	}
+#define IO_ON()                          \
+	{                                    \
+		gpio_set(SWDIO_PORT, SWDIO_PIN); \
 	}
 
 static void rv_write_nbits(int n, uint32_t value)
@@ -54,7 +63,10 @@ static void rv_write_nbits(int n, uint32_t value)
 	const uint32_t mask = 0x80000000UL;
 	for (int i = 0; i < n; i++) {
 		CLK_OFF();
-		gpio_set_val(SWDIO_PORT, SWDIO_PIN, value & mask);
+		if (value & mask)
+			IO_ON()
+		else
+			IO_OFF();
 		CLK_ON();
 		value <<= 1;
 	}
@@ -63,16 +75,16 @@ static void rv_write_nbits(int n, uint32_t value)
 static void rv_start_bit(void)
 {
 	SWDIO_MODE_DRIVE();
-	gpio_clear(SWDIO_PORT, SWDIO_PIN);
+	IO_OFF();
 }
 
 static void rv_stop_bit(void)
 {
 	CLK_OFF();
 	SWDIO_MODE_DRIVE();
-	gpio_clear(SWDIO_PORT, SWDIO_PIN);
+	IO_OFF();
 	CLK_ON();
-	gpio_set(SWDIO_PORT, SWDIO_PIN);
+	IO_ON();
 }
 
 static uint32_t rv_read_nbits(int n)
@@ -82,7 +94,7 @@ static uint32_t rv_read_nbits(int n)
 	for (int i = 0; i < n; i++) {
 		CLK_OFF();
 		CLK_ON();
-		out = (out << 1) + gpio_get(SWDIO_IN_PORT, SWDIO_IN_PIN); // read bit on rising edge
+		out = (out << 1) + (!!gpio_get(SWDIO_IN_PORT, SWDIO_IN_PIN)); // read bit on rising edge
 	}
 	return out;
 }
@@ -91,13 +103,13 @@ static bool rv_dm_reset(void)
 {
 	// toggle the clock 100 times
 	SWDIO_MODE_DRIVE();
-	gpio_set(SWDIO_PORT, SWDIO_PIN);
+	IO_ON();
 	for (int i = 0; i < 5; i++) // 100 bits to 1
 	{
 		rv_write_nbits(20, 0xfffff);
 	}
-	gpio_clear(SWDIO_PORT, SWDIO_PIN);
-	gpio_set(SWDIO_PORT, SWDIO_PIN);
+	IO_OFF();
+	IO_ON();
 	platform_delay(10);
 	return true;
 }

src/platforms/swlink/platform.c

@@ -63,7 +63,7 @@ void platform_init(void)
 	/* Unmap JTAG Pins so we can reuse as GPIO */
 	data = AFIO_MAPR;
 	data &= ~AFIO_MAPR_SWJ_MASK;
-	data |= AFIO_MAPR_SWJ_CFG_JTAG_OFF_SW_OFF;
+	data |= AFIO_MAPR_SWJ_CFG_JTAG_OFF_SW_ON;
 	AFIO_MAPR = data;
 	/* Setup JTAG GPIO ports */
 	gpio_set_mode(TMS_PORT, GPIO_MODE_OUTPUT_2_MHZ, GPIO_CNF_INPUT_FLOAT, TMS_PIN);

src/platforms/swlink/platform.h

@@ -29,6 +29,7 @@
 #include "timing_stm32.h"
 
 #define PLATFORM_HAS_TRACESWO
+#define PLATFORM_HAS_RVSWD
 
 #if ENABLE_DEBUG == 1
 #define PLATFORM_HAS_DEBUG
@@ -43,11 +44,11 @@ extern bool debug_bmp;
 #define TDI_PORT  GPIOA
 #define TDO_PORT  GPIOB
 #define TRST_PORT GPIOB
-#define TMS_PIN   GPIO5
-#define TCK_PIN   GPIO6
+#define TMS_PIN   GPIO6
+#define TCK_PIN   GPIO5
 #define TDI_PIN   GPIO15
 #define TDO_PIN   GPIO3
-#define TRST_PIN  GPIO4
+#define TRST_PIN  GPIO0
 
 #define SWDIO_PORT TMS_PORT
 #define SWCLK_PORT TCK_PORT
@@ -61,8 +62,8 @@ extern bool debug_bmp;
 #define LED_PORT_UART GPIOC
 #define LED_UART      GPIO14
 
-#define SWD_CR      GPIO_CRH(SWDIO_PORT)
-#define SWD_CR_MULT (1U << ((13U - 8U) << 2U))
+#define SWD_CR      GPIO_CRL(SWDIO_PORT)
+#define SWD_CR_MULT (1U << ((6U) << 2U))
 
 #define TMS_SET_MODE() gpio_set_mode(TMS_PORT, GPIO_MODE_OUTPUT_2_MHZ, GPIO_CNF_OUTPUT_PUSHPULL, TMS_PIN);
 #define SWDIO_MODE_FLOAT()           \