[BACK]Return to aitsched.c CVS log [TXT] [DIR] Up to [ELWIX - Embedded LightWeight unIX -] / libaitsched / src

Diff for /libaitsched/src/aitsched.c between versions 1.10 and 1.17.2.1

version 1.10, 2012/05/31 22:31:48 version 1.17.2.1, 2013/05/26 20:14:02
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 108  schedRegisterHooks(sched_root_task_t * __restrict root Line 108  schedRegisterHooks(sched_root_task_t * __restrict root
 #ifdef EVFILT_USER  #ifdef EVFILT_USER
         root->root_hooks.hook_add.user = sched_hook_user;          root->root_hooks.hook_add.user = sched_hook_user;
 #endif  #endif
   #ifdef HAVE_LIBPTHREAD
           root->root_hooks.hook_add.thread = sched_hook_thread;
   #endif
   
         root->root_hooks.hook_exec.cancel = sched_hook_cancel;          root->root_hooks.hook_exec.cancel = sched_hook_cancel;
         root->root_hooks.hook_exec.fetch = sched_hook_fetch;          root->root_hooks.hook_exec.fetch = sched_hook_fetch;
Line 140  schedInit(void ** __restrict data, size_t datlen) Line 143  schedInit(void ** __restrict data, size_t datlen)
         } else {          } else {
                 memset(root, 0, sizeof(sched_root_task_t));                  memset(root, 0, sizeof(sched_root_task_t));
   
                   /* set default maximum regular task hit misses */
                   root->root_miss = MAX_TASK_MISS;
   
                 /* INFINIT polling period by default */                  /* INFINIT polling period by default */
                 sched_timespecinf(&root->root_poll);                  sched_timespecinf(&root->root_poll);
   
 #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 163  schedInit(void ** __restrict data, size_t datlen) Line 169  schedInit(void ** __restrict data, size_t datlen)
                 TAILQ_INIT(&root->root_alarm);                  TAILQ_INIT(&root->root_alarm);
                 TAILQ_INIT(&root->root_node);                  TAILQ_INIT(&root->root_node);
                 TAILQ_INIT(&root->root_proc);                  TAILQ_INIT(&root->root_proc);
                 TAILQ_INIT(&root->root_user);  
                 TAILQ_INIT(&root->root_signal);                  TAILQ_INIT(&root->root_signal);
                   TAILQ_INIT(&root->root_aio);
                   TAILQ_INIT(&root->root_lio);
                   TAILQ_INIT(&root->root_user);
                 TAILQ_INIT(&root->root_event);                  TAILQ_INIT(&root->root_event);
                TAILQ_INIT(&root->root_eventlo);                TAILQ_INIT(&root->root_task);
                 TAILQ_INIT(&root->root_suspend);
                 TAILQ_INIT(&root->root_ready);                  TAILQ_INIT(&root->root_ready);
                 TAILQ_INIT(&root->root_unuse);                  TAILQ_INIT(&root->root_unuse);
                   TAILQ_INIT(&root->root_thread);
   
 #ifdef HAVE_LIBPTHREAD  #ifdef HAVE_LIBPTHREAD
                 for (i = 0; i < taskMAX; i++)                  for (i = 0; i < taskMAX; i++)
Line 222  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_proc, task_node, tmp)          TAILQ_FOREACH_SAFE(task, &(*root)->root_proc, task_node, tmp)
                 schedCancel(task);                  schedCancel(task);
         TAILQ_FOREACH_SAFE(task, &(*root)->root_user, task_node, tmp)  
                 schedCancel(task);  
         TAILQ_FOREACH_SAFE(task, &(*root)->root_signal, task_node, tmp)          TAILQ_FOREACH_SAFE(task, &(*root)->root_signal, task_node, tmp)
                 schedCancel(task);                  schedCancel(task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_aio, task_node, tmp)
                   schedCancel(task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_lio, task_node, tmp)
                   schedCancel(task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_user, task_node, tmp)
                   schedCancel(task);
         TAILQ_FOREACH_SAFE(task, &(*root)->root_event, task_node, tmp)          TAILQ_FOREACH_SAFE(task, &(*root)->root_event, task_node, tmp)
                 schedCancel(task);                  schedCancel(task);
        TAILQ_FOREACH_SAFE(task, &(*root)->root_eventlo, task_node, tmp)        TAILQ_FOREACH_SAFE(task, &(*root)->root_suspend, task_node, tmp)
                 schedCancel(task);                  schedCancel(task);
         TAILQ_FOREACH_SAFE(task, &(*root)->root_ready, task_node, tmp)          TAILQ_FOREACH_SAFE(task, &(*root)->root_ready, task_node, tmp)
                 schedCancel(task);                  schedCancel(task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_thread, task_node, tmp)
                   schedCancel(task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_task, task_node, tmp)
                   schedCancel(task);
   
 #ifdef HAVE_LIBPTHREAD  #ifdef HAVE_LIBPTHREAD
         pthread_mutex_lock(&(*root)->root_mtx[taskUNUSE]);          pthread_mutex_lock(&(*root)->root_mtx[taskUNUSE]);
Line 263  schedEnd(sched_root_task_t ** __restrict root) Line 281  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 286  schedCall(sched_task_t * __restrict task) Line 304  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 372  schedCancel(sched_task_t * __restrict task) Line 390  schedCancel(sched_task_t * __restrict task)
                 case taskPROC:                  case taskPROC:
                         queue = &TASK_ROOT(task)->root_proc;                          queue = &TASK_ROOT(task)->root_proc;
                         break;                          break;
                 case taskUSER:  
                         queue = &TASK_ROOT(task)->root_user;  
                         break;  
                 case taskSIGNAL:                  case taskSIGNAL:
                         queue = &TASK_ROOT(task)->root_signal;                          queue = &TASK_ROOT(task)->root_signal;
                         break;                          break;
                   case taskAIO:
                           queue = &TASK_ROOT(task)->root_aio;
                           break;
                   case taskLIO:
                           queue = &TASK_ROOT(task)->root_lio;
                           break;
                   case taskUSER:
                           queue = &TASK_ROOT(task)->root_user;
                           break;
                 case taskEVENT:                  case taskEVENT:
                         queue = &TASK_ROOT(task)->root_event;                          queue = &TASK_ROOT(task)->root_event;
                         break;                          break;
                case taskEVENTLO:                case taskTASK:
                        queue = &TASK_ROOT(task)->root_eventlo;                        queue = &TASK_ROOT(task)->root_task;
                         break;                          break;
                   case taskSUSPEND:
                           queue = &TASK_ROOT(task)->root_suspend;
                           break;
                 case taskREADY:                  case taskREADY:
                         queue = &TASK_ROOT(task)->root_ready;                          queue = &TASK_ROOT(task)->root_ready;
                         break;                          break;
                   case taskTHREAD:
                           queue = &TASK_ROOT(task)->root_thread;
                           break;
                 default:                  default:
                         queue = NULL;                          queue = NULL;
         }          }
