interesting
/
riscv-openocd
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

bcm2835gpio: enable only the transport specific gpio 

Change-Id: Ice6744600079d5994d628bb3b782aa36e71f862e
Signed-off-by: Antonio Borneo <borneo.antonio@gmail.com>
Reviewed-on: http://openocd.zylin.com/5558
Tested-by: jenkins
This commit is contained in:
Antonio Borneo 2020-04-01 12:03:47 +02:00
parent a8e483a2bf
commit ee86f3ef92
1 changed files with 51 additions and 35 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

86
src/jtag/drivers/bcm2835gpio.c
View File

@ -24,6 +24,7 @@
#endif #endif
#include <jtag/interface.h> #include <jtag/interface.h>
#include <transport/transport.h>
#include "bitbang.h" #include "bitbang.h"
#include <sys/mman.h> #include <sys/mman.h>
@ -456,15 +457,13 @@ static int bcm2835gpio_init(void)
LOG_INFO("BCM2835 GPIO JTAG/SWD bitbang driver"); LOG_INFO("BCM2835 GPIO JTAG/SWD bitbang driver");
if (bcm2835gpio_jtag_mode_possible()) { if (transport_is_jtag() && !bcm2835gpio_jtag_mode_possible()) {
if (bcm2835gpio_swd_mode_possible()) LOG_ERROR("Require tck, tms, tdi and tdo gpios for JTAG mode");
LOG_INFO("JTAG and SWD modes enabled"); return ERROR_JTAG_INIT_FAILED;
else }
LOG_INFO("JTAG only mode enabled (specify swclk and swdio gpio to add SWD mode)");
} else if (bcm2835gpio_swd_mode_possible()) { if (transport_is_swd() && !bcm2835gpio_swd_mode_possible()) {
LOG_INFO("SWD only mode enabled (specify tck, tms, tdi and tdo gpios to add JTAG mode)"); LOG_ERROR("Require swclk and swdio gpio for SWD mode");
} else {
LOG_ERROR("Require tck, tms, tdi and tdo gpios for JTAG mode and/or swclk and swdio gpio for SWD mode");
return ERROR_JTAG_INIT_FAILED; return ERROR_JTAG_INIT_FAILED;
} }
@ -500,31 +499,42 @@ static int bcm2835gpio_init(void)
/* set 4mA drive strength, slew rate limited, hysteresis on */ /* set 4mA drive strength, slew rate limited, hysteresis on */
pads_base[BCM2835_PADS_GPIO_0_27_OFFSET] = 0x5a000008 + 1; pads_base[BCM2835_PADS_GPIO_0_27_OFFSET] = 0x5a000008 + 1;
tdo_gpio_mode = MODE_GPIO(tdo_gpio);
tdi_gpio_mode = MODE_GPIO(tdi_gpio);
tck_gpio_mode = MODE_GPIO(tck_gpio);
tms_gpio_mode = MODE_GPIO(tms_gpio);
swclk_gpio_mode = MODE_GPIO(swclk_gpio);
swdio_gpio_mode = MODE_GPIO(swdio_gpio);
/* /*
* Configure TDO as an input, and TDI, TCK, TMS, TRST, SRST * Configure TDO as an input, and TDI, TCK, TMS, TRST, SRST
* as outputs. Drive TDI and TCK low, and TMS/TRST/SRST high. * as outputs. Drive TDI and TCK low, and TMS/TRST/SRST high.
*/ */
INP_GPIO(tdo_gpio); if (transport_is_jtag()) {
tdo_gpio_mode = MODE_GPIO(tdo_gpio);
tdi_gpio_mode = MODE_GPIO(tdi_gpio);
tck_gpio_mode = MODE_GPIO(tck_gpio);
tms_gpio_mode = MODE_GPIO(tms_gpio);
GPIO_CLR = 1<<tdi_gpio | 1<<tck_gpio | 1<<swdio_gpio | 1<<swclk_gpio; INP_GPIO(tdo_gpio);
GPIO_SET = 1<<tms_gpio;
OUT_GPIO(tdi_gpio); GPIO_CLR = 1<<tdi_gpio | 1<<tck_gpio;
OUT_GPIO(tck_gpio); GPIO_SET = 1<<tms_gpio;
OUT_GPIO(tms_gpio);
OUT_GPIO(swclk_gpio); OUT_GPIO(tdi_gpio);
OUT_GPIO(swdio_gpio); OUT_GPIO(tck_gpio);
if (trst_gpio != -1) { OUT_GPIO(tms_gpio);
trst_gpio_mode = MODE_GPIO(trst_gpio);
GPIO_SET = 1 << trst_gpio; if (trst_gpio != -1) {
OUT_GPIO(trst_gpio); trst_gpio_mode = MODE_GPIO(trst_gpio);
GPIO_SET = 1 << trst_gpio;
OUT_GPIO(trst_gpio);
}
} }
if (transport_is_swd()) {
swclk_gpio_mode = MODE_GPIO(swclk_gpio);
swdio_gpio_mode = MODE_GPIO(swdio_gpio);
GPIO_CLR = 1<<swdio_gpio | 1<<swclk_gpio;
OUT_GPIO(swclk_gpio);
OUT_GPIO(swdio_gpio);
}
if (srst_gpio != -1) { if (srst_gpio != -1) {
srst_gpio_mode = MODE_GPIO(srst_gpio); srst_gpio_mode = MODE_GPIO(srst_gpio);
GPIO_SET = 1 << srst_gpio; GPIO_SET = 1 << srst_gpio;
@ -540,14 +550,20 @@ static int bcm2835gpio_init(void)
static int bcm2835gpio_quit(void) static int bcm2835gpio_quit(void)
{ {
SET_MODE_GPIO(tdo_gpio, tdo_gpio_mode); if (transport_is_jtag()) {
SET_MODE_GPIO(tdi_gpio, tdi_gpio_mode); SET_MODE_GPIO(tdo_gpio, tdo_gpio_mode);
SET_MODE_GPIO(tck_gpio, tck_gpio_mode); SET_MODE_GPIO(tdi_gpio, tdi_gpio_mode);
SET_MODE_GPIO(tms_gpio, tms_gpio_mode); SET_MODE_GPIO(tck_gpio, tck_gpio_mode);
SET_MODE_GPIO(swclk_gpio, swclk_gpio_mode); SET_MODE_GPIO(tms_gpio, tms_gpio_mode);
SET_MODE_GPIO(swdio_gpio, swdio_gpio_mode); if (trst_gpio != -1)
if (trst_gpio != -1) SET_MODE_GPIO(trst_gpio, trst_gpio_mode);
SET_MODE_GPIO(trst_gpio, trst_gpio_mode); }
if (transport_is_swd()) {
SET_MODE_GPIO(swclk_gpio, swclk_gpio_mode);
SET_MODE_GPIO(swdio_gpio, swdio_gpio_mode);
}
if (srst_gpio != -1) if (srst_gpio != -1)
SET_MODE_GPIO(srst_gpio, srst_gpio_mode); SET_MODE_GPIO(srst_gpio, srst_gpio_mode);