diff options
Diffstat (limited to 'src/jtag/drivers/versaloon/usbtoxxx/usbtoswd.c')
-rw-r--r-- | src/jtag/drivers/versaloon/usbtoxxx/usbtoswd.c | 158 |
1 files changed, 158 insertions, 0 deletions
diff --git a/src/jtag/drivers/versaloon/usbtoxxx/usbtoswd.c b/src/jtag/drivers/versaloon/usbtoxxx/usbtoswd.c new file mode 100644 index 00000000..93333f08 --- /dev/null +++ b/src/jtag/drivers/versaloon/usbtoxxx/usbtoswd.c @@ -0,0 +1,158 @@ +/*************************************************************************** + * Copyright (C) 2009 - 2010 by Simon Qian <SimonQian@SimonQian.com> * + * * + * 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., * + * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. * + ***************************************************************************/ +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include <stdlib.h> +#include <string.h> + +#include "../versaloon_include.h" +#include "../versaloon.h" +#include "../versaloon_internal.h" +#include "usbtoxxx.h" +#include "usbtoxxx_internal.h" + +RESULT usbtoswd_callback(void *p, uint8_t *src, uint8_t *processed) +{ + struct versaloon_pending_t *pending = (struct versaloon_pending_t *)p; + + processed = processed; + + if (pending->extra_data != NULL) + { + *((uint8_t *)pending->extra_data) = src[0]; + } + + return ERROR_OK; +} + +RESULT usbtoswd_init(uint8_t interface_index) +{ + return usbtoxxx_init_command(USB_TO_SWD, interface_index); +} + +RESULT usbtoswd_fini(uint8_t interface_index) +{ + return usbtoxxx_fini_command(USB_TO_SWD, interface_index); +} + +RESULT usbtoswd_config(uint8_t interface_index, uint8_t trn, uint16_t retry, + uint16_t dly) +{ + uint8_t cfg_buf[5]; + +#if PARAM_CHECK + if (interface_index > 7) + { + LOG_BUG(ERRMSG_INVALID_INTERFACE_NUM, interface_index); + return ERROR_FAIL; + } +#endif + + cfg_buf[0] = trn; + SET_LE_U16(&cfg_buf[1], retry); + SET_LE_U16(&cfg_buf[3], dly); + + return usbtoxxx_conf_command(USB_TO_SWD, interface_index, cfg_buf, 5); +} + +RESULT usbtoswd_seqout(uint8_t interface_index, uint8_t *data, uint16_t bitlen) +{ + uint16_t bytelen = (bitlen + 7) >> 3; + +#if PARAM_CHECK + if (interface_index > 7) + { + LOG_BUG(ERRMSG_INVALID_INTERFACE_NUM, interface_index); + return ERROR_FAIL; + } +#endif + + SET_LE_U16(&versaloon_cmd_buf[0], bitlen); + memcpy(versaloon_cmd_buf + 2, data, bytelen); + + return usbtoxxx_out_command(USB_TO_SWD, interface_index, + versaloon_cmd_buf, bytelen + 2, 0); +} + +RESULT usbtoswd_seqin(uint8_t interface_index, uint8_t *data, uint16_t bitlen) +{ + uint16_t bytelen = (bitlen + 7) >> 3; + uint8_t buff[2]; + +#if PARAM_CHECK + if (interface_index > 7) + { + LOG_BUG(ERRMSG_INVALID_INTERFACE_NUM, interface_index); + return ERROR_FAIL; + } +#endif + + SET_LE_U16(&buff[0], bitlen); + + return usbtoxxx_in_command(USB_TO_SWD, interface_index, buff, 2, bytelen, + data, 0, bytelen, 0); +} + +RESULT usbtoswd_transact(uint8_t interface_index, uint8_t request, + uint32_t *data, uint8_t *ack) +{ + uint8_t parity; + uint8_t buff[5]; + +#if PARAM_CHECK + if (interface_index > 7) + { + LOG_BUG(ERRMSG_INVALID_INTERFACE_NUM, interface_index); + return ERROR_FAIL; + } +#endif + + parity = (request >> 1) & 1; + parity += (request >> 2) & 1; + parity += (request >> 3) & 1; + parity += (request >> 4) & 1; + parity &= 1; + buff[0] = (request | 0x81 | (parity << 5)) & ~0x40; + if (data != NULL) + { + SET_LE_U32(&buff[1], *data); + } + else + { + memset(buff + 1, 0, 4); + } + + versaloon_set_extra_data(ack); + versaloon_set_callback(usbtoswd_callback); + if (request & 0x04) + { + // read + return usbtoxxx_inout_command(USB_TO_SWD, interface_index, buff, 5, 5, + (uint8_t *)data, 1, 4, 0); + } + else + { + // write + return usbtoxxx_inout_command(USB_TO_SWD, interface_index, buff, 5, 5, + NULL, 0, 0, 0); + } +} + |