target.c 117 KB
Newer Older
3001
3002
3003
3004
	writeLong(f, min); 			/* low_pc */
	writeLong(f, max);			/* high_pc */
	writeLong(f, length);		/* # of samples */
	writeLong(f, 64000000); 	/* 64MHz */
3005
	writeString(f, "seconds");
zwelch's avatar
zwelch committed
3006
	for (i = 0; i < (15-strlen("seconds")); i++)
3007
		writeData(f, &zero, 1);
3008
	writeString(f, "s");
oharboe's avatar
oharboe committed
3009

3010
	/*append binary memory gmon.out profile_hist_data (profile_hist_data + profile_hist_hdr.hist_size) */
oharboe's avatar
oharboe committed
3011

zwelch's avatar
zwelch committed
3012
	char *data = malloc(2*length);
zwelch's avatar
zwelch committed
3013
	if (data != NULL)
3014
	{
zwelch's avatar
zwelch committed
3015
		for (i = 0; i < length;i++)
3016
3017
		{
			int val;
zwelch's avatar
zwelch committed
3018
			val = buckets[i];
zwelch's avatar
zwelch committed
3019
			if (val > 65535)
3020
			{
zwelch's avatar
zwelch committed
3021
				val = 65535;
3022
3023
			}
			data[i*2]=val&0xff;
zwelch's avatar
zwelch committed
3024
			data[i*2 + 1]=(val >> 8)&0xff;
3025
3026
		}
		free(buckets);
3027
		writeData(f, data, length * 2);
3028
3029
3030
3031
3032
3033
3034
3035
3036
3037
		free(data);
	} else
	{
		free(buckets);
	}

	fclose(f);
}

/* profiling samples the CPU PC as quickly as OpenOCD is able, which will be used as a random sampling of PC */
3038
static int handle_profile_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
3039
3040
3041
{
	target_t *target = get_current_target(cmd_ctx);
	struct timeval timeout, now;
oharboe's avatar
oharboe committed
3042

3043
	gettimeofday(&timeout, NULL);
zwelch's avatar
zwelch committed
3044
	if (argc != 2)
3045
3046
3047
	{
		return ERROR_COMMAND_SYNTAX_ERROR;
	}
3048
3049
3050
3051
3052
3053
	unsigned offset;
	int retval = parse_uint(args[0], &offset);
	if (ERROR_OK != retval)
		return retval;

	timeval_add_time(&timeout, offset, 0);
oharboe's avatar
oharboe committed
3054

3055
3056
	command_print(cmd_ctx, "Starting profiling. Halting and resuming the target as often as we can...");

zwelch's avatar
zwelch committed
3057
3058
	static const int maxSample = 10000;
	uint32_t *samples = malloc(sizeof(uint32_t)*maxSample);
zwelch's avatar
zwelch committed
3059
	if (samples == NULL)
3060
		return ERROR_OK;
oharboe's avatar
oharboe committed
3061

zwelch's avatar
zwelch committed
3062
	int numSamples = 0;
3063
	/* hopefully it is safe to cache! We want to stop/restart as quickly as possible. */
3064
	reg_t *reg = register_get_by_name(target->reg_cache, "pc", 1);
oharboe's avatar
oharboe committed
3065

3066
3067
	for (;;)
	{
3068
		target_poll(target);
3069
3070
		if (target->state == TARGET_HALTED)
		{
3071
			uint32_t t=*((uint32_t *)reg->value);
3072
			samples[numSamples++]=t;
3073
3074
			retval = target_resume(target, 1, 0, 0, 0); /* current pc, addr = 0, do not handle breakpoints, not debugging */
			target_poll(target);
3075
			alive_sleep(10); /* sleep 10ms, i.e. <100 samples/second. */
3076
3077
		} else if (target->state == TARGET_RUNNING)
		{
3078
			/* We want to quickly sample the PC. */
zwelch's avatar
zwelch committed
3079
			if ((retval = target_halt(target)) != ERROR_OK)
3080
3081
3082
3083
			{
				free(samples);
				return retval;
			}
3084
3085
3086
		} else
		{
			command_print(cmd_ctx, "Target not halted or running");
zwelch's avatar
zwelch committed
3087
			retval = ERROR_OK;
3088
3089
			break;
		}
zwelch's avatar
zwelch committed
3090
		if (retval != ERROR_OK)
3091
3092
3093
		{
			break;
		}
oharboe's avatar
oharboe committed
3094

3095
		gettimeofday(&now, NULL);
zwelch's avatar
zwelch committed
3096
		if ((numSamples >= maxSample) || ((now.tv_sec >= timeout.tv_sec) && (now.tv_usec >= timeout.tv_usec)))
3097
3098
		{
			command_print(cmd_ctx, "Profiling completed. %d samples.", numSamples);
zwelch's avatar
zwelch committed
3099
			if ((retval = target_poll(target)) != ERROR_OK)
3100
3101
3102
3103
			{
				free(samples);
				return retval;
			}
3104
3105
			if (target->state == TARGET_HALTED)
			{
3106
				target_resume(target, 1, 0, 0, 0); /* current pc, addr = 0, do not handle breakpoints, not debugging */
3107
			}
zwelch's avatar
zwelch committed
3108
			if ((retval = target_poll(target)) != ERROR_OK)
3109
3110
3111
3112
			{
				free(samples);
				return retval;
			}
3113
3114
3115
3116
3117
3118
			writeGmon(samples, numSamples, args[1]);
			command_print(cmd_ctx, "Wrote %s", args[1]);
			break;
		}
	}
	free(samples);
oharboe's avatar
oharboe committed
3119

3120
3121
	return ERROR_OK;
}
3122

