target.c 69.2 KB
Newer Older
1001
1002
1003
1004
1005
{
	u8 *buffer;
	int retval;
	int i;
	u32 checksum = 0;
1006
1007
1008
1009
1010
	if (!target->type->examined)
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}
oharboe's avatar
oharboe committed
1011

1012
1013
1014
1015
1016
1017
	if ((retval = target->type->checksum_memory(target, address,
		size, &checksum)) == ERROR_TARGET_RESOURCE_NOT_AVAILABLE)
	{
		buffer = malloc(size);
		if (buffer == NULL)
		{
1018
			LOG_ERROR("error allocating buffer for section (%d bytes)", size);
1019
1020
1021
1022
1023
1024
1025
1026
1027
1028
1029
1030
1031
1032
1033
1034
1035
1036
1037
1038
			return ERROR_INVALID_ARGUMENTS;
		}
		retval = target_read_buffer(target, address, size, buffer);
		if (retval != ERROR_OK)
		{
			free(buffer);
			return retval;
		}

		/* convert to target endianess */
		for (i = 0; i < (size/sizeof(u32)); i++)
		{
			u32 target_data;
			target_data = target_buffer_get_u32(target, &buffer[i*sizeof(u32)]);
			target_buffer_set_u32(target, &buffer[i*sizeof(u32)], target_data);
		}

		retval = image_calculate_checksum( buffer, size, &checksum );
		free(buffer);
	}
oharboe's avatar
oharboe committed
1039

1040
	*crc = checksum;
oharboe's avatar
oharboe committed
1041

1042
1043
	return retval;
}
1044
1045
1046
1047
1048
1049
1050
1051
1052

int target_blank_check_memory(struct target_s *target, u32 address, u32 size, u32* blank)
{
	int retval;
	if (!target->type->examined)
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}
oharboe's avatar
oharboe committed
1053

1054
1055
	if (target->type->blank_check_memory == 0)
		return ERROR_TARGET_RESOURCE_NOT_AVAILABLE;
oharboe's avatar
oharboe committed
1056

1057
	retval = target->type->blank_check_memory(target, address, size, blank);
oharboe's avatar
oharboe committed
1058

1059
1060
	return retval;
}
1061
1062
1063
1064

int target_read_u32(struct target_s *target, u32 address, u32 *value)
{
	u8 value_buf[4];
1065
1066
1067
1068
1069
	if (!target->type->examined)
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}
1070
1071

	int retval = target->type->read_memory(target, address, 4, 1, value_buf);
oharboe's avatar
oharboe committed
1072

1073
1074
1075
	if (retval == ERROR_OK)
	{
		*value = target_buffer_get_u32(target, value_buf);
1076
		LOG_DEBUG("address: 0x%8.8x, value: 0x%8.8x", address, *value);
1077
1078
1079
1080
	}
	else
	{
		*value = 0x0;
1081
		LOG_DEBUG("address: 0x%8.8x failed", address);
1082
	}
oharboe's avatar
oharboe committed
1083

1084
1085
1086
1087
1088
1089
	return retval;
}

int target_read_u16(struct target_s *target, u32 address, u16 *value)
{
	u8 value_buf[2];
1090
1091
1092
1093
1094
1095
	if (!target->type->examined)
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}

1096
	int retval = target->type->read_memory(target, address, 2, 1, value_buf);
oharboe's avatar
oharboe committed
1097

1098
1099
1100
	if (retval == ERROR_OK)
	{
		*value = target_buffer_get_u16(target, value_buf);
1101
		LOG_DEBUG("address: 0x%8.8x, value: 0x%4.4x", address, *value);
1102
1103
1104
1105
	}
	else
	{
		*value = 0x0;
1106
		LOG_DEBUG("address: 0x%8.8x failed", address);
1107
	}
oharboe's avatar
oharboe committed
1108

1109
1110
1111
1112
1113
1114
	return retval;
}

int target_read_u8(struct target_s *target, u32 address, u8 *value)
{
	int retval = target->type->read_memory(target, address, 1, 1, value);
1115
1116
1117
1118
1119
	if (!target->type->examined)
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}
1120
1121
1122

	if (retval == ERROR_OK)
	{
1123
		LOG_DEBUG("address: 0x%8.8x, value: 0x%2.2x", address, *value);
1124
1125
1126
1127
	}
	else
	{
		*value = 0x0;
1128
		LOG_DEBUG("address: 0x%8.8x failed", address);
1129
	}
oharboe's avatar
oharboe committed
1130

1131
1132
1133
1134
1135
1136
1137
	return retval;
}

int target_write_u32(struct target_s *target, u32 address, u32 value)
{
	int retval;
	u8 value_buf[4];
1138
1139
1140
1141
1142
	if (!target->type->examined)
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}
1143

1144
	LOG_DEBUG("address: 0x%8.8x, value: 0x%8.8x", address, value);
1145

oharboe's avatar
oharboe committed
1146
	target_buffer_set_u32(target, value_buf, value);
1147
1148
	if ((retval = target->type->write_memory(target, address, 4, 1, value_buf)) != ERROR_OK)
	{
1149
		LOG_DEBUG("failed: %i", retval);
1150
	}
