Diff for /libaitsched/src/aitsched.c between versions 1.15.2.2 and 1.22.2.1

version 1.15.2.2, 2012/08/22 23:43:36 version 1.22.2.1, 2013/11/21 14:38:30
Line 12  terms: Line 12  terms:
 All of the documentation and software included in the ELWIX and AITNET  All of the documentation and software included in the ELWIX and AITNET
 Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>  Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>
   
Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012, 2013
         by Michael Pounov <misho@elwix.org>.  All rights reserved.          by Michael Pounov <misho@elwix.org>.  All rights reserved.
   
 Redistribution and use in source and binary forms, with or without  Redistribution and use in source and binary forms, with or without
Line 56  char sched_Error[STRSIZ]; Line 56  char sched_Error[STRSIZ];
   
   
 // sched_GetErrno() Get error code of last operation  // sched_GetErrno() Get error code of last operation
inline intint
 sched_GetErrno()  sched_GetErrno()
 {  {
         return sched_Errno;          return sched_Errno;
 }  }
   
 // sched_GetError() Get error text of last operation  // sched_GetError() Get error text of last operation
inline const char *const char *
 sched_GetError()  sched_GetError()
 {  {
         return sched_Error;          return sched_Error;
 }  }
   
 // sched_SetErr() Set error to variables for internal use!!!  // sched_SetErr() Set error to variables for internal use!!!