3123
static int new_int_array_element(Jim_Interp * interp, const char *varname, int idx, uint32_t val)
3124
3125
3126
3127
3128
3129
3130
3131
{
	char *namebuf;
	Jim_Obj *nameObjPtr, *valObjPtr;
	int result;

	namebuf = alloc_printf("%s(%d)", varname, idx);
	if (!namebuf)
		return JIM_ERR;
oharboe's avatar
oharboe committed
3132

3133
3134
3135
3136
3137
3138
3139
3140
3141
3142
3143
3144
3145
3146
3147
3148
3149
3150
3151
3152
3153
	nameObjPtr = Jim_NewStringObj(interp, namebuf, -1);
	valObjPtr = Jim_NewIntObj(interp, val);
	if (!nameObjPtr || !valObjPtr)
	{
		free(namebuf);
		return JIM_ERR;
	}

	Jim_IncrRefCount(nameObjPtr);
	Jim_IncrRefCount(valObjPtr);
	result = Jim_SetVariable(interp, nameObjPtr, valObjPtr);
	Jim_DecrRefCount(interp, nameObjPtr);
	Jim_DecrRefCount(interp, valObjPtr);
	free(namebuf);
	/* printf("%s(%d) <= 0%08x\n", varname, idx, val); */
	return result;
}

static int jim_mem2array(Jim_Interp *interp, int argc, Jim_Obj *const *argv)
{
	command_context_t *context;
3154
3155
3156
3157
3158
3159
3160
3161
3162
3163
3164
3165
3166
3167
3168
	target_t *target;

	context = Jim_GetAssocData(interp, "context");
	if (context == NULL)
	{
		LOG_ERROR("mem2array: no command context");
		return JIM_ERR;
	}
	target = get_current_target(context);
	if (target == NULL)
	{
		LOG_ERROR("mem2array: no current target");
		return JIM_ERR;
	}

zwelch's avatar
zwelch committed
3169
	return 	target_mem2array(interp, target, argc-1, argv + 1);
3170
3171
3172
3173
}

static int target_mem2array(Jim_Interp *interp, target_t *target, int argc, Jim_Obj *const *argv)
{
3174
	long l;
3175
	uint32_t width;
3176
	int len;
3177
3178
3179
	uint32_t addr;
	uint32_t count;
	uint32_t v;
3180
	const char *varname;
3181
	uint8_t buffer[4096];
3182
	int  n, e, retval;
3183
	uint32_t i;
3184
3185
3186

	/* argv[1] = name of array to receive the data
	 * argv[2] = desired width
oharboe's avatar
oharboe committed
3187
	 * argv[3] = memory address
3188
3189
	 * argv[4] = count of times to read
	 */
3190
	if (argc != 4) {
3191
3192
3193
		Jim_WrongNumArgs(interp, 1, argv, "varname width addr nelems");
		return JIM_ERR;
	}
3194
	varname = Jim_GetString(argv[0], &len);
3195
3196
	/* given "foo" get space for worse case "foo(%d)" .. add 20 */

3197
	e = Jim_GetLong(interp, argv[1], &l);
3198
3199
3200
3201
	width = l;
	if (e != JIM_OK) {
		return e;
	}
oharboe's avatar
oharboe committed
3202

3203
	e = Jim_GetLong(interp, argv[2], &l);
3204
3205
3206
3207
	addr = l;
	if (e != JIM_OK) {
		return e;
	}
3208
	e = Jim_GetLong(interp, argv[3], &l);
3209
3210
3211
3212
3213
3214
3215
3216
3217
3218
3219
3220
3221
3222
3223
3224
	len = l;
	if (e != JIM_OK) {
		return e;
	}
	switch (width) {
		case 8:
			width = 1;
			break;
		case 16:
			width = 2;
			break;
		case 32:
			width = 4;
			break;
		default:
			Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
3225
			Jim_AppendStrings(interp, Jim_GetResult(interp), "Invalid width param, must be 8/16/32", NULL);
3226
3227
3228
3229
3230
3231
3232
3233
3234
3235
3236
3237
3238
3239
3240
3241
3242
			return JIM_ERR;
	}
	if (len == 0) {
		Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
		Jim_AppendStrings(interp, Jim_GetResult(interp), "mem2array: zero width read?", NULL);
		return JIM_ERR;
	}
	if ((addr + (len * width)) < addr) {
		Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
		Jim_AppendStrings(interp, Jim_GetResult(interp), "mem2array: addr + len - wraps to zero?", NULL);
		return JIM_ERR;
	}
	/* absurd transfer size? */
	if (len > 65536) {
		Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
		Jim_AppendStrings(interp, Jim_GetResult(interp), "mem2array: absurd > 64K item request", NULL);
		return JIM_ERR;
oharboe's avatar
oharboe committed
3243
3244
	}

3245
3246
3247
3248
3249
3250
3251
	if ((width == 1) ||
		((width == 2) && ((addr & 1) == 0)) ||
		((width == 4) && ((addr & 3) == 0))) {
		/* all is well */
	} else {
		char buf[100];
		Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
3252
3253
		sprintf(buf, "mem2array address: 0x%08" PRIx32 " is not aligned for %" PRId32 " byte reads",
				addr,
duane's avatar
duane committed
3254
				width);
3255
3256
3257
3258
3259
3260
3261
3262
3263
3264
3265
3266
		Jim_AppendStrings(interp, Jim_GetResult(interp), buf , NULL);
		return JIM_ERR;
	}

	/* Transfer loop */

	/* index counter */
	n = 0;
	/* assume ok */
	e = JIM_OK;
	while (len) {
		/* Slurp... in buffer size chunks */
oharboe's avatar
oharboe committed
3267

3268
3269
3270
3271
		count = len; /* in objects.. */
		if (count > (sizeof(buffer)/width)) {
			count = (sizeof(buffer)/width);
		}
oharboe's avatar
oharboe committed
3272

3273
		retval = target_read_memory(target, addr, width, count, buffer);
3274
3275
		if (retval != ERROR_OK) {
			/* BOO !*/
3276
3277
3278
			LOG_ERROR("mem2array: Read @ 0x%08x, w=%d, cnt=%d, failed",
					  (unsigned int)addr,
					  (int)width,
duane's avatar
duane committed
3279
					  (int)count);
3280
3281
3282
3283
3284
3285
3286
3287
3288
3289
3290
3291
3292
3293
3294
3295
3296
3297
3298
3299
3300
3301
3302
			Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
			Jim_AppendStrings(interp, Jim_GetResult(interp), "mem2array: cannot read memory", NULL);
			e = JIM_ERR;
			len = 0;
		} else {
			v = 0; /* shut up gcc */
			for (i = 0 ;i < count ;i++, n++) {
				switch (width) {
					case 4:
						v = target_buffer_get_u32(target, &buffer[i*width]);
						break;
					case 2:
						v = target_buffer_get_u16(target, &buffer[i*width]);
						break;
					case 1:
						v = buffer[i] & 0x0ff;
						break;
				}
				new_int_array_element(interp, varname, n, v);
			}
			len -= count;
		}
	}
oharboe's avatar
oharboe committed
3303

3304
3305
3306
3307
3308
	Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));

	return JIM_OK;
}

