Annotation of libaitsched/src/tasks.c, revision 1.24.2.2

1.1       misho       1: /*************************************************************************
                      2: * (C) 2011 AITNET ltd - Sofia/Bulgaria - <misho@aitbg.com>
                      3: *  by Michael Pounov <misho@openbsd-bg.org>
                      4: *
                      5: * $Author: misho $
1.24.2.2! misho       6: * $Id: tasks.c,v 1.24.2.1 2014/05/21 21:11:29 misho Exp $
1.1       misho       7: *
                      8: **************************************************************************
                      9: The ELWIX and AITNET software is distributed under the following
                     10: terms:
                     11: 
                     12: All of the documentation and software included in the ELWIX and AITNET
                     13: Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>
                     14: 
1.23      misho      15: Copyright 2004 - 2014
1.1       misho      16:        by Michael Pounov <misho@elwix.org>.  All rights reserved.
                     17: 
                     18: Redistribution and use in source and binary forms, with or without
                     19: modification, are permitted provided that the following conditions
                     20: are met:
                     21: 1. Redistributions of source code must retain the above copyright
                     22:    notice, this list of conditions and the following disclaimer.
                     23: 2. Redistributions in binary form must reproduce the above copyright
                     24:    notice, this list of conditions and the following disclaimer in the
                     25:    documentation and/or other materials provided with the distribution.
                     26: 3. All advertising materials mentioning features or use of this software
                     27:    must display the following acknowledgement:
                     28: This product includes software developed by Michael Pounov <misho@elwix.org>
                     29: ELWIX - Embedded LightWeight unIX and its contributors.
                     30: 4. Neither the name of AITNET nor the names of its contributors
                     31:    may be used to endorse or promote products derived from this software
                     32:    without specific prior written permission.
                     33: 
                     34: THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``AS IS'' AND
                     35: ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
                     36: IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
                     37: ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
                     38: FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
                     39: DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
                     40: OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
                     41: HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
                     42: LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
                     43: OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
                     44: SUCH DAMAGE.
                     45: */
                     46: #include "global.h"
                     47: 
                     48: 
1.13      misho      49: /*
                     50:  * sched_useTask() - Get and init new task
                     51:  *
                     52:  * @root = root task
                     53:  * return: NULL error or !=NULL prepared task
                     54:  */
1.16      misho      55: sched_task_t *
1.13      misho      56: sched_useTask(sched_root_task_t * __restrict root)
1.4       misho      57: {
1.7       misho      58:        sched_task_t *task, *tmp;
1.4       misho      59: 
1.14      misho      60: #ifdef HAVE_LIBPTHREAD
                     61:        pthread_mutex_lock(&root->root_mtx[taskUNUSE]);
                     62: #endif
1.7       misho      63:        TAILQ_FOREACH_SAFE(task, &root->root_unuse, task_node, tmp) {
1.4       misho      64:                if (!TASK_ISLOCKED(task)) {
                     65:                        TAILQ_REMOVE(&root->root_unuse, task, task_node);
                     66:                        break;
                     67:                }
                     68:        }
1.14      misho      69: #ifdef HAVE_LIBPTHREAD
                     70:        pthread_mutex_unlock(&root->root_mtx[taskUNUSE]);
                     71: #endif
1.4       misho      72: 
                     73:        if (!task) {
                     74:                task = malloc(sizeof(sched_task_t));
                     75:                if (!task) {
                     76:                        LOGERR;
                     77:                        return NULL;
                     78:                }
                     79:        }
                     80: 
1.9       misho      81:        memset(task, 0, sizeof(sched_task_t));
                     82:        task->task_id = (uintptr_t) task;
1.4       misho      83:        return task;
                     84: }
                     85: 
1.13      misho      86: /*
                     87:  * sched_unuseTask() - Unlock and put task to unuse queue
                     88:  *
                     89:  * @task = task
                     90:  * return: always is NULL
                     91:  */
1.16      misho      92: sched_task_t *
1.13      misho      93: sched_unuseTask(sched_task_t * __restrict task)
1.4       misho      94: {
                     95:        TASK_UNLOCK(task);
1.5       misho      96:        TASK_TYPE(task) = taskUNUSE;
                     97: #ifdef HAVE_LIBPTHREAD
                     98:        pthread_mutex_lock(&TASK_ROOT(task)->root_mtx[taskUNUSE]);
                     99: #endif
1.9       misho     100:        TAILQ_INSERT_TAIL(&TASK_ROOT(task)->root_unuse, TASK_ID(task), task_node);
1.5       misho     101: #ifdef HAVE_LIBPTHREAD
                    102:        pthread_mutex_unlock(&TASK_ROOT(task)->root_mtx[taskUNUSE]);
                    103: #endif
1.4       misho     104:        task = NULL;
                    105: 
                    106:        return task;
                    107: }
                    108: 
1.14      misho     109: #pragma GCC visibility push(hidden)
                    110: 
                    111: #ifdef HAVE_LIBPTHREAD
                    112: static void
                    113: _sched_threadCleanup(sched_task_t *t)
                    114: {
                    115:        if (!t || !TASK_ROOT(t))
                    116:                return;
                    117: 
1.15      misho     118:        pthread_mutex_lock(&TASK_ROOT(t)->root_mtx[taskTHREAD]);
                    119:        TAILQ_REMOVE(&TASK_ROOT(t)->root_thread, t, task_node);
                    120:        pthread_mutex_unlock(&TASK_ROOT(t)->root_mtx[taskTHREAD]);
1.14      misho     121:        sched_unuseTask(t);
                    122: }
                    123: void *
                    124: _sched_threadWrapper(sched_task_t *t)
                    125: {
                    126:        void *ret = NULL;
                    127: 
1.21      misho     128:        pthread_cleanup_push((void (*)(void*)) _sched_threadCleanup, t);
                    129: 
                    130:        if (!t || !TASK_ROOT(t))
1.14      misho     131:                pthread_exit(ret);
                    132: 
                    133:        pthread_setcancelstate(PTHREAD_CANCEL_ENABLE, NULL);
1.21      misho     134:        /*
1.14      misho     135:        pthread_setcanceltype(PTHREAD_CANCEL_ASYNCHRONOUS, NULL);
1.21      misho     136:        */
1.20      misho     137: 
1.15      misho     138:        /* notify parent, thread is ready for execution */
1.14      misho     139:        pthread_testcancel();
                    140: 
1.22      misho     141:        ret = schedCall(t);
1.14      misho     142: 
                    143:        pthread_cleanup_pop(42);
                    144:        TASK_ROOT(t)->root_ret = ret;
                    145:        pthread_exit(ret);
                    146: }
                    147: #endif
                    148: 
1.24      misho     149: #if defined(HAVE_TIMER_CREATE) && defined(HAVE_TIMER_SETTIME) && defined(HAVE_TIMER_DELETE)
1.19      misho     150: void *
                    151: _sched_rtcWrapper(sched_task_t *t)
                    152: {
                    153:        sched_task_func_t func;
                    154:        sched_task_t *task;
1.20      misho     155:        sched_root_task_t *r;
1.19      misho     156: 
                    157:        if (!t || !TASK_ROOT(t) || !TASK_DATA(t))
                    158:                return NULL;
                    159:        else {
1.20      misho     160:                r = TASK_ROOT(t);
1.19      misho     161:                task = (sched_task_t*) TASK_DATA(t);
                    162:                func = TASK_FUNC(task);
                    163:        }
                    164: 
1.20      misho     165: #ifdef HAVE_LIBPTHREAD
                    166:        pthread_mutex_lock(&r->root_mtx[taskRTC]);
                    167: #endif
                    168:        TAILQ_REMOVE(&r->root_rtc, task, task_node);
                    169: #ifdef HAVE_LIBPTHREAD
                    170:        pthread_mutex_unlock(&r->root_mtx[taskRTC]);
                    171: #endif
1.21      misho     172:        sched_unuseTask(task);
1.20      misho     173: 
1.21      misho     174:        timer_delete((timer_t) TASK_DATLEN(t));
1.20      misho     175: 
1.22      misho     176:        return schedCall(task);
1.19      misho     177: }
                    178: #endif
                    179: 
