Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 1 | /* |
| 2 | * This file is part of the Micro Python project, http://micropython.org/ |
| 3 | * |
| 4 | * The MIT License (MIT) |
| 5 | * |
| 6 | * Copyright (c) 2014 Damien P. George |
| 7 | * |
| 8 | * Permission is hereby granted, free of charge, to any person obtaining a copy |
| 9 | * of this software and associated documentation files (the "Software"), to deal |
| 10 | * in the Software without restriction, including without limitation the rights |
| 11 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
| 12 | * copies of the Software, and to permit persons to whom the Software is |
| 13 | * furnished to do so, subject to the following conditions: |
| 14 | * |
| 15 | * The above copyright notice and this permission notice shall be included in |
| 16 | * all copies or substantial portions of the Software. |
| 17 | * |
| 18 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| 19 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| 20 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
| 21 | * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
| 22 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
| 23 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
| 24 | * THE SOFTWARE. |
| 25 | */ |
| 26 | |
| 27 | #include <stdio.h> |
| 28 | #include "ets_sys.h" |
| 29 | #include "etshal.h" |
| 30 | #include "uart.h" |
| 31 | #include "esp_mphal.h" |
Josef Gajdusek | 800d5cd | 2015-05-10 17:54:09 +0200 | [diff] [blame] | 32 | #include "user_interface.h" |
Paul Sokolovsky | a099bfe | 2016-03-11 09:38:20 +0700 | [diff] [blame] | 33 | #include "ets_alt_task.h" |
Paul Sokolovsky | 8ab16b6 | 2015-12-29 20:44:55 +0200 | [diff] [blame] | 34 | #include "py/obj.h" |
| 35 | #include "py/mpstate.h" |
Paul Sokolovsky | c961889 | 2016-03-29 11:13:32 +0300 | [diff] [blame] | 36 | #include "extmod/misc.h" |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 37 | #include "lib/utils/pyexec.h" |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 38 | |
Paul Sokolovsky | 61fa7c8 | 2016-03-30 18:50:38 +0300 | [diff] [blame] | 39 | STATIC byte input_buf_array[256]; |
| 40 | ringbuf_t input_buf = {input_buf_array, sizeof(input_buf_array)}; |
Paul Sokolovsky | 402a743 | 2016-03-29 11:48:43 +0300 | [diff] [blame] | 41 | void mp_hal_debug_tx_strn_cooked(void *env, const char *str, uint32_t len); |
| 42 | const mp_print_t mp_debug_print = {NULL, mp_hal_debug_tx_strn_cooked}; |
| 43 | |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 44 | void mp_hal_init(void) { |
Paul Sokolovsky | f2a21a2 | 2016-08-20 16:33:04 +0300 | [diff] [blame] | 45 | //ets_wdt_disable(); // it's a pain while developing |
Paul Sokolovsky | a4c8ef9 | 2016-02-08 21:43:37 +0200 | [diff] [blame] | 46 | mp_hal_rtc_init(); |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 47 | uart_init(UART_BIT_RATE_115200, UART_BIT_RATE_115200); |
| 48 | } |
| 49 | |
Paul Sokolovsky | 5699fc9 | 2015-10-29 02:06:13 +0300 | [diff] [blame] | 50 | void mp_hal_delay_us(uint32_t us) { |
Damien George | e673714 | 2016-03-23 13:01:21 +0200 | [diff] [blame] | 51 | uint32_t start = system_get_time(); |
| 52 | while (system_get_time() - start < us) { |
| 53 | ets_event_poll(); |
| 54 | } |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 55 | } |
| 56 | |
Damien George | 0b32e50 | 2015-02-13 15:04:53 +0000 | [diff] [blame] | 57 | int mp_hal_stdin_rx_chr(void) { |
| 58 | for (;;) { |
Paul Sokolovsky | 785cf9a | 2016-04-01 14:02:36 +0300 | [diff] [blame] | 59 | int c = ringbuf_get(&input_buf); |
Damien George | 0b32e50 | 2015-02-13 15:04:53 +0000 | [diff] [blame] | 60 | if (c != -1) { |
| 61 | return c; |
| 62 | } |
Paul Sokolovsky | 4b3f1d7 | 2016-09-19 00:23:38 +0300 | [diff] [blame^] | 63 | #if 0 |
| 64 | // Idles CPU but need more testing before enabling |
| 65 | if (!ets_loop_iter()) { |
| 66 | asm("waiti 0"); |
| 67 | } |
| 68 | #else |
Paul Sokolovsky | 5699fc9 | 2015-10-29 02:06:13 +0300 | [diff] [blame] | 69 | mp_hal_delay_us(1); |
Paul Sokolovsky | 4b3f1d7 | 2016-09-19 00:23:38 +0300 | [diff] [blame^] | 70 | #endif |
Damien George | 0b32e50 | 2015-02-13 15:04:53 +0000 | [diff] [blame] | 71 | } |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 72 | } |
| 73 | |
Paul Sokolovsky | c961889 | 2016-03-29 11:13:32 +0300 | [diff] [blame] | 74 | void mp_hal_stdout_tx_char(char c) { |
| 75 | uart_tx_one_char(UART0, c); |
| 76 | mp_uos_dupterm_tx_strn(&c, 1); |
| 77 | } |
| 78 | |
Paul Sokolovsky | 402a743 | 2016-03-29 11:48:43 +0300 | [diff] [blame] | 79 | #if 0 |
| 80 | void mp_hal_debug_str(const char *str) { |
| 81 | while (*str) { |
| 82 | uart_tx_one_char(UART0, *str++); |
| 83 | } |
| 84 | uart_flush(UART0); |
| 85 | } |
| 86 | #endif |
| 87 | |
Damien George | 0b32e50 | 2015-02-13 15:04:53 +0000 | [diff] [blame] | 88 | void mp_hal_stdout_tx_str(const char *str) { |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 89 | while (*str) { |
Paul Sokolovsky | c961889 | 2016-03-29 11:13:32 +0300 | [diff] [blame] | 90 | mp_hal_stdout_tx_char(*str++); |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 91 | } |
| 92 | } |
| 93 | |
Damien George | 0b32e50 | 2015-02-13 15:04:53 +0000 | [diff] [blame] | 94 | void mp_hal_stdout_tx_strn(const char *str, uint32_t len) { |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 95 | while (len--) { |
Paul Sokolovsky | c961889 | 2016-03-29 11:13:32 +0300 | [diff] [blame] | 96 | mp_hal_stdout_tx_char(*str++); |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 97 | } |
| 98 | } |
| 99 | |
Damien George | 0b32e50 | 2015-02-13 15:04:53 +0000 | [diff] [blame] | 100 | void mp_hal_stdout_tx_strn_cooked(const char *str, uint32_t len) { |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 101 | while (len--) { |
| 102 | if (*str == '\n') { |
Paul Sokolovsky | c961889 | 2016-03-29 11:13:32 +0300 | [diff] [blame] | 103 | mp_hal_stdout_tx_char('\r'); |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 104 | } |
Paul Sokolovsky | c961889 | 2016-03-29 11:13:32 +0300 | [diff] [blame] | 105 | mp_hal_stdout_tx_char(*str++); |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 106 | } |
| 107 | } |
| 108 | |
Paul Sokolovsky | 402a743 | 2016-03-29 11:48:43 +0300 | [diff] [blame] | 109 | void mp_hal_debug_tx_strn_cooked(void *env, const char *str, uint32_t len) { |
| 110 | (void)env; |
| 111 | while (len--) { |
| 112 | if (*str == '\n') { |
| 113 | uart_tx_one_char(UART0, '\r'); |
| 114 | } |
| 115 | uart_tx_one_char(UART0, *str++); |
| 116 | } |
| 117 | } |
| 118 | |
Paul Sokolovsky | 6a09e7d | 2015-10-29 19:35:04 +0300 | [diff] [blame] | 119 | uint32_t mp_hal_ticks_ms(void) { |
Josef Gajdusek | 800d5cd | 2015-05-10 17:54:09 +0200 | [diff] [blame] | 120 | return system_get_time() / 1000; |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 121 | } |
| 122 | |
Damien George | b41a14a | 2015-12-28 17:27:44 +0000 | [diff] [blame] | 123 | uint32_t mp_hal_ticks_us(void) { |
| 124 | return system_get_time(); |
| 125 | } |
| 126 | |
Paul Sokolovsky | ebd9f55 | 2015-10-29 13:03:44 +0300 | [diff] [blame] | 127 | void mp_hal_delay_ms(uint32_t delay) { |
| 128 | mp_hal_delay_us(delay * 1000); |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 129 | } |
| 130 | |
| 131 | void mp_hal_set_interrupt_char(int c) { |
Paul Sokolovsky | d3a4d39 | 2015-12-20 13:58:58 +0200 | [diff] [blame] | 132 | if (c != -1) { |
| 133 | mp_obj_exception_clear_traceback(MP_STATE_PORT(mp_kbd_exception)); |
| 134 | } |
| 135 | extern int interrupt_char; |
| 136 | interrupt_char = c; |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 137 | } |
Paul Sokolovsky | 8ab16b6 | 2015-12-29 20:44:55 +0200 | [diff] [blame] | 138 | |
Paul Sokolovsky | a099bfe | 2016-03-11 09:38:20 +0700 | [diff] [blame] | 139 | void ets_event_poll(void) { |
| 140 | ets_loop_iter(); |
| 141 | if (MP_STATE_VM(mp_pending_exception) != NULL) { |
| 142 | mp_obj_t obj = MP_STATE_VM(mp_pending_exception); |
| 143 | MP_STATE_VM(mp_pending_exception) = MP_OBJ_NULL; |
| 144 | nlr_raise(obj); |
| 145 | } |
| 146 | } |
| 147 | |
Paul Sokolovsky | 8ab16b6 | 2015-12-29 20:44:55 +0200 | [diff] [blame] | 148 | void __assert_func(const char *file, int line, const char *func, const char *expr) { |
| 149 | printf("assert:%s:%d:%s: %s\n", file, line, func, expr); |
| 150 | nlr_raise(mp_obj_new_exception_msg(&mp_type_AssertionError, |
| 151 | "C-level assert")); |
| 152 | } |
Paul Sokolovsky | 61fa7c8 | 2016-03-30 18:50:38 +0300 | [diff] [blame] | 153 | |
| 154 | void mp_hal_signal_input(void) { |
Paul Sokolovsky | 785cf9a | 2016-04-01 14:02:36 +0300 | [diff] [blame] | 155 | #if MICROPY_REPL_EVENT_DRIVEN |
Paul Sokolovsky | 61fa7c8 | 2016-03-30 18:50:38 +0300 | [diff] [blame] | 156 | system_os_post(UART_TASK_ID, 0, 0); |
Paul Sokolovsky | 785cf9a | 2016-04-01 14:02:36 +0300 | [diff] [blame] | 157 | #endif |
Paul Sokolovsky | 61fa7c8 | 2016-03-30 18:50:38 +0300 | [diff] [blame] | 158 | } |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 159 | |
| 160 | static int call_dupterm_read(void) { |
| 161 | if (MP_STATE_PORT(term_obj) == NULL) { |
| 162 | return -1; |
| 163 | } |
| 164 | |
| 165 | nlr_buf_t nlr; |
| 166 | if (nlr_push(&nlr) == 0) { |
Paul Sokolovsky | a22b6eb | 2016-07-04 21:34:40 +0300 | [diff] [blame] | 167 | mp_obj_t readinto_m[3]; |
| 168 | mp_load_method(MP_STATE_PORT(term_obj), MP_QSTR_readinto, readinto_m); |
| 169 | readinto_m[2] = MP_STATE_PORT(dupterm_arr_obj); |
| 170 | mp_obj_t res = mp_call_method_n_kw(1, 0, readinto_m); |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 171 | if (res == mp_const_none) { |
Paul Sokolovsky | 116eeee | 2016-05-24 01:30:28 +0300 | [diff] [blame] | 172 | nlr_pop(); |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 173 | return -2; |
| 174 | } |
Paul Sokolovsky | 3805618 | 2016-07-05 14:18:12 +0300 | [diff] [blame] | 175 | if (res == MP_OBJ_NEW_SMALL_INT(0)) { |
Paul Sokolovsky | 0ab3725 | 2016-05-20 22:20:37 +0300 | [diff] [blame] | 176 | mp_uos_deactivate("dupterm: EOF received, deactivating\n", MP_OBJ_NULL); |
Paul Sokolovsky | 2b05b60 | 2016-05-24 15:04:59 +0300 | [diff] [blame] | 177 | nlr_pop(); |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 178 | return -1; |
| 179 | } |
Paul Sokolovsky | 3805618 | 2016-07-05 14:18:12 +0300 | [diff] [blame] | 180 | mp_buffer_info_t bufinfo; |
| 181 | mp_get_buffer_raise(MP_STATE_PORT(dupterm_arr_obj), &bufinfo, MP_BUFFER_READ); |
Paul Sokolovsky | 2b05b60 | 2016-05-24 15:04:59 +0300 | [diff] [blame] | 182 | nlr_pop(); |
Paul Sokolovsky | 4681b86 | 2016-05-24 01:37:56 +0300 | [diff] [blame] | 183 | if (*(byte*)bufinfo.buf == interrupt_char) { |
| 184 | mp_keyboard_interrupt(); |
| 185 | return -2; |
| 186 | } |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 187 | return *(byte*)bufinfo.buf; |
| 188 | } else { |
Paul Sokolovsky | 0ab3725 | 2016-05-20 22:20:37 +0300 | [diff] [blame] | 189 | mp_uos_deactivate("dupterm: Exception in read() method, deactivating: ", nlr.ret_val); |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 190 | } |
| 191 | |
| 192 | return -1; |
| 193 | } |
| 194 | |
| 195 | STATIC void dupterm_task_handler(os_event_t *evt) { |
Paul Sokolovsky | 6f3b993 | 2016-04-17 18:11:04 +0300 | [diff] [blame] | 196 | static byte lock; |
| 197 | if (lock) { |
| 198 | return; |
| 199 | } |
| 200 | lock = 1; |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 201 | while (1) { |
| 202 | int c = call_dupterm_read(); |
| 203 | if (c < 0) { |
| 204 | break; |
| 205 | } |
| 206 | ringbuf_put(&input_buf, c); |
| 207 | } |
| 208 | mp_hal_signal_input(); |
Paul Sokolovsky | 6f3b993 | 2016-04-17 18:11:04 +0300 | [diff] [blame] | 209 | lock = 0; |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 210 | } |
| 211 | |
| 212 | STATIC os_event_t dupterm_evt_queue[4]; |
| 213 | |
| 214 | void dupterm_task_init() { |
| 215 | system_os_task(dupterm_task_handler, DUPTERM_TASK_ID, dupterm_evt_queue, MP_ARRAY_SIZE(dupterm_evt_queue)); |
| 216 | } |
| 217 | |
| 218 | void mp_hal_signal_dupterm_input(void) { |
| 219 | system_os_post(DUPTERM_TASK_ID, 0, 0); |
| 220 | } |
Damien George | a2d5d84 | 2016-04-22 10:04:12 +0100 | [diff] [blame] | 221 | |
Damien George | 4b37e77 | 2016-05-26 17:06:40 +0100 | [diff] [blame] | 222 | void mp_hal_pin_open_drain(mp_hal_pin_obj_t pin_id) { |
Damien George | a2d5d84 | 2016-04-22 10:04:12 +0100 | [diff] [blame] | 223 | const pyb_pin_obj_t *pin = &pyb_pin_obj[pin_id]; |
Damien George | 67a6d31 | 2016-04-22 10:35:26 +0100 | [diff] [blame] | 224 | |
| 225 | if (pin->phys_port == 16) { |
| 226 | // configure GPIO16 as input with output register holding 0 |
| 227 | WRITE_PERI_REG(PAD_XPD_DCDC_CONF, (READ_PERI_REG(PAD_XPD_DCDC_CONF) & 0xffffffbc) | 1); |
| 228 | WRITE_PERI_REG(RTC_GPIO_CONF, READ_PERI_REG(RTC_GPIO_CONF) & ~1); |
| 229 | WRITE_PERI_REG(RTC_GPIO_ENABLE, (READ_PERI_REG(RTC_GPIO_ENABLE) & ~1)); // input |
| 230 | WRITE_PERI_REG(RTC_GPIO_OUT, (READ_PERI_REG(RTC_GPIO_OUT) & ~1)); // out=0 |
| 231 | return; |
| 232 | } |
| 233 | |
Damien George | a2d5d84 | 2016-04-22 10:04:12 +0100 | [diff] [blame] | 234 | ETS_GPIO_INTR_DISABLE(); |
| 235 | PIN_FUNC_SELECT(pin->periph, pin->func); |
| 236 | GPIO_REG_WRITE(GPIO_PIN_ADDR(GPIO_ID_PIN(pin->phys_port)), |
| 237 | GPIO_REG_READ(GPIO_PIN_ADDR(GPIO_ID_PIN(pin->phys_port))) |
| 238 | | GPIO_PIN_PAD_DRIVER_SET(GPIO_PAD_DRIVER_ENABLE)); // open drain |
| 239 | GPIO_REG_WRITE(GPIO_ENABLE_ADDRESS, |
| 240 | GPIO_REG_READ(GPIO_ENABLE_ADDRESS) | (1 << pin->phys_port)); |
| 241 | ETS_GPIO_INTR_ENABLE(); |
| 242 | } |
Paul Sokolovsky | 3d83041 | 2016-05-03 00:18:14 +0300 | [diff] [blame] | 243 | |
| 244 | // Get pointer to esf_buf bookkeeping structure |
| 245 | void *ets_get_esf_buf_ctlblk(void) { |
| 246 | // Get literal ptr before start of esf_rx_buf_alloc func |
| 247 | extern void *esf_rx_buf_alloc(); |
| 248 | return ((void**)esf_rx_buf_alloc)[-1]; |
| 249 | } |
| 250 | |
| 251 | // Get number of esf_buf free buffers of given type, as encoded by index |
| 252 | // idx 0 corresponds to buf types 1, 2; 1 - 4; 2 - 5; 3 - 7; 4 - 8 |
| 253 | // Only following buf types appear to be used: |
| 254 | // 1 - tx buffer, 5 - management frame tx buffer; 8 - rx buffer |
| 255 | int ets_esf_free_bufs(int idx) { |
| 256 | uint32_t *p = ets_get_esf_buf_ctlblk(); |
| 257 | uint32_t *b = (uint32_t*)p[idx]; |
| 258 | int cnt = 0; |
| 259 | while (b) { |
| 260 | b = (uint32_t*)b[0x20 / 4]; |
| 261 | cnt++; |
| 262 | } |
| 263 | return cnt; |
| 264 | } |
Paul Sokolovsky | 64ad838 | 2016-07-31 02:30:05 +0300 | [diff] [blame] | 265 | |
| 266 | extern int mp_stream_errno; |
| 267 | int *__errno() { |
| 268 | return &mp_stream_errno; |
| 269 | } |