jtag: linuxgpiod: drop extra parenthesis
[openocd.git] / src / pld / efinix.c
blobb6e5f9e477ad2829473caab737f929cd2bd04800
1 // SPDX-License-Identifier: GPL-2.0-or-later
3 /***************************************************************************
4 * Copyright (C) 2022 by Daniel Anselmi *
5 * danselmi@gmx.ch *
6 ***************************************************************************/
8 #ifdef HAVE_CONFIG_H
9 #include "config.h"
10 #endif
12 #include <jtag/jtag.h>
14 #include "pld.h"
15 #include "raw_bit.h"
17 #define PROGRAM 0x4
18 #define ENTERUSER 0x7
19 #define USER1 0x8
20 #define USER2 0x9
21 #define USER3 0xa
22 #define USER4 0xb
24 enum efinix_family_e {
25 EFINIX_TRION,
26 EFINIX_TITANIUM,
27 EFINIX_UNKNOWN
30 #define TRAILING_ZEROS 4000
31 #define RUNTEST_START_CYCLES 100
32 #define RUNTEST_FINISH_CYCLES 100
34 struct efinix_device {
35 uint32_t idcode;
36 int num_user;
39 struct efinix_pld_device {
40 struct jtag_tap *tap;
41 enum efinix_family_e family;
44 static int efinix_read_bit_file(struct raw_bit_file *bit_file, const char *filename)
46 FILE *input_file = fopen(filename, "r");
47 if (!input_file) {
48 LOG_ERROR("couldn't open %s: %s", filename, strerror(errno));
49 return ERROR_PLD_FILE_LOAD_FAILED;
52 fseek(input_file, 0, SEEK_END);
53 long length = ftell(input_file);
54 fseek(input_file, 0, SEEK_SET);
56 if (length < 0 || ((length % 3))) {
57 fclose(input_file);
58 LOG_ERROR("Failed to get length from file %s: %s", filename, strerror(errno));
59 return ERROR_PLD_FILE_LOAD_FAILED;
61 bit_file->length = DIV_ROUND_UP(length, 3);
63 bit_file->data = malloc(bit_file->length);
64 if (!bit_file->data) {
65 fclose(input_file);
66 LOG_ERROR("Out of memory");
67 return ERROR_PLD_FILE_LOAD_FAILED;
70 bool end_detected = false;
71 char buffer[3];
72 for (size_t idx = 0; !end_detected && idx < bit_file->length; ++idx) {
73 size_t read_count = fread(buffer, sizeof(char), 3, input_file);
74 end_detected = feof(input_file);
75 if ((read_count == 3 && buffer[2] != '\n') ||
76 (read_count != 3 && !end_detected) ||
77 (read_count != 2 && end_detected)) {
78 fclose(input_file);
79 free(bit_file->data);
80 bit_file->data = NULL;
81 LOG_ERROR("unexpected line length");
82 return ERROR_PLD_FILE_LOAD_FAILED;
85 if (!isxdigit(buffer[0]) || !isxdigit(buffer[1])) {
86 fclose(input_file);
87 free(bit_file->data);
88 bit_file->data = NULL;
89 LOG_ERROR("unexpected char in hex string");
90 return ERROR_PLD_FILE_LOAD_FAILED;
92 unhexify(&bit_file->data[idx], buffer, 2);
95 fclose(input_file);
97 return ERROR_OK;
100 static int efinix_read_file(struct raw_bit_file *bit_file, const char *filename)
102 if (!filename || !bit_file)
103 return ERROR_COMMAND_SYNTAX_ERROR;
105 /* check if binary .bin or ascii .bit/.hex */
106 const char *file_ending_pos = strrchr(filename, '.');
107 if (!file_ending_pos) {
108 LOG_ERROR("Unable to detect filename suffix");
109 return ERROR_PLD_FILE_LOAD_FAILED;
112 if (strcasecmp(file_ending_pos, ".bin") == 0) {
113 return cpld_read_raw_bit_file(bit_file, filename);
114 } else if ((strcasecmp(file_ending_pos, ".bit") == 0) ||
115 (strcasecmp(file_ending_pos, ".hex") == 0)) {
116 return efinix_read_bit_file(bit_file, filename);
119 LOG_ERROR("Unable to detect filetype");
120 return ERROR_PLD_FILE_LOAD_FAILED;
123 static int efinix_set_instr(struct jtag_tap *tap, uint8_t new_instr)
125 struct scan_field field;
126 field.num_bits = tap->ir_length;
127 void *t = calloc(DIV_ROUND_UP(field.num_bits, 8), 1);
128 if (!t) {
129 LOG_ERROR("Out of memory");
130 return ERROR_FAIL;
132 field.out_value = t;
133 buf_set_u32(t, 0, field.num_bits, new_instr);
134 field.in_value = NULL;
135 jtag_add_ir_scan(tap, &field, TAP_IDLE);
136 free(t);
137 return ERROR_OK;
140 static int efinix_load(struct pld_device *pld_device, const char *filename)
142 struct raw_bit_file bit_file;
143 struct scan_field field[2];
145 if (!pld_device || !pld_device->driver_priv)
146 return ERROR_FAIL;
148 struct efinix_pld_device *efinix_info = pld_device->driver_priv;
149 if (!efinix_info || !efinix_info->tap)
150 return ERROR_FAIL;
151 struct jtag_tap *tap = efinix_info->tap;
153 jtag_add_tlr();
155 int retval = efinix_set_instr(tap, PROGRAM);
156 if (retval != ERROR_OK)
157 return retval;
158 jtag_add_runtest(RUNTEST_START_CYCLES, TAP_IDLE);
159 retval = efinix_set_instr(tap, PROGRAM); /* fix for T20 */
160 if (retval != ERROR_OK)
161 return retval;
162 retval = jtag_execute_queue();
163 if (retval != ERROR_OK)
164 return retval;
166 retval = efinix_read_file(&bit_file, filename);
167 if (retval != ERROR_OK)
168 return retval;
170 for (size_t i = 0; i < bit_file.length; i++)
171 bit_file.data[i] = flip_u32(bit_file.data[i], 8);
173 /* shift in the bitstream */
174 field[0].num_bits = bit_file.length * 8;
175 field[0].out_value = bit_file.data;
176 field[0].in_value = NULL;
178 /* followed by zeros */
179 field[1].num_bits = TRAILING_ZEROS;
180 uint8_t *buf = calloc(TRAILING_ZEROS / 8, 1);
181 if (!buf) {
182 free(bit_file.data);
183 LOG_ERROR("Out of memory");
184 return ERROR_FAIL;
186 field[1].out_value = buf;
187 field[1].in_value = NULL;
189 jtag_add_dr_scan(tap, 2, field, TAP_DRPAUSE);
190 retval = jtag_execute_queue();
191 free(bit_file.data);
192 free(buf);
193 if (retval != ERROR_OK)
194 return retval;
196 retval = efinix_set_instr(tap, ENTERUSER);
197 if (retval != ERROR_OK)
198 return retval;
200 /* entering RUN/TEST for 100 cycles */
201 jtag_add_runtest(RUNTEST_FINISH_CYCLES, TAP_IDLE);
202 retval = jtag_execute_queue();
204 return retval;
207 static int efinix_get_ipdbg_hub(int user_num, struct pld_device *pld_device, struct pld_ipdbg_hub *hub)
209 if (!pld_device)
210 return ERROR_FAIL;
212 struct efinix_pld_device *pld_device_info = pld_device->driver_priv;
214 if (!pld_device_info || !pld_device_info->tap)
215 return ERROR_FAIL;
217 hub->tap = pld_device_info->tap;
219 if (pld_device_info->family == EFINIX_UNKNOWN) {
220 LOG_ERROR("family unknown, please specify for 'pld create'");
221 return ERROR_FAIL;
223 int num_user = 2; /* trion */
224 if (pld_device_info->family == EFINIX_TITANIUM)
225 num_user = 4;
227 if (user_num > num_user) {
228 LOG_ERROR("Devices has only user register 1 to %d", num_user);
229 return ERROR_FAIL;
232 switch (user_num) {
233 case 1:
234 hub->user_ir_code = USER1;
235 break;
236 case 2:
237 hub->user_ir_code = USER2;
238 break;
239 case 3:
240 hub->user_ir_code = USER3;
241 break;
242 case 4:
243 hub->user_ir_code = USER4;
244 break;
245 default:
246 LOG_ERROR("efinix devices only have user register 1 to %d", num_user);
247 return ERROR_FAIL;
249 return ERROR_OK;
252 static int efinix_get_jtagspi_userircode(struct pld_device *pld_device, unsigned int *ir)
254 *ir = USER1;
255 return ERROR_OK;
258 PLD_CREATE_COMMAND_HANDLER(efinix_pld_create_command)
260 if (CMD_ARGC != 4 && CMD_ARGC != 6)
261 return ERROR_COMMAND_SYNTAX_ERROR;
263 if (strcmp(CMD_ARGV[2], "-chain-position") != 0)
264 return ERROR_COMMAND_SYNTAX_ERROR;
266 struct jtag_tap *tap = jtag_tap_by_string(CMD_ARGV[3]);
267 if (!tap) {
268 command_print(CMD, "Tap: %s does not exist", CMD_ARGV[3]);
269 return ERROR_FAIL;
272 enum efinix_family_e family = EFINIX_UNKNOWN;
273 if (CMD_ARGC == 6) {
274 if (strcmp(CMD_ARGV[4], "-family") != 0)
275 return ERROR_COMMAND_SYNTAX_ERROR;
277 if (strcmp(CMD_ARGV[5], "trion") == 0) {
278 family = EFINIX_TRION;
279 } else if (strcmp(CMD_ARGV[5], "titanium") == 0) {
280 family = EFINIX_TITANIUM;
281 } else {
282 command_print(CMD, "unknown family");
283 return ERROR_FAIL;
287 struct efinix_pld_device *efinix_info = malloc(sizeof(struct efinix_pld_device));
288 if (!efinix_info) {
289 LOG_ERROR("Out of memory");
290 return ERROR_FAIL;
292 efinix_info->tap = tap;
293 efinix_info->family = family;
295 pld->driver_priv = efinix_info;
297 return ERROR_OK;
300 struct pld_driver efinix_pld = {
301 .name = "efinix",
302 .pld_create_command = &efinix_pld_create_command,
303 .load = &efinix_load,
304 .get_ipdbg_hub = efinix_get_ipdbg_hub,
305 .get_jtagspi_userircode = efinix_get_jtagspi_userircode,