Line 400  schedCancel(sched_task_t * __restrict task) Line 430  schedCancel(sched_task_t * __restrict task)
 #endif  #endif
         }          }
         if (TASK_TYPE(task) != taskUNUSE)          if (TASK_TYPE(task) != taskUNUSE)
                _sched_unuseTask(task);                sched_unuseTask(task);
   
         return 0;          return 0;
 }  }
Line 411  schedCancel(sched_task_t * __restrict task) Line 441  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_TS|CRITERIA_DATA] *      [CRITERIA_ANY|CRITERIA_CALL|CRITERIA_ARG|CRITERIA_FD|CRITERIA_VAL|CRITERIA_ID|CRITERIA_TS|CRITERIA_DATA]
  * @param = search parameter   * @param = search parameter
  * @hook = custom cleanup hook function, may be NULL   * @hook = custom cleanup hook function, may be NULL
  * return: -1 error, -2 error in sub-stage cancel execution, -3 error from custom hook or 0 ok   * return: -1 error, -2 error in sub-stage cancel execution, -3 error from custom hook or 0 ok
Line 440  schedCancelby(sched_root_task_t * __restrict root, sch Line 470  schedCancelby(sched_root_task_t * __restrict root, sch
                         return -2;                          return -2;
                 if (schedCancelby(root, taskPROC, criteria, param, hook))                  if (schedCancelby(root, taskPROC, criteria, param, hook))
                         return -2;                          return -2;
                 if (schedCancelby(root, taskUSER, criteria, param, hook))  
                         return -2;  
                 if (schedCancelby(root, taskSIGNAL, criteria, param, hook))                  if (schedCancelby(root, taskSIGNAL, criteria, param, hook))
                         return -2;                          return -2;
                   if (schedCancelby(root, taskAIO, criteria, param, hook))
                           return -2;
                   if (schedCancelby(root, taskLIO, criteria, param, hook))
                           return -2;
                   if (schedCancelby(root, taskUSER, criteria, param, hook))
                           return -2;
                 if (schedCancelby(root, taskEVENT, criteria, param, hook))                  if (schedCancelby(root, taskEVENT, criteria, param, hook))
                         return -2;                          return -2;
                if (schedCancelby(root, taskEVENTLO, criteria, param, hook))                if (schedCancelby(root, taskTASK, criteria, param, hook))
                         return -2;                          return -2;
                   if (schedCancelby(root, taskSUSPEND, criteria, param, hook))
                           return -2;
                 if (schedCancelby(root, taskREADY, criteria, param, hook))                  if (schedCancelby(root, taskREADY, criteria, param, hook))
                         return -2;                          return -2;
                   if (schedCancelby(root, taskTHREAD, criteria, param, hook))
                           return -2;
                 return 0;                  return 0;
         }          }
         /* choosen queue */          /* choosen queue */
