[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.20 and 1.26

version 1.20, 2013/10/21 13:38:05 version 1.26, 2014/06/05 22:37:29
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, 2012, 2013Copyright 2004 - 2014
         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 82  sched_SetErr(int eno, char *estr, ...) Line 82  sched_SetErr(int eno, char *estr, ...)
         va_end(lst);          va_end(lst);
 }  }
   
   
   /* string support functions directly imported from OpenBSD */
   
   #ifndef HAVE_STRLCAT
   /*
    * Appends src to string dst of size siz (unlike strncat, siz is the
    * full size of dst, not space left).  At most siz-1 characters
    * will be copied.  Always NUL terminates (unless siz <= strlen(dst)).
    * Returns strlen(src) + MIN(siz, strlen(initial dst)).
    * If retval >= siz, truncation occurred.
    */
   size_t
   strlcat(char * __restrict dst, const char * __restrict src, size_t siz)
   {
           char *d = dst;
           const char *s = src;
           size_t n = siz;
           size_t dlen;
   
           /* Find the end of dst and adjust bytes left but don't go past end */
           while (n-- != 0 && *d != '\0')
                   d++;
           dlen = d - dst;
           n = siz - dlen;
   
           if (n == 0)
                   return(dlen + strlen(s));
           while (*s != '\0') {
                   if (n != 1) {
                           *d++ = *s;
                           n--;
                   }
                   s++;
           }
           *d = '\0';
   
           return(dlen + (s - src));       /* count does not include NUL */
   }
   #endif
   #ifndef HAVE_STRLCPY
   /*
    * Copy src to string dst of size siz.  At most siz-1 characters
    * will be copied.  Always NUL terminates (unless siz == 0).
    * Returns strlen(src); if retval >= siz, truncation occurred.
    */
   size_t
   strlcpy(char * __restrict dst, const char * __restrict src, size_t siz)
   {
           char *d = dst;
           const char *s = src;
           size_t n = siz;
   
           /* Copy as many bytes as will fit */
           if (n != 0) {
                   while (--n != 0) {
                           if ((*d++ = *s++) == '\0')
                                   break;
                   }
           }
   
           /* Not enough room in dst, add NUL and traverse rest of src */
           if (n == 0) {
                   if (siz != 0)
                           *d = '\0';              /* NUL-terminate dst */
                   while (*s++)
                           ;
           }
   
           return(s - src - 1);    /* count does not include NUL */
   }
   #endif
   
   
 /* Init and prepare scheduler functions */  /* Init and prepare scheduler functions */
   
 /*  /*
Line 101  schedRegisterHooks(sched_root_task_t * __restrict root Line 174  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;#if defined(HAVE_TIMER_CREATE) && defined(HAVE_TIMER_SETTIME) && defined(HAVE_TIMER_DELETE)
#if defined(HAVE_TIMER_CREATE) && defined(HAVE_TIMER_SETTIME) 
         root->root_hooks.hook_add.rtc = sched_hook_rtc;          root->root_hooks.hook_add.rtc = sched_hook_rtc;
 #endif  #endif
   #if SUP_ENABLE == KQ_SUPPORT
           root->root_hooks.hook_add.alarm = sched_hook_alarm;
         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;
 #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
   #endif  /* KQ_SUPPORT */
 #ifdef HAVE_LIBPTHREAD  #ifdef HAVE_LIBPTHREAD
         root->root_hooks.hook_add.thread = sched_hook_thread;          root->root_hooks.hook_add.thread = sched_hook_thread;
 #endif  #endif