oharboe's avatar
oharboe committed
1151

1152
1153
1154
1155
1156
1157
1158
	return retval;
}

int target_write_u16(struct target_s *target, u32 address, u16 value)
{
	int retval;
	u8 value_buf[2];
1159
1160
1161
1162
1163
1164
	if (!target->type->examined)
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}

1165
	LOG_DEBUG("address: 0x%8.8x, value: 0x%8.8x", address, value);
1166

oharboe's avatar
oharboe committed
1167
	target_buffer_set_u16(target, value_buf, value);
1168
1169
	if ((retval = target->type->write_memory(target, address, 2, 1, value_buf)) != ERROR_OK)
	{
1170
		LOG_DEBUG("failed: %i", retval);
1171
	}
oharboe's avatar
oharboe committed
1172

1173
1174
1175
1176
1177
1178
	return retval;
}

int target_write_u8(struct target_s *target, u32 address, u8 value)
{
	int retval;
1179
1180
1181
1182
1183
1184
	if (!target->type->examined)
	{
		LOG_ERROR("Target not examined yet");
		return ERROR_FAIL;
	}

1185
	LOG_DEBUG("address: 0x%8.8x, value: 0x%2.2x", address, value);
1186
1187
1188

	if ((retval = target->type->read_memory(target, address, 1, 1, &value)) != ERROR_OK)
	{
1189
		LOG_DEBUG("failed: %i", retval);
1190
	}
oharboe's avatar
oharboe committed
1191

1192
1193
1194
1195
1196
1197
1198
1199
1200
1201
1202
	return retval;
}

int target_register_user_commands(struct command_context_s *cmd_ctx)
{
	register_command(cmd_ctx,  NULL, "reg", handle_reg_command, COMMAND_EXEC, NULL);
	register_command(cmd_ctx,  NULL, "poll", handle_poll_command, COMMAND_EXEC, "poll target state");
	register_command(cmd_ctx,  NULL, "wait_halt", handle_wait_halt_command, COMMAND_EXEC, "wait for target halt [time (s)]");
	register_command(cmd_ctx,  NULL, "halt", handle_halt_command, COMMAND_EXEC, "halt target");
	register_command(cmd_ctx,  NULL, "resume", handle_resume_command, COMMAND_EXEC, "resume target [addr]");
	register_command(cmd_ctx,  NULL, "step", handle_step_command, COMMAND_EXEC, "step one instruction from current PC or [addr]");
oharboe's avatar
oharboe committed
1203
	register_command(cmd_ctx,  NULL, "reset", handle_reset_command, COMMAND_EXEC, "reset target [run|halt|init] - default is run");
1204
1205
1206
1207
1208
	register_command(cmd_ctx,  NULL, "soft_reset_halt", handle_soft_reset_halt_command, COMMAND_EXEC, "halt the target and do a soft reset");

	register_command(cmd_ctx,  NULL, "mdw", handle_md_command, COMMAND_EXEC, "display memory words <addr> [count]");
	register_command(cmd_ctx,  NULL, "mdh", handle_md_command, COMMAND_EXEC, "display memory half-words <addr> [count]");
	register_command(cmd_ctx,  NULL, "mdb", handle_md_command, COMMAND_EXEC, "display memory bytes <addr> [count]");
oharboe's avatar
oharboe committed
1209

oharboe's avatar
oharboe committed
1210
1211
1212
	register_command(cmd_ctx,  NULL, "mww", handle_mw_command, COMMAND_EXEC, "write memory word <addr> <value> [count]");
	register_command(cmd_ctx,  NULL, "mwh", handle_mw_command, COMMAND_EXEC, "write memory half-word <addr> <value> [count]");
	register_command(cmd_ctx,  NULL, "mwb", handle_mw_command, COMMAND_EXEC, "write memory byte <addr> <value> [count]");
oharboe's avatar
oharboe committed
1213
1214

	register_command(cmd_ctx,  NULL, "bp", handle_bp_command, COMMAND_EXEC, "set breakpoint <address> <length> [hw]");
1215
	register_command(cmd_ctx,  NULL, "rbp", handle_rbp_command, COMMAND_EXEC, "remove breakpoint <adress>");
oharboe's avatar
oharboe committed
1216
	register_command(cmd_ctx,  NULL, "wp", handle_wp_command, COMMAND_EXEC, "set watchpoint <address> <length> <r/w/a> [value] [mask]");
1217
	register_command(cmd_ctx,  NULL, "rwp", handle_rwp_command, COMMAND_EXEC, "remove watchpoint <adress>");
oharboe's avatar
oharboe committed
1218

1219
	register_command(cmd_ctx,  NULL, "load_image", handle_load_image_command, COMMAND_EXEC, "load_image <file> <address> ['bin'|'ihex'|'elf'|'s19'] [min_address] [max_length]");
1220
1221
	register_command(cmd_ctx,  NULL, "dump_image", handle_dump_image_command, COMMAND_EXEC, "dump_image <file> <address> <size>");
	register_command(cmd_ctx,  NULL, "verify_image", handle_verify_image_command, COMMAND_EXEC, "verify_image <file> [offset] [type]");
oharboe's avatar
oharboe committed
1222

1223
1224
	target_request_register_commands(cmd_ctx);
	trace_register_commands(cmd_ctx);
oharboe's avatar
oharboe committed
1225

1226
1227
1228
1229
1230
1231
1232
	return ERROR_OK;
}

