Change return value on error.
[openocd.git] / src / jtag / drivers / at91rm9200.c
1 /***************************************************************************
2 * Copyright (C) 2006 by Anders Larsen *
3 * al@alarsen.net *
4 * *
5 * This program is free software; you can redistribute it and/or modify *
6 * it under the terms of the GNU General Public License as published by *
7 * the Free Software Foundation; either version 2 of the License, or *
8 * (at your option) any later version. *
9 * *
10 * This program is distributed in the hope that it will be useful, *
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
13 * GNU General Public License for more details. *
14 * *
15 * You should have received a copy of the GNU General Public License *
16 * along with this program; if not, write to the *
17 * Free Software Foundation, Inc., *
18 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
19 ***************************************************************************/
20 #ifdef HAVE_CONFIG_H
21 #include "config.h"
22 #endif
23
24 #include <jtag/interface.h>
25 #include "bitbang.h"
26
27 #include <sys/mman.h>
28
29
30 /* AT91RM9200 */
31 #define AT91C_BASE_SYS (0xfffff000)
32
33 /* GPIO assignment */
34 #define PIOA (0 << 7)
35 #define PIOB (1 << 7)
36 #define PIOC (2 << 7)
37 #define PIOD (3 << 7)
38
39 #define PIO_PER (0) /* PIO enable */
40 #define PIO_OER (4) /* output enable */
41 #define PIO_ODR (5) /* output disable */
42 #define PIO_SODR (12) /* set output data */
43 #define PIO_CODR (13) /* clear output data */
44 #define PIO_PDSR (15) /* pin data status */
45 #define PIO_PPUER (25) /* pull-up enable */
46
47 #define NC (0) /* not connected */
48 #define P0 (1 << 0)
49 #define P1 (1 << 1)
50 #define P2 (1 << 2)
51 #define P3 (1 << 3)
52 #define P4 (1 << 4)
53 #define P5 (1 << 5)
54 #define P6 (1 << 6)
55 #define P7 (1 << 7)
56 #define P8 (1 << 8)
57 #define P9 (1 << 9)
58 #define P10 (1 << 10)
59 #define P11 (1 << 11)
60 #define P12 (1 << 12)
61 #define P13 (1 << 13)
62 #define P14 (1 << 14)
63 #define P15 (1 << 15)
64 #define P16 (1 << 16)
65 #define P17 (1 << 17)
66 #define P18 (1 << 18)
67 #define P19 (1 << 19)
68 #define P20 (1 << 20)
69 #define P21 (1 << 21)
70 #define P22 (1 << 22)
71 #define P23 (1 << 23)
72 #define P24 (1 << 24)
73 #define P25 (1 << 25)
74 #define P26 (1 << 26)
75 #define P27 (1 << 27)
76 #define P28 (1 << 28)
77 #define P29 (1 << 29)
78 #define P30 (1 << 30)
79 #define P31 (1 << 31)
80
81 struct device_t
82 {
83 char* name;
84 int TDO_PIO; /* PIO holding TDO */
85 uint32_t TDO_MASK; /* TDO bitmask */
86 int TRST_PIO; /* PIO holding TRST */
87 uint32_t TRST_MASK; /* TRST bitmask */
88 int TMS_PIO; /* PIO holding TMS */
89 uint32_t TMS_MASK; /* TMS bitmask */
90 int TCK_PIO; /* PIO holding TCK */
91 uint32_t TCK_MASK; /* TCK bitmask */
92 int TDI_PIO; /* PIO holding TDI */
93 uint32_t TDI_MASK; /* TDI bitmask */
94 int SRST_PIO; /* PIO holding SRST */
95 uint32_t SRST_MASK; /* SRST bitmask */
96 };
97
98 static struct device_t devices[] =
99 {
100 { "rea_ecr", PIOD, P27, PIOA, NC, PIOD, P23, PIOD, P24, PIOD, P26, PIOC, P5 },
101 { .name = NULL },
102 };
103
104 /* configuration */
105 static char* at91rm9200_device;
106
107 /* interface variables
108 */
109 static struct device_t* device;
110 static int dev_mem_fd;
111 static void *sys_controller;
112 static uint32_t* pio_base;
113
114 /* low level command set
115 */
116 static int at91rm9200_read(void);
117 static void at91rm9200_write(int tck, int tms, int tdi);
118 static void at91rm9200_reset(int trst, int srst);
119
120 static int at91rm9200_speed(int speed);
121 static int at91rm9200_init(void);
122 static int at91rm9200_quit(void);
123
124 static struct bitbang_interface at91rm9200_bitbang =
125 {
126 .read = at91rm9200_read,
127 .write = at91rm9200_write,
128 .reset = at91rm9200_reset,
129 .blink = 0
130 };
131
132 static int at91rm9200_read(void)
133 {
134 return (pio_base[device->TDO_PIO + PIO_PDSR] & device->TDO_MASK) != 0;
135 }
136
137 static void at91rm9200_write(int tck, int tms, int tdi)
138 {
139 if (tck)
140 pio_base[device->TCK_PIO + PIO_SODR] = device->TCK_MASK;
141 else
142 pio_base[device->TCK_PIO + PIO_CODR] = device->TCK_MASK;
143
144 if (tms)
145 pio_base[device->TMS_PIO + PIO_SODR] = device->TMS_MASK;
146 else
147 pio_base[device->TMS_PIO + PIO_CODR] = device->TMS_MASK;
148
149 if (tdi)
150 pio_base[device->TDI_PIO + PIO_SODR] = device->TDI_MASK;
151 else
152 pio_base[device->TDI_PIO + PIO_CODR] = device->TDI_MASK;
153 }
154
155 /* (1) assert or (0) deassert reset lines */
156 static void at91rm9200_reset(int trst, int srst)
157 {
158 if (trst == 0)
159 pio_base[device->TRST_PIO + PIO_SODR] = device->TRST_MASK;
160 else if (trst == 1)
161 pio_base[device->TRST_PIO + PIO_CODR] = device->TRST_MASK;
162
163 if (srst == 0)
164 pio_base[device->SRST_PIO + PIO_SODR] = device->SRST_MASK;
165 else if (srst == 1)
166 pio_base[device->SRST_PIO + PIO_CODR] = device->SRST_MASK;
167 }
168
169 static int at91rm9200_speed(int speed)
170 {
171
172 return ERROR_OK;
173 }
174
175 COMMAND_HANDLER(at91rm9200_handle_device_command)
176 {
177 if (CMD_ARGC == 0)
178 return ERROR_COMMAND_SYNTAX_ERROR;
179
180 /* only if the device name wasn't overwritten by cmdline */
181 if (at91rm9200_device == 0)
182 {
183 at91rm9200_device = malloc(strlen(CMD_ARGV[0]) + sizeof(char));
184 strcpy(at91rm9200_device, CMD_ARGV[0]);
185 }
186
187 return ERROR_OK;
188 }
189
190 static const struct command_registration at91rm9200_command_handlers[] = {
191 {
192 .name = "at91rm9200_device",
193 .handler = &at91rm9200_handle_device_command,
194 .mode = COMMAND_CONFIG,
195 .help = "query armjtagew info",
196 },
197 COMMAND_REGISTRATION_DONE
198 };
199
200 struct jtag_interface at91rm9200_interface =
201 {
202 .name = "at91rm9200",
203
204 .execute_queue = bitbang_execute_queue,
205
206 .speed = at91rm9200_speed,
207 .commands = at91rm9200_command_handlers,
208 .init = at91rm9200_init,
209 .quit = at91rm9200_quit,
210 };
211
212 static int at91rm9200_init(void)
213 {
214 struct device_t *cur_device;
215
216 cur_device = devices;
217
218 if (at91rm9200_device == NULL || at91rm9200_device[0] == 0)
219 {
220 at91rm9200_device = "rea_ecr";
221 LOG_WARNING("No at91rm9200 device specified, using default 'rea_ecr'");
222 }
223
224 while (cur_device->name)
225 {
226 if (strcmp(cur_device->name, at91rm9200_device) == 0)
227 {
228 device = cur_device;
229 break;
230 }
231 cur_device++;
232 }
233
234 if (!device)
235 {
236 LOG_ERROR("No matching device found for %s", at91rm9200_device);
237 return ERROR_JTAG_INIT_FAILED;
238 }
239
240 bitbang_interface = &at91rm9200_bitbang;
241
242 dev_mem_fd = open("/dev/mem", O_RDWR | O_SYNC);
243 if (dev_mem_fd < 0) {
244 perror("open");
245 return ERROR_JTAG_INIT_FAILED;
246 }
247
248 sys_controller = mmap(NULL, 4096, PROT_READ | PROT_WRITE,
249 MAP_SHARED, dev_mem_fd, AT91C_BASE_SYS);
250 if (sys_controller == MAP_FAILED) {
251 perror("mmap");
252 close(dev_mem_fd);
253 return ERROR_JTAG_INIT_FAILED;
254 }
255 pio_base = (uint32_t*)sys_controller + 0x100;
256
257 /*
258 * Configure TDO as an input, and TDI, TCK, TMS, TRST, SRST
259 * as outputs. Drive TDI and TCK low, and TMS/TRST/SRST high.
260 */
261 pio_base[device->TDI_PIO + PIO_CODR] = device->TDI_MASK;
262 pio_base[device->TDI_PIO + PIO_OER] = device->TDI_MASK;
263 pio_base[device->TDI_PIO + PIO_PER] = device->TDI_MASK;
264 pio_base[device->TCK_PIO + PIO_CODR] = device->TCK_MASK;
265 pio_base[device->TCK_PIO + PIO_OER] = device->TCK_MASK;
266 pio_base[device->TCK_PIO + PIO_PER] = device->TCK_MASK;
267 pio_base[device->TMS_PIO + PIO_SODR] = device->TMS_MASK;
268 pio_base[device->TMS_PIO + PIO_OER] = device->TMS_MASK;
269 pio_base[device->TMS_PIO + PIO_PER] = device->TMS_MASK;
270 pio_base[device->TRST_PIO + PIO_SODR] = device->TRST_MASK;
271 pio_base[device->TRST_PIO + PIO_OER] = device->TRST_MASK;
272 pio_base[device->TRST_PIO + PIO_PER] = device->TRST_MASK;
273 pio_base[device->SRST_PIO + PIO_SODR] = device->SRST_MASK;
274 pio_base[device->SRST_PIO + PIO_OER] = device->SRST_MASK;
275 pio_base[device->SRST_PIO + PIO_PER] = device->SRST_MASK;
276 pio_base[device->TDO_PIO + PIO_ODR] = device->TDO_MASK;
277 pio_base[device->TDO_PIO + PIO_PPUER] = device->TDO_MASK;
278 pio_base[device->TDO_PIO + PIO_PER] = device->TDO_MASK;
279
280 return ERROR_OK;
281 }
282
283 static int at91rm9200_quit(void)
284 {
285
286 return ERROR_OK;
287 }

