Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 1 | /* |
Alexander Steffen | 55f3324 | 2017-06-30 09:22:17 +0200 | [diff] [blame] | 2 | * This file is part of the MicroPython project, http://micropython.org/ |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 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" |
Damien George | 1b7d672 | 2017-02-15 17:45:36 +1100 | [diff] [blame] | 34 | #include "py/runtime.h" |
Paul Sokolovsky | c961889 | 2016-03-29 11:13:32 +0300 | [diff] [blame] | 35 | #include "extmod/misc.h" |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 36 | #include "lib/utils/pyexec.h" |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 37 | |
Damien George | afd0701 | 2018-05-15 15:13:58 +1000 | [diff] [blame^] | 38 | STATIC byte stdin_ringbuf_array[256]; |
| 39 | ringbuf_t stdin_ringbuf = {stdin_ringbuf_array, sizeof(stdin_ringbuf_array), 0, 0}; |
Paul Sokolovsky | 402a743 | 2016-03-29 11:48:43 +0300 | [diff] [blame] | 40 | void mp_hal_debug_tx_strn_cooked(void *env, const char *str, uint32_t len); |
| 41 | const mp_print_t mp_debug_print = {NULL, mp_hal_debug_tx_strn_cooked}; |
| 42 | |
Damien George | afd0701 | 2018-05-15 15:13:58 +1000 | [diff] [blame^] | 43 | int uart_attached_to_dupterm; |
| 44 | |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 45 | void mp_hal_init(void) { |
Paul Sokolovsky | f2a21a2 | 2016-08-20 16:33:04 +0300 | [diff] [blame] | 46 | //ets_wdt_disable(); // it's a pain while developing |
Paul Sokolovsky | a4c8ef9 | 2016-02-08 21:43:37 +0200 | [diff] [blame] | 47 | mp_hal_rtc_init(); |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 48 | uart_init(UART_BIT_RATE_115200, UART_BIT_RATE_115200); |
Damien George | afd0701 | 2018-05-15 15:13:58 +1000 | [diff] [blame^] | 49 | uart_attached_to_dupterm = 0; |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 50 | } |
| 51 | |
Paul Sokolovsky | 5699fc9 | 2015-10-29 02:06:13 +0300 | [diff] [blame] | 52 | void mp_hal_delay_us(uint32_t us) { |
Damien George | e673714 | 2016-03-23 13:01:21 +0200 | [diff] [blame] | 53 | uint32_t start = system_get_time(); |
| 54 | while (system_get_time() - start < us) { |
| 55 | ets_event_poll(); |
| 56 | } |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 57 | } |
| 58 | |
Damien George | 0b32e50 | 2015-02-13 15:04:53 +0000 | [diff] [blame] | 59 | int mp_hal_stdin_rx_chr(void) { |
| 60 | for (;;) { |
Damien George | afd0701 | 2018-05-15 15:13:58 +1000 | [diff] [blame^] | 61 | int c = ringbuf_get(&stdin_ringbuf); |
Damien George | 0b32e50 | 2015-02-13 15:04:53 +0000 | [diff] [blame] | 62 | if (c != -1) { |
| 63 | return c; |
| 64 | } |
Paul Sokolovsky | 4b3f1d7 | 2016-09-19 00:23:38 +0300 | [diff] [blame] | 65 | #if 0 |
| 66 | // Idles CPU but need more testing before enabling |
| 67 | if (!ets_loop_iter()) { |
| 68 | asm("waiti 0"); |
| 69 | } |
| 70 | #else |
Paul Sokolovsky | 5699fc9 | 2015-10-29 02:06:13 +0300 | [diff] [blame] | 71 | mp_hal_delay_us(1); |
Paul Sokolovsky | 4b3f1d7 | 2016-09-19 00:23:38 +0300 | [diff] [blame] | 72 | #endif |
Damien George | 0b32e50 | 2015-02-13 15:04:53 +0000 | [diff] [blame] | 73 | } |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 74 | } |
| 75 | |
Paul Sokolovsky | 402a743 | 2016-03-29 11:48:43 +0300 | [diff] [blame] | 76 | #if 0 |
| 77 | void mp_hal_debug_str(const char *str) { |
| 78 | while (*str) { |
| 79 | uart_tx_one_char(UART0, *str++); |
| 80 | } |
| 81 | uart_flush(UART0); |
| 82 | } |
| 83 | #endif |
| 84 | |
Damien George | 0b32e50 | 2015-02-13 15:04:53 +0000 | [diff] [blame] | 85 | void mp_hal_stdout_tx_str(const char *str) { |
Damien George | afd0701 | 2018-05-15 15:13:58 +1000 | [diff] [blame^] | 86 | mp_uos_dupterm_tx_strn(str, strlen(str)); |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 87 | } |
| 88 | |
Damien George | 0b32e50 | 2015-02-13 15:04:53 +0000 | [diff] [blame] | 89 | void mp_hal_stdout_tx_strn(const char *str, uint32_t len) { |
Damien George | afd0701 | 2018-05-15 15:13:58 +1000 | [diff] [blame^] | 90 | mp_uos_dupterm_tx_strn(str, len); |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 91 | } |
| 92 | |
Damien George | 0b32e50 | 2015-02-13 15:04:53 +0000 | [diff] [blame] | 93 | void mp_hal_stdout_tx_strn_cooked(const char *str, uint32_t len) { |
Damien George | b00040c | 2017-10-03 19:36:49 +1100 | [diff] [blame] | 94 | const char *last = str; |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 95 | while (len--) { |
| 96 | if (*str == '\n') { |
Damien George | b00040c | 2017-10-03 19:36:49 +1100 | [diff] [blame] | 97 | if (str > last) { |
| 98 | mp_uos_dupterm_tx_strn(last, str - last); |
| 99 | } |
Damien George | b00040c | 2017-10-03 19:36:49 +1100 | [diff] [blame] | 100 | mp_uos_dupterm_tx_strn("\r\n", 2); |
| 101 | ++str; |
| 102 | last = str; |
| 103 | } else { |
Damien George | afd0701 | 2018-05-15 15:13:58 +1000 | [diff] [blame^] | 104 | ++str; |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 105 | } |
Damien George | b00040c | 2017-10-03 19:36:49 +1100 | [diff] [blame] | 106 | } |
| 107 | if (str > last) { |
| 108 | mp_uos_dupterm_tx_strn(last, str - last); |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 109 | } |
| 110 | } |
| 111 | |
Paul Sokolovsky | 402a743 | 2016-03-29 11:48:43 +0300 | [diff] [blame] | 112 | void mp_hal_debug_tx_strn_cooked(void *env, const char *str, uint32_t len) { |
| 113 | (void)env; |
| 114 | while (len--) { |
| 115 | if (*str == '\n') { |
| 116 | uart_tx_one_char(UART0, '\r'); |
| 117 | } |
| 118 | uart_tx_one_char(UART0, *str++); |
| 119 | } |
| 120 | } |
| 121 | |
Paul Sokolovsky | 6a09e7d | 2015-10-29 19:35:04 +0300 | [diff] [blame] | 122 | uint32_t mp_hal_ticks_ms(void) { |
Damien George | 34e0198 | 2016-09-20 14:28:17 +1000 | [diff] [blame] | 123 | return ((uint64_t)system_time_high_word << 32 | (uint64_t)system_get_time()) / 1000; |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 124 | } |
| 125 | |
Damien George | b41a14a | 2015-12-28 17:27:44 +0000 | [diff] [blame] | 126 | uint32_t mp_hal_ticks_us(void) { |
| 127 | return system_get_time(); |
| 128 | } |
| 129 | |
Paul Sokolovsky | ebd9f55 | 2015-10-29 13:03:44 +0300 | [diff] [blame] | 130 | void mp_hal_delay_ms(uint32_t delay) { |
| 131 | mp_hal_delay_us(delay * 1000); |
Damien George | 075d597 | 2014-11-27 20:30:33 +0000 | [diff] [blame] | 132 | } |
| 133 | |
Paul Sokolovsky | a099bfe | 2016-03-11 09:38:20 +0700 | [diff] [blame] | 134 | void ets_event_poll(void) { |
| 135 | ets_loop_iter(); |
Damien George | 1b7d672 | 2017-02-15 17:45:36 +1100 | [diff] [blame] | 136 | mp_handle_pending(); |
Paul Sokolovsky | a099bfe | 2016-03-11 09:38:20 +0700 | [diff] [blame] | 137 | } |
| 138 | |
Paul Sokolovsky | 8ab16b6 | 2015-12-29 20:44:55 +0200 | [diff] [blame] | 139 | void __assert_func(const char *file, int line, const char *func, const char *expr) { |
| 140 | printf("assert:%s:%d:%s: %s\n", file, line, func, expr); |
| 141 | nlr_raise(mp_obj_new_exception_msg(&mp_type_AssertionError, |
| 142 | "C-level assert")); |
| 143 | } |
Paul Sokolovsky | 61fa7c8 | 2016-03-30 18:50:38 +0300 | [diff] [blame] | 144 | |
| 145 | void mp_hal_signal_input(void) { |
Paul Sokolovsky | 785cf9a | 2016-04-01 14:02:36 +0300 | [diff] [blame] | 146 | #if MICROPY_REPL_EVENT_DRIVEN |
Paul Sokolovsky | 61fa7c8 | 2016-03-30 18:50:38 +0300 | [diff] [blame] | 147 | system_os_post(UART_TASK_ID, 0, 0); |
Paul Sokolovsky | 785cf9a | 2016-04-01 14:02:36 +0300 | [diff] [blame] | 148 | #endif |
Paul Sokolovsky | 61fa7c8 | 2016-03-30 18:50:38 +0300 | [diff] [blame] | 149 | } |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 150 | |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 151 | STATIC void dupterm_task_handler(os_event_t *evt) { |
Paul Sokolovsky | 6f3b993 | 2016-04-17 18:11:04 +0300 | [diff] [blame] | 152 | static byte lock; |
| 153 | if (lock) { |
| 154 | return; |
| 155 | } |
| 156 | lock = 1; |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 157 | while (1) { |
Damien George | 37282f8 | 2017-10-13 20:01:57 +1100 | [diff] [blame] | 158 | int c = mp_uos_dupterm_rx_chr(); |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 159 | if (c < 0) { |
| 160 | break; |
| 161 | } |
Damien George | afd0701 | 2018-05-15 15:13:58 +1000 | [diff] [blame^] | 162 | ringbuf_put(&stdin_ringbuf, c); |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 163 | } |
| 164 | mp_hal_signal_input(); |
Paul Sokolovsky | 6f3b993 | 2016-04-17 18:11:04 +0300 | [diff] [blame] | 165 | lock = 0; |
Paul Sokolovsky | 98af891 | 2016-03-31 19:49:55 +0300 | [diff] [blame] | 166 | } |
| 167 | |
| 168 | STATIC os_event_t dupterm_evt_queue[4]; |
| 169 | |
| 170 | void dupterm_task_init() { |
| 171 | system_os_task(dupterm_task_handler, DUPTERM_TASK_ID, dupterm_evt_queue, MP_ARRAY_SIZE(dupterm_evt_queue)); |
| 172 | } |
| 173 | |
| 174 | void mp_hal_signal_dupterm_input(void) { |
| 175 | system_os_post(DUPTERM_TASK_ID, 0, 0); |
| 176 | } |
Damien George | a2d5d84 | 2016-04-22 10:04:12 +0100 | [diff] [blame] | 177 | |
Paul Sokolovsky | 3d83041 | 2016-05-03 00:18:14 +0300 | [diff] [blame] | 178 | // Get pointer to esf_buf bookkeeping structure |
| 179 | void *ets_get_esf_buf_ctlblk(void) { |
| 180 | // Get literal ptr before start of esf_rx_buf_alloc func |
| 181 | extern void *esf_rx_buf_alloc(); |
| 182 | return ((void**)esf_rx_buf_alloc)[-1]; |
| 183 | } |
| 184 | |
| 185 | // Get number of esf_buf free buffers of given type, as encoded by index |
| 186 | // idx 0 corresponds to buf types 1, 2; 1 - 4; 2 - 5; 3 - 7; 4 - 8 |
| 187 | // Only following buf types appear to be used: |
| 188 | // 1 - tx buffer, 5 - management frame tx buffer; 8 - rx buffer |
| 189 | int ets_esf_free_bufs(int idx) { |
| 190 | uint32_t *p = ets_get_esf_buf_ctlblk(); |
| 191 | uint32_t *b = (uint32_t*)p[idx]; |
| 192 | int cnt = 0; |
| 193 | while (b) { |
| 194 | b = (uint32_t*)b[0x20 / 4]; |
| 195 | cnt++; |
| 196 | } |
| 197 | return cnt; |
| 198 | } |
Paul Sokolovsky | 64ad838 | 2016-07-31 02:30:05 +0300 | [diff] [blame] | 199 | |
| 200 | extern int mp_stream_errno; |
| 201 | int *__errno() { |
| 202 | return &mp_stream_errno; |
| 203 | } |