M5Stack_MicroPython/MicroPython_BUILD/components/micropython/py/modthread.c

/*
 * This file is part of the MicroPython project, http://micropython.org/
 *
 * The MIT License (MIT)
 *
 * Copyright (c) 2016 Damien P. George on behalf of Pycom Ltd
 * Copyright (c) 2018 LoBo (https://github.com/loboris)
 *
 * 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 <stdio.h>
#include <string.h>

#include "py/runtime.h"
#include "py/stackctrl.h"

#if MICROPY_PY_THREAD

#include "soc/cpu.h"
#include "py/mpthread.h"
#include "mphalport.h"


/****************************************************************/
// _thread module

size_t thread_stack_size = MP_THREAD_DEFAULT_STACK_SIZE;

//--------------------------------------------------------------------------
STATIC mp_obj_t mod_thread_stack_size(size_t n_args, const mp_obj_t *args) {
    mp_obj_t ret;

    if (n_args > 0) {
    	size_t stack_size = mp_obj_get_int(args[0]);
        if (stack_size == 0) {
        	stack_size = MP_THREAD_DEFAULT_STACK_SIZE; //use default stack size
        }
        else {
            if (stack_size < MP_THREAD_MIN_STACK_SIZE) stack_size = MP_THREAD_MIN_STACK_SIZE;
            else if (stack_size > MP_THREAD_MAX_STACK_SIZE) stack_size = MP_THREAD_MAX_STACK_SIZE;
        }
        thread_stack_size = stack_size;
        ret = mp_obj_new_int_from_uint(thread_stack_size);
    }
    else {
        ret = mp_obj_new_int_from_uint(thread_stack_size);
    }
    return ret;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(mod_thread_stack_size_obj, 0, 1, mod_thread_stack_size);

//-----------------------------------
typedef struct _thread_entry_args_t {
    mp_obj_dict_t *dict_locals;
    mp_obj_dict_t *dict_globals;
    size_t stack_size;
    mp_obj_t fun;
    size_t n_args;
    size_t n_kw;
    mp_obj_t args[];
} thread_entry_args_t;

//-------------------------------
void *thread_entry(void *args_in)
{
    // === Execution begins here for a new thread.  We do not have the GIL. ===

    thread_entry_args_t *args = (thread_entry_args_t*)args_in;

    mp_state_thread_t ts;
    mp_thread_set_state(&ts);

    mp_stack_set_top(&ts + 1); // need to include ts in root-pointer scan
    mp_stack_set_limit(args->stack_size);

    // set locals and globals from the calling context
    mp_locals_set(args->dict_locals);
    mp_globals_set(args->dict_globals);

    MP_THREAD_GIL_ENTER();

	#if MICROPY_ENABLE_PYSTACK
	// TODO threading and pystack is not fully supported, for now just make a small stack
	mp_obj_t mini_pystack[128];
	mp_pystack_init(mini_pystack, &mini_pystack[128]);
	#endif

    volatile uint32_t sp = (uint32_t)get_sp();
    mp_thread_set_sp((void *)sp, MP_STATE_THREAD(stack_top));

    void **ptrs = (void**)(void*)&mp_state_ctx;
    mp_thread_set_ptrs(ptrs, offsetof(mp_state_ctx_t, vm.qstr_last_chunk) / sizeof(void*));

    // signal that we are set up and running
    mp_thread_start();

    // TODO set more thread-specific state here:
    //  mp_pending_exception? (root pointer)
    //  cur_exception (root pointer)

    nlr_buf_t nlr;
    if (nlr_push(&nlr) == 0) {
    	// === Start executing the byte code ===
        mp_call_function_n_kw(args->fun, args->n_args, args->n_kw, args->args);
        nlr_pop();
    } else {
        // uncaught exception
        // check for SystemExit
        mp_obj_base_t *exc = (mp_obj_base_t*)nlr.ret_val;
        if (mp_obj_is_subclass_fast(MP_OBJ_FROM_PTR(exc->type), MP_OBJ_FROM_PTR(&mp_type_SystemExit))) {
            // swallow exception silently
        } else {
            // print exception out
            mp_printf(&mp_plat_print, "Unhandled exception in thread started by ");
            mp_obj_print_helper(&mp_plat_print, args->fun, PRINT_REPR);
            mp_printf(&mp_plat_print, "\n");
            mp_obj_print_exception(&mp_plat_print, MP_OBJ_FROM_PTR(exc));
        }
    }

    MP_THREAD_GIL_EXIT();

    // signal that we are finished
    mp_thread_finish();

    return NULL;
}

//-----------------------------------------------------------------------------------------------------
STATIC mp_obj_t mod_thread_start_new_thread(size_t n_args, const mp_obj_t *pos_args, mp_map_t *kw_args)
{
	const mp_arg_t allowed_args[] = {
	   { MP_QSTR_name,		MP_ARG_REQUIRED | MP_ARG_OBJ,  { .u_obj = mp_const_none } },
	   { MP_QSTR_func,		MP_ARG_REQUIRED | MP_ARG_OBJ,  { .u_obj = mp_const_none } },
	   { MP_QSTR_arg,		MP_ARG_REQUIRED | MP_ARG_OBJ,  { .u_obj = mp_const_none } },
	   { MP_QSTR_kwarg,		                  MP_ARG_OBJ,  { .u_obj = mp_const_none } },
	   { MP_QSTR_samecore,                    MP_ARG_BOOL, { .u_bool = true } },
	   { MP_QSTR_stacksize,                   MP_ARG_INT,  { .u_int = -1 } },
	};

    mp_arg_val_t args[MP_ARRAY_SIZE(allowed_args)];
    mp_arg_parse_all(n_args, pos_args, kw_args, MP_ARRAY_SIZE(allowed_args), allowed_args, args);

    // This structure holds the Python function and arguments for thread entry.
    // We copy all arguments into this structure to keep ownership of them.
    // We must be very careful about root pointers because this pointer may
    // disappear from our address space before the thread is created.
    thread_entry_args_t *th_args;

    char *name = NULL;
	if (MP_OBJ_IS_STR(args[0].u_obj)) {
		name = (char *)mp_obj_str_get_str(args[0].u_obj);
	}
	else {
        mp_raise_TypeError("expecting a string for thread name argument");
	}
    if ((!MP_OBJ_IS_FUN(args[1].u_obj)) && (!MP_OBJ_IS_METH(args[1].u_obj))) {
       	mp_raise_TypeError("expecting a function for thread function argument");
    }

    // get positional arguments
    size_t pos_args_len;
    mp_obj_t *pos_args_items;
    mp_obj_get_array(args[2].u_obj, &pos_args_len, &pos_args_items);

    // check for keyword arguments
    if (args[3].u_obj == mp_const_none) {
        // only positional arguments
        th_args = m_new_obj_var(thread_entry_args_t, mp_obj_t, pos_args_len);
        th_args->n_kw = 0;
    }
    else {
        // positional and keyword arguments
        if (mp_obj_get_type(args[3].u_obj) != &mp_type_dict) {
            mp_raise_TypeError("expecting a dict for keyword args");
        }
        mp_map_t *map = &((mp_obj_dict_t*)MP_OBJ_TO_PTR(args[3].u_obj))->map;
        th_args = m_new_obj_var(thread_entry_args_t, mp_obj_t, pos_args_len + 2 * map->used);
        th_args->n_kw = map->used;
        // copy across the keyword arguments
        for (size_t i = 0, n = pos_args_len; i < map->alloc; ++i) {
            if (MP_MAP_SLOT_IS_FILLED(map, i)) {
                th_args->args[n++] = map->table[i].key;
                th_args->args[n++] = map->table[i].value;
            }
        }
    }

    // copy across the positional arguments
    th_args->n_args = pos_args_len;
    memcpy(th_args->args, pos_args_items, pos_args_len * sizeof(mp_obj_t));

    // pass our locals and globals into the new thread
    th_args->dict_locals = mp_locals_get();
    th_args->dict_globals = mp_globals_get();

    // set the stack size to use
    if ((args[5].u_int >= MP_THREAD_MIN_STACK_SIZE) && (args[5].u_int <= MP_THREAD_MAX_STACK_SIZE)) th_args->stack_size = args[5].u_int;
    else th_args->stack_size = thread_stack_size;

    // set the function for thread entry
    th_args->fun = args[1].u_obj;

    // spawn the thread!
    uintptr_t thr_id = (uintptr_t)mp_thread_create(thread_entry, th_args, &th_args->stack_size, name, args[4].u_bool);

    return mp_obj_new_int_from_uint((uintptr_t)thr_id);
}
STATIC MP_DEFINE_CONST_FUN_OBJ_KW(mod_thread_start_new_thread_obj, 3, mod_thread_start_new_thread);

/*
//------------------------------------------
STATIC mp_obj_t mod_thread_get_ident(void) {
    return mp_obj_new_int_from_uint((uintptr_t)mp_thread_get_state());
}
STATIC MP_DEFINE_CONST_FUN_OBJ_0(mod_thread_get_ident_obj, mod_thread_get_ident);

//-------------------------------------
STATIC mp_obj_t mod_thread_exit(void) {
    nlr_raise(mp_obj_new_exception(&mp_type_SystemExit));
    return mp_const_none;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_0(mod_thread_exit_obj, mod_thread_exit);

//----------------------------------------------
STATIC mp_obj_t mod_thread_allocate_lock(void) {
    return MP_OBJ_FROM_PTR(mp_obj_new_thread_lock());
}
STATIC MP_DEFINE_CONST_FUN_OBJ_0(mod_thread_allocate_lock_obj, mod_thread_allocate_lock);
*/

/****************************************************************/
// Inter-thread notifications and messaging


//-------------------------------------------------
STATIC mp_obj_t mod_thread_status(mp_obj_t in_id) {
	uintptr_t thr_id = mp_obj_get_int(in_id);

	int res = mp_thread_status((void *)thr_id);
    return MP_OBJ_NEW_SMALL_INT(res);
}
STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_thread_status_obj, mod_thread_status);

