firmware: move fpga selftest to a separate file to resolve blinky linker issues

This commit is contained in:
Antoine van Gelder
2025-12-01 14:16:47 +02:00
parent 4e90ee5c51
commit 3faf82ede6
8 changed files with 492 additions and 364 deletions

View File

@@ -22,29 +22,27 @@
#include <stdbool.h>
#include "hackrf_core.h"
#include "ice40_spi.h"
#include "lz4_blk.h"
#include "m0_state.h"
#include "streaming.h"
#include "rf_path.h"
#include "selftest.h"
#include "fpga.h"
#include "fpga_regs.def"
// FPGA bitstreams blob.
extern uint32_t _binary_fpga_bin_start;
extern uint32_t _binary_fpga_bin_end;
extern uint32_t _binary_fpga_bin_size;
/* Set up all registers according to the loaded bitstream's defaults. */
void fpga_init(fpga_driver_t* const drv)
{
// Standard bitstream default register values.
set_FPGA_STANDARD_CTRL(drv, 0);
set_FPGA_STANDARD_TX_CTRL(drv, 0);
// USB buffer used during selftests.
#define USB_BULK_BUFFER_SIZE 0x8000
extern uint8_t usb_bulk_buffer[USB_BULK_BUFFER_SIZE];
// TODO support the other bitstreams
struct fpga_image_read_ctx {
uint32_t addr;
size_t next_block_sz;
uint8_t init_flag;
uint8_t buffer[4096 + 2];
};
fpga_regs_commit(drv);
}
void fpga_setup(fpga_driver_t* const drv)
{
// TODO implement fpga_target.c
fpga_init(drv);
}
uint8_t fpga_reg_read(fpga_driver_t* const drv, uint8_t r)
{
@@ -80,366 +78,57 @@ void fpga_regs_commit(fpga_driver_t* const drv)
}
}
void fpga_hw_sync_enable(const hw_sync_mode_t hw_sync_mode)
void fpga_set_hw_sync_enable(fpga_driver_t* const drv, const hw_sync_mode_t hw_sync_mode)
{
fpga_reg_read(&fpga, FPGA_STANDARD_CTRL);
set_FPGA_STANDARD_CTRL_TRIGGER_EN(&fpga, hw_sync_mode == 1);
fpga_regs_commit(&fpga);
fpga_reg_read(drv, FPGA_STANDARD_CTRL);
set_FPGA_STANDARD_CTRL_TRIGGER_EN(drv, hw_sync_mode == 1);
fpga_regs_commit(drv);
}
static size_t fpga_image_read_block_cb(void* _ctx, uint8_t* out_buffer)
void fpga_set_rx_dc_block_enable(fpga_driver_t* const drv, const bool enable)
{
// Assume out_buffer is 4KB
struct fpga_image_read_ctx* ctx = _ctx;
size_t block_sz = ctx->next_block_sz;
// first iteration: read first block size
if (ctx->init_flag == 0) {
w25q80bv_read(&spi_flash, ctx->addr, 2, ctx->buffer);
block_sz = ctx->buffer[0] | (ctx->buffer[1] << 8);
ctx->addr += 2;
ctx->init_flag = 1;
}
// finish at end marker
if (block_sz == 0)
return 0;
// Read compressed block (and the next block size) from flash.
w25q80bv_read(&spi_flash, ctx->addr, block_sz + 2, ctx->buffer);
ctx->addr += block_sz + 2;
ctx->next_block_sz = ctx->buffer[block_sz] | (ctx->buffer[block_sz + 1] << 8);
// Decompress block.
return lz4_blk_decompress(ctx->buffer, out_buffer, block_sz);
set_FPGA_STANDARD_CTRL_DC_BLOCK(drv, enable);
fpga_regs_commit(drv);
}
bool fpga_image_load(unsigned int index)
void fpga_set_rx_decimation_ratio(fpga_driver_t* const drv, const uint8_t value)
{
#if defined(DFU_MODE) || defined(RAM_MODE)
selftest.fpga_image_load = SKIPPED;
selftest.report.pass = false;
return false;
#endif
// TODO: do SPI setup and read number of bitstreams once!
// Prepare for SPI flash access.
spi_bus_start(spi_flash.bus, &ssp_config_w25q80bv);
w25q80bv_setup(&spi_flash);
// Read number of bitstreams from flash.
// Check the bitstream exists, and extract its offset.
uint32_t addr = (uint32_t) &_binary_fpga_bin_start;
uint32_t num_bitstreams, bitstream_offset;
w25q80bv_read(&spi_flash, addr, 4, (uint8_t*) &num_bitstreams);
if (index >= num_bitstreams)
return false;
w25q80bv_read(&spi_flash, addr + 4 * (index + 1), 4, (uint8_t*) &bitstream_offset);
// A callback function is used by the FPGA programmer
// to obtain consecutive gateware chunks.
ice40_spi_target_init(&ice40);
ssp1_set_mode_ice40();
struct fpga_image_read_ctx fpga_image_ctx = {
.addr = (uint32_t) &_binary_fpga_bin_start + bitstream_offset,
};
const bool success = ice40_spi_syscfg_program(
&ice40,
fpga_image_read_block_cb,
&fpga_image_ctx);
ssp1_set_mode_max283x();
// Update selftest result.
selftest.fpga_image_load = success ? PASSED : FAILED;
if (selftest.fpga_image_load != PASSED) {
selftest.report.pass = false;
}
return success;
set_FPGA_STANDARD_RX_DECIM(drv, value & 0b111);
fpga_regs_commit(drv);
}
static int rx_samples(const unsigned int num_samples, uint32_t max_cycles)
void fpga_set_rx_quarter_shift_mode(
fpga_driver_t* const drv,
const fpga_quarter_shift_mode_t mode)
{
uint32_t cycle_count = 0;
int rc = 0;
m0_set_mode(M0_MODE_RX);
m0_state.shortfall_limit = 0;
baseband_streaming_enable(&sgpio_config);
while (m0_state.m0_count < num_samples) {
cycle_count++;
if ((max_cycles > 0) && (cycle_count >= max_cycles)) {
rc = -1;
break;
}
}
baseband_streaming_disable(&sgpio_config);
m0_set_mode(M0_MODE_IDLE);
return rc;
set_FPGA_STANDARD_CTRL_QUARTER_SHIFT_EN(drv, (mode >> 0) & 0b1);
set_FPGA_STANDARD_CTRL_QUARTER_SHIFT_UP(drv, (mode >> 1) & 0b1);
fpga_regs_commit(drv);
}
bool fpga_spi_selftest()
void fpga_set_tx_interpolation_ratio(fpga_driver_t* const drv, const uint8_t value)
{
// Skip if FPGA configuration failed.
if (selftest.fpga_image_load != PASSED) {
selftest.fpga_spi = SKIPPED;
return false;
}
// Test writing a register and reading it back.
uint8_t reg = 5;
uint8_t write_value = 0xA5;
ssp1_set_mode_ice40();
ice40_spi_write(&ice40, reg, write_value);
uint8_t read_value = ice40_spi_read(&ice40, reg);
ssp1_set_mode_max283x();
// Update selftest result.
selftest.fpga_spi = (read_value == write_value) ? PASSED : FAILED;
if (selftest.fpga_spi != PASSED) {
selftest.report.pass = false;
}
return selftest.fpga_spi == PASSED;
set_FPGA_STANDARD_TX_INTRP(drv, value & 0b111);
fpga_regs_commit(drv);
}
static uint8_t lfsr_advance(uint8_t v)
void fpga_set_prbs_enable(fpga_driver_t* const drv, const bool enable)
{
const uint8_t feedback = ((v >> 3) ^ (v >> 4) ^ (v >> 5) ^ (v >> 7)) & 1;
return (v << 1) | feedback;
set_FPGA_STANDARD_CTRL(drv, 0);
if (enable) {
set_FPGA_STANDARD_CTRL_PRBS(drv, enable);
}
fpga_regs_commit(drv);
}
bool fpga_sgpio_selftest()
void fpga_set_tx_nco_enable(fpga_driver_t* const drv, const bool enable)
{
bool timeout = false;
// Skip if FPGA configuration failed or its SPI bus is not working.
if ((selftest.fpga_image_load != PASSED) || (selftest.fpga_spi != PASSED)) {
selftest.sgpio_rx = SKIPPED;
return false;
}
// Enable PRBS mode.
set_FPGA_STANDARD_CTRL(&fpga, 0);
set_FPGA_STANDARD_CTRL_PRBS(&fpga, 1);
fpga_regs_commit(&fpga);
// Stream 512 samples from the FPGA.
sgpio_configure(&sgpio_config, SGPIO_DIRECTION_RX);
if (rx_samples(512, 10000) == -1) {
timeout = true;
}
// Disable PRBS mode.
set_FPGA_STANDARD_CTRL_PRBS(&fpga, 0);
fpga_regs_commit(&fpga);
// Generate sequence from first value and compare.
bool seq_in_sync = true;
uint8_t seq = lfsr_advance(usb_bulk_buffer[0]);
for (int i = 1; i < 512; ++i) {
if (usb_bulk_buffer[i] != seq) {
seq_in_sync = false;
break;
}
seq = lfsr_advance(seq);
}
// Update selftest result.
if (seq_in_sync) {
selftest.sgpio_rx = PASSED;
} else if (timeout) {
selftest.sgpio_rx = TIMEOUT;
} else {
selftest.sgpio_rx = FAILED;
}
if (selftest.sgpio_rx != PASSED) {
selftest.report.pass = false;
}
return selftest.sgpio_rx == PASSED;
set_FPGA_STANDARD_TX_CTRL_NCO_EN(drv, enable);
fpga_regs_commit(drv);
}
static void measure_tone(int8_t* samples, size_t len, struct xcvr_measurements* results)
void fpga_set_tx_nco_pstep(fpga_driver_t* const drv, const uint8_t phase_increment)
{
results->zcs_i = 0;
results->zcs_q = 0;
results->max_mag_i = 0;
results->max_mag_q = 0;
results->avg_mag_sq_i = 0;
results->avg_mag_sq_q = 0;
uint8_t last_sign_i = 0;
uint8_t last_sign_q = 0;
for (size_t i = 0; i < len; i += 2) {
int8_t sample_i = samples[i];
int8_t sample_q = samples[i + 1];
uint8_t sign_i = sample_i < 0 ? 1 : 0;
uint8_t sign_q = sample_q < 0 ? 1 : 0;
results->zcs_i += sign_i ^ last_sign_i;
results->zcs_q += sign_q ^ last_sign_q;
last_sign_i = sign_i;
last_sign_q = sign_q;
uint8_t mag_i = sign_i ? -sample_i : sample_i;
uint8_t mag_q = sign_q ? -sample_q : sample_q;
if (mag_i > results->max_mag_i)
results->max_mag_i = mag_i;
if (mag_q > results->max_mag_q)
results->max_mag_q = mag_q;
results->avg_mag_sq_i += mag_i * mag_i;
results->avg_mag_sq_q += mag_q * mag_q;
}
results->avg_mag_sq_i /= (len / 2);
results->avg_mag_sq_q /= (len / 2);
}
static bool in_range(int value, int expected, int error)
{
int max = expected * (100 + error) / 100;
int min = expected * (100 - error) / 100;
return (value > min) && (value < max);
}
bool fpga_if_xcvr_selftest()
{
bool timeout = false;
// Skip if FPGA configuration failed or its SPI bus is not working.
if ((selftest.fpga_image_load != PASSED) || (selftest.fpga_spi != PASSED)) {
selftest.xcvr_loopback = SKIPPED;
return false;
}
const size_t num_samples = USB_BULK_BUFFER_SIZE / 2;
// Set common RX path and gateware settings for the measurements.
set_FPGA_STANDARD_TX_PSTEP(&fpga, 128); // NCO phase increment
set_FPGA_STANDARD_TX_CTRL_NCO_EN(&fpga, 1); // NCO TX enable
fpga_regs_commit(&fpga);
rf_path_set_direction(&rf_path, RF_PATH_DIRECTION_RX_CALIBRATION);
max2831_set_lna_gain(&max283x, 16);
max2831_set_vga_gain(&max283x, 36);
max2831_set_frequency(&max283x, 2500000000);
// Capture 1: 4 Msps, tone at 0.5 MHz, narrowband filter OFF
sample_rate_frac_set(4000000 * 2, 1);
delay_us_at_mhz(1000, 204);
if (rx_samples(num_samples, 2000000) == -1) {
timeout = true;
}
measure_tone(
(int8_t*) usb_bulk_buffer,
num_samples,
&selftest.xcvr_measurements[0]);
// Capture 2: 4 Msps, tone at 0.5 MHz, narrowband filter ON
narrowband_filter_set(1);
delay_us_at_mhz(1000, 204);
if (rx_samples(num_samples, 2000000) == -1) {
timeout = true;
}
measure_tone(
(int8_t*) usb_bulk_buffer,
num_samples,
&selftest.xcvr_measurements[1]);
// Capture 3: 20 Msps, tone at 5 MHz, narrowband filter OFF
ssp1_set_mode_ice40();
ice40_spi_write(&ice40, 0x05, 255);
ssp1_set_mode_max283x();
sample_rate_frac_set(20000000 * 2, 1);
narrowband_filter_set(0);
delay_us_at_mhz(1000, 204);
if (rx_samples(num_samples, 2000000) == -1) {
timeout = true;
}
measure_tone(
(int8_t*) usb_bulk_buffer,
num_samples,
&selftest.xcvr_measurements[2]);
// Capture 4: 20 Msps, tone at 5 MHz, narrowband filter ON
narrowband_filter_set(1);
delay_us_at_mhz(1000, 204);
if (rx_samples(num_samples, 2000000) == -1) {
timeout = true;
}
measure_tone(
(int8_t*) usb_bulk_buffer,
num_samples,
&selftest.xcvr_measurements[3]);
// Restore default settings.
sample_rate_set(10000000);
rf_path_set_direction(&rf_path, RF_PATH_DIRECTION_OFF);
narrowband_filter_set(0);
set_FPGA_STANDARD_TX_CTRL(&fpga, 0);
fpga_regs_commit(&fpga);
if (timeout) {
selftest.xcvr_loopback = TIMEOUT;
selftest.report.pass = false;
return false;
}
unsigned int expected_zcs;
bool i_in_range;
bool q_in_range;
bool i_energy_in_range;
bool q_energy_in_range;
// Capture 0:
// Count zero crossings.
// N/2 samples/channel * 2 zcs/cycle / 16 samples/cycle = N/16 zcs/channel
expected_zcs = num_samples / 16;
i_in_range = in_range(selftest.xcvr_measurements[0].zcs_i, expected_zcs, 5);
q_in_range = in_range(selftest.xcvr_measurements[0].zcs_q, expected_zcs, 5);
i_energy_in_range = (selftest.xcvr_measurements[0].avg_mag_sq_i > 500) &&
(selftest.xcvr_measurements[0].avg_mag_sq_i < 2500);
q_energy_in_range = (selftest.xcvr_measurements[0].avg_mag_sq_q > 500) &&
(selftest.xcvr_measurements[0].avg_mag_sq_q < 2500);
bool capture_0_test =
i_in_range && q_in_range && i_energy_in_range && q_energy_in_range;
// Capture 1:
// Count zero crossings.
expected_zcs = num_samples / 16;
i_in_range = in_range(selftest.xcvr_measurements[1].zcs_i, expected_zcs, 5);
q_in_range = in_range(selftest.xcvr_measurements[1].zcs_q, expected_zcs, 5);
i_energy_in_range = (selftest.xcvr_measurements[1].avg_mag_sq_i > 500) &&
(selftest.xcvr_measurements[1].avg_mag_sq_i < 2500);
q_energy_in_range = (selftest.xcvr_measurements[1].avg_mag_sq_q > 500) &&
(selftest.xcvr_measurements[1].avg_mag_sq_q < 2500);
bool capture_1_test =
i_in_range && q_in_range && i_energy_in_range && q_energy_in_range;
// Capture 2:
// Count zero crossings.
expected_zcs = num_samples / 4;
i_in_range = in_range(selftest.xcvr_measurements[2].zcs_i, expected_zcs, 5);
q_in_range = in_range(selftest.xcvr_measurements[2].zcs_q, expected_zcs, 5);
i_energy_in_range = (selftest.xcvr_measurements[2].avg_mag_sq_i > 400) &&
(selftest.xcvr_measurements[2].avg_mag_sq_i < 2000);
q_energy_in_range = (selftest.xcvr_measurements[2].avg_mag_sq_q > 400) &&
(selftest.xcvr_measurements[2].avg_mag_sq_q < 2000);
bool capture_2_test =
i_in_range && q_in_range && i_energy_in_range && q_energy_in_range;
// Capture 3:
i_energy_in_range = (selftest.xcvr_measurements[3].avg_mag_sq_i < 100);
q_energy_in_range = (selftest.xcvr_measurements[3].avg_mag_sq_q < 100);
bool capture_3_test = i_energy_in_range && q_energy_in_range;
// Update selftest result.
selftest.xcvr_loopback =
(capture_0_test && capture_1_test && capture_2_test && capture_3_test) ?
PASSED :
FAILED;
if (selftest.xcvr_loopback != PASSED) {
selftest.report.pass = false;
}
return selftest.xcvr_loopback == PASSED;
set_FPGA_STANDARD_TX_PSTEP(drv, phase_increment);
fpga_regs_commit(drv);
}

