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, see <http://www.gnu.org/licenses/>. *
17 ***************************************************************************/
24 #include "xilinx_bit.h"
27 static int virtex2_set_instr(struct jtag_tap
*tap
, uint32_t new_instr
)
32 if (buf_get_u32(tap
->cur_instr
, 0, tap
->ir_length
) != new_instr
) {
33 struct scan_field field
;
35 field
.num_bits
= tap
->ir_length
;
36 void *t
= calloc(DIV_ROUND_UP(field
.num_bits
, 8), 1);
38 buf_set_u32(t
, 0, field
.num_bits
, new_instr
);
39 field
.in_value
= NULL
;
41 jtag_add_ir_scan(tap
, &field
, TAP_IDLE
);
49 static int virtex2_send_32(struct pld_device
*pld_device
,
50 int num_words
, uint32_t *words
)
52 struct virtex2_pld_device
*virtex2_info
= pld_device
->driver_priv
;
53 struct scan_field scan_field
;
57 values
= malloc(num_words
* 4);
59 scan_field
.num_bits
= num_words
* 32;
60 scan_field
.out_value
= values
;
61 scan_field
.in_value
= NULL
;
63 for (i
= 0; i
< num_words
; i
++)
64 buf_set_u32(values
+ 4 * i
, 0, 32, flip_u32(*words
++, 32));
66 virtex2_set_instr(virtex2_info
->tap
, 0x5); /* CFG_IN */
68 jtag_add_dr_scan(virtex2_info
->tap
, 1, &scan_field
, TAP_DRPAUSE
);
75 static inline void virtexflip32(jtag_callback_data_t arg
)
77 uint8_t *in
= (uint8_t *)arg
;
78 *((uint32_t *)arg
) = flip_u32(le_to_h_u32(in
), 32);
81 static int virtex2_receive_32(struct pld_device
*pld_device
,
82 int num_words
, uint32_t *words
)
84 struct virtex2_pld_device
*virtex2_info
= pld_device
->driver_priv
;
85 struct scan_field scan_field
;
87 scan_field
.num_bits
= 32;
88 scan_field
.out_value
= NULL
;
89 scan_field
.in_value
= NULL
;
91 virtex2_set_instr(virtex2_info
->tap
, 0x4); /* CFG_OUT */
94 scan_field
.in_value
= (uint8_t *)words
;
96 jtag_add_dr_scan(virtex2_info
->tap
, 1, &scan_field
, TAP_DRPAUSE
);
98 jtag_add_callback(virtexflip32
, (jtag_callback_data_t
)words
);
106 static int virtex2_read_stat(struct pld_device
*pld_device
, uint32_t *status
)
112 data
[0] = 0xaa995566; /* synch word */
113 data
[1] = 0x2800E001; /* Type 1, read, address 7, 1 word */
114 data
[2] = 0x20000000; /* NOOP (Type 1, read, address 0, 0 words */
115 data
[3] = 0x20000000; /* NOOP */
116 data
[4] = 0x20000000; /* NOOP */
117 virtex2_send_32(pld_device
, 5, data
);
119 virtex2_receive_32(pld_device
, 1, status
);
121 jtag_execute_queue();
123 LOG_DEBUG("status: 0x%8.8" PRIx32
"", *status
);
128 static int virtex2_load(struct pld_device
*pld_device
, const char *filename
)
130 struct virtex2_pld_device
*virtex2_info
= pld_device
->driver_priv
;
131 struct xilinx_bit_file bit_file
;
134 struct scan_field field
;
136 field
.in_value
= NULL
;
138 retval
= xilinx_read_bit_file(&bit_file
, filename
);
139 if (retval
!= ERROR_OK
)
142 virtex2_set_instr(virtex2_info
->tap
, 0xb); /* JPROG_B */
143 jtag_execute_queue();
144 jtag_add_sleep(1000);
146 virtex2_set_instr(virtex2_info
->tap
, 0x5); /* CFG_IN */
147 jtag_execute_queue();
149 for (i
= 0; i
< bit_file
.length
; i
++)
150 bit_file
.data
[i
] = flip_u32(bit_file
.data
[i
], 8);
152 field
.num_bits
= bit_file
.length
* 8;
153 field
.out_value
= bit_file
.data
;
155 jtag_add_dr_scan(virtex2_info
->tap
, 1, &field
, TAP_DRPAUSE
);
156 jtag_execute_queue();
160 if (!(virtex2_info
->no_jstart
))
161 virtex2_set_instr(virtex2_info
->tap
, 0xc); /* JSTART */
162 jtag_add_runtest(13, TAP_IDLE
);
163 virtex2_set_instr(virtex2_info
->tap
, 0x3f); /* BYPASS */
164 virtex2_set_instr(virtex2_info
->tap
, 0x3f); /* BYPASS */
165 if (!(virtex2_info
->no_jstart
))
166 virtex2_set_instr(virtex2_info
->tap
, 0xc); /* JSTART */
167 jtag_add_runtest(13, TAP_IDLE
);
168 virtex2_set_instr(virtex2_info
->tap
, 0x3f); /* BYPASS */
169 jtag_execute_queue();
174 COMMAND_HANDLER(virtex2_handle_read_stat_command
)
176 struct pld_device
*device
;
180 return ERROR_COMMAND_SYNTAX_ERROR
;
183 COMMAND_PARSE_NUMBER(uint
, CMD_ARGV
[0], dev_id
);
184 device
= get_pld_device_by_num(dev_id
);
186 command_print(CMD
, "pld device '#%s' is out of bounds", CMD_ARGV
[0]);
190 virtex2_read_stat(device
, &status
);
192 command_print(CMD
, "virtex2 status register: 0x%8.8" PRIx32
"", status
);
197 PLD_DEVICE_COMMAND_HANDLER(virtex2_pld_device_command
)
199 struct jtag_tap
*tap
;
201 struct virtex2_pld_device
*virtex2_info
;
204 return ERROR_COMMAND_SYNTAX_ERROR
;
206 tap
= jtag_tap_by_string(CMD_ARGV
[1]);
208 command_print(CMD
, "Tap: %s does not exist", CMD_ARGV
[1]);
212 virtex2_info
= malloc(sizeof(struct virtex2_pld_device
));
213 virtex2_info
->tap
= tap
;
215 virtex2_info
->no_jstart
= 0;
217 COMMAND_PARSE_NUMBER(int, CMD_ARGV
[2], virtex2_info
->no_jstart
);
219 pld
->driver_priv
= virtex2_info
;
224 static const struct command_registration virtex2_exec_command_handlers
[] = {
227 .mode
= COMMAND_EXEC
,
228 .handler
= virtex2_handle_read_stat_command
,
229 .help
= "read status register",
232 COMMAND_REGISTRATION_DONE
234 static const struct command_registration virtex2_command_handler
[] = {
238 .help
= "Virtex-II specific commands",
240 .chain
= virtex2_exec_command_handlers
,
242 COMMAND_REGISTRATION_DONE
245 struct pld_driver virtex2_pld
= {
247 .commands
= virtex2_command_handler
,
248 .pld_device_command
= &virtex2_pld_device_command
,
249 .load
= &virtex2_load
,