1.14      misho     180: #pragma GCC visibility pop
                    181: 
                    182: /*
                    183:  * sched_taskExit() - Exit routine for scheduler task, explicit required for thread tasks
                    184:  *
                    185:  * @task = current task
                    186:  * @retcode = return code
                    187:  * return: return code
                    188:  */
1.16      misho     189: void *
1.14      misho     190: sched_taskExit(sched_task_t *task, intptr_t retcode)
                    191: {
                    192:        if (!task || !TASK_ROOT(task))
                    193:                return (void*) -1;
                    194: 
                    195:        if (TASK_ROOT(task)->root_hooks.hook_exec.exit)
                    196:                TASK_ROOT(task)->root_hooks.hook_exec.exit(task, (void*) retcode);
                    197: 
                    198:        TASK_ROOT(task)->root_ret = (void*) retcode;
                    199:        return (void*) retcode;
                    200: }
                    201: 
1.4       misho     202: 
1.1       misho     203: /*
1.2       misho     204:  * schedRead() - Add READ I/O task to scheduler queue
1.6       misho     205:  *
1.1       misho     206:  * @root = root task
                    207:  * @func = task execution function
                    208:  * @arg = 1st func argument
1.2       misho     209:  * @fd = fd handle
1.5       misho     210:  * @opt_data = Optional data
                    211:  * @opt_dlen = Optional data length
1.1       misho     212:  * return: NULL error or !=NULL new queued task
                    213:  */
                    214: sched_task_t *
1.5       misho     215: schedRead(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int fd, 
                    216:                void *opt_data, size_t opt_dlen)
1.1       misho     217: {
                    218:        sched_task_t *task;
                    219:        void *ptr;
                    220: 
                    221:        if (!root || !func)
                    222:                return NULL;
                    223: 
                    224:        /* get new task */
1.13      misho     225:        if (!(task = sched_useTask(root)))
1.4       misho     226:                return NULL;
1.1       misho     227: 
                    228:        task->task_func = func;
1.5       misho     229:        TASK_TYPE(task) = taskREAD;
                    230:        TASK_ROOT(task) = root;
1.1       misho     231: 
                    232:        TASK_ARG(task) = arg;
1.2       misho     233:        TASK_FD(task) = fd;
1.1       misho     234: 
1.5       misho     235:        TASK_DATA(task) = opt_data;
                    236:        TASK_DATLEN(task) = opt_dlen;
                    237: 
1.1       misho     238:        if (root->root_hooks.hook_add.read)
                    239:                ptr = root->root_hooks.hook_add.read(task, NULL);
                    240:        else
                    241:                ptr = NULL;
                    242: 
1.5       misho     243:        if (!ptr) {
                    244: #ifdef HAVE_LIBPTHREAD
                    245:                pthread_mutex_lock(&root->root_mtx[taskREAD]);
                    246: #endif
1.9       misho     247:                TAILQ_INSERT_TAIL(&root->root_read, TASK_ID(task), task_node);
1.5       misho     248: #ifdef HAVE_LIBPTHREAD
                    249:                pthread_mutex_unlock(&root->root_mtx[taskREAD]);
                    250: #endif
                    251:        } else
1.13      misho     252:                task = sched_unuseTask(task);
1.1       misho     253: 
                    254:        return task;
                    255: }
                    256: 
                    257: /*
1.2       misho     258:  * schedWrite() - Add WRITE I/O task to scheduler queue
1.6       misho     259:  *
1.1       misho     260:  * @root = root task
                    261:  * @func = task execution function
                    262:  * @arg = 1st func argument
1.2       misho     263:  * @fd = fd handle
1.5       misho     264:  * @opt_data = Optional data
                    265:  * @opt_dlen = Optional data length
1.1       misho     266:  * return: NULL error or !=NULL new queued task
                    267:  */
                    268: sched_task_t *
1.5       misho     269: schedWrite(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int fd, 
                    270:                void *opt_data, size_t opt_dlen)