View File

@@ -23,11 +23,18 @@
#define __FPGA_H
#include <stdbool.h>
#include "hackrf_core.h"
/* Up to 5 registers, each containing up to 8 bits of data */
#define FPGA_NUM_REGS 5
#define FPGA_DATA_REGS_MAX_VALUE 255
typedef enum {
FPGA_QUARTER_SHIFT_MODE_NONE = 0b00,
FPGA_QUARTER_SHIFT_MODE_UP = 0b11,
FPGA_QUARTER_SHIFT_MODE_DOWN = 0b01,
} fpga_quarter_shift_mode_t;
struct fpga_driver_t;
typedef struct fpga_driver_t fpga_driver_t;
@@ -37,6 +44,12 @@ struct fpga_driver_t {
uint8_t regs_dirty;
};
/* Initialize the loaded bitstream's registers to their default values. */
extern void fpga_init(fpga_driver_t* const drv);
/* Initialize fpga and gateware. */
extern void fpga_setup(fpga_driver_t* const drv);
/* Read a register via SPI. Save a copy to memory and return
* value. Mark clean. */
extern uint8_t fpga_reg_read(fpga_driver_t* const drv, uint8_t r);
@@ -50,7 +63,17 @@ extern void fpga_reg_write(fpga_driver_t* const drv, uint8_t r, uint8_t v);
* provided routines for those operations. */
extern void fpga_regs_commit(fpga_driver_t* const drv);
void fpga_hw_sync_enable(const hw_sync_mode_t hw_sync_mode);
void fpga_set_hw_sync_enable(fpga_driver_t* const drv, const hw_sync_mode_t hw_sync_mode);
void fpga_set_rx_dc_block_enable(fpga_driver_t* const drv, const bool enable);
void fpga_set_rx_decimation_ratio(fpga_driver_t* const drv, const uint8_t value);
void fpga_set_rx_quarter_shift_mode(
fpga_driver_t* const drv,
const fpga_quarter_shift_mode_t mode);
void fpga_set_tx_interpolation_ratio(fpga_driver_t* const drv, const uint8_t value);
void fpga_set_prbs_enable(fpga_driver_t* const drv, const bool enable);
void fpga_set_tx_nco_enable(fpga_driver_t* const drv, const bool enable);
void fpga_set_tx_nco_pstep(fpga_driver_t* const drv, const uint8_t phase_increment);
bool fpga_image_load(unsigned int index);
bool fpga_spi_selftest();

