-/***************************************************************************\r
- * Copyright (C) 2005 by Dominic Rath *\r
- * Dominic.Rath@gmx.de *\r
- * *\r
- * This program is free software; you can redistribute it and/or modify *\r
- * it under the terms of the GNU General Public License as published by *\r
- * the Free Software Foundation; either version 2 of the License, or *\r
- * (at your option) any later version. *\r
- * *\r
- * This program is distributed in the hope that it will be useful, *\r
- * but WITHOUT ANY WARRANTY; without even the implied warranty of *\r
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *\r
- * GNU General Public License for more details. *\r
- * *\r
- * You should have received a copy of the GNU General Public License *\r
- * along with this program; if not, write to the *\r
- * Free Software Foundation, Inc., *\r
- * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *\r
- ***************************************************************************/\r
-#ifdef HAVE_CONFIG_H\r
-#include "config.h"\r
-#endif\r
-\r
-#include "log.h"\r
-#include "jtag.h"\r
-#include "bitbang.h"\r
-\r
-#define TDO_BIT 1\r
-#define TDI_BIT 2\r
-#define TCK_BIT 4\r
-#define TMS_BIT 8\r
-#define TRST_BIT 16\r
-#define SRST_BIT 32\r
-#define VCC_BIT 64\r
-\r
-/* system includes */\r
-#include <string.h>\r
-#include <stdlib.h>\r
-#include <stdio.h>\r
-#include <sys/mman.h>\r
-#include <unistd.h>\r
-#include <fcntl.h>\r
-\r
-static u8 output_value = 0x0;\r
-static int dev_mem_fd;\r
-static void *gpio_controller;\r
-static volatile u8 *gpio_data_register;\r
-static volatile u8 *gpio_data_direction_register;\r
-\r
-/* low level command set\r
- */\r
-int ep93xx_read(void);\r
-void ep93xx_write(int tck, int tms, int tdi);\r
-void ep93xx_reset(int trst, int srst);\r
-\r
-int ep93xx_speed(int speed);\r
-int ep93xx_register_commands(struct command_context_s *cmd_ctx);\r
-int ep93xx_init(void);\r
-int ep93xx_quit(void);\r
-\r
-struct timespec ep93xx_zzzz;\r
-\r
-jtag_interface_t ep93xx_interface = \r
-{\r
- .name = "ep93xx",\r
- \r
- .execute_queue = bitbang_execute_queue,\r
-\r
- .speed = ep93xx_speed, \r
- .register_commands = ep93xx_register_commands,\r
- .init = ep93xx_init,\r
- .quit = ep93xx_quit,\r
-};\r
-\r
-bitbang_interface_t ep93xx_bitbang =\r
-{\r
- .read = ep93xx_read,\r
- .write = ep93xx_write,\r
- .reset = ep93xx_reset,\r
- .blink = 0;\r
-};\r
-\r
-int ep93xx_read(void)\r
-{\r
- return !!(*gpio_data_register & TDO_BIT);\r
-}\r
-\r
-void ep93xx_write(int tck, int tms, int tdi)\r
-{\r
- if (tck)\r
- output_value |= TCK_BIT;\r
- else\r
- output_value &= TCK_BIT;\r
- \r
- if (tms)\r
- output_value |= TMS_BIT;\r
- else\r
- output_value &= TMS_BIT;\r
- \r
- if (tdi)\r
- output_value |= TDI_BIT;\r
- else\r
- output_value &= TDI_BIT;\r
-\r
- *gpio_data_register = output_value;\r
- nanosleep(ep93xx_zzzz);\r
-}\r
-\r
-/* (1) assert or (0) deassert reset lines */\r
-void ep93xx_reset(int trst, int srst)\r
-{\r
- if (trst == 0)\r
- output_value |= TRST_BIT;\r
- else if (trst == 1)\r
- output_value &= TRST_BIT;\r
-\r
- if (srst == 0)\r
- output_value |= SRST_BIT;\r
- else if (srst == 1)\r
- output_value &= SRST_BIT;\r
- \r
- *gpio_data_register = output_value;\r
- nanosleep(ep93xx_zzzz);\r
-}\r
-\r
-int ep93xx_speed(int speed)\r
-{\r
- \r
- return ERROR_OK;\r
-}\r
-\r
-int ep93xx_register_commands(struct command_context_s *cmd_ctx)\r
-{\r
-\r
- return ERROR_OK;\r
-}\r
-\r
-static int set_gonk_mode(void)\r
-{\r
- void *syscon;\r
- u32 devicecfg;\r
-\r
- syscon = mmap(NULL, 4096, PROT_READ | PROT_WRITE,\r
- MAP_SHARED, dev_mem_fd, 0x80930000);\r
- if (syscon == MAP_FAILED) {\r
- perror("mmap");\r
- return ERROR_JTAG_INIT_FAILED;\r
- }\r
-\r
- devicecfg = *((volatile int *)(syscon + 0x80));\r
- *((volatile int *)(syscon + 0xc0)) = 0xaa;\r
- *((volatile int *)(syscon + 0x80)) = devicecfg | 0x08000000;\r
-\r
- munmap(syscon, 4096);\r
-\r
- return ERROR_OK;\r
-}\r
-\r
-int ep93xx_init(void)\r
-{\r
- int ret;\r
-\r
- bitbang_interface = &ep93xx_bitbang; \r
-\r
- ep93xx_zzzz.tv_sec = 0;\r
- ep93xx_zzzz.tv_nsec = 10000000;\r
-\r
- dev_mem_fd = open("/dev/mem", O_RDWR | O_SYNC);\r
- if (dev_mem_fd < 0) {\r
- perror("open");\r
- return ERROR_JTAG_INIT_FAILED;\r
- }\r
-\r
- gpio_controller = mmap(NULL, 4096, PROT_READ | PROT_WRITE,\r
- MAP_SHARED, dev_mem_fd, 0x80840000);\r
- if (gpio_controller == MAP_FAILED) {\r
- perror("mmap");\r
- close(dev_mem_fd);\r
- return ERROR_JTAG_INIT_FAILED;\r
- }\r
-\r
- ret = set_gonk_mode();\r
- if (ret != ERROR_OK) {\r
- munmap(gpio_controller, 4096);\r
- close(dev_mem_fd);\r
- return ret;\r
- }\r
-\r
-#if 0\r
- /* Use GPIO port A. */\r
- gpio_data_register = gpio_controller + 0x00;\r
- gpio_data_direction_register = gpio_controller + 0x10;\r
-\r
-\r
- /* Use GPIO port B. */\r
- gpio_data_register = gpio_controller + 0x04;\r
- gpio_data_direction_register = gpio_controller + 0x14;\r
-\r
- /* Use GPIO port C. */\r
- gpio_data_register = gpio_controller + 0x08;\r
- gpio_data_direction_register = gpio_controller + 0x18;\r
-\r
- /* Use GPIO port D. */\r
- gpio_data_register = gpio_controller + 0x0c;\r
- gpio_data_direction_register = gpio_controller + 0x1c;\r
-#endif\r
-\r
- /* Use GPIO port C. */\r
- gpio_data_register = gpio_controller + 0x08;\r
- gpio_data_direction_register = gpio_controller + 0x18;\r
-\r
- INFO("gpio_data_register = %p\n", gpio_data_register);\r
- INFO("gpio_data_direction_reg = %p\n", gpio_data_direction_register); \r
- /*\r
- * Configure bit 0 (TDO) as an input, and bits 1-5 (TDI, TCK\r
- * TMS, TRST, SRST) as outputs. Drive TDI and TCK low, and\r
- * TMS/TRST/SRST high.\r
- */\r
- output_value = TMS_BIT | TRST_BIT | SRST_BIT | VCC_BIT;\r
- *gpio_data_register = output_value;\r
- nanosleep(ep93xx_zzzz);\r
-\r
- /*\r
- * Configure the direction register. 1 = output, 0 = input.\r
- */\r
- *gpio_data_direction_register =\r
- TDI_BIT | TCK_BIT | TMS_BIT | TRST_BIT | SRST_BIT | VCC_BIT;\r
-\r
- nanosleep(ep93xx_zzzz);\r
- return ERROR_OK;\r
-}\r
-\r
-int ep93xx_quit(void)\r
-{\r
-\r
- return ERROR_OK;\r
-}\r
+/***************************************************************************
+ * Copyright (C) 2005 by Dominic Rath *
+ * Dominic.Rath@gmx.de *
+ * *
+ * This program is free software; you can redistribute it and/or modify *
+ * it under the terms of the GNU General Public License as published by *
+ * the Free Software Foundation; either version 2 of the License, or *
+ * (at your option) any later version. *
+ * *
+ * This program is distributed in the hope that it will be useful, *
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of *
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
+ * GNU General Public License for more details. *
+ * *
+ * You should have received a copy of the GNU General Public License *
+ * along with this program; if not, write to the *
+ * Free Software Foundation, Inc., *
+ * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
+ ***************************************************************************/
+#ifdef HAVE_CONFIG_H
+#include "config.h"
+#endif
+
+#include "log.h"
+#include "jtag.h"
+#include "bitbang.h"
+
+#define TDO_BIT 1
+#define TDI_BIT 2
+#define TCK_BIT 4
+#define TMS_BIT 8
+#define TRST_BIT 16
+#define SRST_BIT 32
+#define VCC_BIT 64
+
+/* system includes */
+#include <string.h>
+#include <stdlib.h>
+#include <stdio.h>
+#include <sys/mman.h>
+#include <unistd.h>
+#include <fcntl.h>
+
+static u8 output_value = 0x0;
+static int dev_mem_fd;
+static void *gpio_controller;
+static volatile u8 *gpio_data_register;
+static volatile u8 *gpio_data_direction_register;
+
+/* low level command set
+ */
+int ep93xx_read(void);
+void ep93xx_write(int tck, int tms, int tdi);
+void ep93xx_reset(int trst, int srst);
+
+int ep93xx_speed(int speed);
+int ep93xx_register_commands(struct command_context_s *cmd_ctx);
+int ep93xx_init(void);
+int ep93xx_quit(void);
+
+struct timespec ep93xx_zzzz;
+
+jtag_interface_t ep93xx_interface =
+{
+ .name = "ep93xx",
+
+ .execute_queue = bitbang_execute_queue,
+
+ .speed = ep93xx_speed,
+ .register_commands = ep93xx_register_commands,
+ .init = ep93xx_init,
+ .quit = ep93xx_quit,
+};
+
+bitbang_interface_t ep93xx_bitbang =
+{
+ .read = ep93xx_read,
+ .write = ep93xx_write,
+ .reset = ep93xx_reset,
+ .blink = 0;
+};
+
+int ep93xx_read(void)
+{
+ return !!(*gpio_data_register & TDO_BIT);
+}
+
+void ep93xx_write(int tck, int tms, int tdi)
+{
+ if (tck)
+ output_value |= TCK_BIT;
+ else
+ output_value &= TCK_BIT;
+
+ if (tms)
+ output_value |= TMS_BIT;
+ else
+ output_value &= TMS_BIT;
+
+ if (tdi)
+ output_value |= TDI_BIT;
+ else
+ output_value &= TDI_BIT;
+
+ *gpio_data_register = output_value;
+ nanosleep(ep93xx_zzzz);
+}
+
+/* (1) assert or (0) deassert reset lines */
+void ep93xx_reset(int trst, int srst)
+{
+ if (trst == 0)
+ output_value |= TRST_BIT;
+ else if (trst == 1)
+ output_value &= TRST_BIT;
+
+ if (srst == 0)
+ output_value |= SRST_BIT;
+ else if (srst == 1)
+ output_value &= SRST_BIT;
+
+ *gpio_data_register = output_value;
+ nanosleep(ep93xx_zzzz);
+}
+
+int ep93xx_speed(int speed)
+{
+
+ return ERROR_OK;
+}
+
+int ep93xx_register_commands(struct command_context_s *cmd_ctx)
+{
+
+ return ERROR_OK;
+}
+
+static int set_gonk_mode(void)
+{
+ void *syscon;
+ u32 devicecfg;
+
+ syscon = mmap(NULL, 4096, PROT_READ | PROT_WRITE,
+ MAP_SHARED, dev_mem_fd, 0x80930000);
+ if (syscon == MAP_FAILED) {
+ perror("mmap");
+ return ERROR_JTAG_INIT_FAILED;
+ }
+
+ devicecfg = *((volatile int *)(syscon + 0x80));
+ *((volatile int *)(syscon + 0xc0)) = 0xaa;
+ *((volatile int *)(syscon + 0x80)) = devicecfg | 0x08000000;
+
+ munmap(syscon, 4096);
+
+ return ERROR_OK;
+}
+
+int ep93xx_init(void)
+{
+ int ret;
+
+ bitbang_interface = &ep93xx_bitbang;
+
+ ep93xx_zzzz.tv_sec = 0;
+ ep93xx_zzzz.tv_nsec = 10000000;
+
+ dev_mem_fd = open("/dev/mem", O_RDWR | O_SYNC);
+ if (dev_mem_fd < 0) {
+ perror("open");
+ return ERROR_JTAG_INIT_FAILED;
+ }
+
+ gpio_controller = mmap(NULL, 4096, PROT_READ | PROT_WRITE,
+ MAP_SHARED, dev_mem_fd, 0x80840000);
+ if (gpio_controller == MAP_FAILED) {
+ perror("mmap");
+ close(dev_mem_fd);
+ return ERROR_JTAG_INIT_FAILED;
+ }
+
+ ret = set_gonk_mode();
+ if (ret != ERROR_OK) {
+ munmap(gpio_controller, 4096);
+ close(dev_mem_fd);
+ return ret;
+ }
+
+#if 0
+ /* Use GPIO port A. */
+ gpio_data_register = gpio_controller + 0x00;
+ gpio_data_direction_register = gpio_controller + 0x10;
+
+
+ /* Use GPIO port B. */
+ gpio_data_register = gpio_controller + 0x04;
+ gpio_data_direction_register = gpio_controller + 0x14;
+
+ /* Use GPIO port C. */
+ gpio_data_register = gpio_controller + 0x08;
+ gpio_data_direction_register = gpio_controller + 0x18;
+
+ /* Use GPIO port D. */
+ gpio_data_register = gpio_controller + 0x0c;
+ gpio_data_direction_register = gpio_controller + 0x1c;
+#endif
+
+ /* Use GPIO port C. */
+ 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);
+ /*
+ * Configure bit 0 (TDO) as an input, and bits 1-5 (TDI, TCK
+ * TMS, TRST, SRST) as outputs. Drive TDI and TCK low, and
+ * TMS/TRST/SRST high.
+ */
+ output_value = TMS_BIT | TRST_BIT | SRST_BIT | VCC_BIT;
+ *gpio_data_register = output_value;
+ nanosleep(ep93xx_zzzz);
+
+ /*
+ * Configure the direction register. 1 = output, 0 = input.
+ */
+ *gpio_data_direction_register =
+ TDI_BIT | TCK_BIT | TMS_BIT | TRST_BIT | SRST_BIT | VCC_BIT;
+
+ nanosleep(ep93xx_zzzz);
+ return ERROR_OK;
+}
+
+int ep93xx_quit(void)
+{
+
+ return ERROR_OK;
+}