1.1       misho     271: {
                    272:        sched_task_t *task;
                    273:        void *ptr;
                    274: 
                    275:        if (!root || !func)
                    276:                return NULL;
                    277: 
                    278:        /* get new task */
1.13      misho     279:        if (!(task = sched_useTask(root)))
1.4       misho     280:                return NULL;
1.1       misho     281: 
                    282:        task->task_func = func;
1.5       misho     283:        TASK_TYPE(task) = taskWRITE;
                    284:        TASK_ROOT(task) = root;
1.1       misho     285: 
                    286:        TASK_ARG(task) = arg;
1.2       misho     287:        TASK_FD(task) = fd;
1.1       misho     288: 
1.5       misho     289:        TASK_DATA(task) = opt_data;
                    290:        TASK_DATLEN(task) = opt_dlen;
                    291: 
1.1       misho     292:        if (root->root_hooks.hook_add.write)
                    293:                ptr = root->root_hooks.hook_add.write(task, NULL);
                    294:        else
                    295:                ptr = NULL;
                    296: 
1.5       misho     297:        if (!ptr) {
                    298: #ifdef HAVE_LIBPTHREAD
                    299:                pthread_mutex_lock(&root->root_mtx[taskWRITE]);
                    300: #endif
1.9       misho     301:                TAILQ_INSERT_TAIL(&root->root_write, TASK_ID(task), task_node);
1.5       misho     302: #ifdef HAVE_LIBPTHREAD
                    303:                pthread_mutex_unlock(&root->root_mtx[taskWRITE]);
                    304: #endif
                    305:        } else
1.13      misho     306:                task = sched_unuseTask(task);
1.1       misho     307: 
                    308:        return task;
                    309: }
                    310: 
                    311: /*
1.9       misho     312:  * schedNode() - Add NODE task to scheduler queue
                    313:  *
                    314:  * @root = root task
                    315:  * @func = task execution function
                    316:  * @arg = 1st func argument
                    317:  * @fd = fd handle
                    318:  * @opt_data = Optional data
                    319:  * @opt_dlen = Optional data length
                    320:  * return: NULL error or !=NULL new queued task
                    321:  */
                    322: sched_task_t *
                    323: schedNode(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int fd, 
                    324:                void *opt_data, size_t opt_dlen)
                    325: {
1.23      misho     326: #ifdef KQ_DISABLE
                    327:        sched_SetErr(ENOTSUP, "disabled kqueue support");
                    328:        return NULL;
                    329: #else
1.9       misho     330:        sched_task_t *task;
                    331:        void *ptr;
                    332: 
                    333:        if (!root || !func)
                    334:                return NULL;
                    335: 
                    336:        /* get new task */
1.13      misho     337:        if (!(task = sched_useTask(root)))
1.9       misho     338:                return NULL;
                    339: 
                    340:        task->task_func = func;
                    341:        TASK_TYPE(task) = taskNODE;
                    342:        TASK_ROOT(task) = root;
                    343: 
                    344:        TASK_ARG(task) = arg;
                    345:        TASK_FD(task) = fd;
                    346: 
                    347:        TASK_DATA(task) = opt_data;
                    348:        TASK_DATLEN(task) = opt_dlen;
                    349: 
                    350:        if (root->root_hooks.hook_add.node)
                    351:                ptr = root->root_hooks.hook_add.node(task, NULL);
                    352:        else
                    353:                ptr = NULL;
                    354: 
                    355:        if (!ptr) {
                    356: #ifdef HAVE_LIBPTHREAD
                    357:                pthread_mutex_lock(&root->root_mtx[taskNODE]);
                    358: #endif
                    359:                TAILQ_INSERT_TAIL(&root->root_node, TASK_ID(task), task_node);
                    360: #ifdef HAVE_LIBPTHREAD
                    361:                pthread_mutex_unlock(&root->root_mtx[taskNODE]);
                    362: #endif
                    363:        } else
1.13      misho     364:                task = sched_unuseTask(task);
1.9       misho     365: 
                    366:        return task;
1.23      misho     367: #endif /* KQ_DISABLE */
1.9       misho     368: }
                    369: 
                    370: /*
                    371:  * schedProc() - Add PROC task to scheduler queue
                    372:  *
                    373:  * @root = root task
                    374:  * @func = task execution function
                    375:  * @arg = 1st func argument
                    376:  * @pid = PID
                    377:  * @opt_data = Optional data
                    378:  * @opt_dlen = Optional data length
                    379:  * return: NULL error or !=NULL new queued task
                    380:  */
                    381: sched_task_t *
                    382: schedProc(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, u_long pid, 
                    383:                void *opt_data, size_t opt_dlen)
                    384: {
1.23      misho     385: #ifdef KQ_DISABLE
                    386:        sched_SetErr(ENOTSUP, "disabled kqueue support");
                    387:        return NULL;
                    388: #else
1.9       misho     389:        sched_task_t *task;
                    390:        void *ptr;
                    391: 
                    392:        if (!root || !func)
                    393:                return NULL;
                    394: 
                    395:        /* get new task */
1.13      misho     396:        if (!(task = sched_useTask(root)))
1.9       misho     397:                return NULL;
                    398: 
                    399:        task->task_func = func;
                    400:        TASK_TYPE(task) = taskPROC;
                    401:        TASK_ROOT(task) = root;
                    402: 
                    403:        TASK_ARG(task) = arg;
                    404:        TASK_VAL(task) = pid;
                    405: 
                    406:        TASK_DATA(task) = opt_data;
                    407:        TASK_DATLEN(task) = opt_dlen;
                    408: 
                    409:        if (root->root_hooks.hook_add.proc)
                    410:                ptr = root->root_hooks.hook_add.proc(task, NULL);
                    411:        else
                    412:                ptr = NULL;
                    413: 
                    414:        if (!ptr) {
                    415: #ifdef HAVE_LIBPTHREAD
                    416:                pthread_mutex_lock(&root->root_mtx[taskPROC]);
                    417: #endif
                    418:                TAILQ_INSERT_TAIL(&root->root_proc, TASK_ID(task), task_node);
                    419: #ifdef HAVE_LIBPTHREAD
                    420:                pthread_mutex_unlock(&root->root_mtx[taskPROC]);
                    421: #endif
                    422:        } else
1.13      misho     423:                task = sched_unuseTask(task);
1.9       misho     424: 
                    425:        return task;
1.23      misho     426: #endif /* KQ_DISABLE */
1.9       misho     427: }
                    428: 
                    429: /*
                    430:  * schedUser() - Add trigger USER task to scheduler queue
                    431:  *
                    432:  * @root = root task
                    433:  * @func = task execution function
                    434:  * @arg = 1st func argument
                    435:  * @id = Trigger ID
                    436:  * @opt_data = Optional data
                    437:  * @opt_dlen = Optional user's trigger flags
                    438:  * return: NULL error or !=NULL new queued task
                    439:  */
                    440: sched_task_t *
                    441: schedUser(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, u_long id, 
                    442:                void *opt_data, size_t opt_dlen)
                    443: {
1.23      misho     444: #ifdef KQ_DISABLE
                    445:        sched_SetErr(ENOTSUP, "disabled kqueue support");
                    446:        return NULL;
                    447: #else
1.9       misho     448: #ifndef EVFILT_USER
                    449:        sched_SetErr(ENOTSUP, "Not supported kevent() filter");
                    450:        return NULL;
                    451: #else
                    452:        sched_task_t *task;
                    453:        void *ptr;
                    454: 
                    455:        if (!root || !func)
                    456:                return NULL;
                    457: 
                    458:        /* get new task */
1.13      misho     459:        if (!(task = sched_useTask(root)))
1.9       misho     460:                return NULL;
                    461: 
                    462:        task->task_func = func;
                    463:        TASK_TYPE(task) = taskUSER;
                    464:        TASK_ROOT(task) = root;
                    465: 
                    466:        TASK_ARG(task) = arg;
                    467:        TASK_VAL(task) = id;
                    468: 
                    469:        TASK_DATA(task) = opt_data;
                    470:        TASK_DATLEN(task) = opt_dlen;
                    471: 
                    472:        if (root->root_hooks.hook_add.user)
                    473:                ptr = root->root_hooks.hook_add.user(task, NULL);
                    474:        else
                    475:                ptr = NULL;
                    476: 
                    477:        if (!ptr) {
                    478: #ifdef HAVE_LIBPTHREAD
                    479:                pthread_mutex_lock(&root->root_mtx[taskUSER]);
                    480: #endif
                    481:                TAILQ_INSERT_TAIL(&root->root_user, TASK_ID(task), task_node);
                    482: #ifdef HAVE_LIBPTHREAD
                    483:                pthread_mutex_unlock(&root->root_mtx[taskUSER]);
                    484: #endif
                    485:        } else
1.13      misho     486:                task = sched_unuseTask(task);
1.9       misho     487: 
                    488:        return task;
1.23      misho     489: #endif /* EVFILT_USER */
                    490: #endif /* KQ_DISABLE */
1.9       misho     491: }
                    492: 
                    493: /*
                    494:  * schedSignal() - Add SIGNAL task to scheduler queue
                    495:  *
                    496:  * @root = root task
                    497:  * @func = task execution function
                    498:  * @arg = 1st func argument
                    499:  * @sig = Signal
                    500:  * @opt_data = Optional data
                    501:  * @opt_dlen = Optional data length
                    502:  * return: NULL error or !=NULL new queued task
                    503:  */
                    504: sched_task_t *
                    505: schedSignal(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, u_long sig, 
                    506:                void *opt_data, size_t opt_dlen)
                    507: {
1.23      misho     508: #ifdef KQ_DISABLE
                    509:        sched_SetErr(ENOTSUP, "disabled kqueue support");
                    510:        return NULL;
                    511: #else
1.9       misho     512:        sched_task_t *task;
                    513:        void *ptr;
                    514: 
                    515:        if (!root || !func)
                    516:                return NULL;
                    517: 
                    518:        /* get new task */
1.13      misho     519:        if (!(task = sched_useTask(root)))
1.9       misho     520:                return NULL;
                    521: 
                    522:        task->task_func = func;
                    523:        TASK_TYPE(task) = taskSIGNAL;
                    524:        TASK_ROOT(task) = root;
                    525: 
                    526:        TASK_ARG(task) = arg;
                    527:        TASK_VAL(task) = sig;
                    528: 
                    529:        TASK_DATA(task) = opt_data;
                    530:        TASK_DATLEN(task) = opt_dlen;
                    531: 
                    532:        if (root->root_hooks.hook_add.signal)
                    533:                ptr = root->root_hooks.hook_add.signal(task, NULL);
                    534:        else
                    535:                ptr = NULL;
                    536: 
                    537:        if (!ptr) {
                    538: #ifdef HAVE_LIBPTHREAD
                    539:                pthread_mutex_lock(&root->root_mtx[taskSIGNAL]);
                    540: #endif
                    541:                TAILQ_INSERT_TAIL(&root->root_signal, TASK_ID(task), task_node);
                    542: #ifdef HAVE_LIBPTHREAD
                    543:                pthread_mutex_unlock(&root->root_mtx[taskSIGNAL]);
                    544: #endif
                    545:        } else
1.13      misho     546:                task = sched_unuseTask(task);
1.9       misho     547: 
                    548:        return task;
1.23      misho     549: #endif /* KQ_DISABLE */
1.9       misho     550: }
                    551: 
                    552: /*
1.8       misho     553:  * schedAlarm() - Add ALARM task to scheduler queue
                    554:  *
                    555:  * @root = root task
                    556:  * @func = task execution function
                    557:  * @arg = 1st func argument
                    558:  * @ts = timeout argument structure, minimum alarm timer resolution is 1msec!
1.17      misho     559:  * @opt_data = Alarm timer ID
1.8       misho     560:  * @opt_dlen = Optional data length
                    561:  * return: NULL error or !=NULL new queued task
                    562:  */
                    563: sched_task_t *
                    564: schedAlarm(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, struct timespec ts, 
                    565:                void *opt_data, size_t opt_dlen)
                    566: {
1.23      misho     567: #ifdef KQ_DISABLE
                    568:        sched_SetErr(ENOTSUP, "disabled kqueue support");
                    569:        return NULL;
                    570: #else
1.8       misho     571:        sched_task_t *task;
                    572:        void *ptr;
                    573: 
                    574:        if (!root || !func)
                    575:                return NULL;
                    576: 
                    577:        /* get new task */
1.13      misho     578:        if (!(task = sched_useTask(root)))
1.8       misho     579:                return NULL;
                    580: 
                    581:        task->task_func = func;
                    582:        TASK_TYPE(task) = taskALARM;
                    583:        TASK_ROOT(task) = root;
                    584: 
                    585:        TASK_ARG(task) = arg;
                    586:        TASK_TS(task) = ts;
                    587: 
                    588:        TASK_DATA(task) = opt_data;
                    589:        TASK_DATLEN(task) = opt_dlen;
                    590: 
                    591:        if (root->root_hooks.hook_add.alarm)
                    592:                ptr = root->root_hooks.hook_add.alarm(task, NULL);
                    593:        else
                    594:                ptr = NULL;
                    595: 
                    596:        if (!ptr) {
                    597: #ifdef HAVE_LIBPTHREAD
                    598:                pthread_mutex_lock(&root->root_mtx[taskALARM]);
                    599: #endif
1.9       misho     600:                TAILQ_INSERT_TAIL(&root->root_alarm, TASK_ID(task), task_node);
1.8       misho     601: #ifdef HAVE_LIBPTHREAD
                    602:                pthread_mutex_unlock(&root->root_mtx[taskALARM]);
                    603: #endif
                    604:        } else
1.13      misho     605:                task = sched_unuseTask(task);
1.8       misho     606: 
                    607:        return task;
1.23      misho     608: #endif /* KQ_DISABLE */
1.8       misho     609: }
                    610: 