Linking to existing account procedure

If you already have an account and want to add another login method you MUST first sign in with your existing account and then change URL to read https://review.openocd.org/login/?link to get to this page again but this time it'll work for linking. Thank you.

SSH host keys fingerprints

1024 SHA256:YKx8b7u5ZWdcbp7/4AeXNaqElP49m6QrwfXaqQGJAOk gerrit-code-review@openocd.zylin.com (DSA)
384 SHA256:jHIbSQa4REvwCFG4cq5LBlBLxmxSqelQPem/EXIrxjk gerrit-code-review@openocd.org (ECDSA)
521 SHA256:UAOPYkU9Fjtcao0Ul/Rrlnj/OsQvt+pgdYSZ4jOYdgs gerrit-code-review@openocd.org (ECDSA)
256 SHA256:A13M5QlnozFOvTllybRZH6vm7iSt0XLxbA48yfc2yfY gerrit-code-review@openocd.org (ECDSA)
256 SHA256:spYMBqEYoAOtK7yZBrcwE8ZpYt6b68Cfh9yEVetvbXg gerrit-code-review@openocd.org (ED25519)
+--[ED25519 256]--+
|=..              |
|+o..   .         |
|*.o   . .        |
|+B . . .         |
|Bo. = o S        |
|Oo.+ + =         |
|oB=.* = . o      |
| =+=.+   + E     |
|. .=o   . o      |
+----[SHA256]-----+
2048 SHA256:0Onrb7/PHjpo6iVZ7xQX2riKN83FJ3KGU0TvI0TaFG4 gerrit-code-review@openocd.zylin.com (RSA)