mirror of https://github.com/thesofproject/sof.git
116 lines
2.6 KiB
C
116 lines
2.6 KiB
C
// SPDX-License-Identifier: BSD-3-Clause
|
|
//
|
|
// Copyright(c) 2019 Intel Corporation. All rights reserved.
|
|
//
|
|
// Author: Bartosz Kokoszko <bartoszx.kokoszko@linux.intel.com>
|
|
|
|
#include <sof/audio/component.h>
|
|
#include <sof/schedule/task.h>
|
|
#include <stdint.h>
|
|
#include <sof/schedule/edf_schedule.h>
|
|
#include <sof/lib/wait.h>
|
|
#include <stdlib.h>
|
|
|
|
/* scheduler testbench definition */
|
|
|
|
struct edf_schedule_data {
|
|
struct list_item list; /* list of tasks in priority queue */
|
|
uint32_t clock;
|
|
};
|
|
|
|
struct scheduler_ops schedule_edf_ops;
|
|
|
|
static struct edf_schedule_data *sch;
|
|
|
|
static void schedule_edf_task_complete(struct task *task)
|
|
{
|
|
list_item_del(&task->list);
|
|
task->state = SOF_TASK_STATE_COMPLETED;
|
|
}
|
|
|
|
/* schedule task */
|
|
static void schedule_edf_task(void *data, struct task *task, uint64_t start,
|
|
uint64_t period)
|
|
{
|
|
struct edf_schedule_data *sch = data;
|
|
(void)period;
|
|
list_item_prepend(&task->list, &sch->list);
|
|
task->state = SOF_TASK_STATE_QUEUED;
|
|
|
|
if (task->ops.run)
|
|
task->ops.run(task->data);
|
|
|
|
schedule_edf_task_complete(task);
|
|
}
|
|
|
|
int schedule_task_init_edf(struct task *task, const struct task_ops *ops,
|
|
void *data, uint16_t core, uint32_t flags)
|
|
{
|
|
struct edf_task_pdata *edf_pdata;
|
|
int ret = 0;
|
|
|
|
ret = schedule_task_init(task, SOF_SCHEDULE_EDF, 0, ops->run, data,
|
|
core, flags);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
edf_pdata = malloc(sizeof(*edf_pdata));
|
|
edf_sch_set_pdata(task, edf_pdata);
|
|
|
|
task->ops.complete = ops->complete;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* initialize scheduler */
|
|
int scheduler_init_edf(void)
|
|
{
|
|
trace_edf_sch("edf_scheduler_init()");
|
|
sch = malloc(sizeof(*sch));
|
|
list_init(&sch->list);
|
|
|
|
scheduler_init(SOF_SCHEDULE_EDF, &schedule_edf_ops, sch);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void edf_scheduler_free(void *data)
|
|
{
|
|
free(data);
|
|
}
|
|
|
|
/* The following definitions are to satisfy libsof linker errors */
|
|
static void schedule_edf(void *data)
|
|
{
|
|
}
|
|
|
|
static void schedule_edf_task_cancel(void *data, struct task *task)
|
|
{
|
|
if (task->state == SOF_TASK_STATE_QUEUED) {
|
|
/* delete task */
|
|
task->state = SOF_TASK_STATE_CANCEL;
|
|
list_item_del(&task->list);
|
|
}
|
|
}
|
|
|
|
static void schedule_edf_task_free(void *data, struct task *task)
|
|
{
|
|
task->state = SOF_TASK_STATE_FREE;
|
|
task->ops.run = NULL;
|
|
task->data = NULL;
|
|
|
|
free(edf_sch_get_pdata(task));
|
|
edf_sch_set_pdata(task, NULL);
|
|
}
|
|
|
|
struct scheduler_ops schedule_edf_ops = {
|
|
.schedule_task = schedule_edf_task,
|
|
.schedule_task_running = NULL,
|
|
.schedule_task_complete = NULL,
|
|
.reschedule_task = NULL,
|
|
.schedule_task_cancel = schedule_edf_task_cancel,
|
|
.schedule_task_free = schedule_edf_task_free,
|
|
.scheduler_free = edf_scheduler_free,
|
|
.scheduler_run = schedule_edf
|
|
};
|