zy1000.c 16.8 KB
Newer Older
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
/***************************************************************************
 *   Copyright (C) 2007-2008 by yvind Harboe                              *
 *                                                                         *
 *   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

23
#include "embeddedice.h"
zwelch's avatar
zwelch committed
24
#include "minidriver.h"
25
#include "interface.h"
26
27
28
29
30

#include <cyg/hal/hal_io.h>             // low level i/o
#include <cyg/hal/hal_diag.h>


oharboe's avatar
oharboe committed
31
#define ZYLIN_VERSION "1.52"
32
33
#define ZYLIN_DATE __DATE__
#define ZYLIN_TIME __TIME__
oharboe's avatar
oharboe committed
34
#define ZYLIN_OPENOCD "$Revision$"
35
36
#define ZYLIN_OPENOCD_VERSION "Zylin JTAG ZY1000 " ZYLIN_VERSION " " ZYLIN_DATE " " ZYLIN_TIME
const char *zylin_config_dir="/config/settings";
37
38
39

/* low level command set
 */
40
41
42
int zy1000_read(void);
static void zy1000_write(int tck, int tms, int tdi);
void zy1000_reset(int trst, int srst);
43
44


45
46
47
48
int zy1000_speed(int speed);
int zy1000_register_commands(struct command_context_s *cmd_ctx);
int zy1000_init(void);
int zy1000_quit(void);
49
50

/* interface commands */
51
int zy1000_handle_zy1000_port_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc);
52

53
static int zy1000_khz(int khz, int *jtag_speed)
54
55
56
57
58
59
60
61
62
63
64
65
{
	if (khz==0)
	{
		*jtag_speed=0;
	}
	else
	{
		*jtag_speed=64000/khz;
	}
	return ERROR_OK;
}

66
static int zy1000_speed_div(int speed, int *khz)
67
68
69
70
71
72
73
74
75
76
77
78
79
{
	if (speed==0)
	{
		*khz = 0;
	}
	else
	{
		*khz=64000/speed;
	}

	return ERROR_OK;
}

80
static bool readPowerDropout(void)
81
82
83
{
	cyg_uint32 state;
	// sample and clear power dropout
oharboe's avatar
wip    
oharboe committed
84
85
	HAL_WRITE_UINT32(ZY1000_JTAG_BASE+0x10, 0x80);
	HAL_READ_UINT32(ZY1000_JTAG_BASE+0x10, state);
86
87
88
89
	bool powerDropout;
	powerDropout = (state & 0x80) != 0;
	return powerDropout;
}
90

91

92
static bool readSRST(void)
93
94
95
{
	cyg_uint32 state;
	// sample and clear SRST sensing
oharboe's avatar
wip    
oharboe committed
96
97
	HAL_WRITE_UINT32(ZY1000_JTAG_BASE+0x10, 0x00000040);
	HAL_READ_UINT32(ZY1000_JTAG_BASE+0x10, state);
98
99
100
101
102
	bool srstAsserted;
	srstAsserted = (state & 0x40) != 0;
	return srstAsserted;
}

oharboe's avatar
oharboe committed
103
104
105
106
107
108
static int zy1000_srst_asserted(int *srst_asserted)
{
	*srst_asserted=readSRST();
	return ERROR_OK;
}

109
110
static int zy1000_power_dropout(int *dropout)
{
oharboe's avatar
oharboe committed
111
	*dropout=readPowerDropout();
112
113
114
115
116
	return ERROR_OK;
}


jtag_interface_t zy1000_interface =
117
118
{
	.name = "ZY1000",
oharboe's avatar
oharboe committed
119
	.execute_queue = NULL,
120
121
122
123
124
125
126
	.speed = zy1000_speed,
	.register_commands = zy1000_register_commands,
	.init = zy1000_init,
	.quit = zy1000_quit,
	.khz = zy1000_khz,
	.speed_div = zy1000_speed_div,
	.power_dropout = zy1000_power_dropout,
oharboe's avatar
oharboe committed
127
	.srst_asserted = zy1000_srst_asserted,
128
129
};

130
static void zy1000_write(int tck, int tms, int tdi)
131
132
133
134
{

}

135
int zy1000_read(void)
136
137
138
139
{
	return -1;
}

140
extern bool readSRST(void);
141