3309
static int get_int_array_element(Jim_Interp * interp, const char *varname, int idx, uint32_t *val)
3310
3311
3312
3313
3314
3315
3316
3317
3318
3319
3320
3321
3322
3323
3324
3325
3326
3327
3328
3329
3330
3331
3332
3333
3334
3335
3336
3337
3338
3339
3340
3341
3342
{
	char *namebuf;
	Jim_Obj *nameObjPtr, *valObjPtr;
	int result;
	long l;

	namebuf = alloc_printf("%s(%d)", varname, idx);
	if (!namebuf)
		return JIM_ERR;

	nameObjPtr = Jim_NewStringObj(interp, namebuf, -1);
	if (!nameObjPtr)
	{
		free(namebuf);
		return JIM_ERR;
	}

	Jim_IncrRefCount(nameObjPtr);
	valObjPtr = Jim_GetVariable(interp, nameObjPtr, JIM_ERRMSG);
	Jim_DecrRefCount(interp, nameObjPtr);
	free(namebuf);
	if (valObjPtr == NULL)
		return JIM_ERR;

	result = Jim_GetLong(interp, valObjPtr, &l);
	/* printf("%s(%d) => 0%08x\n", varname, idx, val); */
	*val = l;
	return result;
}

static int jim_array2mem(Jim_Interp *interp, int argc, Jim_Obj *const *argv)
{
	command_context_t *context;
3343
	target_t *target;
3344

3345
	context = Jim_GetAssocData(interp, "context");
zwelch's avatar
zwelch committed
3346
	if (context == NULL) {
3347
3348
3349
3350
		LOG_ERROR("array2mem: no command context");
		return JIM_ERR;
	}
	target = get_current_target(context);
zwelch's avatar
zwelch committed
3351
	if (target == NULL) {
3352
3353
3354
		LOG_ERROR("array2mem: no current target");
		return JIM_ERR;
	}
3355

3356
	return target_array2mem(interp,target, argc-1, argv + 1);
3357
}
3358

