2 * This file is part of the libsigrok project.
4 * Copyright (C) 2019 Vitaliy Vorobyov
6 * This program is free software: you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation, either version 3 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program. If not, see <http://www.gnu.org/licenses/>.
25 * Register description (all registers are 32bit):
27 * Rx - means register with index x (register address is x*4)
29 * R0(wr): trigger sel0 (low/high)
30 * R0(rd): n*256 samples (post trigger) captured
32 * R1(wr): trigger sel1 (level/edge)
33 * R1(rd): current sampled value
35 * R2(wr): trigger enable mask
37 * R2(rd): (status register)
38 * b0: 1 - keys entered
40 * b3: 1 - capture done
42 * not configured: B6FF9C97, 12FF9C97, 92FF9C97, 16FF9C97, ...
43 * configured: A5A5A5A0, after enter keys A5A5A5A1
45 * sel1 (one bit per channel):
49 * sel0 (one bit per channel):
50 * 0 - (low level trigger, sel1=0), (falling edge, sel1=1)
51 * 1 - (high level trigger, sel1=0), (raising edge, sel1=1)
53 * mask (one bit per channel):
54 * 0 - disable trigger on channel n
55 * 1 - enable trigger on channel n
57 * R3: upload base address or num samples (0x300000)
60 * 0 - div 1 (no division)
67 * b0: 1 - enable pll mul 2, 0 - disable pll mul 2
72 * b5: ->0->1 upload next data chunk (to pc)
74 * b7: 0 - enable pll mul 1.25, 1 - disable pll mul 1.25
77 * R6: post trigger depth, value x means (x+1)*256 (samples), min value is 1
78 * R7: pre trigger depth, value y means (y+1)*256 (samples), min value is 1
79 * (x+1)*256 + (y+1)*256 <= 64M
81 * R9: PWM1 HI (1 width-1)
82 * R10: PWM1 LO (0 width-1)
84 * R11: PWM2 HI (1 width-1)
85 * R12: PWM2 LO (0 width-1)
117 #define BITSTREAM_NAME "sysclk-sla5032.bit"
118 #define BITSTREAM_MAX_SIZE (512 * 1024) /* Bitstream size limit for safety */
119 #define BITSTREAM_HEADER_SIZE 0x69
120 #define FW_CHUNK_SIZE 250
121 #define XILINX_SYNC_WORD 0xAA995566
123 static int la_write_cmd_buf(const struct sr_usb_dev_inst *usb, uint8_t cmd,
124 unsigned int addr, unsigned int len, const void *data)
130 cmd_pkt = g_try_malloc(len + 10);
141 case CMD_INIT_FW_UPLOAD: /* init firmware upload */
143 case CMD_UPLOAD_FW_CHUNK:
146 memcpy(&cmd_pkt[2], data, len);
148 case CMD_READ_REG: /* read register */
153 case CMD_WRITE_REG: /* write register */
157 memcpy(&cmd_pkt[3], data, len);
159 case CMD_READ_MEM: /* read mem */
160 cmd_pkt[1] = (addr >> 8) & 0xFF;
161 cmd_pkt[2] = addr & 0xFF;
165 case CMD_READ_DATA: /* read samples */
171 ret = libusb_bulk_transfer(usb->devhdl, EP_COMMAND, cmd_pkt, cmd_len,
172 &xfer_len, USB_CMD_TIMEOUT_MS);
174 sr_dbg("Failed to send command %d: %s.",
175 cmd, libusb_error_name(ret));
179 if (xfer_len != cmd_len) {
180 sr_dbg("Invalid send command response of length %d.", xfer_len);
189 static int la_read_reg(const struct sr_usb_dev_inst *usb, unsigned int reg, uint32_t *val)
194 ret = la_write_cmd_buf(usb, CMD_READ_REG, reg * sizeof(uint32_t),
195 sizeof(reply), NULL); /* rd reg */
199 ret = libusb_bulk_transfer(usb->devhdl, EP_REPLY, (uint8_t *)&reply,
200 sizeof(reply), &xfer_len, USB_REPLY_TIMEOUT_MS);
204 if (xfer_len != sizeof(uint32_t)) {
205 sr_dbg("Invalid register read response of length %d.", xfer_len);
209 *val = GUINT32_FROM_BE(reply);
214 static int la_write_reg(const struct sr_usb_dev_inst *usb, unsigned int reg, uint32_t val)
219 val_be = GUINT32_TO_BE(val);
221 ret = la_write_cmd_buf(usb, CMD_WRITE_REG, reg * sizeof(uint32_t),
222 sizeof(val_be), &val_be); /* wr reg */
227 static int la_read_mem(const struct sr_usb_dev_inst *usb, unsigned int addr, unsigned int len, void *data)
231 ret = la_write_cmd_buf(usb, CMD_READ_MEM, addr, len, NULL); /* rd mem */
236 ret = libusb_bulk_transfer(usb->devhdl, EP_REPLY, (uint8_t *)data,
237 len, &xfer_len, USB_REPLY_TIMEOUT_MS);
238 if (xfer_len != (int)len) {
239 sr_dbg("Invalid memory read response of length %d.", xfer_len);
246 static int la_read_samples(const struct sr_usb_dev_inst *usb, unsigned int addr)
250 ret = la_write_cmd_buf(usb, CMD_READ_DATA, addr, 0, NULL); /* rd samples */
254 SR_PRIV int sla5032_set_depth(const struct sr_usb_dev_inst *usb, uint32_t pre, uint32_t post)
258 /* (pre + 1)*256 + (post + 1)*256 <= 64*1024*1024 */
259 ret = la_write_reg(usb, 7, pre);
263 ret = la_write_reg(usb, 6, post);
268 SR_PRIV int sla5032_set_triggers(const struct sr_usb_dev_inst *usb,
269 uint32_t trg_value, uint32_t trg_edge_mask, uint32_t trg_mask)
273 sr_dbg("set trigger: val: %08X, e_mask: %08X, mask: %08X.", trg_value,
274 trg_edge_mask, trg_mask);
276 ret = la_write_reg(usb, 0, trg_value);
280 ret = la_write_reg(usb, 1, trg_edge_mask);
284 ret = la_write_reg(usb, 2, trg_mask);
289 static int la_set_res_reg_bit(const struct sr_usb_dev_inst *usb,
290 unsigned int reg, unsigned int bit, unsigned int set_bit)
296 ret = la_read_reg(usb, reg, &v);
305 ret = la_write_reg(usb, reg, v);
310 struct pll_tbl_entry_t
313 uint32_t pll_div_minus_1;
314 unsigned int pll_mul_flags;
318 PLL_MUL2 = 1, /* x2 */
319 PLL_MUL1_25 = 2, /* x1.25 */
322 static const struct pll_tbl_entry_t pll_tbl[] = {
323 { 500000000, 0, PLL_MUL2 | PLL_MUL1_25 }, /* 500M = f*2*1.25/1 */
324 { 400000000, 0, PLL_MUL2 }, /* 400M = f*2/1 */
325 { 250000000, 0, PLL_MUL1_25 }, /* 250M = f*1.25/1 */
326 { 200000000, 0, 0 }, /* 200M = f/1 */
327 { 100000000, 1, 0 }, /* 100M = f/2 */
328 { 50000000, 3, 0 }, /* 50M = f/4 */
329 { 25000000, 7, 0 }, /* 25M = f/8 */
330 { 20000000, 9, 0 }, /* 20M = f/10 */
331 { 10000000, 19, 0 }, /* 10M = f/20 */
332 { 5000000, 39, 0 }, /* 5M = f/40 */
333 { 2000000, 99, 0 }, /* 2M = f/100 */
334 { 1000000, 199, 0 }, /* 1M = f/200 */
335 { 500000, 399, 0 }, /* 500k = f/400 */
336 { 200000, 999, 0 }, /* 200k = f/1000 */
337 { 100000, 1999, 0 }, /* 100k = f/2000 */
338 { 50000, 3999, 0 }, /* 50k = f/4000 */
339 { 20000, 9999, 0 }, /* 20k = f/10000 */
340 { 10000, 19999, 0 }, /* 10k = f/20000 */
341 { 5000, 39999, 0 }, /* 5k = f/40000 */
342 { 2000, 99999, 0 }, /* 2k = f/100000 */
345 SR_PRIV int sla5032_set_samplerate(const struct sr_usb_dev_inst *usb, unsigned int sr)
348 const struct pll_tbl_entry_t *e;
351 for (i = 0; i < (int)ARRAY_SIZE(pll_tbl); i++) {
352 if (sr == pll_tbl[i].sr) {
359 return SR_ERR_SAMPLERATE;
361 sr_dbg("set sample rate: %u.", e->sr);
363 ret = la_write_reg(usb, 4, e->pll_div_minus_1);
367 ret = la_set_res_reg_bit(usb, 5, 0,
368 (e->pll_mul_flags & PLL_MUL2) ? 1 : 0); /* bit0 (1=en_mul2) */
372 ret = la_set_res_reg_bit(usb, 5, 7,
373 (e->pll_mul_flags & PLL_MUL1_25) ? 0 : 1); /* bit7 (0=en_mul_1.25) */
378 SR_PRIV int sla5032_start_sample(const struct sr_usb_dev_inst *usb)
382 ret = la_write_reg(usb, 14, 1);
386 ret = la_set_res_reg_bit(usb, 5, 2, 0);
390 ret = la_set_res_reg_bit(usb, 5, 3, 0);
394 ret = la_set_res_reg_bit(usb, 5, 5, 0);
398 ret = la_set_res_reg_bit(usb, 5, 6, 1);
402 ret = la_set_res_reg_bit(usb, 5, 1, 1);
406 ret = la_set_res_reg_bit(usb, 5, 1, 0);
410 ret = la_set_res_reg_bit(usb, 5, 8, 1);
414 ret = la_set_res_reg_bit(usb, 5, 8, 0);
418 ret = la_set_res_reg_bit(usb, 5, 6, 1);
422 ret = la_set_res_reg_bit(usb, 5, 2, 1);
427 SR_PRIV int sla5032_get_status(const struct sr_usb_dev_inst *usb, uint32_t status[3])
432 ret = la_read_reg(usb, 1, &status[0]);
436 status[1] = 1; /* wait trigger */
438 ret = la_read_reg(usb, 0, &status[2]);
443 ret = la_read_reg(usb, 2, &v);
448 status[1] = 3; /* sample done */
449 sr_dbg("get status, reg2: %08X.", v);
451 status[1] = 2; /* triggered */
457 static int la_read_samples_data(const struct sr_usb_dev_inst *usb, void *buf,
458 unsigned int len, int *xfer_len)
462 ret = libusb_bulk_transfer(usb->devhdl, EP_DATA, (uint8_t *)buf, len,
463 xfer_len, USB_DATA_TIMEOUT_MS);
468 SR_PRIV int sla5032_read_data_chunk(const struct sr_usb_dev_inst *usb,
469 void *buf, unsigned int len, int *xfer_len)
473 ret = la_read_samples(usb, 3);
477 ret = la_write_reg(usb, 3, 0x300000);
481 ret = la_set_res_reg_bit(usb, 5, 4, 0);
485 ret = la_set_res_reg_bit(usb, 5, 4, 1);
489 ret = la_read_samples_data(usb, buf, len, xfer_len);
494 SR_PRIV int sla5032_set_read_back(const struct sr_usb_dev_inst *usb)
498 ret = la_write_reg(usb, 5, 0x08);
502 ret = la_write_reg(usb, 5, 0x28);
507 SR_PRIV int sla5032_set_pwm1(const struct sr_usb_dev_inst* usb, uint32_t hi, uint32_t lo)
511 ret = la_write_reg(usb, 9, hi);
515 ret = la_write_reg(usb, 10, lo);
520 SR_PRIV int sla5032_set_pwm2(const struct sr_usb_dev_inst* usb, uint32_t hi, uint32_t lo)
524 ret = la_write_reg(usb, 11, hi);
528 ret = la_write_reg(usb, 12, lo);
533 SR_PRIV int sla5032_write_reg14_zero(const struct sr_usb_dev_inst* usb)
537 ret = la_write_reg(usb, 14, 0);
542 static int la_cfg_fpga_done(const struct sr_usb_dev_inst *usb, unsigned int addr)
549 memset(done_key, 0, sizeof(done_key));
551 ret = la_read_mem(usb, addr, sizeof(done_key), done_key); /* read key from eeprom */
555 k0 = RL32(done_key); /* 0x641381F6 */
556 k1 = RL32(done_key + 4); /* 0x00000000 */
558 sr_dbg("cfg fpga done, k0: %08X, k1: %08X.", k0, k1);
560 ret = la_write_reg(usb, 16, k0);
564 ret = la_write_reg(usb, 17, k1);
569 ret = la_read_reg(usb, 2, ®2);
571 sr_dbg("cfg fpga done, reg2: %08X.", reg2);
577 * Load a bitstream file into memory. Returns a newly allocated array
578 * consisting of a 32-bit length field followed by the bitstream data.
580 static unsigned char *load_bitstream(struct sr_context *ctx,
581 const char *name, int *length_p)
583 struct sr_resource fw;
584 unsigned char *stream, *fw_data;
585 ssize_t length, count;
587 if (sr_resource_open(ctx, &fw, SR_RESOURCE_FIRMWARE, name) != SR_OK)
590 if (fw.size <= BITSTREAM_HEADER_SIZE || fw.size > BITSTREAM_MAX_SIZE) {
591 sr_err("Refusing to load bitstream of unreasonable size "
592 "(%" PRIu64 " bytes).", fw.size);
593 sr_resource_close(ctx, &fw);
597 stream = g_try_malloc(fw.size);
599 sr_err("Failed to allocate bitstream buffer.");
600 sr_resource_close(ctx, &fw);
604 count = sr_resource_read(ctx, &fw, stream, fw.size);
605 sr_resource_close(ctx, &fw);
607 if (count != (ssize_t)fw.size) {
608 sr_err("Failed to read bitstream '%s'.", name);
613 if (RB32(stream + BITSTREAM_HEADER_SIZE) != XILINX_SYNC_WORD) {
614 sr_err("Invalid bitstream signature.");
619 length = fw.size - BITSTREAM_HEADER_SIZE + 0x100;
620 fw_data = g_try_malloc(length);
622 sr_err("Failed to allocate bitstream aligned buffer.");
626 memset(fw_data, 0xFF, 0x100);
627 memcpy(fw_data + 0x100, stream + BITSTREAM_HEADER_SIZE,
628 fw.size - BITSTREAM_HEADER_SIZE);
636 static int sla5032_is_configured(const struct sr_usb_dev_inst* usb, gboolean *is_configured)
642 ret = la_read_reg(usb, 2, ®2);
644 *is_configured = (reg2 & 0xFFFFFFF1) == 0xA5A5A5A1 ? TRUE : FALSE;
649 /* Load a Binary File from the firmware directory, transfer it to the device. */
650 static int sla5032_send_bitstream(struct sr_context *ctx,
651 const struct sr_usb_dev_inst *usb, const char *name)
653 unsigned char *stream;
654 int ret, length, i, n, m;
657 if (!ctx || !usb || !name)
660 stream = load_bitstream(ctx, name, &length);
664 sr_dbg("Downloading FPGA bitstream '%s'.", name);
667 ret = la_read_reg(usb, 2, ®2);
668 sr_dbg("send bitstream, reg2: %08X.", reg2);
670 /* Transfer the entire bitstream in one URB. */
671 ret = la_write_cmd_buf(usb, CMD_INIT_FW_UPLOAD, 0, 0, NULL); /* init firmware upload */
677 n = length / FW_CHUNK_SIZE;
678 m = length % FW_CHUNK_SIZE;
680 for (i = 0; i < n; i++) {
681 /* upload firmware chunk */
682 ret = la_write_cmd_buf(usb, CMD_UPLOAD_FW_CHUNK, 0,
683 FW_CHUNK_SIZE, &stream[i * FW_CHUNK_SIZE]);
692 /* upload firmware last chunk */
693 ret = la_write_cmd_buf(usb, CMD_UPLOAD_FW_CHUNK, 0, m,
694 &stream[n * FW_CHUNK_SIZE]);
704 la_cfg_fpga_done(usb, 4000);
706 sla5032_write_reg14_zero(usb);
708 sr_dbg("FPGA bitstream download of %d bytes done.", length);
713 /* Select and transfer FPGA bitstream for the current configuration. */
714 SR_PRIV int sla5032_apply_fpga_config(const struct sr_dev_inst *sdi)
716 struct dev_context *devc;
717 struct drv_context *drvc;
719 gboolean is_configured;
722 drvc = sdi->driver->context;
724 if (FPGA_NOCONF != devc->active_fpga_config)
725 return SR_OK; /* No change. */
727 is_configured = FALSE;
728 ret = sla5032_is_configured(sdi->conn, &is_configured);
733 devc->active_fpga_config = FPGA_CONF;
737 sr_dbg("FPGA not configured, send bitstream.");
738 ret = sla5032_send_bitstream(drvc->sr_ctx, sdi->conn, BITSTREAM_NAME);
739 devc->active_fpga_config = (ret == SR_OK) ? FPGA_CONF : FPGA_NOCONF;