142
void zy1000_reset(int trst, int srst)
143
144
145
146
{
	LOG_DEBUG("zy1000 trst=%d, srst=%d", trst, srst);
	if(!srst)
	{
oharboe's avatar
wip    
oharboe committed
147
		ZY1000_POKE(ZY1000_JTAG_BASE+0x14, 0x00000001);
148
149
150
151
	}
	else
	{
		/* Danger!!! if clk!=0 when in
152
		 * idle in TAP_IDLE, reset halt on str912 will fail.
153
		 */
oharboe's avatar
wip    
oharboe committed
154
		ZY1000_POKE(ZY1000_JTAG_BASE+0x10, 0x00000001);
155
156
157
158
	}

	if(!trst)
	{
oharboe's avatar
wip    
oharboe committed
159
		ZY1000_POKE(ZY1000_JTAG_BASE+0x14, 0x00000002);
160
161
162
163
	}
	else
	{
		/* assert reset */
oharboe's avatar
wip    
oharboe committed
164
		ZY1000_POKE(ZY1000_JTAG_BASE+0x10, 0x00000002);
165
	}
166

167
168
169
	if (trst||(srst&&(jtag_reset_config & RESET_SRST_PULLS_TRST)))
	{
		waitIdle();
170
		/* we're now in the RESET state until trst is deasserted */
171
		ZY1000_POKE(ZY1000_JTAG_BASE+0x20, TAP_RESET);
172
173
174
	} else
	{
		/* We'll get RCLK failure when we assert TRST, so clear any false positives here */
oharboe's avatar
wip    
oharboe committed
175
		ZY1000_POKE(ZY1000_JTAG_BASE+0x14, 0x400);
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
	}

	/* wait for srst to float back up */
	if (!srst)
	{
		int i;
		for (i=0; i<1000; i++)
		{
			// We don't want to sense our own reset, so we clear here.
			// There is of course a timing hole where we could loose
			// a "real" reset.
			if (!readSRST())
				break;

			/* wait 1ms */
			alive_sleep(1);
		}

		if (i==1000)
		{
			LOG_USER("SRST didn't deassert after %dms", i);
		} else if (i>1)
		{
			LOG_USER("SRST took %dms to deassert", i);
		}
	}
}

204
int zy1000_speed(int speed)
205
206
207
208
209
{
	if(speed == 0)
	{
		/*0 means RCLK*/
		speed = 0;
oharboe's avatar
wip    
oharboe committed
210
		ZY1000_POKE(ZY1000_JTAG_BASE+0x10, 0x100);
211
212
213
214
215
216
		LOG_DEBUG("jtag_speed using RCLK");
	}
	else
	{
		if(speed > 8190 || speed < 2)
		{
217
			LOG_USER("valid ZY1000 jtag_speed=[8190,2]. Divisor is 64MHz / even values between 8190-2, i.e. min 7814Hz, max 32MHz");
218
219
220
221
			return ERROR_INVALID_ARGUMENTS;
		}

		LOG_USER("jtag_speed %d => JTAG clk=%f", speed, 64.0/(float)speed);
oharboe's avatar
wip    
oharboe committed
222
223
		ZY1000_POKE(ZY1000_JTAG_BASE+0x14, 0x100);
		ZY1000_POKE(ZY1000_JTAG_BASE+0x1c, speed&~1);
224
225
226
227
	}
	return ERROR_OK;
}

228
static bool savePower;
229
230


231
static void setPower(bool power)
232
{
233
234
235
236
237
238
239
240
	savePower = power;
	if (power)
	{
		HAL_WRITE_UINT32(ZY1000_JTAG_BASE+0x14, 0x8);
	} else
	{
		HAL_WRITE_UINT32(ZY1000_JTAG_BASE+0x10, 0x8);
	}
241
242
}

243
int handle_power_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
244
{
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
	if (argc > 1)
	{
		return ERROR_INVALID_ARGUMENTS;
	}

	if (argc == 1)
	{
		if (strcmp(args[0], "on") == 0)
		{
			setPower(1);
		}
		else if (strcmp(args[0], "off") == 0)
		{
			setPower(0);
		} else
		{
			command_print(cmd_ctx, "arg is \"on\" or \"off\"");
			return ERROR_INVALID_ARGUMENTS;
		}
	}

	command_print(cmd_ctx, "Target power %s", savePower ? "on" : "off");
267
268
269
270
271

	return ERROR_OK;
}