inline voidvoid
 sched_SetErr(int eno, char *estr, ...)  sched_SetErr(int eno, char *estr, ...)
 {  {
         va_list lst;          va_list lst;
Line 102  schedRegisterHooks(sched_root_task_t * __restrict root Line 102  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.alarm = sched_hook_alarm;
   #if defined(HAVE_TIMER_CREATE) && defined(HAVE_TIMER_SETTIME)
           root->root_hooks.hook_add.rtc = sched_hook_rtc;
   #endif
         root->root_hooks.hook_add.node = sched_hook_node;          root->root_hooks.hook_add.node = sched_hook_node;
         root->root_hooks.hook_add.proc = sched_hook_proc;          root->root_hooks.hook_add.proc = sched_hook_proc;
         root->root_hooks.hook_add.signal = sched_hook_signal;          root->root_hooks.hook_add.signal = sched_hook_signal;
Line 151  schedInit(void ** __restrict data, size_t datlen) Line 154  schedInit(void ** __restrict data, size_t datlen)
   
 #ifdef HAVE_LIBPTHREAD  #ifdef HAVE_LIBPTHREAD
                 for (i = 0; i < taskMAX; i++)                  for (i = 0; i < taskMAX; i++)
                        if (pthread_mutex_init(&root->root_mtx[i], NULL)) {                        if ((errno = pthread_mutex_init(&root->root_mtx[i], NULL))) {
                                 LOGERR;                                  LOGERR;
                                 while (i)                                  while (i)
                                         pthread_mutex_destroy(&root->root_mtx[--i]);                                          pthread_mutex_destroy(&root->root_mtx[--i]);
Line 167  schedInit(void ** __restrict data, size_t datlen) Line 170  schedInit(void ** __restrict data, size_t datlen)
                 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_alarm);
                   TAILQ_INIT(&root->root_rtc);
                 TAILQ_INIT(&root->root_node);                  TAILQ_INIT(&root->root_node);
                 TAILQ_INIT(&root->root_proc);                  TAILQ_INIT(&root->root_proc);
                 TAILQ_INIT(&root->root_signal);                  TAILQ_INIT(&root->root_signal);
Line 228  schedEnd(sched_root_task_t ** __restrict root) Line 232  schedEnd(sched_root_task_t ** __restrict root)
                 schedCancel(task);                  schedCancel(task);
         TAILQ_FOREACH_SAFE(task, &(*root)->root_alarm, task_node, tmp)          TAILQ_FOREACH_SAFE(task, &(*root)->root_alarm, task_node, tmp)
                 schedCancel(task);                  schedCancel(task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_rtc, task_node, tmp)
                   schedCancel(task);
         TAILQ_FOREACH_SAFE(task, &(*root)->root_node, task_node, tmp)          TAILQ_FOREACH_SAFE(task, &(*root)->root_node, task_node, tmp)
                 schedCancel(task);                  schedCancel(task);
         TAILQ_FOREACH_SAFE(task, &(*root)->root_proc, task_node, tmp)          TAILQ_FOREACH_SAFE(task, &(*root)->root_proc, task_node, tmp)
Line 281  schedEnd(sched_root_task_t ** __restrict root) Line 287  schedEnd(sched_root_task_t ** __restrict root)
  * @task = current task   * @task = current task
  * return: !=NULL error or =NULL ok   * return: !=NULL error or =NULL ok
  */   */
inline void *void *
 schedCall(sched_task_t * __restrict task)  schedCall(sched_task_t * __restrict task)
 {  {
         void *ptr = (void*) -1;          void *ptr = (void*) -1;
Line 304  schedCall(sched_task_t * __restrict task) Line 310  schedCall(sched_task_t * __restrict task)
  * @root = root task   * @root = root task
  * return: =NULL error or !=NULL ready task   * return: =NULL error or !=NULL ready task
  */   */
inline void *void *
 schedFetch(sched_root_task_t * __restrict root)  schedFetch(sched_root_task_t * __restrict root)
 {  {
         void *ptr;          void *ptr;
Line 354  schedTrigger(sched_task_t * __restrict task) Line 360  schedTrigger(sched_task_t * __restrict task)
 }  }
   
 /*  /*
    * schedQuery() - Query task in scheduler
    *
    * @task = task
    * return: -1 error, 0 found  and 1 not found
    */
   int
   schedQuery(sched_task_t * __restrict task)
   {
           sched_queue_t *queue;
           sched_task_t *t;
   
           if (!task || !TASK_ROOT(task))
                   return -1;      /* error */
   
           switch (TASK_TYPE(task)) {
                   case taskREAD:
                           queue = &TASK_ROOT(task)->root_read;
                           break;
                   case taskWRITE:
                           queue = &TASK_ROOT(task)->root_write;
                           break;
                   case taskTIMER:
                           queue = &TASK_ROOT(task)->root_timer;
                           break;
                   case taskALARM:
                           queue = &TASK_ROOT(task)->root_alarm;
                           break;
                   case taskRTC:
                           queue = &TASK_ROOT(task)->root_rtc;
                           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:
                           queue = &TASK_ROOT(task)->root_event;
                           break;
                   case taskTASK:
                           queue = &TASK_ROOT(task)->root_task;
                           break;
                   case taskSUSPEND:
                           queue = &TASK_ROOT(task)->root_suspend;
                           break;
                   case taskREADY:
                           queue = &TASK_ROOT(task)->root_ready;
                           break;
                   case taskTHREAD:
                           queue = &TASK_ROOT(task)->root_thread;
                           break;
                   default:
                           return 1;       /* not in queue */
           }
           if (queue)
                   TAILQ_FOREACH(t, queue, task_node)
                           if (TASK_ID(t) == TASK_ID(task))
                                   return 0;       /* found */
   
           return 1;       /* not in queue */
   }
   
   /*
    * schedQueryby() - Query task in scheduler by criteria
    *
    * @root = root task
    * @type = query from queue type, if =taskMAX query same task from all queues
    * @criteria = find task by criteria 
    *      [ CRITERIA_ANY|CRITERIA_CALL|CRITERIA_ARG|CRITERIA_FD|CRITERIA_VAL|
    *              CRITERIA_ID|CRITERIA_TS|CRITERIA_DATA|CRITERIA_DATLEN ]
    * @param = search parameter
    * return: -1 error, 0 found or 1 not found
    */
   int
   schedQueryby(sched_root_task_t * __restrict root, sched_task_type_t type, 
                   u_char criteria, void *param)
   {
           sched_task_t *task;
           sched_queue_t *queue;
           register int flg = 0;
   
           if (!root)
                   return -1;
           /* if type == taskMAX check in all queues */
           if (type == taskMAX) {
                   if ((flg = schedQueryby(root, taskREAD, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskWRITE, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskTIMER, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskALARM, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskRTC, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskNODE, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskPROC, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskSIGNAL, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskAIO, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskLIO, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskUSER, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskEVENT, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskTASK, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskSUSPEND, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskREADY, criteria, param)) < 1)
                           return flg;
                   if ((flg = schedQueryby(root, taskTHREAD, criteria, param)) < 1)
                           return flg;
                   return 1;       /* not found */
           }
           /* choosen queue */
           switch (type) {
                   case taskREAD:
                           queue = &root->root_read;
                           break;
                   case taskWRITE:
                           queue = &root->root_write;
                           break;
                   case taskTIMER:
                           queue = &root->root_timer;
                           break;
                   case taskALARM:
                           queue = &root->root_alarm;
                           break;
                   case taskRTC:
                           queue = &root->root_rtc;
                           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:
                           queue = &root->root_event;
                           break;
                   case taskTASK:
                           queue = &root->root_task;
                           break;
                   case taskSUSPEND:
                           queue = &root->root_suspend;
                           break;
                   case taskREADY:
                           queue = &root->root_ready;
                           break;
                   case taskTHREAD:
                           queue = &root->root_thread;
                           break;
                   default:
                           return 1;       /* not found */
           }
   
           TAILQ_FOREACH(task, queue, task_node) {
                   switch (criteria) {
                           case CRITERIA_ANY:
                                   return 0;               /* found */
                           case CRITERIA_CALL:
                                   if (TASK_FUNC(task) == (sched_task_func_t) param)
                                           return 0;       /* found */
                                   break;
                           case CRITERIA_ARG:
                                   if (TASK_ARG(task) == param)
                                           return 0;       /* found */
                                   break;
                           case CRITERIA_FD:
                                   if (TASK_FD(task) == (intptr_t) param)
                                           return 0;       /* found */
                                   break;
                           case CRITERIA_ID:
                           case CRITERIA_VAL:
                                   if (TASK_VAL(task) == (u_long) param)
                                           return 0;       /* found */
                                   break;
                           case CRITERIA_TS:
                                   if (!sched_timespeccmp(&TASK_TS(task), 
                                                           (struct timespec*) param, -))
                                           return 0;       /* found */
                                   break;
                           case CRITERIA_DATA:
                                   if (TASK_DATA(task) == param)
                                           return 0;       /* found */
                                   break;
                           case CRITERIA_DATLEN:
                                   if (TASK_DATLEN(task) == (size_t) param)
                                           return 0;       /* found */
                                   break;
                           default:
                                   sched_SetErr(EINVAL, "Invalid parameter criteria %d", 
                                                   criteria);
                                   return 1;               /* not found */
                   }
           }
   
           return 1;       /* not found */
   }
   
   /*
  * schedCancel() - Cancel task from scheduler   * schedCancel() - Cancel task from scheduler
  *   *
  * @task = task   * @task = task
Line 384  schedCancel(sched_task_t * __restrict task) Line 620  schedCancel(sched_task_t * __restrict task)
                 case taskALARM:                  case taskALARM:
                         queue = &TASK_ROOT(task)->root_alarm;                          queue = &TASK_ROOT(task)->root_alarm;
                         break;                          break;
                   case taskRTC:
                           queue = &TASK_ROOT(task)->root_rtc;
                           break;
                 case taskNODE:                  case taskNODE:
                         queue = &TASK_ROOT(task)->root_node;                          queue = &TASK_ROOT(task)->root_node;
                         break;                          break;
Line 441  schedCancel(sched_task_t * __restrict task) Line 680  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 = find task by criteria 
 *      [CRITERIA_ANY|CRITERIA_CALL|CRITERIA_ARG|CRITERIA_FD|CRITERIA_VAL|CRITERIA_ID|CRITERIA_TS|CRITERIA_DATA] *      [ CRITERIA_ANY|CRITERIA_CALL|CRITERIA_ARG|CRITERIA_FD|CRITERIA_VAL|
  *                CRITERIA_ID|CRITERIA_TS|CRITERIA_DATA|CRITERIA_DATLEN ]
  * @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 466  schedCancelby(sched_root_task_t * __restrict root, sch Line 706  schedCancelby(sched_root_task_t * __restrict root, sch
                         return -2;                          return -2;
                 if (schedCancelby(root, taskALARM, criteria, param, hook))                  if (schedCancelby(root, taskALARM, criteria, param, hook))
                         return -2;                          return -2;
                   if (schedCancelby(root, taskRTC, criteria, param, hook))
                           return -2;
                 if (schedCancelby(root, taskNODE, criteria, param, hook))                  if (schedCancelby(root, taskNODE, criteria, param, hook))
                         return -2;                          return -2;
                 if (schedCancelby(root, taskPROC, criteria, param, hook))                  if (schedCancelby(root, taskPROC, criteria, param, hook))
Line 504  schedCancelby(sched_root_task_t * __restrict root, sch Line 746  schedCancelby(sched_root_task_t * __restrict root, sch
                 case taskALARM:                  case taskALARM:
                         queue = &root->root_alarm;                          queue = &root->root_alarm;
                         break;                          break;
                   case taskRTC:
                           queue = &root->root_rtc;
                           break;
                 case taskNODE:                  case taskNODE:
                         queue = &root->root_node;                          queue = &root->root_node;
                         break;                          break;
Line 575  schedCancelby(sched_root_task_t * __restrict root, sch Line 820  schedCancelby(sched_root_task_t * __restrict root, sch
                                 if (TASK_DATA(task) == param)                                  if (TASK_DATA(task) == param)
                                         flg = 1;                                          flg = 1;
                                 break;                                  break;
                           case CRITERIA_DATLEN:
                                   if (TASK_DATLEN(task) == (size_t) param)
                                           flg = 1;
                                   break;
                         default:                          default:
                                 sched_SetErr(EINVAL, "Invalid parameter criteria %d", criteria);                                  sched_SetErr(EINVAL, "Invalid parameter criteria %d", criteria);
                                 flg = -1;                                  flg = -1;
Line 659  schedRun(sched_root_task_t *root, volatile intptr_t *  Line 908  schedRun(sched_root_task_t *root, volatile intptr_t * 
  * @tsold = old timeout polling if !=NULL   * @tsold = old timeout polling if !=NULL
  * return: -1 error or 0 ok   * return: -1 error or 0 ok
  */   */
inline intint
 schedPolling(sched_root_task_t * __restrict root, struct timespec * __restrict ts,   schedPolling(sched_root_task_t * __restrict root, struct timespec * __restrict ts, 
                 struct timespec * __restrict tsold)                  struct timespec * __restrict tsold)
 {  {
Line 684  schedPolling(sched_root_task_t * __restrict root, stru Line 933  schedPolling(sched_root_task_t * __restrict root, stru
  * @condValue = condition value, kill schedRun() if condValue == killState   * @condValue = condition value, kill schedRun() if condValue == killState
  * return: -1 error or 0 ok   * return: -1 error or 0 ok
  */   */
inline intint
 schedTermCondition(sched_root_task_t * __restrict root, intptr_t condValue)  schedTermCondition(sched_root_task_t * __restrict root, intptr_t condValue)
 {  {
         if (!root)          if (!root)
Line 700  schedTermCondition(sched_root_task_t * __restrict root Line 949  schedTermCondition(sched_root_task_t * __restrict root
  *   *
  * @root = root task   * @root = root task
  * @criteria = find task by criteria    * @criteria = find task by criteria 
 *      [CRITERIA_ANY|CRITERIA_ID|CRITERIA_DATA] *      [CRITERIA_ANY|CRITERIA_ID|CRITERIA_VAL|CRITERIA_DATA]
 * @param = search parameter (sched_task_t *task| u_long id) * @param = search parameter (sched_task_t *task| unsigned long id)
  * return: -1 error or 0 resumed ok   * return: -1 error or 0 resumed ok
  */   */
 int  int
Line 723  schedResumeby(sched_root_task_t * __restrict root, u_c Line 972  schedResumeby(sched_root_task_t * __restrict root, u_c
                                 flg = 1;                                  flg = 1;
                                 break;                                  break;
                         case CRITERIA_ID:                          case CRITERIA_ID:
                           case CRITERIA_VAL:
                                 if (TASK_VAL(task) == (u_long) param)                                  if (TASK_VAL(task) == (u_long) param)
                                         flg = 1;                                          flg = 1;
                                 break;                                  break;

Removed from v.1.15.2.2  
changed lines
  Added in v.1.22.2.1


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