1.11      misho     611: #ifdef AIO_SUPPORT
                    612: /*
                    613:  * schedAIO() - Add AIO task to scheduler queue
                    614:  *
                    615:  * @root = root task
                    616:  * @func = task execution function
                    617:  * @arg = 1st func argument
                    618:  * @acb = AIO cb structure address
                    619:  * @opt_data = Optional data
                    620:  * @opt_dlen = Optional data length
                    621:  * return: NULL error or !=NULL new queued task
                    622:  */
                    623: sched_task_t *
                    624: schedAIO(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, 
                    625:                struct aiocb * __restrict acb, void *opt_data, size_t opt_dlen)
                    626: {
1.23      misho     627: #ifdef KQ_DISABLE
                    628:        sched_SetErr(ENOTSUP, "disabled kqueue support");
                    629:        return NULL;
                    630: #else
1.11      misho     631:        sched_task_t *task;
                    632:        void *ptr;
                    633: 
                    634:        if (!root || !func || !acb || !opt_dlen)
                    635:                return NULL;
                    636: 
                    637:        /* get new task */
1.13      misho     638:        if (!(task = sched_useTask(root)))
1.11      misho     639:                return NULL;
                    640: 
                    641:        task->task_func = func;
                    642:        TASK_TYPE(task) = taskAIO;
                    643:        TASK_ROOT(task) = root;
                    644: 
                    645:        TASK_ARG(task) = arg;
                    646:        TASK_VAL(task) = (u_long) acb;
                    647: 
                    648:        TASK_DATA(task) = opt_data;
                    649:        TASK_DATLEN(task) = opt_dlen;
                    650: 
                    651:        if (root->root_hooks.hook_add.aio)
                    652:                ptr = root->root_hooks.hook_add.aio(task, NULL);
                    653:        else
                    654:                ptr = NULL;
                    655: 
                    656:        if (!ptr) {
                    657: #ifdef HAVE_LIBPTHREAD
                    658:                pthread_mutex_lock(&root->root_mtx[taskAIO]);
                    659: #endif
                    660:                TAILQ_INSERT_TAIL(&root->root_aio, TASK_ID(task), task_node);
                    661: #ifdef HAVE_LIBPTHREAD
                    662:                pthread_mutex_unlock(&root->root_mtx[taskAIO]);
                    663: #endif
                    664:        } else
1.13      misho     665:                task = sched_unuseTask(task);
1.11      misho     666: 
                    667:        return task;
1.23      misho     668: #endif /* KQ_DISABLE */
1.11      misho     669: }
                    670: 
                    671: /*
                    672:  * schedAIORead() - Add AIO read task to scheduler queue
                    673:  *
                    674:  * @root = root task
                    675:  * @func = task execution function
                    676:  * @arg = 1st func argument
                    677:  * @fd = file descriptor
                    678:  * @buffer = Buffer
                    679:  * @buflen = Buffer length
                    680:  * @offset = Offset from start of file, if =-1 from current position
                    681:  * return: NULL error or !=NULL new queued task
                    682:  */
1.16      misho     683: sched_task_t *
1.11      misho     684: schedAIORead(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int fd, 
                    685:                void *buffer, size_t buflen, off_t offset)
                    686: {
1.23      misho     687: #ifdef KQ_DISABLE
                    688:        sched_SetErr(ENOTSUP, "disabled kqueue support");
                    689:        return NULL;
                    690: #else
1.11      misho     691:        struct aiocb *acb;
                    692:        off_t off;
                    693: 
                    694:        if (!root || !func || !buffer || !buflen)
                    695:                return NULL;
                    696: 
                    697:        if (offset == (off_t) -1) {
                    698:                off = lseek(fd, 0, SEEK_CUR);
                    699:                if (off == -1) {
                    700:                        LOGERR;
                    701:                        return NULL;
                    702:                }
                    703:        } else
                    704:                off = offset;
                    705: 
                    706:        if (!(acb = malloc(sizeof(struct aiocb)))) {
                    707:                LOGERR;
                    708:                return NULL;
                    709:        } else
                    710:                memset(acb, 0, sizeof(struct aiocb));
                    711: 
                    712:        acb->aio_fildes = fd;
                    713:        acb->aio_nbytes = buflen;
                    714:        acb->aio_buf = buffer;
                    715:        acb->aio_offset = off;
                    716:        acb->aio_sigevent.sigev_notify = SIGEV_KEVENT;
                    717:        acb->aio_sigevent.sigev_notify_kqueue = root->root_kq;
                    718:        acb->aio_sigevent.sigev_value.sival_ptr = acb;
                    719: 
                    720:        if (aio_read(acb)) {
                    721:                LOGERR;
                    722:                free(acb);
                    723:                return NULL;
                    724:        }
                    725: 
                    726:        return schedAIO(root, func, arg, acb, buffer, buflen);
1.23      misho     727: #endif /* KQ_DISABLE */
1.11      misho     728: }
                    729: 
                    730: /*
                    731:  * schedAIOWrite() - Add AIO write task to scheduler queue
                    732:  *
                    733:  * @root = root task
                    734:  * @func = task execution function
                    735:  * @arg = 1st func argument
                    736:  * @fd = file descriptor
                    737:  * @buffer = Buffer
                    738:  * @buflen = Buffer length
                    739:  * @offset = Offset from start of file, if =-1 from current position
                    740:  * return: NULL error or !=NULL new queued task
                    741:  */