272
/* Give TELNET a way to find out what version this is */
oharboe's avatar
oharboe committed
273
static int jim_zy1000_version(Jim_Interp *interp, int argc, Jim_Obj *const *argv)
274
{
oharboe's avatar
oharboe committed
275
276
277
278
279
280
	if ((argc < 1) || (argc > 2))
		return JIM_ERR;
	char buff[128];
	const char *version_str=NULL;

	if (argc == 1)
281
	{
oharboe's avatar
oharboe committed
282
283
		version_str=ZYLIN_OPENOCD_VERSION;
	} else
284
	{
oharboe's avatar
oharboe committed
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
		const char *str = Jim_GetString(argv[1], NULL);
		if (strcmp("openocd", str) == 0)
		{
			int revision;
			revision = atol(ZYLIN_OPENOCD+strlen("XRevision: "));
			sprintf(buff, "%d", revision);
			version_str=buff;
		}
		else if (strcmp("zy1000", str) == 0)
		{
			version_str=ZYLIN_VERSION;
		}
		else if (strcmp("date", str) == 0)
		{
			version_str=ZYLIN_DATE;
		}
		else
		{
			return JIM_ERR;
		}
305
	}
306

oharboe's avatar
oharboe committed
307
308
309
	Jim_SetResult(interp, Jim_NewStringObj(interp, version_str, -1));

	return JIM_OK;
310
311
}

312

oharboe's avatar
oharboe committed
313
314
static int
zylinjtag_Jim_Command_powerstatus(Jim_Interp *interp,
315
								   int argc,
oharboe's avatar
oharboe committed
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
		Jim_Obj * const *argv)
{
	if (argc != 1)
	{
		Jim_WrongNumArgs(interp, 1, argv, "powerstatus");
		return JIM_ERR;
	}

	cyg_uint32 status;
	ZY1000_PEEK(ZY1000_JTAG_BASE+0x10, status);

	Jim_SetResult(interp, Jim_NewIntObj(interp, (status&0x80)!=0));

	return JIM_OK;
}

332
333
334
335
int zy1000_register_commands(struct command_context_s *cmd_ctx)
{
	register_command(cmd_ctx, NULL, "power", handle_power_command, COMMAND_ANY,
			"power <on/off> - turn power switch to target on/off. No arguments - print status.");
oharboe's avatar
oharboe committed
336
337
338

	Jim_CreateCommand(interp, "zy1000_version", jim_zy1000_version, NULL, NULL);

339

oharboe's avatar
oharboe committed
340
	Jim_CreateCommand(interp, "powerstatus", zylinjtag_Jim_Command_powerstatus, NULL, NULL);
341

342
343
344
345
	return ERROR_OK;
}


oharboe's avatar
oharboe committed
346
347


348
349
int zy1000_init(void)
{
oharboe's avatar
oharboe committed
350
	LOG_USER("%s", ZYLIN_OPENOCD_VERSION);
351
352
353
354
355
356
357
358

	ZY1000_POKE(ZY1000_JTAG_BASE+0x10, 0x30); // Turn on LED1 & LED2

	setPower(true); // on by default


	 /* deassert resets. Important to avoid infinite loop waiting for SRST to deassert */
	zy1000_reset(0, 0);
359
	zy1000_speed(jtag_get_speed());
360
361
362
363
364
365
366
367

	return ERROR_OK;
}

int zy1000_quit(void)
{

	return ERROR_OK;
368
369
370
371
372
373
374
375
376
}



int interface_jtag_execute_queue(void)
{
	cyg_uint32 empty;

	waitIdle();
oharboe's avatar
wip    
oharboe committed
377
	ZY1000_PEEK(ZY1000_JTAG_BASE+0x10, empty);
378
	/* clear JTAG error register */
oharboe's avatar
wip    
oharboe committed
379
	ZY1000_POKE(ZY1000_JTAG_BASE+0x14, 0x400);
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395

	if ((empty&0x400)!=0)
	{
		LOG_WARNING("RCLK timeout");
		/* the error is informative only as we don't want to break the firmware if there
		 * is a false positive.
		 */
//		return ERROR_FAIL;
	}
	return ERROR_OK;
}





396
static cyg_uint32 getShiftValue(void)
397
398
399
{
	cyg_uint32 value;
	waitIdle();
oharboe's avatar
wip    
oharboe committed
400
	ZY1000_PEEK(ZY1000_JTAG_BASE+0xc, value);
401
402
403
404
	VERBOSE(LOG_INFO("getShiftValue %08x", value));
	return value;
}
#if 0
405
static cyg_uint32 getShiftValueFlip(void)
406
407
408
{
	cyg_uint32 value;
	waitIdle();
oharboe's avatar
wip    
oharboe committed
409
	ZY1000_PEEK(ZY1000_JTAG_BASE+0x18, value);
410
411
412
413
414
415
	VERBOSE(LOG_INFO("getShiftValue %08x (flipped)", value));
	return value;
}
#endif

