Планирование потоков

if (setjmp(current_thread->context) == 0) {
  // Сохранили контекст выполняемой в данной момент нити.
  ...
  current_thread = scheduler_select_next_thread();  // Выбрали какую-то нить для запуска.
  ...
  longjmp(current_thread->context, 1);                // Запустили ее.
} else {
  // В результате longjmp() строкой выше оказались тут.
  ...
  return;                                                         // Выходим из обработчика сигнала.
}

#include <stdio.h>
#include <stdlib.h>
#include <time.h>
#include <unistd.h>
#include <setjmp.h>
#include <pthread.h>
#include <math.h>
 
#define TIME_RUN 10
 
int count_of_func=0;
int run_func=0;
jmp_buf crt;
jmp_buf *func;
 
int func1(int n)
{
  int i = 0;
 
  for (i = 0; i < 100000; ++i)
  {
      printf("%i - %i", n, i);
  }
 
  return (i);
}
 
 
 
void* func_thr ( void* arg)
{
        int new_func=setjmp(crt);
        switch (new_func)
        {
            case 1:
                setjmp(*(func+new_func-1));
                func1(1);
                count_of_func--;
                break;
            case 2:
                setjmp(*(func+new_func-1));
                func1(2);
                count_of_func--;
                break;
            default:
                break;
        }
    return NULL;
}
 
 
int creat_th (jmp_buf *func, int *prior, int numb_of_func, int priority)
{
    count_of_func++;
 
    if (count_of_func!=1)
    {
        func=realloc(func, sizeof(jmp_buf)*count_of_func);
 
        prior=realloc(prior, sizeof(int)*count_of_func);
    }
 
    *(prior+count_of_func-1)=priority;
 
    longjmp(crt, numb_of_func);
 
    usleep(400);
}
 
int main()
{
    int *prioritet=malloc(sizeof(int));
 
    func=malloc(sizeof(jmp_buf));
 
    pthread_t pth;
 
    pthread_create (&pth, NULL, func_thr,(void*)run_func);
 
    creat_th(func, prioritet, 1, 6);
    run_func=1;
 
    while (count_of_func!=0)
    {
        longjmp(*(func+run_func-1), 0);
 
        usleep(*(prioritet+run_func-1)*TIME_RUN);
 
        setjmp(*(func+run_func-1));
 
        run_func++;
 
        if (run_func==count_of_func)
        {
            run_func=1;
        }
 
    }
 
    free(prioritet);
    free(func);
 
    return 0;
}