View File

@@ -0,0 +1,108 @@
/*
* Copyright 2025 Great Scott Gadgets <info@greatscottgadgets.com>
*
* This file is part of HackRF.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2, or (at your option)
* any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; see the file COPYING. If not, write to
* the Free Software Foundation, Inc., 51 Franklin Street,
* Boston, MA 02110-1301, USA.
*/
#include "hackrf_core.h"
#include "lz4_blk.h"
#include "selftest.h"
// FPGA bitstreams blob.
extern uint32_t _binary_fpga_bin_start;
extern uint32_t _binary_fpga_bin_end;
extern uint32_t _binary_fpga_bin_size;
struct fpga_image_read_ctx {
uint32_t addr;
size_t next_block_sz;
uint8_t init_flag;
uint8_t buffer[4096 + 2];
};
static size_t fpga_image_read_block_cb(void* _ctx, uint8_t* out_buffer)
{
// Assume out_buffer is 4KB
struct fpga_image_read_ctx* ctx = _ctx;
size_t block_sz = ctx->next_block_sz;
// first iteration: read first block size
if (ctx->init_flag == 0) {
w25q80bv_read(&spi_flash, ctx->addr, 2, ctx->buffer);
block_sz = ctx->buffer[0] | (ctx->buffer[1] << 8);
ctx->addr += 2;
ctx->init_flag = 1;
}
// finish at end marker
if (block_sz == 0)
return 0;
// Read compressed block (and the next block size) from flash.
w25q80bv_read(&spi_flash, ctx->addr, block_sz + 2, ctx->buffer);
ctx->addr += block_sz + 2;
ctx->next_block_sz = ctx->buffer[block_sz] | (ctx->buffer[block_sz + 1] << 8);
// Decompress block.
return lz4_blk_decompress(ctx->buffer, out_buffer, block_sz);
}
bool fpga_image_load(unsigned int index)
{
#if defined(DFU_MODE) || defined(RAM_MODE)
selftest.fpga_image_load = SKIPPED;
selftest.report.pass = false;
return false;
#endif
// TODO: do SPI setup and read number of bitstreams once!
// Prepare for SPI flash access.
spi_bus_start(spi_flash.bus, &ssp_config_w25q80bv);
w25q80bv_setup(&spi_flash);
// Read number of bitstreams from flash.
// Check the bitstream exists, and extract its offset.
uint32_t addr = (uint32_t) &_binary_fpga_bin_start;
uint32_t num_bitstreams, bitstream_offset;
w25q80bv_read(&spi_flash, addr, 4, (uint8_t*) &num_bitstreams);
if (index >= num_bitstreams)
return false;
w25q80bv_read(&spi_flash, addr + 4 * (index + 1), 4, (uint8_t*) &bitstream_offset);
// A callback function is used by the FPGA programmer
// to obtain consecutive gateware chunks.
ice40_spi_target_init(&ice40);
ssp1_set_mode_ice40();
struct fpga_image_read_ctx fpga_image_ctx = {
.addr = (uint32_t) &_binary_fpga_bin_start + bitstream_offset,
};
const bool success = ice40_spi_syscfg_program(
&ice40,
fpga_image_read_block_cb,
&fpga_image_ctx);
ssp1_set_mode_max283x();
// Update selftest result.
selftest.fpga_image_load = success ? PASSED : FAILED;
if (selftest.fpga_image_load != PASSED) {
selftest.report.pass = false;
}
return success;
}

