1 /***************************************************************************
2 * Copyright (C) 2007-2008 by �yvind Harboe *
4 * This program is free software; you can redistribute it and/or modify *
5 * it under the terms of the GNU General Public License as published by *
6 * the Free Software Foundation; either version 2 of the License, or *
7 * (at your option) any later version. *
9 * This program is distributed in the hope that it will be useful, *
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of *
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
12 * GNU General Public License for more details. *
14 * You should have received a copy of the GNU General Public License *
15 * along with this program; if not, write to the *
16 * Free Software Foundation, Inc., *
17 * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
18 ***************************************************************************/
23 #include "embeddedice.h"
24 #include "minidriver.h"
25 #include "interface.h"
27 #include <cyg/hal/hal_io.h> // low level i/o
28 #include <cyg/hal/hal_diag.h>
31 #define ZYLIN_VERSION "1.54"
32 #define ZYLIN_DATE __DATE__
33 #define ZYLIN_TIME __TIME__
34 #define ZYLIN_OPENOCD "$Revision$"
35 #define ZYLIN_OPENOCD_VERSION "Zylin JTAG ZY1000 " ZYLIN_VERSION " " ZYLIN_DATE " " ZYLIN_TIME
37 /* low level command set
39 void zy1000_reset(int trst
, int srst
);
42 int zy1000_speed(int speed
);
43 int zy1000_register_commands(struct command_context_s
*cmd_ctx
);
44 int zy1000_init(void);
45 int zy1000_quit(void);
47 /* interface commands */
48 int zy1000_handle_zy1000_port_command(struct command_context_s
*cmd_ctx
, char *cmd
, char **args
, int argc
);
50 static int zy1000_khz(int khz
, int *jtag_speed
)
58 *jtag_speed
= 64000/khz
;
63 static int zy1000_speed_div(int speed
, int *khz
)
77 static bool readPowerDropout(void)
80 // sample and clear power dropout
81 HAL_WRITE_UINT32(ZY1000_JTAG_BASE
+ 0x10, 0x80);
82 HAL_READ_UINT32(ZY1000_JTAG_BASE
+ 0x10, state
);
84 powerDropout
= (state
& 0x80) != 0;
89 static bool readSRST(void)
92 // sample and clear SRST sensing
93 HAL_WRITE_UINT32(ZY1000_JTAG_BASE
+ 0x10, 0x00000040);
94 HAL_READ_UINT32(ZY1000_JTAG_BASE
+ 0x10, state
);
96 srstAsserted
= (state
& 0x40) != 0;
100 static int zy1000_srst_asserted(int *srst_asserted
)
102 *srst_asserted
= readSRST();
106 static int zy1000_power_dropout(int *dropout
)
108 *dropout
= readPowerDropout();
113 jtag_interface_t zy1000_interface
=
116 .execute_queue
= NULL
,
117 .speed
= zy1000_speed
,
118 .register_commands
= zy1000_register_commands
,
122 .speed_div
= zy1000_speed_div
,
123 .power_dropout
= zy1000_power_dropout
,
124 .srst_asserted
= zy1000_srst_asserted
,
127 void zy1000_reset(int trst
, int srst
)
129 LOG_DEBUG("zy1000 trst=%d, srst=%d", trst
, srst
);
132 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x14, 0x00000001);
136 /* Danger!!! if clk != 0 when in
137 * idle in TAP_IDLE, reset halt on str912 will fail.
139 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x10, 0x00000001);
144 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x14, 0x00000002);
149 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x10, 0x00000002);
152 if (trst
||(srst
&& (jtag_get_reset_config() & RESET_SRST_PULLS_TRST
)))
155 /* we're now in the RESET state until trst is deasserted */
156 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x20, TAP_RESET
);
159 /* We'll get RCLK failure when we assert TRST, so clear any false positives here */
160 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x14, 0x400);
163 /* wait for srst to float back up */
167 for (i
= 0; i
< 1000; i
++)
169 // We don't want to sense our own reset, so we clear here.
170 // There is of course a timing hole where we could loose
181 LOG_USER("SRST didn't deassert after %dms", i
);
184 LOG_USER("SRST took %dms to deassert", i
);
189 int zy1000_speed(int speed
)
195 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x10, 0x100);
196 LOG_DEBUG("jtag_speed using RCLK");
200 if (speed
> 8190 || speed
< 2)
202 LOG_USER("valid ZY1000 jtag_speed=[8190,2]. Divisor is 64MHz / even values between 8190-2, i.e. min 7814Hz, max 32MHz");
203 return ERROR_INVALID_ARGUMENTS
;
206 LOG_USER("jtag_speed %d => JTAG clk=%f", speed
, 64.0/(float)speed
);
207 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x14, 0x100);
208 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x1c, speed
&~1);
213 static bool savePower
;
216 static void setPower(bool power
)
221 HAL_WRITE_UINT32(ZY1000_JTAG_BASE
+ 0x14, 0x8);
224 HAL_WRITE_UINT32(ZY1000_JTAG_BASE
+ 0x10, 0x8);
228 int handle_power_command(struct command_context_s
*cmd_ctx
, char *cmd
, char **args
, int argc
)
232 return ERROR_INVALID_ARGUMENTS
;
237 if (strcmp(args
[0], "on") == 0)
241 else if (strcmp(args
[0], "off") == 0)
246 command_print(cmd_ctx
, "arg is \"on\" or \"off\"");
247 return ERROR_INVALID_ARGUMENTS
;
251 command_print(cmd_ctx
, "Target power %s", savePower
? "on" : "off");
257 /* Give TELNET a way to find out what version this is */
258 static int jim_zy1000_version(Jim_Interp
*interp
, int argc
, Jim_Obj
*const *argv
)
260 if ((argc
< 1) || (argc
> 2))
263 const char *version_str
= NULL
;
267 version_str
= ZYLIN_OPENOCD_VERSION
;
270 const char *str
= Jim_GetString(argv
[1], NULL
);
271 if (strcmp("openocd", str
) == 0)
274 revision
= atol(ZYLIN_OPENOCD
+ strlen("XRevision: "));
275 sprintf(buff
, "%d", revision
);
278 else if (strcmp("zy1000", str
) == 0)
280 version_str
= ZYLIN_VERSION
;
282 else if (strcmp("date", str
) == 0)
284 version_str
= ZYLIN_DATE
;
286 else if (strcmp("pcb", str
) == 0)
288 #ifdef CYGPKG_HAL_NIOS2
300 Jim_SetResult(interp
, Jim_NewStringObj(interp
, version_str
, -1));
306 #ifdef CYGPKG_HAL_NIOS2
307 static int jim_zy1000_writefirmware(Jim_Interp
*interp
, int argc
, Jim_Obj
*const *argv
)
314 const char *str
= Jim_GetString(argv
[1], &length
);
316 /* BUG!!!! skip header! */
317 void *firmware_address
=0x4000000;
318 int firmware_length
=0x100000;
320 if (length
>firmware_length
)
325 if ((stat
= flash_erase((void *)firmware_address
, firmware_length
, (void **)&err_addr
)) != 0)
330 if ((stat
= flash_program(firmware_address
, str
, length
, (void **)&err_addr
)) != 0)
338 zylinjtag_Jim_Command_powerstatus(Jim_Interp
*interp
,
340 Jim_Obj
* const *argv
)
344 Jim_WrongNumArgs(interp
, 1, argv
, "powerstatus");
349 ZY1000_PEEK(ZY1000_JTAG_BASE
+ 0x10, status
);
351 Jim_SetResult(interp
, Jim_NewIntObj(interp
, (status
&0x80) != 0));
356 int zy1000_register_commands(struct command_context_s
*cmd_ctx
)
358 register_command(cmd_ctx
, NULL
, "power", handle_power_command
, COMMAND_ANY
,
359 "power <on/off> - turn power switch to target on/off. No arguments - print status.");
361 Jim_CreateCommand(interp
, "zy1000_version", jim_zy1000_version
, NULL
, NULL
);
364 Jim_CreateCommand(interp
, "powerstatus", zylinjtag_Jim_Command_powerstatus
, NULL
, NULL
);
366 #ifdef CYGPKG_HAL_NIOS2
367 Jim_CreateCommand(interp
, "updatezy1000firmware", jim_zy1000_writefirmware
, NULL
, NULL
);
377 int zy1000_init(void)
379 LOG_USER("%s", ZYLIN_OPENOCD_VERSION
);
381 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x10, 0x30); // Turn on LED1 & LED2
383 setPower(true); // on by default
386 /* deassert resets. Important to avoid infinite loop waiting for SRST to deassert */
388 zy1000_speed(jtag_get_speed());
393 int zy1000_quit(void)
401 int interface_jtag_execute_queue(void)
406 ZY1000_PEEK(ZY1000_JTAG_BASE
+ 0x10, empty
);
407 /* clear JTAG error register */
408 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x14, 0x400);
410 if ((empty
&0x400) != 0)
412 LOG_WARNING("RCLK timeout");
413 /* the error is informative only as we don't want to break the firmware if there
414 * is a false positive.
416 // return ERROR_FAIL;
425 static cyg_uint32
getShiftValue(void)
429 ZY1000_PEEK(ZY1000_JTAG_BASE
+ 0xc, value
);
430 VERBOSE(LOG_INFO("getShiftValue %08x", value
));
434 static cyg_uint32
getShiftValueFlip(void)
438 ZY1000_PEEK(ZY1000_JTAG_BASE
+ 0x18, value
);
439 VERBOSE(LOG_INFO("getShiftValue %08x (flipped)", value
));
445 static void shiftValueInnerFlip(const tap_state_t state
, const tap_state_t endState
, int repeat
, cyg_uint32 value
)
447 VERBOSE(LOG_INFO("shiftValueInner %s %s %d %08x (flipped)", tap_state_name(state
), tap_state_name(endState
), repeat
, value
));
451 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0xc, value
);
452 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x8, (1 << 15) | (repeat
<< 8) | (a
<< 4) | b
);
453 VERBOSE(getShiftValueFlip());
457 extern int jtag_check_value(uint8_t *captured
, void *priv
);
459 static void gotoEndState(tap_state_t end_state
)
461 setCurrentState(end_state
);
464 static __inline
void scanFields(int num_fields
, const scan_field_t
*fields
, tap_state_t shiftState
, int pause
)
470 for (i
= 0; i
< num_fields
; i
++)
474 uint8_t *inBuffer
= NULL
;
477 // figure out where to store the input data
478 int num_bits
= fields
[i
].num_bits
;
479 if (fields
[i
].in_value
!= NULL
)
481 inBuffer
= fields
[i
].in_value
;
484 // here we shuffle N bits out/in
488 tap_state_t pause_state
;
491 pause_state
= (shiftState
== TAP_DRSHIFT
)?TAP_DRSHIFT
:TAP_IRSHIFT
;
495 /* we have more to shift out */
496 } else if (pause
&&(i
== num_fields
-1))
498 /* this was the last to shift out this time */
499 pause_state
= (shiftState
==TAP_DRSHIFT
)?TAP_DRPAUSE
:TAP_IRPAUSE
;
502 // we have (num_bits + 7)/8 bytes of bits to toggle out.
503 // bits are pushed out LSB to MSB
505 if (fields
[i
].out_value
!= NULL
)
507 for (l
= 0; l
< k
; l
+= 8)
509 value
|=fields
[i
].out_value
[(j
+ l
)/8]<<l
;
512 /* mask away unused bits for easier debugging */
513 value
&=~(((uint32_t)0xffffffff) << k
);
515 shiftValueInner(shiftState
, pause_state
, k
, value
);
517 if (inBuffer
!= NULL
)
519 // data in, LSB to MSB
520 value
= getShiftValue();
521 // we're shifting in data to MSB, shift data to be aligned for returning the value
524 for (l
= 0; l
< k
; l
+= 8)
526 inBuffer
[(j
+ l
)/8]=(value
>> l
)&0xff;
534 int interface_jtag_set_end_state(tap_state_t state
)
540 int interface_jtag_add_ir_scan(int num_fields
, const scan_field_t
*fields
, tap_state_t state
)
545 jtag_tap_t
*tap
, *nextTap
;
546 for (tap
= jtag_tap_next_enabled(NULL
); tap
!= NULL
; tap
= nextTap
)
548 nextTap
= jtag_tap_next_enabled(tap
);
549 int pause
= (nextTap
==NULL
);
553 scan_size
= tap
->ir_length
;
555 /* search the list */
556 for (j
= 0; j
< num_fields
; j
++)
558 if (tap
== fields
[j
].tap
)
562 scanFields(1, fields
+ j
, TAP_IRSHIFT
, pause
);
563 /* update device information */
564 buf_cpy(fields
[j
].out_value
, tap
->cur_instr
, scan_size
);
573 /* if a device isn't listed, set it to BYPASS */
574 uint8_t ones
[]={0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff};
577 memset(&tmp
, 0, sizeof(tmp
));
578 tmp
.out_value
= ones
;
579 tmp
.num_bits
= scan_size
;
580 scanFields(1, &tmp
, TAP_IRSHIFT
, pause
);
581 /* update device information */
582 buf_cpy(tmp
.out_value
, tap
->cur_instr
, scan_size
);
595 int interface_jtag_add_plain_ir_scan(int num_fields
, const scan_field_t
*fields
, tap_state_t state
)
597 scanFields(num_fields
, fields
, TAP_IRSHIFT
, 1);
603 /*extern jtag_command_t **jtag_get_last_command_p(void);*/
605 int interface_jtag_add_dr_scan(int num_fields
, const scan_field_t
*fields
, tap_state_t state
)
609 jtag_tap_t
*tap
, *nextTap
;
610 for (tap
= jtag_tap_next_enabled(NULL
); tap
!= NULL
; tap
= nextTap
)
612 nextTap
= jtag_tap_next_enabled(tap
);
614 int pause
= (nextTap
==NULL
);
616 for (j
= 0; j
< num_fields
; j
++)
618 if (tap
== fields
[j
].tap
)
622 scanFields(1, fields
+j
, TAP_DRSHIFT
, pause
);
628 /* program the scan field to 1 bit length, and ignore it's value */
630 tmp
.out_value
= NULL
;
633 scanFields(1, &tmp
, TAP_DRSHIFT
, pause
);
643 int interface_jtag_add_plain_dr_scan(int num_fields
, const scan_field_t
*fields
, tap_state_t state
)
645 scanFields(num_fields
, fields
, TAP_DRSHIFT
, 1);
651 int interface_jtag_add_tlr()
653 setCurrentState(TAP_RESET
);
660 extern int jtag_nsrst_delay
;
661 extern int jtag_ntrst_delay
;
663 int interface_jtag_add_reset(int req_trst
, int req_srst
)
665 zy1000_reset(req_trst
, req_srst
);
669 static int zy1000_jtag_add_clocks(int num_cycles
, tap_state_t state
, tap_state_t clockstate
)
671 /* num_cycles can be 0 */
672 setCurrentState(clockstate
);
674 /* execute num_cycles, 32 at the time. */
676 for (i
= 0; i
< num_cycles
; i
+= 32)
680 if (num_cycles
-i
< num
)
684 shiftValueInner(clockstate
, clockstate
, num
, 0);
688 /* finish in end_state */
689 setCurrentState(state
);
691 tap_state_t t
= TAP_IDLE
;
692 /* test manual drive code on any target */
694 uint8_t tms_scan
= tap_get_tms_path(t
, state
);
695 int tms_count
= tap_get_tms_path_len(tap_get_state(), tap_get_end_state());
697 for (i
= 0; i
< tms_count
; i
++)
699 tms
= (tms_scan
>> i
) & 1;
701 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x28, tms
);
704 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x20, state
);
711 int interface_jtag_add_runtest(int num_cycles
, tap_state_t state
)
713 return zy1000_jtag_add_clocks(num_cycles
, state
, TAP_IDLE
);
716 int interface_jtag_add_clocks(int num_cycles
)
718 return zy1000_jtag_add_clocks(num_cycles
, cmd_queue_cur_state
, cmd_queue_cur_state
);
721 int interface_jtag_add_sleep(uint32_t us
)
727 int interface_jtag_add_pathmove(int num_states
, const tap_state_t
*path
)
732 /*wait for the fifo to be empty*/
737 tap_state_t cur_state
= cmd_queue_cur_state
;
741 if (tap_state_transition(cur_state
, false) == path
[state_count
])
745 else if (tap_state_transition(cur_state
, true) == path
[state_count
])
751 LOG_ERROR("BUG: %s -> %s isn't a valid TAP transition", tap_state_name(cur_state
), tap_state_name(path
[state_count
]));
756 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x28, tms
);
758 cur_state
= path
[state_count
];
764 ZY1000_POKE(ZY1000_JTAG_BASE
+ 0x20, cur_state
);
770 void embeddedice_write_dcc(jtag_tap_t
*tap
, int reg_addr
, uint8_t *buffer
, int little
, int count
)
772 // static int const reg_addr = 0x5;
773 tap_state_t end_state
= jtag_get_end_state();
774 if (jtag_tap_next_enabled(jtag_tap_next_enabled(NULL
)) == NULL
)
776 /* better performance via code duplication */
780 for (i
= 0; i
< count
; i
++)
782 shiftValueInner(TAP_DRSHIFT
, TAP_DRSHIFT
, 32, fast_target_buffer_get_u32(buffer
, 1));
783 shiftValueInner(TAP_DRSHIFT
, end_state
, 6, reg_addr
| (1 << 5));
789 for (i
= 0; i
< count
; i
++)
791 shiftValueInner(TAP_DRSHIFT
, TAP_DRSHIFT
, 32, fast_target_buffer_get_u32(buffer
, 0));
792 shiftValueInner(TAP_DRSHIFT
, end_state
, 6, reg_addr
| (1 << 5));
800 for (i
= 0; i
< count
; i
++)
802 embeddedice_write_reg_inner(tap
, reg_addr
, fast_target_buffer_get_u32(buffer
, little
));
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)