int handle_targets_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
	target_t *target = targets;
	int count = 0;
oharboe's avatar
oharboe committed
1233

1234
1235
1236
	if (argc == 1)
	{
		int num = strtoul(args[0], NULL, 0);
oharboe's avatar
oharboe committed
1237

1238
1239
1240
1241
1242
		while (target)
		{
			count++;
			target = target->next;
		}
oharboe's avatar
oharboe committed
1243

1244
1245
1246
1247
		if (num < count)
			cmd_ctx->current_target = num;
		else
			command_print(cmd_ctx, "%i is out of bounds, only %i targets are configured", num, count);
oharboe's avatar
oharboe committed
1248

1249
1250
		return ERROR_OK;
	}
oharboe's avatar
oharboe committed
1251

1252
1253
1254
1255
1256
	while (target)
	{
		command_print(cmd_ctx, "%i: %s (%s), state: %s", count++, target->type->name, target_endianess_strings[target->endianness], target_state_strings[target->state]);
		target = target->next;
	}
oharboe's avatar
oharboe committed
1257

1258
1259
1260
1261
1262
1263
1264
	return ERROR_OK;
}

int handle_target_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
	int i;
	int found = 0;
oharboe's avatar
oharboe committed
1265

1266
1267
	if (argc < 3)
	{
1268
		return ERROR_COMMAND_SYNTAX_ERROR;
1269
	}
oharboe's avatar
oharboe committed
1270

1271
1272
1273
1274
1275
1276
1277
1278
	/* search for the specified target */
	if (args[0] && (args[0][0] != 0))
	{
		for (i = 0; target_types[i]; i++)
		{
			if (strcmp(args[0], target_types[i]->name) == 0)
			{
				target_t **last_target_p = &targets;
oharboe's avatar
oharboe committed
1279

1280
1281
1282
				/* register target specific commands */
				if (target_types[i]->register_commands(cmd_ctx) != ERROR_OK)
				{
1283
					LOG_ERROR("couldn't register '%s' commands", args[0]);
1284
1285
1286
1287
1288
1289
1290
1291
1292
1293
1294
					exit(-1);
				}

				if (*last_target_p)
				{
					while ((*last_target_p)->next)
						last_target_p = &((*last_target_p)->next);
					last_target_p = &((*last_target_p)->next);
				}

				*last_target_p = malloc(sizeof(target_t));
oharboe's avatar
oharboe committed
1295

1296
1297
				/* allocate memory for each unique target type */
				(*last_target_p)->type = (target_type_t*)malloc(sizeof(target_type_t));
oharboe's avatar
oharboe committed
1298
1299
				*((*last_target_p)->type) = *target_types[i];

1300
1301
1302
1303
1304
1305
				if (strcmp(args[1], "big") == 0)
					(*last_target_p)->endianness = TARGET_BIG_ENDIAN;
				else if (strcmp(args[1], "little") == 0)
					(*last_target_p)->endianness = TARGET_LITTLE_ENDIAN;
				else
				{
1306
					LOG_ERROR("endianness must be either 'little' or 'big', not '%s'", args[1]);
1307
					return ERROR_COMMAND_SYNTAX_ERROR;
1308
				}
oharboe's avatar
oharboe committed
1309

1310
				if (strcmp(args[2], "reset_halt") == 0)
1311
				{
oharboe's avatar
   
oharboe committed
1312
1313
					LOG_WARNING("reset_mode argument is obsolete.");
					return ERROR_COMMAND_SYNTAX_ERROR;
1314
				}
1315
				else if (strcmp(args[2], "reset_run") == 0)
1316
				{
oharboe's avatar
   
oharboe committed
1317
1318
					LOG_WARNING("reset_mode argument is obsolete.");
					return ERROR_COMMAND_SYNTAX_ERROR;
1319
				}
1320
				else if (strcmp(args[2], "reset_init") == 0)
1321
				{
oharboe's avatar
   
oharboe committed
1322
1323
					LOG_WARNING("reset_mode argument is obsolete.");
					return ERROR_COMMAND_SYNTAX_ERROR;
1324
				}
1325
				else if (strcmp(args[2], "run_and_halt") == 0)
1326
				{
oharboe's avatar
   
oharboe committed
1327
1328
					LOG_WARNING("reset_mode argument is obsolete.");
					return ERROR_COMMAND_SYNTAX_ERROR;
1329
				}
1330
				else if (strcmp(args[2], "run_and_init") == 0)
1331
				{
oharboe's avatar
   
oharboe committed
1332
1333
					LOG_WARNING("reset_mode argument is obsolete.");
					return ERROR_COMMAND_SYNTAX_ERROR;
1334
				}
1335
1336
				else
				{
1337
1338
1339
					/* Kludge! we want to make this reset arg optional while remaining compatible! */
					args--;
					argc++;
1340
				}
oharboe's avatar
oharboe committed
1341

1342
1343
1344
1345
				(*last_target_p)->working_area = 0x0;
				(*last_target_p)->working_area_size = 0x0;
				(*last_target_p)->working_areas = NULL;
				(*last_target_p)->backup_working_area = 0;
oharboe's avatar
oharboe committed
1346

1347
				(*last_target_p)->state = TARGET_UNKNOWN;
1348
				(*last_target_p)->debug_reason = DBG_REASON_UNDEFINED;
1349
1350
1351
1352
1353
				(*last_target_p)->reg_cache = NULL;
				(*last_target_p)->breakpoints = NULL;
				(*last_target_p)->watchpoints = NULL;
				(*last_target_p)->next = NULL;
				(*last_target_p)->arch_info = NULL;
oharboe's avatar
oharboe committed
1354

1355
1356
1357
1358
1359
1360
1361
1362
1363
				/* initialize trace information */
				(*last_target_p)->trace_info = malloc(sizeof(trace_t));
				(*last_target_p)->trace_info->num_trace_points = 0;
				(*last_target_p)->trace_info->trace_points_size = 0;
				(*last_target_p)->trace_info->trace_points = NULL;
				(*last_target_p)->trace_info->trace_history_size = 0;
				(*last_target_p)->trace_info->trace_history = NULL;
				(*last_target_p)->trace_info->trace_history_pos = 0;
				(*last_target_p)->trace_info->trace_history_overflowed = 0;
oharboe's avatar
oharboe committed
1364

1365
1366
				(*last_target_p)->dbgmsg = NULL;
				(*last_target_p)->dbg_msg_enabled = 0;
oharboe's avatar
oharboe committed
1367

1368
				(*last_target_p)->type->target_command(cmd_ctx, cmd, args, argc, *last_target_p);
oharboe's avatar
oharboe committed
1369

1370
1371
1372
1373
1374
				found = 1;
				break;
			}
		}
	}