3359
3360
static int target_array2mem(Jim_Interp *interp, target_t *target, int argc, Jim_Obj *const *argv)
{
3361
	long l;
3362
	uint32_t width;
3363
	int len;
3364
3365
3366
	uint32_t addr;
	uint32_t count;
	uint32_t v;
3367
	const char *varname;
3368
	uint8_t buffer[4096];
3369
	int  n, e, retval;
3370
	uint32_t i;
3371
3372
3373

	/* argv[1] = name of array to get the data
	 * argv[2] = desired width
oharboe's avatar
oharboe committed
3374
	 * argv[3] = memory address
3375
3376
	 * argv[4] = count to write
	 */
3377
	if (argc != 4) {
3378
3379
3380
		Jim_WrongNumArgs(interp, 1, argv, "varname width addr nelems");
		return JIM_ERR;
	}
3381
	varname = Jim_GetString(argv[0], &len);
3382
3383
	/* given "foo" get space for worse case "foo(%d)" .. add 20 */

3384
	e = Jim_GetLong(interp, argv[1], &l);
3385
3386
3387
3388
	width = l;
	if (e != JIM_OK) {
		return e;
	}
oharboe's avatar
oharboe committed
3389

3390
	e = Jim_GetLong(interp, argv[2], &l);
3391
3392
3393
3394
	addr = l;
	if (e != JIM_OK) {
		return e;
	}
3395
	e = Jim_GetLong(interp, argv[3], &l);
3396
3397
3398
3399
3400
3401
3402
3403
3404
3405
3406
3407
3408
3409
3410
3411
	len = l;
	if (e != JIM_OK) {
		return e;
	}
	switch (width) {
		case 8:
			width = 1;
			break;
		case 16:
			width = 2;
			break;
		case 32:
			width = 4;
			break;
		default:
			Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
3412
			Jim_AppendStrings(interp, Jim_GetResult(interp), "Invalid width param, must be 8/16/32", NULL);
3413
3414
3415
3416
3417
3418
3419
3420
3421
3422
3423
3424
3425
3426
3427
3428
3429
			return JIM_ERR;
	}
	if (len == 0) {
		Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
		Jim_AppendStrings(interp, Jim_GetResult(interp), "array2mem: zero width read?", NULL);
		return JIM_ERR;
	}
	if ((addr + (len * width)) < addr) {
		Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
		Jim_AppendStrings(interp, Jim_GetResult(interp), "array2mem: addr + len - wraps to zero?", NULL);
		return JIM_ERR;
	}
	/* absurd transfer size? */
	if (len > 65536) {
		Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
		Jim_AppendStrings(interp, Jim_GetResult(interp), "array2mem: absurd > 64K item request", NULL);
		return JIM_ERR;
oharboe's avatar
oharboe committed
3430
3431
	}

3432
3433
3434
3435
3436
3437
3438
	if ((width == 1) ||
		((width == 2) && ((addr & 1) == 0)) ||
		((width == 4) && ((addr & 3) == 0))) {
		/* all is well */
	} else {
		char buf[100];
		Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
3439
3440
		sprintf(buf, "array2mem address: 0x%08x is not aligned for %d byte reads",
				(unsigned int)addr,
duane's avatar
duane committed
3441
				(int)width);
3442
3443
3444
3445
3446
3447
3448
3449
3450
3451
3452
3453
		Jim_AppendStrings(interp, Jim_GetResult(interp), buf , NULL);
		return JIM_ERR;
	}

	/* Transfer loop */

	/* index counter */
	n = 0;
	/* assume ok */
	e = JIM_OK;
	while (len) {
		/* Slurp... in buffer size chunks */
oharboe's avatar
oharboe committed
3454

3455
3456
3457
3458
3459
3460
3461
3462
3463
3464
3465
3466
3467
3468
3469
3470
3471
3472
3473
3474
3475
3476
		count = len; /* in objects.. */
		if (count > (sizeof(buffer)/width)) {
			count = (sizeof(buffer)/width);
		}

		v = 0; /* shut up gcc */
		for (i = 0 ;i < count ;i++, n++) {
			get_int_array_element(interp, varname, n, &v);
			switch (width) {
			case 4:
				target_buffer_set_u32(target, &buffer[i*width], v);
				break;
			case 2:
				target_buffer_set_u16(target, &buffer[i*width], v);
				break;
			case 1:
				buffer[i] = v & 0x0ff;
				break;
			}
		}
		len -= count;

zwelch's avatar
zwelch committed
3477
		retval = target_write_memory(target, addr, width, count, buffer);
3478
3479
		if (retval != ERROR_OK) {
			/* BOO !*/
3480
3481
3482
			LOG_ERROR("array2mem: Write @ 0x%08x, w=%d, cnt=%d, failed",
					  (unsigned int)addr,
					  (int)width,
duane's avatar
duane committed
3483
					  (int)count);
3484
			Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));
3485
			Jim_AppendStrings(interp, Jim_GetResult(interp), "array2mem: cannot read memory", NULL);
3486
3487
3488
3489
			e = JIM_ERR;
			len = 0;
		}
	}
oharboe's avatar
oharboe committed
3490

3491
3492
3493
3494
	Jim_SetResult(interp, Jim_NewEmptyStringObj(interp));

	return JIM_OK;
}
3495

3496
void target_all_handle_event(enum target_event e)
3497
3498
3499
{
	target_t *target;

3500
	LOG_DEBUG("**all*targets: event: %d, %s",
duane's avatar
duane committed
3501
			   (int)e,
3502
			   Jim_Nvp_value2name_simple(nvp_target_event, e)->name);
3503
3504

	target = all_targets;
zwelch's avatar
zwelch committed
3505
	while (target) {
3506
		target_handle_event(target, e);
3507
3508
3509
3510
		target = target->next;
	}
}

