kopia lustrzana https://github.com/micropython/micropython
382 wiersze
11 KiB
C
382 wiersze
11 KiB
C
/*
|
|
* This file is part of the MicroPython project, http://micropython.org/
|
|
*
|
|
* The MIT License (MIT)
|
|
*
|
|
* Copyright (c) 2015 Glenn Ruben Bakke
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
#include <string.h>
|
|
|
|
#include "py/mpstate.h"
|
|
#include "py/mphal.h"
|
|
#include "py/mperrno.h"
|
|
#include "py/runtime.h"
|
|
#include "py/stream.h"
|
|
#include "uart.h"
|
|
#include "nrfx_errors.h"
|
|
#include "nrfx_config.h"
|
|
|
|
#if MICROPY_PY_TIME_TICKS
|
|
#include "nrfx_rtc.h"
|
|
#include "nrf_clock.h"
|
|
#endif
|
|
|
|
#if MICROPY_PY_TIME_TICKS
|
|
|
|
// Use RTC1 for time ticks generation (ms and us) with 32kHz tick resolution
|
|
// and overflow handling in RTC IRQ.
|
|
|
|
#define RTC_TICK_INCREASE_MSEC (33)
|
|
|
|
#define RTC_RESCHEDULE_CC(rtc, cc_nr, ticks) \
|
|
do { \
|
|
nrfx_rtc_cc_set(&rtc, cc_nr, nrfx_rtc_counter_get(&rtc) + ticks, true); \
|
|
} while (0);
|
|
|
|
// RTC overflow irq handling notes:
|
|
// - If has_overflowed is set it could be before or after COUNTER is read.
|
|
// If before then an adjustment must be made, if after then no adjustment is necessary.
|
|
// - The before case is when COUNTER is very small (because it just overflowed and was set to zero),
|
|
// the after case is when COUNTER is very large (because it's just about to overflow
|
|
// but we read it right before it overflows).
|
|
// - The extra check for counter is to distinguish these cases. 1<<23 because it's halfway
|
|
// between min and max values of COUNTER.
|
|
#define RTC1_GET_TICKS_ATOMIC(rtc, overflows, counter) \
|
|
do { \
|
|
rtc.p_reg->INTENCLR = RTC_INTENCLR_OVRFLW_Msk; \
|
|
overflows = rtc_overflows; \
|
|
counter = rtc.p_reg->COUNTER; \
|
|
uint32_t has_overflowed = rtc.p_reg->EVENTS_OVRFLW; \
|
|
if (has_overflowed && counter < (1 << 23)) { \
|
|
overflows += 1; \
|
|
} \
|
|
rtc.p_reg->INTENSET = RTC_INTENSET_OVRFLW_Msk; \
|
|
} while (0);
|
|
|
|
nrfx_rtc_t rtc1 = NRFX_RTC_INSTANCE(1);
|
|
volatile mp_uint_t rtc_overflows = 0;
|
|
|
|
const nrfx_rtc_config_t rtc_config_time_ticks = {
|
|
.prescaler = 0,
|
|
.reliable = 0,
|
|
.tick_latency = 0,
|
|
#ifdef NRF51
|
|
.interrupt_priority = 1,
|
|
#else
|
|
.interrupt_priority = 3,
|
|
#endif
|
|
};
|
|
|
|
STATIC void rtc_irq_time(nrfx_rtc_int_type_t event) {
|
|
// irq handler for overflow
|
|
if (event == NRFX_RTC_INT_OVERFLOW) {
|
|
rtc_overflows += 1;
|
|
}
|
|
// irq handler for wakeup from WFI (~1msec)
|
|
if (event == NRFX_RTC_INT_COMPARE0) {
|
|
RTC_RESCHEDULE_CC(rtc1, 0, RTC_TICK_INCREASE_MSEC)
|
|
}
|
|
}
|
|
|
|
void rtc1_init_time_ticks(void) {
|
|
// Start the low-frequency clock (if it hasn't been started already)
|
|
if (!nrf_clock_lf_is_running(NRF_CLOCK)) {
|
|
nrf_clock_task_trigger(NRF_CLOCK, NRF_CLOCK_TASK_LFCLKSTART);
|
|
}
|
|
// Uninitialize first, then set overflow IRQ and first CC event
|
|
nrfx_rtc_uninit(&rtc1);
|
|
nrfx_rtc_init(&rtc1, &rtc_config_time_ticks, rtc_irq_time);
|
|
nrfx_rtc_overflow_enable(&rtc1, true);
|
|
RTC_RESCHEDULE_CC(rtc1, 0, RTC_TICK_INCREASE_MSEC)
|
|
nrfx_rtc_enable(&rtc1);
|
|
}
|
|
|
|
mp_uint_t mp_hal_ticks_ms(void) {
|
|
// Compute: (rtc_overflows << 24 + COUNTER) * 1000 / 32768
|
|
//
|
|
// Note that COUNTER * 1000 / 32768 would overflow during calculation, so use
|
|
// the less obvious * 125 / 4096 calculation (overflow secure).
|
|
//
|
|
// Make sure not to call this function within an irq with higher prio than the
|
|
// RTC's irq. This would introduce the danger of preempting the RTC irq and
|
|
// calling mp_hal_ticks_ms() at that time would return a false result.
|
|
uint32_t overflows;
|
|
uint32_t counter;
|
|
// guard against overflow irq
|
|
RTC1_GET_TICKS_ATOMIC(rtc1, overflows, counter)
|
|
return (overflows << 9) * 1000 + (counter * 125 / 4096);
|
|
}
|
|
|
|
mp_uint_t mp_hal_ticks_us(void) {
|
|
// Compute: ticks_us = (overflows << 24 + counter) * 1000000 / 32768
|
|
// = (overflows << 15 * 15625) + (counter * 15625 / 512)
|
|
// Since this function is likely to be called in a poll loop it must
|
|
// be fast, using an optimized 64bit mult/divide.
|
|
uint32_t overflows;
|
|
uint32_t counter;
|
|
// guard against overflow irq
|
|
RTC1_GET_TICKS_ATOMIC(rtc1, overflows, counter)
|
|
// first compute counter * 15625
|
|
uint32_t counter_lo = (counter & 0xffff) * 15625;
|
|
uint32_t counter_hi = (counter >> 16) * 15625;
|
|
// actual value is counter_hi << 16 + counter_lo
|
|
return ((overflows << 15) * 15625) + ((counter_hi << 7) + (counter_lo >> 9));
|
|
}
|
|
|
|
#else
|
|
|
|
mp_uint_t mp_hal_ticks_ms(void) {
|
|
return 0;
|
|
}
|
|
|
|
#endif
|
|
|
|
uint64_t mp_hal_time_ns(void) {
|
|
return 0;
|
|
}
|
|
|
|
// this table converts from HAL_StatusTypeDef to POSIX errno
|
|
const byte mp_hal_status_to_errno_table[4] = {
|
|
[HAL_OK] = 0,
|
|
[HAL_ERROR] = MP_EIO,
|
|
[HAL_BUSY] = MP_EBUSY,
|
|
[HAL_TIMEOUT] = MP_ETIMEDOUT,
|
|
};
|
|
|
|
NORETURN void mp_hal_raise(HAL_StatusTypeDef status) {
|
|
mp_raise_OSError(mp_hal_status_to_errno_table[status]);
|
|
}
|
|
|
|
#if !MICROPY_KBD_EXCEPTION
|
|
void mp_hal_set_interrupt_char(int c) {
|
|
|
|
}
|
|
#endif
|
|
|
|
#if !MICROPY_PY_BLE_NUS && !MICROPY_HW_USB_CDC
|
|
uintptr_t mp_hal_stdio_poll(uintptr_t poll_flags) {
|
|
uintptr_t ret = 0;
|
|
if ((poll_flags & MP_STREAM_POLL_RD) && MP_STATE_VM(dupterm_objs[0]) != MP_OBJ_NULL
|
|
&& uart_rx_any(MP_STATE_VM(dupterm_objs[0]))) {
|
|
ret |= MP_STREAM_POLL_RD;
|
|
}
|
|
if ((poll_flags & MP_STREAM_POLL_WR) && MP_STATE_VM(dupterm_objs[0]) != MP_OBJ_NULL) {
|
|
ret |= MP_STREAM_POLL_WR;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
int mp_hal_stdin_rx_chr(void) {
|
|
for (;;) {
|
|
if (MP_STATE_VM(dupterm_objs[0]) != MP_OBJ_NULL && uart_rx_any(MP_STATE_VM(dupterm_objs[0]))) {
|
|
return uart_rx_char(MP_STATE_VM(dupterm_objs[0]));
|
|
}
|
|
MICROPY_EVENT_POLL_HOOK
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
mp_uint_t mp_hal_stdout_tx_strn(const char *str, mp_uint_t len) {
|
|
if (MP_STATE_VM(dupterm_objs[0]) != MP_OBJ_NULL) {
|
|
uart_tx_strn(MP_STATE_VM(dupterm_objs[0]), str, len);
|
|
return len;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
void mp_hal_stdout_tx_strn_cooked(const char *str, mp_uint_t len) {
|
|
if (MP_STATE_VM(dupterm_objs[0]) != MP_OBJ_NULL) {
|
|
uart_tx_strn_cooked(MP_STATE_VM(dupterm_objs[0]), str, len);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
void mp_hal_stdout_tx_str(const char *str) {
|
|
mp_hal_stdout_tx_strn(str, strlen(str));
|
|
}
|
|
|
|
#if MICROPY_PY_TIME_TICKS
|
|
|
|
void mp_hal_delay_us(mp_uint_t us) {
|
|
uint32_t now;
|
|
if (us == 0) {
|
|
return;
|
|
}
|
|
now = mp_hal_ticks_us();
|
|
while (mp_hal_ticks_us() - now < us) {
|
|
}
|
|
}
|
|
|
|
void mp_hal_delay_ms(mp_uint_t ms) {
|
|
uint32_t now;
|
|
if (ms == 0) {
|
|
return;
|
|
}
|
|
now = mp_hal_ticks_ms();
|
|
while (mp_hal_ticks_ms() - now < ms) {
|
|
MICROPY_EVENT_POLL_HOOK
|
|
}
|
|
}
|
|
|
|
#else
|
|
|
|
void mp_hal_delay_us(mp_uint_t us) {
|
|
if (us == 0) {
|
|
return;
|
|
}
|
|
register uint32_t delay __ASM("r0") = us;
|
|
__ASM volatile (
|
|
"1:\n"
|
|
#ifdef NRF51
|
|
" SUB %0, %0, #1\n"
|
|
#else
|
|
" SUBS %0, %0, #1\n"
|
|
#endif
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
#if defined(NRF52) || defined(NRF9160_XXAA)
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
" NOP\n"
|
|
#endif
|
|
" BNE 1b\n"
|
|
: "+r" (delay));
|
|
}
|
|
|
|
void mp_hal_delay_ms(mp_uint_t ms) {
|
|
for (mp_uint_t i = 0; i < ms; i++)
|
|
{
|
|
mp_hal_delay_us(999);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
#if defined(NRFX_LOG_ENABLED) && (NRFX_LOG_ENABLED == 1)
|
|
|
|
static const char nrfx_error_unknown[1] = "";
|
|
|
|
static const char nrfx_error_success[] = "NRFX_SUCCESS";
|
|
static const char nrfx_error_internal[] = "NRFX_ERROR_INTERNAL";
|
|
static const char nrfx_error_no_mem[] = "NRFX_ERROR_NO_MEM";
|
|
static const char nrfx_error_not_supported[] = "NRFX_ERROR_NOT_SUPPORTED";
|
|
static const char nrfx_error_invalid_param[] = "NRFX_ERROR_INVALID_PARAM";
|
|
static const char nrfx_error_invalid_state[] = "NRFX_ERROR_INVALID_STATE";
|
|
static const char nrfx_error_invalid_length[] = "NRFX_ERROR_INVALID_LENGTH";
|
|
static const char nrfx_error_timeout[] = "NRFX_ERROR_TIMEOUT";
|
|
static const char nrfx_error_forbidden[] = "NRFX_ERROR_FORBIDDEN";
|
|
static const char nrfx_error_null[] = "NRFX_ERROR_NULL";
|
|
static const char nrfx_error_invalid_addr[] = "NRFX_ERROR_INVALID_ADDR";
|
|
static const char nrfx_error_busy[] = "NRFX_ERROR_BUSY";
|
|
static const char nrfx_error_already_initalized[] = "NRFX_ERROR_ALREADY_INITIALIZED";
|
|
|
|
static const char *nrfx_error_strings[13] = {
|
|
nrfx_error_success,
|
|
nrfx_error_internal,
|
|
nrfx_error_no_mem,
|
|
nrfx_error_not_supported,
|
|
nrfx_error_invalid_param,
|
|
nrfx_error_invalid_state,
|
|
nrfx_error_invalid_length,
|
|
nrfx_error_timeout,
|
|
nrfx_error_forbidden,
|
|
nrfx_error_null,
|
|
nrfx_error_invalid_addr,
|
|
nrfx_error_busy,
|
|
nrfx_error_already_initalized
|
|
};
|
|
|
|
static const char nrfx_drv_error_twi_err_overrun[] = "NRFX_ERROR_DRV_TWI_ERR_OVERRUN";
|
|
static const char nrfx_drv_error_twi_err_anack[] = "NRFX_ERROR_DRV_TWI_ERR_ANACK";
|
|
static const char nrfx_drv_error_twi_err_dnack[] = "NRFX_ERROR_DRV_TWI_ERR_DNACK";
|
|
|
|
static const char *nrfx_drv_error_strings[3] = {
|
|
nrfx_drv_error_twi_err_overrun,
|
|
nrfx_drv_error_twi_err_anack,
|
|
nrfx_drv_error_twi_err_dnack
|
|
};
|
|
|
|
const char *nrfx_error_code_lookup(uint32_t err_code) {
|
|
if (err_code >= NRFX_ERROR_BASE_NUM && err_code <= NRFX_ERROR_BASE_NUM + 13) {
|
|
return nrfx_error_strings[err_code - NRFX_ERROR_BASE_NUM];
|
|
} else if (err_code >= NRFX_ERROR_DRIVERS_BASE_NUM && err_code <= NRFX_ERROR_DRIVERS_BASE_NUM + 3) {
|
|
return nrfx_drv_error_strings[err_code - NRFX_ERROR_DRIVERS_BASE_NUM];
|
|
}
|
|
|
|
return nrfx_error_unknown;
|
|
}
|
|
|
|
#endif // NRFX_LOG_ENABLED
|