oharboe's avatar
oharboe committed
1375

1376
1377
1378
	/* no matching target found */
	if (!found)
	{
1379
		LOG_ERROR("target '%s' not found", args[0]);
1380
		return ERROR_COMMAND_SYNTAX_ERROR;
1381
1382
1383
1384
1385
	}

	return ERROR_OK;
}

oharboe's avatar
oharboe committed
1386
1387
int target_invoke_script(struct command_context_s *cmd_ctx, target_t *target, char *name)
{
oharboe's avatar
oharboe committed
1388
1389
	return command_run_linef(cmd_ctx, " if {[catch {info body target_%d_%s} t]==0} {target_%d_%s}",
			get_num_by_target(target), name,
oharboe's avatar
   
oharboe committed
1390
			get_num_by_target(target), name);
oharboe's avatar
oharboe committed
1391
1392
}

1393
1394
1395
int handle_working_area_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
	target_t *target = NULL;
oharboe's avatar
oharboe committed
1396

1397
1398
1399
1400
	if ((argc < 4) || (argc > 5))
	{
		return ERROR_COMMAND_SYNTAX_ERROR;
	}
oharboe's avatar
oharboe committed
1401

1402
1403
1404
	target = get_target_by_num(strtoul(args[0], NULL, 0));
	if (!target)
	{
1405
		return ERROR_COMMAND_SYNTAX_ERROR;
1406
1407
	}
	target_free_all_working_areas(target);
oharboe's avatar
oharboe committed
1408

1409
1410
1411
1412
1413
1414
	target->working_area_phys = target->working_area_virt = strtoul(args[1], NULL, 0);
	if (argc == 5)
	{
		target->working_area_virt = strtoul(args[4], NULL, 0);
	}
	target->working_area_size = strtoul(args[2], NULL, 0);
oharboe's avatar
oharboe committed
1415

1416
1417
1418
1419
1420
1421
1422
1423
1424
1425
	if (strcmp(args[3], "backup") == 0)
	{
		target->backup_working_area = 1;
	}
	else if (strcmp(args[3], "nobackup") == 0)
	{
		target->backup_working_area = 0;
	}
	else
	{
1426
		LOG_ERROR("unrecognized <backup|nobackup> argument (%s)", args[3]);
1427
1428
		return ERROR_COMMAND_SYNTAX_ERROR;
	}
oharboe's avatar
oharboe committed
1429

1430
1431
1432
1433
1434
1435
1436
1437
	return ERROR_OK;
}


/* process target state changes */
int handle_target(void *priv)
{
	target_t *target = targets;
oharboe's avatar
oharboe committed
1438

1439
1440
	while (target)
	{
1441
		if (target_continous_poll)
1442
		{
1443
1444
			/* polling may fail silently until the target has been examined */
			target_poll(target);
1445
		}
oharboe's avatar
oharboe committed
1446

1447
1448
		target = target->next;
	}
oharboe's avatar
oharboe committed
1449

1450
1451
1452
1453
1454
1455
1456
1457
1458
	return ERROR_OK;
}

int handle_reg_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
	target_t *target;
	reg_t *reg = NULL;
	int count = 0;
	char *value;
oharboe's avatar
oharboe committed
1459

1460
	LOG_DEBUG("-");
