diff options
Diffstat (limited to 'src/jtag/drivers/versaloon/usbtoxxx/usbtojtagraw.c')
-rw-r--r-- | src/jtag/drivers/versaloon/usbtoxxx/usbtojtagraw.c | 84 |
1 files changed, 84 insertions, 0 deletions
diff --git a/src/jtag/drivers/versaloon/usbtoxxx/usbtojtagraw.c b/src/jtag/drivers/versaloon/usbtoxxx/usbtojtagraw.c new file mode 100644 index 00000000..11e8064d --- /dev/null +++ b/src/jtag/drivers/versaloon/usbtoxxx/usbtojtagraw.c @@ -0,0 +1,84 @@ +/*************************************************************************** + * 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 <string.h> + +#include "../versaloon_include.h" +#include "../versaloon.h" +#include "../versaloon_internal.h" +#include "usbtoxxx.h" +#include "usbtoxxx_internal.h" + +RESULT usbtojtagraw_init(uint8_t interface_index) +{ + return usbtoxxx_init_command(USB_TO_JTAG_RAW, interface_index); +} + +RESULT usbtojtagraw_fini(uint8_t interface_index) +{ + return usbtoxxx_fini_command(USB_TO_JTAG_RAW, interface_index); +} + +RESULT usbtojtagraw_config(uint8_t interface_index, uint32_t kHz) +{ + uint8_t cfg_buf[4]; + +#if PARAM_CHECK + if (interface_index > 7) + { + LOG_BUG(ERRMSG_INVALID_INTERFACE_NUM, interface_index); + return ERROR_FAIL; + } +#endif + + SET_LE_U32(&cfg_buf[0], kHz); + + return usbtoxxx_conf_command(USB_TO_JTAG_RAW, interface_index, cfg_buf, 4); +} + +RESULT usbtojtagraw_execute(uint8_t interface_index, uint8_t *tdi, + uint8_t *tms, uint8_t *tdo, uint32_t bitlen) +{ + uint16_t bytelen; + +#if PARAM_CHECK + if (interface_index > 7) + { + LOG_BUG(ERRMSG_INVALID_INTERFACE_NUM, interface_index); + return ERROR_FAIL; + } +#endif + + if (bitlen > 8 * 0xFFFF) + { + return ERROR_FAIL; + } + bytelen = (uint16_t)((bitlen + 7) >> 3); + + SET_LE_U32(&versaloon_cmd_buf[0], bitlen); + memcpy(versaloon_cmd_buf + 4, tdi, bytelen); + memcpy(versaloon_cmd_buf + 4 + bytelen, tms, bytelen); + + return usbtoxxx_inout_command(USB_TO_JTAG_RAW, interface_index, + versaloon_cmd_buf, 4 + bytelen * 2, bytelen, tdo, 0, bytelen, 0); +} + |