2020-12-09 20:44:26 +08:00
|
|
|
///! ADC sample timestamper using external Pounder reference clock.
|
2021-01-06 21:42:36 +08:00
|
|
|
///!
|
|
|
|
///! # Design
|
|
|
|
///!
|
|
|
|
///! The pounder timestamper utilizes the pounder SYNC_CLK output as a fast external reference clock
|
|
|
|
///! for recording a timestamp for each of the ADC samples.
|
|
|
|
///!
|
|
|
|
///! To accomplish this, a timer peripheral is configured to be driven by an external clock input.
|
|
|
|
///! Due to the limitations of clock frequencies allowed by the timer peripheral, the SYNC_CLK input
|
|
|
|
///! is divided by 4. This clock then clocks the timer peripheral in a free-running mode with an ARR
|
|
|
|
///! (max count register value) configured to overflow once per ADC sample batch.
|
|
|
|
///!
|
|
|
|
///! Once the timer is configured, an input capture is configured to record the timer count
|
|
|
|
///! register. The input capture is configured to utilize an internal trigger for the input capture.
|
|
|
|
///! The internal trigger is selected such that when a sample is generated on ADC0, the input
|
|
|
|
///! capture is simultaneously triggered. This results in the input capture triggering identically
|
|
|
|
///! to when the ADC samples the input.
|
|
|
|
///!
|
|
|
|
///! Once the input capture is properly configured, a DMA transfer is configured to collect all of
|
|
|
|
///! timestamps. The DMA transfer collects 1 timestamp for each ADC sample collected. In order to
|
|
|
|
///! avoid potentially losing a timestamp for a sample, the DMA transfer operates in double-buffer
|
|
|
|
///! mode. As soon as the DMA transfer completes, the hardware automatically swaps over to a second
|
|
|
|
///! buffer to continue capturing. This alleviates timing sensitivities of the DMA transfer
|
|
|
|
///! schedule.
|
2020-12-09 20:44:26 +08:00
|
|
|
use stm32h7xx_hal as hal;
|
|
|
|
|
2020-12-10 01:19:33 +08:00
|
|
|
use hal::dma::{dma::DmaConfig, PeripheralToMemory, Transfer};
|
2020-12-09 20:44:26 +08:00
|
|
|
|
2021-02-04 20:36:24 +08:00
|
|
|
use crate::hardware::{design_parameters::SAMPLE_BUFFER_SIZE, timers};
|
2020-12-09 20:44:26 +08:00
|
|
|
|
2021-01-06 21:42:36 +08:00
|
|
|
// Three buffers are required for double buffered mode - 2 are owned by the DMA stream and 1 is the
|
|
|
|
// working data provided to the application. These buffers must exist in a DMA-accessible memory
|
|
|
|
// region. Note that AXISRAM is not initialized on boot, so their initial contents are undefined.
|
2020-12-09 20:44:26 +08:00
|
|
|
#[link_section = ".axisram.buffers"]
|
|
|
|
static mut BUF: [[u16; SAMPLE_BUFFER_SIZE]; 3] = [[0; SAMPLE_BUFFER_SIZE]; 3];
|
|
|
|
|
2021-01-06 21:42:36 +08:00
|
|
|
/// Software unit to timestamp stabilizer ADC samples using an external pounder reference clock.
|
2020-12-09 20:44:26 +08:00
|
|
|
pub struct Timestamper {
|
|
|
|
next_buffer: Option<&'static mut [u16; SAMPLE_BUFFER_SIZE]>,
|
2020-12-10 01:19:33 +08:00
|
|
|
timer: timers::PounderTimestampTimer,
|
2020-12-09 20:44:26 +08:00
|
|
|
transfer: Transfer<
|
2021-01-11 19:31:15 +08:00
|
|
|
hal::dma::dma::Stream0<hal::stm32::DMA2>,
|
2020-12-10 01:19:33 +08:00
|
|
|
timers::tim8::Channel1InputCapture,
|
2020-12-09 20:44:26 +08:00
|
|
|
PeripheralToMemory,
|
|
|
|
&'static mut [u16; SAMPLE_BUFFER_SIZE],
|
2021-02-03 20:25:00 +08:00
|
|
|
hal::dma::DBTransfer,
|
2020-12-09 20:44:26 +08:00
|
|
|
>,
|
|
|
|
}
|
|
|
|
|
|
|
|
impl Timestamper {
|
2021-01-06 21:42:36 +08:00
|
|
|
/// Construct the pounder sample timestamper.
|
|
|
|
///
|
|
|
|
/// # Note
|
|
|
|
/// The DMA is immediately configured after instantiation. It will not collect any samples
|
|
|
|
/// until the sample timer begins to cause input capture triggers.
|
|
|
|
///
|
|
|
|
/// # Args
|
|
|
|
/// * `timestamp_timer` - The timer peripheral used for capturing timestamps from.
|
|
|
|
/// * `stream` - The DMA stream to use for collecting timestamps.
|
|
|
|
/// * `capture_channel` - The input capture channel for collecting timestamps.
|
|
|
|
/// * `sampling_timer` - The stabilizer ADC sampling timer.
|
|
|
|
/// * `_clock_input` - The input pin for the external clock from Pounder.
|
|
|
|
///
|
|
|
|
/// # Returns
|
|
|
|
/// The new pounder timestamper in an operational state.
|
2020-12-09 20:44:26 +08:00
|
|
|
pub fn new(
|
2020-12-10 01:19:33 +08:00
|
|
|
mut timestamp_timer: timers::PounderTimestampTimer,
|
2021-01-11 19:31:15 +08:00
|
|
|
stream: hal::dma::dma::Stream0<hal::stm32::DMA2>,
|
2020-12-10 01:19:33 +08:00
|
|
|
capture_channel: timers::tim8::Channel1,
|
|
|
|
sampling_timer: &mut timers::SamplingTimer,
|
|
|
|
_clock_input: hal::gpio::gpioa::PA0<
|
|
|
|
hal::gpio::Alternate<hal::gpio::AF3>,
|
|
|
|
>,
|
2020-12-09 20:44:26 +08:00
|
|
|
) -> Self {
|
|
|
|
let config = DmaConfig::default()
|
|
|
|
.memory_increment(true)
|
|
|
|
.circular_buffer(true)
|
|
|
|
.double_buffer(true);
|
|
|
|
|
2020-12-10 01:19:33 +08:00
|
|
|
// The sampling timer should generate a trigger output when CH1 comparison occurs.
|
|
|
|
sampling_timer.generate_trigger(timers::TriggerGenerator::ComparePulse);
|
|
|
|
|
|
|
|
// The timestamp timer trigger input should use TIM2 (SamplingTimer)'s trigger, which is
|
|
|
|
// mapped to ITR1.
|
|
|
|
timestamp_timer.set_trigger_source(timers::TriggerSource::Trigger1);
|
|
|
|
|
|
|
|
// The capture channel should capture whenever the trigger input occurs.
|
|
|
|
let input_capture = capture_channel
|
2021-02-03 21:11:00 +08:00
|
|
|
.into_input_capture(timers::tim8::CaptureSource1::TRC);
|
2020-12-10 01:19:33 +08:00
|
|
|
input_capture.listen_dma();
|
|
|
|
|
2020-12-09 20:44:26 +08:00
|
|
|
// The data transfer is always a transfer of data from the peripheral to a RAM buffer.
|
2021-02-03 20:25:00 +08:00
|
|
|
let data_transfer: Transfer<_, _, PeripheralToMemory, _, _> =
|
2020-12-09 20:44:26 +08:00
|
|
|
Transfer::init(
|
|
|
|
stream,
|
2020-12-10 01:19:33 +08:00
|
|
|
input_capture,
|
2021-01-06 21:42:36 +08:00
|
|
|
// Note(unsafe): BUF[0] and BUF[1] are "owned" by this peripheral.
|
|
|
|
// They shall not be used anywhere else in the module.
|
2020-12-09 20:44:26 +08:00
|
|
|
unsafe { &mut BUF[0] },
|
|
|
|
unsafe { Some(&mut BUF[1]) },
|
|
|
|
config,
|
|
|
|
);
|
|
|
|
|
|
|
|
Self {
|
2020-12-10 01:19:33 +08:00
|
|
|
timer: timestamp_timer,
|
2020-12-09 20:44:26 +08:00
|
|
|
transfer: data_transfer,
|
2021-01-06 21:42:36 +08:00
|
|
|
|
|
|
|
// Note(unsafe): BUF[2] is "owned" by this peripheral. It shall not be used anywhere
|
|
|
|
// else in the module.
|
2020-12-09 20:44:26 +08:00
|
|
|
next_buffer: unsafe { Some(&mut BUF[2]) },
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-01-18 23:47:47 +08:00
|
|
|
/// Start the DMA transfer for collecting timestamps.
|
2021-01-19 00:23:21 +08:00
|
|
|
#[allow(dead_code)]
|
2021-01-18 23:47:47 +08:00
|
|
|
pub fn start(&mut self) {
|
|
|
|
self.transfer
|
|
|
|
.start(|capture_channel| capture_channel.enable());
|
|
|
|
}
|
|
|
|
|
2021-01-06 21:42:36 +08:00
|
|
|
/// Update the period of the underlying timestamp timer.
|
2021-01-19 00:23:21 +08:00
|
|
|
#[allow(dead_code)]
|
2020-12-09 20:44:26 +08:00
|
|
|
pub fn update_period(&mut self, period: u16) {
|
2021-01-06 20:34:55 +08:00
|
|
|
self.timer.set_period_ticks(period);
|
2020-12-09 20:44:26 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/// Obtain a buffer filled with timestamps.
|
|
|
|
///
|
|
|
|
/// # Returns
|
|
|
|
/// A reference to the underlying buffer that has been filled with timestamps.
|
2021-01-19 00:23:21 +08:00
|
|
|
#[allow(dead_code)]
|
2020-12-09 20:44:26 +08:00
|
|
|
pub fn acquire_buffer(&mut self) -> &[u16; SAMPLE_BUFFER_SIZE] {
|
|
|
|
// Wait for the transfer to fully complete before continuing.
|
|
|
|
// Note: If a device hangs up, check that this conditional is passing correctly, as there is
|
|
|
|
// no time-out checks here in the interest of execution speed.
|
|
|
|
while !self.transfer.get_transfer_complete_flag() {}
|
|
|
|
|
|
|
|
let next_buffer = self.next_buffer.take().unwrap();
|
|
|
|
|
|
|
|
// Start the next transfer.
|
|
|
|
let (prev_buffer, _, _) =
|
|
|
|
self.transfer.next_transfer(next_buffer).unwrap();
|
|
|
|
|
|
|
|
self.next_buffer.replace(prev_buffer); // .unwrap_none() https://github.com/rust-lang/rust/issues/62633
|
|
|
|
|
|
|
|
self.next_buffer.as_ref().unwrap()
|
|
|
|
}
|
|
|
|
}
|