2019-06-22 14:03:41 +01:00
|
|
|
/*
|
|
|
|
* This file is part of the MicroPython project, http://micropython.org/
|
|
|
|
*
|
|
|
|
* The MIT License (MIT)
|
|
|
|
*
|
|
|
|
* Copyright (c) 2019 Damien P. George
|
2022-06-04 17:09:11 +01:00
|
|
|
* Copyright (c) 2022 Robert Hammelrath
|
2019-06-22 14:03:41 +01:00
|
|
|
*
|
|
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
|
|
* in the Software without restriction, including without limitation the rights
|
|
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
|
|
* furnished to do so, subject to the following conditions:
|
|
|
|
*
|
|
|
|
* The above copyright notice and this permission notice shall be included in
|
|
|
|
* all copies or substantial portions of the Software.
|
|
|
|
*
|
|
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
|
|
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
|
|
* THE SOFTWARE.
|
|
|
|
*/
|
|
|
|
|
2020-02-06 09:25:54 +00:00
|
|
|
#include "py/runtime.h"
|
2019-06-22 14:03:41 +01:00
|
|
|
#include "py/mphal.h"
|
2021-05-20 09:30:08 +01:00
|
|
|
#include "py/stream.h"
|
2022-06-04 17:09:11 +01:00
|
|
|
#include "shared/runtime/interrupt_char.h"
|
|
|
|
#include "extmod/misc.h"
|
2019-06-22 14:03:41 +01:00
|
|
|
#include "samd_soc.h"
|
|
|
|
#include "tusb.h"
|
|
|
|
|
2022-06-28 15:59:01 +01:00
|
|
|
#ifndef MICROPY_HW_STDIN_BUFFER_LEN
|
|
|
|
#define MICROPY_HW_STDIN_BUFFER_LEN 128
|
|
|
|
#endif
|
|
|
|
|
2022-09-29 15:13:23 +01:00
|
|
|
extern volatile uint32_t ticks_us64_upper;
|
|
|
|
|
2022-06-28 15:59:01 +01:00
|
|
|
STATIC uint8_t stdin_ringbuf_array[MICROPY_HW_STDIN_BUFFER_LEN];
|
|
|
|
ringbuf_t stdin_ringbuf = { stdin_ringbuf_array, sizeof(stdin_ringbuf_array), 0, 0 };
|
2019-06-22 14:03:41 +01:00
|
|
|
|
2022-06-28 15:59:01 +01:00
|
|
|
uint8_t cdc_itf_pending; // keep track of cdc interfaces which need attention to poll
|
|
|
|
|
|
|
|
void poll_cdc_interfaces(void) {
|
|
|
|
// any CDC interfaces left to poll?
|
|
|
|
if (cdc_itf_pending && ringbuf_free(&stdin_ringbuf)) {
|
|
|
|
for (uint8_t itf = 0; itf < 8; ++itf) {
|
|
|
|
if (cdc_itf_pending & (1 << itf)) {
|
|
|
|
tud_cdc_rx_cb(itf);
|
|
|
|
if (!cdc_itf_pending) {
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2019-06-22 14:03:41 +01:00
|
|
|
}
|
|
|
|
|
2022-06-28 15:59:01 +01:00
|
|
|
void tud_cdc_rx_cb(uint8_t itf) {
|
|
|
|
// consume pending USB data immediately to free usb buffer and keep the endpoint from stalling.
|
|
|
|
// in case the ringbuffer is full, mark the CDC interface that need attention later on for polling
|
|
|
|
cdc_itf_pending &= ~(1 << itf);
|
|
|
|
for (uint32_t bytes_avail = tud_cdc_n_available(itf); bytes_avail > 0; --bytes_avail) {
|
|
|
|
if (ringbuf_free(&stdin_ringbuf)) {
|
|
|
|
int data_char = tud_cdc_read_char();
|
|
|
|
#if MICROPY_KBD_EXCEPTION
|
|
|
|
if (data_char == mp_interrupt_char) {
|
|
|
|
// Clear the ring buffer
|
|
|
|
stdin_ringbuf.iget = stdin_ringbuf.iput = 0;
|
|
|
|
// and stop
|
|
|
|
mp_sched_keyboard_interrupt();
|
|
|
|
} else {
|
|
|
|
ringbuf_put(&stdin_ringbuf, data_char);
|
|
|
|
}
|
|
|
|
#else
|
|
|
|
ringbuf_put(&stdin_ringbuf, data_char);
|
|
|
|
#endif
|
|
|
|
} else {
|
|
|
|
cdc_itf_pending |= (1 << itf);
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2019-06-22 14:03:41 +01:00
|
|
|
|
2022-06-04 17:09:11 +01:00
|
|
|
void mp_hal_set_pin_mux(mp_hal_pin_obj_t pin, uint8_t mux) {
|
|
|
|
int pin_grp = pin / 32;
|
|
|
|
int port_grp = (pin % 32) / 2;
|
|
|
|
PORT->Group[pin_grp].PINCFG[pin % 32].bit.PMUXEN = 1; // Enable Mux
|
|
|
|
if (pin & 1) {
|
|
|
|
PORT->Group[pin_grp].PMUX[port_grp].bit.PMUXO = mux;
|
|
|
|
} else {
|
|
|
|
PORT->Group[pin_grp].PMUX[port_grp].bit.PMUXE = mux;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2022-06-05 10:03:59 +01:00
|
|
|
void mp_hal_clr_pin_mux(mp_hal_pin_obj_t pin) {
|
|
|
|
int pin_grp = pin / 32;
|
|
|
|
PORT->Group[pin_grp].PINCFG[pin % 32].bit.PMUXEN = 0; // Disable Mux
|
|
|
|
}
|
2022-06-04 17:09:11 +01:00
|
|
|
|
2019-06-22 14:03:41 +01:00
|
|
|
void mp_hal_delay_ms(mp_uint_t ms) {
|
2022-06-04 17:09:11 +01:00
|
|
|
if (ms > 10) {
|
|
|
|
uint32_t t0 = systick_ms;
|
|
|
|
while (systick_ms - t0 < ms) {
|
|
|
|
MICROPY_EVENT_POLL_HOOK
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
mp_hal_delay_us(ms * 1000);
|
2019-06-22 14:03:41 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void mp_hal_delay_us(mp_uint_t us) {
|
2022-06-04 17:09:11 +01:00
|
|
|
if (us > 0) {
|
|
|
|
#if defined(MCU_SAMD21)
|
2022-09-29 15:13:23 +01:00
|
|
|
uint32_t start = mp_hal_ticks_us();
|
2022-06-04 17:09:11 +01:00
|
|
|
while ((mp_hal_ticks_us() - start) < us) {
|
|
|
|
}
|
2022-09-29 15:13:23 +01:00
|
|
|
#else
|
|
|
|
uint64_t stop = mp_hal_ticks_us_64() + us;
|
|
|
|
while (mp_hal_ticks_us_64() < stop) {
|
2022-06-04 17:09:11 +01:00
|
|
|
}
|
|
|
|
#endif
|
2019-06-22 14:03:41 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2022-09-29 15:13:23 +01:00
|
|
|
uint64_t mp_hal_ticks_us_64(void) {
|
|
|
|
uint32_t us64_upper = ticks_us64_upper;
|
|
|
|
uint32_t us64_lower;
|
|
|
|
uint8_t intflag;
|
|
|
|
__disable_irq();
|
|
|
|
#if defined(MCU_SAMD21)
|
|
|
|
us64_lower = REG_TC4_COUNT32_COUNT;
|
|
|
|
intflag = TC4->COUNT32.INTFLAG.reg;
|
|
|
|
#elif defined(MCU_SAMD51)
|
|
|
|
TC0->COUNT32.CTRLBSET.reg = TC_CTRLBSET_CMD_READSYNC;
|
|
|
|
while (TC0->COUNT32.CTRLBSET.reg != 0) {
|
|
|
|
}
|
|
|
|
us64_lower = REG_TC0_COUNT32_COUNT;
|
|
|
|
intflag = TC0->COUNT32.INTFLAG.reg;
|
|
|
|
#endif
|
|
|
|
__enable_irq();
|
|
|
|
if ((intflag & TC_INTFLAG_OVF) && us64_lower < 0x10000000) {
|
|
|
|
// The timer counter overflowed before reading it but the IRQ handler
|
|
|
|
// has not yet been called, so perform the IRQ arithmetic now.
|
|
|
|
us64_upper++;
|
|
|
|
}
|
|
|
|
#if defined(MCU_SAMD21)
|
2023-01-25 17:05:40 +00:00
|
|
|
return ((uint64_t)us64_upper << 31) | (us64_lower >> 1);
|
2022-09-29 15:13:23 +01:00
|
|
|
#elif defined(MCU_SAMD51)
|
|
|
|
return ((uint64_t)us64_upper << 28) | (us64_lower >> 4);
|
|
|
|
#endif
|
|
|
|
|
|
|
|
}
|
|
|
|
|
2021-05-20 09:30:08 +01:00
|
|
|
uintptr_t mp_hal_stdio_poll(uintptr_t poll_flags) {
|
|
|
|
uintptr_t ret = 0;
|
2022-06-28 15:59:01 +01:00
|
|
|
|
|
|
|
poll_cdc_interfaces();
|
|
|
|
if ((poll_flags & MP_STREAM_POLL_RD) && ringbuf_peek(&stdin_ringbuf) != -1) {
|
2021-05-20 09:30:08 +01:00
|
|
|
ret |= MP_STREAM_POLL_RD;
|
|
|
|
}
|
2022-06-28 15:59:01 +01:00
|
|
|
|
2023-03-21 13:14:46 +00:00
|
|
|
if ((poll_flags & MP_STREAM_POLL_WR) && tud_cdc_connected() && tud_cdc_write_available() > 0) {
|
|
|
|
ret |= MP_STREAM_POLL_WR;
|
|
|
|
}
|
|
|
|
|
2022-06-05 19:34:37 +01:00
|
|
|
#if MICROPY_PY_OS_DUPTERM
|
2022-08-18 05:47:56 +01:00
|
|
|
ret |= mp_os_dupterm_poll(poll_flags);
|
2022-06-05 19:34:37 +01:00
|
|
|
#endif
|
2021-05-20 09:30:08 +01:00
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
2019-06-22 14:03:41 +01:00
|
|
|
int mp_hal_stdin_rx_chr(void) {
|
|
|
|
for (;;) {
|
2022-06-28 15:59:01 +01:00
|
|
|
|
|
|
|
poll_cdc_interfaces();
|
|
|
|
int c = ringbuf_get(&stdin_ringbuf);
|
|
|
|
if (c != -1) {
|
|
|
|
return c;
|
2019-06-22 14:03:41 +01:00
|
|
|
}
|
2022-06-28 15:59:01 +01:00
|
|
|
|
2022-06-05 19:34:37 +01:00
|
|
|
#if MICROPY_PY_OS_DUPTERM
|
2022-08-18 05:47:56 +01:00
|
|
|
int dupterm_c = mp_os_dupterm_rx_chr();
|
2022-06-05 19:34:37 +01:00
|
|
|
if (dupterm_c >= 0) {
|
|
|
|
return dupterm_c;
|
|
|
|
}
|
|
|
|
#endif
|
2022-06-04 17:09:11 +01:00
|
|
|
MICROPY_EVENT_POLL_HOOK
|
2019-06-22 14:03:41 +01:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void mp_hal_stdout_tx_strn(const char *str, mp_uint_t len) {
|
|
|
|
if (tud_cdc_connected()) {
|
|
|
|
for (size_t i = 0; i < len;) {
|
|
|
|
uint32_t n = len - i;
|
2021-02-12 03:09:01 +00:00
|
|
|
if (n > CFG_TUD_CDC_EP_BUFSIZE) {
|
|
|
|
n = CFG_TUD_CDC_EP_BUFSIZE;
|
|
|
|
}
|
2022-10-16 11:08:52 +01:00
|
|
|
int timeout = 0;
|
|
|
|
// Wait with a max of USC_CDC_TIMEOUT ms
|
|
|
|
while (n > tud_cdc_write_available() && timeout++ < MICROPY_HW_USB_CDC_TX_TIMEOUT) {
|
2022-06-04 17:09:11 +01:00
|
|
|
MICROPY_EVENT_POLL_HOOK
|
2019-06-22 14:03:41 +01:00
|
|
|
}
|
2022-10-16 11:08:52 +01:00
|
|
|
if (timeout >= MICROPY_HW_USB_CDC_TX_TIMEOUT) {
|
|
|
|
break;
|
|
|
|
}
|
2021-02-12 03:09:01 +00:00
|
|
|
uint32_t n2 = tud_cdc_write(str + i, n);
|
|
|
|
tud_cdc_write_flush();
|
2019-06-22 14:03:41 +01:00
|
|
|
i += n2;
|
|
|
|
}
|
|
|
|
}
|
2022-06-05 19:34:37 +01:00
|
|
|
#if MICROPY_PY_OS_DUPTERM
|
2022-08-18 05:47:56 +01:00
|
|
|
mp_os_dupterm_tx_strn(str, len);
|
2022-06-05 19:34:37 +01:00
|
|
|
#endif
|
2019-06-22 14:03:41 +01:00
|
|
|
}
|