2015-02-13 15:04:53 +00:00
|
|
|
#include <string.h>
|
2014-10-23 14:25:32 +01:00
|
|
|
|
2016-10-07 03:58:25 +01:00
|
|
|
#include "py/runtime.h"
|
2016-05-10 23:22:54 +01:00
|
|
|
#include "py/mperrno.h"
|
2015-10-30 23:03:58 +00:00
|
|
|
#include "py/mphal.h"
|
2017-10-19 04:16:42 +01:00
|
|
|
#include "extmod/misc.h"
|
2014-11-27 16:58:31 +00:00
|
|
|
#include "usb.h"
|
2015-02-13 15:04:53 +00:00
|
|
|
#include "uart.h"
|
2014-10-23 14:25:32 +01:00
|
|
|
|
|
|
|
// this table converts from HAL_StatusTypeDef to POSIX errno
|
|
|
|
const byte mp_hal_status_to_errno_table[4] = {
|
|
|
|
[HAL_OK] = 0,
|
2016-05-10 23:22:54 +01:00
|
|
|
[HAL_ERROR] = MP_EIO,
|
|
|
|
[HAL_BUSY] = MP_EBUSY,
|
|
|
|
[HAL_TIMEOUT] = MP_ETIMEDOUT,
|
2014-10-23 14:25:32 +01:00
|
|
|
};
|
|
|
|
|
|
|
|
NORETURN void mp_hal_raise(HAL_StatusTypeDef status) {
|
2016-10-07 03:58:25 +01:00
|
|
|
mp_raise_OSError(mp_hal_status_to_errno_table[status]);
|
2014-10-23 14:25:32 +01:00
|
|
|
}
|
2014-11-27 16:58:31 +00:00
|
|
|
|
2015-02-13 15:04:53 +00:00
|
|
|
int mp_hal_stdin_rx_chr(void) {
|
|
|
|
for (;;) {
|
|
|
|
#if 0
|
|
|
|
#ifdef USE_HOST_MODE
|
|
|
|
pyb_usb_host_process();
|
|
|
|
int c = pyb_usb_host_get_keyboard();
|
|
|
|
if (c != 0) {
|
|
|
|
return c;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
2018-02-13 07:51:08 +00:00
|
|
|
#if MICROPY_HW_ENABLE_USB
|
2015-02-13 15:04:53 +00:00
|
|
|
byte c;
|
|
|
|
if (usb_vcp_recv_byte(&c) != 0) {
|
|
|
|
return c;
|
2018-02-13 07:51:08 +00:00
|
|
|
}
|
|
|
|
#endif
|
|
|
|
if (MP_STATE_PORT(pyb_stdio_uart) != NULL && uart_rx_any(MP_STATE_PORT(pyb_stdio_uart))) {
|
2015-02-13 15:04:53 +00:00
|
|
|
return uart_rx_char(MP_STATE_PORT(pyb_stdio_uart));
|
|
|
|
}
|
2017-10-19 04:16:42 +01:00
|
|
|
int dupterm_c = mp_uos_dupterm_rx_chr();
|
|
|
|
if (dupterm_c >= 0) {
|
|
|
|
return dupterm_c;
|
|
|
|
}
|
2017-02-06 04:10:03 +00:00
|
|
|
MICROPY_EVENT_POLL_HOOK
|
2015-02-13 15:04:53 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
void mp_hal_stdout_tx_str(const char *str) {
|
|
|
|
mp_hal_stdout_tx_strn(str, strlen(str));
|
|
|
|
}
|
|
|
|
|
2015-10-30 23:03:58 +00:00
|
|
|
void mp_hal_stdout_tx_strn(const char *str, size_t len) {
|
2015-02-13 15:04:53 +00:00
|
|
|
if (MP_STATE_PORT(pyb_stdio_uart) != NULL) {
|
|
|
|
uart_tx_strn(MP_STATE_PORT(pyb_stdio_uart), str, len);
|
|
|
|
}
|
|
|
|
#if 0 && defined(USE_HOST_MODE) && MICROPY_HW_HAS_LCD
|
|
|
|
lcd_print_strn(str, len);
|
|
|
|
#endif
|
2018-02-13 07:51:08 +00:00
|
|
|
#if MICROPY_HW_ENABLE_USB
|
2015-02-13 15:04:53 +00:00
|
|
|
if (usb_vcp_is_enabled()) {
|
|
|
|
usb_vcp_send_strn(str, len);
|
|
|
|
}
|
2018-02-13 07:51:08 +00:00
|
|
|
#endif
|
2017-10-19 04:16:42 +01:00
|
|
|
mp_uos_dupterm_tx_strn(str, len);
|
2015-02-13 15:04:53 +00:00
|
|
|
}
|
|
|
|
|
2017-10-19 04:15:32 +01:00
|
|
|
// Efficiently convert "\n" to "\r\n"
|
2015-10-30 23:03:58 +00:00
|
|
|
void mp_hal_stdout_tx_strn_cooked(const char *str, size_t len) {
|
2017-10-19 04:15:32 +01:00
|
|
|
const char *last = str;
|
|
|
|
while (len--) {
|
|
|
|
if (*str == '\n') {
|
|
|
|
if (str > last) {
|
|
|
|
mp_hal_stdout_tx_strn(last, str - last);
|
|
|
|
}
|
|
|
|
mp_hal_stdout_tx_strn("\r\n", 2);
|
|
|
|
++str;
|
|
|
|
last = str;
|
|
|
|
} else {
|
|
|
|
++str;
|
|
|
|
}
|
2015-02-13 15:04:53 +00:00
|
|
|
}
|
2017-10-19 04:15:32 +01:00
|
|
|
if (str > last) {
|
|
|
|
mp_hal_stdout_tx_strn(last, str - last);
|
2015-02-13 15:04:53 +00:00
|
|
|
}
|
|
|
|
}
|
2015-08-03 00:05:16 +01:00
|
|
|
|
2016-10-18 04:30:00 +01:00
|
|
|
void mp_hal_ticks_cpu_enable(void) {
|
2018-03-29 06:23:52 +01:00
|
|
|
if (!(DWT->CTRL & DWT_CTRL_CYCCNTENA_Msk)) {
|
2016-10-18 04:30:00 +01:00
|
|
|
CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
|
2017-03-10 03:58:26 +00:00
|
|
|
#if defined(__CORTEX_M) && __CORTEX_M == 7
|
|
|
|
// on Cortex-M7 we must unlock the DWT before writing to its registers
|
|
|
|
DWT->LAR = 0xc5acce55;
|
|
|
|
#endif
|
2016-10-18 04:30:00 +01:00
|
|
|
DWT->CYCCNT = 0;
|
|
|
|
DWT->CTRL |= DWT_CTRL_CYCCNTENA_Msk;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2015-08-03 00:05:16 +01:00
|
|
|
void mp_hal_gpio_clock_enable(GPIO_TypeDef *gpio) {
|
|
|
|
if (0) {
|
2018-02-13 04:37:35 +00:00
|
|
|
#ifdef __HAL_RCC_GPIOA_CLK_ENABLE
|
2015-08-03 00:05:16 +01:00
|
|
|
} else if (gpio == GPIOA) {
|
2018-02-13 04:37:35 +00:00
|
|
|
__HAL_RCC_GPIOA_CLK_ENABLE();
|
2015-08-03 00:05:16 +01:00
|
|
|
#endif
|
2018-02-13 04:37:35 +00:00
|
|
|
#ifdef __HAL_RCC_GPIOB_CLK_ENABLE
|
2015-08-03 00:05:16 +01:00
|
|
|
} else if (gpio == GPIOB) {
|
2018-02-13 04:37:35 +00:00
|
|
|
__HAL_RCC_GPIOB_CLK_ENABLE();
|
2015-08-03 00:05:16 +01:00
|
|
|
#endif
|
2018-02-13 04:37:35 +00:00
|
|
|
#ifdef __HAL_RCC_GPIOC_CLK_ENABLE
|
2015-08-03 00:05:16 +01:00
|
|
|
} else if (gpio == GPIOC) {
|
2018-02-13 04:37:35 +00:00
|
|
|
__HAL_RCC_GPIOC_CLK_ENABLE();
|
2015-08-03 00:05:16 +01:00
|
|
|
#endif
|
2018-02-13 04:37:35 +00:00
|
|
|
#ifdef __HAL_RCC_GPIOD_CLK_ENABLE
|
2015-08-03 00:05:16 +01:00
|
|
|
} else if (gpio == GPIOD) {
|
2018-02-13 04:37:35 +00:00
|
|
|
__HAL_RCC_GPIOD_CLK_ENABLE();
|
2015-08-03 00:05:16 +01:00
|
|
|
#endif
|
2018-02-13 04:37:35 +00:00
|
|
|
#ifdef __HAL_RCC_GPIOE_CLK_ENABLE
|
2015-08-03 00:05:16 +01:00
|
|
|
} else if (gpio == GPIOE) {
|
2018-02-13 04:37:35 +00:00
|
|
|
__HAL_RCC_GPIOE_CLK_ENABLE();
|
2015-08-03 00:05:16 +01:00
|
|
|
#endif
|
2018-02-13 04:37:35 +00:00
|
|
|
#ifdef __HAL_RCC_GPIOF_CLK_ENABLE
|
2015-08-03 00:05:16 +01:00
|
|
|
} else if (gpio == GPIOF) {
|
2018-02-13 04:37:35 +00:00
|
|
|
__HAL_RCC_GPIOF_CLK_ENABLE();
|
2015-08-03 00:05:16 +01:00
|
|
|
#endif
|
2018-02-13 04:37:35 +00:00
|
|
|
#ifdef __HAL_RCC_GPIOG_CLK_ENABLE
|
2015-08-03 00:05:16 +01:00
|
|
|
} else if (gpio == GPIOG) {
|
2017-01-11 17:26:33 +00:00
|
|
|
#if defined(STM32L476xx) || defined(STM32L486xx)
|
|
|
|
// Port G pins 2 thru 15 are powered using VddIO2 on these MCUs.
|
|
|
|
HAL_PWREx_EnableVddIO2();
|
|
|
|
#endif
|
2018-02-13 04:37:35 +00:00
|
|
|
__HAL_RCC_GPIOG_CLK_ENABLE();
|
2015-08-03 00:05:16 +01:00
|
|
|
#endif
|
2018-02-13 04:37:35 +00:00
|
|
|
#ifdef __HAL_RCC_GPIOH_CLK_ENABLE
|
2015-08-03 00:05:16 +01:00
|
|
|
} else if (gpio == GPIOH) {
|
2018-02-13 04:37:35 +00:00
|
|
|
__HAL_RCC_GPIOH_CLK_ENABLE();
|
2015-08-03 00:05:16 +01:00
|
|
|
#endif
|
2018-02-13 04:37:35 +00:00
|
|
|
#ifdef __HAL_RCC_GPIOI_CLK_ENABLE
|
2015-08-03 00:05:16 +01:00
|
|
|
} else if (gpio == GPIOI) {
|
2018-02-13 04:37:35 +00:00
|
|
|
__HAL_RCC_GPIOI_CLK_ENABLE();
|
2015-08-03 00:05:16 +01:00
|
|
|
#endif
|
2018-02-13 04:37:35 +00:00
|
|
|
#ifdef __HAL_RCC_GPIOJ_CLK_ENABLE
|
2015-08-03 00:05:16 +01:00
|
|
|
} else if (gpio == GPIOJ) {
|
2018-02-13 04:37:35 +00:00
|
|
|
__HAL_RCC_GPIOJ_CLK_ENABLE();
|
2015-08-03 00:05:16 +01:00
|
|
|
#endif
|
2018-02-13 04:37:35 +00:00
|
|
|
#ifdef __HAL_RCC_GPIOK_CLK_ENABLE
|
2015-08-03 00:05:16 +01:00
|
|
|
} else if (gpio == GPIOK) {
|
2018-02-13 04:37:35 +00:00
|
|
|
__HAL_RCC_GPIOK_CLK_ENABLE();
|
2015-08-03 00:05:16 +01:00
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
2016-02-11 05:20:14 +00:00
|
|
|
|
2016-10-18 04:32:42 +01:00
|
|
|
void mp_hal_pin_config(mp_hal_pin_obj_t pin_obj, uint32_t mode, uint32_t pull, uint32_t alt) {
|
|
|
|
GPIO_TypeDef *gpio = pin_obj->gpio;
|
|
|
|
uint32_t pin = pin_obj->pin;
|
2016-04-12 13:50:47 +01:00
|
|
|
mp_hal_gpio_clock_enable(gpio);
|
|
|
|
gpio->MODER = (gpio->MODER & ~(3 << (2 * pin))) | ((mode & 3) << (2 * pin));
|
|
|
|
gpio->OTYPER = (gpio->OTYPER & ~(1 << pin)) | ((mode >> 2) << pin);
|
|
|
|
gpio->OSPEEDR = (gpio->OSPEEDR & ~(3 << (2 * pin))) | (2 << (2 * pin)); // full speed
|
|
|
|
gpio->PUPDR = (gpio->PUPDR & ~(3 << (2 * pin))) | (pull << (2 * pin));
|
|
|
|
gpio->AFR[pin >> 3] = (gpio->AFR[pin >> 3] & ~(15 << (4 * (pin & 7)))) | (alt << (4 * (pin & 7)));
|
|
|
|
}
|
|
|
|
|
2016-11-11 06:53:45 +00:00
|
|
|
bool mp_hal_pin_config_alt(mp_hal_pin_obj_t pin, uint32_t mode, uint32_t pull, uint8_t fn, uint8_t unit) {
|
2016-02-11 05:20:14 +00:00
|
|
|
const pin_af_obj_t *af = pin_find_af(pin, fn, unit);
|
|
|
|
if (af == NULL) {
|
|
|
|
return false;
|
|
|
|
}
|
2016-11-11 06:53:45 +00:00
|
|
|
mp_hal_pin_config(pin, mode, pull, af->idx);
|
2016-02-11 05:20:14 +00:00
|
|
|
return true;
|
|
|
|
}
|
2018-05-01 08:31:23 +01:00
|
|
|
|
|
|
|
void mp_hal_pin_config_speed(mp_hal_pin_obj_t pin_obj, uint32_t speed) {
|
|
|
|
GPIO_TypeDef *gpio = pin_obj->gpio;
|
|
|
|
uint32_t pin = pin_obj->pin;
|
|
|
|
gpio->OSPEEDR = (gpio->OSPEEDR & ~(3 << (2 * pin))) | (speed << (2 * pin));
|
|
|
|
}
|