/* * Copyright (c) 2013-2019, Huawei Technologies Co., Ltd. All rights reserved. * Copyright (c) 2020, Huawei Device Co., Ltd. All rights reserved. * * Redistribution and use in source and binary forms, with or without modification, * are permitted provided that the following conditions are met: * * 1. Redistributions of source code must retain the above copyright notice, this list of * conditions and the following disclaimer. * * 2. Redistributions in binary form must reproduce the above copyright notice, this list * of conditions and the following disclaimer in the documentation and/or other materials * provided with the distribution. * * 3. Neither the name of the copyright holder nor the names of its contributors may be used * to endorse or promote products derived from this software without specific prior written * permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. */ #include #include #include #include #include #include #include #include #include #include #if (LOSCFG_KERNEL_SMP == YES) SPIN_LOCK_INIT(arch_protect_spin); static u32_t lwprot_thread = LOS_ERRNO_TSK_ID_INVALID; static int lwprot_count = 0; #endif /* LOSCFG_KERNEL_SMP == YES */ #define ROUND_UP_DIV(val, div) (((val) + (div) - 1) / (div)) /** * Thread and System misc */ sys_thread_t sys_thread_new(const char *name, lwip_thread_fn thread, void *arg, int stackSize, int prio) { UINT32 taskID = LOS_ERRNO_TSK_ID_INVALID; UINT32 ret; TSK_INIT_PARAM_S task = {0}; /* Create host Task */ task.pfnTaskEntry = (TSK_ENTRY_FUNC)thread; task.uwStackSize = stackSize; task.pcName = (char *)name; task.usTaskPrio = prio; task.auwArgs[0] = (UINTPTR)arg; task.uwResved = LOS_TASK_STATUS_DETACHED; ret = LOS_TaskCreate(&taskID, &task); if (ret != LOS_OK) { LWIP_DEBUGF(SYS_DEBUG, ("sys_thread_new: LOS_TaskCreate error %u\n", ret)); return -1; } return taskID; } void sys_init(void) { /* set rand seed to make random sequence diff on every startup */ UINT32 seedhsb, seedlsb; LOS_GetCpuCycle(&seedhsb, &seedlsb); srand(seedlsb); } u32_t sys_now(void) { /* Lwip docs mentioned like wraparound is not a problem in this funtion */ return (u32_t)((LOS_TickCountGet() * OS_SYS_MS_PER_SECOND) / LOSCFG_BASE_CORE_TICK_PER_SECOND); } #if (LWIP_CHKSUM_ALGORITHM == 4) /* version #4, asm based */ #include "in_cksum.h" u16_t lwip_standard_chksum(const void *dataptr, int len) { return ~(u16_t)(in_cksum(dataptr, len)); } #endif /** * Protector */ sys_prot_t sys_arch_protect(void) { #if (LOSCFG_KERNEL_SMP == YES) /* Note that we are using spinlock instead of mutex for LiteOS-SMP here: * 1. spinlock is more effective for short critical region protection. * 2. this function is called only in task context, not in interrupt handler. * so it's not needed to disable interrupt. */ if (lwprot_thread != LOS_CurTaskIDGet()) { /* We are locking the spinlock where it has not been locked before * or is being locked by another thread */ LOS_SpinLock(&arch_protect_spin); lwprot_thread = LOS_CurTaskIDGet(); lwprot_count = 1; } else { /* It is already locked by THIS thread */ lwprot_count++; } #else LOS_TaskLock(); #endif /* LOSCFG_KERNEL_SMP == YES */ return 0; /* return value is unused */ } void sys_arch_unprotect(sys_prot_t pval) { LWIP_UNUSED_ARG(pval); #if (LOSCFG_KERNEL_SMP == YES) if (lwprot_thread == LOS_CurTaskIDGet()) { lwprot_count--; if (lwprot_count == 0) { lwprot_thread = LOS_ERRNO_TSK_ID_INVALID; LOS_SpinUnlock(&arch_protect_spin); } } #else LOS_TaskUnlock(); #endif /* LOSCFG_KERNEL_SMP == YES */ } /** * MessageBox */ err_t sys_mbox_new(sys_mbox_t *mbox, int size) { CHAR qName[] = "lwIP"; UINT32 ret = LOS_QueueCreate(qName, (UINT16)size, mbox, 0, sizeof(void *)); switch (ret) { case LOS_OK: return ERR_OK; case LOS_ERRNO_QUEUE_CB_UNAVAILABLE: case LOS_ERRNO_QUEUE_CREATE_NO_MEMORY: return ERR_MEM; default: break; } LWIP_DEBUGF(SYS_DEBUG, ("%s: LOS_QueueCreate error %u\n", __FUNCTION__, ret)); return ERR_ARG; } void sys_mbox_post(sys_mbox_t *mbox, void *msg) { /* Caution: the second parameter is NOT &msg */ UINT32 ret = LOS_QueueWrite(*mbox, msg, sizeof(char *), LOS_WAIT_FOREVER); if (ret != LOS_OK) { LWIP_DEBUGF(SYS_DEBUG, ("%s: LOS_QueueWrite error %u\n", __FUNCTION__, ret)); } } err_t sys_mbox_trypost(sys_mbox_t *mbox, void *msg) { /* Caution: the second parameter is NOT &msg */ UINT32 ret = LOS_QueueWrite(*mbox, msg, sizeof(char *), 0); switch (ret) { case LOS_OK: return ERR_OK; case LOS_ERRNO_QUEUE_ISFULL: return ERR_MEM; default: break; } LWIP_DEBUGF(SYS_DEBUG, ("%s: LOS_QueueWrite error %u\n", __FUNCTION__, ret)); return ERR_ARG; } err_t sys_mbox_trypost_fromisr(sys_mbox_t *mbox, void *msg); u32_t sys_arch_mbox_fetch(sys_mbox_t *mbox, void **msg, u32_t timeoutMs) { void *ignore = 0; /* if msg==NULL, the fetched msg should be dropped */ UINT64 tick = ROUND_UP_DIV((UINT64)timeoutMs * LOSCFG_BASE_CORE_TICK_PER_SECOND, OS_SYS_MS_PER_SECOND); UINT32 ret = LOS_QueueRead(*mbox, msg ? msg : &ignore, sizeof(void *), tick ? (UINT32)tick : LOS_WAIT_FOREVER); switch (ret) { case LOS_OK: return ERR_OK; case LOS_ERRNO_QUEUE_ISEMPTY: case LOS_ERRNO_QUEUE_TIMEOUT: return SYS_ARCH_TIMEOUT; default: break; } LWIP_DEBUGF(SYS_DEBUG, ("%s: LOS_QueueRead error %u\n", __FUNCTION__, ret)); return SYS_ARCH_TIMEOUT; /* Errors should be treated as timeout */ } u32_t sys_arch_mbox_tryfetch(sys_mbox_t *mbox, void **msg) { void *ignore = 0; /* if msg==NULL, the fetched msg should be dropped */ UINT32 ret = LOS_QueueRead(*mbox, msg ? msg : &ignore, sizeof(void *), 0); switch (ret) { case LOS_OK: return ERR_OK; case LOS_ERRNO_QUEUE_ISEMPTY: return SYS_MBOX_EMPTY; case LOS_ERRNO_QUEUE_TIMEOUT: return SYS_ARCH_TIMEOUT; default: break; } LWIP_DEBUGF(SYS_DEBUG, ("%s: LOS_QueueRead error %u\n", __FUNCTION__, ret)); return SYS_MBOX_EMPTY; /* Errors should be treated as timeout */ } void sys_mbox_free(sys_mbox_t *mbox) { (void)LOS_QueueDelete(*mbox); } int sys_mbox_valid(sys_mbox_t *mbox) { QUEUE_INFO_S queueInfo; return LOS_OK == LOS_QueueInfoGet(*mbox, &queueInfo); } void sys_mbox_set_invalid(sys_mbox_t *mbox) { *mbox = LOSCFG_BASE_IPC_QUEUE_LIMIT; } /** * Semaphore */ err_t sys_sem_new(sys_sem_t *sem, u8_t count) { UINT32 ret = LOS_SemCreate(count, sem); if (ret != LOS_OK) { return ERR_ARG; } return ERR_OK; } void sys_sem_signal(sys_sem_t *sem) { (void)LOS_SemPost(*sem); } u32_t sys_arch_sem_wait(sys_sem_t *sem, u32_t timeoutMs) { UINT64 tick = ROUND_UP_DIV((UINT64)timeoutMs * LOSCFG_BASE_CORE_TICK_PER_SECOND, OS_SYS_MS_PER_SECOND); UINT32 ret = LOS_SemPend(*sem, tick ? (UINT32)tick : LOS_WAIT_FOREVER); // timeoutMs 0 means wait forever switch (ret) { case LOS_OK: return ERR_OK; case LOS_ERRNO_SEM_TIMEOUT: return SYS_ARCH_TIMEOUT; default: break; } LWIP_DEBUGF(SYS_DEBUG, ("%s: LOS_SemPend error %u\n", __FUNCTION__, ret)); return SYS_ARCH_TIMEOUT; /* Errors should be treated as timeout */ } void sys_sem_free(sys_sem_t *sem) { (void)LOS_SemDelete(*sem); } int sys_sem_valid(sys_sem_t *sem) { return *sem != LOSCFG_BASE_IPC_SEM_LIMIT; } void sys_sem_set_invalid(sys_sem_t *sem) { *sem = LOSCFG_BASE_IPC_SEM_LIMIT; } /** * Mutex */ err_t sys_mutex_new(sys_mutex_t *mutex) { UINT32 ret = LOS_MuxInit(mutex, NULL); if (ret != LOS_OK) { return ERR_ARG; } return ERR_OK; } void sys_mutex_lock(sys_mutex_t *mutex) { (void)LOS_MuxLock(mutex, LOS_WAIT_FOREVER); } void sys_mutex_unlock(sys_mutex_t *mutex) { (void)LOS_MuxUnlock(mutex); } void sys_mutex_free(sys_mutex_t *mutex) { (void)LOS_MuxDestroy(mutex); } int sys_mutex_valid(sys_mutex_t *mutex) { return LOS_MuxIsValid(mutex); } void sys_mutex_set_invalid(sys_mutex_t *mutex) { (void)LOS_MuxDestroy(mutex); }