C高级 跨平台协程库

//
// Fiber creation flags
//
#define FIBER_FLAG_FLOAT_SWITCH 0x1     // context switch floating point

/*
 * VS编译器特性约定
 * 1. 其参数都是从右向左通过堆栈传递的
 * 2. 函数调用在返回前要由被调用者清理堆栈(被调用函数弹出的时候销毁堆栈)
 */
#define WINAPI      __stdcall

/*
 * 将当前线程转成纤程, 返回转换成功的主纤程对象域
 * lpParameter    : 转换的时候传入到主线程中用户数据
 * dwFlags        : 附加参数, 默认填写 FIBER_FLAG_FLOAT_SWITCH
 *                : 返回转换成功后的主纤程对象域
 */
WINBASEAPI __out_opt LPVOID WINAPI ConvertThreadToFiberEx(
    __in_opt LPVOID lpParameter,
    __in DWORD dwFlags
);

// 得到当前纤程中用户传入的数据, 就是上面 lpParameter
__inline PVOID GetFiberData( void )    { return *(PVOID *) (ULONG_PTR) __readfsdword (0x10);}

// 得到当前运行纤程对象
__inline PVOID GetCurrentFiber( void ) { return (PVOID) (ULONG_PTR) __readfsdword (0x10);}
                                                          
/*
 * 将当前纤程转换成线程, 对映ConvertThreadToFiberEx操作系列函数. 返回原始环境
 *                : 返回成功状态, TRUE标识成功
 */
WINBASEAPI BOOL WINAPI ConvertFiberToThread(VOID);

// 标识纤程执行体的注册函数声明, lpFiberParameter 可以通过 GetFiberData 得到
typedef VOID (WINAPI *PFIBER_START_ROUTINE)(LPVOID lpFiberParameter);
typedef PFIBER_START_ROUTINE LPFIBER_START_ROUTINE;

/*
 * 创建一个没有启动纤程对象并返回
 * dwStackCommitSize    : 当前纤程栈大小, 0标识默认大小
 * dwStackReserveSize    : 当前纤程初始化化保留大小, 0标识默认大小
 * dwFlags                : 纤程创建状态, 默认FIBER_FLAG_FLOAT_SWITCH, 支持浮点数操作
 * lpStartAddress        : 指定纤程运行的载体.等同于纤程执行需要指明执行函数
 * lpParameter            : 纤程执行的时候, 传入的用户数据, 在纤程中GetFiberData可以得到
 *                        : 返回创建好的纤程对象 
 */                                              
WINBASEAPI __out_opt LPVOID WINAPI CreateFiberEx(
    __in     SIZE_T dwStackCommitSize,
    __in     SIZE_T dwStackReserveSize,
    __in     DWORD dwFlags,
    __in     LPFIBER_START_ROUTINE lpStartAddress,
    __in_opt LPVOID lpParameter
);

// 销毁一个申请的纤程资源和CreateFiberEx成对出现
WINBASEAPI VOID WINAPI DeleteFiber(__in LPVOID lpFiber);

// 纤程跳转, 跳转到lpFiber指定的纤程
WINBASEAPI VOID WINAPI SwitchToFiber(__in LPVOID lpFiber);

#include <Windows.h>
#include <stdio.h>
#include <stdlib.h>

// fiber one run
static void WINAPI _fiber_one_run(LPVOID pars) {
    LPVOID * fibers = pars;
    puts("_fiber_one_run start");
    
    fibers[1] = GetCurrentFiber();
    // 切换到主纤程中
    SwitchToFiber(fibers[0]);

    puts("_fiber_one_run end");
    SwitchToFiber(fibers[0]);
}

/*
 * test 纤程练习
 */
int main(int argc, char * argv[]) {
    PVOID fibers[2];
    // A pointer to a variable that is passed to the fiber. The fiber can retrieve this data by using the GetFiberData macro.
    fibers[0] = ConvertThreadToFiberEx(NULL, FIBER_FLAG_FLOAT_SWITCH);
    
    // 创建普通纤程, 当前还是在主纤程中
    fibers[1] = CreateFiberEx(0, 0, FIBER_FLAG_FLOAT_SWITCH, _fiber_one_run, fibers);
    
    puts("main ConvertThreadToFiberEx start");
    SwitchToFiber(fibers[1]);
    
    puts("main ConvertThreadToFiber SwitchToFiber");
    SwitchToFiber(fibers[1]);
    puts("main ConvertThreadToFiber SwitchToFiber two");

    DeleteFiber(fibers[1]);
    ConvertFiberToThread();
    puts("main ConvertThreadToFiber SwitchToFiber two end");

    return 0;
}

