src/jtag/bitbang.c

   1 /***************************************************************************
   2  *   Copyright (C) 2005 by Dominic Rath                                    *
   3  *   Dominic.Rath@gmx.de                                                   *
   4  *                                                                         *
   5  *   This program is free software; you can redistribute it and/or modify  *
   6  *   it under the terms of the GNU General Public License as published by  *
   7  *   the Free Software Foundation; either version 2 of the License, or     *
   8  *   (at your option) any later version.                                   *
   9  *                                                                         *
  10  *   This program is distributed in the hope that it will be useful,       *
  11  *   but WITHOUT ANY WARRANTY; without even the implied warranty of        *
  12  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         *
  13  *   GNU General Public License for more details.                          *
  14  *                                                                         *
  15  *   You should have received a copy of the GNU General Public License     *
  16  *   along with this program; if not, write to the                         *
  17  *   Free Software Foundation, Inc.,                                       *
  18  *   59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.             *
  19  ***************************************************************************/
  20 #ifdef HAVE_CONFIG_H
  21 #include "config.h"
  22 #endif
  23
  24 #include "bitbang.h"
  25
  26 /* project specific includes */
  27 #include "log.h"
  28 #include "types.h"
  29 #include "jtag.h"
  30 #include "configuration.h"
  31
  32 /* system includes */
  33 #include <string.h>
  34 #include <stdlib.h>
  35 #include <unistd.h>
  36
  37 #include <sys/time.h>
  38 #include <time.h>
  39
  40 bitbang_interface_t *bitbang_interface;
  41
  42 int bitbang_execute_queue(void);
  43
  44 void bitbang_end_state(enum tap_state state)
  45 {
  46         if (tap_move_map[state] != -1)
  47                 end_state = state;
  48         else
  49         {
  50                 ERROR("BUG: %i is not a valid end state", state);
  51                 exit(-1);
  52         }
  53 }
  54
  55 void bitbang_state_move(void) {
  56
  57         int i=0, tms=0;
  58         u8 tms_scan = TAP_MOVE(cur_state, end_state);
  59
  60         for (i = 0; i < 7; i++)
  61         {
  62                 tms = (tms_scan >> i) & 1;
  63                 bitbang_interface->write(0, tms, 0);
  64                 bitbang_interface->write(1, tms, 0);
  65         }
  66         bitbang_interface->write(0, tms, 0);
  67
  68         cur_state = end_state;
  69 }
  70
  71 void bitbang_path_move(pathmove_command_t *cmd)
  72 {
  73         int num_states = cmd->num_states;
  74         int state_count;
  75
  76         state_count = 0;
  77         while (num_states)
  78         {
  79                 if (tap_transitions[cur_state].low == cmd->path[state_count])
  80                 {
  81                         bitbang_interface->write(0, 0, 0);
  82                         bitbang_interface->write(1, 0, 0);
  83                 }
  84                 else if (tap_transitions[cur_state].high == cmd->path[state_count])
  85                 {
  86                         bitbang_interface->write(0, 1, 0);
  87                         bitbang_interface->write(1, 1, 0);
  88                 }
  89                 else
  90                 {
  91                         ERROR("BUG: %s -> %s isn't a valid TAP transition", tap_state_strings[cur_state], tap_state_strings[cmd->path[state_count]]);
  92                         exit(-1);
  93                 }
  94
  95                 cur_state = cmd->path[state_count];
  96                 state_count++;
  97                 num_states--;
  98         }
  99
 100         end_state = cur_state;
 101 }
 102
 103 void bitbang_runtest(int num_cycles)
 104 {
 105         int i;
 106
 107         enum tap_state saved_end_state = end_state;
 108
 109         /* only do a state_move when we're not already in RTI */
 110         if (cur_state != TAP_RTI)
 111         {
 112                 bitbang_end_state(TAP_RTI);
 113                 bitbang_state_move();
 114         }
 115
 116         /* execute num_cycles */
 117         bitbang_interface->write(0, 0, 0);
 118         for (i = 0; i < num_cycles; i++)
 119         {
 120                 bitbang_interface->write(1, 0, 0);
 121                 bitbang_interface->write(0, 0, 0);
 122         }
 123
 124         /* finish in end_state */
 125         bitbang_end_state(saved_end_state);
 126         if (cur_state != end_state)
 127                 bitbang_state_move();
 128 }
 129
 130 void bitbang_scan(int ir_scan, enum scan_type type, u8 *buffer, int scan_size)
 131 {
 132         enum tap_state saved_end_state = end_state;
 133         int bit_cnt;
 134
 135         if (!((!ir_scan && (cur_state == TAP_SD)) || (ir_scan && (cur_state == TAP_SI))))
 136         {
 137                 if (ir_scan)
 138                         bitbang_end_state(TAP_SI);
 139                 else
 140                         bitbang_end_state(TAP_SD);
 141
 142                 bitbang_state_move();
 143                 bitbang_end_state(saved_end_state);
 144         }
 145
 146         for (bit_cnt = 0; bit_cnt < scan_size; bit_cnt++)
 147         {
 148                 /* if we're just reading the scan, but don't care about the output
 149                  * default to outputting 'low', this also makes valgrind traces more readable,
 150                  * as it removes the dependency on an uninitialised value
 151                  */
 152                 if ((type != SCAN_IN) && ((buffer[bit_cnt/8] >> (bit_cnt % 8)) & 0x1))
 153                 {
 154                         bitbang_interface->write(0, (bit_cnt==scan_size-1) ? 1 : 0, 1);
 155                         bitbang_interface->write(1, (bit_cnt==scan_size-1) ? 1 : 0, 1);
 156                 } else {
 157                         bitbang_interface->write(0, (bit_cnt==scan_size-1) ? 1 : 0, 0);
 158                         bitbang_interface->write(1, (bit_cnt==scan_size-1) ? 1 : 0, 0);
 159                 }
 160
 161                 if (type != SCAN_OUT)
 162                 {
 163                         if (bitbang_interface->read())
 164                                 buffer[(bit_cnt)/8] |= 1 << ((bit_cnt) % 8);
 165                         else
 166                                 buffer[(bit_cnt)/8] &= ~(1 << ((bit_cnt) % 8));
 167                 }
 168         }
 169
 170         /* Exit1 -> Pause */
 171         bitbang_interface->write(0, 0, 0);
 172         bitbang_interface->write(1, 0, 0);
 173
 174         if (ir_scan)
 175                 cur_state = TAP_PI;
 176         else
 177                 cur_state = TAP_PD;
 178
 179         if (cur_state != end_state)
 180                 bitbang_state_move();
 181 }
 182
 183 int bitbang_execute_queue(void)
 184 {
 185         jtag_command_t *cmd = jtag_command_queue; /* currently processed command */
 186         int scan_size;
 187         enum scan_type type;
 188         u8 *buffer;
 189         int retval;
 190
 191         if (!bitbang_interface)
 192         {
 193                 ERROR("BUG: Bitbang interface called, but not yet initialized");
 194                 exit(-1);
 195         }
 196
 197         /* return ERROR_OK, unless a jtag_read_buffer returns a failed check
 198          * that wasn't handled by a caller-provided error handler
 199          */
 200         retval = ERROR_OK;
 201
 202         if(bitbang_interface->blink)
 203                 bitbang_interface->blink(1);
 204
 205         while (cmd)
 206         {
 207                 switch (cmd->type)
 208                 {
 209                         case JTAG_END_STATE:
 210 #ifdef _DEBUG_JTAG_IO_
 211                                 DEBUG("end_state: %i", cmd->cmd.end_state->end_state);
 212 #endif
 213                                 if (cmd->cmd.end_state->end_state != -1)
 214                                         bitbang_end_state(cmd->cmd.end_state->end_state);
 215                                 break;
 216                         case JTAG_RESET:
 217 #ifdef _DEBUG_JTAG_IO_
 218                                 DEBUG("reset trst: %i srst %i", cmd->cmd.reset->trst, cmd->cmd.reset->srst);
 219 #endif
 220                                 if (cmd->cmd.reset->trst == 1)
 221                                 {
 222                                         cur_state = TAP_TLR;
 223                                 }
 224                                 bitbang_interface->reset(cmd->cmd.reset->trst, cmd->cmd.reset->srst);
 225                                 break;
 226                         case JTAG_RUNTEST:
 227 #ifdef _DEBUG_JTAG_IO_
 228                                 DEBUG("runtest %i cycles, end in %i", cmd->cmd.runtest->num_cycles, cmd->cmd.runtest->end_state);
 229 #endif
 230                                 if (cmd->cmd.runtest->end_state != -1)
 231                                         bitbang_end_state(cmd->cmd.runtest->end_state);
 232                                 bitbang_runtest(cmd->cmd.runtest->num_cycles);
 233                                 break;
 234                         case JTAG_STATEMOVE:
 235 #ifdef _DEBUG_JTAG_IO_
 236                                 DEBUG("statemove end in %i", cmd->cmd.statemove->end_state);
 237 #endif
 238                                 if (cmd->cmd.statemove->end_state != -1)
 239                                         bitbang_end_state(cmd->cmd.statemove->end_state);
 240                                 bitbang_state_move();
 241                                 break;
 242                         case JTAG_PATHMOVE:
 243 #ifdef _DEBUG_JTAG_IO_
 244                                 DEBUG("pathmove: %i states, end in %i", cmd->cmd.pathmove->num_states, cmd->cmd.pathmove->path[cmd->cmd.pathmove->num_states - 1]);
 245 #endif
 246                                 bitbang_path_move(cmd->cmd.pathmove);
 247                                 break;
 248                         case JTAG_SCAN:
 249 #ifdef _DEBUG_JTAG_IO_
 250                                 DEBUG("%s scan end in %i",  (cmd->cmd.scan->ir_scan) ? "IR" : "DR", cmd->cmd.scan->end_state);
 251 #endif
 252                                 if (cmd->cmd.scan->end_state != -1)
 253                                         bitbang_end_state(cmd->cmd.scan->end_state);
 254                                 scan_size = jtag_build_buffer(cmd->cmd.scan, &buffer);
 255                                 type = jtag_scan_type(cmd->cmd.scan);
 256                                 bitbang_scan(cmd->cmd.scan->ir_scan, type, buffer, scan_size);
 257                                 if (jtag_read_buffer(buffer, cmd->cmd.scan) != ERROR_OK)
 258                                         retval = ERROR_JTAG_QUEUE_FAILED;
 259                                 if (buffer)
 260                                         free(buffer);
 261                                 break;
 262                         case JTAG_SLEEP:
 263 #ifdef _DEBUG_JTAG_IO_
 264                                 DEBUG("sleep %i", cmd->cmd.sleep->us);
 265 #endif
 266                                 jtag_sleep(cmd->cmd.sleep->us);
 267                                 break;
 268                         default:
 269                                 ERROR("BUG: unknown JTAG command type encountered");
 270                                 exit(-1);
 271                 }
 272                 cmd = cmd->next;
 273         }
 274         if(bitbang_interface->blink)
 275                 bitbang_interface->blink(0);
 276
 277         return retval;
 278 }
 279