mphalport.c 4.44 KB
Newer Older
1
#include <string.h>
2

3
#include "py/mpstate.h"
4
#include "py/runtime.h"
5
#include "py/mperrno.h"
6
#include "py/mphal.h"
7
#include "usb.h"
8
#include "uart.h"
9

10
11
bool mp_hal_ticks_cpu_enabled = false;

12
13
14
// this table converts from HAL_StatusTypeDef to POSIX errno
const byte mp_hal_status_to_errno_table[4] = {
    [HAL_OK] = 0,
15
16
17
    [HAL_ERROR] = MP_EIO,
    [HAL_BUSY] = MP_EBUSY,
    [HAL_TIMEOUT] = MP_ETIMEDOUT,
18
19
20
};

NORETURN void mp_hal_raise(HAL_StatusTypeDef status) {
21
    mp_raise_OSError(mp_hal_status_to_errno_table[status]);
22
}
23
24
25
26

void mp_hal_set_interrupt_char(int c) {
    usb_vcp_set_interrupt_char(c);
}
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45

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

        byte c;
        if (usb_vcp_recv_byte(&c) != 0) {
            return c;
        } else if (MP_STATE_PORT(pyb_stdio_uart) != NULL && uart_rx_any(MP_STATE_PORT(pyb_stdio_uart))) {
            return uart_rx_char(MP_STATE_PORT(pyb_stdio_uart));
        }
46
        MICROPY_EVENT_POLL_HOOK
47
48
49
50
51
52
53
    }
}

void mp_hal_stdout_tx_str(const char *str) {
    mp_hal_stdout_tx_strn(str, strlen(str));
}

54
void mp_hal_stdout_tx_strn(const char *str, size_t len) {
55
56
57
58
59
60
61
62
63
64
65
    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
    if (usb_vcp_is_enabled()) {
        usb_vcp_send_strn(str, len);
    }
}

66
void mp_hal_stdout_tx_strn_cooked(const char *str, size_t len) {
67
68
69
70
71
72
73
74
    // send stdout to UART and USB CDC VCP
    if (MP_STATE_PORT(pyb_stdio_uart) != NULL) {
        uart_tx_strn_cooked(MP_STATE_PORT(pyb_stdio_uart), str, len);
    }
    if (usb_vcp_is_enabled()) {
        usb_vcp_send_strn_cooked(str, len);
    }
}
75

76
77
78
79
80
81
82
83
84
void mp_hal_ticks_cpu_enable(void) {
    if (!mp_hal_ticks_cpu_enabled) {
        CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
        DWT->CYCCNT = 0;
        DWT->CTRL |= DWT_CTRL_CYCCNTENA_Msk;
        mp_hal_ticks_cpu_enabled = true;
    }
}

85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
void mp_hal_gpio_clock_enable(GPIO_TypeDef *gpio) {
    if (0) {
    #ifdef __GPIOA_CLK_ENABLE
    } else if (gpio == GPIOA) {
        __GPIOA_CLK_ENABLE();
    #endif
    #ifdef __GPIOB_CLK_ENABLE
    } else if (gpio == GPIOB) {
        __GPIOB_CLK_ENABLE();
    #endif
    #ifdef __GPIOC_CLK_ENABLE
    } else if (gpio == GPIOC) {
        __GPIOC_CLK_ENABLE();
    #endif
    #ifdef __GPIOD_CLK_ENABLE
    } else if (gpio == GPIOD) {
        __GPIOD_CLK_ENABLE();
    #endif
    #ifdef __GPIOE_CLK_ENABLE
    } else if (gpio == GPIOE) {
        __GPIOE_CLK_ENABLE();
    #endif
107
    #if defined(GPIOF) && defined(__GPIOF_CLK_ENABLE)
108
109
110
    } else if (gpio == GPIOF) {
        __GPIOF_CLK_ENABLE();
    #endif
111
    #if defined(GPIOG) && defined(__GPIOG_CLK_ENABLE)
112
    } else if (gpio == GPIOG) {
113
114
115
116
        #if defined(STM32L476xx) || defined(STM32L486xx)
        // Port G pins 2 thru 15 are powered using VddIO2 on these MCUs.
        HAL_PWREx_EnableVddIO2();
        #endif
117
118
119
120
121
122
        __GPIOG_CLK_ENABLE();
    #endif
    #ifdef __GPIOH_CLK_ENABLE
    } else if (gpio == GPIOH) {
        __GPIOH_CLK_ENABLE();
    #endif
123
    #if defined(GPIOI) && defined(__GPIOI_CLK_ENABLE)
124
125
126
    } else if (gpio == GPIOI) {
        __GPIOI_CLK_ENABLE();
    #endif
127
    #if defined(GPIOJ) && defined(__GPIOJ_CLK_ENABLE)
128
129
130
    } else if (gpio == GPIOJ) {
        __GPIOJ_CLK_ENABLE();
    #endif
131
    #if defined(GPIOK) && defined(__GPIOK_CLK_ENABLE)
132
133
134
135
136
    } else if (gpio == GPIOK) {
        __GPIOK_CLK_ENABLE();
    #endif
    }
}
137

138
139
140
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;
141
142
143
144
145
146
147
148
    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)));
}

149
bool mp_hal_pin_config_alt(mp_hal_pin_obj_t pin, uint32_t mode, uint32_t pull, uint8_t fn, uint8_t unit) {
150
151
152
153
    const pin_af_obj_t *af = pin_find_af(pin, fn, unit);
    if (af == NULL) {
        return false;
    }
154
    mp_hal_pin_config(pin, mode, pull, af->idx);
155
156
    return true;
}