#include <ucontext.h>

/*
 * 得到当前程序运行此处上下文信息
 * ucp        : 返回当前程序上下文并保存在ucp指向的内存中
 *            : -1标识失败, 0标识成功
 */
int getcontext(ucontext_t * ucp);

/*
 * 设置到执行程序上下文对象中. 
 * ucp        : 准备跳转的上下文对象
 *            : 失败返回-1. 成功不返回
 */
int setcontext(const ucontext_t * ucp);

/*
 * 重新设置ucp上下文. 
 * ucp        : 待设置的上下文对象
 * func        : 新上下文执行函数体, 其实gcc认为声明是void * func(void)
 * argc        : func 函数参数个数
 * ...        : 传入func中的参数
 */
void makecontext(ucontext_t * ucp, void * func(), int argc, ...);

/*
 * 保存当前上下文对象 oucp, 并且跳转到执行上下文件对象 ucp 中
 * oucp        : 保存当前上下文对象
 * ucp        : 执行的上下文对象
 *            : 失败返回-1, 成功不返回
 */
int swapcontext (ucontext_t * oucp, ucontext_t * ucp);

/* Userlevel context.  */
typedef struct ucontext {
     unsigned long int uc_flags;
     struct ucontext * uc_link;                // 下一个执行的序列, NULL不继续执行了
     stack_t uc_stack;                         // 当前上下文, 堆栈信息
     mcontext_t uc_mcontext;
     __sigset_t uc_sigmask;
    struct _libc_fpstate __fpregs_mem;
} ucontext_t;

/* Alternate, preferred interface.  */
typedef struct sigaltstack {
    void * ss_sp;                             // 指向当前堆栈信息首地址
    int ss_flags;
    size_t ss_size;                           // 当前堆栈大小
} stack_t;

#include <ucontext.h>
#include <stdio.h>
#include <stdlib.h>

static ucontext_t uctx_main, uctx_func1, uctx_func2;

#define handle_error(msg)     do { perror(msg); exit(EXIT_FAILURE); } while (0)

static void _func1(void) {
    printf("func1: started\n");
    printf("func1: swapcontext(&uctx_func1, &uctx_func2)\n");
    if (swapcontext(&uctx_func1, &uctx_func2) == -1)
        handle_error("swapcontext");
    printf("func1: returning\n");
}

static void _func2(void) {
    printf("func2: started\n");
    printf("func2: swapcontext(&uctx_func2, &uctx_func1)\n");
    if (swapcontext(&uctx_func2, &uctx_func1) == -1)
        handle_error("swapcontext");
    printf("func2: returning\n");
}

int main(int argc, char * argv[]) {
    char func1_stack[16384];
    char func2_stack[16384];

    if (getcontext(&uctx_func1) == -1)
        handle_error("getcontext");
    uctx_func1.uc_stack.ss_sp = func1_stack;
    uctx_func1.uc_stack.ss_size = sizeof(func1_stack);
    uctx_func1.uc_link = &uctx_main;
    makecontext(&uctx_func1, _func1, 0);

    if (getcontext(&uctx_func2) == -1)
        handle_error("getcontext");
    uctx_func2.uc_stack.ss_sp = func2_stack;
    uctx_func2.uc_stack.ss_size = sizeof(func2_stack);
    uctx_func2.uc_link = &uctx_func1;
    makecontext(&uctx_func2, _func2, 0);

    printf("main: swapcontext(&uctx_main, &uctx_func2)\n");
    if (swapcontext(&uctx_main, &uctx_func2) == -1)
        handle_error("swapcontext");

    printf("main: exiting\n");
    return 0;
}

#ifndef _H_COROUTINE
#define _H_COROUTINE

