mirror of
https://github.com/cesanta/mongoose.git
synced 2026-11-20 19:41:58 +00:00
Add radio simulation
This commit is contained in:
1 parent
9337a78cd0
commit
d39519b92f
66 files changed
+5659
-1000
No files matched your search
+7
-2
@@ -17,6 +17,7 @@ CFLAGS += -mcpu=cortex-m33+nodsp -mthumb -mfloat-abi=hard -mfpu=fpv5-sp-d16 $(CF
|
||||
LDFLAGS ?= -Tlink.ld -nostdlib -nostartfiles --specs=nano.specs -lc -lgcc -Wl,--gc-sections
|
||||
|
||||
SOURCES = main.c hal.c radio.c startup.c flexspi.c flash_config.c $(MGDIR)/mongoose.c
|
||||
|
||||
SOURCES += cmsis_rw612/devices/RW612/drivers/fsl_clock.c
|
||||
SOURCES += cmsis_rw612/devices/RW612/drivers/fsl_trng.c
|
||||
SOURCES += cmsis_rw612/devices/RW612/drivers/fsl_reset.c
|
||||
@@ -35,9 +36,13 @@ firmware.bin: firmware.elf
|
||||
arm-none-eabi-objcopy -O binary $< $@
|
||||
arm-none-eabi-size --format=berkeley $<
|
||||
|
||||
firmware.elf: cmsis_core cmsis_rw612 $(RADIO_FW) $(SOURCES) $(wildcard *.h) link.ld Makefile mongoose_config.h
|
||||
firmware.elf: cmsis_core cmsis_rw612 $(RADIO_FW) $(SOURCES) $(wildcard *.h) $(MGDIR)/mongoose.h link.ld Makefile mongoose_config.h mesh-config
|
||||
arm-none-eabi-gcc $(SOURCES) $(CFLAGS) $(LDFLAGS) -o $@
|
||||
|
||||
# Rebuild when overriding the board address or timing.
|
||||
.PHONY: mesh-config
|
||||
mesh-config:
|
||||
|
||||
cmsis_core:
|
||||
git clone -q -c advice.detachedHead=false --depth 1 -b 5.9.0 https://github.com/ARM-software/CMSIS_5 $@
|
||||
|
||||
@@ -56,7 +61,7 @@ show_symbols_sorted_by_size: firmware.bin
|
||||
arm-none-eabi-readelf -sW firmware.elf | sed 1,3d | sed 's,^.*: ,,' | tr -s ' ' | cut -d ' ' -f 2,7 | sort -nk1 | grep -v '^0 '
|
||||
|
||||
flash: firmware.bin
|
||||
(echo 'loadfile firmware.elf'; echo 'reset'; echo 'exit';) | JLinkExe -device RW612 -if SWD -speed 4000 -autoconnect 1 -NoGui 1 -ExitOnError 1
|
||||
(echo 'loadfile firmware.elf'; echo 'reset'; echo 'go'; echo 'exit';) | JLinkExe -device RW612 -if SWD -speed 4000 -autoconnect 1 -NoGui 1 -ExitOnError 1
|
||||
# JRun --nogui --device RW612 --if SWD firmware.elf
|
||||
|
||||
clean:
|
||||
File renamed without changes.
File renamed without changes.
File renamed without changes.
+20
@@ -26,6 +26,26 @@ uint64_t hal_get_tick(void) {
|
||||
return s_ticks;
|
||||
};
|
||||
|
||||
uint64_t mg_micros(void);
|
||||
// SysTick runs at the core clock and reloads every millisecond. Sample
|
||||
// the tick counter and the sub-millisecond counter in one critical section.
|
||||
uint64_t mg_micros(void) {
|
||||
uint32_t primask = __get_PRIMASK(), val, pending;
|
||||
uint64_t ms;
|
||||
__disable_irq();
|
||||
ms = hal_get_tick();
|
||||
pending = SCB->ICSR & SCB_ICSR_PENDSTSET_Msk;
|
||||
val = SysTick->VAL;
|
||||
if (pending != (SCB->ICSR & SCB_ICSR_PENDSTSET_Msk)) {
|
||||
pending = SCB_ICSR_PENDSTSET_Msk;
|
||||
val = SysTick->VAL;
|
||||
}
|
||||
__set_PRIMASK(primask);
|
||||
if (pending != 0 && val != 0) ms++;
|
||||
return ms * 1000 + ((uint64_t) (SysTick->LOAD - val) * 1000) /
|
||||
(SysTick->LOAD + 1);
|
||||
}
|
||||
|
||||
uint32_t SystemCoreClock = SYS_FREQUENCY;
|
||||
int hal_radio_err; // Result of hal_radio_init()
|
||||
void SystemInit(void) { // Called automatically by startup code
|
||||
+12
-6
@@ -152,16 +152,22 @@ static inline void hal_gpio_toggle(uint16_t pin) {
|
||||
#define MG_HAL_SYSTICK MG_HAL_SYSTICK_NONE
|
||||
#endif
|
||||
|
||||
static inline void hal_uart_init(USART_Type *uart, unsigned long baud) {
|
||||
if (uart == USART0) {
|
||||
static inline void hal_uart_init(USART_Type *uart, unsigned long baud,
|
||||
uint16_t tx_pin, uint16_t rx_pin) {
|
||||
if (uart == USART0 && tx_pin == PIN(0, 3) &&
|
||||
rx_pin == PIN(0, 2)) {
|
||||
IO_MUX_SetPinMux(IO_MUX_FC0_USART_DATA);
|
||||
} else if (uart == USART1) {
|
||||
} else if (uart == USART1 && tx_pin == PIN(0, 8) &&
|
||||
rx_pin == PIN(0, 9)) {
|
||||
IO_MUX_SetPinMux(IO_MUX_FC1_USART_DATA);
|
||||
} else if (uart == USART2) {
|
||||
} else if (uart == USART2 && tx_pin == PIN(0, 14) &&
|
||||
rx_pin == PIN(0, 13)) {
|
||||
IO_MUX_SetPinMux(IO_MUX_FC2_USART_DATA);
|
||||
} else if (uart == USART3) {
|
||||
} else if (uart == USART3 && tx_pin == PIN(0, 26) &&
|
||||
rx_pin == PIN(0, 24)) {
|
||||
IO_MUX_SetPinMux(IO_MUX_FC3_USART_DATA);
|
||||
} else if (uart == USART14) {
|
||||
} else if (uart == USART14 && tx_pin == PIN(1, 24) &&
|
||||
rx_pin == PIN(1, 25)) {
|
||||
IO_MUX_SetPinMux(IO_MUX_FC14_USART_DATA);
|
||||
} else {
|
||||
return;
|
||||
File renamed without changes.
@@ -0,0 +1,123 @@
|
||||
// Copyright (c) 2026 Cesanta Software Limited
|
||||
// All rights reserved
|
||||
|
||||
#include "hal.h"
|
||||
#include "mongoose.h"
|
||||
|
||||
#define LED_RADIO PIN(0, 12) // Green, active low
|
||||
#define LED_LAN PIN(0, 0) // Blue, active low
|
||||
#define LED_RED PIN(0, 1) // Red, active low
|
||||
|
||||
static uint64_t s_radio_led_until;
|
||||
|
||||
// Cumulative totals. Up: radio -> LAN; down: LAN -> radio queue.
|
||||
static uint64_t s_frames_up, s_frames_down, s_bytes_up, s_bytes_down;
|
||||
static uint64_t s_radio_sent, s_radio_received;
|
||||
static size_t (*s_radio_tx)(struct mg_tcpip_if *, const void *, size_t);
|
||||
|
||||
static size_t radio_tx(struct mg_tcpip_if *ifp, const void *buf, size_t len) {
|
||||
size_t sent = s_radio_tx(ifp, buf, len);
|
||||
if (sent != 0) s_radio_sent++;
|
||||
return sent;
|
||||
}
|
||||
|
||||
static size_t eth_up(const void *buf, size_t len, struct mg_tcpip_if *ifp) {
|
||||
size_t sent = mg_tcpip_driver_rw612.tx(buf, len, ifp);
|
||||
if (sent != 0) s_frames_up++, s_bytes_up += sent;
|
||||
return sent;
|
||||
}
|
||||
|
||||
static size_t eth_down(struct mg_mesh_node *node, const void *buf, size_t len) {
|
||||
size_t queued = mg_mesh_default.tx(node, buf, len);
|
||||
if (queued != 0) s_frames_down++, s_bytes_down += queued;
|
||||
return queued;
|
||||
}
|
||||
|
||||
static void radio_rx(struct mg_mesh_node *node, void *buf, size_t len) {
|
||||
s_radio_received++;
|
||||
s_radio_led_until = mg_millis() + 2;
|
||||
mg_mesh_default.rx(node, buf, len);
|
||||
}
|
||||
|
||||
static void log_fn(char ch, void *arg) {
|
||||
hal_uart_write_buf(arg, &ch, 1);
|
||||
}
|
||||
|
||||
uint64_t mg_millis(void) {
|
||||
return hal_get_tick();
|
||||
}
|
||||
|
||||
int main(void) {
|
||||
static struct mg_tcpip_driver_rw612_data eth_data;
|
||||
static struct mg_tcpip_if eth;
|
||||
static struct mg_tcpip_driver eth_driver;
|
||||
static char eth_queue[8192];
|
||||
static struct mg_tcpip_driver_rw612w_data radio_data;
|
||||
static struct mg_tcpip_if radio;
|
||||
static struct mg_mesh mesh;
|
||||
uint32_t lan_received = 0;
|
||||
uint64_t lan_led_until = 0;
|
||||
uint64_t link_timer = 0, stats_timer = 0;
|
||||
|
||||
hal_clock_init();
|
||||
hal_rng_init();
|
||||
hal_gpio_output(LED_RADIO);
|
||||
hal_gpio_output(LED_LAN);
|
||||
hal_gpio_output(LED_RED);
|
||||
hal_gpio_write(LED_RADIO, true);
|
||||
hal_gpio_write(LED_LAN, true);
|
||||
hal_gpio_write(LED_RED, true);
|
||||
hal_uart_init(USART3, 115200, PIN(0, 26), PIN(0, 24));
|
||||
mg_log_set_fn(log_fn, USART3);
|
||||
hal_ethernet_init();
|
||||
|
||||
mesh = mg_mesh_default;
|
||||
mesh.tx = eth_down;
|
||||
mesh.rx = radio_rx; // Observe radio reception without modifying the driver.
|
||||
radio_data.strategy = &mesh;
|
||||
radio.driver = &mg_tcpip_driver_rw612w;
|
||||
radio.driver_data = &radio_data;
|
||||
if (!radio.driver->init(&radio)) return 1;
|
||||
s_radio_tx = radio_data.mesh->tx;
|
||||
radio_data.mesh->tx = radio_tx;
|
||||
|
||||
eth_data.mdc_cr = MG_DRIVER_MDC_CR;
|
||||
eth_data.mdc_holdtime = MG_DRIVER_MDC_HOLDTIME;
|
||||
eth_data.phy_addr = MG_TCPIP_PHY_ADDR;
|
||||
eth_driver = mg_tcpip_driver_rw612;
|
||||
eth_driver.tx = eth_up;
|
||||
eth.driver = ð_driver;
|
||||
eth.driver_data = ð_data;
|
||||
memcpy(eth.mac, radio.mac, 6);
|
||||
mg_queue_init(ð.recv_queue, eth_queue, sizeof(eth_queue));
|
||||
if (!eth.driver->init(ð)) return 1;
|
||||
|
||||
ENET->RCR |= ENET_RCR_PROM_MASK; // Receive frames addressed to radio nodes.
|
||||
radio_data.mesh->lan = ð
|
||||
radio_data.mesh->next_tick = 0;
|
||||
|
||||
MG_INFO(("Ethernet/radio bridge, channel %u", MG_802154_CHANNEL));
|
||||
stats_timer = mg_millis() + 5000;
|
||||
for (;;) {
|
||||
uint64_t now = mg_millis();
|
||||
if (mg_timer_expired(&link_timer, 100, mg_millis())) {
|
||||
eth.state = eth.driver->poll(ð, true) ? MG_TCPIP_STATE_UP
|
||||
: MG_TCPIP_STATE_DOWN;
|
||||
}
|
||||
radio.driver->poll(&radio, false);
|
||||
if (mg_timer_expired(&stats_timer, 5000, now)) {
|
||||
MG_INFO(
|
||||
("ETH frames up/down %llu/%llu, bytes up/down "
|
||||
"%llu/%llu, radio frames sent/rcvd %llu/%llu",
|
||||
s_frames_up, s_frames_down, s_bytes_up, s_bytes_down, s_radio_sent,
|
||||
s_radio_received));
|
||||
}
|
||||
if (eth.nrecv != lan_received) {
|
||||
lan_received = eth.nrecv;
|
||||
lan_led_until = now + 2;
|
||||
}
|
||||
hal_gpio_write(LED_RADIO, now >= s_radio_led_until);
|
||||
hal_gpio_write(LED_LAN, now >= lan_led_until);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
@@ -0,0 +1,13 @@
|
||||
#pragma once
|
||||
|
||||
// See https://mongoose.ws/docs/getting-started/build-environment/
|
||||
#define MG_ARCH MG_ARCH_ARMGCC
|
||||
|
||||
#define MG_ENABLE_TCPIP 1
|
||||
#define MG_ENABLE_DRIVER_RW612 1 // Ethernet
|
||||
#define MG_ENABLE_DRIVER_RW612W 1 // Mesh bridge over raw 802.15.4
|
||||
#define MG_ENABLE_CUSTOM_MILLIS 1
|
||||
|
||||
|
||||
// The bridge initializes and polls its two L2 interfaces directly.
|
||||
#define MG_ENABLE_TCPIP_DRIVER_INIT 0
|
||||
File renamed without changes.
File renamed without changes.
@@ -1,101 +0,0 @@
|
||||
// Copyright (c) 2026 Cesanta Software Limited
|
||||
// All rights reserved
|
||||
//
|
||||
// Ethernet <-> IEEE 802.15.4 radio bridge. Radio frames carry Ethernet frames
|
||||
// split into pieces, see mg_l2_802154_tx(). Radio nodes, e.g. the
|
||||
// FRDM-MCXW71 minimal tutorial, are on the Ethernet LAN: they get IPv4
|
||||
// addresses from its DHCP server. The bridge itself has no IP address.
|
||||
// Everything from the radio goes to Ethernet. From Ethernet, only broadcasts
|
||||
// and frames to radio nodes go to the radio, it is much slower
|
||||
|
||||
#include "hal.h"
|
||||
#include "mongoose.h"
|
||||
|
||||
#define UART_DEBUG USART3
|
||||
|
||||
static void log_fn(char ch, void *param) {
|
||||
hal_uart_write_buf(param, &ch, 1);
|
||||
}
|
||||
|
||||
uint64_t mg_millis(void) {
|
||||
return hal_get_tick();
|
||||
}
|
||||
|
||||
// MAC addresses of radio nodes, learned from frames they send
|
||||
static uint8_t s_nodes[8][6];
|
||||
static size_t s_next;
|
||||
|
||||
// Remember a radio node's MAC address, if new
|
||||
static void learn(const uint8_t *mac) {
|
||||
size_t i, n = sizeof(s_nodes) / sizeof(s_nodes[0]);
|
||||
for (i = 0; i < n && memcmp(s_nodes[i], mac, 6) != 0; i++) (void) 0;
|
||||
if (i < n) return;
|
||||
memcpy(s_nodes[s_next], mac, 6);
|
||||
s_next = (s_next + 1) % n;
|
||||
MG_INFO(("Radio node %M", mg_print_mac, mac));
|
||||
}
|
||||
|
||||
// Is an Ethernet frame for the radio: broadcast, or to a radio node
|
||||
static bool for_radio(const uint8_t *dst) {
|
||||
size_t i, n = sizeof(s_nodes) / sizeof(s_nodes[0]);
|
||||
if (memcmp(dst, "\xff\xff\xff\xff\xff\xff", 6) == 0) return true;
|
||||
for (i = 0; i < n && memcmp(s_nodes[i], dst, 6) != 0; i++) (void) 0;
|
||||
return i < n;
|
||||
}
|
||||
|
||||
int main(void) {
|
||||
static struct mg_tcpip_driver_rw612_data eth_data = {
|
||||
.mdc_cr = MG_DRIVER_MDC_CR, .phy_addr = MG_TCPIP_PHY_ADDR};
|
||||
static struct mg_l2_802154_data radio_data = {
|
||||
.channel = MG_L2_802154_CHANNEL, .pan_id = MG_L2_802154_PAN_ID};
|
||||
static struct mg_tcpip_if eth = {.driver = &mg_tcpip_driver_rw612,
|
||||
.driver_data = ð_data};
|
||||
static struct mg_tcpip_if radio = {.driver = &mg_tcpip_driver_rw612_154,
|
||||
.driver_data = &radio_data};
|
||||
static char eth_queue[8192]; // Filled by the Ethernet IRQ handler
|
||||
static uint8_t frame[1540];
|
||||
uint8_t uid[FSL_OCOTP_UID_LENGTH], digest[32];
|
||||
uint32_t uid_len = sizeof(uid);
|
||||
uint64_t timer = 0;
|
||||
char *p;
|
||||
size_t n;
|
||||
|
||||
hal_clock_init();
|
||||
hal_uart_init(UART_DEBUG, 115200);
|
||||
mg_log_set_fn(log_fn, UART_DEBUG);
|
||||
if (hal_radio_err) {
|
||||
MG_ERROR(("Radio firmware failed to start, step %d", hal_radio_err));
|
||||
}
|
||||
|
||||
// MAC addresses made from the chip unique ID
|
||||
memset(uid, 0, sizeof(uid));
|
||||
OCOTP_ReadUniqueID(uid, &uid_len);
|
||||
mg_sha256(digest, uid, sizeof(uid));
|
||||
memcpy(eth.mac, digest, 6);
|
||||
memcpy(radio.mac, digest + 6, 6);
|
||||
eth.mac[0] = radio.mac[0] = 0x02; // Locally administered, unicast
|
||||
|
||||
hal_ethernet_init();
|
||||
mg_queue_init(ð.recv_queue, eth_queue, sizeof(eth_queue));
|
||||
if (!eth.driver->init(ð)) MG_ERROR(("Ethernet init failed"));
|
||||
if (!radio.driver->init(&radio)) MG_ERROR(("Radio init failed"));
|
||||
ENET->RCR |= ENET_RCR_PROM_MASK; // Receive frames for radio nodes, too
|
||||
MG_INFO(("Bridge started, radio channel %d", radio_data.channel));
|
||||
|
||||
for (;;) {
|
||||
if ((n = mg_queue_next(ð.recv_queue, &p)) > 0) { // Ethernet -> radio
|
||||
if (n >= 14 && for_radio((uint8_t *) p)) radio.driver->tx(p, n, &radio);
|
||||
mg_queue_del(ð.recv_queue, n);
|
||||
}
|
||||
if ((n = radio.driver->rx(frame, sizeof(frame), &radio)) >= 14) {
|
||||
learn(frame + 6); // Radio -> Ethernet
|
||||
eth.driver->tx(frame, n, ð);
|
||||
}
|
||||
if (mg_timer_expired(&timer, 1000, mg_millis())) { // Ethernet link
|
||||
bool up = eth.driver->poll(ð, true);
|
||||
eth.state = up ? MG_TCPIP_STATE_UP : MG_TCPIP_STATE_DOWN;
|
||||
}
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
@@ -1,10 +0,0 @@
|
||||
#pragma once
|
||||
|
||||
// See https://mongoose.ws/docs/getting-started/build-environment/
|
||||
#define MG_ARCH MG_ARCH_ARMGCC
|
||||
|
||||
#define MG_ENABLE_TCPIP 1
|
||||
#define MG_ENABLE_DRIVER_RW612 1 // Ethernet
|
||||
#define MG_ENABLE_DRIVER_RW612_154 1 // 802.15.4 radio
|
||||
#define MG_ENABLE_TCPIP_DRIVER_INIT 0 // main.c drives both, no TCP/IP stack
|
||||
#define MG_ENABLE_CUSTOM_MILLIS 1
|
||||
@@ -147,16 +147,22 @@ static inline void hal_gpio_toggle(uint16_t pin) {
|
||||
#define MG_HAL_SYSTICK MG_HAL_SYSTICK_NONE
|
||||
#endif
|
||||
|
||||
static inline void hal_uart_init(USART_Type *uart, unsigned long baud) {
|
||||
if (uart == USART0) {
|
||||
static inline void hal_uart_init(USART_Type *uart, unsigned long baud,
|
||||
uint16_t tx_pin, uint16_t rx_pin) {
|
||||
if (uart == USART0 && tx_pin == PIN(0, 3) &&
|
||||
rx_pin == PIN(0, 2)) {
|
||||
IO_MUX_SetPinMux(IO_MUX_FC0_USART_DATA);
|
||||
} else if (uart == USART1) {
|
||||
} else if (uart == USART1 && tx_pin == PIN(0, 8) &&
|
||||
rx_pin == PIN(0, 9)) {
|
||||
IO_MUX_SetPinMux(IO_MUX_FC1_USART_DATA);
|
||||
} else if (uart == USART2) {
|
||||
} else if (uart == USART2 && tx_pin == PIN(0, 14) &&
|
||||
rx_pin == PIN(0, 13)) {
|
||||
IO_MUX_SetPinMux(IO_MUX_FC2_USART_DATA);
|
||||
} else if (uart == USART3) {
|
||||
} else if (uart == USART3 && tx_pin == PIN(0, 26) &&
|
||||
rx_pin == PIN(0, 24)) {
|
||||
IO_MUX_SetPinMux(IO_MUX_FC3_USART_DATA);
|
||||
} else if (uart == USART14) {
|
||||
} else if (uart == USART14 && tx_pin == PIN(1, 24) &&
|
||||
rx_pin == PIN(1, 25)) {
|
||||
IO_MUX_SetPinMux(IO_MUX_FC14_USART_DATA);
|
||||
} else {
|
||||
return;
|
||||
|
||||
@@ -96,7 +96,7 @@ int main(void) {
|
||||
hal_gpio_write(LED2, true);
|
||||
hal_gpio_output(LED3);
|
||||
hal_gpio_write(LED3, true);
|
||||
hal_uart_init(UART_DEBUG, 115200);
|
||||
hal_uart_init(UART_DEBUG, 115200, PIN(0, 26), PIN(0, 24));
|
||||
mg_log_set_fn(log_fn, UART_DEBUG);
|
||||
|
||||
hal_ethernet_init();
|
||||
|
||||
Reference in new issue
Block a user