134 lines
2.7 KiB
C++
134 lines
2.7 KiB
C++
#include "async.h"
|
|
#include "buffer.h"
|
|
#include "gpio.h"
|
|
#include "intc.h"
|
|
#include "interrupts.h"
|
|
#include "pol0.h"
|
|
#include "timer.h"
|
|
#include "trace.h"
|
|
#include "uart.h"
|
|
#include "uart_async.h"
|
|
|
|
namespace {
|
|
|
|
Timer* timer0;
|
|
|
|
void Uart0Isr() {
|
|
HandleUartIsr();
|
|
}
|
|
|
|
void Timer0Isr() {
|
|
SetLed(6);
|
|
__builtin_trap();
|
|
}
|
|
|
|
void SetupUart() {
|
|
InitUarts();
|
|
|
|
intc::SetIsr(UART0_IRQN, Uart0Isr);
|
|
intc::SetIrqEnabled(UART0_IRQN, true);
|
|
}
|
|
|
|
void SetupTimer() {
|
|
timer0 = Timer::Instance(TIMER0_BASE);
|
|
timer0->SetupAsWdt(100'000 * 1000);
|
|
timer0->EnableT1();
|
|
|
|
intc::SetIsr(TIMER0_IRQN, Timer0Isr);
|
|
intc::SetIrqEnabled(TIMER0_IRQN, true);
|
|
}
|
|
|
|
void SetupInterrupts() {
|
|
intc::EnableInterrupts();
|
|
SetExternalInterruptHandler(intc::InterruptHandler);
|
|
EnableExternalInterrupts();
|
|
EnableInterrupts(true);
|
|
}
|
|
|
|
async::task<> echo() {
|
|
async::task<std::byte> reader = UartReadLoop();
|
|
async::gimme<std::span<const std::byte>> feeder;
|
|
async::task<> writer = UartWriteLoop(feeder);
|
|
writer.h.resume(); // advance to first yield
|
|
while (1) {
|
|
SetLed(1);
|
|
std::byte c = co_await reader;
|
|
ClearLed(1);
|
|
co_await feeder.feed(std::span{&c, 1});
|
|
}
|
|
}
|
|
|
|
async::task<> blink() {
|
|
while (1) {
|
|
co_await async::delay(500);
|
|
ToggleLed(0);
|
|
timer0->Pet();
|
|
}
|
|
}
|
|
|
|
} // namespace
|
|
|
|
int main() {
|
|
SetupUart();
|
|
UartWriteBlocking("uart setup done\r\n");
|
|
SetupTimer();
|
|
UartWriteBlocking("timer setup done\r\n");
|
|
|
|
gpio0->data = 0;
|
|
SetupInterrupts();
|
|
|
|
async::schedule(echo().h);
|
|
async::schedule(blink().h);
|
|
|
|
UartWriteBlocking("init done. starting main loop\r\n");
|
|
|
|
async::main_loop(nullptr);
|
|
// should never get here
|
|
}
|
|
|
|
/// stdlib stuff
|
|
|
|
#include <sys/time.h>
|
|
|
|
#include <cstdint>
|
|
|
|
#include "itoa.h"
|
|
#include "lock.h"
|
|
|
|
extern unsigned char _heap_begin, _heap_end;
|
|
|
|
extern "C" void* _sbrk(int increment) {
|
|
static unsigned char* heap = &_heap_begin;
|
|
unsigned char* prev_heap = heap;
|
|
if (heap + increment >= &_heap_end) {
|
|
UartWriteCrash("Heap overflow!\r\n");
|
|
return reinterpret_cast<void*>(-1);
|
|
}
|
|
heap += increment;
|
|
return prev_heap;
|
|
}
|
|
|
|
extern "C" int _gettimeofday(struct timeval* tv, void* tzvp) {
|
|
(void)tzvp;
|
|
uint32_t ticks = timer0->GetT1Ticks();
|
|
tv->tv_sec = ticks / 100000000;
|
|
tv->tv_usec = (ticks % 100000000) / 100;
|
|
|
|
return 0;
|
|
}
|
|
|
|
extern "C" uint8_t __atomic_exchange_1(volatile void* ptr, uint8_t val,
|
|
int memorder) {
|
|
(void)memorder;
|
|
auto* dest = reinterpret_cast<volatile uint8_t*>(ptr);
|
|
bool ret;
|
|
|
|
{
|
|
InterruptLock lock;
|
|
ret = *dest;
|
|
*dest = val;
|
|
}
|
|
|
|
return ret;
|
|
}
|