typedef enum costatus {       // 纤程存在状态
    CS_Dead       = 0,        // 纤程死亡状态
    CS_Ready      = 1,        // 纤程已经就绪
    CS_Running    = 2,        // 纤程正在运行
    CS_Suspend    = 3,        // 纤程暂停等待
} costatus_e;

typedef struct comng * comng_t;

/*
 * 创建运行纤程的主体, 等同于纤程创建需要执行的函数体.
 * schedule : co_start 函数返回的结果
 * ud       : 用户自定义数据
 */
typedef void (* co_f)(comng_t comng, void * ud);

/*
 * 开启纤程系统, 并创建主纤程
 *            : 返回开启的纤程调度系统管理器
 */
extern comng_t co_start(void);

/*
 * 关闭开启的纤程系统
 * comng    : co_start 返回的纤程管理器
 */
extern void co_close(comng_t comng);

/*
 * 创建一个纤程对象,并返回创建纤程的id. 创建好的纤程状态是CS_Ready
 * comng    : co_start 返回的纤程管理器
 * func     : 纤程运行的主体
 * ud       : 用户传入的数据, co_f 中 ud 会使用
 *          : 返回创建好的纤程标识id
 */
extern int co_create(comng_t comng, co_f func, void * ud);

/*
 * 激活创建的纤程对象.
 * comng    : 纤程管理器对象
 * id       : co_create 创建的纤程对象
 */
extern void co_resume(comng_t comng, int id);

/*
 * 中断当前运行的的纤程, 并将CPU交给主纤程处理调度.
 * comng    : 纤程管理器对象
 */
extern void co_yield(comng_t comng);

/*
 * 得到当前纤程运行的状态
 * comng    : 纤程管理器对象
 * id       : co_create 创建的纤程对象
 *          : 返回状态具体参照 costatus_e
 */
extern costatus_e co_status(comng_t comng, int id);

/*
 * 得到当前纤程系统中运行的纤程, 返回 < 0表示没有纤程在运行
 * comng    : 纤程管理器对象
 *          : 返回当前运行的纤程标识id, 
 */
extern int co_running(comng_t comng);

#endif // !_H_COROUTINE

#include <stdio.h>
#include "coroutine.h"

struct args {
    int n;
};

static void _foo(void * comng, void * ud) {
    struct args * arg = ud;
    int start = arg->n;
    int i;
    for (i = 0;i<5;i++) {
        printf("coroutine %d : %d\n", co_running(comng), start + i);
        co_yield(comng);
    }
}

static void _test(void * comng) {
    struct args arg1 = { 0 };
    struct args arg2 = { 100 };

    int co1 = co_create(comng, _foo, &arg1);
    int co2 = co_create(comng, _foo, &arg2);
    printf("main start\n");
    while (co_status(comng, co1) && co_status(comng, co2)) {
        co_resume(comng, co1);
        co_resume(comng, co2);
    }
    printf("main end\n");
}

/*
 * test coroutine demo
 */
int main(int argc, char * argv[]) {
    void * comng = co_start();
    _test(comng);
    co_close(comng);

    return 0;
}

#include "coroutine.h"
#include <Windows.h>
#include <string.h>
#include <assert.h>
#include <stdlib.h>

// 纤程栈大小
#define _INT_STACK        (1024 * 1024)
// 默认初始化创建纤程数目
#define _INT_COROUTINE    (16)

/*
 * 单个纤程单元 coroutine , 还有纤程集管理器 comng
 */
struct coroutine;

struct comng {
    PVOID main;                 // 纤程管理器中保存的临时纤程对象
    int running;                // 当前纤程管理器中运行的纤程id
    int nco;                    // 当前纤程集轮询中当前索引
    int cap;                    // 纤程集容量,
    struct coroutine ** co;     // 保存的纤程集
};

struct coroutine {
    PVOID ctx;                    // 操作系统纤程对象                
    co_f func;                    // 纤程执行的函数体
    void * ud;                    // 纤程执行的额外参数
    costatus_e status;            // 当前纤程运行状态
    struct comng * comng;         // 当前纤程集管理器
};

/*
 * 开启纤程系统, 并创建主纤程
 *            : 返回开启的纤程调度系统管理器
 */
