version 1.6.2.4, 2012/05/03 15:05:09
|
version 1.15.2.4, 2012/08/23 02:09:54
|
Line 101 schedRegisterHooks(sched_root_task_t * __restrict root
|
Line 101 schedRegisterHooks(sched_root_task_t * __restrict root
|
|
|
root->root_hooks.hook_add.read = sched_hook_read; |
root->root_hooks.hook_add.read = sched_hook_read; |
root->root_hooks.hook_add.write = sched_hook_write; |
root->root_hooks.hook_add.write = sched_hook_write; |
|
root->root_hooks.hook_add.alarm = sched_hook_alarm; |
|
root->root_hooks.hook_add.node = sched_hook_node; |
|
root->root_hooks.hook_add.proc = sched_hook_proc; |
|
root->root_hooks.hook_add.signal = sched_hook_signal; |
|
#ifdef EVFILT_USER |
|
root->root_hooks.hook_add.user = sched_hook_user; |
|
#endif |
|
#ifdef HAVE_LIBPTHREAD |
|
root->root_hooks.hook_add.thread = sched_hook_thread; |
|
#endif |
|
|
root->root_hooks.hook_exec.cancel = sched_hook_cancel; |
root->root_hooks.hook_exec.cancel = sched_hook_cancel; |
root->root_hooks.hook_exec.fetch = sched_hook_fetch; |
root->root_hooks.hook_exec.fetch = sched_hook_fetch; |
Line 133 schedInit(void ** __restrict data, size_t datlen)
|
Line 143 schedInit(void ** __restrict data, size_t datlen)
|
} else { |
} else { |
memset(root, 0, sizeof(sched_root_task_t)); |
memset(root, 0, sizeof(sched_root_task_t)); |
|
|
|
/* set default maximum regular task hit misses */ |
|
root->root_miss = MAX_TASK_MISS; |
|
|
/* INFINIT polling period by default */ |
/* INFINIT polling period by default */ |
sched_timespecinf(&root->root_poll); |
sched_timespecinf(&root->root_poll); |
|
|
Line 153 schedInit(void ** __restrict data, size_t datlen)
|
Line 166 schedInit(void ** __restrict data, size_t datlen)
|
TAILQ_INIT(&root->root_read); |
TAILQ_INIT(&root->root_read); |
TAILQ_INIT(&root->root_write); |
TAILQ_INIT(&root->root_write); |
TAILQ_INIT(&root->root_timer); |
TAILQ_INIT(&root->root_timer); |
|
TAILQ_INIT(&root->root_alarm); |
|
TAILQ_INIT(&root->root_node); |
|
TAILQ_INIT(&root->root_proc); |
|
TAILQ_INIT(&root->root_signal); |
|
TAILQ_INIT(&root->root_aio); |
|
TAILQ_INIT(&root->root_lio); |
|
TAILQ_INIT(&root->root_user); |
TAILQ_INIT(&root->root_event); |
TAILQ_INIT(&root->root_event); |
TAILQ_INIT(&root->root_eventlo); | TAILQ_INIT(&root->root_task); |
| TAILQ_INIT(&root->root_suspend); |
TAILQ_INIT(&root->root_ready); |
TAILQ_INIT(&root->root_ready); |
TAILQ_INIT(&root->root_unuse); |
TAILQ_INIT(&root->root_unuse); |
|
TAILQ_INIT(&root->root_thread); |
|
|
#ifdef HAVE_LIBPTHREAD |
#ifdef HAVE_LIBPTHREAD |
for (i = 0; i < taskMAX; i++) |
for (i = 0; i < taskMAX; i++) |
Line 190 schedInit(void ** __restrict data, size_t datlen)
|
Line 212 schedInit(void ** __restrict data, size_t datlen)
|
int |
int |
schedEnd(sched_root_task_t ** __restrict root) |
schedEnd(sched_root_task_t ** __restrict root) |
{ |
{ |
sched_task_t *task; | sched_task_t *task, *tmp; |
#ifdef HAVE_LIBPTHREAD |
#ifdef HAVE_LIBPTHREAD |
register int i; |
register int i; |
#endif |
#endif |
Line 198 schedEnd(sched_root_task_t ** __restrict root)
|
Line 220 schedEnd(sched_root_task_t ** __restrict root)
|
if (!root || !*root) |
if (!root || !*root) |
return -1; |
return -1; |
|
|
TAILQ_FOREACH(task, &(*root)->root_read, task_node) { | TAILQ_FOREACH_SAFE(task, &(*root)->root_read, task_node, tmp) |
schedCancel(task); |
schedCancel(task); |
} | TAILQ_FOREACH_SAFE(task, &(*root)->root_write, task_node, tmp) |
TAILQ_FOREACH(task, &(*root)->root_write, task_node) { | |
schedCancel(task); |
schedCancel(task); |
} | TAILQ_FOREACH_SAFE(task, &(*root)->root_timer, task_node, tmp) |
TAILQ_FOREACH(task, &(*root)->root_timer, task_node) { | |
schedCancel(task); |
schedCancel(task); |
} | TAILQ_FOREACH_SAFE(task, &(*root)->root_alarm, task_node, tmp) |
TAILQ_FOREACH(task, &(*root)->root_event, task_node) { | |
schedCancel(task); |
schedCancel(task); |
} | TAILQ_FOREACH_SAFE(task, &(*root)->root_node, task_node, tmp) |
TAILQ_FOREACH(task, &(*root)->root_eventlo, task_node) { | |
schedCancel(task); |
schedCancel(task); |
} | TAILQ_FOREACH_SAFE(task, &(*root)->root_proc, task_node, tmp) |
TAILQ_FOREACH(task, &(*root)->root_ready, task_node) { | |
schedCancel(task); |
schedCancel(task); |
} | TAILQ_FOREACH_SAFE(task, &(*root)->root_signal, task_node, tmp) |
| schedCancel(task); |
| TAILQ_FOREACH_SAFE(task, &(*root)->root_aio, task_node, tmp) |
| schedCancel(task); |
| TAILQ_FOREACH_SAFE(task, &(*root)->root_lio, task_node, tmp) |
| schedCancel(task); |
| TAILQ_FOREACH_SAFE(task, &(*root)->root_user, task_node, tmp) |
| schedCancel(task); |
| TAILQ_FOREACH_SAFE(task, &(*root)->root_event, task_node, tmp) |
| schedCancel(task); |
| TAILQ_FOREACH_SAFE(task, &(*root)->root_suspend, task_node, tmp) |
| schedCancel(task); |
| TAILQ_FOREACH_SAFE(task, &(*root)->root_ready, task_node, tmp) |
| schedCancel(task); |
| TAILQ_FOREACH_SAFE(task, &(*root)->root_thread, task_node, tmp) |
| schedCancel(task); |
| TAILQ_FOREACH_SAFE(task, &(*root)->root_task, task_node, tmp) |
| schedCancel(task); |
|
|
#ifdef HAVE_LIBPTHREAD |
#ifdef HAVE_LIBPTHREAD |
pthread_mutex_lock(&(*root)->root_mtx[taskUNUSE]); |
pthread_mutex_lock(&(*root)->root_mtx[taskUNUSE]); |
#endif |
#endif |
while ((task = TAILQ_FIRST(&(*root)->root_unuse))) { | TAILQ_FOREACH_SAFE(task, &(*root)->root_unuse, task_node, tmp) { |
TAILQ_REMOVE(&(*root)->root_unuse, task, task_node); |
TAILQ_REMOVE(&(*root)->root_unuse, task, task_node); |
free(task); |
free(task); |
} |
} |
Line 258 schedCall(sched_task_t * __restrict task)
|
Line 292 schedCall(sched_task_t * __restrict task)
|
if (!TASK_ISLOCKED(task)) |
if (!TASK_ISLOCKED(task)) |
TASK_LOCK(task); |
TASK_LOCK(task); |
|
|
task->task_id++; |
|
ptr = task->task_func(task); |
ptr = task->task_func(task); |
|
|
TASK_UNLOCK(task); |
TASK_UNLOCK(task); |
Line 288 schedFetch(sched_root_task_t * __restrict root)
|
Line 321 schedFetch(sched_root_task_t * __restrict root)
|
} |
} |
|
|
/* |
/* |
|
* schedTrigger() - Triggering USER task |
|
* |
|
* @task = task |
|
* return: -1 error or 0 ok |
|
*/ |
|
int |
|
schedTrigger(sched_task_t * __restrict task) |
|
{ |
|
#ifndef EVFILT_USER |
|
sched_SetErr(ENOTSUP, "Not supported kevent() filter"); |
|
return -1; |
|
#else |
|
struct kevent chg[1]; |
|
struct timespec timeout = { 0, 0 }; |
|
|
|
if (!task || !TASK_ROOT(task)) |
|
return -1; |
|
|
|
#ifdef __NetBSD__ |
|
EV_SET(chg, TASK_VAL(task), EVFILT_USER, 0, NOTE_TRIGGER, 0, (intptr_t) TASK_VAL(task)); |
|
#else |
|
EV_SET(chg, TASK_VAL(task), EVFILT_USER, 0, NOTE_TRIGGER, 0, (void*) TASK_VAL(task)); |
|
#endif |
|
if (kevent(TASK_ROOT(task)->root_kq, chg, 1, NULL, 0, &timeout) == -1) { |
|
LOGERR; |
|
return -1; |
|
} |
|
|
|
return 0; |
|
#endif |
|
} |
|
|
|
/* |
* schedCancel() - Cancel task from scheduler |
* schedCancel() - Cancel task from scheduler |
* |
* |
* @task = task |
* @task = task |
Line 315 schedCancel(sched_task_t * __restrict task)
|
Line 381 schedCancel(sched_task_t * __restrict task)
|
case taskTIMER: |
case taskTIMER: |
queue = &TASK_ROOT(task)->root_timer; |
queue = &TASK_ROOT(task)->root_timer; |
break; |
break; |
|
case taskALARM: |
|
queue = &TASK_ROOT(task)->root_alarm; |
|
break; |
|
case taskNODE: |
|
queue = &TASK_ROOT(task)->root_node; |
|
break; |
|
case taskPROC: |
|
queue = &TASK_ROOT(task)->root_proc; |
|
break; |
|
case taskSIGNAL: |
|
queue = &TASK_ROOT(task)->root_signal; |
|
break; |
|
case taskAIO: |
|
queue = &TASK_ROOT(task)->root_aio; |
|
break; |
|
case taskLIO: |
|
queue = &TASK_ROOT(task)->root_lio; |
|
break; |
|
case taskUSER: |
|
queue = &TASK_ROOT(task)->root_user; |
|
break; |
case taskEVENT: |
case taskEVENT: |
queue = &TASK_ROOT(task)->root_event; |
queue = &TASK_ROOT(task)->root_event; |
break; |
break; |
case taskEVENTLO: | case taskTASK: |
queue = &TASK_ROOT(task)->root_eventlo; | queue = &TASK_ROOT(task)->root_task; |
break; |
break; |
|
case taskSUSPEND: |
|
queue = &TASK_ROOT(task)->root_suspend; |
|
break; |
case taskREADY: |
case taskREADY: |
queue = &TASK_ROOT(task)->root_ready; |
queue = &TASK_ROOT(task)->root_ready; |
break; |
break; |
|
case taskTHREAD: |
|
queue = &TASK_ROOT(task)->root_thread; |
|
break; |
default: |
default: |
queue = NULL; |
queue = NULL; |
} |
} |
Line 331 schedCancel(sched_task_t * __restrict task)
|
Line 424 schedCancel(sched_task_t * __restrict task)
|
#ifdef HAVE_LIBPTHREAD |
#ifdef HAVE_LIBPTHREAD |
pthread_mutex_lock(&TASK_ROOT(task)->root_mtx[TASK_TYPE(task)]); |
pthread_mutex_lock(&TASK_ROOT(task)->root_mtx[TASK_TYPE(task)]); |
#endif |
#endif |
TAILQ_REMOVE(queue, task, task_node); | TAILQ_REMOVE(queue, TASK_ID(task), task_node); |
#ifdef HAVE_LIBPTHREAD |
#ifdef HAVE_LIBPTHREAD |
pthread_mutex_unlock(&TASK_ROOT(task)->root_mtx[TASK_TYPE(task)]); |
pthread_mutex_unlock(&TASK_ROOT(task)->root_mtx[TASK_TYPE(task)]); |
#endif |
#endif |
} |
} |
if (TASK_TYPE(task) != taskUNUSE) |
if (TASK_TYPE(task) != taskUNUSE) |
_sched_unuseTask(task); | sched_unuseTask(task); |
|
|
return 0; |
return 0; |
} |
} |
Line 347 schedCancel(sched_task_t * __restrict task)
|
Line 440 schedCancel(sched_task_t * __restrict task)
|
* |
* |
* @root = root task |
* @root = root task |
* @type = cancel from queue type, if =taskMAX cancel same task from all queues |
* @type = cancel from queue type, if =taskMAX cancel same task from all queues |
* @criteria = find task by criteria [CRITERIA_CALL|CRITERIA_ARG|CRITERIA_FD|CRITERIA_VAL|CRITERIA_TV] | * @criteria = find task by criteria |
| * [CRITERIA_ANY|CRITERIA_CALL|CRITERIA_ARG|CRITERIA_FD|CRITERIA_VAL|CRITERIA_ID|CRITERIA_TS|CRITERIA_DATA] |
* @param = search parameter |
* @param = search parameter |
* @hook = custom cleanup hook function, may be NULL |
* @hook = custom cleanup hook function, may be NULL |
* return: -1 error, -2 error in sub-stage cancel execution, -3 error from custom hook or 0 ok |
* return: -1 error, -2 error in sub-stage cancel execution, -3 error from custom hook or 0 ok |
Line 356 int
|
Line 450 int
|
schedCancelby(sched_root_task_t * __restrict root, sched_task_type_t type, |
schedCancelby(sched_root_task_t * __restrict root, sched_task_type_t type, |
u_char criteria, void *param, sched_hook_func_t hook) |
u_char criteria, void *param, sched_hook_func_t hook) |
{ |
{ |
sched_task_t *task; | sched_task_t *task, *tmp; |
sched_queue_t *queue; |
sched_queue_t *queue; |
int flg = 0; | register int flg = 0; |
|
|
if (!root) |
if (!root) |
return -1; |
return -1; |
|
/* if type == taskMAX check in all queues */ |
if (type == taskMAX) { |
if (type == taskMAX) { |
if (schedCancelby(root, taskREAD, criteria, param, hook)) |
if (schedCancelby(root, taskREAD, criteria, param, hook)) |
return -2; |
return -2; |
Line 369 schedCancelby(sched_root_task_t * __restrict root, sch
|
Line 464 schedCancelby(sched_root_task_t * __restrict root, sch
|
return -2; |
return -2; |
if (schedCancelby(root, taskTIMER, criteria, param, hook)) |
if (schedCancelby(root, taskTIMER, criteria, param, hook)) |
return -2; |
return -2; |
|
if (schedCancelby(root, taskALARM, criteria, param, hook)) |
|
return -2; |
|
if (schedCancelby(root, taskNODE, criteria, param, hook)) |
|
return -2; |
|
if (schedCancelby(root, taskPROC, criteria, param, hook)) |
|
return -2; |
|
if (schedCancelby(root, taskSIGNAL, criteria, param, hook)) |
|
return -2; |
|
if (schedCancelby(root, taskAIO, criteria, param, hook)) |
|
return -2; |
|
if (schedCancelby(root, taskLIO, criteria, param, hook)) |
|
return -2; |
|
if (schedCancelby(root, taskUSER, criteria, param, hook)) |
|
return -2; |
if (schedCancelby(root, taskEVENT, criteria, param, hook)) |
if (schedCancelby(root, taskEVENT, criteria, param, hook)) |
return -2; |
return -2; |
if (schedCancelby(root, taskEVENTLO, criteria, param, hook)) | if (schedCancelby(root, taskTASK, criteria, param, hook)) |
return -2; |
return -2; |
|
if (schedCancelby(root, taskSUSPEND, criteria, param, hook)) |
|
return -2; |
if (schedCancelby(root, taskREADY, criteria, param, hook)) |
if (schedCancelby(root, taskREADY, criteria, param, hook)) |
return -2; |
return -2; |
|
if (schedCancelby(root, taskTHREAD, criteria, param, hook)) |
|
return -2; |
return 0; |
return 0; |
} |
} |
|
/* choosen queue */ |
switch (type) { |
switch (type) { |
case taskREAD: |
case taskREAD: |
queue = &root->root_read; |
queue = &root->root_read; |
Line 387 schedCancelby(sched_root_task_t * __restrict root, sch
|
Line 501 schedCancelby(sched_root_task_t * __restrict root, sch
|
case taskTIMER: |
case taskTIMER: |
queue = &root->root_timer; |
queue = &root->root_timer; |
break; |
break; |
|
case taskALARM: |
|
queue = &root->root_alarm; |
|
break; |
|
case taskNODE: |
|
queue = &root->root_node; |
|
break; |
|
case taskPROC: |
|
queue = &root->root_proc; |
|
break; |
|
case taskSIGNAL: |
|
queue = &root->root_signal; |
|
break; |
|
case taskAIO: |
|
queue = &root->root_aio; |
|
break; |
|
case taskLIO: |
|
queue = &root->root_lio; |
|
break; |
|
case taskUSER: |
|
queue = &root->root_user; |
|
break; |
case taskEVENT: |
case taskEVENT: |
queue = &root->root_event; |
queue = &root->root_event; |
break; |
break; |
case taskEVENTLO: | case taskTASK: |
queue = &root->root_eventlo; | queue = &root->root_task; |
break; |
break; |
|
case taskSUSPEND: |
|
queue = &root->root_suspend; |
|
break; |
case taskREADY: |
case taskREADY: |
queue = &root->root_ready; |
queue = &root->root_ready; |
break; |
break; |
|
case taskTHREAD: |
|
queue = &root->root_thread; |
|
break; |
default: |
default: |
return 0; |
return 0; |
} |
} |
Line 403 schedCancelby(sched_root_task_t * __restrict root, sch
|
Line 544 schedCancelby(sched_root_task_t * __restrict root, sch
|
#ifdef HAVE_LIBPTHREAD |
#ifdef HAVE_LIBPTHREAD |
pthread_mutex_lock(&root->root_mtx[type]); |
pthread_mutex_lock(&root->root_mtx[type]); |
#endif |
#endif |
TAILQ_FOREACH(task, queue, task_node) | TAILQ_FOREACH_SAFE(task, queue, task_node, tmp) { |
if (criteria == CRITERIA_CALL) { | flg ^= flg; |
if (task->task_func == (sched_task_func_t) param) { | switch (criteria) { |
flg++; | case CRITERIA_ANY: |
| flg = 1; |
break; |
break; |
} | case CRITERIA_CALL: |
} else if (criteria == CRITERIA_ARG) { | if (TASK_FUNC(task) == (sched_task_func_t) param) |
if (task->task_arg == param) { | flg = 1; |
flg++; | |
break; |
break; |
} | case CRITERIA_ARG: |
} else if (criteria == CRITERIA_FD) { | if (TASK_ARG(task) == param) |
if (TASK_FD(task) == (intptr_t) param) { | flg = 1; |
flg++; | |
break; |
break; |
} | case CRITERIA_FD: |
} else if (criteria == CRITERIA_VAL) { | if (TASK_FD(task) == (intptr_t) param) |
if (TASK_VAL(task) == (u_long) param) { | flg = 1; |
flg++; | |
break; |
break; |
} | case CRITERIA_ID: |
} else if (criteria == CRITERIA_TV) { | case CRITERIA_VAL: |
if (!sched_timespeccmp(&TASK_TS(task), (struct timespec*) param, -)) { | if (TASK_VAL(task) == (u_long) param) |
flg++; | flg = 1; |
break; |
break; |
} | case CRITERIA_TS: |
} else { | if (!sched_timespeccmp(&TASK_TS(task), (struct timespec*) param, -)) |
#ifdef HAVE_LIBPTHREAD | flg = 1; |
pthread_mutex_unlock(&root->root_mtx[type]); | break; |
#endif | case CRITERIA_DATA: |
sched_SetErr(EINVAL, "Invalid parameter criteria %d", criteria); | if (TASK_DATA(task) == param) |
return -1; | flg = 1; |
| break; |
| default: |
| sched_SetErr(EINVAL, "Invalid parameter criteria %d", criteria); |
| flg = -1; |
} |
} |
#ifdef HAVE_LIBPTHREAD | if (flg < 0) /* error */ |
pthread_mutex_unlock(&root->root_mtx[type]); | break; |
#endif | /* cancel choosen task */ |
if (!flg || !task) /* task not found */ | if (flg > 0) { |
return 0; | if (TASK_ROOT(task)->root_hooks.hook_exec.cancel) |
| if (TASK_ROOT(task)->root_hooks.hook_exec.cancel(task, NULL)) { |
| flg = -1; |
| break; |
| } |
| /* custom hook */ |
| if (hook) |
| if (hook(task, NULL)) { |
| flg = -3; |
| break; |
| } |
|
|
if (TASK_ROOT(task)->root_hooks.hook_exec.cancel) | TAILQ_REMOVE(queue, task, task_node); |
if (TASK_ROOT(task)->root_hooks.hook_exec.cancel(task, NULL)) | if (TASK_TYPE(task) != taskUNUSE) |
return -1; | sched_unuseTask(task); |
if (hook) | |
if (hook(task, NULL)) | |
return -3; | |
|
|
|
flg ^= flg; /* ok */ |
|
} |
|
} |
#ifdef HAVE_LIBPTHREAD |
#ifdef HAVE_LIBPTHREAD |
pthread_mutex_lock(&TASK_ROOT(task)->root_mtx[type]); | pthread_mutex_unlock(&root->root_mtx[type]); |
#endif |
#endif |
TAILQ_REMOVE(queue, task, task_node); | return flg; |
#ifdef HAVE_LIBPTHREAD | |
pthread_mutex_unlock(&TASK_ROOT(task)->root_mtx[type]); | |
#endif | |
| |
if (TASK_TYPE(task) != taskUNUSE) | |
_sched_unuseTask(task); | |
return 0; | |
} |
} |
|
|
/* |
/* |
Line 488 schedRun(sched_root_task_t *root, volatile intptr_t *
|
Line 634 schedRun(sched_root_task_t *root, volatile intptr_t *
|
root->root_hooks.hook_exec.condition && |
root->root_hooks.hook_exec.condition && |
root->root_hooks.hook_exec.condition(root, (void*) killState)) { |
root->root_hooks.hook_exec.condition(root, (void*) killState)) { |
if ((task = root->root_hooks.hook_exec.fetch(root, NULL))) |
if ((task = root->root_hooks.hook_exec.fetch(root, NULL))) |
schedCall(task); | root->root_ret = schedCall(task); |
} |
} |
else |
else |
/* trigger scheduler loop */ |
/* trigger scheduler loop */ |
while (!*killState && root && root->root_hooks.hook_exec.fetch) { |
while (!*killState && root && root->root_hooks.hook_exec.fetch) { |
if ((task = root->root_hooks.hook_exec.fetch(root, NULL))) |
if ((task = root->root_hooks.hook_exec.fetch(root, NULL))) |
schedCall(task); | root->root_ret = schedCall(task); |
} |
} |
} else |
} else |
/* infinite scheduler loop */ |
/* infinite scheduler loop */ |
while (root && root->root_hooks.hook_exec.fetch) |
while (root && root->root_hooks.hook_exec.fetch) |
if ((task = root->root_hooks.hook_exec.fetch(root, NULL))) |
if ((task = root->root_hooks.hook_exec.fetch(root, NULL))) |
schedCall(task); | root->root_ret = schedCall(task); |
|
|
return 0; |
return 0; |
} |
} |
Line 536 schedPolling(sched_root_task_t * __restrict root, stru
|
Line 682 schedPolling(sched_root_task_t * __restrict root, stru
|
* |
* |
* @root = root task |
* @root = root task |
* @condValue = condition value, kill schedRun() if condValue == killState |
* @condValue = condition value, kill schedRun() if condValue == killState |
* return: -1 error ok 0 ok | * return: -1 error or 0 ok |
*/ |
*/ |
inline int |
inline int |
schedTermCondition(sched_root_task_t * __restrict root, intptr_t condValue) |
schedTermCondition(sched_root_task_t * __restrict root, intptr_t condValue) |
Line 547 schedTermCondition(sched_root_task_t * __restrict root
|
Line 693 schedTermCondition(sched_root_task_t * __restrict root
|
root->root_cond = condValue; |
root->root_cond = condValue; |
root->root_hooks.hook_exec.condition = sched_hook_condition; |
root->root_hooks.hook_exec.condition = sched_hook_condition; |
return 0; |
return 0; |
|
} |
|
|
|
/* |
|
* schedResumeby() - Resume suspended task |
|
* |
|
* @root = root task |
|
* @criteria = find task by criteria |
|
* [CRITERIA_ANY|CRITERIA_ID|CRITERIA_DATA] |
|
* @param = search parameter (sched_task_t *task| u_long id) |
|
* return: -1 error or 0 resumed ok |
|
*/ |
|
int |
|
schedResumeby(sched_root_task_t * __restrict root, u_char criteria, void *param) |
|
{ |
|
sched_task_t *task, *tmp; |
|
register int flg = 0; |
|
|
|
if (!root) |
|
return -1; |
|
|
|
#ifdef HAVE_LIBPTHREAD |
|
pthread_mutex_lock(&root->root_mtx[taskSUSPEND]); |
|
#endif |
|
TAILQ_FOREACH_SAFE(task, &root->root_suspend, task_node, tmp) { |
|
flg ^= flg; |
|
switch (criteria) { |
|
case CRITERIA_ANY: |
|
flg = 1; |
|
break; |
|
case CRITERIA_ID: |
|
if (TASK_VAL(task) == (u_long) param) |
|
flg = 1; |
|
break; |
|
case CRITERIA_DATA: |
|
if (TASK_ID(task) == (sched_task_t*) param) |
|
flg = 1; |
|
break; |
|
default: |
|
sched_SetErr(EINVAL, "Invalid parameter criteria %d", criteria); |
|
flg = -1; |
|
} |
|
if (flg < 0) |
|
break; |
|
/* resume choosen task */ |
|
if (flg > 0) { |
|
if (root->root_hooks.hook_exec.resume) |
|
if (root->root_hooks.hook_exec.resume(task, NULL)) { |
|
flg = -1; |
|
break; |
|
} |
|
|
|
TAILQ_REMOVE(&root->root_suspend, task, task_node); |
|
|
|
task->task_type = taskREADY; |
|
#ifdef HAVE_LIBPTHREAD |
|
pthread_mutex_lock(&root->root_mtx[taskREADY]); |
|
#endif |
|
TAILQ_INSERT_TAIL(&root->root_ready, task, task_node); |
|
#ifdef HAVE_LIBPTHREAD |
|
pthread_mutex_unlock(&root->root_mtx[taskREADY]); |
|
#endif |
|
|
|
flg ^= flg; /* ok */ |
|
} |
|
} |
|
#ifdef HAVE_LIBPTHREAD |
|
pthread_mutex_unlock(&root->root_mtx[taskSUSPEND]); |
|
#endif |
|
|
|
return flg; |
} |
} |