wt/mongoose
1
0 Fork 0
mirror of https://github.com/cesanta/mongoose.git synced 2026-11-08 16:11:18 +00:00
Code Issues Packages Projects Releases Wiki Activity

Improve STM32 driver

Browse Source
This commit is contained in:
Sergio R. Caprile committed 2022-12-02 19:47:29 -03:00
1 parent 751413f050
commit d059d2cda4
3 files changed
+51 -36
Download Patch File Download Diff File Expand all files Collapse all files

No files matched your search

examples/stm32/nucleo-f429zi-freertos-mip/Makefile
+3 -2
View File
@@ -14,13 +14,14 @@ FREERTOS_REPO ?= https://github.com/FreeRTOS/FreeRTOS-Kernel
build example: firmware.elf build example: firmware.elf
firmware.elf: FreeRTOS-Kernel $(SOURCES) firmware.elf: FreeRTOS-Kernel $(SOURCES)
$(DOCKER) arm-none-eabi-gcc -o $@ $(SOURCES) $(CFLAGS) $(LDFLAGS) \ $(DOCKER) arm-none-eabi-gcc -o $@ $(SOURCES) $(CFLAGS) \
-IFreeRTOS-Kernel/include \ -IFreeRTOS-Kernel/include \
-IFreeRTOS-Kernel/portable/GCC/ARM_CM4F \ -IFreeRTOS-Kernel/portable/GCC/ARM_CM4F \
-Wno-conversion \ -Wno-conversion \
$(wildcard FreeRTOS-Kernel/*.c) \ $(wildcard FreeRTOS-Kernel/*.c) \
FreeRTOS-Kernel/portable/MemMang/heap_4.c \ FreeRTOS-Kernel/portable/MemMang/heap_4.c \
FreeRTOS-Kernel/portable/GCC/ARM_CM4F/port.c FreeRTOS-Kernel/portable/GCC/ARM_CM4F/port.c \
$(LDFLAGS)
firmware.bin: firmware.elf firmware.bin: firmware.elf
$(DOCKER) arm-none-eabi-objcopy -O binary $< $@ $(DOCKER) arm-none-eabi-objcopy -O binary $< $@
mip/driver_stm32.c
+24 -17
View File
@@ -1,6 +1,7 @@
#include "mip.h" #include "mip.h"
#if MG_ENABLE_MIP && (!defined(MG_ENABLE_DRIVER_TM4C) || MG_ENABLE_DRIVER_TM4C == 0) #if MG_ENABLE_MIP && \
(!defined(MG_ENABLE_DRIVER_TM4C) || MG_ENABLE_DRIVER_TM4C == 0)
struct stm32_eth { struct stm32_eth {
volatile uint32_t MACCR, MACFFR, MACHTHR, MACHTLR, MACMIIAR, MACMIIDR, MACFCR, volatile uint32_t MACCR, MACFFR, MACHTHR, MACHTLR, MACMIIAR, MACMIIDR, MACFCR,
MACVLANTR, RESERVED0[2], MACRWUFFR, MACPMTCSR, RESERVED1, MACDBGR, MACSR, MACVLANTR, RESERVED0[2], MACRWUFFR, MACPMTCSR, RESERVED1, MACDBGR, MACSR,
@@ -156,10 +157,11 @@ static void mip_driver_stm32_setrx(void (*rx)(void *, size_t, void *),
static uint32_t s_txno; static uint32_t s_txno;
static size_t mip_driver_stm32_tx(const void *buf, size_t len, void *userdata) { static size_t mip_driver_stm32_tx(const void *buf, size_t len, void *userdata) {
if (len > sizeof(s_txbuf[s_txno])) { if (len > sizeof(s_txbuf[s_txno])) {
printf("%s: frame too big, %ld\n", __func__, (long) len); MG_ERROR(("Frame too big, %ld", (long) len));
len = 0; // Frame is too big len = 0; // Frame is too big
} else if ((s_txdesc[s_txno][0] & BIT(31))) { } else if ((s_txdesc[s_txno][0] & BIT(31))) {
printf("%s: no free descr\n", __func__); MG_ERROR(("No free descriptors"));
// printf("D0 %lx SR %lx\n", (long) s_txdesc[0][0], (long) ETH->DMASR);
len = 0; // All descriptors are busy, fail len = 0; // All descriptors are busy, fail
} else { } else {
memcpy(s_txbuf[s_txno], buf, len); // Copy data memcpy(s_txbuf[s_txno], buf, len); // Copy data
@@ -168,10 +170,8 @@ static size_t mip_driver_stm32_tx(const void *buf, size_t len, void *userdata) {
s_txdesc[s_txno][0] |= BIT(31); // Set OWN bit - let DMA take over s_txdesc[s_txno][0] |= BIT(31); // Set OWN bit - let DMA take over
if (++s_txno >= ETH_DESC_CNT) s_txno = 0; if (++s_txno >= ETH_DESC_CNT) s_txno = 0;
} }
uint32_t sr = ETH->DMASR; ETH->DMASR = BIT(2) | BIT(5); // Clear any prior TBUS/TUS
if (sr & BIT(2)) ETH->DMASR = BIT(2), ETH->DMATPDR = 0; // Resume ETH->DMATPDR = 0; // and resume
if (sr & BIT(5)) ETH->DMASR = BIT(5), ETH->DMATPDR = 0; // if busy
if (len == 0) printf("E: D0 %lx SR %lx\n", (long) s_txdesc[0][0], (long) sr);
return len; return len;
(void) userdata; (void) userdata;
} }
@@ -183,20 +183,27 @@ static bool mip_driver_stm32_up(void *userdata) {
} }
void ETH_IRQHandler(void); void ETH_IRQHandler(void);
static uint32_t s_rxno;
void ETH_IRQHandler(void) { void ETH_IRQHandler(void) {
qp_mark(QP_IRQTRIGGERED, 0); qp_mark(QP_IRQTRIGGERED, 0);
volatile uint32_t sr = ETH->DMASR; if (ETH->DMASR & BIT(6)) { // Frame received, loop
if (sr & BIT(6)) { // Frame received, loop ETH->DMASR = BIT(16) | BIT(6); // Clear flag
for (uint32_t i = 0; i < ETH_DESC_CNT; i++) { for (uint32_t i = 0; i < 10; i++) { // read as they arrive but not forever
if (s_rxdesc[i][0] & BIT(31)) continue; if (s_rxdesc[s_rxno][0] & BIT(31)) break; // exit when done
uint32_t len = ((s_rxdesc[i][0] >> 16) & (BIT(14) - 1)); if (((s_rxdesc[s_rxno][0] & (BIT(8) | BIT(9))) == (BIT(8) | BIT(9))) &&
// printf("%lx %lu %lx %lx\n", i, len, s_rxdesc[i][0], sr); !(s_rxdesc[s_rxno][0] & BIT(15))) { // skip partial/errored frames
if (s_rx != NULL) s_rx(s_rxbuf[i], len > 4 ? len - 4 : len, s_rxdata); uint32_t len = ((s_rxdesc[s_rxno][0] >> 16) & (BIT(14) - 1));
s_rxdesc[i][0] = BIT(31); // printf("%lx %lu %lx %.8lx\n", s_rxno, len, s_rxdesc[s_rxno][0],
// ETH->DMASR);
if (s_rx != NULL)
s_rx(s_rxbuf[s_rxno], len > 4 ? len - 4 : len, s_rxdata);
}
s_rxdesc[s_rxno][0] = BIT(31);
if (++s_rxno >= ETH_DESC_CNT) s_rxno = 0;
} }
} }
if (sr & BIT(7)) ETH->DMARPDR = 0; // Resume RX ETH->DMASR = BIT(7); // Clear possible RBUS while processing
ETH->DMASR = sr & ~(BIT(2) | BIT(7)); // Clear status ETH->DMARPDR = 0; // and resume RX
} }
struct mip_driver mip_driver_stm32 = { struct mip_driver mip_driver_stm32 = {
mongoose.c
+24 -17
View File
@@ -5985,7 +5985,8 @@ struct mip_driver mip_driver_enc28j60 = {
#endif #endif
#if MG_ENABLE_MIP && (!defined(MG_ENABLE_DRIVER_TM4C) || MG_ENABLE_DRIVER_TM4C == 0) #if MG_ENABLE_MIP && \
(!defined(MG_ENABLE_DRIVER_TM4C) || MG_ENABLE_DRIVER_TM4C == 0)
struct stm32_eth { struct stm32_eth {
volatile uint32_t MACCR, MACFFR, MACHTHR, MACHTLR, MACMIIAR, MACMIIDR, MACFCR, volatile uint32_t MACCR, MACFFR, MACHTHR, MACHTLR, MACMIIAR, MACMIIDR, MACFCR,
MACVLANTR, RESERVED0[2], MACRWUFFR, MACPMTCSR, RESERVED1, MACDBGR, MACSR, MACVLANTR, RESERVED0[2], MACRWUFFR, MACPMTCSR, RESERVED1, MACDBGR, MACSR,
@@ -6141,10 +6142,11 @@ static void mip_driver_stm32_setrx(void (*rx)(void *, size_t, void *),
static uint32_t s_txno; static uint32_t s_txno;
static size_t mip_driver_stm32_tx(const void *buf, size_t len, void *userdata) { static size_t mip_driver_stm32_tx(const void *buf, size_t len, void *userdata) {
if (len > sizeof(s_txbuf[s_txno])) { if (len > sizeof(s_txbuf[s_txno])) {
printf("%s: frame too big, %ld\n", __func__, (long) len); MG_ERROR(("Frame too big, %ld", (long) len));
len = 0; // Frame is too big len = 0; // Frame is too big
} else if ((s_txdesc[s_txno][0] & BIT(31))) { } else if ((s_txdesc[s_txno][0] & BIT(31))) {
printf("%s: no free descr\n", __func__); MG_ERROR(("No free descriptors"));
// printf("D0 %lx SR %lx\n", (long) s_txdesc[0][0], (long) ETH->DMASR);
len = 0; // All descriptors are busy, fail len = 0; // All descriptors are busy, fail
} else { } else {
memcpy(s_txbuf[s_txno], buf, len); // Copy data memcpy(s_txbuf[s_txno], buf, len); // Copy data
@@ -6153,10 +6155,8 @@ static size_t mip_driver_stm32_tx(const void *buf, size_t len, void *userdata) {
s_txdesc[s_txno][0] |= BIT(31); // Set OWN bit - let DMA take over s_txdesc[s_txno][0] |= BIT(31); // Set OWN bit - let DMA take over
if (++s_txno >= ETH_DESC_CNT) s_txno = 0; if (++s_txno >= ETH_DESC_CNT) s_txno = 0;
} }
uint32_t sr = ETH->DMASR; ETH->DMASR = BIT(2) | BIT(5); // Clear any prior TBUS/TUS
if (sr & BIT(2)) ETH->DMASR = BIT(2), ETH->DMATPDR = 0; // Resume ETH->DMATPDR = 0; // and resume
if (sr & BIT(5)) ETH->DMASR = BIT(5), ETH->DMATPDR = 0; // if busy
if (len == 0) printf("E: D0 %lx SR %lx\n", (long) s_txdesc[0][0], (long) sr);
return len; return len;
(void) userdata; (void) userdata;
} }
@@ -6168,20 +6168,27 @@ static bool mip_driver_stm32_up(void *userdata) {
} }
void ETH_IRQHandler(void); void ETH_IRQHandler(void);
static uint32_t s_rxno;
void ETH_IRQHandler(void) { void ETH_IRQHandler(void) {
qp_mark(QP_IRQTRIGGERED, 0); qp_mark(QP_IRQTRIGGERED, 0);
volatile uint32_t sr = ETH->DMASR; if (ETH->DMASR & BIT(6)) { // Frame received, loop
if (sr & BIT(6)) { // Frame received, loop ETH->DMASR = BIT(16) | BIT(6); // Clear flag
for (uint32_t i = 0; i < ETH_DESC_CNT; i++) { for (uint32_t i = 0; i < 10; i++) { // read as they arrive but not forever
if (s_rxdesc[i][0] & BIT(31)) continue; if (s_rxdesc[s_rxno][0] & BIT(31)) break; // exit when done
uint32_t len = ((s_rxdesc[i][0] >> 16) & (BIT(14) - 1)); if (((s_rxdesc[s_rxno][0] & (BIT(8) | BIT(9))) == (BIT(8) | BIT(9))) &&
// printf("%lx %lu %lx %lx\n", i, len, s_rxdesc[i][0], sr); !(s_rxdesc[s_rxno][0] & BIT(15))) { // skip partial/errored frames
if (s_rx != NULL) s_rx(s_rxbuf[i], len > 4 ? len - 4 : len, s_rxdata); uint32_t len = ((s_rxdesc[s_rxno][0] >> 16) & (BIT(14) - 1));
s_rxdesc[i][0] = BIT(31); // printf("%lx %lu %lx %.8lx\n", s_rxno, len, s_rxdesc[s_rxno][0],
// ETH->DMASR);
if (s_rx != NULL)
s_rx(s_rxbuf[s_rxno], len > 4 ? len - 4 : len, s_rxdata);
}
s_rxdesc[s_rxno][0] = BIT(31);
if (++s_rxno >= ETH_DESC_CNT) s_rxno = 0;
} }
} }
if (sr & BIT(7)) ETH->DMARPDR = 0; // Resume RX ETH->DMASR = BIT(7); // Clear possible RBUS while processing
ETH->DMASR = sr & ~(BIT(2) | BIT(7)); // Clear status ETH->DMARPDR = 0; // and resume RX
} }
struct mip_driver mip_driver_stm32 = { struct mip_driver mip_driver_stm32 = {