1.16      misho     742: sched_task_t *
1.11      misho     743: schedAIOWrite(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int fd, 
                    744:                void *buffer, size_t buflen, off_t offset)
                    745: {
1.23      misho     746: #ifdef KQ_DISABLE
                    747:        sched_SetErr(ENOTSUP, "disabled kqueue support");
                    748:        return NULL;
                    749: #else
1.11      misho     750:        struct aiocb *acb;
                    751:        off_t off;
                    752: 
                    753:        if (!root || !func || !buffer || !buflen)
                    754:                return NULL;
                    755: 
                    756:        if (offset == (off_t) -1) {
                    757:                off = lseek(fd, 0, SEEK_CUR);
                    758:                if (off == -1) {
                    759:                        LOGERR;
                    760:                        return NULL;
                    761:                }
                    762:        } else
                    763:                off = offset;
                    764: 
                    765:        if (!(acb = malloc(sizeof(struct aiocb)))) {
                    766:                LOGERR;
                    767:                return NULL;
                    768:        } else
                    769:                memset(acb, 0, sizeof(struct aiocb));
                    770: 
                    771:        acb->aio_fildes = fd;
                    772:        acb->aio_nbytes = buflen;
                    773:        acb->aio_buf = buffer;
                    774:        acb->aio_offset = off;
                    775:        acb->aio_sigevent.sigev_notify = SIGEV_KEVENT;
                    776:        acb->aio_sigevent.sigev_notify_kqueue = root->root_kq;
                    777:        acb->aio_sigevent.sigev_value.sival_ptr = acb;
                    778: 
                    779:        if (aio_write(acb)) {
                    780:                LOGERR;
                    781:                free(acb);
                    782:                return NULL;
                    783:        }
                    784: 
                    785:        return schedAIO(root, func, arg, acb, buffer, buflen);
1.23      misho     786: #endif /* KQ_DISABLE */
1.11      misho     787: }
                    788: 
                    789: #ifdef EVFILT_LIO
                    790: /*
                    791:  * schedLIO() - Add AIO bulk tasks to scheduler queue
                    792:  *
                    793:  * @root = root task
                    794:  * @func = task execution function
                    795:  * @arg = 1st func argument
                    796:  * @acbs = AIO cb structure addresses
                    797:  * @opt_data = Optional data
                    798:  * @opt_dlen = Optional data length
                    799:  * return: NULL error or !=NULL new queued task
                    800:  */
                    801: sched_task_t *
                    802: schedLIO(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, 
                    803:                struct aiocb ** __restrict acbs, void *opt_data, size_t opt_dlen)
                    804: {
1.23      misho     805: #ifdef KQ_DISABLE
                    806:        sched_SetErr(ENOTSUP, "disabled kqueue support");
                    807:        return NULL;
                    808: #else
1.11      misho     809:        sched_task_t *task;
                    810:        void *ptr;
                    811: 
                    812:        if (!root || !func || !acbs || !opt_dlen)
                    813:                return NULL;
                    814: 
                    815:        /* get new task */
1.13      misho     816:        if (!(task = sched_useTask(root)))
1.11      misho     817:                return NULL;
                    818: 
                    819:        task->task_func = func;
                    820:        TASK_TYPE(task) = taskLIO;
                    821:        TASK_ROOT(task) = root;
                    822: 
                    823:        TASK_ARG(task) = arg;
                    824:        TASK_VAL(task) = (u_long) acbs;
                    825: 
                    826:        TASK_DATA(task) = opt_data;
                    827:        TASK_DATLEN(task) = opt_dlen;
                    828: 
                    829:        if (root->root_hooks.hook_add.lio)
                    830:                ptr = root->root_hooks.hook_add.lio(task, NULL);
                    831:        else
                    832:                ptr = NULL;
                    833: 
                    834:        if (!ptr) {
                    835: #ifdef HAVE_LIBPTHREAD
                    836:                pthread_mutex_lock(&root->root_mtx[taskLIO]);
                    837: #endif
                    838:                TAILQ_INSERT_TAIL(&root->root_lio, TASK_ID(task), task_node);
                    839: #ifdef HAVE_LIBPTHREAD
                    840:                pthread_mutex_unlock(&root->root_mtx[taskLIO]);
                    841: #endif
                    842:        } else
1.13      misho     843:                task = sched_unuseTask(task);
1.11      misho     844: 
                    845:        return task;
1.23      misho     846: #endif /* KQ_DISABLE */
1.11      misho     847: }
                    848: 
                    849: /*
                    850:  * schedLIORead() - Add list of AIO read tasks to scheduler queue
                    851:  *
                    852:  * @root = root task
                    853:  * @func = task execution function
                    854:  * @arg = 1st func argument
                    855:  * @fd = file descriptor
                    856:  * @bufs = Buffer's list
                    857:  * @nbufs = Number of Buffers
                    858:  * @offset = Offset from start of file, if =-1 from current position
                    859:  * return: NULL error or !=NULL new queued task
                    860:  */
                    861: sched_task_t *
                    862: schedLIORead(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int fd, 
                    863:                struct iovec *bufs, size_t nbufs, off_t offset)
                    864: {
1.23      misho     865: #ifdef KQ_DISABLE
                    866:        sched_SetErr(ENOTSUP, "disabled kqueue support");
                    867:        return NULL;
                    868: #else
1.11      misho     869:        struct sigevent sig;
                    870:        struct aiocb **acb;
                    871:        off_t off;
                    872:        register int i;
                    873: 
                    874:        if (!root || !func || !bufs || !nbufs)
                    875:                return NULL;
                    876: 
                    877:        if (offset == (off_t) -1) {
                    878:                off = lseek(fd, 0, SEEK_CUR);
                    879:                if (off == -1) {
                    880:                        LOGERR;
                    881:                        return NULL;
                    882:                }
                    883:        } else
                    884:                off = offset;
                    885: 
                    886:        if (!(acb = calloc(sizeof(void*), nbufs))) {
                    887:                LOGERR;
                    888:                return NULL;
                    889:        } else
                    890:                memset(acb, 0, sizeof(void*) * nbufs);
                    891:        for (i = 0; i < nbufs; off += bufs[i++].iov_len) {
                    892:                acb[i] = malloc(sizeof(struct aiocb));
                    893:                if (!acb[i]) {
                    894:                        LOGERR;
                    895:                        for (i = 0; i < nbufs; i++)
                    896:                                if (acb[i])
                    897:                                        free(acb[i]);
                    898:                        free(acb);
                    899:                        return NULL;
                    900:                } else
                    901:                        memset(acb[i], 0, sizeof(struct aiocb));
                    902:                acb[i]->aio_fildes = fd;
                    903:                acb[i]->aio_nbytes = bufs[i].iov_len;
                    904:                acb[i]->aio_buf = bufs[i].iov_base;
                    905:                acb[i]->aio_offset = off;
                    906:                acb[i]->aio_lio_opcode = LIO_READ;
                    907:        }
                    908:        memset(&sig, 0, sizeof sig);
                    909:        sig.sigev_notify = SIGEV_KEVENT;
                    910:        sig.sigev_notify_kqueue = root->root_kq;
                    911:        sig.sigev_value.sival_ptr = acb;
                    912: 
                    913:        if (lio_listio(LIO_NOWAIT, acb, nbufs, &sig)) {
                    914:                LOGERR;
                    915:                for (i = 0; i < nbufs; i++)
                    916:                        if (acb[i])
                    917:                                free(acb[i]);
                    918:                free(acb);
                    919:                return NULL;
                    920:        }
                    921: 
                    922:        return schedLIO(root, func, arg, (void*) acb, bufs, nbufs);
1.23      misho     923: #endif /* KQ_DISABLE */
1.11      misho     924: }
                    925: 
                    926: /*
                    927:  * schedLIOWrite() - Add list of AIO write tasks to scheduler queue
                    928:  *
                    929:  * @root = root task
                    930:  * @func = task execution function
                    931:  * @arg = 1st func argument
                    932:  * @fd = file descriptor
                    933:  * @bufs = Buffer's list
                    934:  * @nbufs = Number of Buffers
                    935:  * @offset = Offset from start of file, if =-1 from current position
                    936:  * return: NULL error or !=NULL new queued task
                    937:  */