3511
3512
3513
3514

/* FIX? should we propagate errors here rather than printing them
 * and continuing?
 */
3515
void target_handle_event(target_t *target, enum target_event e)
3516
3517
3518
{
	target_event_action_t *teap;

dbrownell's avatar
dbrownell committed
3519
	for (teap = target->event_action; teap != NULL; teap = teap->next) {
zwelch's avatar
zwelch committed
3520
		if (teap->event == e) {
3521
			LOG_DEBUG("target: (%d) %s (%s) event: %d (%s) action: %s",
3522
3523
					   target->target_number,
					   target->cmd_name,
zwelch's avatar
zwelch committed
3524
					   target_get_name(target),
3525
					   e,
3526
3527
3528
					   Jim_Nvp_value2name_simple(nvp_target_event, e)->name,
					   Jim_GetString(teap->body, NULL));
			if (Jim_EvalObj(interp, teap->body) != JIM_OK)
3529
3530
3531
			{
				Jim_PrintErrorMessage(interp);
			}
3532
3533
3534
3535
3536
3537
		}
	}
}

enum target_cfg_param {
	TCFG_TYPE,
3538
	TCFG_EVENT,
3539
3540
3541
3542
3543
3544
3545
3546
3547
3548
3549
3550
3551
3552
3553
3554
3555
3556
3557
	TCFG_WORK_AREA_VIRT,
	TCFG_WORK_AREA_PHYS,
	TCFG_WORK_AREA_SIZE,
	TCFG_WORK_AREA_BACKUP,
	TCFG_ENDIAN,
	TCFG_VARIANT,
	TCFG_CHAIN_POSITION,
};

static Jim_Nvp nvp_config_opts[] = {
	{ .name = "-type",             .value = TCFG_TYPE },
	{ .name = "-event",            .value = TCFG_EVENT },
	{ .name = "-work-area-virt",   .value = TCFG_WORK_AREA_VIRT },
	{ .name = "-work-area-phys",   .value = TCFG_WORK_AREA_PHYS },
	{ .name = "-work-area-size",   .value = TCFG_WORK_AREA_SIZE },
	{ .name = "-work-area-backup", .value = TCFG_WORK_AREA_BACKUP },
	{ .name = "-endian" ,          .value = TCFG_ENDIAN },
	{ .name = "-variant",          .value = TCFG_VARIANT },
	{ .name = "-chain-position",   .value = TCFG_CHAIN_POSITION },
3558

3559
3560
	{ .name = NULL, .value = -1 }
};
3561