inline comng_t
co_start(void) {
    struct comng * comng = malloc(sizeof(struct comng));
    assert(NULL != comng);
    comng->nco = 0;
    comng->running = -1;
    comng->co = calloc(comng->cap = _INT_COROUTINE, sizeof(struct coroutine *));
    assert(NULL != comng->co);
    // 开启Window协程
    comng->main = ConvertThreadToFiberEx(NULL, FIBER_FLAG_FLOAT_SWITCH);
    return comng;
}

// 销毁一个纤程
static inline void _co_delete(struct coroutine * co) {
    DeleteFiber(co->ctx);
    free(co);
}

/*
 * 关闭开启的纤程系统
 * comng    : co_start 返回的纤程管理器
 */
void 
co_close(comng_t comng) {
    int i;
    for (i = 0; i < comng->cap; ++i) {
        struct coroutine * co = comng->co[i];
        if (co) {
            _co_delete(co);
            comng->co[i] = NULL;
        }
    }
    free(comng->co);
    comng->co = NULL;
    free(comng);
    ConvertFiberToThread();
}

// 创建一个纤程对象
static inline struct coroutine * _co_new(comng_t comng, co_f func, void * ud) {
    struct coroutine * co = malloc(sizeof(struct coroutine));
    assert(co && comng && func);
    co->func = func;
    co->ud = ud;
    co->comng = comng;
    co->status = CS_Ready;
    return co;
}

/*
 * 创建一个纤程对象,并返回创建纤程的id. 创建好的纤程状态是CS_Ready
 * comng    : co_start 返回的纤程管理器
 * func     : 纤程运行的主体
 * ud       : 用户传入的数据, co_f 中 ud 会使用
 *          : 返回创建好的纤程标识id
 */
int 
co_create(comng_t comng, co_f func, void * ud) {
    struct coroutine * co = _co_new(comng, func, ud);
    // 下面是普通情况, 可以找见
    if (comng->nco < comng->cap) {
        int i;
        for (i = 0; i < comng->cap; ++i) {
            int id = (i + comng->nco) % comng->cap;
            if (NULL == comng->co[id]) {
                comng->co[id] = co;
                ++comng->nco;
                return id;
            }
        }
        assert(i == comng->cap);
        return -1;
    }

    // 需要重新分配空间, 构造完毕后返回
    comng->co = realloc(comng->co, sizeof(struct coroutine *) * comng->cap * 2);
    assert(NULL != comng->co);
    memset(comng->co + comng->cap, 0, sizeof(struct coroutine *) * comng->cap);
    comng->cap <<= 1;
    comng->co[comng->nco] = co;
    return comng->nco++;
}

static inline VOID WINAPI _comain(LPVOID ptr) {
    struct comng * comng = ptr;
    int id = comng->running;
    struct coroutine * co = comng->co[id];
    co->func(comng, co->ud);
    _co_delete(co);
    comng->co[id] = NULL;
    --comng->nco;
    comng->running = -1;
}

/*
 * 激活创建的纤程对象.
 * comng    : 纤程管理器对象
 * id       : co_create 创建的纤程对象
 */
void 
co_resume(comng_t comng, int id) {
    struct coroutine * co;
    assert(comng->running == -1 && id >= 0 && id < comng->cap);
    co = comng->co[id];
    if(NULL == co || co->status == CS_Dead)
        return;
    switch(co->status) {
    case CS_Ready:
        comng->running = id;
        co->status = CS_Running;
        co->ctx = CreateFiberEx(_INT_STACK, 0, FIBER_FLAG_FLOAT_SWITCH, _comain, comng);
        comng->main = GetCurrentFiber();
        SwitchToFiber(co->ctx);
        break;
    case CS_Suspend:
        comng->running = id;
        co->status = CS_Running;
        comng->main = GetCurrentFiber();
        SwitchToFiber(co->ctx);
        break;
    default:
        assert(0);
    }
}

/*
 * 中断当前运行的的纤程, 并将CPU交给主纤程处理调度.
 * comng    : 纤程管理器对象
 */