View File

@@ -21,8 +21,8 @@
* Boston, MA 02110-1301, USA.
*/
#ifndef __FPGA_STANDARD_REGS_DEF
#define __FPGA_STANDARD_REGS_DEF
#ifndef __FPGA_REGS_DEF
#define __FPGA_REGS_DEF
#define FPGA_REG_SET_CLEAN(_d, _r) (_d->regs_dirty &= ~(1UL<<_r))
#define FPGA_REG_SET_DIRTY(_d, _r) (_d->regs_dirty |= (1UL<<_r))
@@ -71,4 +71,4 @@ __MREG__(FPGA_STANDARD_TX_INTRP, 4, 0, 3)
/* REG 05 (5): TX_PSTEP */
__MREG__(FPGA_STANDARD_TX_PSTEP, 5, 0, 8)
#endif // __FPGA_STANDARD_REGS_DEF
#endif // __FPGA_REGS_DEF

View File

@@ -0,0 +1,307 @@
/*
* Copyright 2025 Great Scott Gadgets <info@greatscottgadgets.com>
*
* This file is part of HackRF.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2, or (at your option)
* any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; see the file COPYING. If not, write to
* the Free Software Foundation, Inc., 51 Franklin Street,
* Boston, MA 02110-1301, USA.
*/
#include "hackrf_core.h"
#include "m0_state.h"
#include "streaming.h"
#include "selftest.h"
#include "fpga.h"
// USB buffer used during selftests.
#define USB_BULK_BUFFER_SIZE 0x8000
extern uint8_t usb_bulk_buffer[USB_BULK_BUFFER_SIZE];
static int rx_samples(const unsigned int num_samples, uint32_t max_cycles)
{
uint32_t cycle_count = 0;
int rc = 0;
m0_set_mode(M0_MODE_RX);
m0_state.shortfall_limit = 0;
baseband_streaming_enable(&sgpio_config);
while (m0_state.m0_count < num_samples) {
cycle_count++;
if ((max_cycles > 0) && (cycle_count >= max_cycles)) {
rc = -1;
break;
}
}
baseband_streaming_disable(&sgpio_config);
m0_set_mode(M0_MODE_IDLE);
return rc;
}
bool fpga_spi_selftest()
{
// Skip if FPGA configuration failed.
if (selftest.fpga_image_load != PASSED) {
selftest.fpga_spi = SKIPPED;
return false;
}
// Test writing a register and reading it back.
uint8_t reg = 5;
uint8_t write_value = 0xA5;
ssp1_set_mode_ice40();
ice40_spi_write(&ice40, reg, write_value);
uint8_t read_value = ice40_spi_read(&ice40, reg);
ssp1_set_mode_max283x();
// Update selftest result.
selftest.fpga_spi = (read_value == write_value) ? PASSED : FAILED;
if (selftest.fpga_spi != PASSED) {
selftest.report.pass = false;
}
return selftest.fpga_spi == PASSED;
}
static uint8_t lfsr_advance(uint8_t v)
{
const uint8_t feedback = ((v >> 3) ^ (v >> 4) ^ (v >> 5) ^ (v >> 7)) & 1;
return (v << 1) | feedback;
}
bool fpga_sgpio_selftest()
{
bool timeout = false;
// Skip if FPGA configuration failed or its SPI bus is not working.
if ((selftest.fpga_image_load != PASSED) || (selftest.fpga_spi != PASSED)) {
selftest.sgpio_rx = SKIPPED;
return false;
}
// Enable PRBS mode.
fpga_set_prbs_enable(&fpga, true);
// Stream 512 samples from the FPGA.
sgpio_configure(&sgpio_config, SGPIO_DIRECTION_RX);
if (rx_samples(512, 10000) == -1) {
timeout = true;
}
// Disable PRBS mode.
fpga_set_prbs_enable(&fpga, true);
// Generate sequence from first value and compare.
bool seq_in_sync = true;
uint8_t seq = lfsr_advance(usb_bulk_buffer[0]);
for (int i = 1; i < 512; ++i) {
if (usb_bulk_buffer[i] != seq) {
seq_in_sync = false;
break;
}
seq = lfsr_advance(seq);
}
// Update selftest result.
if (seq_in_sync) {
selftest.sgpio_rx = PASSED;
} else if (timeout) {
selftest.sgpio_rx = TIMEOUT;
} else {
selftest.sgpio_rx = FAILED;
}
if (selftest.sgpio_rx != PASSED) {
selftest.report.pass = false;
}
return selftest.sgpio_rx == PASSED;
}
static void measure_tone(int8_t* samples, size_t len, struct xcvr_measurements* results)
{
results->zcs_i = 0;
results->zcs_q = 0;
results->max_mag_i = 0;
results->max_mag_q = 0;
results->avg_mag_sq_i = 0;
results->avg_mag_sq_q = 0;
uint8_t last_sign_i = 0;
uint8_t last_sign_q = 0;
for (size_t i = 0; i < len; i += 2) {
int8_t sample_i = samples[i];
int8_t sample_q = samples[i + 1];
uint8_t sign_i = sample_i < 0 ? 1 : 0;
uint8_t sign_q = sample_q < 0 ? 1 : 0;
results->zcs_i += sign_i ^ last_sign_i;
results->zcs_q += sign_q ^ last_sign_q;
last_sign_i = sign_i;
last_sign_q = sign_q;
uint8_t mag_i = sign_i ? -sample_i : sample_i;
uint8_t mag_q = sign_q ? -sample_q : sample_q;
if (mag_i > results->max_mag_i)
results->max_mag_i = mag_i;
if (mag_q > results->max_mag_q)
results->max_mag_q = mag_q;
results->avg_mag_sq_i += mag_i * mag_i;
results->avg_mag_sq_q += mag_q * mag_q;
}
results->avg_mag_sq_i /= (len / 2);
results->avg_mag_sq_q /= (len / 2);
}
static bool in_range(int value, int expected, int error)
{
int max = expected * (100 + error) / 100;
int min = expected * (100 - error) / 100;
return (value > min) && (value < max);
}
bool fpga_if_xcvr_selftest()
{
bool timeout = false;
// Skip if FPGA configuration failed or its SPI bus is not working.
if ((selftest.fpga_image_load != PASSED) || (selftest.fpga_spi != PASSED)) {
selftest.xcvr_loopback = SKIPPED;
return false;
}
const size_t num_samples = USB_BULK_BUFFER_SIZE / 2;
// Set common RX path and gateware settings for the measurements.
fpga_set_tx_nco_pstep(&fpga, 64); // NCO phase increment
fpga_set_tx_nco_enable(&fpga, true); // TX enable
rf_path_set_direction(&rf_path, RF_PATH_DIRECTION_RX_CALIBRATION);
max2831_set_lna_gain(&max283x, 16);
max2831_set_vga_gain(&max283x, 36);
max2831_set_frequency(&max283x, 2500000000);
// Capture 1: 4 Msps, tone at 0.5 MHz, narrowband filter OFF
sample_rate_frac_set(4000000 * 2, 1);
delay_us_at_mhz(1000, 204);
if (rx_samples(num_samples, 2000000) == -1) {
timeout = true;
}
measure_tone(
(int8_t*) usb_bulk_buffer,
num_samples,
&selftest.xcvr_measurements[0]);
// Capture 2: 4 Msps, tone at 0.5 MHz, narrowband filter ON
narrowband_filter_set(1);
delay_us_at_mhz(1000, 204);
if (rx_samples(num_samples, 2000000) == -1) {
timeout = true;
}
measure_tone(
(int8_t*) usb_bulk_buffer,
num_samples,
&selftest.xcvr_measurements[1]);
// Capture 3: 20 Msps, tone at 5 MHz, narrowband filter OFF
fpga_set_tx_nco_pstep(&fpga, 255);
sample_rate_frac_set(20000000 * 2, 1);
narrowband_filter_set(0);
delay_us_at_mhz(1000, 204);
if (rx_samples(num_samples, 2000000) == -1) {
timeout = true;
}
measure_tone(
(int8_t*) usb_bulk_buffer,
num_samples,
&selftest.xcvr_measurements[2]);
// Capture 4: 20 Msps, tone at 5 MHz, narrowband filter ON
narrowband_filter_set(1);
delay_us_at_mhz(1000, 204);
if (rx_samples(num_samples, 2000000) == -1) {
timeout = true;
}
measure_tone(
(int8_t*) usb_bulk_buffer,
num_samples,
&selftest.xcvr_measurements[3]);
// Restore default settings.
sample_rate_set(10000000);
rf_path_set_direction(&rf_path, RF_PATH_DIRECTION_OFF);
narrowband_filter_set(0);
fpga_init(&fpga);
if (timeout) {
selftest.xcvr_loopback = TIMEOUT;
selftest.report.pass = false;
return false;
}
unsigned int expected_zcs;
bool i_in_range;
bool q_in_range;
bool i_energy_in_range;
bool q_energy_in_range;
// Capture 0:
// Count zero crossings.
// N/2 samples/channel * 2 zcs/cycle / 16 samples/cycle = N/16 zcs/channel
expected_zcs = num_samples / 16;
i_in_range = in_range(selftest.xcvr_measurements[0].zcs_i, expected_zcs, 5);
q_in_range = in_range(selftest.xcvr_measurements[0].zcs_q, expected_zcs, 5);
i_energy_in_range = (selftest.xcvr_measurements[0].avg_mag_sq_i > 500) &&
(selftest.xcvr_measurements[0].avg_mag_sq_i < 2500);
q_energy_in_range = (selftest.xcvr_measurements[0].avg_mag_sq_q > 500) &&
(selftest.xcvr_measurements[0].avg_mag_sq_q < 2500);
bool capture_0_test =
i_in_range && q_in_range && i_energy_in_range && q_energy_in_range;
// Capture 1:
// Count zero crossings.
expected_zcs = num_samples / 16;
i_in_range = in_range(selftest.xcvr_measurements[1].zcs_i, expected_zcs, 5);
q_in_range = in_range(selftest.xcvr_measurements[1].zcs_q, expected_zcs, 5);
i_energy_in_range = (selftest.xcvr_measurements[1].avg_mag_sq_i > 500) &&
(selftest.xcvr_measurements[1].avg_mag_sq_i < 2500);
q_energy_in_range = (selftest.xcvr_measurements[1].avg_mag_sq_q > 500) &&
(selftest.xcvr_measurements[1].avg_mag_sq_q < 2500);
bool capture_1_test =
i_in_range && q_in_range && i_energy_in_range && q_energy_in_range;
// Capture 2:
// Count zero crossings.
expected_zcs = num_samples / 4;
i_in_range = in_range(selftest.xcvr_measurements[2].zcs_i, expected_zcs, 5);
q_in_range = in_range(selftest.xcvr_measurements[2].zcs_q, expected_zcs, 5);
i_energy_in_range = (selftest.xcvr_measurements[2].avg_mag_sq_i > 400) &&
(selftest.xcvr_measurements[2].avg_mag_sq_i < 2000);
q_energy_in_range = (selftest.xcvr_measurements[2].avg_mag_sq_q > 400) &&
(selftest.xcvr_measurements[2].avg_mag_sq_q < 2000);
bool capture_2_test =
i_in_range && q_in_range && i_energy_in_range && q_energy_in_range;
// Capture 3:
i_energy_in_range = (selftest.xcvr_measurements[3].avg_mag_sq_i < 100);
q_energy_in_range = (selftest.xcvr_measurements[3].avg_mag_sq_q < 100);
bool capture_3_test = i_energy_in_range && q_energy_in_range;
// Update selftest result.
selftest.xcvr_loopback =
(capture_0_test && capture_1_test && capture_2_test && capture_3_test) ?
PASSED :
FAILED;
if (selftest.xcvr_loopback != PASSED) {
selftest.report.pass = false;
}
return selftest.xcvr_loopback == PASSED;
}

View File

@@ -1365,7 +1365,7 @@ void hw_sync_enable(const hw_sync_mode_t hw_sync_mode)
#ifndef PRALINE
gpio_write(sgpio_config.gpio_hw_sync_enable, hw_sync_mode == 1);
#else
fpga_hw_sync_enable(hw_sync_mode);
fpga_set_hw_sync_enable(&fpga, hw_sync_mode);
#endif
}

View File

@@ -78,6 +78,8 @@ if(BOARD STREQUAL "PRALINE")
SET(SRC_M4
${SRC_M4}
"${PATH_HACKRF_FIRMWARE_COMMON}/lz4_blk.c"
"${PATH_HACKRF_FIRMWARE_COMMON}/fpga_image.c"
"${PATH_HACKRF_FIRMWARE_COMMON}/fpga_selftest.c"
usb_api_praline.c
)
SET(OBJ_M4

View File

@@ -27,7 +27,6 @@
#include "usb_api_selftest.h"
#include "selftest.h"
#include "platform_detect.h"
#include "fpga.h"
static char* itoa(int val, int base)
{