oharboe's avatar
oharboe committed
1461

1462
	target = get_current_target(cmd_ctx);
oharboe's avatar
oharboe committed
1463

1464
1465
1466
1467
	/* list all available registers for the current target */
	if (argc == 0)
	{
		reg_cache_t *cache = target->reg_cache;
oharboe's avatar
oharboe committed
1468

1469
1470
1471
1472
1473
1474
1475
1476
1477
1478
1479
1480
		count = 0;
		while(cache)
		{
			int i;
			for (i = 0; i < cache->num_regs; i++)
			{
				value = buf_to_str(cache->reg_list[i].value, cache->reg_list[i].size, 16);
				command_print(cmd_ctx, "(%i) %s (/%i): 0x%s (dirty: %i, valid: %i)", count++, cache->reg_list[i].name, cache->reg_list[i].size, value, cache->reg_list[i].dirty, cache->reg_list[i].valid);
				free(value);
			}
			cache = cache->next;
		}
oharboe's avatar
oharboe committed
1481

1482
1483
		return ERROR_OK;
	}
oharboe's avatar
oharboe committed
1484

1485
1486
1487
1488
1489
	/* access a single register by its ordinal number */
	if ((args[0][0] >= '0') && (args[0][0] <= '9'))
	{
		int num = strtoul(args[0], NULL, 0);
		reg_cache_t *cache = target->reg_cache;
oharboe's avatar
oharboe committed
1490

1491
1492
1493
1494
1495
1496
1497
1498
1499
1500
1501
1502
1503
1504
1505
1506
		count = 0;
		while(cache)
		{
			int i;
			for (i = 0; i < cache->num_regs; i++)
			{
				if (count++ == num)
				{
					reg = &cache->reg_list[i];
					break;
				}
			}
			if (reg)
				break;
			cache = cache->next;
		}
oharboe's avatar
oharboe committed
1507

1508
1509
1510
1511
1512
1513
1514
1515
		if (!reg)
		{
			command_print(cmd_ctx, "%i is out of bounds, the current target has only %i registers (0 - %i)", num, count, count - 1);
			return ERROR_OK;
		}
	} else /* access a single register by its name */
	{
		reg = register_get_by_name(target->reg_cache, args[0], 1);
oharboe's avatar
oharboe committed
1516

1517
1518
1519
1520
1521
1522
1523
1524
1525
1526
1527
1528
		if (!reg)
		{
			command_print(cmd_ctx, "register %s not found in current target", args[0]);
			return ERROR_OK;
		}
	}

	/* display a register */
	if ((argc == 1) || ((argc == 2) && !((args[1][0] >= '0') && (args[1][0] <= '9'))))
	{
		if ((argc == 2) && (strcmp(args[1], "force") == 0))
			reg->valid = 0;
oharboe's avatar
oharboe committed
1529

1530
1531
1532
1533
1534
		if (reg->valid == 0)
		{
			reg_arch_type_t *arch_type = register_get_arch_type(reg->arch_type);
			if (arch_type == NULL)
			{
1535
				LOG_ERROR("BUG: encountered unregistered arch type");
1536
1537
1538
1539
1540
1541
1542
1543
1544
				return ERROR_OK;
			}
			arch_type->get(reg);
		}
		value = buf_to_str(reg->value, reg->size, 16);
		command_print(cmd_ctx, "%s (/%i): 0x%s", reg->name, reg->size, value);
		free(value);
		return ERROR_OK;
	}
oharboe's avatar
oharboe committed
1545

1546
1547
1548
1549
1550
1551
1552
1553
1554
	/* set register value */
	if (argc == 2)
	{
		u8 *buf = malloc(CEIL(reg->size, 8));
		str_to_buf(args[1], strlen(args[1]), buf, reg->size, 0);

		reg_arch_type_t *arch_type = register_get_arch_type(reg->arch_type);
		if (arch_type == NULL)
		{
1555
			LOG_ERROR("BUG: encountered unregistered arch type");
1556
1557
			return ERROR_OK;
		}
oharboe's avatar
oharboe committed
1558

1559
		arch_type->set(reg, buf);
oharboe's avatar
oharboe committed
1560

1561
1562
1563
		value = buf_to_str(reg->value, reg->size, 16);
		command_print(cmd_ctx, "%s (/%i): 0x%s", reg->name, reg->size, value);
		free(value);
oharboe's avatar
oharboe committed
1564

1565
		free(buf);
oharboe's avatar
oharboe committed
1566

1567
1568
		return ERROR_OK;
	}
oharboe's avatar
oharboe committed
1569

1570
	command_print(cmd_ctx, "usage: reg <#|name> [value]");
oharboe's avatar
oharboe committed
1571

1572
1573
1574
1575
1576
1577
1578
1579
1580
1581
	return ERROR_OK;
}


int handle_poll_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
	target_t *target = get_current_target(cmd_ctx);

	if (argc == 0)
	{
1582
		target_poll(target);
1583
		target_arch_state(target);
1584
1585
1586
1587
1588
1589
1590
1591
1592
1593
1594
1595
1596
1597
1598
1599
	}
	else
	{
		if (strcmp(args[0], "on") == 0)
		{
			target_continous_poll = 1;
		}
		else if (strcmp(args[0], "off") == 0)
		{
			target_continous_poll = 0;
		}
		else
		{
			command_print(cmd_ctx, "arg is \"on\" or \"off\"");
		}
	}