#if 0
416
static void shiftValueInnerFlip(const tap_state_t state, const tap_state_t endState, int repeat, cyg_uint32 value)
417
{
418
	VERBOSE(LOG_INFO("shiftValueInner %s %s %d %08x (flipped)", tap_state_name(state), tap_state_name(endState), repeat, value));
419
420
421
	cyg_uint32 a,b;
	a=state;
	b=endState;
oharboe's avatar
wip    
oharboe committed
422
423
	ZY1000_POKE(ZY1000_JTAG_BASE+0xc, value);
	ZY1000_POKE(ZY1000_JTAG_BASE+0x8, (1<<15)|(repeat<<8)|(a<<4)|b);
424
425
426
427
428
429
	VERBOSE(getShiftValueFlip());
}
#endif

extern int jtag_check_value(u8 *captured, void *priv);

430
static __inline void scanFields(int num_fields, scan_field_t *fields, tap_state_t shiftState, tap_state_t end_state)
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
{
	int i;
	int j;
	int k;

	for (i = 0; i < num_fields; i++)
	{
		cyg_uint32 value;

		static u8 *in_buff=NULL; /* pointer to buffer for scanned data */
		static int in_buff_size=0;
		u8 *inBuffer=NULL;


		// figure out where to store the input data
		int num_bits=fields[i].num_bits;
		if (fields[i].in_value!=NULL)
		{
			inBuffer=fields[i].in_value;
		}

		// here we shuffle N bits out/in
		j=0;
		while (j<num_bits)
		{
456
			tap_state_t pause_state;
457
458
			int l;
			k=num_bits-j;
459
			pause_state=(shiftState==TAP_DRSHIFT)?TAP_DRSHIFT:TAP_IRSHIFT;
460
461
462
463
			if (k>32)
			{
				k=32;
				/* we have more to shift out */
464
			} else if (i == num_fields-1)
465
466
			{
				/* this was the last to shift out this time */
467
				pause_state=end_state;
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
			}

			// we have (num_bits+7)/8 bytes of bits to toggle out.
			// bits are pushed out LSB to MSB
			value=0;
			if (fields[i].out_value!=NULL)
			{
				for (l=0; l<k; l+=8)
				{
					value|=fields[i].out_value[(j+l)/8]<<l;
				}
			}
			/* mask away unused bits for easier debugging */
			value&=~(((u32)0xffffffff)<<k);

			shiftValueInner(shiftState, pause_state, k, value);

			if (inBuffer!=NULL)
			{
				// data in, LSB to MSB
				value=getShiftValue();
				// we're shifting in data to MSB, shift data to be aligned for returning the value
				value >>= 32-k;

				for (l=0; l<k; l+=8)
				{
					inBuffer[(j+l)/8]=(value>>l)&0xff;
				}
			}
			j+=k;
		}
	}
}

502
int interface_jtag_set_end_state(tap_state_t state)
503
504
505
506
507
{
	return ERROR_OK;
}


oharboe's avatar
oharboe committed
508
int interface_jtag_add_ir_scan(int num_fields, const scan_field_t *fields, tap_state_t state)
509
510
{

oharboe's avatar
oharboe committed
511
	int j;
512
	int scan_size = 0;
oharboe's avatar
oharboe committed
513
	jtag_tap_t *tap, *nextTap;
514
	for(tap = jtag_tap_next_enabled(NULL); tap!= NULL; tap=nextTap)
515
	{
516
		nextTap=jtag_tap_next_enabled(tap);
517
518
519
		tap_state_t end_state;
		if (nextTap==NULL)
		{
520
			end_state = state;
521
522
523
524
		} else
		{
			end_state = TAP_IRSHIFT;
		}
oharboe's avatar
oharboe committed
525

526
		int found = 0;
527

oharboe's avatar
oharboe committed
528
		scan_size = tap->ir_length;
529
530
531
532

		/* search the list */
		for (j=0; j < num_fields; j++)
		{
oharboe's avatar
oharboe committed
533
			if (tap == fields[j].tap)
534
535
536
			{
				found = 1;

537
				scanFields(1, fields+j, TAP_IRSHIFT, end_state);
538
				/* update device information */
oharboe's avatar
oharboe committed
539
				buf_cpy(fields[j].out_value, tap->cur_instr, scan_size);
540

oharboe's avatar
oharboe committed
541
				tap->bypass = 0;
542
543
544
545
546
547
548
549
550
551
552
553
554
				break;
			}
		}

		if (!found)
		{
			/* if a device isn't listed, set it to BYPASS */
			u8 ones[]={0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff};

			scan_field_t tmp;
			memset(&tmp, 0, sizeof(tmp));
			tmp.out_value = ones;
			tmp.num_bits = scan_size;
555
			scanFields(1, &tmp, TAP_IRSHIFT, end_state);
556
			/* update device information */
oharboe's avatar
oharboe committed
557
558
			buf_cpy(tmp.out_value, tap->cur_instr, scan_size);
			tap->bypass = 1;
559
560
561
562
563
564
565
566
567
568
		}
	}

	return ERROR_OK;
}