Line 472  schedCancelby(sched_root_task_t * __restrict root, sch Line 510  schedCancelby(sched_root_task_t * __restrict root, sch
                 case taskPROC:                  case taskPROC:
                         queue = &root->root_proc;                          queue = &root->root_proc;
                         break;                          break;
                 case taskUSER:  
                         queue = &root->root_user;  
                         break;  
                 case taskSIGNAL:                  case taskSIGNAL:
                         queue = &root->root_signal;                          queue = &root->root_signal;
                         break;                          break;
                   case taskAIO:
                           queue = &root->root_aio;
                           break;
                   case taskLIO:
                           queue = &root->root_lio;
                           break;
                   case taskUSER:
                           queue = &root->root_user;
                           break;
                 case taskEVENT:                  case taskEVENT:
                         queue = &root->root_event;                          queue = &root->root_event;
                         break;                          break;
                case taskEVENTLO:                case taskTASK:
                        queue = &root->root_eventlo;                        queue = &root->root_task;
                         break;                          break;
                   case taskSUSPEND:
                           queue = &root->root_suspend;
                           break;
                 case taskREADY:                  case taskREADY:
                         queue = &root->root_ready;                          queue = &root->root_ready;
                         break;                          break;
                   case taskTHREAD:
                           queue = &root->root_thread;
                           break;
                 default:                  default:
                         return 0;                          return 0;
         }          }
Line 512  schedCancelby(sched_root_task_t * __restrict root, sch Line 562  schedCancelby(sched_root_task_t * __restrict root, sch
                                 if (TASK_FD(task) == (intptr_t) param)                                  if (TASK_FD(task) == (intptr_t) param)
                                         flg = 1;                                          flg = 1;
                                 break;                                  break;
                           case CRITERIA_ID:
                         case CRITERIA_VAL:                          case CRITERIA_VAL:
                                 if (TASK_VAL(task) == (u_long) param)                                  if (TASK_VAL(task) == (u_long) param)
                                         flg = 1;                                          flg = 1;
Line 546  schedCancelby(sched_root_task_t * __restrict root, sch Line 597  schedCancelby(sched_root_task_t * __restrict root, sch
   
                         TAILQ_REMOVE(queue, task, task_node);                          TAILQ_REMOVE(queue, task, task_node);
                         if (TASK_TYPE(task) != taskUNUSE)                          if (TASK_TYPE(task) != taskUNUSE)
                                _sched_unuseTask(task);                                sched_unuseTask(task);
   
                         flg ^= flg;     /* ok */                          flg ^= flg;     /* ok */
                 }                  }
Line 583  schedRun(sched_root_task_t *root, volatile intptr_t *  Line 634  schedRun(sched_root_task_t *root, volatile intptr_t * 
                                         root->root_hooks.hook_exec.condition &&                                           root->root_hooks.hook_exec.condition && 
                                         root->root_hooks.hook_exec.condition(root, (void*) killState)) {                                          root->root_hooks.hook_exec.condition(root, (void*) killState)) {
                                 if ((task = root->root_hooks.hook_exec.fetch(root, NULL)))                                  if ((task = root->root_hooks.hook_exec.fetch(root, NULL)))
                                        schedCall(task);                                        root->root_ret = schedCall(task);
                         }                          }
                 else                  else
                         /* trigger scheduler loop */                          /* trigger scheduler loop */
                         while (!*killState && root && root->root_hooks.hook_exec.fetch) {                          while (!*killState && root && root->root_hooks.hook_exec.fetch) {
                                 if ((task = root->root_hooks.hook_exec.fetch(root, NULL)))                                  if ((task = root->root_hooks.hook_exec.fetch(root, NULL)))
                                        schedCall(task);                                        root->root_ret = schedCall(task);
                         }                          }
         } else          } else
                 /* infinite scheduler loop */                  /* infinite scheduler loop */
                 while (root && root->root_hooks.hook_exec.fetch)                  while (root && root->root_hooks.hook_exec.fetch)
                         if ((task = root->root_hooks.hook_exec.fetch(root, NULL)))                          if ((task = root->root_hooks.hook_exec.fetch(root, NULL)))
                                schedCall(task);                                root->root_ret = schedCall(task);
   
         return 0;          return 0;
 }  }
