|
|
|
@@ -1,6 +1,8 @@
|
|
|
|
|
//
|
|
|
|
|
// Created by MightyPork on 2018/02/04.
|
|
|
|
|
//
|
|
|
|
|
// The core functionality of the ADC unit is defined here.
|
|
|
|
|
//
|
|
|
|
|
|
|
|
|
|
#include "platform.h"
|
|
|
|
|
#include "unit_base.h"
|
|
|
|
@@ -11,6 +13,16 @@
|
|
|
|
|
|
|
|
|
|
#define DMA_POS(priv) ((priv)->buf_itemcount - (priv)->DMA_CHx->CNDTR)
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Async job to send a chunk of the DMA buffer to PC.
|
|
|
|
|
* This can't be done directly because the interrupt couldn't wait for the TinyFrame mutex.
|
|
|
|
|
*
|
|
|
|
|
* unit - unit
|
|
|
|
|
* data1 - start index
|
|
|
|
|
* data2 - number of samples to send
|
|
|
|
|
* data3 - bit flags: 0x80 if this is the last sample and we should close
|
|
|
|
|
* 0x01 if this was the TC interrupt (otherwise it's HT)
|
|
|
|
|
*/
|
|
|
|
|
static void UADC_JobSendBlockChunk(Job *job)
|
|
|
|
|
{
|
|
|
|
|
Unit *unit = job->unit;
|
|
|
|
@@ -21,9 +33,7 @@ static void UADC_JobSendBlockChunk(Job *job)
|
|
|
|
|
const bool close = (bool) (job->data3 & 0x80);
|
|
|
|
|
const bool tc = (bool) (job->data3 & 0x01);
|
|
|
|
|
|
|
|
|
|
// assert_param(count <= priv->buf_itemcount);
|
|
|
|
|
|
|
|
|
|
TF_TYPE type = close ? EVT_CAPT_DONE : EVT_CAPT_MORE;
|
|
|
|
|
const TF_TYPE type = close ? EVT_CAPT_DONE : EVT_CAPT_MORE;
|
|
|
|
|
|
|
|
|
|
TF_Msg msg = {
|
|
|
|
|
.frame_id = priv->stream_frame_id,
|
|
|
|
@@ -35,12 +45,22 @@ static void UADC_JobSendBlockChunk(Job *job)
|
|
|
|
|
TF_Multipart_Payload(comm, (uint8_t *) (priv->dma_buffer + start), count * sizeof(uint16_t));
|
|
|
|
|
TF_Multipart_Close(comm);
|
|
|
|
|
|
|
|
|
|
// Clear the "busy" flags - those are checked in the DMA ISR to detect overrun
|
|
|
|
|
if (tc) priv->tc_pending = false;
|
|
|
|
|
else priv->ht_pending = false;
|
|
|
|
|
|
|
|
|
|
priv->stream_serial++;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Async job to send the trigger header.
|
|
|
|
|
* The header includes info about the trigger + the pre-trigger buffer.
|
|
|
|
|
*
|
|
|
|
|
* data1 - index in the DMA buffer at which the captured data willl start
|
|
|
|
|
* data2 - edge type - 1 rise, 2 fall, 3 forced
|
|
|
|
|
* timestamp - event stamp
|
|
|
|
|
* unit - unit
|
|
|
|
|
*/
|
|
|
|
|
static void UADC_JobSendTriggerCaptureHeader(Job *job)
|
|
|
|
|
{
|
|
|
|
|
Unit *unit = job->unit;
|
|
|
|
@@ -50,7 +70,12 @@ static void UADC_JobSendTriggerCaptureHeader(Job *job)
|
|
|
|
|
.unit = unit,
|
|
|
|
|
.type = EVT_CAPT_START,
|
|
|
|
|
.timestamp = job->timestamp,
|
|
|
|
|
.length = (priv->pretrig_len+1) * priv->nb_channels * sizeof(uint16_t) + 4 /*pretrig len*/ + 1 /*edge*/ + 1 /* seq */
|
|
|
|
|
.length = (priv->pretrig_len + 1) * // see below why +1
|
|
|
|
|
priv->nb_channels *
|
|
|
|
|
sizeof(uint16_t) +
|
|
|
|
|
4 /*pretrig len*/ +
|
|
|
|
|
1 /*edge*/ +
|
|
|
|
|
1 /* seq */
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
uint32_t index_trigd = job->data1;
|
|
|
|
@@ -70,7 +95,9 @@ static void UADC_JobSendTriggerCaptureHeader(Job *job)
|
|
|
|
|
|
|
|
|
|
if (priv->pretrig_len > 0) {
|
|
|
|
|
// pretrig
|
|
|
|
|
uint32_t pretrig_remain = (priv->pretrig_len + 1) * priv->nb_channels; // +1 because we want pretrig 0 to exactly start with the triggering sample
|
|
|
|
|
|
|
|
|
|
// +1 because we want pretrig 0 to exactly start with the triggering sample
|
|
|
|
|
uint32_t pretrig_remain = (priv->pretrig_len + 1) * priv->nb_channels;
|
|
|
|
|
|
|
|
|
|
assert_param(index_trigd <= priv->buf_itemcount);
|
|
|
|
|
|
|
|
|
@@ -95,6 +122,9 @@ static void UADC_JobSendTriggerCaptureHeader(Job *job)
|
|
|
|
|
EventReport_End();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Async job to notify about end of stream
|
|
|
|
|
*/
|
|
|
|
|
static void UADC_JobSendEndOfStreamMsg(Job *job)
|
|
|
|
|
{
|
|
|
|
|
TF_Msg msg = {
|
|
|
|
@@ -104,6 +134,10 @@ static void UADC_JobSendEndOfStreamMsg(Job *job)
|
|
|
|
|
TF_Respond(comm, &msg);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Schedule sending a event report to the PC that the current stream has ended.
|
|
|
|
|
* The client library should handle this appropriately.
|
|
|
|
|
*/
|
|
|
|
|
void UADC_ReportEndOfStream(Unit *unit)
|
|
|
|
|
{
|
|
|
|
|
struct priv *priv = unit->data;
|
|
|
|
@@ -116,6 +150,15 @@ void UADC_ReportEndOfStream(Unit *unit)
|
|
|
|
|
scheduleJob(&j);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* This is a helper function for the ADC DMA interrupt for handing the different interrupt types (half / full transfer).
|
|
|
|
|
* It sends the part of the buffer that was just captured via an async job, or aborts on overrun.
|
|
|
|
|
*
|
|
|
|
|
* It's split off here to allow calling it for the different flags without repeating code.
|
|
|
|
|
*
|
|
|
|
|
* @param unit
|
|
|
|
|
* @param tc - true if this is the TC interrupt, else HT
|
|
|
|
|
*/
|
|
|
|
|
static void handle_httc(Unit *unit, bool tc)
|
|
|
|
|
{
|
|
|
|
|
struct priv *priv = unit->data;
|
|
|
|
@@ -134,8 +177,9 @@ static void handle_httc(Unit *unit, bool tc)
|
|
|
|
|
end = priv->buf_itemcount;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (start != end) {
|
|
|
|
|
if (start != end) { // this sometimes happened after a trigger, may be unnecessary now
|
|
|
|
|
if (end < start) {
|
|
|
|
|
// this was a trap for a bug with missed TC irq, it's hopefully fixed now
|
|
|
|
|
trap("end < start! %d < %d, tc %d", (int)end, (int)start, (int)tc);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
@@ -146,7 +190,8 @@ static void handle_httc(Unit *unit, bool tc)
|
|
|
|
|
priv->trig_stream_remain -= sgcount;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
bool close = !m_stream && priv->trig_stream_remain == 0;
|
|
|
|
|
// Check for the closing condition
|
|
|
|
|
const bool close = !m_stream && priv->trig_stream_remain == 0;
|
|
|
|
|
|
|
|
|
|
if ((tc && priv->tc_pending) || (ht && priv->ht_pending)) {
|
|
|
|
|
dbg("(!) ADC DMA not handled in time, abort capture");
|
|
|
|
@@ -176,13 +221,15 @@ static void handle_httc(Unit *unit, bool tc)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (close) {
|
|
|
|
|
// If auto-arm enabled, we need to re-arm again.
|
|
|
|
|
// However, EOS irq is disabled during the capture.
|
|
|
|
|
// We have to wait for the next EOS interrupt to occur.
|
|
|
|
|
// If auto-arm is enabled, we need to re-arm again.
|
|
|
|
|
// However, EOS irq is disabled during the capture so the trigger edge detection would
|
|
|
|
|
// work on stale data from before this trigger. We have to wait for the next full
|
|
|
|
|
// conversion (EOS) before arming.
|
|
|
|
|
UADC_SwitchMode(unit, (priv->auto_rearm && m_trigd) ? ADC_OPMODE_REARM_PENDING : ADC_OPMODE_IDLE);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Advance the starting position
|
|
|
|
|
if (tc) {
|
|
|
|
|
priv->stream_startpos = 0;
|
|
|
|
|
}
|
|
|
|
@@ -191,21 +238,38 @@ static void handle_httc(Unit *unit, bool tc)
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* IRQ handler for the DMA flags.
|
|
|
|
|
*
|
|
|
|
|
* We handle flags:
|
|
|
|
|
* TC - transfer complete
|
|
|
|
|
* HT - half transfer
|
|
|
|
|
* TE - transfer error (this should never happen unless there's a bug)
|
|
|
|
|
*
|
|
|
|
|
* The buffer works in a circular mode, so we always handle the previous half
|
|
|
|
|
* or what of it should be sent (if capture started somewhere inside).
|
|
|
|
|
*
|
|
|
|
|
* @param arg - the unit, passed via the irq dispatcher
|
|
|
|
|
*/
|
|
|
|
|
void UADC_DMA_Handler(void *arg)
|
|
|
|
|
{
|
|
|
|
|
Unit *unit = arg;
|
|
|
|
|
struct priv *priv = unit->data;
|
|
|
|
|
|
|
|
|
|
// First thing, grab the flags. They may change during the function.
|
|
|
|
|
// Working on the live register might cause race conditions.
|
|
|
|
|
const uint32_t isrsnapshot = priv->DMAx->ISR;
|
|
|
|
|
|
|
|
|
|
if (priv->opmode == ADC_OPMODE_UNINIT) {
|
|
|
|
|
// the IRQ occured while switching mode, clear flags and do nothing else
|
|
|
|
|
LL_DMA_ClearFlag_HT(priv->DMAx, priv->dma_chnum);
|
|
|
|
|
LL_DMA_ClearFlag_TC(priv->DMAx, priv->dma_chnum);
|
|
|
|
|
LL_DMA_ClearFlag_TE(priv->DMAx, priv->dma_chnum);
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
const uint32_t isrsnapshot = priv->DMAx->ISR;
|
|
|
|
|
|
|
|
|
|
if (LL_DMA_IsActiveFlag_G(isrsnapshot, priv->dma_chnum)) {
|
|
|
|
|
// we have some flags set - check which
|
|
|
|
|
const bool tc = LL_DMA_IsActiveFlag_TC(isrsnapshot, priv->dma_chnum);
|
|
|
|
|
const bool ht = LL_DMA_IsActiveFlag_HT(isrsnapshot, priv->dma_chnum);
|
|
|
|
|
const bool te = LL_DMA_IsActiveFlag_TE(isrsnapshot, priv->dma_chnum);
|
|
|
|
@@ -213,43 +277,52 @@ void UADC_DMA_Handler(void *arg)
|
|
|
|
|
if (ht) LL_DMA_ClearFlag_HT(priv->DMAx, priv->dma_chnum);
|
|
|
|
|
if (tc) LL_DMA_ClearFlag_TC(priv->DMAx, priv->dma_chnum);
|
|
|
|
|
|
|
|
|
|
if (te) {
|
|
|
|
|
// this shouldn't happen - error
|
|
|
|
|
adc_dbg("ADC DMA TE!");
|
|
|
|
|
LL_DMA_ClearFlag_TE(priv->DMAx, priv->dma_chnum);
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// check what mode we're in
|
|
|
|
|
const bool m_trigd = priv->opmode == ADC_OPMODE_TRIGD;
|
|
|
|
|
const bool m_stream = priv->opmode == ADC_OPMODE_STREAM;
|
|
|
|
|
const bool m_fixcpt = priv->opmode == ADC_OPMODE_BLCAP;
|
|
|
|
|
|
|
|
|
|
if (m_trigd || m_stream || m_fixcpt) {
|
|
|
|
|
if (ht || tc) {
|
|
|
|
|
const uint32_t half = (uint32_t) (priv->buf_itemcount / 2);
|
|
|
|
|
if (ht && tc) {
|
|
|
|
|
if (priv->stream_startpos > half) {
|
|
|
|
|
handle_httc(unit, true); // TC
|
|
|
|
|
handle_httc(unit, false); // HT
|
|
|
|
|
} else {
|
|
|
|
|
handle_httc(unit, false); // HT
|
|
|
|
|
handle_httc(unit, true); // TC
|
|
|
|
|
}
|
|
|
|
|
const uint32_t half = (uint32_t) (priv->buf_itemcount / 2);
|
|
|
|
|
if (ht && tc) {
|
|
|
|
|
// dual event interrupt - may happen if we missed both and they were pending after
|
|
|
|
|
// interrupts became enabled again (this can happen due to the EOS or other higher prio irq's)
|
|
|
|
|
|
|
|
|
|
if (priv->stream_startpos > half) {
|
|
|
|
|
handle_httc(unit, true); // TC
|
|
|
|
|
handle_httc(unit, false); // HT
|
|
|
|
|
} else {
|
|
|
|
|
if (ht && priv->stream_startpos > half) {
|
|
|
|
|
// We missed the TC interrupt while e.g. setting up the stream / interrupt. catch up!
|
|
|
|
|
handle_httc(unit, true); // TC
|
|
|
|
|
}
|
|
|
|
|
handle_httc(unit, tc);
|
|
|
|
|
handle_httc(unit, false); // HT
|
|
|
|
|
handle_httc(unit, true); // TC
|
|
|
|
|
}
|
|
|
|
|
} else {
|
|
|
|
|
if (ht && priv->stream_startpos > half) {
|
|
|
|
|
// We missed the TC interrupt while e.g. setting up the stream / interrupt. catch up!
|
|
|
|
|
// This fixes a bug with "negative size" for report.
|
|
|
|
|
handle_httc(unit, true); // TC
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
handle_httc(unit, tc);
|
|
|
|
|
}
|
|
|
|
|
} else {
|
|
|
|
|
// This shouldn't happen, the interrupt should be disabled in this opmode
|
|
|
|
|
dbg("(!) not streaming, ADC DMA IT should be disabled");
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (te) {
|
|
|
|
|
// this shouldn't happen - error
|
|
|
|
|
adc_dbg("ADC DMA TE!");
|
|
|
|
|
LL_DMA_ClearFlag_TE(priv->DMAx, priv->dma_chnum);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* End of measurement group interrupt handler.
|
|
|
|
|
* This interrupt records the measured values and checks for trigger.
|
|
|
|
|
*
|
|
|
|
|
* @param arg - unit, passed b y irq dispatcher
|
|
|
|
|
*/
|
|
|
|
|
void UADC_ADC_EOS_Handler(void *arg)
|
|
|
|
|
{
|
|
|
|
|
Unit *unit = arg;
|
|
|
|
@@ -299,11 +372,11 @@ void UADC_ADC_EOS_Handler(void *arg)
|
|
|
|
|
|
|
|
|
|
if ((priv->trig_prev_level < priv->trig_level) && val >= priv->trig_level && (bool) (priv->trig_edge & 0b01)) {
|
|
|
|
|
// Rising edge
|
|
|
|
|
UADC_HandleTrigger(unit, 1, timestamp);
|
|
|
|
|
UADC_HandleTrigger(unit, 0b01, timestamp);
|
|
|
|
|
}
|
|
|
|
|
else if ((priv->trig_prev_level > priv->trig_level) && val <= priv->trig_level && (bool) (priv->trig_edge & 0b10)) {
|
|
|
|
|
// Falling edge
|
|
|
|
|
UADC_HandleTrigger(unit, 2, timestamp);
|
|
|
|
|
UADC_HandleTrigger(unit, 0b10, timestamp);
|
|
|
|
|
}
|
|
|
|
|
priv->trig_prev_level = val;
|
|
|
|
|
}
|
|
|
|
@@ -321,6 +394,13 @@ void UADC_ADC_EOS_Handler(void *arg)
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Handle a detected trigger - start capture if we're not in hold-off
|
|
|
|
|
*
|
|
|
|
|
* @param unit
|
|
|
|
|
* @param edge_type - edge type, is included in the report
|
|
|
|
|
* @param timestamp - event time
|
|
|
|
|
*/
|
|
|
|
|
void UADC_HandleTrigger(Unit *unit, uint8_t edge_type, uint64_t timestamp)
|
|
|
|
|
{
|
|
|
|
|
struct priv *priv = unit->data;
|
|
|
|
@@ -342,6 +422,7 @@ void UADC_HandleTrigger(Unit *unit, uint8_t edge_type, uint64_t timestamp)
|
|
|
|
|
priv->trig_stream_remain = priv->trig_len;
|
|
|
|
|
priv->stream_serial = 0;
|
|
|
|
|
|
|
|
|
|
// This func may be called from the EOS interrupt, so it's safer to send the header message asynchronously
|
|
|
|
|
Job j = {
|
|
|
|
|
.unit = unit,
|
|
|
|
|
.timestamp = timestamp,
|
|
|
|
@@ -354,6 +435,9 @@ void UADC_HandleTrigger(Unit *unit, uint8_t edge_type, uint64_t timestamp)
|
|
|
|
|
UADC_SwitchMode(unit, ADC_OPMODE_TRIGD);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Abort ongoing capture.
|
|
|
|
|
*/
|
|
|
|
|
void UADC_AbortCapture(Unit *unit)
|
|
|
|
|
{
|
|
|
|
|
struct priv *priv = unit->data;
|
|
|
|
@@ -371,6 +455,13 @@ void UADC_AbortCapture(Unit *unit)
|
|
|
|
|
UADC_SwitchMode(unit, ADC_OPMODE_IDLE);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Start a manual block capture.
|
|
|
|
|
*
|
|
|
|
|
* @param unit
|
|
|
|
|
* @param len - number of samples (groups)
|
|
|
|
|
* @param frame_id - TF session to re-use for the report (client has a listener set up)
|
|
|
|
|
*/
|
|
|
|
|
void UADC_StartBlockCapture(Unit *unit, uint32_t len, TF_ID frame_id)
|
|
|
|
|
{
|
|
|
|
|
struct priv *priv = unit->data;
|
|
|
|
@@ -383,7 +474,11 @@ void UADC_StartBlockCapture(Unit *unit, uint32_t len, TF_ID frame_id)
|
|
|
|
|
UADC_SwitchMode(unit, ADC_OPMODE_BLCAP);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/** Start stream */
|
|
|
|
|
/**
|
|
|
|
|
* Start a stream
|
|
|
|
|
*
|
|
|
|
|
* @param frame_id - TF session to re-use for the frames (client has a listener set up)
|
|
|
|
|
*/
|
|
|
|
|
void UADC_StartStream(Unit *unit, TF_ID frame_id)
|
|
|
|
|
{
|
|
|
|
|
struct priv *priv = unit->data;
|
|
|
|
@@ -393,7 +488,9 @@ void UADC_StartStream(Unit *unit, TF_ID frame_id)
|
|
|
|
|
UADC_SwitchMode(unit, ADC_OPMODE_STREAM);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/** End stream */
|
|
|
|
|
/**
|
|
|
|
|
* End a stream by user request.
|
|
|
|
|
*/
|
|
|
|
|
void UADC_StopStream(Unit *unit)
|
|
|
|
|
{
|
|
|
|
|
struct priv *priv = unit->data;
|
|
|
|
@@ -403,7 +500,10 @@ void UADC_StopStream(Unit *unit)
|
|
|
|
|
UADC_SwitchMode(unit, ADC_OPMODE_IDLE);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/** Handle unit update tick - expire the trigger hold-off */
|
|
|
|
|
/**
|
|
|
|
|
* Handle unit update tick - expire the trigger hold-off.
|
|
|
|
|
* We also check for the emergency shutdown condition and clear it.
|
|
|
|
|
*/
|
|
|
|
|
void UADC_updateTick(Unit *unit)
|
|
|
|
|
{
|
|
|
|
|
struct priv *priv = unit->data;
|
|
|
|
@@ -429,12 +529,17 @@ void UADC_updateTick(Unit *unit)
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* Switch the ADC operational mode.
|
|
|
|
|
*
|
|
|
|
|
* @param unit
|
|
|
|
|
* @param new_mode - mode to set
|
|
|
|
|
*/
|
|
|
|
|
void UADC_SwitchMode(Unit *unit, enum uadc_opmode new_mode)
|
|
|
|
|
{
|
|
|
|
|
struct priv *priv = unit->data;
|
|
|
|
|
|
|
|
|
|
const enum uadc_opmode old_mode = priv->opmode;
|
|
|
|
|
|
|
|
|
|
if (new_mode == old_mode) return; // nothing to do
|
|
|
|
|
|
|
|
|
|
// if un-itied, can go only to IDLE
|
|
|
|
@@ -520,10 +625,9 @@ void UADC_SwitchMode(Unit *unit, enum uadc_opmode new_mode)
|
|
|
|
|
// avoid firing immediately by the value jumping across the scale
|
|
|
|
|
priv->trig_prev_level = priv->last_samples[priv->trigger_source];
|
|
|
|
|
}
|
|
|
|
|
else if (new_mode == ADC_OPMODE_TRIGD ||
|
|
|
|
|
new_mode == ADC_OPMODE_STREAM ||
|
|
|
|
|
new_mode == ADC_OPMODE_BLCAP) {
|
|
|
|
|
else if (new_mode == ADC_OPMODE_TRIGD || new_mode == ADC_OPMODE_STREAM || new_mode == ADC_OPMODE_BLCAP) {
|
|
|
|
|
adc_dbg("ADC switch -> CAPTURE");
|
|
|
|
|
|
|
|
|
|
assert_param(old_mode == ADC_OPMODE_ARMED || old_mode == ADC_OPMODE_IDLE);
|
|
|
|
|
|
|
|
|
|
// during the capture, we disallow direct readout and averaging to reduce overhead
|
|
|
|
|