oharboe's avatar
oharboe committed
1600
1601


1602
1603
1604
1605
1606
1607
	return ERROR_OK;
}

int handle_wait_halt_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
	int ms = 5000;
oharboe's avatar
oharboe committed
1608

1609
1610
1611
1612
1613
1614
1615
1616
1617
1618
1619
	if (argc > 0)
	{
		char *end;

		ms = strtoul(args[0], &end, 0) * 1000;
		if (*end)
		{
			command_print(cmd_ctx, "usage: %s [seconds]", cmd);
			return ERROR_OK;
		}
	}
1620
	target_t *target = get_current_target(cmd_ctx);
1621

oharboe's avatar
oharboe committed
1622
	return target_wait_state(target, TARGET_HALTED, ms);
1623
1624
}

1625
int target_wait_state(target_t *target, enum target_state state, int ms)
1626
1627
1628
{
	int retval;
	struct timeval timeout, now;
1629
	int once=1;
1630
1631
	gettimeofday(&timeout, NULL);
	timeval_add_time(&timeout, 0, ms * 1000);
oharboe's avatar
oharboe committed
1632

1633
1634
	for (;;)
	{
1635
		if ((retval=target_poll(target))!=ERROR_OK)
1636
			return retval;
1637
		target_call_timer_callbacks_now();
1638
1639
1640
1641
		if (target->state == state)
		{
			break;
		}
1642
1643
1644
		if (once)
		{
			once=0;
1645
			LOG_USER("waiting for target %s...", target_state_strings[state]);
1646
		}
oharboe's avatar
oharboe committed
1647

1648
1649
1650
		gettimeofday(&now, NULL);
		if ((now.tv_sec > timeout.tv_sec) || ((now.tv_sec == timeout.tv_sec) && (now.tv_usec >= timeout.tv_usec)))
		{
1651
			LOG_ERROR("timed out while waiting for target %s", target_state_strings[state]);
oharboe's avatar
oharboe committed
1652
			return ERROR_FAIL;
1653
1654
		}
	}
oharboe's avatar
oharboe committed
1655

1656
1657
1658
1659
1660
1661
1662
1663
	return ERROR_OK;
}

int handle_halt_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
	int retval;
	target_t *target = get_current_target(cmd_ctx);

1664
	LOG_DEBUG("-");
1665

1666
	if ((retval = target_halt(target)) != ERROR_OK)
1667
1668
1669
	{
		return retval;
	}
oharboe's avatar
oharboe committed
1670

1671
1672
1673
1674
1675
1676
	return handle_wait_halt_command(cmd_ctx, cmd, args, argc);
}

int handle_soft_reset_halt_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
	target_t *target = get_current_target(cmd_ctx);
oharboe's avatar
oharboe committed
1677

1678
	LOG_USER("requesting target halt and executing a soft reset");
oharboe's avatar
oharboe committed
1679

oharboe's avatar
   
oharboe committed
1680
	target->type->soft_reset_halt(target);
oharboe's avatar
oharboe committed
1681

1682
1683
1684
1685
1686
	return ERROR_OK;
}

int handle_reset_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
1687
	enum target_reset_mode reset_mode = RESET_RUN;
oharboe's avatar
oharboe committed
1688

1689
1690
1691
1692
1693
1694
1695
1696
1697
1698
	if (argc >= 1)
	{
		if (strcmp("run", args[0]) == 0)
			reset_mode = RESET_RUN;
		else if (strcmp("halt", args[0]) == 0)
			reset_mode = RESET_HALT;
		else if (strcmp("init", args[0]) == 0)
			reset_mode = RESET_INIT;
		else
		{
oharboe's avatar
oharboe committed
1699
			return ERROR_COMMAND_SYNTAX_ERROR;
1700
1701
		}
	}
oharboe's avatar
oharboe committed
1702

1703
	/* reset *all* targets */
oharboe's avatar
   
oharboe committed
1704
	target_process_reset(cmd_ctx, reset_mode);
oharboe's avatar
oharboe committed
1705

1706
1707
1708
1709
1710
1711
1712
	return ERROR_OK;
}

int handle_resume_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
	int retval;
	target_t *target = get_current_target(cmd_ctx);
oharboe's avatar
oharboe committed
1713

1714
	target_invoke_script(cmd_ctx, target, "pre_resume");
oharboe's avatar
oharboe committed
1715

1716
	if (argc == 0)
1717
		retval = target_resume(target, 1, 0, 1, 0); /* current pc, addr = 0, handle breakpoints, not debugging */
1718
	else if (argc == 1)
1719
		retval = target_resume(target, 0, strtoul(args[0], NULL, 0), 1, 0); /* addr = args[0], handle breakpoints, not debugging */
1720
1721
1722
1723
	else
	{
		return ERROR_COMMAND_SYNTAX_ERROR;
	}
oharboe's avatar
oharboe committed
1724

1725
1726
1727
1728
1729
1730
	return retval;
}