1.16      misho     938: sched_task_t *
1.11      misho     939: schedLIOWrite(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int fd, 
                    940:                struct iovec *bufs, size_t nbufs, off_t offset)
                    941: {
1.23      misho     942: #ifdef KQ_DISABLE
                    943:        sched_SetErr(ENOTSUP, "disabled kqueue support");
                    944:        return NULL;
                    945: #else
1.11      misho     946:        struct sigevent sig;
                    947:        struct aiocb **acb;
                    948:        off_t off;
                    949:        register int i;
                    950: 
                    951:        if (!root || !func || !bufs || !nbufs)
                    952:                return NULL;
                    953: 
                    954:        if (offset == (off_t) -1) {
                    955:                off = lseek(fd, 0, SEEK_CUR);
                    956:                if (off == -1) {
                    957:                        LOGERR;
                    958:                        return NULL;
                    959:                }
                    960:        } else
                    961:                off = offset;
                    962: 
                    963:        if (!(acb = calloc(sizeof(void*), nbufs))) {
                    964:                LOGERR;
                    965:                return NULL;
                    966:        } else
                    967:                memset(acb, 0, sizeof(void*) * nbufs);
                    968:        for (i = 0; i < nbufs; off += bufs[i++].iov_len) {
                    969:                acb[i] = malloc(sizeof(struct aiocb));
                    970:                if (!acb[i]) {
                    971:                        LOGERR;
                    972:                        for (i = 0; i < nbufs; i++)
                    973:                                if (acb[i])
                    974:                                        free(acb[i]);
                    975:                        free(acb);
                    976:                        return NULL;
                    977:                } else
                    978:                        memset(acb[i], 0, sizeof(struct aiocb));
                    979:                acb[i]->aio_fildes = fd;
                    980:                acb[i]->aio_nbytes = bufs[i].iov_len;
                    981:                acb[i]->aio_buf = bufs[i].iov_base;
                    982:                acb[i]->aio_offset = off;
                    983:                acb[i]->aio_lio_opcode = LIO_WRITE;
                    984:        }
                    985:        memset(&sig, 0, sizeof sig);
                    986:        sig.sigev_notify = SIGEV_KEVENT;
                    987:        sig.sigev_notify_kqueue = root->root_kq;
                    988:        sig.sigev_value.sival_ptr = acb;
                    989: 
                    990:        if (lio_listio(LIO_NOWAIT, acb, nbufs, &sig)) {
                    991:                LOGERR;
                    992:                for (i = 0; i < nbufs; i++)
                    993:                        if (acb[i])
                    994:                                free(acb[i]);
                    995:                free(acb);
                    996:                return NULL;
                    997:        }
                    998: 
                    999:        return schedLIO(root, func, arg, (void*) acb, bufs, nbufs);
1.23      misho    1000: #endif /* KQ_DISABLE */
1.11      misho    1001: }
                   1002: #endif /* EVFILT_LIO */
                   1003: #endif /* AIO_SUPPORT */
                   1004: 
1.8       misho    1005: /*
1.1       misho    1006:  * schedTimer() - Add TIMER task to scheduler queue
1.6       misho    1007:  *
1.1       misho    1008:  * @root = root task
                   1009:  * @func = task execution function
                   1010:  * @arg = 1st func argument
1.5       misho    1011:  * @ts = timeout argument structure
                   1012:  * @opt_data = Optional data
                   1013:  * @opt_dlen = Optional data length
1.1       misho    1014:  * return: NULL error or !=NULL new queued task
                   1015:  */
                   1016: sched_task_t *
1.5       misho    1017: schedTimer(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, struct timespec ts, 
                   1018:                void *opt_data, size_t opt_dlen)
1.1       misho    1019: {
1.9       misho    1020:        sched_task_t *task, *tmp, *t = NULL;
1.1       misho    1021:        void *ptr;
1.5       misho    1022:        struct timespec now;
1.1       misho    1023: 
                   1024:        if (!root || !func)
                   1025:                return NULL;
                   1026: 
                   1027:        /* get new task */
1.13      misho    1028:        if (!(task = sched_useTask(root)))
1.4       misho    1029:                return NULL;
1.1       misho    1030: 
                   1031:        task->task_func = func;
1.5       misho    1032:        TASK_TYPE(task) = taskTIMER;
                   1033:        TASK_ROOT(task) = root;
1.1       misho    1034: 
                   1035:        TASK_ARG(task) = arg;
                   1036: 
1.5       misho    1037:        TASK_DATA(task) = opt_data;
                   1038:        TASK_DATLEN(task) = opt_dlen;
                   1039: 
1.1       misho    1040:        /* calculate timeval structure */
1.5       misho    1041:        clock_gettime(CLOCK_MONOTONIC, &now);
                   1042:        now.tv_sec += ts.tv_sec;
                   1043:        now.tv_nsec += ts.tv_nsec;
                   1044:        if (now.tv_nsec >= 1000000000L) {
1.1       misho    1045:                now.tv_sec++;
1.5       misho    1046:                now.tv_nsec -= 1000000000L;
                   1047:        } else if (now.tv_nsec < 0) {
1.1       misho    1048:                now.tv_sec--;
1.5       misho    1049:                now.tv_nsec += 1000000000L;
1.1       misho    1050:        }
1.5       misho    1051:        TASK_TS(task) = now;
1.1       misho    1052: 
                   1053:        if (root->root_hooks.hook_add.timer)
                   1054:                ptr = root->root_hooks.hook_add.timer(task, NULL);
                   1055:        else
                   1056:                ptr = NULL;
                   1057: 
                   1058:        if (!ptr) {
1.5       misho    1059: #ifdef HAVE_LIBPTHREAD
                   1060:                pthread_mutex_lock(&root->root_mtx[taskTIMER]);
                   1061: #endif
1.1       misho    1062: #ifdef TIMER_WITHOUT_SORT
1.9       misho    1063:                TAILQ_INSERT_TAIL(&root->root_timer, TASK_ID(task), task_node);
1.1       misho    1064: #else
1.9       misho    1065:                TAILQ_FOREACH_SAFE(t, &root->root_timer, task_node, tmp)
1.5       misho    1066:                        if (sched_timespeccmp(&TASK_TS(task), &TASK_TS(t), -) < 1)
1.1       misho    1067:                                break;
                   1068:                if (!t)
1.9       misho    1069:                        TAILQ_INSERT_TAIL(&root->root_timer, TASK_ID(task), task_node);
1.1       misho    1070:                else
1.9       misho    1071:                        TAILQ_INSERT_BEFORE(t, TASK_ID(task), task_node);
1.1       misho    1072: #endif
1.5       misho    1073: #ifdef HAVE_LIBPTHREAD
                   1074:                pthread_mutex_unlock(&root->root_mtx[taskTIMER]);
                   1075: #endif
1.4       misho    1076:        } else
1.13      misho    1077:                task = sched_unuseTask(task);
1.1       misho    1078: 
                   1079:        return task;
                   1080: }
                   1081: 
                   1082: /*
                   1083:  * schedEvent() - Add EVENT task to scheduler queue
1.6       misho    1084:  *
1.1       misho    1085:  * @root = root task
                   1086:  * @func = task execution function
                   1087:  * @arg = 1st func argument
1.2       misho    1088:  * @val = additional func argument
1.5       misho    1089:  * @opt_data = Optional data
                   1090:  * @opt_dlen = Optional data length
1.1       misho    1091:  * return: NULL error or !=NULL new queued task
                   1092:  */
                   1093: sched_task_t *
