- added mips software breakpoint support

[openocd] / src / jtag / ep93xx.c

diff --git a/src/jtag/ep93xx.c b/src/jtag/ep93xx.c
index aa62ad5b14cbfeded29571b2bc980afeb4fdca89..03a391a0c054aea62db55effec9c5dfec9f25f59 100644 (file)
--- a/src/jtag/ep93xx.c
+++ b/src/jtag/ep93xx.c
@@ -37,6 +37,7 @@
 #include <string.h>
 #include <stdlib.h>
 #include <stdio.h>
+#include <time.h>
 #include <sys/mman.h>
 #include <unistd.h>
 #include <fcntl.h>
@@ -63,7 +64,7 @@ struct timespec ep93xx_zzzz;
 jtag_interface_t ep93xx_interface = 
 {
        .name = "ep93xx",
-       
+
        .execute_queue = bitbang_execute_queue,
 
        .speed = ep93xx_speed,  
@@ -77,7 +78,7 @@ bitbang_interface_t ep93xx_bitbang =
        .read = ep93xx_read,
        .write = ep93xx_write,
        .reset = ep93xx_reset,
-       .blink = 0;
+       .blink = 0,
 };
 
 int ep93xx_read(void)
@@ -90,20 +91,20 @@ void ep93xx_write(int tck, int tms, int tdi)
        if (tck)
                output_value |= TCK_BIT;
        else
-               output_value &= TCK_BIT;
+               output_value &= ~TCK_BIT;
        
        if (tms)
                output_value |= TMS_BIT;
        else
-               output_value &= TMS_BIT;
+               output_value &= ~TMS_BIT;
        
        if (tdi)
                output_value |= TDI_BIT;
        else
-               output_value &= TDI_BIT;
+               output_value &= ~TDI_BIT;
 
        *gpio_data_register = output_value;
-       nanosleep(ep93xx_zzzz);
+       nanosleep(&ep93xx_zzzz, NULL);
 }
 
 /* (1) assert or (0) deassert reset lines */
@@ -112,20 +113,20 @@ void ep93xx_reset(int trst, int srst)
        if (trst == 0)
                output_value |= TRST_BIT;
        else if (trst == 1)
-               output_value &= TRST_BIT;
+               output_value &= ~TRST_BIT;
 
        if (srst == 0)
                output_value |= SRST_BIT;
        else if (srst == 1)
-               output_value &= SRST_BIT;
+               output_value &= ~SRST_BIT;
        
        *gpio_data_register = output_value;
-       nanosleep(ep93xx_zzzz);
+       nanosleep(&ep93xx_zzzz, NULL);
 }
 
 int ep93xx_speed(int speed)
 {
-       
+
        return ERROR_OK;
 }
 
@@ -209,8 +210,8 @@ int ep93xx_init(void)
        gpio_data_register = gpio_controller + 0x08;
        gpio_data_direction_register = gpio_controller + 0x18;
 
-       INFO("gpio_data_register      = %p\n", gpio_data_register);
-       INFO("gpio_data_direction_reg = %p\n", gpio_data_direction_register); 
+       LOG_INFO("gpio_data_register      = %p\n", gpio_data_register);
+       LOG_INFO("gpio_data_direction_reg = %p\n", gpio_data_direction_register); 
        /*
         * Configure bit 0 (TDO) as an input, and bits 1-5 (TDI, TCK
         * TMS, TRST, SRST) as outputs.  Drive TDI and TCK low, and
@@ -218,7 +219,7 @@ int ep93xx_init(void)
         */
        output_value = TMS_BIT | TRST_BIT | SRST_BIT | VCC_BIT;
        *gpio_data_register = output_value;
-       nanosleep(ep93xx_zzzz);
+       nanosleep(&ep93xx_zzzz, NULL);
 
        /*
         * Configure the direction register.  1 = output, 0 = input.
@@ -226,7 +227,7 @@ int ep93xx_init(void)
        *gpio_data_direction_register =
                TDI_BIT | TCK_BIT | TMS_BIT | TRST_BIT | SRST_BIT | VCC_BIT;
 
-       nanosleep(ep93xx_zzzz);
+       nanosleep(&ep93xx_zzzz, NULL);
        return ERROR_OK;
 }