int handle_step_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
	target_t *target = get_current_target(cmd_ctx);
oharboe's avatar
oharboe committed
1731

1732
	LOG_DEBUG("-");
oharboe's avatar
oharboe committed
1733

1734
1735
1736
1737
1738
	if (argc == 0)
		target->type->step(target, 1, 0, 1); /* current pc, addr = 0, handle breakpoints */

	if (argc == 1)
		target->type->step(target, 0, strtoul(args[0], NULL, 0), 1); /* addr = args[0], handle breakpoints */
oharboe's avatar
oharboe committed
1739

1740
1741
1742
1743
1744
1745
1746
1747
1748
1749
1750
1751
1752
1753
1754
1755
1756
1757
1758
1759
1760
1761
1762
1763
1764
1765
1766
	return ERROR_OK;
}

int handle_md_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
	const int line_bytecnt = 32;
	int count = 1;
	int size = 4;
	u32 address = 0;
	int line_modulo;
	int i;

	char output[128];
	int output_len;

	int retval;

	u8 *buffer;
	target_t *target = get_current_target(cmd_ctx);

	if (argc < 1)
		return ERROR_OK;

	if (argc == 2)
		count = strtoul(args[1], NULL, 0);

	address = strtoul(args[0], NULL, 0);
oharboe's avatar
oharboe committed
1767

1768
1769
1770
1771
1772
1773
1774
1775
1776
1777
1778
1779
1780
1781
1782
1783
1784
1785

	switch (cmd[2])
	{
		case 'w':
			size = 4; line_modulo = line_bytecnt / 4;
			break;
		case 'h':
			size = 2; line_modulo = line_bytecnt / 2;
			break;
		case 'b':
			size = 1; line_modulo = line_bytecnt / 1;
			break;
		default:
			return ERROR_OK;
	}

	buffer = calloc(count, size);
	retval  = target->type->read_memory(target, address, size, count, buffer);
1786
	if (retval == ERROR_OK)
1787
	{
1788
		output_len = 0;
oharboe's avatar
oharboe committed
1789

1790
		for (i = 0; i < count; i++)
1791
		{
1792
1793
			if (i%line_modulo == 0)
				output_len += snprintf(output + output_len, 128 - output_len, "0x%8.8x: ", address + (i*size));
oharboe's avatar
oharboe committed
1794

1795
1796
1797
1798
1799
1800
1801
1802
1803
1804
1805
1806
			switch (size)
			{
				case 4:
					output_len += snprintf(output + output_len, 128 - output_len, "%8.8x ", target_buffer_get_u32(target, &buffer[i*4]));
					break;
				case 2:
					output_len += snprintf(output + output_len, 128 - output_len, "%4.4x ", target_buffer_get_u16(target, &buffer[i*2]));
					break;
				case 1:
					output_len += snprintf(output + output_len, 128 - output_len, "%2.2x ", buffer[i*1]);
					break;
			}
oharboe's avatar
oharboe committed
1807

1808
1809
1810
1811
1812
			if ((i%line_modulo == line_modulo-1) || (i == count - 1))
			{
				command_print(cmd_ctx, output);
				output_len = 0;
			}
1813
1814
1815
1816
		}
	}

	free(buffer);
oharboe's avatar
oharboe committed
1817

oharboe's avatar
oharboe committed
1818
	return retval;
1819
1820
1821
1822
1823
1824
}

int handle_mw_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
	u32 address = 0;
	u32 value = 0;
oharboe's avatar
oharboe committed
1825
1826
1827
	int count = 1;
	int i;
	int wordsize;
1828
1829
1830
	target_t *target = get_current_target(cmd_ctx);
	u8 value_buf[4];

oharboe's avatar
oharboe committed
1831
1832
	 if ((argc < 2) || (argc > 3))
		return ERROR_COMMAND_SYNTAX_ERROR;
1833
1834
1835

	address = strtoul(args[0], NULL, 0);
	value = strtoul(args[1], NULL, 0);
oharboe's avatar
oharboe committed
1836
1837
	if (argc == 3)
		count = strtoul(args[2], NULL, 0);
oharboe's avatar
oharboe committed
1838

1839
1840
1841
	switch (cmd[2])
	{
		case 'w':
oharboe's avatar
oharboe committed
1842
			wordsize = 4;
1843
1844
1845
			target_buffer_set_u32(target, value_buf, value);
			break;
		case 'h':
oharboe's avatar
oharboe committed
1846
			wordsize = 2;
1847
1848
1849
			target_buffer_set_u16(target, value_buf, value);
			break;
		case 'b':
oharboe's avatar
oharboe committed
1850
			wordsize = 1;
1851
1852
1853
			value_buf[0] = value;
			break;
		default:
oharboe's avatar
oharboe committed
1854
			return ERROR_COMMAND_SYNTAX_ERROR;
1855
	}
oharboe's avatar
oharboe committed
1856
	for (i=0; i<count; i++)