1.5       misho    1094: schedEvent(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, u_long val, 
                   1095:                void *opt_data, size_t opt_dlen)
1.1       misho    1096: {
                   1097:        sched_task_t *task;
                   1098:        void *ptr;
                   1099: 
                   1100:        if (!root || !func)
                   1101:                return NULL;
                   1102: 
                   1103:        /* get new task */
1.13      misho    1104:        if (!(task = sched_useTask(root)))
1.4       misho    1105:                return NULL;
1.1       misho    1106: 
                   1107:        task->task_func = func;
1.5       misho    1108:        TASK_TYPE(task) = taskEVENT;
                   1109:        TASK_ROOT(task) = root;
1.1       misho    1110: 
                   1111:        TASK_ARG(task) = arg;
1.2       misho    1112:        TASK_VAL(task) = val;
1.1       misho    1113: 
1.5       misho    1114:        TASK_DATA(task) = opt_data;
                   1115:        TASK_DATLEN(task) = opt_dlen;
                   1116: 
1.1       misho    1117:        if (root->root_hooks.hook_add.event)
                   1118:                ptr = root->root_hooks.hook_add.event(task, NULL);
                   1119:        else
                   1120:                ptr = NULL;
                   1121: 
1.5       misho    1122:        if (!ptr) {
                   1123: #ifdef HAVE_LIBPTHREAD
                   1124:                pthread_mutex_lock(&root->root_mtx[taskEVENT]);
                   1125: #endif
1.9       misho    1126:                TAILQ_INSERT_TAIL(&root->root_event, TASK_ID(task), task_node);
1.5       misho    1127: #ifdef HAVE_LIBPTHREAD
                   1128:                pthread_mutex_unlock(&root->root_mtx[taskEVENT]);
                   1129: #endif
                   1130:        } else
1.13      misho    1131:                task = sched_unuseTask(task);
1.1       misho    1132: 
                   1133:        return task;
                   1134: }
                   1135: 
                   1136: 
                   1137: /*
1.12      misho    1138:  * schedTask() - Add regular task to scheduler queue
1.6       misho    1139:  *
1.1       misho    1140:  * @root = root task
                   1141:  * @func = task execution function
                   1142:  * @arg = 1st func argument
1.12      misho    1143:  * @prio = regular task priority, 0 is hi priority for regular tasks
1.5       misho    1144:  * @opt_data = Optional data
                   1145:  * @opt_dlen = Optional data length
1.1       misho    1146:  * return: NULL error or !=NULL new queued task
                   1147:  */
                   1148: sched_task_t *
1.12      misho    1149: schedTask(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, u_long prio, 
1.5       misho    1150:                void *opt_data, size_t opt_dlen)
1.1       misho    1151: {
1.12      misho    1152:        sched_task_t *task, *tmp, *t = NULL;
1.1       misho    1153:        void *ptr;
                   1154: 
                   1155:        if (!root || !func)
                   1156:                return NULL;
                   1157: 
                   1158:        /* get new task */
1.13      misho    1159:        if (!(task = sched_useTask(root)))
1.4       misho    1160:                return NULL;
1.1       misho    1161: 
                   1162:        task->task_func = func;
1.12      misho    1163:        TASK_TYPE(task) = taskTASK;
1.5       misho    1164:        TASK_ROOT(task) = root;
1.1       misho    1165: 
                   1166:        TASK_ARG(task) = arg;
1.12      misho    1167:        TASK_VAL(task) = prio;
1.1       misho    1168: 
1.5       misho    1169:        TASK_DATA(task) = opt_data;
                   1170:        TASK_DATLEN(task) = opt_dlen;
                   1171: 
1.12      misho    1172:        if (root->root_hooks.hook_add.task)
                   1173:                ptr = root->root_hooks.hook_add.task(task, NULL);
1.1       misho    1174:        else
                   1175:                ptr = NULL;
                   1176: 
1.5       misho    1177:        if (!ptr) {
                   1178: #ifdef HAVE_LIBPTHREAD
1.12      misho    1179:                pthread_mutex_lock(&root->root_mtx[taskTASK]);
1.5       misho    1180: #endif
1.12      misho    1181:                TAILQ_FOREACH_SAFE(t, &root->root_task, task_node, tmp)
                   1182:                        if (TASK_VAL(task) < TASK_VAL(t))
                   1183:                                break;
                   1184:                if (!t)
                   1185:                        TAILQ_INSERT_TAIL(&root->root_task, TASK_ID(task), task_node);
                   1186:                else
                   1187:                        TAILQ_INSERT_BEFORE(t, TASK_ID(task), task_node);
1.5       misho    1188: #ifdef HAVE_LIBPTHREAD
1.12      misho    1189:                pthread_mutex_unlock(&root->root_mtx[taskTASK]);
1.5       misho    1190: #endif
                   1191:        } else
1.13      misho    1192:                task = sched_unuseTask(task);
1.1       misho    1193: 
                   1194:        return task;
                   1195: }
                   1196: 
                   1197: /*
1.10      misho    1198:  * schedSuspend() - Add Suspended task to scheduler queue
                   1199:  *
                   1200:  * @root = root task
                   1201:  * @func = task execution function
                   1202:  * @arg = 1st func argument
                   1203:  * @id = Trigger ID
                   1204:  * @opt_data = Optional data
                   1205:  * @opt_dlen = Optional data length
                   1206:  * return: NULL error or !=NULL new queued task
                   1207:  */
                   1208: sched_task_t *
                   1209: schedSuspend(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, u_long id, 
                   1210:                void *opt_data, size_t opt_dlen)
                   1211: {
                   1212:        sched_task_t *task;
                   1213:        void *ptr;
                   1214: 
                   1215:        if (!root || !func)
                   1216:                return NULL;
                   1217: 
                   1218:        /* get new task */
1.13      misho    1219:        if (!(task = sched_useTask(root)))
1.10      misho    1220:                return NULL;
                   1221: 
                   1222:        task->task_func = func;
                   1223:        TASK_TYPE(task) = taskSUSPEND;
                   1224:        TASK_ROOT(task) = root;
                   1225: 
                   1226:        TASK_ARG(task) = arg;
                   1227:        TASK_VAL(task) = id;
                   1228: 
                   1229:        TASK_DATA(task) = opt_data;
                   1230:        TASK_DATLEN(task) = opt_dlen;
                   1231: 
                   1232:        if (root->root_hooks.hook_add.suspend)
                   1233:                ptr = root->root_hooks.hook_add.suspend(task, NULL);
                   1234:        else
                   1235:                ptr = NULL;
                   1236: 
                   1237:        if (!ptr) {
                   1238: #ifdef HAVE_LIBPTHREAD
                   1239:                pthread_mutex_lock(&root->root_mtx[taskSUSPEND]);
                   1240: #endif
                   1241:                TAILQ_INSERT_TAIL(&root->root_suspend, TASK_ID(task), task_node);
                   1242: #ifdef HAVE_LIBPTHREAD
                   1243:                pthread_mutex_unlock(&root->root_mtx[taskSUSPEND]);
                   1244: #endif
                   1245:        } else
1.13      misho    1246:                task = sched_unuseTask(task);
1.10      misho    1247: 
                   1248:        return task;
                   1249: }
                   1250: 
                   1251: /*
1.1       misho    1252:  * schedCallOnce() - Call once from scheduler
1.6       misho    1253:  *
1.1       misho    1254:  * @root = root task
                   1255:  * @func = task execution function
                   1256:  * @arg = 1st func argument
1.2       misho    1257:  * @val = additional func argument
1.5       misho    1258:  * @opt_data = Optional data
                   1259:  * @opt_dlen = Optional data length
1.2       misho    1260:  * return: return value from called func
1.1       misho    1261:  */
                   1262: sched_task_t *
