drivers/linuxgpiod: add led

[fw/openocd] / src / jtag / drivers / bcm2835gpio.c

diff --git a/src/jtag/drivers/bcm2835gpio.c b/src/jtag/drivers/bcm2835gpio.c
index 77ae5668f0cb4cae7ec4d45fa9c84cefa864f5ea..40cb5aa0b6d4d9bf1cb31fd7c8ebd00e92a72894 100644 (file)
--- a/src/jtag/drivers/bcm2835gpio.c
+++ b/src/jtag/drivers/bcm2835gpio.c
@@ -24,6 +24,7 @@
 #endif
 
 #include <jtag/interface.h>
+#include <transport/transport.h>
 #include "bitbang.h"
 
 #include <sys/mman.h>
@@ -456,15 +457,13 @@ static int bcm2835gpio_init(void)
 
        LOG_INFO("BCM2835 GPIO JTAG/SWD bitbang driver");
 
-       if (bcm2835gpio_jtag_mode_possible()) {
-               if (bcm2835gpio_swd_mode_possible())
-                       LOG_INFO("JTAG and SWD modes enabled");
-               else
-                       LOG_INFO("JTAG only mode enabled (specify swclk and swdio gpio to add SWD mode)");
-       } else if (bcm2835gpio_swd_mode_possible()) {
-               LOG_INFO("SWD only mode enabled (specify tck, tms, tdi and tdo gpios to add JTAG mode)");
-       } else {
-               LOG_ERROR("Require tck, tms, tdi and tdo gpios for JTAG mode and/or swclk and swdio gpio for SWD mode");
+       if (transport_is_jtag() && !bcm2835gpio_jtag_mode_possible()) {
+               LOG_ERROR("Require tck, tms, tdi and tdo gpios for JTAG mode");
+               return ERROR_JTAG_INIT_FAILED;
+       }
+
+       if (transport_is_swd() && !bcm2835gpio_swd_mode_possible()) {
+               LOG_ERROR("Require swclk and swdio gpio for SWD mode");
                return ERROR_JTAG_INIT_FAILED;
        }
 
@@ -474,7 +473,7 @@ static int bcm2835gpio_init(void)
                dev_mem_fd = open("/dev/mem", O_RDWR | O_SYNC);
        }
        if (dev_mem_fd < 0) {
-               perror("open");
+               LOG_ERROR("open: %s", strerror(errno));
                return ERROR_JTAG_INIT_FAILED;
        }
 
@@ -482,7 +481,7 @@ static int bcm2835gpio_init(void)
                                MAP_SHARED, dev_mem_fd, BCM2835_GPIO_BASE);
 
        if (pio_base == MAP_FAILED) {
-               perror("mmap");
+               LOG_ERROR("mmap: %s", strerror(errno));
                close(dev_mem_fd);
                return ERROR_JTAG_INIT_FAILED;
        }
@@ -492,7 +491,7 @@ static int bcm2835gpio_init(void)
                                MAP_SHARED, dev_mem_fd, BCM2835_PADS_GPIO_0_27);
 
        if (pads_base == MAP_FAILED) {
-               perror("mmap");
+               LOG_ERROR("mmap: %s", strerror(errno));
                close(dev_mem_fd);
                return ERROR_JTAG_INIT_FAILED;
        }
@@ -500,31 +499,42 @@ static int bcm2835gpio_init(void)
        /* set 4mA drive strength, slew rate limited, hysteresis on */
        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
         * as outputs.  Drive TDI and TCK low, and TMS/TRST/SRST high.
         */
-       INP_GPIO(tdo_gpio);
-
-       GPIO_CLR = 1<<tdi_gpio | 1<<tck_gpio | 1<<swdio_gpio | 1<<swclk_gpio;
-       GPIO_SET = 1<<tms_gpio;
-
-       OUT_GPIO(tdi_gpio);
-       OUT_GPIO(tck_gpio);
-       OUT_GPIO(tms_gpio);
-       OUT_GPIO(swclk_gpio);
-       OUT_GPIO(swdio_gpio);
-       if (trst_gpio != -1) {
-               trst_gpio_mode = MODE_GPIO(trst_gpio);
-               GPIO_SET = 1 << trst_gpio;
-               OUT_GPIO(trst_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);
+
+               INP_GPIO(tdo_gpio);
+
+               GPIO_CLR = 1<<tdi_gpio | 1<<tck_gpio;
+               GPIO_SET = 1<<tms_gpio;
+
+               OUT_GPIO(tdi_gpio);
+               OUT_GPIO(tck_gpio);
+               OUT_GPIO(tms_gpio);
+
+               if (trst_gpio != -1) {
+                       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) {
                srst_gpio_mode = MODE_GPIO(srst_gpio);
                GPIO_SET = 1 << srst_gpio;
@@ -540,14 +550,20 @@ static int bcm2835gpio_init(void)
 
 static int bcm2835gpio_quit(void)
 {
-       SET_MODE_GPIO(tdo_gpio, tdo_gpio_mode);
-       SET_MODE_GPIO(tdi_gpio, tdi_gpio_mode);
-       SET_MODE_GPIO(tck_gpio, tck_gpio_mode);
-       SET_MODE_GPIO(tms_gpio, tms_gpio_mode);
-       SET_MODE_GPIO(swclk_gpio, swclk_gpio_mode);
-       SET_MODE_GPIO(swdio_gpio, swdio_gpio_mode);
-       if (trst_gpio != -1)
-               SET_MODE_GPIO(trst_gpio, trst_gpio_mode);
+       if (transport_is_jtag()) {
+               SET_MODE_GPIO(tdo_gpio, tdo_gpio_mode);
+               SET_MODE_GPIO(tdi_gpio, tdi_gpio_mode);
+               SET_MODE_GPIO(tck_gpio, tck_gpio_mode);
+               SET_MODE_GPIO(tms_gpio, tms_gpio_mode);
+               if (trst_gpio != -1)
+                       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)
                SET_MODE_GPIO(srst_gpio, srst_gpio_mode);