3562
static int target_configure(Jim_GetOptInfo *goi, target_t *target)
3563
3564
3565
3566
3567
3568
3569
3570
{
	Jim_Nvp *n;
	Jim_Obj *o;
	jim_wide w;
	char *cp;
	int e;

	/* parse config or cget options ... */
zwelch's avatar
zwelch committed
3571
	while (goi->argc > 0) {
3572
3573
		Jim_SetEmptyResult(goi->interp);
		/* Jim_GetOpt_Debug(goi); */
3574

zwelch's avatar
zwelch committed
3575
		if (target->type->target_jim_configure) {
3576
3577
			/* target defines a configure function */
			/* target gets first dibs on parameters */
3578
			e = (*(target->type->target_jim_configure))(target, goi);
zwelch's avatar
zwelch committed
3579
			if (e == JIM_OK) {
3580
3581
3582
				/* more? */
				continue;
			}
zwelch's avatar
zwelch committed
3583
			if (e == JIM_ERR) {
3584
3585
3586
3587
3588
				/* An error */
				return e;
			}
			/* otherwise we 'continue' below */
		}
3589
		e = Jim_GetOpt_Nvp(goi, nvp_config_opts, &n);
zwelch's avatar
zwelch committed
3590
		if (e != JIM_OK) {
3591
			Jim_GetOpt_NvpUnknown(goi, nvp_config_opts, 0);
3592
3593
			return e;
		}
zwelch's avatar
zwelch committed
3594
		switch (n->value) {
3595
3596
		case TCFG_TYPE:
			/* not setable */
zwelch's avatar
zwelch committed
3597
			if (goi->isconfigure) {
3598
				Jim_SetResult_sprintf(goi->interp, "not setable: %s", n->name);
3599
3600
3601
				return JIM_ERR;
			} else {
			no_params:
zwelch's avatar
zwelch committed
3602
				if (goi->argc != 0) {
3603
					Jim_WrongNumArgs(goi->interp, goi->argc, goi->argv, "NO PARAMS");
3604
3605
3606
					return JIM_ERR;
				}
			}
3607
			Jim_SetResultString(goi->interp, target_get_name(target), -1);
3608
3609
3610
			/* loop for more */
			break;
		case TCFG_EVENT:
zwelch's avatar
zwelch committed
3611
			if (goi->argc == 0) {
3612
				Jim_WrongNumArgs(goi->interp, goi->argc, goi->argv, "-event ?event-name? ...");
3613
3614
3615
				return JIM_ERR;
			}

3616
			e = Jim_GetOpt_Nvp(goi, nvp_target_event, &n);
zwelch's avatar
zwelch committed
3617
			if (e != JIM_OK) {
3618
				Jim_GetOpt_NvpUnknown(goi, nvp_target_event, 1);
3619
3620
3621
				return e;
			}

zwelch's avatar
zwelch committed
3622
3623
			if (goi->isconfigure) {
				if (goi->argc != 1) {
3624
					Jim_WrongNumArgs(goi->interp, goi->argc, goi->argv, "-event ?event-name? ?EVENT-BODY?");
3625
					return JIM_ERR;
3626
				}
3627
			} else {
zwelch's avatar
zwelch committed
3628
				if (goi->argc != 0) {
3629
3630
3631
3632
3633
					Jim_WrongNumArgs(goi->interp, goi->argc, goi->argv, "-event ?event-name?");
					return JIM_ERR;
				}
			}

3634
			{
3635
				target_event_action_t *teap;
3636

3637
3638
				teap = target->event_action;
				/* replace existing? */
zwelch's avatar
zwelch committed
3639
3640
				while (teap) {
					if (teap->event == (enum target_event)n->value) {
3641
3642
3643
3644
						break;
					}
					teap = teap->next;
				}
3645

zwelch's avatar
zwelch committed
3646
				if (goi->isconfigure) {
3647
					bool replace = true;
zwelch's avatar
zwelch committed
3648
					if (teap == NULL) {
3649
						/* create new */
3650
						teap = calloc(1, sizeof(*teap));
3651
						replace = false;
3652
3653
					}
					teap->event = n->value;
3654
					Jim_GetOpt_Obj(goi, &o);
zwelch's avatar
zwelch committed
3655
					if (teap->body) {
3656
						Jim_DecrRefCount(interp, teap->body);
3657
					}
3658
					teap->body  = Jim_DuplicateObj(goi->interp, o);
3659
					/*
3660
					 * FIXME:
3661
3662
3663
3664
3665
3666
3667
3668
					 *     Tcl/TK - "tk events" have a nice feature.
					 *     See the "BIND" command.
					 *    We should support that here.
					 *     You can specify %X and %Y in the event code.
					 *     The idea is: %T - target name.
					 *     The idea is: %N - target number
					 *     The idea is: %E - event name.
					 */
3669
					Jim_IncrRefCount(teap->body);
3670

3671
3672
3673
3674
3675
3676
					if (!replace)
					{
						/* add to head of event list */
						teap->next = target->event_action;
						target->event_action = teap;
					}
3677
3678
3679
					Jim_SetEmptyResult(goi->interp);
				} else {
					/* get */
zwelch's avatar
zwelch committed
3680
					if (teap == NULL) {
3681
						Jim_SetEmptyResult(goi->interp);
3682
					} else {
3683
						Jim_SetResult(goi->interp, Jim_DuplicateObj(goi->interp, teap->body));
3684
3685
3686
3687
3688
3689
3690
					}
				}
			}
			/* loop for more */
			break;

		case TCFG_WORK_AREA_VIRT:
zwelch's avatar
zwelch committed
3691
			if (goi->isconfigure) {
3692
				target_free_all_working_areas(target);
3693
				e = Jim_GetOpt_Wide(goi, &w);
zwelch's avatar
zwelch committed
3694
				if (e != JIM_OK) {
3695
3696
3697
3698
					return e;
				}
				target->working_area_virt = w;
			} else {
zwelch's avatar
zwelch committed
3699
				if (goi->argc != 0) {
3700
3701
					goto no_params;
				}
3702
			}
3703
			Jim_SetResult(interp, Jim_NewIntObj(goi->interp, target->working_area_virt));
3704
3705
			/* loop for more */
			break;
3706

3707
		case TCFG_WORK_AREA_PHYS:
zwelch's avatar
zwelch committed
3708
			if (goi->isconfigure) {
3709
				target_free_all_working_areas(target);
3710
				e = Jim_GetOpt_Wide(goi, &w);
zwelch's avatar
zwelch committed
3711
				if (e != JIM_OK) {
3712
3713
3714
3715
					return e;
				}
				target->working_area_phys = w;
			} else {
zwelch's avatar
zwelch committed
3716
				if (goi->argc != 0) {
3717
3718
					goto no_params;
				}
3719
			}
3720
			Jim_SetResult(interp, Jim_NewIntObj(goi->interp, target->working_area_phys));
3721
3722
3723
3724
			/* loop for more */
			break;

		case TCFG_WORK_AREA_SIZE:
zwelch's avatar
zwelch committed
3725
			if (goi->isconfigure) {
3726
				target_free_all_working_areas(target);
3727
				e = Jim_GetOpt_Wide(goi, &w);
zwelch's avatar
zwelch committed
3728
				if (e != JIM_OK) {
3729
3730
3731
3732
					return e;
				}
				target->working_area_size = w;
			} else {
zwelch's avatar
zwelch committed
3733
				if (goi->argc != 0) {
3734
3735
					goto no_params;
				}
3736
			}
3737
			Jim_SetResult(interp, Jim_NewIntObj(goi->interp, target->working_area_size));
3738
3739
3740
3741
			/* loop for more */
			break;

		case TCFG_WORK_AREA_BACKUP:
zwelch's avatar
zwelch committed
3742
			if (goi->isconfigure) {
3743
				target_free_all_working_areas(target);
3744
				e = Jim_GetOpt_Wide(goi, &w);
zwelch's avatar
zwelch committed
3745
				if (e != JIM_OK) {
3746
3747
3748
3749
3750
					return e;
				}
				/* make this exactly 1 or 0 */
				target->backup_working_area = (!!w);
			} else {
zwelch's avatar
zwelch committed
3751
				if (goi->argc != 0) {
3752
3753
					goto no_params;
				}
3754
			}
3755
			Jim_SetResult(interp, Jim_NewIntObj(goi->interp, target->backup_working_area));
3756
3757
3758
3759
			/* loop for more e*/
			break;

		case TCFG_ENDIAN:
zwelch's avatar
zwelch committed
3760
			if (goi->isconfigure) {
3761
				e = Jim_GetOpt_Nvp(goi, nvp_target_endian, &n);
zwelch's avatar
zwelch committed
3762
				if (e != JIM_OK) {
3763
					Jim_GetOpt_NvpUnknown(goi, nvp_target_endian, 1);
3764
3765
3766
3767
					return e;
				}
				target->endianness = n->value;
			} else {
zwelch's avatar
zwelch committed
3768
				if (goi->argc != 0) {
3769
3770
3771
					goto no_params;
				}
			}
3772
			n = Jim_Nvp_value2name_simple(nvp_target_endian, target->endianness);
zwelch's avatar
zwelch committed
3773
			if (n->name == NULL) {
3774
				target->endianness = TARGET_LITTLE_ENDIAN;
3775
				n = Jim_Nvp_value2name_simple(nvp_target_endian, target->endianness);
3776
			}
3777
			Jim_SetResultString(goi->interp, n->name, -1);
3778
3779
3780
3781
			/* loop for more */
			break;

		case TCFG_VARIANT:
zwelch's avatar
zwelch committed
3782
3783
			if (goi->isconfigure) {
				if (goi->argc < 1) {
3784
					Jim_SetResult_sprintf(goi->interp,
3785
										   "%s ?STRING?",
3786
										   n->name);
3787
3788
					return JIM_ERR;
				}
zwelch's avatar
zwelch committed
3789
				if (target->variant) {
3790
3791
					free((void *)(target->variant));
				}
3792
				e = Jim_GetOpt_String(goi, &cp, NULL);
3793
3794
				target->variant = strdup(cp);
			} else {
zwelch's avatar
zwelch committed
3795
				if (goi->argc != 0) {
3796
3797
					goto no_params;
				}
3798
			}
3799
			Jim_SetResultString(goi->interp, target->variant,-1);
3800
3801
3802
			/* loop for more */
			break;
		case TCFG_CHAIN_POSITION:
zwelch's avatar
zwelch committed
3803
			if (goi->isconfigure) {
3804
3805
				Jim_Obj *o;
				jtag_tap_t *tap;
3806
				target_free_all_working_areas(target);
3807
				e = Jim_GetOpt_Obj(goi, &o);
zwelch's avatar
zwelch committed
3808
				if (e != JIM_OK) {
3809
3810
					return e;
				}
3811
				tap = jtag_tap_by_jim_obj(goi->interp, o);
zwelch's avatar
zwelch committed
3812
				if (tap == NULL) {
3813
					return JIM_ERR;
3814
				}
3815
				/* make this exactly 1 or 0 */
3816
				target->tap = tap;
3817
			} else {
zwelch's avatar
zwelch committed
3818
				if (goi->argc != 0) {
3819
3820
					goto no_params;
				}
3821
			}
3822
			Jim_SetResultString(interp, target->tap->dotted_name, -1);
3823
3824
3825
			/* loop for more e*/
			break;
		}
3826
	} /* while (goi->argc) */
3827
3828


3829
		/* done - we return */
3830
3831
3832
3833
	return JIM_OK;
}

