/* Copyright (c), 2001-2022, Shenshu Tech. Co., Ltd. */ #include "ot_osal.h" #include #include #include #include #include #include #include "securec.h" osal_task_t *osal_kthread_create(threadfn_t thread, void *data, const char *name) { struct task_struct *k = NULL; osal_task_t *p = (osal_task_t *)kmalloc(sizeof(osal_task_t), GFP_KERNEL); if (p == NULL) { osal_trace("%s - kmalloc error!\n", __FUNCTION__); return NULL; } (void)memset_s(p, sizeof(osal_task_t), 0, sizeof(osal_task_t)); k = kthread_run(thread, data, name); if (IS_ERR(k)) { osal_trace("%s - kthread create error!\n", __FUNCTION__); kfree(p); p = NULL; return NULL; } p->task_struct = k; return p; } EXPORT_SYMBOL(osal_kthread_create); void osal_kthread_destroy(osal_task_t *task, unsigned int stop_flag) { if (task == NULL) { osal_trace("%s - parameter invalid!\n", __FUNCTION__); return; } /* note: When you call the Kthread_stop function, the thread function cannot be finished, otherwise it will oops. */ if ((stop_flag != 0) && (task->task_struct != NULL)) { kthread_stop((struct task_struct *)(task->task_struct)); } task->task_struct = NULL; kfree(task); } EXPORT_SYMBOL(osal_kthread_destroy); int osal_kthread_should_stop(void) { return kthread_should_stop(); } EXPORT_SYMBOL(osal_kthread_should_stop); int osal_tasklet_init(osal_tasklet_t *tasklet, void (*func)(unsigned long), unsigned long data) { struct tasklet_struct *p = NULL; if (tasklet == NULL) { osal_trace("%s - parameter invalid!\n", __FUNCTION__); return -1; } p = (struct tasklet_struct *)kmalloc(sizeof(struct tasklet_struct), GFP_KERNEL); if (p == NULL) { osal_trace("%s - kmalloc error!\n", __FUNCTION__); return -1; } tasklet_init(p, func, data); tasklet->tasklet_struct = p; return 0; } EXPORT_SYMBOL(osal_tasklet_init); void osal_tasklet_kill(osal_tasklet_t *tasklet) { struct tasklet_struct *p = NULL; if ((tasklet == NULL) || (tasklet->tasklet_struct == NULL)) { osal_trace("%s - parameter invalid!\n", __FUNCTION__); return; } p = (struct tasklet_struct *)(tasklet->tasklet_struct); tasklet_kill(p); kfree(p); tasklet->tasklet_struct = NULL; } EXPORT_SYMBOL(osal_tasklet_kill); void osal_tasklet_schedule(const osal_tasklet_t *tasklet) { struct tasklet_struct *p = NULL; if ((tasklet == NULL) || (tasklet->tasklet_struct == NULL)) { osal_trace("%s - parameter invalid!\n", __FUNCTION__); return; } p = (struct tasklet_struct *)tasklet->tasklet_struct; tasklet_schedule(p); } EXPORT_SYMBOL(osal_tasklet_schedule); int osal_get_current_tgid(void) { return get_current()->tgid; } EXPORT_SYMBOL(osal_get_current_tgid); int osal_get_current_pid(void) { return get_current()->pid; } EXPORT_SYMBOL(osal_get_current_pid);