//-------------------------------------------------------
STATIC mp_obj_t mod_thread_allowsuspend(mp_obj_t in_id) {
	int allow = mp_obj_is_true(in_id);

	mp_thread_allowsuspend(allow);
    return mp_const_false;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_thread_allowsuspend_obj, mod_thread_allowsuspend);

//--------------------------------------------------
STATIC mp_obj_t mod_thread_suspend(mp_obj_t in_id) {
	uintptr_t thr_id = mp_obj_get_int(in_id);

	if (mp_thread_suspend((void *)thr_id)) return mp_const_true;
    return mp_const_false;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_thread_suspend_obj, mod_thread_suspend);

//-------------------------------------------------
STATIC mp_obj_t mod_thread_resume(mp_obj_t in_id) {
	uintptr_t thr_id = mp_obj_get_int(in_id);

	if (mp_thread_resume((void *)thr_id)) return mp_const_true;
    return mp_const_false;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_thread_resume_obj, mod_thread_resume);

//-----------------------------------------------
STATIC mp_obj_t mod_thread_stop(mp_obj_t in_id) {
	uintptr_t thr_id = mp_obj_get_int(in_id);

	if (mp_thread_notify((void *)thr_id, THREAD_NOTIFY_EXIT)) return mp_const_true;
    return mp_const_false;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_thread_stop_obj, mod_thread_stop);