/** this is the 'tcl' handler for the target specific command */
3834
static int tcl_target_func(Jim_Interp *interp, int argc, Jim_Obj *const *argv)
3835
3836
3837
3838
{
	Jim_GetOptInfo goi;
	jim_wide a,b,c;
	int x,y,z;
3839
	uint8_t  target_buf[32];
3840
3841
3842
3843
3844
3845
3846
3847
	Jim_Nvp *n;
	target_t *target;
	struct command_context_s *cmd_ctx;
	int e;

	enum {
		TS_CMD_CONFIGURE,
		TS_CMD_CGET,
3848

3849
3850
3851
3852
		TS_CMD_MWW, TS_CMD_MWH, TS_CMD_MWB,
		TS_CMD_MDW, TS_CMD_MDH, TS_CMD_MDB,
		TS_CMD_MRW, TS_CMD_MRH, TS_CMD_MRB,
		TS_CMD_MEM2ARRAY, TS_CMD_ARRAY2MEM,
3853
		TS_CMD_EXAMINE,
3854
3855
3856
3857
3858
3859
		TS_CMD_POLL,
		TS_CMD_RESET,
		TS_CMD_HALT,
		TS_CMD_WAITSTATE,
		TS_CMD_EVENTLIST,
		TS_CMD_CURSTATE,
3860
		TS_CMD_INVOKE_EVENT,
3861
	};
3862

3863
3864
3865
3866
3867
3868
3869
3870
3871
3872
3873
3874
3875
3876
3877
3878
3879
3880
3881
	static const Jim_Nvp target_options[] = {
		{ .name = "configure", .value = TS_CMD_CONFIGURE },
		{ .name = "cget", .value = TS_CMD_CGET },
		{ .name = "mww", .value = TS_CMD_MWW },
		{ .name = "mwh", .value = TS_CMD_MWH },
		{ .name = "mwb", .value = TS_CMD_MWB },
		{ .name = "mdw", .value = TS_CMD_MDW },
		{ .name = "mdh", .value = TS_CMD_MDH },
		{ .name = "mdb", .value = TS_CMD_MDB },
		{ .name = "mem2array", .value = TS_CMD_MEM2ARRAY },
		{ .name = "array2mem", .value = TS_CMD_ARRAY2MEM },
		{ .name = "eventlist", .value = TS_CMD_EVENTLIST },
		{ .name = "curstate",  .value = TS_CMD_CURSTATE },

		{ .name = "arp_examine", .value = TS_CMD_EXAMINE },
		{ .name = "arp_poll", .value = TS_CMD_POLL },
		{ .name = "arp_reset", .value = TS_CMD_RESET },
		{ .name = "arp_halt", .value = TS_CMD_HALT },
		{ .name = "arp_waitstate", .value = TS_CMD_WAITSTATE },
3882
		{ .name = "invoke-event", .value = TS_CMD_INVOKE_EVENT },
3883
3884
3885
3886
3887

		{ .name = NULL, .value = -1 },
	};

	/* go past the "command" */
3888
	Jim_GetOpt_Setup(&goi, interp, argc-1, argv + 1);
3889

3890
	target = Jim_CmdPrivData(goi.interp);
3891
3892
3893
	cmd_ctx = Jim_GetAssocData(goi.interp, "context");

	/* commands here are in an NVP table */
3894
	e = Jim_GetOpt_Nvp(&goi, target_options, &n);
zwelch's avatar
zwelch committed
3895
	if (e != JIM_OK) {
3896
		Jim_GetOpt_NvpUnknown(&goi, target_options, 0);
3897
3898
		return e;
	}
3899
	/* Assume blank result */
3900
	Jim_SetEmptyResult(goi.interp);
3901

zwelch's avatar
zwelch committed
3902
	switch (n->value) {
3903
	case TS_CMD_CONFIGURE:
zwelch's avatar
zwelch committed
3904
		if (goi.argc < 2) {
3905
			Jim_WrongNumArgs(goi.interp, goi.argc, goi.argv, "missing: -option VALUE ...");
3906
3907
3908
			return JIM_ERR;
		}
		goi.isconfigure = 1;
3909
		return target_configure(&goi, target);
3910
3911
	case TS_CMD_CGET:
		// some things take params
zwelch's avatar
zwelch committed
3912
		if (goi.argc < 1) {
3913
			Jim_WrongNumArgs(goi.interp, 0, goi.argv, "missing: ?-option?");
3914
3915
3916
			return JIM_ERR;
		}
		goi.isconfigure = 0;
3917
		return target_configure(&goi, target);
3918
3919
3920
3921
3922
3923
3924
3925
3926
		break;
	case TS_CMD_MWW:
	case TS_CMD_MWH:
	case TS_CMD_MWB:
		/* argv[0] = cmd
		 * argv[1] = address
		 * argv[2] = data
		 * argv[3] = optional count.
		 */
3927

zwelch's avatar
zwelch committed
3928
		if ((goi.argc == 2) || (goi.argc == 3)) {
3929
3930
3931
			/* all is well */
		} else {
		mwx_error:
3932
			Jim_SetResult_sprintf(goi.interp, "expected: %s ADDR DATA [COUNT]", n->name);
3933
3934
			return JIM_ERR;
		}
3935

3936
		e = Jim_GetOpt_Wide(&goi, &a);
zwelch's avatar
zwelch committed
3937
		if (e != JIM_OK) {
3938
3939
3940
			goto mwx_error;
		}

3941
		e = Jim_GetOpt_Wide(&goi, &b);
zwelch's avatar
zwelch committed
3942
		if (e != JIM_OK) {
3943
3944
			goto mwx_error;
		}
zwelch's avatar
zwelch committed
3945
		if (goi.argc == 3) {
3946
			e = Jim_GetOpt_Wide(&goi, &c);
zwelch's avatar
zwelch committed
3947
			if (e != JIM_OK) {
3948
3949
3950
3951
3952
				goto mwx_error;
			}
		} else {
			c = 1;
		}
3953

zwelch's avatar
zwelch committed
3954
		switch (n->value) {
3955
		case TS_CMD_MWW:
3956
			target_buffer_set_u32(target, target_buf, b);
3957
3958
3959
			b = 4;
			break;
		case TS_CMD_MWH:
3960
			target_buffer_set_u16(target, target_buf, b);
<