1 // SPDX-License-Identifier: GPL-2.0-or-later
3 /***************************************************************************
4 * Copyright (C) 2006 by Dominic Rath *
5 * Dominic.Rath@gmx.de *
6 ***************************************************************************/
13 #include "xilinx_bit.h"
16 static int virtex2_set_instr(struct jtag_tap
*tap
, uint32_t new_instr
)
21 if (buf_get_u32(tap
->cur_instr
, 0, tap
->ir_length
) != new_instr
) {
22 struct scan_field field
;
24 field
.num_bits
= tap
->ir_length
;
25 void *t
= calloc(DIV_ROUND_UP(field
.num_bits
, 8), 1);
27 buf_set_u32(t
, 0, field
.num_bits
, new_instr
);
28 field
.in_value
= NULL
;
30 jtag_add_ir_scan(tap
, &field
, TAP_IDLE
);
38 static int virtex2_send_32(struct pld_device
*pld_device
,
39 int num_words
, uint32_t *words
)
41 struct virtex2_pld_device
*virtex2_info
= pld_device
->driver_priv
;
42 struct scan_field scan_field
;
46 values
= malloc(num_words
* 4);
48 scan_field
.num_bits
= num_words
* 32;
49 scan_field
.out_value
= values
;
50 scan_field
.in_value
= NULL
;
52 for (i
= 0; i
< num_words
; i
++)
53 buf_set_u32(values
+ 4 * i
, 0, 32, flip_u32(*words
++, 32));
55 virtex2_set_instr(virtex2_info
->tap
, 0x5); /* CFG_IN */
57 jtag_add_dr_scan(virtex2_info
->tap
, 1, &scan_field
, TAP_DRPAUSE
);
64 static inline void virtexflip32(jtag_callback_data_t arg
)
66 uint8_t *in
= (uint8_t *)arg
;
67 *((uint32_t *)arg
) = flip_u32(le_to_h_u32(in
), 32);
70 static int virtex2_receive_32(struct pld_device
*pld_device
,
71 int num_words
, uint32_t *words
)
73 struct virtex2_pld_device
*virtex2_info
= pld_device
->driver_priv
;
74 struct scan_field scan_field
;
76 scan_field
.num_bits
= 32;
77 scan_field
.out_value
= NULL
;
78 scan_field
.in_value
= NULL
;
80 virtex2_set_instr(virtex2_info
->tap
, 0x4); /* CFG_OUT */
83 scan_field
.in_value
= (uint8_t *)words
;
85 jtag_add_dr_scan(virtex2_info
->tap
, 1, &scan_field
, TAP_DRPAUSE
);
87 jtag_add_callback(virtexflip32
, (jtag_callback_data_t
)words
);
95 static int virtex2_read_stat(struct pld_device
*pld_device
, uint32_t *status
)
101 data
[0] = 0xaa995566; /* synch word */
102 data
[1] = 0x2800E001; /* Type 1, read, address 7, 1 word */
103 data
[2] = 0x20000000; /* NOOP (Type 1, read, address 0, 0 words */
104 data
[3] = 0x20000000; /* NOOP */
105 data
[4] = 0x20000000; /* NOOP */
106 virtex2_send_32(pld_device
, 5, data
);
108 virtex2_receive_32(pld_device
, 1, status
);
110 jtag_execute_queue();
112 LOG_DEBUG("status: 0x%8.8" PRIx32
"", *status
);
117 static int virtex2_load(struct pld_device
*pld_device
, const char *filename
)
119 struct virtex2_pld_device
*virtex2_info
= pld_device
->driver_priv
;
120 struct xilinx_bit_file bit_file
;
123 struct scan_field field
;
125 field
.in_value
= NULL
;
127 retval
= xilinx_read_bit_file(&bit_file
, filename
);
128 if (retval
!= ERROR_OK
)
131 virtex2_set_instr(virtex2_info
->tap
, 0xb); /* JPROG_B */
132 jtag_execute_queue();
133 jtag_add_sleep(1000);
135 virtex2_set_instr(virtex2_info
->tap
, 0x5); /* CFG_IN */
136 jtag_execute_queue();
138 for (i
= 0; i
< bit_file
.length
; i
++)
139 bit_file
.data
[i
] = flip_u32(bit_file
.data
[i
], 8);
141 field
.num_bits
= bit_file
.length
* 8;
142 field
.out_value
= bit_file
.data
;
144 jtag_add_dr_scan(virtex2_info
->tap
, 1, &field
, TAP_DRPAUSE
);
145 jtag_execute_queue();
149 if (!(virtex2_info
->no_jstart
))
150 virtex2_set_instr(virtex2_info
->tap
, 0xc); /* JSTART */
151 jtag_add_runtest(13, TAP_IDLE
);
152 virtex2_set_instr(virtex2_info
->tap
, 0x3f); /* BYPASS */
153 virtex2_set_instr(virtex2_info
->tap
, 0x3f); /* BYPASS */
154 if (!(virtex2_info
->no_jstart
))
155 virtex2_set_instr(virtex2_info
->tap
, 0xc); /* JSTART */
156 jtag_add_runtest(13, TAP_IDLE
);
157 virtex2_set_instr(virtex2_info
->tap
, 0x3f); /* BYPASS */
158 jtag_execute_queue();
163 COMMAND_HANDLER(virtex2_handle_read_stat_command
)
165 struct pld_device
*device
;
169 return ERROR_COMMAND_SYNTAX_ERROR
;
172 COMMAND_PARSE_NUMBER(uint
, CMD_ARGV
[0], dev_id
);
173 device
= get_pld_device_by_num(dev_id
);
175 command_print(CMD
, "pld device '#%s' is out of bounds", CMD_ARGV
[0]);
179 virtex2_read_stat(device
, &status
);
181 command_print(CMD
, "virtex2 status register: 0x%8.8" PRIx32
"", status
);
186 PLD_DEVICE_COMMAND_HANDLER(virtex2_pld_device_command
)
188 struct jtag_tap
*tap
;
190 struct virtex2_pld_device
*virtex2_info
;
193 return ERROR_COMMAND_SYNTAX_ERROR
;
195 tap
= jtag_tap_by_string(CMD_ARGV
[1]);
197 command_print(CMD
, "Tap: %s does not exist", CMD_ARGV
[1]);
201 virtex2_info
= malloc(sizeof(struct virtex2_pld_device
));
202 virtex2_info
->tap
= tap
;
204 virtex2_info
->no_jstart
= 0;
206 COMMAND_PARSE_NUMBER(int, CMD_ARGV
[2], virtex2_info
->no_jstart
);
208 pld
->driver_priv
= virtex2_info
;
213 static const struct command_registration virtex2_exec_command_handlers
[] = {
216 .mode
= COMMAND_EXEC
,
217 .handler
= virtex2_handle_read_stat_command
,
218 .help
= "read status register",
221 COMMAND_REGISTRATION_DONE
223 static const struct command_registration virtex2_command_handler
[] = {
227 .help
= "Virtex-II specific commands",
229 .chain
= virtex2_exec_command_handlers
,
231 COMMAND_REGISTRATION_DONE
234 struct pld_driver virtex2_pld
= {
236 .commands
= virtex2_command_handler
,
237 .pld_device_command
= &virtex2_pld_device_command
,
238 .load
= &virtex2_load
,