rt-thread-stm32f072/rt-thread/components/drivers/wlan/wlan_workqueue.c

102 lines
2.4 KiB
C

/*
* Copyright (c) 2006-2021, RT-Thread Development Team
*
* SPDX-License-Identifier: Apache-2.0
*
* Change Logs:
* Date Author Notes
* 2018-08-19 tyx the first version
*/
#include <rthw.h>
#include <rtthread.h>
#include <wlan_workqueue.h>
#include <ipc/workqueue.h>
#define DBG_TAG "WLAN.work"
#define DBG_LVL DBG_INFO
#include <rtdbg.h>
#ifdef RT_WLAN_WORK_THREAD_ENABLE
struct rt_wlan_work
{
struct rt_work work;
void (*fun)(void *parameter);
void *parameter;
};
static struct rt_workqueue *wlan_workqueue;
static void rt_wlan_workqueue_fun(struct rt_work *work, void *work_data)
{
struct rt_wlan_work *wlan_work = work_data;
wlan_work->fun(wlan_work->parameter);
rt_free(wlan_work);
}
struct rt_workqueue *rt_wlan_get_workqueue(void)
{
return wlan_workqueue;
}
rt_err_t rt_wlan_workqueue_dowork(void (*func)(void *parameter), void *parameter)
{
struct rt_wlan_work *wlan_work;
rt_err_t err = RT_EOK;
LOG_D("F:%s is run", __FUNCTION__);
if (func == RT_NULL)
{
LOG_E("F:%s L:%d func is null", __FUNCTION__, __LINE__);
return -RT_EINVAL;
}
if (wlan_workqueue == RT_NULL)
{
LOG_E("F:%s L:%d not init wlan work queue", __FUNCTION__, __LINE__);
return -RT_ERROR;
}
wlan_work = rt_malloc(sizeof(struct rt_wlan_work));
if (wlan_work == RT_NULL)
{
LOG_E("F:%s L:%d create work failed", __FUNCTION__, __LINE__);
return -RT_ENOMEM;
}
wlan_work->fun = func;
wlan_work->parameter = parameter;
rt_work_init(&wlan_work->work, rt_wlan_workqueue_fun, wlan_work);
err = rt_workqueue_dowork(wlan_workqueue, &wlan_work->work);
if (err != RT_EOK)
{
LOG_E("F:%s L:%d do work failed", __FUNCTION__, __LINE__);
rt_free(wlan_work);
return err;
}
return err;
}
int rt_wlan_workqueue_init(void)
{
static rt_int8_t _init_flag = 0;
if (_init_flag == 0)
{
wlan_workqueue = rt_workqueue_create(RT_WLAN_WORKQUEUE_THREAD_NAME, RT_WLAN_WORKQUEUE_THREAD_SIZE,
RT_WLAN_WORKQUEUE_THREAD_PRIO);
if (wlan_workqueue == RT_NULL)
{
LOG_E("F:%s L:%d wlan work queue create failed", __FUNCTION__, __LINE__);
return -1;
}
_init_flag = 1;
return 0;
}
return 0;
}
INIT_PREV_EXPORT(rt_wlan_workqueue_init);
#endif