inline void 
co_yield(comng_t comng) {
    struct coroutine * co;
    int id = comng->running;
    assert(id >= 0);
    co = comng->co[id];
    co->status = CS_Suspend;
    comng->running = -1;
    co->ctx = GetCurrentFiber();
    SwitchToFiber(comng->main);
}

/*
 * 得到当前纤程运行的状态
 * comng    : 纤程管理器对象
 * id       : co_create 创建的纤程对象
 *          : 返回状态具体参照 costatus_e
 */
inline costatus_e 
co_status(comng_t comng, int id) {
    assert(comng && id >=0 && id < comng->cap);
    return comng->co[id] ? comng->co[id]->status : CS_Dead;
}

/*
 * 得到当前纤程系统中运行的纤程, 返回 < 0表示没有纤程在运行
 * comng    : 纤程管理器对象
 *          : 返回当前运行的纤程标识id,
 */
inline int 
co_running(comng_t comng) {
    return comng->running;
}

struct comng {
    PVOID main;                 // 纤程管理器中保存的临时纤程对象
    int running;                // 当前纤程管理器中运行的纤程id
    int nco;                    // 当前纤程集轮询中当前索引
    int cap;                    // 纤程集容量,
    struct coroutine ** co;     // 保存的纤程集
};

    co->ctx = GetCurrentFiber();
    SwitchToFiber(comng->main);

#include "coroutine.h"
#include <ucontext.h>
#include <string.h>
#include <assert.h>
#include <stdlib.h>
#include <stddef.h>
#include <stdint.h>

// 纤程栈大小
#define _INT_STACK        (1024 * 1024)
// 默认初始化创建纤程数目
#define _INT_COROUTINE    (16)

/*
 * 单个纤程单元 coroutine , 还有纤程集管理器 comng
 */
struct coroutine;

struct comng {
    char stack[_INT_STACK];
    ucontext_t main;            // 纤程管理器中保存的临时纤程对象
    int running;                // 当前纤程管理器中运行的纤程id
    int nco;                    // 当前纤程集轮询中当前索引
    int cap;                    // 纤程集容量,
    struct coroutine ** co;     // 保存的纤程集
};

struct coroutine {
    char * stack;
    ucontext_t ctx;               // 操作系统纤程对象
    ptrdiff_t cap;
    ptrdiff_t size;                
    co_f func;                    // 纤程执行的函数体
    void * ud;                    // 纤程执行的额外参数
    costatus_e status;            // 当前纤程运行状态
    struct comng * comng;         // 当前纤程集管理器
};

/*
 * 开启纤程系统, 并创建主纤程
 *            : 返回开启的纤程调度系统管理器
 */
inline comng_t
co_start(void) {
    struct comng * comng = malloc(sizeof(struct comng));
    assert(NULL != comng);
    comng->nco = 0;
    comng->running = -1;
    comng->co = calloc(comng->cap = _INT_COROUTINE, sizeof(struct coroutine *));
    assert(NULL != comng->co);
    return comng;
}

// 销毁一个纤程
static inline void _co_delete(struct coroutine * co) {
    free(co->stack);
    free(co);
}

/*
 * 关闭开启的纤程系统
 * comng    : co_start 返回的纤程管理器
 */
void 
co_close(comng_t comng) {
    int i;
    for (i = 0; i < comng->cap; ++i) {
        struct coroutine * co = comng->co[i];
        if (co) {
            _co_delete(co);
            comng->co[i] = NULL;
        }
    }
    free(comng->co);
    comng->co = NULL;
    free(comng);
}

// 创建一个纤程对象
static inline struct coroutine * _co_new(comng_t comng, co_f func, void * ud) {
    struct coroutine * co = malloc(sizeof(struct coroutine));
    assert(co && comng && func);
    co->func = func;
    co->ud = ud;
    co->comng = comng;
    co->status = CS_Ready;
    co->cap = 0;
    co->size = 0;
    co->stack = NULL;
    return co;
}

/*
 * 创建一个纤程对象,并返回创建纤程的id. 创建好的纤程状态是CS_Ready
 * comng    : co_start 返回的纤程管理器
 * func     : 纤程运行的主体
 * ud       : 用户传入的数据, co_f 中 ud 会使用
 *          : 返回创建好的纤程标识id
 */