Line 608  schedRun(sched_root_task_t *root, volatile intptr_t *  Line 659  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 631  schedPolling(sched_root_task_t * __restrict root, stru Line 682  schedPolling(sched_root_task_t * __restrict root, stru
  *   *
  * @root = root task   * @root = root task
  * @condValue = condition value, kill schedRun() if condValue == killState   * @condValue = condition value, kill schedRun() if condValue == killState
 * return: -1 error ok 0 ok * return: -1 error or 0 ok
  */   */
inline 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 642  schedTermCondition(sched_root_task_t * __restrict root Line 693  schedTermCondition(sched_root_task_t * __restrict root
         root->root_cond = condValue;          root->root_cond = condValue;
         root->root_hooks.hook_exec.condition = sched_hook_condition;          root->root_hooks.hook_exec.condition = sched_hook_condition;
         return 0;          return 0;
   }
   
   /*
    * schedResumeby() - Resume suspended task
    *
    * @root = root task
    * @criteria = find task by criteria 
    *      [CRITERIA_ANY|CRITERIA_ID|CRITERIA_DATA]
    * @param = search parameter (sched_task_t *task| u_long id)
    * return: -1 error or 0 resumed ok
    */
   int
   schedResumeby(sched_root_task_t * __restrict root, u_char criteria, void *param)
   {
           sched_task_t *task, *tmp;
           register int flg = 0;
   
           if (!root)
                   return -1;
   
   #ifdef HAVE_LIBPTHREAD
           pthread_mutex_lock(&root->root_mtx[taskSUSPEND]);
   #endif
           TAILQ_FOREACH_SAFE(task, &root->root_suspend, task_node, tmp) {
                   flg ^= flg;
                   switch (criteria) {
                           case CRITERIA_ANY:
                                   flg = 1;
                                   break;
                           case CRITERIA_ID:
                                   if (TASK_VAL(task) == (u_long) param)
                                           flg = 1;
                                   break;
                           case CRITERIA_DATA:
                                   if (TASK_ID(task) == (sched_task_t*) param)
                                           flg = 1;
                                   break;
                           default:
                                   sched_SetErr(EINVAL, "Invalid parameter criteria %d", criteria);
                                   flg = -1;
                   }
                   if (flg < 0)
                           break;
                   /* resume choosen task */
                   if (flg > 0) {
                           if (root->root_hooks.hook_exec.resume)
                                   if (root->root_hooks.hook_exec.resume(task, NULL)) {
                                           flg = -1;
                                           break;
                                   }
   
                           TAILQ_REMOVE(&root->root_suspend, task, task_node);
   
                           task->task_type = taskREADY;
   #ifdef HAVE_LIBPTHREAD
                           pthread_mutex_lock(&root->root_mtx[taskREADY]);
   #endif
                           TAILQ_INSERT_TAIL(&root->root_ready, task, task_node);
   #ifdef HAVE_LIBPTHREAD
                           pthread_mutex_unlock(&root->root_mtx[taskREADY]);
   #endif
   
                           flg ^= flg;     /* ok */
                   }
           }
   #ifdef HAVE_LIBPTHREAD
           pthread_mutex_unlock(&root->root_mtx[taskSUSPEND]);
   #endif
   
           return flg;
 }  }
Removed from v.1.10  
changed lines
  Added in v.1.17.2.1

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