1 /***************************************************************************
2 * Copyright (C) 2006 by Dominic Rath *
3 * Dominic.Rath@gmx.de *
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. *
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. *
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 ***************************************************************************/
25 #include "xilinx_bit.h"
29 static int virtex2_set_instr(struct jtag_tap
*tap
, uint32_t new_instr
)
34 if (buf_get_u32(tap
->cur_instr
, 0, tap
->ir_length
) != new_instr
)
36 struct scan_field field
;
38 field
.num_bits
= tap
->ir_length
;
39 field
.out_value
= calloc(DIV_ROUND_UP(field
.num_bits
, 8), 1);
40 buf_set_u32(field
.out_value
, 0, field
.num_bits
, new_instr
);
41 field
.in_value
= NULL
;
43 jtag_add_ir_scan(tap
, &field
, jtag_set_end_state(TAP_IDLE
));
45 free(field
.out_value
);
51 static int virtex2_send_32(struct pld_device
*pld_device
,
52 int num_words
, uint32_t *words
)
54 struct virtex2_pld_device
*virtex2_info
= pld_device
->driver_priv
;
55 struct scan_field scan_field
;
59 values
= malloc(num_words
* 4);
61 scan_field
.num_bits
= num_words
* 32;
62 scan_field
.out_value
= values
;
63 scan_field
.in_value
= NULL
;
65 for (i
= 0; i
< num_words
; i
++)
66 buf_set_u32(values
+ 4 * i
, 0, 32, flip_u32(*words
++, 32));
68 virtex2_set_instr(virtex2_info
->tap
, 0x5); /* CFG_IN */
70 jtag_add_dr_scan(virtex2_info
->tap
, 1, &scan_field
, jtag_set_end_state(TAP_DRPAUSE
));
77 static __inline__
void virtexflip32(jtag_callback_data_t arg
)
79 uint8_t *in
= (uint8_t *)arg
;
80 *((uint32_t *)in
) = flip_u32(le_to_h_u32(in
), 32);
83 static int virtex2_receive_32(struct pld_device
*pld_device
,
84 int num_words
, uint32_t *words
)
86 struct virtex2_pld_device
*virtex2_info
= pld_device
->driver_priv
;
87 struct scan_field scan_field
;
89 scan_field
.num_bits
= 32;
90 scan_field
.out_value
= NULL
;
91 scan_field
.in_value
= NULL
;
93 virtex2_set_instr(virtex2_info
->tap
, 0x4); /* CFG_OUT */
97 scan_field
.in_value
= (uint8_t *)words
;
99 jtag_add_dr_scan(virtex2_info
->tap
, 1, &scan_field
, jtag_set_end_state(TAP_DRPAUSE
));
101 jtag_add_callback(virtexflip32
, (jtag_callback_data_t
)words
);
109 static int virtex2_read_stat(struct pld_device
*pld_device
, uint32_t *status
)
115 data
[0] = 0xaa995566; /* synch word */
116 data
[1] = 0x2800E001; /* Type 1, read, address 7, 1 word */
117 data
[2] = 0x20000000; /* NOOP (Type 1, read, address 0, 0 words */
118 data
[3] = 0x20000000; /* NOOP */
119 data
[4] = 0x20000000; /* NOOP */
120 virtex2_send_32(pld_device
, 5, data
);
122 virtex2_receive_32(pld_device
, 1, status
);
124 jtag_execute_queue();
126 LOG_DEBUG("status: 0x%8.8" PRIx32
"", *status
);
131 static int virtex2_load(struct pld_device
*pld_device
, const char *filename
)
133 struct virtex2_pld_device
*virtex2_info
= pld_device
->driver_priv
;
134 struct xilinx_bit_file bit_file
;
137 struct scan_field field
;
139 field
.in_value
= NULL
;
141 if ((retval
= xilinx_read_bit_file(&bit_file
, filename
)) != ERROR_OK
)
144 jtag_set_end_state(TAP_IDLE
);
145 virtex2_set_instr(virtex2_info
->tap
, 0xb); /* JPROG_B */
146 jtag_execute_queue();
147 jtag_add_sleep(1000);
149 virtex2_set_instr(virtex2_info
->tap
, 0x5); /* CFG_IN */
150 jtag_execute_queue();
152 for (i
= 0; i
< bit_file
.length
; i
++)
153 bit_file
.data
[i
] = flip_u32(bit_file
.data
[i
], 8);
155 field
.num_bits
= bit_file
.length
* 8;
156 field
.out_value
= bit_file
.data
;
158 jtag_add_dr_scan(virtex2_info
->tap
, 1, &field
, jtag_set_end_state(TAP_DRPAUSE
));
159 jtag_execute_queue();
163 jtag_set_end_state(TAP_IDLE
);
164 virtex2_set_instr(virtex2_info
->tap
, 0xc); /* JSTART */
165 jtag_add_runtest(13, jtag_set_end_state(TAP_IDLE
));
166 virtex2_set_instr(virtex2_info
->tap
, 0x3f); /* BYPASS */
167 virtex2_set_instr(virtex2_info
->tap
, 0x3f); /* BYPASS */
168 virtex2_set_instr(virtex2_info
->tap
, 0xc); /* JSTART */
169 jtag_add_runtest(13, jtag_set_end_state(TAP_IDLE
));
170 virtex2_set_instr(virtex2_info
->tap
, 0x3f); /* BYPASS */
171 jtag_execute_queue();
176 COMMAND_HANDLER(virtex2_handle_read_stat_command
)
178 struct pld_device
*device
;
179 struct virtex2_pld_device
*virtex2_info
;
184 command_print(CMD_CTX
, "usage: virtex2 read_stat <num>");
189 COMMAND_PARSE_NUMBER(uint
, CMD_ARGV
[0], dev_id
);
190 device
= get_pld_device_by_num(dev_id
);
193 command_print(CMD_CTX
, "pld device '#%s' is out of bounds", CMD_ARGV
[0]);
197 virtex2_info
= device
->driver_priv
;
199 virtex2_read_stat(device
, &status
);
201 command_print(CMD_CTX
, "virtex2 status register: 0x%8.8" PRIx32
"", status
);
206 PLD_DEVICE_COMMAND_HANDLER(virtex2_pld_device_command
)
208 struct jtag_tap
*tap
;
210 struct virtex2_pld_device
*virtex2_info
;
214 LOG_WARNING("incomplete pld device 'virtex2' configuration");
215 return ERROR_PLD_DEVICE_INVALID
;
218 tap
= jtag_tap_by_string(CMD_ARGV
[1]);
220 command_print(CMD_CTX
, "Tap: %s does not exist", CMD_ARGV
[1]);
224 virtex2_info
= malloc(sizeof(struct virtex2_pld_device
));
225 virtex2_info
->tap
= tap
;
227 pld
->driver_priv
= virtex2_info
;
232 static const struct command_registration virtex2_exec_command_handlers
[] = {
235 .mode
= COMMAND_EXEC
,
236 .handler
= virtex2_handle_read_stat_command
,
237 .help
= "read status register",
240 COMMAND_REGISTRATION_DONE
242 static const struct command_registration virtex2_command_handler
[] = {
246 .help
= "Virtex-II specific commands",
247 .chain
= virtex2_exec_command_handlers
,
249 COMMAND_REGISTRATION_DONE
252 struct pld_driver virtex2_pld
= {
254 .commands
= virtex2_command_handler
,
255 .pld_device_command
= &virtex2_pld_device_command
,
256 .load
= &virtex2_load
,