Menu
▾
▴
[OpenOCD-devel] [PATCH]: b8abe60 Support for Freescale LS102x SAP
|
From: <ge...@op...> - 2015-11-04 15:03:46
|
This is an automated email from Gerrit. Esben Haabendal (es...@ha...) just uploaded a new patch set to Gerrit, which you can find at http://openocd.zylin.com/3096 -- gerrit commit b8abe603f7763b53e3bed8f2673b491a4fad71e5 Author: Esben Haabendal <es...@ha...> Date: Wed Nov 4 16:02:55 2015 +0100 Support for Freescale LS102x SAP The SAP in LS102x SoC's from Freescale is able to read and write to all physical memory locations, independently of CPU cores and DAP. This implementation is 100% based on reverse-engineering of JTAG communication with an LS1021A SAP using a JTAG debugger with SAP support. And as such, this code is for now "works-for-me", pending verification by other OpenOCD users, or even better, actual information from Freescale on the SAP interface. Change-Id: Ibb30945e017894da5c402f9f633fc513bed4e68c Signed-off-by: Esben Haabendal <es...@ha...> diff --git a/src/target/Makefile.am b/src/target/Makefile.am index 2cec491..e47b6f3 100644 --- a/src/target/Makefile.am +++ b/src/target/Makefile.am @@ -82,7 +82,8 @@ ARMV7_SRC = \ armv7m_trace.c \ cortex_m.c \ armv7a.c \ - cortex_a.c + cortex_a.c \ + ls1_sap.c ARM_DEBUG_SRC = \ arm_dpm.c \ diff --git a/src/target/ls1_sap.c b/src/target/ls1_sap.c new file mode 100644 index 0000000..12752c5 --- /dev/null +++ b/src/target/ls1_sap.c @@ -0,0 +1,249 @@ +/*************************************************************************** + * Copyright (C) 2015 by Esben Haabendal * + * eh...@de... * + * * + * This program is free software; you can redistribute it and/or modify * + * it under the terms of the GNU General Public License as published by * + * the Free Software Foundation; either version 2 of the License, or * + * (at your option) any later version. * + * * + * This program is distributed in the hope that it will be useful, * + * but WITHOUT ANY WARRANTY; without even the implied warranty of * + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * + * GNU General Public License for more details. * + * * + * You should have received a copy of the GNU General Public License * + * along with this program; if not, write to the * + * Free Software Foundation, Inc., * + * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. * + ***************************************************************************/ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include "target.h" +#include "target_type.h" + +#include <jtag/jtag.h> + +struct ls1_sap { + struct jtag_tap *tap; +}; + +static int ls1_sap_target_create(struct target *target, Jim_Interp *interp) +{ + struct ls1_sap *ls1_sap = calloc(1, sizeof(struct ls1_sap)); + + ls1_sap->tap = target->tap; + target->arch_info = ls1_sap; + + return ERROR_OK; +} + +static int ls1_sap_init_target(struct command_context *cmd_ctx, struct target *target) +{ + LOG_DEBUG("%s", __func__); + return ERROR_OK; +} + +static int ls1_sap_arch_state(struct target *target) +{ + LOG_DEBUG("%s", __func__); + return ERROR_OK; +} + +static int ls1_sap_poll(struct target *target) +{ + if ((target->state == TARGET_UNKNOWN) || + (target->state == TARGET_RUNNING) || + (target->state == TARGET_DEBUG_RUNNING)) + target->state = TARGET_HALTED; + + //LOG_DEBUG("%s %d", __func__, target->state); + return ERROR_OK; +} + +static int ls1_sap_halt(struct target *target) +{ + LOG_DEBUG("%s", __func__); + return ERROR_OK; +} + +static int ls1_sap_resume(struct target *target, int current, uint32_t address, + int handle_breakpoints, int debug_execution) +{ + LOG_DEBUG("%s", __func__); + return ERROR_OK; +} + +static int ls1_sap_step(struct target *target, int current, uint32_t address, + int handle_breakpoints) +{ + LOG_DEBUG("%s", __func__); + return ERROR_OK; +} + +static int ls1_sap_assert_reset(struct target *target) +{ + target->state = TARGET_RESET; + + LOG_DEBUG("%s", __func__); + return ERROR_OK; +} + +static int ls1_sap_deassert_reset(struct target *target) +{ + target->state = TARGET_RUNNING; + + LOG_DEBUG("%s", __func__); + return ERROR_OK; +} + +static void ls1_sap_set_instr(struct jtag_tap *tap, uint32_t new_instr) +{ + if (buf_get_u32(tap->cur_instr, 0, tap->ir_length) != new_instr) { + LOG_DEBUG("%s: doing something", __func__); + struct scan_field field; + field.num_bits = tap->ir_length; + void *t = calloc(DIV_ROUND_UP(field.num_bits, 8), 1); + field.out_value = t; + buf_set_u32(t, 0, field.num_bits, new_instr); + field.in_value = NULL; + jtag_add_ir_scan(tap, &field, TAP_IDLE); + free(t); + } else + LOG_DEBUG("%s: not doing something", __func__); +} + +static void ls1_sap_set_addr_high(struct jtag_tap *tap, uint16_t addr_high) +{ + struct scan_field field; + uint8_t buf[2]; + + ls1_sap_set_instr(tap, 0x21); + + field.num_bits = 16; + field.out_value = buf; + buf_set_u32(buf, 0, 16, addr_high); + field.in_value = NULL; + field.check_value = NULL; + field.check_mask = NULL; + jtag_add_dr_scan(tap, 1, &field, TAP_IDLE); +} + +static void ls1_sap_memory_cmd(struct jtag_tap *tap, uint32_t address, + int32_t size, int read) +{ + struct scan_field field; + uint8_t cmd[8]; + + ls1_sap_set_instr(tap, 0x24); + + field.num_bits = 64; + field.out_value = cmd; + buf_set_u64(cmd, 0, 9, 0); + buf_set_u64(cmd, 9, 3, size); + buf_set_u64(cmd, 12, 1, !!read); + buf_set_u64(cmd, 13, 3, 0); + buf_set_u64(cmd, 16, 32, address); + buf_set_u64(cmd, 48, 16, 0); + field.in_value = NULL; + field.check_value = NULL; + field.check_mask = NULL; + jtag_add_dr_scan(tap, 1, &field, TAP_IDLE); +} + +static void ls1_sap_memory_read(struct jtag_tap *tap, uint32_t size, + uint8_t *value) +{ + struct scan_field field; + + ls1_sap_set_instr(tap, 0x25); + + field.num_bits = 8 * size; + field.out_value = NULL; + field.in_value = value; + field.check_value = NULL; + field.check_mask = NULL; + jtag_add_dr_scan(tap, 1, &field, TAP_IDLE); +} + +static void ls1_sap_memory_write(struct jtag_tap *tap, uint32_t size, + const uint8_t *value) +{ + struct scan_field field; + + ls1_sap_set_instr(tap, 0x25); + + field.num_bits = 8 * size; + field.out_value = value; + field.in_value = NULL; + field.check_value = NULL; + field.check_mask = NULL; + jtag_add_dr_scan(tap, 1, &field, TAP_IDLE); +} + +static int ls1_sap_read_memory(struct target *target, uint32_t address, + uint32_t size, uint32_t count, uint8_t *buffer) +{ + LOG_DEBUG("Reading memory at physical address 0x%" PRIx32 + "; size %" PRId32 "; count %" PRId32, address, size, count); + + if (count == 0 || buffer == NULL) + return ERROR_COMMAND_SYNTAX_ERROR; + + ls1_sap_set_addr_high(target->tap, 0); + + while (count--) { + ls1_sap_memory_cmd(target->tap, address, size, 1); + ls1_sap_memory_read(target->tap, size, buffer); + address += size; + buffer += size; + } + + return jtag_execute_queue(); +} + +static int ls1_sap_write_memory(struct target *target, uint32_t address, + uint32_t size, uint32_t count, + const uint8_t *buffer) +{ + LOG_DEBUG("Writing memory at physical address 0x%" PRIx32 + "; size %" PRId32 "; count %" PRId32, address, size, count); + + + if (count == 0 || buffer == NULL) + return ERROR_COMMAND_SYNTAX_ERROR; + + ls1_sap_set_addr_high(target->tap, 0); + + while (count--) { + ls1_sap_memory_cmd(target->tap, address, size, 0); + ls1_sap_memory_write(target->tap, size, buffer); + address += size; + buffer += size; + } + + return jtag_execute_queue(); +} + +struct target_type ls1_sap_target = { + .name = "ls1_sap", + + .target_create = ls1_sap_target_create, + .init_target = ls1_sap_init_target, + + .poll = ls1_sap_poll, + .arch_state = ls1_sap_arch_state, + + .halt = ls1_sap_halt, + .resume = ls1_sap_resume, + .step = ls1_sap_step, + + .assert_reset = ls1_sap_assert_reset, + .deassert_reset = ls1_sap_deassert_reset, + + .read_memory = ls1_sap_read_memory, + .write_memory = ls1_sap_write_memory, +}; diff --git a/src/target/target.c b/src/target/target.c index 19e5d65..233fe21 100644 --- a/src/target/target.c +++ b/src/target/target.c @@ -92,6 +92,7 @@ extern struct target_type cortexm_target; extern struct target_type cortexa_target; extern struct target_type cortexr4_target; extern struct target_type arm11_target; +extern struct target_type ls1_sap_target; extern struct target_type mips_m4k_target; extern struct target_type avr_target; extern struct target_type dsp563xx_target; @@ -121,6 +122,7 @@ static struct target_type *target_types[] = { &cortexa_target, &cortexr4_target, &arm11_target, + &ls1_sap_target, &mips_m4k_target, &avr_target, &dsp563xx_target, -- |