1.5       misho    1263: schedCallOnce(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, u_long val, 
                   1264:                void *opt_data, size_t opt_dlen)
1.1       misho    1265: {
                   1266:        sched_task_t *task;
1.2       misho    1267:        void *ret;
1.1       misho    1268: 
                   1269:        if (!root || !func)
                   1270:                return NULL;
                   1271: 
                   1272:        /* get new task */
1.13      misho    1273:        if (!(task = sched_useTask(root)))
1.4       misho    1274:                return NULL;
1.1       misho    1275: 
                   1276:        task->task_func = func;
1.5       misho    1277:        TASK_TYPE(task) = taskEVENT;
                   1278:        TASK_ROOT(task) = root;
1.1       misho    1279: 
                   1280:        TASK_ARG(task) = arg;
1.2       misho    1281:        TASK_VAL(task) = val;
1.1       misho    1282: 
1.5       misho    1283:        TASK_DATA(task) = opt_data;
                   1284:        TASK_DATLEN(task) = opt_dlen;
                   1285: 
1.2       misho    1286:        ret = schedCall(task);
1.1       misho    1287: 
1.13      misho    1288:        sched_unuseTask(task);
1.2       misho    1289:        return ret;
1.1       misho    1290: }
1.13      misho    1291: 
                   1292: /*
                   1293:  * schedThread() - Add thread task to scheduler queue
                   1294:  *
                   1295:  * @root = root task
                   1296:  * @func = task execution function
                   1297:  * @arg = 1st func argument
1.15      misho    1298:  * @ss = stack size
1.13      misho    1299:  * @opt_data = Optional data
                   1300:  * @opt_dlen = Optional data length
                   1301:  * return: NULL error or !=NULL new queued task
                   1302:  */
                   1303: sched_task_t *
1.21      misho    1304: schedThread(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, 
1.15      misho    1305:                size_t ss, void *opt_data, size_t opt_dlen)
1.13      misho    1306: {
                   1307: #ifndef HAVE_LIBPTHREAD
                   1308:        sched_SetErr(ENOTSUP, "Not supported thread tasks");
                   1309:        return NULL;
                   1310: #endif
                   1311:        sched_task_t *task;
                   1312:        pthread_attr_t attr;
                   1313: 
                   1314:        if (!root || !func)
                   1315:                return NULL;
                   1316: 
                   1317:        /* get new task */
1.15      misho    1318:        if (!(task = sched_useTask(root))) {
                   1319: 
1.13      misho    1320:                return NULL;
1.15      misho    1321:        }
1.13      misho    1322: 
                   1323:        task->task_func = func;
                   1324:        TASK_TYPE(task) = taskTHREAD;
                   1325:        TASK_ROOT(task) = root;
                   1326: 
                   1327:        TASK_ARG(task) = arg;
                   1328: 
                   1329:        TASK_DATA(task) = opt_data;
                   1330:        TASK_DATLEN(task) = opt_dlen;
                   1331: 
                   1332:        pthread_attr_init(&attr);
1.24.2.1  misho    1333:        pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
1.15      misho    1334:        if (ss && (errno = pthread_attr_setstacksize(&attr, ss))) {
                   1335:                LOGERR;
                   1336:                pthread_attr_destroy(&attr);
                   1337:                return sched_unuseTask(task);
                   1338:        }
                   1339:        if ((errno = pthread_attr_getstacksize(&attr, &ss))) {
                   1340:                LOGERR;
                   1341:                pthread_attr_destroy(&attr);
                   1342:                return sched_unuseTask(task);
                   1343:        } else
1.21      misho    1344:                TASK_FLAG(task) = ss;
1.24.2.2! misho    1345: 
1.15      misho    1346: #ifdef SCHED_RR
                   1347:        pthread_attr_setschedpolicy(&attr, SCHED_RR);
                   1348: #else
                   1349:        pthread_attr_setschedpolicy(&attr, SCHED_OTHER);
                   1350: #endif
1.21      misho    1351: 
                   1352:        pthread_mutex_lock(&root->root_mtx[taskTHREAD]);
                   1353:        TAILQ_INSERT_TAIL(&root->root_thread, TASK_ID(task), task_node);
                   1354:        pthread_mutex_unlock(&root->root_mtx[taskTHREAD]);
                   1355: 
1.13      misho    1356:        if (root->root_hooks.hook_add.thread)
1.21      misho    1357:                if (root->root_hooks.hook_add.thread(task, &attr)) {
                   1358:                        schedCancel(task);
                   1359:                        task = NULL;
                   1360:                }
1.13      misho    1361:        pthread_attr_destroy(&attr);
                   1362:        return task;
                   1363: }
                   1364: 
1.17      misho    1365: /*
                   1366:  * schedRTC() - Add RTC task to scheduler queue
                   1367:  *
                   1368:  * @root = root task
                   1369:  * @func = task execution function
                   1370:  * @arg = 1st func argument
                   1371:  * @ts = timeout argument structure, minimum alarm timer resolution is 1msec!
                   1372:  * @opt_data = Optional RTC ID
1.18      misho    1373:  * @opt_dlen = Optional data length
1.17      misho    1374:  * return: NULL error or !=NULL new queued task
                   1375:  */
                   1376: sched_task_t *
                   1377: schedRTC(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, struct timespec ts, 
                   1378:                void *opt_data, size_t opt_dlen)
                   1379: {
1.24      misho    1380: #if defined(HAVE_TIMER_CREATE) && defined(HAVE_TIMER_SETTIME) && defined(HAVE_TIMER_DELETE)
1.17      misho    1381:        sched_task_t *task;
                   1382:        void *ptr;
                   1383: 
                   1384:        if (!root || !func)
                   1385:                return NULL;
                   1386: 
                   1387:        /* get new task */
                   1388:        if (!(task = sched_useTask(root)))
                   1389:                return NULL;
                   1390: 
                   1391:        task->task_func = func;
                   1392:        TASK_TYPE(task) = taskRTC;
                   1393:        TASK_ROOT(task) = root;
                   1394: 
                   1395:        TASK_ARG(task) = arg;
                   1396:        TASK_TS(task) = ts;
                   1397: 
                   1398:        TASK_DATA(task) = opt_data;
                   1399:        TASK_DATLEN(task) = opt_dlen;
                   1400: 
                   1401:        if (root->root_hooks.hook_add.rtc)
                   1402:                ptr = root->root_hooks.hook_add.rtc(task, NULL);
                   1403:        else
                   1404:                ptr = NULL;
                   1405: 
                   1406:        if (!ptr) {
                   1407: #ifdef HAVE_LIBPTHREAD
                   1408:                pthread_mutex_lock(&root->root_mtx[taskRTC]);
                   1409: #endif
                   1410:                TAILQ_INSERT_TAIL(&root->root_rtc, TASK_ID(task), task_node);
                   1411: #ifdef HAVE_LIBPTHREAD
                   1412:                pthread_mutex_unlock(&root->root_mtx[taskRTC]);
                   1413: #endif
                   1414:        } else
                   1415:                task = sched_unuseTask(task);
                   1416: 
                   1417:        return task;
                   1418: #else
                   1419:        sched_SetErr(ENOTSUP, "Not supported realtime clock extensions");
                   1420:        return NULL;
                   1421: #endif
                   1422: }

FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>