Diff for /libaitsched/src/tasks.c between versions 1.13.2.3 and 1.21.2.2

version 1.13.2.3, 2012/08/22 23:43:36 version 1.21.2.2, 2013/09/02 11:19:20
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 52  SUCH DAMAGE. Line 52  SUCH DAMAGE.
  * @root = root task   * @root = root task
  * return: NULL error or !=NULL prepared task   * return: NULL error or !=NULL prepared task
  */   */
inline sched_task_t *sched_task_t *
 sched_useTask(sched_root_task_t * __restrict root)  sched_useTask(sched_root_task_t * __restrict root)
 {  {
         sched_task_t *task, *tmp;          sched_task_t *task, *tmp;
   
         TAILQ_FOREACH_SAFE(task, &root->root_unuse, task_node, tmp) {  
                 if (!TASK_ISLOCKED(task)) {  
 #ifdef HAVE_LIBPTHREAD  #ifdef HAVE_LIBPTHREAD
                        pthread_mutex_lock(&root->root_mtx[taskUNUSE]);        pthread_mutex_lock(&root->root_mtx[taskUNUSE]);
 #endif  #endif
           TAILQ_FOREACH_SAFE(task, &root->root_unuse, task_node, tmp) {
                   if (!TASK_ISLOCKED(task)) {
                         TAILQ_REMOVE(&root->root_unuse, task, task_node);                          TAILQ_REMOVE(&root->root_unuse, task, task_node);
 #ifdef HAVE_LIBPTHREAD  
                         pthread_mutex_unlock(&root->root_mtx[taskUNUSE]);  
 #endif  
                         break;                          break;
                 }                  }
         }          }
   #ifdef HAVE_LIBPTHREAD
           pthread_mutex_unlock(&root->root_mtx[taskUNUSE]);
   #endif
   
         if (!task) {          if (!task) {
                 task = malloc(sizeof(sched_task_t));                  task = malloc(sizeof(sched_task_t));
Line 89  sched_useTask(sched_root_task_t * __restrict root) Line 89  sched_useTask(sched_root_task_t * __restrict root)
  * @task = task   * @task = task
  * return: always is NULL   * return: always is NULL
  */   */
inline sched_task_t *sched_task_t *
 sched_unuseTask(sched_task_t * __restrict task)  sched_unuseTask(sched_task_t * __restrict task)
 {  {
         TASK_UNLOCK(task);          TASK_UNLOCK(task);
Line 108  sched_unuseTask(sched_task_t * __restrict task) Line 108  sched_unuseTask(sched_task_t * __restrict task)
   
 #pragma GCC visibility push(hidden)  #pragma GCC visibility push(hidden)
   
   #ifdef HAVE_LIBPTHREAD
   static void
   _sched_threadCleanup(sched_task_t *t)
   {
           if (!t || !TASK_ROOT(t))
                   return;
   
           pthread_mutex_lock(&TASK_ROOT(t)->root_mtx[taskTHREAD]);
           TAILQ_REMOVE(&TASK_ROOT(t)->root_thread, t, task_node);
           pthread_mutex_unlock(&TASK_ROOT(t)->root_mtx[taskTHREAD]);
           sched_unuseTask(t);
   }
 void *  void *
_sched_threadJoin(sched_task_t *task)_sched_threadWrapper(sched_task_t *t)
 {  {
         void *ret = NULL;          void *ret = NULL;
   
        if (!task)        pthread_cleanup_push((void (*)(void*)) _sched_threadCleanup, t);
 
         if (!t || !TASK_ROOT(t))
                 pthread_exit(ret);
 
         pthread_setcancelstate(PTHREAD_CANCEL_ENABLE, NULL);
         /*
         pthread_setcanceltype(PTHREAD_CANCEL_ASYNCHRONOUS, NULL);
         */
 
         /* notify parent, thread is ready for execution */
         pthread_testcancel();
 
         ret = schedCall(t);
 
         pthread_cleanup_pop(42);
         TASK_ROOT(t)->root_ret = ret;
         pthread_exit(ret);
 }
 #endif
 
 #if defined(HAVE_TIMER_CREATE) && defined(HAVE_TIMER_SETTIME)
 void *
 _sched_rtcWrapper(sched_task_t *t)
 {
         sched_task_func_t func;
         sched_task_t *task;
         sched_root_task_t *r;
 
         if (!t || !TASK_ROOT(t) || !TASK_DATA(t))
                 return NULL;                  return NULL;
           else {
                   r = TASK_ROOT(t);
                   task = (sched_task_t*) TASK_DATA(t);
                   func = TASK_FUNC(task);
           }
   
 #ifdef HAVE_LIBPTHREAD  #ifdef HAVE_LIBPTHREAD
        if (pthread_kill((pthread_t) TASK_VAL(task), 0)) {        pthread_mutex_lock(&r->root_mtx[taskRTC]);
                pthread_join((pthread_t) TASK_VAL(task), &ret); 
                TASK_ROOT(task)->root_ret = ret; 
        } else { 
                usleep(10000); 
                schedTaskSelf(task); 
        } 
 #endif  #endif
           TAILQ_REMOVE(&r->root_rtc, task, task_node);
   #ifdef HAVE_LIBPTHREAD
           pthread_mutex_unlock(&r->root_mtx[taskRTC]);
   #endif
           sched_unuseTask(task);
   
        return NULL;        timer_delete((timer_t) TASK_DATLEN(t));
 
         return schedCall(task);
 }  }
   #endif
   
 #pragma GCC visibility pop  #pragma GCC visibility pop
   
Line 138  _sched_threadJoin(sched_task_t *task) Line 186  _sched_threadJoin(sched_task_t *task)
  * @retcode = return code   * @retcode = return code
  * return: return code   * return: return code
  */   */
inline void *void *
 sched_taskExit(sched_task_t *task, intptr_t retcode)  sched_taskExit(sched_task_t *task, intptr_t retcode)
 {  {
         if (!task || !TASK_ROOT(task))          if (!task || !TASK_ROOT(task))
Line 148  sched_taskExit(sched_task_t *task, intptr_t retcode) Line 196  sched_taskExit(sched_task_t *task, intptr_t retcode)
                 TASK_ROOT(task)->root_hooks.hook_exec.exit(task, (void*) retcode);                  TASK_ROOT(task)->root_hooks.hook_exec.exit(task, (void*) retcode);
   
         TASK_ROOT(task)->root_ret = (void*) retcode;          TASK_ROOT(task)->root_ret = (void*) retcode;
   
 #ifdef HAVE_LIBPTHREAD  
         if (TASK_TYPE(task) == taskTHREAD) {  
                 if (TASK_FLAG(task) == PTHREAD_CREATE_JOINABLE) /* joinable thread */  
                         schedTask(TASK_ROOT(task), _sched_threadJoin, TASK_ARG(task),  
                                         TASK_VAL(task), TASK_DATA(task), TASK_DATLEN(task));  
                 sched_unuseTask(task);  
                 pthread_exit((void*) retcode);  
         }  
 #endif  
   
         return (void*) retcode;          return (void*) retcode;
 }  }
   
Line 499  schedSignal(sched_root_task_t * __restrict root, sched Line 536  schedSignal(sched_root_task_t * __restrict root, sched
  * @func = task execution function   * @func = task execution function
  * @arg = 1st func argument   * @arg = 1st func argument
  * @ts = timeout argument structure, minimum alarm timer resolution is 1msec!   * @ts = timeout argument structure, minimum alarm timer resolution is 1msec!
 * @opt_data = Optional data * @opt_data = Alarm timer ID
  * @opt_dlen = Optional data length   * @opt_dlen = Optional data length
  * return: NULL error or !=NULL new queued task   * return: NULL error or !=NULL new queued task
  */   */
Line 613  schedAIO(sched_root_task_t * __restrict root, sched_ta Line 650  schedAIO(sched_root_task_t * __restrict root, sched_ta
  * @offset = Offset from start of file, if =-1 from current position   * @offset = Offset from start of file, if =-1 from current position
  * return: NULL error or !=NULL new queued task   * return: NULL error or !=NULL new queued task
  */   */
inline sched_task_t *sched_task_t *
 schedAIORead(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int fd,   schedAIORead(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int fd, 
                 void *buffer, size_t buflen, off_t offset)                  void *buffer, size_t buflen, off_t offset)
 {  {
Line 667  schedAIORead(sched_root_task_t * __restrict root, sche Line 704  schedAIORead(sched_root_task_t * __restrict root, sche
  * @offset = Offset from start of file, if =-1 from current position   * @offset = Offset from start of file, if =-1 from current position
  * return: NULL error or !=NULL new queued task   * return: NULL error or !=NULL new queued task
  */   */
inline sched_task_t *sched_task_t *
 schedAIOWrite(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int fd,   schedAIOWrite(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int fd, 
                 void *buffer, size_t buflen, off_t offset)                  void *buffer, size_t buflen, off_t offset)
 {  {
Line 848  schedLIORead(sched_root_task_t * __restrict root, sche Line 885  schedLIORead(sched_root_task_t * __restrict root, sche
  * @offset = Offset from start of file, if =-1 from current position   * @offset = Offset from start of file, if =-1 from current position
  * return: NULL error or !=NULL new queued task   * return: NULL error or !=NULL new queued task
  */   */
inline sched_task_t *sched_task_t *
 schedLIOWrite(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int fd,   schedLIOWrite(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int fd, 
                 struct iovec *bufs, size_t nbufs, off_t offset)                  struct iovec *bufs, size_t nbufs, off_t offset)
 {  {
Line 1203  schedCallOnce(sched_root_task_t * __restrict root, sch Line 1240  schedCallOnce(sched_root_task_t * __restrict root, sch
  * @root = root task   * @root = root task
  * @func = task execution function   * @func = task execution function
  * @arg = 1st func argument   * @arg = 1st func argument
 * @detach = Detach thread from scheduler, if !=0 * @ss = stack size
  * @opt_data = Optional data   * @opt_data = Optional data
  * @opt_dlen = Optional data length   * @opt_dlen = Optional data length
  * return: NULL error or !=NULL new queued task   * return: NULL error or !=NULL new queued task
  */   */
 sched_task_t *  sched_task_t *
schedThread(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, int detach, schedThread(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, 
                void *opt_data, size_t opt_dlen)                size_t ss, void *opt_data, size_t opt_dlen)
 {  {
 #ifndef HAVE_LIBPTHREAD  #ifndef HAVE_LIBPTHREAD
         sched_SetErr(ENOTSUP, "Not supported thread tasks");          sched_SetErr(ENOTSUP, "Not supported thread tasks");
         return NULL;          return NULL;
 #endif  #endif
         sched_task_t *task;          sched_task_t *task;
         void *ptr;  
         pthread_attr_t attr;          pthread_attr_t attr;
   
         if (!root || !func)          if (!root || !func)
                 return NULL;                  return NULL;
   
         /* get new task */          /* get new task */
        if (!(task = sched_useTask(root)))        if (!(task = sched_useTask(root))) {
 
                 return NULL;                  return NULL;
           }
   
         task->task_func = func;          task->task_func = func;
         TASK_TYPE(task) = taskTHREAD;          TASK_TYPE(task) = taskTHREAD;
         TASK_ROOT(task) = root;          TASK_ROOT(task) = root;
   
         TASK_ARG(task) = arg;          TASK_ARG(task) = arg;
         TASK_FLAG(task) = detach ? PTHREAD_CREATE_DETACHED : PTHREAD_CREATE_JOINABLE;  
   
         TASK_DATA(task) = opt_data;          TASK_DATA(task) = opt_data;
         TASK_DATLEN(task) = opt_dlen;          TASK_DATLEN(task) = opt_dlen;
   
         pthread_attr_init(&attr);          pthread_attr_init(&attr);
        pthread_attr_setdetachstate(&attr, TASK_FLAG(task));        pthread_attr_setdetachstate(&attr, PTHREAD_DETACHED);
         if (ss && (errno = pthread_attr_setstacksize(&attr, ss))) {
                 LOGERR;
                 pthread_attr_destroy(&attr);
                 return sched_unuseTask(task);
         }
         if ((errno = pthread_attr_getstacksize(&attr, &ss))) {
                 LOGERR;
                 pthread_attr_destroy(&attr);
                 return sched_unuseTask(task);
         } else
                 TASK_FLAG(task) = ss;
         if ((errno = pthread_attr_setguardsize(&attr, ss))) {
                 LOGERR;
                 pthread_attr_destroy(&attr);
                 return sched_unuseTask(task);
         }
 #ifdef SCHED_RR
         pthread_attr_setschedpolicy(&attr, SCHED_RR);
 #else
         pthread_attr_setschedpolicy(&attr, SCHED_OTHER);
 #endif
 
         pthread_mutex_lock(&root->root_mtx[taskTHREAD]);
         TAILQ_INSERT_TAIL(&root->root_thread, TASK_ID(task), task_node);
         pthread_mutex_unlock(&root->root_mtx[taskTHREAD]);
 
         if (root->root_hooks.hook_add.thread)          if (root->root_hooks.hook_add.thread)
                ptr = root->root_hooks.hook_add.thread(task, &attr);                if (root->root_hooks.hook_add.thread(task, &attr)) {
                         schedCancel(task);
                         task = NULL;
                 }
         pthread_attr_destroy(&attr);
         return task;
 }
 
 /*
  * schedRTC() - Add RTC task to scheduler queue
  *
  * @root = root task
  * @func = task execution function
  * @arg = 1st func argument
  * @ts = timeout argument structure, minimum alarm timer resolution is 1msec!
  * @opt_data = Optional RTC ID
  * @opt_dlen = Optional data length
  * return: NULL error or !=NULL new queued task
  */
 sched_task_t *
 schedRTC(sched_root_task_t * __restrict root, sched_task_func_t func, void *arg, struct timespec ts, 
                 void *opt_data, size_t opt_dlen)
 {
 #if defined(HAVE_TIMER_CREATE) && defined(HAVE_TIMER_SETTIME)
         sched_task_t *task;
         void *ptr;
 
         if (!root || !func)
                 return NULL;
 
         /* get new task */
         if (!(task = sched_useTask(root)))
                 return NULL;
 
         task->task_func = func;
         TASK_TYPE(task) = taskRTC;
         TASK_ROOT(task) = root;
 
         TASK_ARG(task) = arg;
         TASK_TS(task) = ts;
 
         TASK_DATA(task) = opt_data;
         TASK_DATLEN(task) = opt_dlen;
 
         if (root->root_hooks.hook_add.rtc)
                 ptr = root->root_hooks.hook_add.rtc(task, NULL);
         else          else
                 ptr = NULL;                  ptr = NULL;
         pthread_attr_destroy(&attr);  
   
         if (!ptr) {          if (!ptr) {
                pthread_mutex_lock(&root->root_mtx[taskTHREAD]);#ifdef HAVE_LIBPTHREAD
                TAILQ_INSERT_TAIL(&root->root_thread, TASK_ID(task), task_node);                pthread_mutex_lock(&root->root_mtx[taskRTC]);
                pthread_mutex_unlock(&root->root_mtx[taskTHREAD]);#endif
                 TAILQ_INSERT_TAIL(&root->root_rtc, TASK_ID(task), task_node);
 #ifdef HAVE_LIBPTHREAD
                 pthread_mutex_unlock(&root->root_mtx[taskRTC]);
 #endif
         } else          } else
                 task = sched_unuseTask(task);                  task = sched_unuseTask(task);
   
         return task;          return task;
   #else
           sched_SetErr(ENOTSUP, "Not supported realtime clock extensions");
           return NULL;
   #endif
 }  }
   

Removed from v.1.13.2.3  
changed lines
  Added in v.1.21.2.2


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