mirror of https://github.com/ArduPilot/ardupilot
HAL_ChibiOS: reduce the impact of UART DMA contention
this changes the heuristics for UART TX DMA allocation to greatly reduce the chances of DMA contention causing long delays on other devices This fixes issues with FETTec driver output and gimbal status messages as reported by Amilcar and OlliW. The problem is particularly bad when no GPS is connected to GPS1 on fmuv3 and derived boards (such as CubeBlack) key changes: - remember the contention_counter across begin() calls, as the GPS calls begin with new baudrates regularly - added a is_shared() API to Shared_DMA, allowing the UART driver to avoid TX DMA on shared streams when at low baudrates.
This commit is contained in:
parent
dc252aa8f5
commit
39f44147b8
|
@ -80,6 +80,13 @@ static const eventmask_t EVT_TRANSMIT_UNBUFFERED = EVENT_MASK(3);
|
|||
#define HAL_UART_RX_STACK_SIZE 768
|
||||
#endif
|
||||
|
||||
// threshold for disabling TX DMA due to contention
|
||||
#if defined(USART_CR1_FIFOEN)
|
||||
#define CONTENTION_BAUD_THRESHOLD 460800
|
||||
#else
|
||||
#define CONTENTION_BAUD_THRESHOLD 115200
|
||||
#endif
|
||||
|
||||
UARTDriver::UARTDriver(uint8_t _serial_num) :
|
||||
serial_num(_serial_num),
|
||||
sdef(_serial_tab[_serial_num]),
|
||||
|
@ -306,6 +313,15 @@ void UARTDriver::begin(uint32_t b, uint16_t rxS, uint16_t txS)
|
|||
rx_dma_enabled = rx_bounce_buf[0] != nullptr && rx_bounce_buf[1] != nullptr;
|
||||
tx_dma_enabled = tx_bounce_buf != nullptr;
|
||||
}
|
||||
if (contention_counter > 1000 && _baudrate <= CONTENTION_BAUD_THRESHOLD) {
|
||||
// we've previously disabled TX DMA due to contention, don't
|
||||
// re-enable on a new begin() unless high baudrate
|
||||
tx_dma_enabled = false;
|
||||
}
|
||||
if (_baudrate <= 115200 && sdef.dma_tx && Shared_DMA::is_shared(sdef.dma_tx_stream_id)) {
|
||||
// avoid DMA on shared low-baudrate links
|
||||
tx_dma_enabled = false;
|
||||
}
|
||||
#endif
|
||||
|
||||
#if defined(USART_CR1_FIFOEN)
|
||||
|
@ -374,7 +390,9 @@ void UARTDriver::begin(uint32_t b, uint16_t rxS, uint16_t txS)
|
|||
dmaSetRequestSource(rxdma, sdef.dma_rx_channel_id);
|
||||
#endif
|
||||
}
|
||||
if (tx_dma_enabled) {
|
||||
_device_initialised = true;
|
||||
}
|
||||
if (tx_dma_enabled && dma_handle == nullptr) {
|
||||
// we only allow for sharing of the TX DMA channel, not the RX
|
||||
// DMA channel, as the RX side is active all the time, so
|
||||
// cannot be shared
|
||||
|
@ -382,8 +400,9 @@ void UARTDriver::begin(uint32_t b, uint16_t rxS, uint16_t txS)
|
|||
SHARED_DMA_NONE,
|
||||
FUNCTOR_BIND_MEMBER(&UARTDriver::dma_tx_allocate, void, Shared_DMA *),
|
||||
FUNCTOR_BIND_MEMBER(&UARTDriver::dma_tx_deallocate, void, Shared_DMA *));
|
||||
if (dma_handle == nullptr) {
|
||||
tx_dma_enabled = false;
|
||||
}
|
||||
_device_initialised = true;
|
||||
}
|
||||
#endif // HAL_UART_NODMA
|
||||
sercfg.speed = _baudrate;
|
||||
|
@ -935,12 +954,7 @@ void UARTDriver::write_pending_bytes_DMA(uint32_t n)
|
|||
|
||||
if (dma_handle->has_contention()) {
|
||||
// on boards with a hw fifo we can use a higher threshold for disabling DMA
|
||||
#if defined(USART_CR1_FIFOEN)
|
||||
const uint32_t baud_threshold = 460800;
|
||||
#else
|
||||
const uint32_t baud_threshold = 115200;
|
||||
#endif
|
||||
if (_baudrate <= baud_threshold) {
|
||||
if (_baudrate <= CONTENTION_BAUD_THRESHOLD) {
|
||||
contention_counter += 3;
|
||||
if (contention_counter > 1000) {
|
||||
// more than 25% of attempts to use this DMA
|
||||
|
|
|
@ -438,11 +438,15 @@ def write_dma_header(f, peripheral_list, mcu_type, dma_exclude=[],
|
|||
for key in ordered_up_channels:
|
||||
ordered_timers.append(key[0:-3])
|
||||
|
||||
shared_set = set()
|
||||
|
||||
for key in sorted(curr_dict.keys()):
|
||||
stream = curr_dict[key]
|
||||
shared = ''
|
||||
if len(stream_assign[stream]) > 1:
|
||||
shared = ' // shared %s' % ','.join(stream_assign[stream])
|
||||
if stream[0] in [1,2]:
|
||||
shared_set.add("(1U<<STM32_DMA_STREAM_ID(%u,%u))" % (stream[0],stream[1]))
|
||||
if curr_dict[key] == "STM32_DMA_STREAM_ID_ANY":
|
||||
f.write("#define %-30s STM32_DMA_STREAM_ID_ANY\n" % (chibios_dma_define_name(key)+'STREAM'))
|
||||
f.write("#define %-30s %s\n" % (chibios_dma_define_name(key)+'CHAN', dmamux_channel(key)))
|
||||
|
@ -486,6 +490,12 @@ def write_dma_header(f, peripheral_list, mcu_type, dma_exclude=[],
|
|||
chan.replace('_UP', '_CH{}'.format(ch))))
|
||||
break
|
||||
|
||||
f.write("\n// Mask of DMA streams which are shared\n")
|
||||
if len(shared_set) == 0:
|
||||
f.write("#define SHARED_DMA_MASK 0\n")
|
||||
else:
|
||||
f.write("#define SHARED_DMA_MASK (%s)\n" % '|'.join(list(shared_set)))
|
||||
|
||||
# now generate UARTDriver.cpp DMA config lines
|
||||
f.write("\n\n// generated UART DMA configuration lines\n")
|
||||
for u in range(1, 9):
|
||||
|
|
|
@ -53,6 +53,14 @@ Shared_DMA::Shared_DMA(uint8_t _stream_id1,
|
|||
deallocate = _deallocate;
|
||||
}
|
||||
|
||||
/*
|
||||
return true if a stream ID is shared between two peripherals
|
||||
*/
|
||||
bool Shared_DMA::is_shared(uint8_t stream_id)
|
||||
{
|
||||
return (stream_id < SHARED_DMA_MAX_STREAM_ID) && ((1U<<stream_id) & SHARED_DMA_MASK) != 0;
|
||||
}
|
||||
|
||||
//remove any assigned deallocator or allocator
|
||||
void Shared_DMA::unregister()
|
||||
{
|
||||
|
|
|
@ -67,6 +67,9 @@ public:
|
|||
// display dma contention statistics as text buffer for @SYS/dma.txt
|
||||
static void dma_info(ExpandingString &str);
|
||||
|
||||
// return true if a stream ID is shared between two peripherals
|
||||
static bool is_shared(uint8_t stream_id);
|
||||
|
||||
private:
|
||||
dma_allocate_fn_t allocate;
|
||||
dma_allocate_fn_t deallocate;
|
||||
|
|
Loading…
Reference in New Issue