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 */
1704
	return target_process_reset(cmd_ctx, reset_mode);
1705
1706
1707
1708
1709
1710
}

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
1711

1712
	target_invoke_script(cmd_ctx, target, "pre_resume");
oharboe's avatar
oharboe committed
1713

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

1723
1724
1725
1726
1727
1728
	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
1729

1730
	LOG_DEBUG("-");
oharboe's avatar
oharboe committed
1731

1732
1733
1734
1735
1736
	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
1737

1738
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
	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
1765

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

	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);
1784
	if (retval == ERROR_OK)
1785
	{
1786
		output_len = 0;
oharboe's avatar
oharboe committed
1787

1788
		for (i = 0; i < count; i++)
1789
		{
1790
1791
			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
1792

1793
1794
1795
1796
1797
1798
1799
1800
1801
1802
1803
1804
			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
1805

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

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

oharboe's avatar
oharboe committed
1816
	return retval;
1817
1818
1819
1820
1821
1822
}

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
1823
1824
1825
	int count = 1;
	int i;
	int wordsize;
1826
1827
1828
	target_t *target = get_current_target(cmd_ctx);
	u8 value_buf[4];

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

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

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

	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;
1886
1887
	u32 min_address=0;
	u32 max_address=0xffffffff;
1888
1889
1890
	int i;
	int retval;

oharboe's avatar
oharboe committed
1891
1892
	image_t image;

1893
1894
	duration_t duration;
	char *duration_text;
oharboe's avatar
oharboe committed
1895

1896
1897
	target_t *target = get_current_target(cmd_ctx);

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

1903
1904
1905
1906
1907
1908
1909
1910
1911
1912
	/* 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
1913
1914


1915
	image.start_address_set = 0;
oharboe's avatar
oharboe committed
1916

1917
1918
1919
1920
1921
1922
1923
1924
	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
1925

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

1931
1932

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

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

1939
	image_size = 0x0;
1940
	retval = ERROR_OK;
1941
1942
1943
1944
1945
1946
1947
1948
	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
1949

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

1956
1957
		u32 offset=0;
		u32 length=buf_cnt;
oharboe's avatar
oharboe committed
1958
1959


1960
		/* DANGER!!! beware of unsigned comparision here!!! */
oharboe's avatar
oharboe committed
1961

1962
1963
		if ((image.sections[i].base_address+buf_cnt>=min_address)&&
				(image.sections[i].base_address<max_address))
1964
		{
1965
1966
1967
1968
1969
1970
			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
1971

1972
1973
1974
1975
			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
1976

1977
1978
1979
1980
1981
1982
1983
			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);
1984
		}
oharboe's avatar
oharboe committed
1985

1986
1987
1988
1989
		free(buffer);
	}

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

1996
1997
	image_close(&image);

1998
	return retval;
1999
2000

}
For faster browsing, not all history is shown. View entire blame