1857
	{
oharboe's avatar
oharboe committed
1858
1859
1860
1861
1862
1863
1864
1865
1866
1867
1868
1869
1870
1871
1872
1873
1874
1875
1876
		int retval;
		switch (wordsize)
		{
			case 4:
				retval = target->type->write_memory(target, address + i*wordsize, 4, 1, value_buf);
				break;
			case 2:
				retval = target->type->write_memory(target, address + i*wordsize, 2, 1, value_buf);
				break;
			case 1:
				retval = target->type->write_memory(target, address + i*wordsize, 1, 1, value_buf);
			break;
			default:
			return ERROR_OK;
		}
		if (retval!=ERROR_OK)
		{
			return retval;
		}
1877
1878
1879
1880
1881
1882
1883
1884
1885
1886
1887
	}

	return ERROR_OK;

}

int handle_load_image_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc)
{
	u8 *buffer;
	u32 buf_cnt;
	u32 image_size;
1888
1889
	u32 min_address=0;
	u32 max_address=0xffffffff;
1890
1891
1892
	int i;
	int retval;

oharboe's avatar
oharboe committed
1893
1894
	image_t image;

1895
1896
	duration_t duration;
	char *duration_text;
oharboe's avatar
oharboe committed
1897

1898
1899
	target_t *target = get_current_target(cmd_ctx);

1900
	if ((argc < 1)||(argc > 5))
1901
	{
1902
		return ERROR_COMMAND_SYNTAX_ERROR;
1903
	}
oharboe's avatar
oharboe committed
1904

1905
1906
1907
1908
1909
1910
1911
1912
1913
1914
	/* a base address isn't always necessary, default to 0x0 (i.e. don't relocate) */
	if (argc >= 2)
	{
		image.base_address_set = 1;
		image.base_address = strtoul(args[1], NULL, 0);
	}
	else
	{
		image.base_address_set = 0;
	}
oharboe's avatar
oharboe committed
1915
1916


1917
	image.start_address_set = 0;
oharboe's avatar
oharboe committed
1918

1919
1920
1921
1922
1923
1924
1925
1926
	if (argc>=4)
	{
		min_address=strtoul(args[3], NULL, 0);
	}
	if (argc>=5)
	{
		max_address=strtoul(args[4], NULL, 0)+min_address;
	}
oharboe's avatar
oharboe committed
1927

1928
1929
1930
1931
	if (min_address>max_address)
	{
		return ERROR_COMMAND_SYNTAX_ERROR;
	}
oharboe's avatar
oharboe committed
1932

1933
1934

	duration_start_measure(&duration);
oharboe's avatar
oharboe committed
1935

1936
1937
1938
1939
	if (image_open(&image, args[0], (argc >= 3) ? args[2] : NULL) != ERROR_OK)
	{
		return ERROR_OK;
	}
oharboe's avatar
oharboe committed
1940

1941
	image_size = 0x0;
1942
	retval = ERROR_OK;
1943
1944
1945
1946
1947
1948
1949
1950
	for (i = 0; i < image.num_sections; i++)
	{
		buffer = malloc(image.sections[i].size);
		if (buffer == NULL)
		{
			command_print(cmd_ctx, "error allocating buffer for section (%d bytes)", image.sections[i].size);
			break;
		}
oharboe's avatar
oharboe committed
1951

1952
1953
1954
		if ((retval = image_read_section(&image, i, 0x0, image.sections[i].size, buffer, &buf_cnt)) != ERROR_OK)
		{
			free(buffer);
1955
1956
			break;
		}
oharboe's avatar
oharboe committed
1957

1958
1959
		u32 offset=0;
		u32 length=buf_cnt;
oharboe's avatar
oharboe committed
1960
1961


1962
		/* DANGER!!! beware of unsigned comparision here!!! */
oharboe's avatar
oharboe committed
1963

1964
1965
		if ((image.sections[i].base_address+buf_cnt>=min_address)&&
				(image.sections[i].base_address<max_address))
1966
		{
1967
1968
1969
1970
1971
1972
			if (image.sections[i].base_address<min_address)
			{
				/* clip addresses below */
				offset+=min_address-image.sections[i].base_address;
				length-=offset;
			}
oharboe's avatar
oharboe committed
1973

1974
1975
1976
1977
			if (image.sections[i].base_address+buf_cnt>max_address)
			{
				length-=(image.sections[i].base_address+buf_cnt)-max_address;
			}
oharboe's avatar
oharboe committed
1978

1979
1980
1981
1982
1983
1984
1985
			if ((retval = target_write_buffer(target, image.sections[i].base_address+offset, length, buffer+offset)) != ERROR_OK)
			{
				free(buffer);
				break;
			}
			image_size += length;
			command_print(cmd_ctx, "%u byte written at address 0x%8.8x", length, image.sections[i].base_address+offset);
1986
		}
oharboe's avatar
oharboe committed
1987

1988
1989
1990
1991
		free(buffer);
	}

	duration_stop_measure(&duration, &duration_text);
1992
1993
1994
1995
	if (retval==ERROR_OK)
	{
		command_print(cmd_ctx, "downloaded %u byte in %s", image_size, duration_text);
	}
1996
	free(duration_text);
oharboe's avatar
oharboe committed
1997

1998
1999
	image_close(&image);

2000
	return retval;
For faster browsing, not all history is shown. View entire blame