oharboe's avatar
oharboe committed
569
int interface_jtag_add_plain_ir_scan(int num_fields, const scan_field_t *fields, tap_state_t state)
570
{
571
	scanFields(num_fields, fields, TAP_IRSHIFT, state);
572
573
574
575
576
577

	return ERROR_OK;
}

/*extern jtag_command_t **jtag_get_last_command_p(void);*/

oharboe's avatar
oharboe committed
578
int interface_jtag_add_dr_scan(int num_fields, const scan_field_t *fields, tap_state_t state)
579
{
oharboe's avatar
oharboe committed
580
581
582

	int j;
	jtag_tap_t *tap, *nextTap;
583
	for(tap = jtag_tap_next_enabled(NULL); tap!= NULL; tap=nextTap)
584
	{
585
		nextTap=jtag_tap_next_enabled(tap);
oharboe's avatar
oharboe committed
586
		int found=0;
587
588
589
		tap_state_t end_state;
		if (nextTap==NULL)
		{
590
			end_state = state;
591
592
593
594
		} else
		{
			end_state = TAP_DRSHIFT;
		}
595
596
597

		for (j=0; j < num_fields; j++)
		{
oharboe's avatar
oharboe committed
598
			if (tap == fields[j].tap)
599
600
601
			{
				found = 1;

602
				scanFields(1, fields+j, TAP_DRSHIFT, end_state);
603
604
605
606
607
608
609
610
611
612
			}
		}
		if (!found)
		{
			scan_field_t tmp;
			/* program the scan field to 1 bit length, and ignore it's value */
			tmp.num_bits = 1;
			tmp.out_value = NULL;
			tmp.in_value = NULL;

613
			scanFields(1, &tmp, TAP_DRSHIFT, end_state);
614
615
616
617
618
619
620
621
		}
		else
		{
		}
	}
	return ERROR_OK;
}

oharboe's avatar
oharboe committed
622
int interface_jtag_add_plain_dr_scan(int num_fields, const scan_field_t *fields, tap_state_t state)
623
{
624
	scanFields(num_fields, fields, TAP_DRSHIFT, state);
625
626
627
628
629
630
	return ERROR_OK;
}


int interface_jtag_add_tlr()
{
631
	setCurrentState(TAP_RESET);
632
633
634
635
636
637
638
639
640
641
642
	return ERROR_OK;
}




extern int jtag_nsrst_delay;
extern int jtag_ntrst_delay;

int interface_jtag_add_reset(int req_trst, int req_srst)
{
643
	zy1000_reset(req_trst, req_srst);
644
645
646
	return ERROR_OK;
}

647
static int zy1000_jtag_add_clocks(int num_cycles, tap_state_t state, tap_state_t clockstate)
648
649
{
	/* num_cycles can be 0 */
650
	setCurrentState(clockstate);
651
652
653
654
655
656
657
658
659
660
661

	/* execute num_cycles, 32 at the time. */
	int i;
	for (i=0; i<num_cycles; i+=32)
	{
		int num;
		num=32;
		if (num_cycles-i<num)
		{
			num=num_cycles-i;
		}
662
		shiftValueInner(clockstate, clockstate, num, 0);
663
664
665
666
667
668
	}

#if !TEST_MANUAL()
	/* finish in end_state */
	setCurrentState(state);
#else
669
	tap_state_t t=TAP_IDLE;
670
671
	/* test manual drive code on any target */
	int tms;
672
	u8 tms_scan = tap_get_tms_path(t, state);
673
	int tms_count = tap_get_tms_path_len(tap_get_state(), tap_get_end_state());
674

675
	for (i = 0; i < tms_count; i++)
676
677
678
	{
		tms = (tms_scan >> i) & 1;
		waitIdle();
oharboe's avatar
wip    
oharboe committed
679
		ZY1000_POKE(ZY1000_JTAG_BASE+0x28,  tms);
680
681
	}
	waitIdle();
oharboe's avatar
wip    
oharboe committed
682
	ZY1000_POKE(ZY1000_JTAG_BASE+0x20, state);
683
684
685
686
687
688
#endif


	return ERROR_OK;
}