Line 224  schedEnd(sched_root_task_t ** __restrict root) Line 299  schedEnd(sched_root_task_t ** __restrict root)
         if (!root || !*root)          if (!root || !*root)
                 return -1;                  return -1;
   
   #if 0
         TAILQ_FOREACH_SAFE(task, &(*root)->root_read, task_node, tmp)          TAILQ_FOREACH_SAFE(task, &(*root)->root_read, task_node, tmp)
                   printf("read=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_write, task_node, tmp)
                   printf("write=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_timer, task_node, tmp)
                   printf("timer=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_alarm, task_node, tmp)
                   printf("alarm=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_rtc, task_node, tmp)
                   printf("rtc=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_node, task_node, tmp)
                   printf("node=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_proc, task_node, tmp)
                   printf("proc=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_signal, task_node, tmp)
                   printf("signal=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_aio, task_node, tmp)
                   printf("aio=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_lio, task_node, tmp)
                   printf("lio=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_user, task_node, tmp)
                   printf("user=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_event, task_node, tmp)
                   printf("event=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_suspend, task_node, tmp)
                   printf("suspend=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_ready, task_node, tmp)
                   printf("ready=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_thread, task_node, tmp)
                   printf("thread=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_task, task_node, tmp)
                   printf("task=%p\n", task);
           TAILQ_FOREACH_SAFE(task, &(*root)->root_unuse, task_node, tmp)
                   printf("unuse=%p\n", task);
           fflush(stdout);
   #endif
   
           TAILQ_FOREACH_SAFE(task, &(*root)->root_read, task_node, tmp)
                 schedCancel(task);                  schedCancel(task);
         TAILQ_FOREACH_SAFE(task, &(*root)->root_write, task_node, tmp)          TAILQ_FOREACH_SAFE(task, &(*root)->root_write, task_node, tmp)
                 schedCancel(task);                  schedCancel(task);
Line 257  schedEnd(sched_root_task_t ** __restrict root) Line 370  schedEnd(sched_root_task_t ** __restrict root)
         TAILQ_FOREACH_SAFE(task, &(*root)->root_task, task_node, tmp)          TAILQ_FOREACH_SAFE(task, &(*root)->root_task, task_node, tmp)
                 schedCancel(task);                  schedCancel(task);
   
#ifdef HAVE_LIBPTHREAD        SCHED_QLOCK((*root), taskUNUSE);
        pthread_mutex_lock(&(*root)->root_mtx[taskUNUSE]); 
#endif 
         TAILQ_FOREACH_SAFE(task, &(*root)->root_unuse, task_node, tmp) {          TAILQ_FOREACH_SAFE(task, &(*root)->root_unuse, task_node, tmp) {
                 TAILQ_REMOVE(&(*root)->root_unuse, task, task_node);                  TAILQ_REMOVE(&(*root)->root_unuse, task, task_node);
                 free(task);                  free(task);
         }          }
#ifdef HAVE_LIBPTHREAD        SCHED_QUNLOCK((*root), taskUNUSE);
        pthread_mutex_unlock(&(*root)->root_mtx[taskUNUSE]); 
#endif 
   
         if ((*root)->root_hooks.hook_root.fini)          if ((*root)->root_hooks.hook_root.fini)
                 (*root)->root_hooks.hook_root.fini(*root, NULL);                  (*root)->root_hooks.hook_root.fini(*root, NULL);
   
 #ifdef HAVE_LIBPTHREAD  #ifdef HAVE_LIBPTHREAD
        for (i = 0; i < taskMAX; i++)        for (i = 0; i < taskMAX; i++) {
                 SCHED_QUNLOCK(*root, i);
                 pthread_mutex_destroy(&(*root)->root_mtx[i]);                  pthread_mutex_destroy(&(*root)->root_mtx[i]);
           }
 #endif  #endif
   
         free(*root);          free(*root);
Line 335  schedFetch(sched_root_task_t * __restrict root) Line 446  schedFetch(sched_root_task_t * __restrict root)
 int  int
 schedTrigger(sched_task_t * __restrict task)  schedTrigger(sched_task_t * __restrict task)
 {  {
   #if SUP_ENABLE != KQ_SUPPORT
           sched_SetErr(ENOTSUP, "disabled kqueue support");
           return -1;
   #else
 #ifndef EVFILT_USER  #ifndef EVFILT_USER
         sched_SetErr(ENOTSUP, "Not supported kevent() filter");          sched_SetErr(ENOTSUP, "Not supported kevent() filter");
         return -1;          return -1;
Line 357  schedTrigger(sched_task_t * __restrict task) Line 472  schedTrigger(sched_task_t * __restrict task)
   
         return 0;          return 0;
 #endif  #endif
   #endif  /* KQ_SUPPORT */
 }  }
   
 /*  /*
Line 441  schedQuery(sched_task_t * __restrict task) Line 557  schedQuery(sched_task_t * __restrict task)
  * @type = query from queue type, if =taskMAX query same task from all queues   * @type = query from queue type, if =taskMAX query 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_ANY|CRITERIA_CALL|CRITERIA_ARG|CRITERIA_FD|CRITERIA_VAL|
 *              CRITERIA_ID|CRITERIA_TS|CRITERIA_DATA ] *              CRITERIA_ID|CRITERIA_TS|CRITERIA_DATA|CRITERIA_DATLEN ]
  * @param = search parameter   * @param = search parameter
  * return: -1 error, 0 found or 1 not found   * return: -1 error, 0 found or 1 not found
  */   */
Line 449  int Line 565  int
 schedQueryby(sched_root_task_t * __restrict root, sched_task_type_t type,   schedQueryby(sched_root_task_t * __restrict root, sched_task_type_t type, 
                 u_char criteria, void *param)                  u_char criteria, void *param)
 {  {
        sched_task_t *task, *tmp;        sched_task_t *task;
         sched_queue_t *queue;          sched_queue_t *queue;
         register int flg = 0;          register int flg = 0;
   
Line 575  schedQueryby(sched_root_task_t * __restrict root, sche Line 691  schedQueryby(sched_root_task_t * __restrict root, sche
                                 if (TASK_DATA(task) == param)                                  if (TASK_DATA(task) == param)
                                         return 0;       /* found */                                          return 0;       /* found */
                                 break;                                  break;
                           case CRITERIA_DATLEN:
                                   if (TASK_DATLEN(task) == (size_t) param)
                                           return 0;       /* found */
                                   break;
                         default:                          default:
                                 sched_SetErr(EINVAL, "Invalid parameter criteria %d",                                   sched_SetErr(EINVAL, "Invalid parameter criteria %d", 
                                                 criteria);                                                  criteria);
Line 655  schedCancel(sched_task_t * __restrict task) Line 775  schedCancel(sched_task_t * __restrict task)
                 default:                  default:
                         queue = NULL;                          queue = NULL;
         }          }
        if (queue) {        if (queue)
#ifdef HAVE_LIBPTHREAD                remove_task_from(task, queue);
                pthread_mutex_lock(&TASK_ROOT(task)->root_mtx[TASK_TYPE(task)]); 
#endif 
                TAILQ_REMOVE(queue, TASK_ID(task), task_node); 
#ifdef HAVE_LIBPTHREAD 
                pthread_mutex_unlock(&TASK_ROOT(task)->root_mtx[TASK_TYPE(task)]); 
#endif 
        } 
         if (TASK_TYPE(task) != taskUNUSE)          if (TASK_TYPE(task) != taskUNUSE)
                 sched_unuseTask(task);                  sched_unuseTask(task);
   
Line 677  schedCancel(sched_task_t * __restrict task) Line 790  schedCancel(sched_task_t * __restrict 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_ANY|CRITERIA_CALL|CRITERIA_ARG|CRITERIA_FD|CRITERIA_VAL|
 *              CRITERIA_ID|CRITERIA_TS|CRITERIA_DATA ] *              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 782  schedCancelby(sched_root_task_t * __restrict root, sch Line 895  schedCancelby(sched_root_task_t * __restrict root, sch
                         return 0;                          return 0;
         }          }
   
#ifdef HAVE_LIBPTHREAD        SCHED_QLOCK(root, type);
        pthread_mutex_lock(&root->root_mtx[type]); 
#endif 
         TAILQ_FOREACH_SAFE(task, queue, task_node, tmp) {          TAILQ_FOREACH_SAFE(task, queue, task_node, tmp) {
                 flg ^= flg;                  flg ^= flg;
                 switch (criteria) {                  switch (criteria) {
Line 816  schedCancelby(sched_root_task_t * __restrict root, sch Line 927  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 843  schedCancelby(sched_root_task_t * __restrict root, sch Line 958  schedCancelby(sched_root_task_t * __restrict root, sch
                         flg ^= flg;     /* ok */                          flg ^= flg;     /* ok */
                 }                  }
         }          }
#ifdef HAVE_LIBPTHREAD        SCHED_QUNLOCK(root, type);
        pthread_mutex_unlock(&root->root_mtx[type]);
#endif 
         return flg;          return flg;
 }  }
   
Line 926  schedPolling(sched_root_task_t * __restrict root, stru Line 1040  schedPolling(sched_root_task_t * __restrict root, stru
  * return: -1 error or 0 ok   * return: -1 error or 0 ok
  */   */
 int  int
schedTermCondition(sched_root_task_t * __restrict root, intptr_t condValue)schedTermCondition(sched_root_task_t * __restrict root, intptr_t * __restrict condValue)
 {  {
        if (!root)        if (!root && !condValue)
                 return -1;                  return -1;
   
        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;
 }  }
Line 941  schedTermCondition(sched_root_task_t * __restrict root Line 1055  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| unsigned 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
  */   */
Line 954  schedResumeby(sched_root_task_t * __restrict root, u_c Line 1068  schedResumeby(sched_root_task_t * __restrict root, u_c
         if (!root)          if (!root)
                 return -1;                  return -1;
   
#ifdef HAVE_LIBPTHREAD        SCHED_QLOCK(root, taskSUSPEND);
        pthread_mutex_lock(&root->root_mtx[taskSUSPEND]); 
#endif 
         TAILQ_FOREACH_SAFE(task, &root->root_suspend, task_node, tmp) {          TAILQ_FOREACH_SAFE(task, &root->root_suspend, task_node, tmp) {
                 flg ^= flg;                  flg ^= flg;
                 switch (criteria) {                  switch (criteria) {
Line 964  schedResumeby(sched_root_task_t * __restrict root, u_c Line 1076  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;
Line 988  schedResumeby(sched_root_task_t * __restrict root, u_c Line 1101  schedResumeby(sched_root_task_t * __restrict root, u_c
                         TAILQ_REMOVE(&root->root_suspend, task, task_node);                          TAILQ_REMOVE(&root->root_suspend, task, task_node);
   
                         task->task_type = taskREADY;                          task->task_type = taskREADY;
#ifdef HAVE_LIBPTHREAD                        insert_task_to(task, &root->root_ready);
                        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 */                          flg ^= flg;     /* ok */
                 }                  }
         }          }
#ifdef HAVE_LIBPTHREAD        SCHED_QUNLOCK(root, taskSUSPEND);
        pthread_mutex_unlock(&root->root_mtx[taskSUSPEND]); 
#endif 
   
         return flg;          return flg;
 }  }
Removed from v.1.20  
changed lines
  Added in v.1.26

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