int 
co_create(comng_t comng, co_f func, void * ud) {
    struct coroutine * co = _co_new(comng, func, ud);
    // 下面是普通情况, 可以找见
    if (comng->nco < comng->cap) {
        int i;
        for (i = 0; i < comng->cap; ++i) {
            int id = (i + comng->nco) % comng->cap;
            if (NULL == comng->co[id]) {
                comng->co[id] = co;
                ++comng->nco;
                return id;
            }
        }
        assert(i == comng->cap);
        return -1;
    }

    // 需要重新分配空间, 构造完毕后返回
    comng->co = realloc(comng->co, sizeof(struct coroutine *) * comng->cap * 2);
    assert(NULL != comng->co);
    memset(comng->co + comng->cap, 0, sizeof(struct coroutine *) * comng->cap);
    comng->cap <<= 1;
    comng->co[comng->nco] = co;
    return comng->nco++;
}

static inline void _comain(uint32_t low32, uint32_t hig32) {
    uintptr_t ptr = (uintptr_t)low32 | ((uintptr_t)hig32 << 32);
    struct comng * comng = (struct comng *)ptr;
    int id = comng->running;
    struct coroutine * co = comng->co[id];
    co->func(comng, co->ud);
    _co_delete(co);
    comng->co[id] = NULL;
    --comng->nco;
    comng->running = -1;
}

/*
 * 激活创建的纤程对象.
 * comng    : 纤程管理器对象
 * id       : co_create 创建的纤程对象
 */
void 
co_resume(comng_t comng, int id) {
    struct coroutine * co;
    uintptr_t ptr;
    assert(comng->running == -1 && id >= 0 && id < comng->cap);
    co = comng->co[id];
    if(NULL == co || co->status == CS_Dead)
        return;
    switch(co->status) {
    case CS_Ready:
        comng->running = id;
        co->status = CS_Running;
        getcontext(&co->ctx);
        co->ctx.uc_stack.ss_sp = comng->stack;
        co->ctx.uc_stack.ss_size = _INT_STACK;
        co->ctx.uc_link = &comng->main;
        ptr = (uintptr_t)comng;
        makecontext(&co->ctx, (void (*)())_comain, 2, (uint32_t)ptr, (uint32_t)(ptr >> 32));
        swapcontext(&comng->main, &co->ctx);
        break;
    case CS_Suspend:
        comng->running = id;
        co->status = CS_Running;
        // stack add is high -> low
        memcpy(comng->stack + _INT_STACK - co->size, co->stack, co->size);
        swapcontext(&comng->main, &co->ctx);
        break;
    default:
        assert(0);
    }
}

// 保存当前运行的堆栈信息
static void _save_stack(struct coroutine * co, char * top) {
    char dummy = 0;
    assert(top - &dummy <= _INT_STACK);
    if(co->cap < top - &dummy) {
        free(co->stack);
        co->cap = top - &dummy;
        co->stack = malloc(co->cap);
        assert(co->stack);
    }
    co->size = top - &dummy;
    memcpy(co->stack, &dummy, co->size);
}

/*
 * 中断当前运行的的纤程, 并将CPU交给主纤程处理调度.
 * comng    : 纤程管理器对象
 */
inline void 
co_yield(comng_t comng) {
    struct coroutine * co;
    int id = comng->running;
    assert(id >= 0);
    co = comng->co[id];
    assert((char *)&co > comng->stack);
    _save_stack(co, comng->stack + _INT_STACK);
    co->status = CS_Suspend;
    comng->running = -1;
    swapcontext(&co->ctx, &comng->main);
}

/*
 * 得到当前纤程运行的状态
 * comng    : 纤程管理器对象
 * id       : co_create 创建的纤程对象
 *          : 返回状态具体参照 costatus_e
 */
inline costatus_e 
co_status(comng_t comng, int id) {
    assert(comng && id >=0 && id < comng->cap);
    return comng->co[id] ? comng->co[id]->status : CS_Dead;
}

/*
 * 得到当前纤程系统中运行的纤程, 返回 < 0表示没有纤程在运行
 * comng    : 纤程管理器对象
 *          : 返回当前运行的纤程标识id,
 */
inline int 
co_running(comng_t comng) {
    return comng->running;
}