80 lines
1.8 KiB
C
80 lines
1.8 KiB
C
/*
|
|
* Copyright (c) 2016 Wind River Systems, Inc.
|
|
*
|
|
* SPDX-License-Identifier: Apache-2.0
|
|
*/
|
|
|
|
/**
|
|
* @file @brief task_offload_to_fiber() function for legacy applications
|
|
*
|
|
* For the legacy applications that need task_offload_to_fiber() function,
|
|
* the moduel implements it by means of using work queue
|
|
*/
|
|
|
|
#include <kernel.h>
|
|
#include <kernel_structs.h>
|
|
#include <ksched.h>
|
|
#include <init.h>
|
|
|
|
struct offload_work {
|
|
struct k_work work_item;
|
|
int (*offload_func)();
|
|
void *offload_args;
|
|
struct k_thread *thread;
|
|
};
|
|
|
|
static struct k_work_q offload_work_q;
|
|
|
|
/*
|
|
* Internal handler of the offload requests
|
|
*/
|
|
|
|
static void offload_handler(struct k_work *work)
|
|
{
|
|
struct offload_work *offload =
|
|
CONTAINER_OF(work, struct offload_work, work_item);
|
|
int result = (offload->offload_func)(offload->offload_args);
|
|
unsigned int key = irq_lock();
|
|
|
|
offload->thread->base.swap_data = (void *)result;
|
|
irq_unlock(key);
|
|
}
|
|
|
|
int task_offload_to_fiber(int (*func)(), void *argp)
|
|
{
|
|
/*
|
|
* Create work in stack. Task is scheduled out and does not
|
|
* return until the work is consumed and complete, so the
|
|
* work item will exists until then.
|
|
*/
|
|
struct offload_work offload = {
|
|
.offload_func = func,
|
|
.offload_args = argp
|
|
};
|
|
|
|
__ASSERT(_is_preempt(_current), "Fiber is trying to offload work");
|
|
|
|
k_work_init(&offload.work_item, offload_handler);
|
|
|
|
offload.thread = _current;
|
|
k_work_submit_to_queue(&offload_work_q, &offload.work_item);
|
|
return (int)_current->base.swap_data;
|
|
}
|
|
|
|
static char __stack offload_work_q_stack[CONFIG_OFFLOAD_WORKQUEUE_STACK_SIZE];
|
|
|
|
static int k_offload_work_q_init(struct device *dev)
|
|
{
|
|
ARG_UNUSED(dev);
|
|
|
|
k_work_q_start(&offload_work_q,
|
|
offload_work_q_stack,
|
|
sizeof(offload_work_q_stack),
|
|
CONFIG_OFFLOAD_WORKQUEUE_PRIORITY);
|
|
|
|
return 0;
|
|
}
|
|
|
|
SYS_INIT(k_offload_work_q_init, POST_KERNEL,
|
|
CONFIG_KERNEL_INIT_PRIORITY_DEFAULT);
|