From a8c62a932cbe977e48210b56b16b9bdc0503e691 Mon Sep 17 00:00:00 2001 From: Alex Taradov Date: Sun, 23 Feb 2020 14:48:05 -0800 Subject: [PATCH] Line endigs fix and transfer abort fix --- dap.c | 2067 ++++++++++++++++++++++++++++----------------------------- dap.h | 85 +-- 2 files changed, 1076 insertions(+), 1076 deletions(-) diff --git a/dap.c b/dap.c index 216fd06..7e18320 100644 --- a/dap.c +++ b/dap.c @@ -1,1034 +1,1033 @@ -/* - * Copyright (c) 2016, Alex Taradov - * All rights reserved. - * - * Redistribution and use in source and binary forms, with or without - * modification, are permitted provided that the following conditions are met: - * - * 1. Redistributions of source code must retain the above copyright notice, - * this list of conditions and the following disclaimer. - * 2. Redistributions in binary form must reproduce the above copyright - * notice, this list of conditions and the following disclaimer in the - * documentation and/or other materials provided with the distribution. - * 3. The name of the author may not be used to endorse or promote products - * derived from this software without specific prior written permission. - * - * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" - * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE - * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE - * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE - * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR - * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF - * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS - * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN - * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) - * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE - * POSSIBILITY OF SUCH DAMAGE. - */ - -/*- Includes ----------------------------------------------------------------*/ -#include -#include -#include -#include "dap_config.h" -#include "dap.h" - -#ifdef DAP_CONFIG_ENABLE_JTAG -#error JTAG is not supported. If you have a real need for it, please contact me. -#endif - -#if DAP_CONFIG_PACKET_COUNT != 1 -#error DAP_CONFIG_PACKET_COUNT must be 1 for now. -#endif - -/*- Definitions -------------------------------------------------------------*/ -enum -{ - ID_DAP_INFO = 0x00, - ID_DAP_LED = 0x01, - ID_DAP_CONNECT = 0x02, - ID_DAP_DISCONNECT = 0x03, - ID_DAP_TRANSFER_CONFIGURE = 0x04, - ID_DAP_TRANSFER = 0x05, - ID_DAP_TRANSFER_BLOCK = 0x06, - ID_DAP_TRANSFER_ABORT = 0x07, - ID_DAP_WRITE_ABORT = 0x08, - ID_DAP_DELAY = 0x09, - ID_DAP_RESET_TARGET = 0x0a, - ID_DAP_SWJ_PINS = 0x10, - ID_DAP_SWJ_CLOCK = 0x11, - ID_DAP_SWJ_SEQUENCE = 0x12, - ID_DAP_SWD_CONFIGURE = 0x13, - ID_DAP_JTAG_SEQUENCE = 0x14, - ID_DAP_JTAG_CONFIGURE = 0x15, - ID_DAP_JTAG_IDCODE = 0x16, - ID_DAP_VENDOR_0 = 0x80, - ID_DAP_VENDOR_31 = 0x9f, - ID_DAP_INVALID = 0xff, -}; - -enum -{ - DAP_INFO_VENDOR = 0x01, - DAP_INFO_PRODUCT = 0x02, - DAP_INFO_SER_NUM = 0x03, - DAP_INFO_FW_VER = 0x04, - DAP_INFO_DEVICE_VENDOR = 0x05, - DAP_INFO_DEVICE_NAME = 0x06, - DAP_INFO_CAPABILITIES = 0xf0, - DAP_INFO_PACKET_COUNT = 0xfe, - DAP_INFO_PACKET_SIZE = 0xff, -}; - -enum -{ - DAP_TRANSFER_APnDP = 1 << 0, - DAP_TRANSFER_RnW = 1 << 1, - DAP_TRANSFER_A2 = 1 << 2, - DAP_TRANSFER_A3 = 1 << 3, - DAP_TRANSFER_MATCH_VALUE = 1 << 4, - DAP_TRANSFER_MATCH_MASK = 1 << 5, -}; - -enum -{ - DAP_TRANSFER_INVALID = 0, - DAP_TRANSFER_OK = 1 << 0, - DAP_TRANSFER_WAIT = 1 << 1, - DAP_TRANSFER_FAULT = 1 << 2, - DAP_TRANSFER_ERROR = 1 << 3, - DAP_TRANSFER_MISMATCH = 1 << 4, -}; - -enum -{ - DAP_PORT_DISABLED = 0, - DAP_PORT_AUTODETECT = 0, - DAP_PORT_SWD = 1, - DAP_PORT_JTAG = 2, -}; - -enum -{ - DAP_SWJ_SWCLK_TCK = 1 << 0, - DAP_SWJ_SWDIO_TMS = 1 << 1, - DAP_SWJ_TDI = 1 << 2, - DAP_SWJ_TDO = 1 << 3, - DAP_SWJ_nTRST = 1 << 5, - DAP_SWJ_nRESET = 1 << 7, -}; - -enum -{ - DAP_OK = 0x00, - DAP_ERROR = 0xff, -}; - -enum -{ - SWD_DP_R_IDCODE = 0x00, - SWD_DP_W_ABORT = 0x00, - SWD_DP_R_CTRL_STAT = 0x04, - SWD_DP_W_CTRL_STAT = 0x04, // When CTRLSEL == 0 - SWD_DP_W_WCR = 0x04, // When CTRLSEL == 1 - SWD_DP_R_RESEND = 0x08, - SWD_DP_W_SELECT = 0x08, - SWD_DP_R_RDBUFF = 0x0c, -}; - -/*- Constants ---------------------------------------------------------------*/ -static const char * const dap_info_strings[] = -{ - [DAP_INFO_VENDOR] = DAP_CONFIG_VENDOR_STR, - [DAP_INFO_PRODUCT] = DAP_CONFIG_PRODUCT_STR, - [DAP_INFO_SER_NUM] = DAP_CONFIG_SER_NUM_STR, - [DAP_INFO_FW_VER] = DAP_CONFIG_FW_VER_STR, - [DAP_INFO_DEVICE_VENDOR] = DAP_CONFIG_DEVICE_VENDOR_STR, - [DAP_INFO_DEVICE_NAME] = DAP_CONFIG_DEVICE_NAME_STR, -}; - -/*- Variables ---------------------------------------------------------------*/ -static int dap_port; -static bool dap_abort; -static uint32_t dap_match_mask; -static int dap_idle_cycles; -static int dap_retry_count; -static int dap_match_retry_count; -static int dap_clock_delay; - -static void (*dap_swd_clock)(int); -static void (*dap_swd_write)(uint32_t, int); -static uint32_t (*dap_swd_read)(int); - -#ifdef DAP_CONFIG_ENABLE_SWD -static int dap_swd_turnaround; -static bool dap_swd_data_phase; -#endif - -/*- Implementations ---------------------------------------------------------*/ - -//----------------------------------------------------------------------------- -static inline void dap_delay_loop(int delay) -{ - while (--delay) - asm("nop"); -} - -//----------------------------------------------------------------------------- -static void dap_delay_us(int delay) -{ - while (delay) - { - int del = (delay > 100000) ? 100000 : delay; - - dap_delay_loop((DAP_CONFIG_DELAY_CONSTANT * 2 * del) / 1000); - - delay -= del; - } -} - -//----------------------------------------------------------------------------- -static void dap_swd_clock_slow(int cycles) -{ - while (cycles--) - { - DAP_CONFIG_SWCLK_TCK_clr(); - dap_delay_loop(dap_clock_delay); - DAP_CONFIG_SWCLK_TCK_set(); - dap_delay_loop(dap_clock_delay); - } -} - -//----------------------------------------------------------------------------- -static void dap_swd_write_slow(uint32_t value, int size) -{ - for (int i = 0; i < size; i++) - { - DAP_CONFIG_SWDIO_TMS_write(value & 1); - DAP_CONFIG_SWCLK_TCK_clr(); - dap_delay_loop(dap_clock_delay); - DAP_CONFIG_SWCLK_TCK_set(); - dap_delay_loop(dap_clock_delay); - value >>= 1; - } -} - -//----------------------------------------------------------------------------- -static uint32_t dap_swd_read_slow(int size) -{ - uint32_t value = 0; - - for (int i = 0; i < size; i++) - { - DAP_CONFIG_SWCLK_TCK_clr(); - dap_delay_loop(dap_clock_delay); - value |= ((uint32_t)DAP_CONFIG_SWDIO_TMS_read() << i); - DAP_CONFIG_SWCLK_TCK_set(); - dap_delay_loop(dap_clock_delay); - } - - return value; -} - -//----------------------------------------------------------------------------- -static void dap_swd_clock_fast(int cycles) -{ - while (cycles--) - { - DAP_CONFIG_SWCLK_TCK_clr(); - DAP_CONFIG_SWCLK_TCK_set(); - } -} - -//----------------------------------------------------------------------------- -static void dap_swd_write_fast(uint32_t value, int size) -{ - for (int i = 0; i < size; i++) - { - DAP_CONFIG_SWDIO_TMS_write(value & 1); - DAP_CONFIG_SWCLK_TCK_clr(); - value >>= 1; - DAP_CONFIG_SWCLK_TCK_set(); - } -} - -//----------------------------------------------------------------------------- -static uint32_t dap_swd_read_fast(int size) -{ - uint32_t value = 0; - uint32_t bit; - - for (int i = 0; i < size; i++) - { - DAP_CONFIG_SWCLK_TCK_clr(); - bit = DAP_CONFIG_SWDIO_TMS_read(); - DAP_CONFIG_SWCLK_TCK_set(); - value |= (bit << i); - } - - return value; -} - -//----------------------------------------------------------------------------- -static void dap_setup_clock(int freq) -{ - if (freq > DAP_CONFIG_FAST_CLOCK) - { - dap_clock_delay = 1; - dap_swd_clock = dap_swd_clock_fast; - dap_swd_write = dap_swd_write_fast; - dap_swd_read = dap_swd_read_fast; - } - else - { - dap_clock_delay = (DAP_CONFIG_DELAY_CONSTANT * 1000) / freq; - dap_swd_clock = dap_swd_clock_slow; - dap_swd_write = dap_swd_write_slow; - dap_swd_read = dap_swd_read_slow; - } -} - -//----------------------------------------------------------------------------- -static inline uint32_t dap_parity(uint32_t value) -{ - value ^= value >> 16; - value ^= value >> 8; - value ^= value >> 4; - value &= 0x0f; - - return (0x6996 >> value) & 1; -} - -//----------------------------------------------------------------------------- -static int dap_swd_operation(int req, uint32_t *data) -{ - uint32_t value; - int ack = 0; - - dap_swd_write(0x81 | (dap_parity(req) << 5) | (req << 1), 8); - - DAP_CONFIG_SWDIO_TMS_in(); - - dap_swd_clock(dap_swd_turnaround); - - ack = dap_swd_read(3); - - if (DAP_TRANSFER_OK == ack) - { - if (req & DAP_TRANSFER_RnW) - { - value = dap_swd_read(32); - - if (dap_parity(value) != dap_swd_read(1)) - ack = DAP_TRANSFER_ERROR; - - if (data) - *data = value; - - dap_swd_clock(dap_swd_turnaround); - - DAP_CONFIG_SWDIO_TMS_out(); - } - else - { - dap_swd_clock(dap_swd_turnaround); - - DAP_CONFIG_SWDIO_TMS_out(); - - dap_swd_write(*data, 32); - dap_swd_write(dap_parity(*data), 1); - } - - DAP_CONFIG_SWDIO_TMS_write(0); - dap_swd_clock(dap_idle_cycles); - } - - else if (DAP_TRANSFER_WAIT == ack || DAP_TRANSFER_FAULT == ack) - { - if (dap_swd_data_phase && (req & DAP_TRANSFER_RnW)) - dap_swd_clock(32 + 1); - - dap_swd_clock(dap_swd_turnaround); - - DAP_CONFIG_SWDIO_TMS_out(); - - if (dap_swd_data_phase && (0 == (req & DAP_TRANSFER_RnW))) - { - DAP_CONFIG_SWDIO_TMS_write(0); - dap_swd_clock(32 + 1); - } - } - - else - { - dap_swd_clock(dap_swd_turnaround + 32 + 1); - } - - DAP_CONFIG_SWDIO_TMS_write(1); - - return ack; -} - -//----------------------------------------------------------------------------- -static int dap_swd_transfer_word(int req, uint32_t *data) -{ - int ack; - - req &= (DAP_TRANSFER_APnDP | DAP_TRANSFER_RnW | DAP_TRANSFER_A2 | DAP_TRANSFER_A3); - - for (int i = 0; i < dap_retry_count; i++) - { - ack = dap_swd_operation(req, data); - - if (DAP_TRANSFER_WAIT != ack || dap_abort) - break; - } - - return ack; -} - -//----------------------------------------------------------------------------- -static void dap_swd_transfer(uint8_t *req, uint8_t *resp) -{ - int req_count, resp_count, request, ack; - uint8_t *req_data, *resp_data; - bool posted_read, verify_write; - uint32_t data, match_value; - - req_count = req[1]; - req_data = &req[2]; - - ack = DAP_TRANSFER_INVALID; - resp_count = 0; - resp_data = &resp[2]; - - posted_read = false; - verify_write = false; - - while (req_count && !dap_abort) - { - verify_write = false; - request = req_data[0]; - req_data++; - - if (posted_read) - { - if ((request & DAP_TRANSFER_APnDP) && (request & DAP_TRANSFER_RnW)) - { - ack = dap_swd_transfer_word(request, &data); - } - else - { - ack = dap_swd_transfer_word(SWD_DP_R_RDBUFF | DAP_TRANSFER_RnW, &data); - posted_read = false; - } - - if (ack != DAP_TRANSFER_OK) - break; - - resp_data[0] = data; - resp_data[1] = data >> 8; - resp_data[2] = data >> 16; - resp_data[3] = data >> 24; - resp_data += 4; - } - - if (request & DAP_TRANSFER_RnW) - { - if (request & DAP_TRANSFER_MATCH_VALUE) - { - match_value = ((uint32_t)req_data[3] << 24) | ((uint32_t)req_data[2] << 16) | - ((uint32_t)req_data[1] << 8) | req_data[0]; - req_data += 4; - - for (int i = 0; i < dap_match_retry_count; i++) - { - ack = dap_swd_transfer_word(request, &data); - - if (DAP_TRANSFER_OK != ack || (data & dap_match_mask) == match_value || dap_abort) - break; - }; - - if ((data & dap_match_mask) != match_value) - ack |= DAP_TRANSFER_MISMATCH; - - if (ack != DAP_TRANSFER_OK) - break; - } - else - { - if (request & DAP_TRANSFER_APnDP) - { - if (!posted_read) - { - ack = dap_swd_transfer_word(request, NULL); - - if (ack != DAP_TRANSFER_OK) - break; - - posted_read = true; - } - } - else - { - ack = dap_swd_transfer_word(request, &data); - - if (DAP_TRANSFER_OK != ack) - break; - - resp_data[0] = data; - resp_data[1] = data >> 8; - resp_data[2] = data >> 16; - resp_data[3] = data >> 24; - resp_data += 4; - } - } - } - else - { - data = ((uint32_t)req_data[3] << 24) | ((uint32_t)req_data[2] << 16) | - ((uint32_t)req_data[1] << 8) | req_data[0]; - req_data += 4; - - if (request & DAP_TRANSFER_MATCH_MASK) - { - ack = DAP_TRANSFER_OK; - dap_match_mask = data; - } - else - { - ack = dap_swd_transfer_word(request, &data); - - if (ack != DAP_TRANSFER_OK) - break; - - verify_write = true; - } - } - - req_count--; - resp_count++; - } - - if (DAP_TRANSFER_OK == ack) - { - if (posted_read) - { - ack = dap_swd_transfer_word(SWD_DP_R_RDBUFF | DAP_TRANSFER_RnW, &data); - - // Save data regardless of the ACK status, at this point it does not matter - resp_data[0] = data; - resp_data[1] = data >> 8; - resp_data[2] = data >> 16; - resp_data[3] = data >> 24; - } - else if (verify_write) - { - ack = dap_swd_transfer_word(SWD_DP_R_RDBUFF | DAP_TRANSFER_RnW, NULL); - } - } - - resp[0] = resp_count; - resp[1] = ack; -} - -//----------------------------------------------------------------------------- -static void dap_swd_transfer_block(uint8_t *req, uint8_t *resp) -{ - int req_count, resp_count, request, ack; - uint8_t *req_data, *resp_data; - uint32_t data; - - req_count = ((int)req[2] << 8) | req[1]; - request = req[3]; - req_data = &req[4]; - - ack = DAP_TRANSFER_INVALID; - resp_count = 0; - resp_data = &resp[3]; - - resp[0] = 0; - resp[1] = 0; - resp[2] = DAP_TRANSFER_INVALID; - - if (0 == req_count) - return; - - if (request & DAP_TRANSFER_RnW) - { - int transfers = (request & DAP_TRANSFER_APnDP) ? (req_count + 1) : req_count; - - for (int i = 0; i < transfers; i++) - { - if (i == req_count) // This will only happen for AP transfers - request = SWD_DP_R_RDBUFF | DAP_TRANSFER_RnW; - - ack = dap_swd_transfer_word(request, &data); - - if (DAP_TRANSFER_OK != ack) - break; - - if ((0 == i) && (request & DAP_TRANSFER_APnDP)) - continue; - - resp_data[0] = data; - resp_data[1] = data >> 8; - resp_data[2] = data >> 16; - resp_data[3] = data >> 24; - resp_data += 4; - resp_count++; - } - } - else - { - for (int i = 0; i < req_count; i++) - { - data = ((uint32_t)req_data[3] << 24) | ((uint32_t)req_data[2] << 16) | - ((uint32_t)req_data[1] << 8) | ((uint32_t)req_data[0] << 0); - req_data += 4; - - ack = dap_swd_transfer_word(request, &data); - - if (DAP_TRANSFER_OK != ack) - break; - - resp_count++; - } - - if (DAP_TRANSFER_OK == ack) - ack = dap_swd_transfer_word(SWD_DP_R_RDBUFF | DAP_TRANSFER_RnW, NULL); - } - - resp[0] = resp_count; - resp[1] = resp_count >> 8; - resp[2] = ack; -} - -//----------------------------------------------------------------------------- -static void dap_info(uint8_t *req, uint8_t *resp) -{ - int index = req[0]; - - if (DAP_INFO_VENDOR <= index && index <= DAP_INFO_DEVICE_NAME) - { - if (dap_info_strings[index]) - { - resp[0] = strlen(dap_info_strings[index]) + 1; - strcpy((char *)&resp[1], dap_info_strings[index]); - } - else - { - resp[0] = 0; - } - } - else if (DAP_INFO_CAPABILITIES == index) - { - resp[0] = 1; - resp[1] = 0; - -#ifdef DAP_CONFIG_ENABLE_SWD - resp[1] |= DAP_PORT_SWD; -#endif -#ifdef DAP_CONFIG_ENABLE_JTAG - resp[1] |= DAP_PORT_JTAG; -#endif - } - else if (DAP_INFO_PACKET_COUNT == index) - { - resp[0] = 1; - resp[1] = DAP_CONFIG_PACKET_COUNT; - } - else if (DAP_INFO_PACKET_SIZE == index) - { - resp[0] = 2; - resp[1] = DAP_CONFIG_PACKET_SIZE; - resp[2] = DAP_CONFIG_PACKET_SIZE >> 8; - } -} - -//----------------------------------------------------------------------------- -static void dap_led(uint8_t *req, uint8_t *resp) -{ - int index = req[0]; - int state = req[1]; - - DAP_CONFIG_LED(index, state); - - resp[0] = DAP_OK; -} - -//----------------------------------------------------------------------------- -static void dap_connect(uint8_t *req, uint8_t *resp) -{ - int port = req[0]; - - if (DAP_PORT_AUTODETECT == port) - port = DAP_CONFIG_DEFAULT_PORT; - - dap_port = DAP_PORT_DISABLED; - -#ifdef DAP_CONFIG_ENABLE_SWD - if (DAP_PORT_SWD == port) - { - DAP_CONFIG_CONNECT_SWD(); - dap_port = DAP_PORT_SWD; - } -#endif - -#ifdef DAP_CONFIG_ENABLE_JTAG - if (DAP_PORT_JTAG == port) - { - DAP_CONFIG_CONNECT_JTAG(); - dap_port = DAP_PORT_JTAG; - } -#endif - - resp[0] = dap_port; -} - -//----------------------------------------------------------------------------- -static void dap_disconnect(uint8_t *req, uint8_t *resp) -{ - DAP_CONFIG_DISCONNECT(); - - dap_port = DAP_PORT_DISABLED; - - resp[0] = DAP_OK; - - (void)req; -} - -//----------------------------------------------------------------------------- -static void dap_transfer_configure(uint8_t *req, uint8_t *resp) -{ - dap_idle_cycles = req[0]; - dap_retry_count = ((int)req[2] << 8) | req[1]; - dap_match_retry_count = ((int)req[4] << 8) | req[3]; - - resp[0] = DAP_OK; -} - -//----------------------------------------------------------------------------- -static void dap_transfer(uint8_t *req, uint8_t *resp) -{ - resp[0] = 0; - resp[1] = DAP_TRANSFER_INVALID; - -#ifdef DAP_CONFIG_ENABLE_SWD - if (DAP_PORT_SWD == dap_port) - dap_swd_transfer(req, resp); -#endif - -#ifdef DAP_CONFIG_ENABLE_JTAG - if (DAP_PORT_JTAG == dap_port) - dap_jtag_transfer(req, resp); -#endif -} - -//----------------------------------------------------------------------------- -static void dap_transfer_block(uint8_t *req, uint8_t *resp) -{ - resp[0] = 0; - resp[1] = 0; - resp[2] = DAP_TRANSFER_INVALID; - -#ifdef DAP_CONFIG_ENABLE_SWD - if (DAP_PORT_SWD == dap_port) - dap_swd_transfer_block(req, resp); -#endif - -#ifdef DAP_CONFIG_ENABLE_JTAG - if (DAP_PORT_JTAG == dap_port) - dap_jtag_transfer_block(req, resp); -#endif -} - -//----------------------------------------------------------------------------- -static void dap_transfer_abort(uint8_t *req, uint8_t *resp) -{ - // This request is handled outside of the normal queue - // TODO: verify entire transfer abort mechanism - resp[0] = DAP_OK; - (void)req; -} - -//----------------------------------------------------------------------------- -static void dap_write_abort(uint8_t *req, uint8_t *resp) -{ -#ifdef DAP_CONFIG_ENABLE_SWD - if (DAP_PORT_SWD == dap_port) - { - uint32_t data; - - data = ((uint32_t)req[4] << 24) | ((uint32_t)req[3] << 16) | - ((uint32_t)req[2] << 8) | ((uint32_t)req[1] << 0); - - dap_swd_transfer_word(SWD_DP_W_ABORT, &data); - - resp[0] = DAP_OK; - } -#endif - -#ifdef DAP_CONFIG_ENABLE_JTAG - if (DAP_PORT_JTAG == dap_port) - { - // TODO: implement - resp[0] = DAP_OK; - } -#endif -} - -//----------------------------------------------------------------------------- -static void dap_delay(uint8_t *req, uint8_t *resp) -{ - int delay; - - delay = ((int)req[1] << 8) | req[0]; - - dap_delay_us(delay); - - resp[0] = DAP_OK; -} - -//----------------------------------------------------------------------------- -static void dap_reset_target(uint8_t *req, uint8_t *resp) -{ - resp[0] = DAP_OK; -#ifdef DAP_CONFIG_RESET_TARGET_FN - resp[1] = 1; - DAP_CONFIG_RESET_TARGET_FN(); -#endif - (void)req; -} - -//----------------------------------------------------------------------------- -static void dap_swj_pins(uint8_t *req, uint8_t *resp) -{ - int value = req[0]; - int select = req[1]; - int wait; - - wait = ((int)req[5] << 24) | ((int)req[4] << 16) | ((int)req[3] << 8) | req[2]; - - if (select & DAP_SWJ_SWCLK_TCK) - DAP_CONFIG_SWCLK_TCK_write(value & DAP_SWJ_SWCLK_TCK); - - if (select & DAP_SWJ_SWDIO_TMS) - DAP_CONFIG_SWDIO_TMS_write(value & DAP_SWJ_SWDIO_TMS); - - if (select & DAP_SWJ_TDI) - DAP_CONFIG_TDO_write(value & DAP_SWJ_TDI); - - if (select & DAP_SWJ_nTRST) - DAP_CONFIG_nTRST_write(value & DAP_SWJ_nTRST); - - if (select & DAP_SWJ_nRESET) - DAP_CONFIG_nRESET_write(value & DAP_SWJ_nRESET); - - dap_delay_us(wait * 1000); - - value = - (DAP_CONFIG_SWCLK_TCK_read() ? DAP_SWJ_SWCLK_TCK : 0) | - (DAP_CONFIG_SWDIO_TMS_read() ? DAP_SWJ_SWDIO_TMS : 0) | - (DAP_CONFIG_TDI_read() ? DAP_SWJ_TDI : 0) | - (DAP_CONFIG_TDO_read() ? DAP_SWJ_TDO : 0) | - (DAP_CONFIG_nTRST_read() ? DAP_SWJ_nTRST : 0) | - (DAP_CONFIG_nRESET_read() ? DAP_SWJ_nRESET : 0); - - resp[0] = value; -} - -//----------------------------------------------------------------------------- -static void dap_swj_clock(uint8_t *req, uint8_t *resp) -{ - uint32_t freq; - - freq = ((uint32_t)req[3] << 24) | ((uint32_t)req[2] << 16) | - ((uint32_t)req[1] << 8) | req[0]; - - dap_setup_clock(freq); - - resp[0] = DAP_OK; -} - -//----------------------------------------------------------------------------- -static void dap_swj_sequence(uint8_t *req, uint8_t *resp) -{ - int size = req[0]; - uint8_t *data = &req[1]; - int offset = 0; - - while (size) - { - int sz = (size > 8) ? 8 : size; - - dap_swd_write(data[offset], sz); - - size -= sz; - offset++; - } - - resp[0] = DAP_OK; -} - -//----------------------------------------------------------------------------- -static void dap_swd_configure(uint8_t *req, uint8_t *resp) -{ -#ifdef DAP_CONFIG_ENABLE_SWD - uint8_t data = req[0]; - - dap_swd_turnaround = (data & 3) + 1; - dap_swd_data_phase = (data & 4) ? 1 : 0; - - resp[0] = DAP_OK; -#endif - - (void)req; - (void)resp; -} - -//----------------------------------------------------------------------------- -static void dap_jtag_sequence(uint8_t *req, uint8_t *resp) -{ -#ifdef DAP_CONFIG_ENABLE_JTAG - // TODO: implement - resp[0] = DAP_OK; -#endif - - (void)req; - (void)resp; -} - -//----------------------------------------------------------------------------- -static void dap_jtag_configure(uint8_t *req, uint8_t *resp) -{ -#ifdef DAP_CONFIG_ENABLE_JTAG - // TODO: implement - resp[0] = DAP_OK; -#endif - - (void)req; - (void)resp; -} - -//----------------------------------------------------------------------------- -static void dap_jtag_idcode(uint8_t *req, uint8_t *resp) -{ -#ifdef DAP_CONFIG_ENABLE_JTAG - // TODO: implement - resp[0] = DAP_OK; -#endif - - (void)req; - (void)resp; -} - -//----------------------------------------------------------------------------- -void dap_init(void) -{ - dap_port = 0; - dap_abort = false; - dap_match_mask = 0; - dap_idle_cycles = 0; - dap_retry_count = 100; - dap_match_retry_count = 100; - -#ifdef DAP_CONFIG_ENABLE_SWD - dap_swd_turnaround = 1; - dap_swd_data_phase = false; -#endif - - dap_setup_clock(DAP_CONFIG_DEFAULT_CLOCK); - - DAP_CONFIG_SETUP(); -} - -//----------------------------------------------------------------------------- -void dap_filter_request(uint8_t *req) -{ - int cmd = req[0]; - - if (ID_DAP_TRANSFER_ABORT == cmd) - { - dap_abort = true; - } -} - -//----------------------------------------------------------------------------- -void dap_process_request(uint8_t *req, uint8_t *resp) -{ - const struct - { - int cmd; - void (*handler)(uint8_t *, uint8_t *); - } handlers[] = - { - { ID_DAP_INFO, dap_info }, - { ID_DAP_LED, dap_led }, - { ID_DAP_CONNECT, dap_connect }, - { ID_DAP_DISCONNECT, dap_disconnect }, - { ID_DAP_TRANSFER_CONFIGURE, dap_transfer_configure }, - { ID_DAP_TRANSFER, dap_transfer }, - { ID_DAP_TRANSFER_BLOCK, dap_transfer_block }, - { ID_DAP_TRANSFER_ABORT, dap_transfer_abort }, - { ID_DAP_WRITE_ABORT, dap_write_abort }, - { ID_DAP_DELAY, dap_delay }, - { ID_DAP_RESET_TARGET, dap_reset_target }, - { ID_DAP_SWJ_PINS, dap_swj_pins }, - { ID_DAP_SWJ_CLOCK, dap_swj_clock }, - { ID_DAP_SWJ_SEQUENCE, dap_swj_sequence }, - { ID_DAP_SWD_CONFIGURE, dap_swd_configure }, - { ID_DAP_JTAG_SEQUENCE, dap_jtag_sequence }, - { ID_DAP_JTAG_CONFIGURE, dap_jtag_configure }, - { ID_DAP_JTAG_IDCODE, dap_jtag_idcode }, - { -1, NULL }, - }; - int cmd = req[0]; - - memset(resp, 0, DAP_CONFIG_PACKET_SIZE); - - dap_abort = false; - - resp[0] = cmd; - resp[1] = DAP_ERROR; - - for (int i = 0; -1 != handlers[i].cmd; i++) - { - if (cmd == handlers[i].cmd) - { - handlers[i].handler(&req[1], &resp[1]); - return; - } - } - - if (ID_DAP_VENDOR_0 <= cmd && cmd <= ID_DAP_VENDOR_31) - return; - - resp[0] = ID_DAP_INVALID; -} - -//----------------------------------------------------------------------------- -void dap_clock_test(int delay) -{ - DAP_CONFIG_CONNECT_SWD(); - - if (delay) - { - while (1) - { - DAP_CONFIG_SWCLK_TCK_clr(); - dap_delay_loop(delay); - DAP_CONFIG_SWCLK_TCK_set(); - dap_delay_loop(delay); - } - } - else - { - while (1) - { - DAP_CONFIG_SWCLK_TCK_clr(); - DAP_CONFIG_SWCLK_TCK_set(); - } - } -} - +/* + * Copyright (c) 2016, Alex Taradov + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * 1. Redistributions of source code must retain the above copyright notice, + * this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + */ + +/*- Includes ----------------------------------------------------------------*/ +#include +#include +#include +#include "dap_config.h" +#include "dap.h" + +#ifdef DAP_CONFIG_ENABLE_JTAG +#error JTAG is not supported. If you have a real need for it, please contact me. +#endif + +/*- Definitions -------------------------------------------------------------*/ +enum +{ + ID_DAP_INFO = 0x00, + ID_DAP_LED = 0x01, + ID_DAP_CONNECT = 0x02, + ID_DAP_DISCONNECT = 0x03, + ID_DAP_TRANSFER_CONFIGURE = 0x04, + ID_DAP_TRANSFER = 0x05, + ID_DAP_TRANSFER_BLOCK = 0x06, + ID_DAP_TRANSFER_ABORT = 0x07, + ID_DAP_WRITE_ABORT = 0x08, + ID_DAP_DELAY = 0x09, + ID_DAP_RESET_TARGET = 0x0a, + ID_DAP_SWJ_PINS = 0x10, + ID_DAP_SWJ_CLOCK = 0x11, + ID_DAP_SWJ_SEQUENCE = 0x12, + ID_DAP_SWD_CONFIGURE = 0x13, + ID_DAP_JTAG_SEQUENCE = 0x14, + ID_DAP_JTAG_CONFIGURE = 0x15, + ID_DAP_JTAG_IDCODE = 0x16, + ID_DAP_VENDOR_0 = 0x80, + ID_DAP_VENDOR_31 = 0x9f, + ID_DAP_INVALID = 0xff, +}; + +enum +{ + DAP_INFO_VENDOR = 0x01, + DAP_INFO_PRODUCT = 0x02, + DAP_INFO_SER_NUM = 0x03, + DAP_INFO_FW_VER = 0x04, + DAP_INFO_DEVICE_VENDOR = 0x05, + DAP_INFO_DEVICE_NAME = 0x06, + DAP_INFO_CAPABILITIES = 0xf0, + DAP_INFO_PACKET_COUNT = 0xfe, + DAP_INFO_PACKET_SIZE = 0xff, +}; + +enum +{ + DAP_TRANSFER_APnDP = 1 << 0, + DAP_TRANSFER_RnW = 1 << 1, + DAP_TRANSFER_A2 = 1 << 2, + DAP_TRANSFER_A3 = 1 << 3, + DAP_TRANSFER_MATCH_VALUE = 1 << 4, + DAP_TRANSFER_MATCH_MASK = 1 << 5, +}; + +enum +{ + DAP_TRANSFER_INVALID = 0, + DAP_TRANSFER_OK = 1 << 0, + DAP_TRANSFER_WAIT = 1 << 1, + DAP_TRANSFER_FAULT = 1 << 2, + DAP_TRANSFER_ERROR = 1 << 3, + DAP_TRANSFER_MISMATCH = 1 << 4, +}; + +enum +{ + DAP_PORT_DISABLED = 0, + DAP_PORT_AUTODETECT = 0, + DAP_PORT_SWD = 1, + DAP_PORT_JTAG = 2, +}; + +enum +{ + DAP_SWJ_SWCLK_TCK = 1 << 0, + DAP_SWJ_SWDIO_TMS = 1 << 1, + DAP_SWJ_TDI = 1 << 2, + DAP_SWJ_TDO = 1 << 3, + DAP_SWJ_nTRST = 1 << 5, + DAP_SWJ_nRESET = 1 << 7, +}; + +enum +{ + DAP_OK = 0x00, + DAP_ERROR = 0xff, +}; + +enum +{ + SWD_DP_R_IDCODE = 0x00, + SWD_DP_W_ABORT = 0x00, + SWD_DP_R_CTRL_STAT = 0x04, + SWD_DP_W_CTRL_STAT = 0x04, // When CTRLSEL == 0 + SWD_DP_W_WCR = 0x04, // When CTRLSEL == 1 + SWD_DP_R_RESEND = 0x08, + SWD_DP_W_SELECT = 0x08, + SWD_DP_R_RDBUFF = 0x0c, +}; + +/*- Constants ---------------------------------------------------------------*/ +static const char * const dap_info_strings[] = +{ + [DAP_INFO_VENDOR] = DAP_CONFIG_VENDOR_STR, + [DAP_INFO_PRODUCT] = DAP_CONFIG_PRODUCT_STR, + [DAP_INFO_SER_NUM] = DAP_CONFIG_SER_NUM_STR, + [DAP_INFO_FW_VER] = DAP_CONFIG_FW_VER_STR, + [DAP_INFO_DEVICE_VENDOR] = DAP_CONFIG_DEVICE_VENDOR_STR, + [DAP_INFO_DEVICE_NAME] = DAP_CONFIG_DEVICE_NAME_STR, +}; + +/*- Variables ---------------------------------------------------------------*/ +static int dap_port; +static bool dap_abort; +static uint32_t dap_match_mask; +static int dap_idle_cycles; +static int dap_retry_count; +static int dap_match_retry_count; +static int dap_clock_delay; + +static void (*dap_swd_clock)(int); +static void (*dap_swd_write)(uint32_t, int); +static uint32_t (*dap_swd_read)(int); + +#ifdef DAP_CONFIG_ENABLE_SWD +static int dap_swd_turnaround; +static bool dap_swd_data_phase; +#endif + +/*- Implementations ---------------------------------------------------------*/ + +//----------------------------------------------------------------------------- +static inline void dap_delay_loop(int delay) +{ + while (--delay) + asm("nop"); +} + +//----------------------------------------------------------------------------- +static void dap_delay_us(int delay) +{ + while (delay) + { + int del = (delay > 100000) ? 100000 : delay; + + dap_delay_loop((DAP_CONFIG_DELAY_CONSTANT * 2 * del) / 1000); + + delay -= del; + } +} + +//----------------------------------------------------------------------------- +static void dap_swd_clock_slow(int cycles) +{ + while (cycles--) + { + DAP_CONFIG_SWCLK_TCK_clr(); + dap_delay_loop(dap_clock_delay); + DAP_CONFIG_SWCLK_TCK_set(); + dap_delay_loop(dap_clock_delay); + } +} + +//----------------------------------------------------------------------------- +static void dap_swd_write_slow(uint32_t value, int size) +{ + for (int i = 0; i < size; i++) + { + DAP_CONFIG_SWDIO_TMS_write(value & 1); + DAP_CONFIG_SWCLK_TCK_clr(); + dap_delay_loop(dap_clock_delay); + DAP_CONFIG_SWCLK_TCK_set(); + dap_delay_loop(dap_clock_delay); + value >>= 1; + } +} + +//----------------------------------------------------------------------------- +static uint32_t dap_swd_read_slow(int size) +{ + uint32_t value = 0; + + for (int i = 0; i < size; i++) + { + DAP_CONFIG_SWCLK_TCK_clr(); + dap_delay_loop(dap_clock_delay); + value |= ((uint32_t)DAP_CONFIG_SWDIO_TMS_read() << i); + DAP_CONFIG_SWCLK_TCK_set(); + dap_delay_loop(dap_clock_delay); + } + + return value; +} + +//----------------------------------------------------------------------------- +static void dap_swd_clock_fast(int cycles) +{ + while (cycles--) + { + DAP_CONFIG_SWCLK_TCK_clr(); + DAP_CONFIG_SWCLK_TCK_set(); + } +} + +//----------------------------------------------------------------------------- +static void dap_swd_write_fast(uint32_t value, int size) +{ + for (int i = 0; i < size; i++) + { + DAP_CONFIG_SWDIO_TMS_write(value & 1); + DAP_CONFIG_SWCLK_TCK_clr(); + value >>= 1; + DAP_CONFIG_SWCLK_TCK_set(); + } +} + +//----------------------------------------------------------------------------- +static uint32_t dap_swd_read_fast(int size) +{ + uint32_t value = 0; + uint32_t bit; + + for (int i = 0; i < size; i++) + { + DAP_CONFIG_SWCLK_TCK_clr(); + bit = DAP_CONFIG_SWDIO_TMS_read(); + DAP_CONFIG_SWCLK_TCK_set(); + value |= (bit << i); + } + + return value; +} + +//----------------------------------------------------------------------------- +static void dap_setup_clock(int freq) +{ + if (freq > DAP_CONFIG_FAST_CLOCK) + { + dap_clock_delay = 1; + dap_swd_clock = dap_swd_clock_fast; + dap_swd_write = dap_swd_write_fast; + dap_swd_read = dap_swd_read_fast; + } + else + { + dap_clock_delay = (DAP_CONFIG_DELAY_CONSTANT * 1000) / freq; + dap_swd_clock = dap_swd_clock_slow; + dap_swd_write = dap_swd_write_slow; + dap_swd_read = dap_swd_read_slow; + } +} + +//----------------------------------------------------------------------------- +static inline uint32_t dap_parity(uint32_t value) +{ + value ^= value >> 16; + value ^= value >> 8; + value ^= value >> 4; + value &= 0x0f; + + return (0x6996 >> value) & 1; +} + +//----------------------------------------------------------------------------- +static int dap_swd_operation(int req, uint32_t *data) +{ + uint32_t value; + int ack = 0; + + dap_swd_write(0x81 | (dap_parity(req) << 5) | (req << 1), 8); + + DAP_CONFIG_SWDIO_TMS_in(); + + dap_swd_clock(dap_swd_turnaround); + + ack = dap_swd_read(3); + + if (DAP_TRANSFER_OK == ack) + { + if (req & DAP_TRANSFER_RnW) + { + value = dap_swd_read(32); + + if (dap_parity(value) != dap_swd_read(1)) + ack = DAP_TRANSFER_ERROR; + + if (data) + *data = value; + + dap_swd_clock(dap_swd_turnaround); + + DAP_CONFIG_SWDIO_TMS_out(); + } + else + { + dap_swd_clock(dap_swd_turnaround); + + DAP_CONFIG_SWDIO_TMS_out(); + + dap_swd_write(*data, 32); + dap_swd_write(dap_parity(*data), 1); + } + + DAP_CONFIG_SWDIO_TMS_write(0); + dap_swd_clock(dap_idle_cycles); + } + + else if (DAP_TRANSFER_WAIT == ack || DAP_TRANSFER_FAULT == ack) + { + if (dap_swd_data_phase && (req & DAP_TRANSFER_RnW)) + dap_swd_clock(32 + 1); + + dap_swd_clock(dap_swd_turnaround); + + DAP_CONFIG_SWDIO_TMS_out(); + + if (dap_swd_data_phase && (0 == (req & DAP_TRANSFER_RnW))) + { + DAP_CONFIG_SWDIO_TMS_write(0); + dap_swd_clock(32 + 1); + } + } + + else + { + dap_swd_clock(dap_swd_turnaround + 32 + 1); + } + + DAP_CONFIG_SWDIO_TMS_write(1); + + return ack; +} + +//----------------------------------------------------------------------------- +static int dap_swd_transfer_word(int req, uint32_t *data) +{ + int ack; + + req &= (DAP_TRANSFER_APnDP | DAP_TRANSFER_RnW | DAP_TRANSFER_A2 | DAP_TRANSFER_A3); + + for (int i = 0; i < dap_retry_count; i++) + { + ack = dap_swd_operation(req, data); + + if (DAP_TRANSFER_WAIT != ack || dap_abort) + break; + } + + return ack; +} + +//----------------------------------------------------------------------------- +static void dap_swd_transfer(uint8_t *req, uint8_t *resp) +{ + int req_count, resp_count, request, ack; + uint8_t *req_data, *resp_data; + bool posted_read, verify_write; + uint32_t data, match_value; + + req_count = req[1]; + req_data = &req[2]; + + ack = DAP_TRANSFER_INVALID; + resp_count = 0; + resp_data = &resp[2]; + + posted_read = false; + verify_write = false; + + while (req_count && !dap_abort) + { + verify_write = false; + request = req_data[0]; + req_data++; + + if (posted_read) + { + if ((request & DAP_TRANSFER_APnDP) && (request & DAP_TRANSFER_RnW)) + { + ack = dap_swd_transfer_word(request, &data); + } + else + { + ack = dap_swd_transfer_word(SWD_DP_R_RDBUFF | DAP_TRANSFER_RnW, &data); + posted_read = false; + } + + if (ack != DAP_TRANSFER_OK) + break; + + resp_data[0] = data; + resp_data[1] = data >> 8; + resp_data[2] = data >> 16; + resp_data[3] = data >> 24; + resp_data += 4; + } + + if (request & DAP_TRANSFER_RnW) + { + if (request & DAP_TRANSFER_MATCH_VALUE) + { + match_value = ((uint32_t)req_data[3] << 24) | ((uint32_t)req_data[2] << 16) | + ((uint32_t)req_data[1] << 8) | req_data[0]; + req_data += 4; + + for (int i = 0; i < dap_match_retry_count; i++) + { + ack = dap_swd_transfer_word(request, &data); + + if (DAP_TRANSFER_OK != ack || (data & dap_match_mask) == match_value || dap_abort) + break; + }; + + if ((data & dap_match_mask) != match_value) + ack |= DAP_TRANSFER_MISMATCH; + + if (ack != DAP_TRANSFER_OK) + break; + } + else + { + if (request & DAP_TRANSFER_APnDP) + { + if (!posted_read) + { + ack = dap_swd_transfer_word(request, NULL); + + if (ack != DAP_TRANSFER_OK) + break; + + posted_read = true; + } + } + else + { + ack = dap_swd_transfer_word(request, &data); + + if (DAP_TRANSFER_OK != ack) + break; + + resp_data[0] = data; + resp_data[1] = data >> 8; + resp_data[2] = data >> 16; + resp_data[3] = data >> 24; + resp_data += 4; + } + } + } + else + { + data = ((uint32_t)req_data[3] << 24) | ((uint32_t)req_data[2] << 16) | + ((uint32_t)req_data[1] << 8) | req_data[0]; + req_data += 4; + + if (request & DAP_TRANSFER_MATCH_MASK) + { + ack = DAP_TRANSFER_OK; + dap_match_mask = data; + } + else + { + ack = dap_swd_transfer_word(request, &data); + + if (ack != DAP_TRANSFER_OK) + break; + + verify_write = true; + } + } + + req_count--; + resp_count++; + } + + if (DAP_TRANSFER_OK == ack) + { + if (posted_read) + { + ack = dap_swd_transfer_word(SWD_DP_R_RDBUFF | DAP_TRANSFER_RnW, &data); + + // Save data regardless of the ACK status, at this point it does not matter + resp_data[0] = data; + resp_data[1] = data >> 8; + resp_data[2] = data >> 16; + resp_data[3] = data >> 24; + } + else if (verify_write) + { + ack = dap_swd_transfer_word(SWD_DP_R_RDBUFF | DAP_TRANSFER_RnW, NULL); + } + } + + resp[0] = resp_count; + resp[1] = ack; +} + +//----------------------------------------------------------------------------- +static void dap_swd_transfer_block(uint8_t *req, uint8_t *resp) +{ + int req_count, resp_count, request, ack; + uint8_t *req_data, *resp_data; + uint32_t data; + + req_count = ((int)req[2] << 8) | req[1]; + request = req[3]; + req_data = &req[4]; + + ack = DAP_TRANSFER_INVALID; + resp_count = 0; + resp_data = &resp[3]; + + resp[0] = 0; + resp[1] = 0; + resp[2] = DAP_TRANSFER_INVALID; + + if (0 == req_count) + return; + + if (request & DAP_TRANSFER_RnW) + { + int transfers = (request & DAP_TRANSFER_APnDP) ? (req_count + 1) : req_count; + + for (int i = 0; i < transfers; i++) + { + if (i == req_count) // This will only happen for AP transfers + request = SWD_DP_R_RDBUFF | DAP_TRANSFER_RnW; + + ack = dap_swd_transfer_word(request, &data); + + if (DAP_TRANSFER_OK != ack) + break; + + if ((0 == i) && (request & DAP_TRANSFER_APnDP)) + continue; + + resp_data[0] = data; + resp_data[1] = data >> 8; + resp_data[2] = data >> 16; + resp_data[3] = data >> 24; + resp_data += 4; + resp_count++; + } + } + else + { + for (int i = 0; i < req_count; i++) + { + data = ((uint32_t)req_data[3] << 24) | ((uint32_t)req_data[2] << 16) | + ((uint32_t)req_data[1] << 8) | ((uint32_t)req_data[0] << 0); + req_data += 4; + + ack = dap_swd_transfer_word(request, &data); + + if (DAP_TRANSFER_OK != ack) + break; + + resp_count++; + } + + if (DAP_TRANSFER_OK == ack) + ack = dap_swd_transfer_word(SWD_DP_R_RDBUFF | DAP_TRANSFER_RnW, NULL); + } + + resp[0] = resp_count; + resp[1] = resp_count >> 8; + resp[2] = ack; +} + +//----------------------------------------------------------------------------- +static void dap_info(uint8_t *req, uint8_t *resp) +{ + int index = req[0]; + + if (DAP_INFO_VENDOR <= index && index <= DAP_INFO_DEVICE_NAME) + { + if (dap_info_strings[index]) + { + resp[0] = strlen(dap_info_strings[index]) + 1; + strcpy((char *)&resp[1], dap_info_strings[index]); + } + else + { + resp[0] = 0; + } + } + else if (DAP_INFO_CAPABILITIES == index) + { + resp[0] = 1; + resp[1] = 0; + +#ifdef DAP_CONFIG_ENABLE_SWD + resp[1] |= DAP_PORT_SWD; +#endif +#ifdef DAP_CONFIG_ENABLE_JTAG + resp[1] |= DAP_PORT_JTAG; +#endif + } + else if (DAP_INFO_PACKET_COUNT == index) + { + resp[0] = 1; + resp[1] = DAP_CONFIG_PACKET_COUNT; + } + else if (DAP_INFO_PACKET_SIZE == index) + { + resp[0] = 2; + resp[1] = DAP_CONFIG_PACKET_SIZE & 0xff; + resp[2] = (DAP_CONFIG_PACKET_SIZE >> 8) & 0xff; + } +} + +//----------------------------------------------------------------------------- +static void dap_led(uint8_t *req, uint8_t *resp) +{ + int index = req[0]; + int state = req[1]; + + DAP_CONFIG_LED(index, state); + + resp[0] = DAP_OK; +} + +//----------------------------------------------------------------------------- +static void dap_connect(uint8_t *req, uint8_t *resp) +{ + int port = req[0]; + + if (DAP_PORT_AUTODETECT == port) + port = DAP_CONFIG_DEFAULT_PORT; + + dap_port = DAP_PORT_DISABLED; + +#ifdef DAP_CONFIG_ENABLE_SWD + if (DAP_PORT_SWD == port) + { + DAP_CONFIG_CONNECT_SWD(); + dap_port = DAP_PORT_SWD; + } +#endif + +#ifdef DAP_CONFIG_ENABLE_JTAG + if (DAP_PORT_JTAG == port) + { + DAP_CONFIG_CONNECT_JTAG(); + dap_port = DAP_PORT_JTAG; + } +#endif + + resp[0] = dap_port; +} + +//----------------------------------------------------------------------------- +static void dap_disconnect(uint8_t *req, uint8_t *resp) +{ + DAP_CONFIG_DISCONNECT(); + + dap_port = DAP_PORT_DISABLED; + + resp[0] = DAP_OK; + + (void)req; +} + +//----------------------------------------------------------------------------- +static void dap_transfer_configure(uint8_t *req, uint8_t *resp) +{ + dap_idle_cycles = req[0]; + dap_retry_count = ((int)req[2] << 8) | req[1]; + dap_match_retry_count = ((int)req[4] << 8) | req[3]; + + resp[0] = DAP_OK; +} + +//----------------------------------------------------------------------------- +static void dap_transfer(uint8_t *req, uint8_t *resp) +{ + resp[0] = 0; + resp[1] = DAP_TRANSFER_INVALID; + +#ifdef DAP_CONFIG_ENABLE_SWD + if (DAP_PORT_SWD == dap_port) + dap_swd_transfer(req, resp); +#endif + +#ifdef DAP_CONFIG_ENABLE_JTAG + if (DAP_PORT_JTAG == dap_port) + dap_jtag_transfer(req, resp); +#endif +} + +//----------------------------------------------------------------------------- +static void dap_transfer_block(uint8_t *req, uint8_t *resp) +{ + resp[0] = 0; + resp[1] = 0; + resp[2] = DAP_TRANSFER_INVALID; + +#ifdef DAP_CONFIG_ENABLE_SWD + if (DAP_PORT_SWD == dap_port) + dap_swd_transfer_block(req, resp); +#endif + +#ifdef DAP_CONFIG_ENABLE_JTAG + if (DAP_PORT_JTAG == dap_port) + dap_jtag_transfer_block(req, resp); +#endif +} + +//----------------------------------------------------------------------------- +static void dap_transfer_abort(uint8_t *req, uint8_t *resp) +{ + // This request is handled outside of the normal queue. + // We should never get here. + resp[0] = DAP_OK; + (void)req; +} + +//----------------------------------------------------------------------------- +static void dap_write_abort(uint8_t *req, uint8_t *resp) +{ +#ifdef DAP_CONFIG_ENABLE_SWD + if (DAP_PORT_SWD == dap_port) + { + uint32_t data; + + data = ((uint32_t)req[4] << 24) | ((uint32_t)req[3] << 16) | + ((uint32_t)req[2] << 8) | ((uint32_t)req[1] << 0); + + dap_swd_transfer_word(SWD_DP_W_ABORT, &data); + + resp[0] = DAP_OK; + } +#endif + +#ifdef DAP_CONFIG_ENABLE_JTAG + if (DAP_PORT_JTAG == dap_port) + { + // TODO: implement + resp[0] = DAP_OK; + } +#endif +} + +//----------------------------------------------------------------------------- +static void dap_delay(uint8_t *req, uint8_t *resp) +{ + int delay; + + delay = ((int)req[1] << 8) | req[0]; + + dap_delay_us(delay); + + resp[0] = DAP_OK; +} + +//----------------------------------------------------------------------------- +static void dap_reset_target(uint8_t *req, uint8_t *resp) +{ + resp[0] = DAP_OK; +#ifdef DAP_CONFIG_RESET_TARGET_FN + resp[1] = 1; + DAP_CONFIG_RESET_TARGET_FN(); +#endif + (void)req; +} + +//----------------------------------------------------------------------------- +static void dap_swj_pins(uint8_t *req, uint8_t *resp) +{ + int value = req[0]; + int select = req[1]; + int wait; + + wait = ((int)req[5] << 24) | ((int)req[4] << 16) | ((int)req[3] << 8) | req[2]; + + if (select & DAP_SWJ_SWCLK_TCK) + DAP_CONFIG_SWCLK_TCK_write(value & DAP_SWJ_SWCLK_TCK); + + if (select & DAP_SWJ_SWDIO_TMS) + DAP_CONFIG_SWDIO_TMS_write(value & DAP_SWJ_SWDIO_TMS); + + if (select & DAP_SWJ_TDI) + DAP_CONFIG_TDO_write(value & DAP_SWJ_TDI); + + if (select & DAP_SWJ_nTRST) + DAP_CONFIG_nTRST_write(value & DAP_SWJ_nTRST); + + if (select & DAP_SWJ_nRESET) + DAP_CONFIG_nRESET_write(value & DAP_SWJ_nRESET); + + dap_delay_us(wait * 1000); + + value = + (DAP_CONFIG_SWCLK_TCK_read() ? DAP_SWJ_SWCLK_TCK : 0) | + (DAP_CONFIG_SWDIO_TMS_read() ? DAP_SWJ_SWDIO_TMS : 0) | + (DAP_CONFIG_TDI_read() ? DAP_SWJ_TDI : 0) | + (DAP_CONFIG_TDO_read() ? DAP_SWJ_TDO : 0) | + (DAP_CONFIG_nTRST_read() ? DAP_SWJ_nTRST : 0) | + (DAP_CONFIG_nRESET_read() ? DAP_SWJ_nRESET : 0); + + resp[0] = value; +} + +//----------------------------------------------------------------------------- +static void dap_swj_clock(uint8_t *req, uint8_t *resp) +{ + uint32_t freq; + + freq = ((uint32_t)req[3] << 24) | ((uint32_t)req[2] << 16) | + ((uint32_t)req[1] << 8) | req[0]; + + dap_setup_clock(freq); + + resp[0] = DAP_OK; +} + +//----------------------------------------------------------------------------- +static void dap_swj_sequence(uint8_t *req, uint8_t *resp) +{ + int size = req[0]; + uint8_t *data = &req[1]; + int offset = 0; + + while (size) + { + int sz = (size > 8) ? 8 : size; + + dap_swd_write(data[offset], sz); + + size -= sz; + offset++; + } + + resp[0] = DAP_OK; +} + +//----------------------------------------------------------------------------- +static void dap_swd_configure(uint8_t *req, uint8_t *resp) +{ +#ifdef DAP_CONFIG_ENABLE_SWD + uint8_t data = req[0]; + + dap_swd_turnaround = (data & 3) + 1; + dap_swd_data_phase = (data & 4) ? 1 : 0; + + resp[0] = DAP_OK; +#endif + + (void)req; + (void)resp; +} + +//----------------------------------------------------------------------------- +static void dap_jtag_sequence(uint8_t *req, uint8_t *resp) +{ +#ifdef DAP_CONFIG_ENABLE_JTAG + // TODO: implement + resp[0] = DAP_OK; +#endif + + (void)req; + (void)resp; +} + +//----------------------------------------------------------------------------- +static void dap_jtag_configure(uint8_t *req, uint8_t *resp) +{ +#ifdef DAP_CONFIG_ENABLE_JTAG + // TODO: implement + resp[0] = DAP_OK; +#endif + + (void)req; + (void)resp; +} + +//----------------------------------------------------------------------------- +static void dap_jtag_idcode(uint8_t *req, uint8_t *resp) +{ +#ifdef DAP_CONFIG_ENABLE_JTAG + // TODO: implement + resp[0] = DAP_OK; +#endif + + (void)req; + (void)resp; +} + +//----------------------------------------------------------------------------- +void dap_init(void) +{ + dap_port = 0; + dap_abort = false; + dap_match_mask = 0; + dap_idle_cycles = 0; + dap_retry_count = 100; + dap_match_retry_count = 100; + +#ifdef DAP_CONFIG_ENABLE_SWD + dap_swd_turnaround = 1; + dap_swd_data_phase = false; +#endif + + dap_setup_clock(DAP_CONFIG_DEFAULT_CLOCK); + + DAP_CONFIG_SETUP(); +} + +//----------------------------------------------------------------------------- +bool dap_filter_request(uint8_t *req) +{ + int cmd = req[0]; + + if (ID_DAP_TRANSFER_ABORT == cmd) + { + dap_abort = true; + return false; + } + + return true; +} + +//----------------------------------------------------------------------------- +void dap_process_request(uint8_t *req, uint8_t *resp) +{ + const struct + { + int cmd; + void (*handler)(uint8_t *, uint8_t *); + } handlers[] = + { + { ID_DAP_INFO, dap_info }, + { ID_DAP_LED, dap_led }, + { ID_DAP_CONNECT, dap_connect }, + { ID_DAP_DISCONNECT, dap_disconnect }, + { ID_DAP_TRANSFER_CONFIGURE, dap_transfer_configure }, + { ID_DAP_TRANSFER, dap_transfer }, + { ID_DAP_TRANSFER_BLOCK, dap_transfer_block }, + { ID_DAP_TRANSFER_ABORT, dap_transfer_abort }, + { ID_DAP_WRITE_ABORT, dap_write_abort }, + { ID_DAP_DELAY, dap_delay }, + { ID_DAP_RESET_TARGET, dap_reset_target }, + { ID_DAP_SWJ_PINS, dap_swj_pins }, + { ID_DAP_SWJ_CLOCK, dap_swj_clock }, + { ID_DAP_SWJ_SEQUENCE, dap_swj_sequence }, + { ID_DAP_SWD_CONFIGURE, dap_swd_configure }, + { ID_DAP_JTAG_SEQUENCE, dap_jtag_sequence }, + { ID_DAP_JTAG_CONFIGURE, dap_jtag_configure }, + { ID_DAP_JTAG_IDCODE, dap_jtag_idcode }, + { -1, NULL }, + }; + int cmd = req[0]; + + memset(resp, 0, DAP_CONFIG_PACKET_SIZE); + + dap_abort = false; + + resp[0] = cmd; + resp[1] = DAP_ERROR; + + for (int i = 0; -1 != handlers[i].cmd; i++) + { + if (cmd == handlers[i].cmd) + { + handlers[i].handler(&req[1], &resp[1]); + return; + } + } + + if (ID_DAP_VENDOR_0 <= cmd && cmd <= ID_DAP_VENDOR_31) + return; + + resp[0] = ID_DAP_INVALID; +} + +//----------------------------------------------------------------------------- +void dap_clock_test(int delay) +{ + DAP_CONFIG_CONNECT_SWD(); + + if (delay) + { + while (1) + { + DAP_CONFIG_SWCLK_TCK_clr(); + dap_delay_loop(delay); + DAP_CONFIG_SWCLK_TCK_set(); + dap_delay_loop(delay); + } + } + else + { + while (1) + { + DAP_CONFIG_SWCLK_TCK_clr(); + DAP_CONFIG_SWCLK_TCK_set(); + } + } +} + diff --git a/dap.h b/dap.h index abf2a1d..d3e836c 100644 --- a/dap.h +++ b/dap.h @@ -1,42 +1,43 @@ -/* - * Copyright (c) 2016, Alex Taradov - * All rights reserved. - * - * Redistribution and use in source and binary forms, with or without - * modification, are permitted provided that the following conditions are met: - * - * 1. Redistributions of source code must retain the above copyright notice, - * this list of conditions and the following disclaimer. - * 2. Redistributions in binary form must reproduce the above copyright - * notice, this list of conditions and the following disclaimer in the - * documentation and/or other materials provided with the distribution. - * 3. The name of the author may not be used to endorse or promote products - * derived from this software without specific prior written permission. - * - * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" - * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE - * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE - * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE - * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR - * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF - * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS - * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN - * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) - * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE - * POSSIBILITY OF SUCH DAMAGE. - */ - -#ifndef _DAP_H_ -#define _DAP_H_ - -/*- Includes ----------------------------------------------------------------*/ -#include - -/*- Prototypes --------------------------------------------------------------*/ -void dap_init(void); -void dap_filter_request(uint8_t *req); -void dap_process_request(uint8_t *req, uint8_t *resp); -void dap_clock_test(int delay); - -#endif // _DAP_H_ - +/* + * Copyright (c) 2016, Alex Taradov + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions are met: + * + * 1. Redistributions of source code must retain the above copyright notice, + * this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + */ + +#ifndef _DAP_H_ +#define _DAP_H_ + +/*- Includes ----------------------------------------------------------------*/ +#include +#include + +/*- Prototypes --------------------------------------------------------------*/ +void dap_init(void); +bool dap_filter_request(uint8_t *req); +void dap_process_request(uint8_t *req, uint8_t *resp); +void dap_clock_test(int delay); + +#endif // _DAP_H_ +