689
int interface_jtag_add_runtest(int num_cycles, tap_state_t state)
690
691
692
693
694
695
{
	return zy1000_jtag_add_clocks(num_cycles, state, TAP_IDLE);
}

int interface_jtag_add_clocks(int num_cycles)
{
696
	return zy1000_jtag_add_clocks(num_cycles, cmd_queue_cur_state, cmd_queue_cur_state);
697
698
}

699
700
701
702
703
704
int interface_jtag_add_sleep(u32 us)
{
	jtag_sleep(us);
	return ERROR_OK;
}

oharboe's avatar
oharboe committed
705
int interface_jtag_add_pathmove(int num_states, const tap_state_t *path)
706
707
708
709
710
711
712
713
714
{
	int state_count;
	int tms = 0;

	/*wait for the fifo to be empty*/
	waitIdle();

	state_count = 0;

715
	tap_state_t cur_state=cmd_queue_cur_state;
716
717
718

	while (num_states)
	{
719
		if (tap_state_transition(cur_state, false) == path[state_count])
720
721
722
		{
			tms = 0;
		}
723
		else if (tap_state_transition(cur_state, true) == path[state_count])
724
725
726
727
728
		{
			tms = 1;
		}
		else
		{
729
			LOG_ERROR("BUG: %s -> %s isn't a valid TAP transition", tap_state_name(cur_state), tap_state_name(path[state_count]));
730
731
732
733
			exit(-1);
		}

		waitIdle();
oharboe's avatar
wip    
oharboe committed
734
		ZY1000_POKE(ZY1000_JTAG_BASE+0x28,  tms);
735
736
737
738
739
740
741

		cur_state = path[state_count];
		state_count++;
		num_states--;
	}

	waitIdle();
oharboe's avatar
wip    
oharboe committed
742
	ZY1000_POKE(ZY1000_JTAG_BASE+0x20,  cur_state);
743
744
745
746
747
	return ERROR_OK;
}



oharboe's avatar
oharboe committed
748
void embeddedice_write_dcc(jtag_tap_t *tap, int reg_addr, u8 *buffer, int little, int count)
749
750
{
//	static int const reg_addr=0x5;
751
	tap_state_t end_state=jtag_get_end_state();
752
	if (jtag_tap_next_enabled(jtag_tap_next_enabled(NULL))==NULL)
753
754
755
756
757
758
759
	{
		/* better performance via code duplication */
		if (little)
		{
			int i;
			for (i = 0; i < count; i++)
			{
760
761
				shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, 32, fast_target_buffer_get_u32(buffer, 1));
				shiftValueInner(TAP_DRSHIFT, end_state, 6, reg_addr|(1<<5));
762
763
764
765
766
767
768
				buffer+=4;
			}
		} else
		{
			int i;
			for (i = 0; i < count; i++)
			{
769
770
				shiftValueInner(TAP_DRSHIFT, TAP_DRSHIFT, 32, fast_target_buffer_get_u32(buffer, 0));
				shiftValueInner(TAP_DRSHIFT, end_state, 6, reg_addr|(1<<5));
771
772
773
774
775
776
777
778
779
				buffer+=4;
			}
		}
	}
	else
	{
		int i;
		for (i = 0; i < count; i++)
		{
oharboe's avatar
oharboe committed
780
			embeddedice_write_reg_inner(tap, reg_addr, fast_target_buffer_get_u32(buffer, little));
781
782
783
784
785
			buffer += 4;
		}
	}
}

786
787
788
789
790
791
792
793
794
795
796
797
798
799
800
801
802
803
804
805
806
807
int loadFile(const char *fileName, void **data, int *len);

/* boolean parameter stored on config */
int boolParam(char *var)
{
	bool result = false;
	char *name = alloc_printf("%s/%s", zylin_config_dir, var);
	if (name == NULL)
		return result;

	void *data;
	int len;
	if (loadFile(name, &data, &len) == ERROR_OK)
	{
		if (len > 1)
			len = 1;
		result = strncmp((char *) data, "1", len) == 0;
		free(data);
	}
	free(name);
	return result;
}
808
809