//--------------------------------------------------------------------
STATIC mp_obj_t mod_thread_notify(mp_obj_t in_id, mp_obj_t in_value) {
	uintptr_t thr_id = mp_obj_get_int(in_id);
	uint32_t notify_value = mp_obj_get_int(in_value);
	if (notify_value == 0) return mp_const_false;

	if (mp_thread_notify((void *)thr_id, notify_value)) return mp_const_true;
    return mp_const_false;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_2(mod_thread_notify_obj, mod_thread_notify);

//-----------------------------------------------------
STATIC mp_obj_t mod_thread_isnotified(mp_obj_t in_id) {
	uintptr_t thr_id = mp_obj_get_int(in_id);
	int notify = mp_thread_notifyPending((void *)thr_id);

	if (notify == 0) return mp_const_true;
    return mp_const_false;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_thread_isnotified_obj, mod_thread_isnotified);

//--------------------------------------
STATIC mp_obj_t mod_thread_getREPLId() {
    return mp_obj_new_int_from_uint((uintptr_t)ReplTaskHandle);
}
STATIC MP_DEFINE_CONST_FUN_OBJ_0(mod_thread_getREPLId_obj, mod_thread_getREPLId);

//--------------------------------------
STATIC mp_obj_t mod_thread_getMAINId() {
    return mp_obj_new_int_from_uint((uintptr_t)MainTaskHandle);
}
STATIC MP_DEFINE_CONST_FUN_OBJ_0(mod_thread_getMAINId_obj, mod_thread_getMAINId);

//--------------------------------------
STATIC mp_obj_t mod_thread_getnotify() {

	uint32_t not_val = mp_thread_getnotify(0);
    return MP_OBJ_NEW_SMALL_INT(not_val);
}
STATIC MP_DEFINE_CONST_FUN_OBJ_0(mod_thread_getnotify_obj, mod_thread_getnotify);

//----------------------------------------------------------------------------------------------
STATIC mp_obj_t mod_thread_sendmsg(size_t n_args, const mp_obj_t *pos_args, mp_map_t *kw_args) {
    const mp_arg_t allowed_args[] = {
       { MP_QSTR_ThreadID, MP_ARG_REQUIRED | MP_ARG_OBJ, { .u_obj = mp_const_none } },
       { MP_QSTR_Message,  MP_ARG_REQUIRED | MP_ARG_OBJ, { .u_obj = mp_const_none } },
    };
    mp_arg_val_t args[MP_ARRAY_SIZE(allowed_args)];
    mp_arg_parse_all(n_args, pos_args, kw_args, MP_ARRAY_SIZE(allowed_args), allowed_args, args);

    const char *msg = NULL;
    size_t msglen = 0;
    mp_int_t msg_int = 0;
    uintptr_t thr_id = 1;

    int type = THREAD_MSG_TYPE_INTEGER;

	if (MP_OBJ_IS_INT(args[0].u_obj)) {
		thr_id = mp_obj_get_int((mp_const_obj_t)args[0].u_obj);
	}
	else return mp_const_false;

	if (MP_OBJ_IS_STR(args[1].u_obj)) {
        msg = mp_obj_str_get_data(args[1].u_obj, &msglen);
        if (msglen == 0) return mp_const_false;
        type = THREAD_MSG_TYPE_STRING;
    }
	else if (MP_OBJ_IS_INT(args[1].u_obj)) {
    	msg_int = mp_obj_get_int(args[1].u_obj);
    }
	else return mp_const_false;

	int res = mp_thread_semdmsg((void *)thr_id, type, msg_int, (uint8_t *)msg, msglen);

	return MP_OBJ_NEW_SMALL_INT(res);
}
STATIC MP_DEFINE_CONST_FUN_OBJ_KW(mod_thread_sendmsg_obj, 2, mod_thread_sendmsg);

//---------------------------------
STATIC mp_obj_t mod_thread_getmsg()
{
	uint8_t *buf = NULL;
	uint32_t msg_int = 0;
	int res = 0;
	uint32_t buflen = 0;
	uintptr_t sender = 0;
    mp_obj_t tuple[3];

	res = mp_thread_getmsg(&msg_int, &buf, &buflen, (uint32_t *)&sender);

	tuple[0] = mp_obj_new_int(res);
    tuple[1] = mp_obj_new_int(sender);
	if (res == THREAD_MSG_TYPE_NONE) {
		tuple[2] = mp_const_none;
	}
	else if (res == THREAD_MSG_TYPE_INTEGER) {
	    tuple[2] = mp_obj_new_int(msg_int);
	}
	else if (res == THREAD_MSG_TYPE_STRING) {
		if (buf != NULL) {
			tuple[2] = mp_obj_new_str((char *)buf, buflen);
			free(buf);
		}
		else tuple[2] = mp_const_none;
	}

    return mp_obj_new_tuple(3, tuple);
}
STATIC MP_DEFINE_CONST_FUN_OBJ_0(mod_thread_getmsg_obj, mod_thread_getmsg);

//--------------------------------------------------
STATIC mp_obj_t mod_thread_getname(mp_obj_t in_id) {
	uintptr_t thr_id = mp_obj_get_int(in_id);
	char name[THREAD_NAME_MAX_SIZE] = {'\0'};

	int res = mp_thread_getname((void *)thr_id, name);
	if (!res) {
		sprintf(name,"unknown");
	}
	return mp_obj_new_str((char *)name, strlen(name));
}
STATIC MP_DEFINE_CONST_FUN_OBJ_1(mod_thread_getname_obj, mod_thread_getname);

//------------------------------------------------------
STATIC mp_obj_t mod_thread_getSelfname() {
	char name[THREAD_NAME_MAX_SIZE] = {'\0'};

	int res = mp_thread_getSelfname(name);
	if (!res) {
		sprintf(name,"unknown");
	}
	return mp_obj_new_str((char *)name, strlen(name));
}
STATIC MP_DEFINE_CONST_FUN_OBJ_0(mod_thread_getSelfname_obj, mod_thread_getSelfname);

extern TaskHandle_t TelnetTaskHandle;
extern TaskHandle_t FtpTaskHandle;

//-----------------------------------------------------------------------
STATIC mp_obj_t mod_thread_list(mp_uint_t n_args, const mp_obj_t *args) {
	int prn = 1, n = 0;
    if (n_args > 0) prn = mp_obj_is_true(args[0]);

	thread_list_t list = {0, NULL};

	uint32_t num = mp_thread_list(&list);

	if ((num == 0) || (list.threads == NULL)) return mp_const_none;

	threadlistitem_t *thr = NULL;
	if (prn) {
		for (n=0; n<num; n++) {
			thr = list.threads + (sizeof(threadlistitem_t) * n);
			char th_type[8] = {'\0'};
			char th_state[16] = {'\0'};
			if (thr->type == THREAD_TYPE_MAIN) sprintf(th_type, "MAIN");
			else if (thr->type == THREAD_TYPE_REPL) sprintf(th_type, "REPL");
			else if (thr->type == THREAD_TYPE_PYTHON) sprintf(th_type, "PYTHON");
			else if (thr->type == THREAD_TYPE_SERVICE) sprintf(th_type, "SERVICE");
			else sprintf(th_type, "Unknown");
			if (thr->suspended) sprintf(th_state, "suspended");
			else if (thr->waiting) sprintf(th_state, "waiting");
			else sprintf(th_state, "running");

			mp_printf(&mp_plat_print, "ID=%u, Name: %s, State: %s, Stack=%d, MaxUsed=%d, Type: %s\n",
					thr->id, thr->name, th_state, thr->stack_len,
					thr->stack_max, th_type);
		}
		free(list.threads);
		#ifdef CONFIG_MICROPY_USE_TELNET
		if (TelnetTaskHandle) {
			mp_printf(&mp_plat_print, "ID=%u, Name: Telnet, Stack=%d, MaxUsed=%d, Type: SERVICE\n",
					TelnetTaskHandle, TELNET_STACK_LEN, TELNET_STACK_LEN - uxTaskGetStackHighWaterMark(TelnetTaskHandle));
		}
		#endif

		#ifdef CONFIG_MICROPY_USE_FTPSERVER
		if (FtpTaskHandle) {
			mp_printf(&mp_plat_print, "ID=%u, Name: Ftp, Stack=%d, MaxUsed=%d, Type: SERVICE\n",
					FtpTaskHandle, FTP_STACK_LEN, FTP_STACK_LEN - uxTaskGetStackHighWaterMark(FtpTaskHandle));
		}
		#endif
		return mp_const_none;
	}
	else {
		int services = 0;
		#ifdef CONFIG_MICROPY_USE_TELNET
		if (TelnetTaskHandle) services++;
		#endif
		#ifdef CONFIG_MICROPY_USE_FTPSERVER
		if (FtpTaskHandle) services++;
		#endif
		mp_obj_t thr_info[6];
		mp_obj_t tuple[num+services];
		for (n=0; n<num; n++) {
			thr = list.threads + (sizeof(threadlistitem_t) * n);
			thr_info[0] = mp_obj_new_int(thr->id);
			thr_info[1] = mp_obj_new_int(thr->type);
			thr_info[2] = mp_obj_new_str(thr->name, strlen(thr->name));
			if (thr->suspended) thr_info[3] = mp_obj_new_int(1);
			else if (thr->waiting) thr_info[3] = mp_obj_new_int(2);
			else thr_info[3] = mp_obj_new_int(0);
			thr_info[4] = mp_obj_new_int(thr->stack_len);
			thr_info[5] = mp_obj_new_int(thr->stack_max);
			tuple[n] = mp_obj_new_tuple(6, thr_info);
		}
		free(list.threads);
		#ifdef CONFIG_MICROPY_USE_TELNET
		if (TelnetTaskHandle) {
			thr_info[0] = mp_obj_new_int((int)TelnetTaskHandle);
			thr_info[1] = mp_obj_new_int(THREAD_TYPE_SERVICE);
			thr_info[2] = mp_obj_new_str("Telnet", 6);
			thr_info[3] = mp_obj_new_int(0);
			thr_info[4] = mp_obj_new_int(TELNET_STACK_LEN);
			thr_info[5] = mp_obj_new_int(TELNET_STACK_LEN - uxTaskGetStackHighWaterMark(TelnetTaskHandle));
			tuple[n] = mp_obj_new_tuple(6, thr_info);
			n++;
		}
		#endif
		#ifdef CONFIG_MICROPY_USE_FTPSERVER
		if (FtpTaskHandle) {
			thr_info[0] = mp_obj_new_int((int)FtpTaskHandle);
			thr_info[1] = mp_obj_new_int(THREAD_TYPE_SERVICE);
			thr_info[2] = mp_obj_new_str("Ftp", 3);
			thr_info[3] = mp_obj_new_int(0);
			thr_info[4] = mp_obj_new_int(FTP_STACK_LEN);
			thr_info[5] = mp_obj_new_int(FTP_STACK_LEN - uxTaskGetStackHighWaterMark(FtpTaskHandle));
			tuple[n] = mp_obj_new_tuple(6, thr_info);
			n++;
		}
		#endif

		return mp_obj_new_tuple(n, tuple);
	}
}
STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(mod_thread_list_obj, 0, 1, mod_thread_list);

//--------------------------------------------------------------------------------
STATIC mp_obj_t mod_thread_replAcceptMsg(mp_uint_t n_args, const mp_obj_t *args) {
	int res = 0;
    if (n_args == 0) {
    	res = mp_thread_replAcceptMsg(-1);
    }
    else {
    	res = mp_thread_replAcceptMsg(mp_obj_is_true(args[0]));
    }
	return mp_obj_new_bool(res);
}
STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(mod_thread_replAcceptMsg_obj, 0, 1, mod_thread_replAcceptMsg);

//--------------------------------------------------------------------------------
STATIC mp_obj_t mod_thread_mainAcceptMsg(mp_uint_t n_args, const mp_obj_t *args) {
	int res = 0;
    if (n_args == 0) {
    	res = mp_thread_mainAcceptMsg(-1);
    }
    else {
    	res = mp_thread_mainAcceptMsg(mp_obj_is_true(args[0]));
    }
	return mp_obj_new_bool(res);
}
STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(mod_thread_mainAcceptMsg_obj, 0, 1, mod_thread_mainAcceptMsg);

//-----------------------------------------------------------------------------
STATIC mp_obj_t mod_thread_waitnotify(mp_uint_t n_args, const mp_obj_t *args) {
	uint32_t tmo = portMAX_DELAY;
    if (n_args > 0) {
    	tmo = mp_obj_get_int(args[0]);
    	if (tmo < 1) tmo = 1;
    	tmo /= portTICK_PERIOD_MS;
    }
	uint32_t not_val = 0;
	mp_obj_t ret = mp_const_none;

   	if (mp_thread_setblocked()) {
   		MP_THREAD_GIL_EXIT();
		if (xTaskNotifyWait(0, 0, &not_val, tmo) == pdPASS) {
			xTaskNotifyWait(ULONG_MAX, ULONG_MAX, NULL, 0);
			mp_thread_resetPending();
			ret = MP_OBJ_NEW_SMALL_INT(not_val);
		}
		mp_thread_setnotblocked();
		MP_THREAD_GIL_ENTER();
   	}

	return ret;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_VAR_BETWEEN(mod_thread_waitnotify_obj, 0, 1, mod_thread_waitnotify);

//-------------------------------
STATIC mp_obj_t mod_thread_lock()
{
    MP_STATE_VM(thread_lock) = 1;
	return mp_const_none;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_0(mod_thread_lock_obj, mod_thread_lock);

//------------------------------
STATIC mp_obj_t mod_thread_unlock()
{
    MP_STATE_VM(thread_lock) = 0;
	return mp_const_none;
}
STATIC MP_DEFINE_CONST_FUN_OBJ_0(mod_thread_unlock_obj, mod_thread_unlock);


//=================================================================
STATIC const mp_rom_map_elem_t mp_module_thread_globals_table[] = {
    { MP_ROM_QSTR(MP_QSTR___name__),			MP_ROM_QSTR(MP_QSTR__thread) },
    { MP_ROM_QSTR(MP_QSTR_stack_size),			MP_ROM_PTR(&mod_thread_stack_size_obj) },
    { MP_ROM_QSTR(MP_QSTR_start_new_thread),	MP_ROM_PTR(&mod_thread_start_new_thread_obj) },
    { MP_ROM_QSTR(MP_QSTR_allowsuspend),		MP_ROM_PTR(&mod_thread_allowsuspend_obj) },
    { MP_ROM_QSTR(MP_QSTR_suspend),				MP_ROM_PTR(&mod_thread_suspend_obj) },
    { MP_ROM_QSTR(MP_QSTR_resume),				MP_ROM_PTR(&mod_thread_resume_obj) },
    { MP_ROM_QSTR(MP_QSTR_stop),				MP_ROM_PTR(&mod_thread_stop_obj) },
    { MP_ROM_QSTR(MP_QSTR_notify),				MP_ROM_PTR(&mod_thread_notify_obj) },
    { MP_ROM_QSTR(MP_QSTR_getnotification),		MP_ROM_PTR(&mod_thread_getnotify_obj) },
    { MP_ROM_QSTR(MP_QSTR_isnotified),			MP_ROM_PTR(&mod_thread_isnotified_obj) },
    { MP_ROM_QSTR(MP_QSTR_getReplID),			MP_ROM_PTR(&mod_thread_getREPLId_obj) },
    { MP_ROM_QSTR(MP_QSTR_getMainID),			MP_ROM_PTR(&mod_thread_getMAINId_obj) },
    { MP_ROM_QSTR(MP_QSTR_replAcceptMsg),		MP_ROM_PTR(&mod_thread_replAcceptMsg_obj) },
    { MP_ROM_QSTR(MP_QSTR_mainAcceptMsg),		MP_ROM_PTR(&mod_thread_mainAcceptMsg_obj) },
    { MP_ROM_QSTR(MP_QSTR_sendmsg),				MP_ROM_PTR(&mod_thread_sendmsg_obj) },
    { MP_ROM_QSTR(MP_QSTR_getmsg),				MP_ROM_PTR(&mod_thread_getmsg_obj) },
    { MP_ROM_QSTR(MP_QSTR_list),				MP_ROM_PTR(&mod_thread_list_obj) },
    { MP_ROM_QSTR(MP_QSTR_getThreadName),		MP_ROM_PTR(&mod_thread_getname_obj) },
    { MP_ROM_QSTR(MP_QSTR_getSelfName),			MP_ROM_PTR(&mod_thread_getSelfname_obj) },
    { MP_ROM_QSTR(MP_QSTR_status),				MP_ROM_PTR(&mod_thread_status_obj) },
    { MP_ROM_QSTR(MP_QSTR_wait),				MP_ROM_PTR(&mod_thread_waitnotify_obj) },
    { MP_ROM_QSTR(MP_QSTR_lock),				MP_ROM_PTR(&mod_thread_lock_obj) },
    { MP_ROM_QSTR(MP_QSTR_unlock),				MP_ROM_PTR(&mod_thread_unlock_obj) },

	// Constants
	{ MP_ROM_QSTR(MP_QSTR_PAUSE),				MP_ROM_INT(THREAD_NOTIFY_PAUSE) },
	{ MP_ROM_QSTR(MP_QSTR_SUSPEND),				MP_ROM_INT(THREAD_NOTIFY_PAUSE) },
	{ MP_ROM_QSTR(MP_QSTR_RESUME),				MP_ROM_INT(THREAD_NOTIFY_RESUME) },
	{ MP_ROM_QSTR(MP_QSTR_EXIT),				MP_ROM_INT(THREAD_NOTIFY_EXIT) },
	{ MP_ROM_QSTR(MP_QSTR_STOP),				MP_ROM_INT(THREAD_NOTIFY_EXIT) },
	{ MP_ROM_QSTR(MP_QSTR_STATUS),				MP_ROM_INT(THREAD_NOTIFY_STATUS) },

	{ MP_ROM_QSTR(MP_QSTR_RUNNING),				MP_ROM_INT(THREAD_STATUS_RUNNING) },
	{ MP_ROM_QSTR(MP_QSTR_SUSPENDED),			MP_ROM_INT(THREAD_STATUS_SUSPENDED) },
	{ MP_ROM_QSTR(MP_QSTR_WAITING),				MP_ROM_INT(THREAD_STATUS_WAITING) },
	{ MP_ROM_QSTR(MP_QSTR_TERMINATED),			MP_ROM_INT(THREAD_STATUS_TERMINATED) },
};
STATIC MP_DEFINE_CONST_DICT(mp_module_thread_globals, mp_module_thread_globals_table);

//========================================
const mp_obj_module_t mp_module_thread = {
    .base = { &mp_type_module },
    .globals = (mp_obj_dict_t*)&mp_module_thread_globals,
};

#endif // MICROPY_PY_THREAD