2017-03-21 09:47:32 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* machinarium.
|
2017-03-21 09:58:58 +00:00
|
|
|
*
|
2017-03-21 09:47:32 +00:00
|
|
|
* cooperative multitasking engine.
|
|
|
|
*/
|
|
|
|
|
2017-03-21 12:55:23 +00:00
|
|
|
#include <machinarium_private.h>
|
|
|
|
#include <machinarium.h>
|
2017-03-21 09:47:32 +00:00
|
|
|
|
2017-03-21 11:21:25 +00:00
|
|
|
static void
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_idle_cb(mm_idle_t *handle)
|
2017-03-21 11:21:25 +00:00
|
|
|
{
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_t *machine = handle->arg;
|
2017-03-21 11:21:25 +00:00
|
|
|
while (machine->scheduler.count_ready > 0) {
|
|
|
|
mm_fiber_t *fiber;
|
|
|
|
fiber = mm_scheduler_next_ready(&machine->scheduler);
|
|
|
|
mm_scheduler_set(fiber, MM_FIBER_ACTIVE);
|
|
|
|
mm_scheduler_call(fiber);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-03-21 09:47:32 +00:00
|
|
|
MACHINE_API machine_t
|
2017-03-21 11:48:35 +00:00
|
|
|
machine_create(void)
|
2017-03-21 11:21:25 +00:00
|
|
|
{
|
|
|
|
mm_t *machine;
|
|
|
|
machine = malloc(sizeof(*machine));
|
|
|
|
if (machine == NULL)
|
|
|
|
return NULL;
|
|
|
|
machine->online = 0;
|
|
|
|
mm_scheduler_init(&machine->scheduler, 2048 /* 16K */, machine);
|
2017-03-24 13:19:48 +00:00
|
|
|
int rc;
|
2017-04-10 15:07:14 +00:00
|
|
|
rc = mm_loop_init(&machine->loop);
|
2017-03-21 11:21:25 +00:00
|
|
|
if (rc < 0)
|
|
|
|
return NULL;
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_loop_set_idle(&machine->loop, mm_idle_cb, machine);
|
2017-03-21 11:21:25 +00:00
|
|
|
return machine;
|
|
|
|
}
|
|
|
|
|
2017-03-21 09:47:32 +00:00
|
|
|
MACHINE_API int
|
2017-03-21 11:21:25 +00:00
|
|
|
machine_free(machine_t obj)
|
|
|
|
{
|
|
|
|
mm_t *machine = obj;
|
|
|
|
if (machine->online)
|
|
|
|
return -1;
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_loop_shutdown(&machine->loop);
|
2017-03-21 11:21:25 +00:00
|
|
|
mm_scheduler_free(&machine->scheduler);
|
|
|
|
free(obj);
|
|
|
|
return 0;
|
|
|
|
}
|
2017-03-21 09:47:32 +00:00
|
|
|
|
2017-03-21 13:32:54 +00:00
|
|
|
MACHINE_API int64_t
|
2017-03-21 11:21:25 +00:00
|
|
|
machine_create_fiber(machine_t obj,
|
|
|
|
machine_fiber_function_t function,
|
|
|
|
void *arg)
|
|
|
|
{
|
|
|
|
mm_t *machine = obj;
|
|
|
|
mm_fiber_t *fiber;
|
|
|
|
fiber = mm_scheduler_new(&machine->scheduler, function, arg);
|
|
|
|
if (fiber == NULL)
|
2017-03-21 13:32:54 +00:00
|
|
|
return -1;
|
2017-03-21 11:21:25 +00:00
|
|
|
fiber->data = machine;
|
2017-03-21 13:32:54 +00:00
|
|
|
return fiber->id;
|
2017-03-21 11:21:25 +00:00
|
|
|
}
|
2017-03-21 09:47:32 +00:00
|
|
|
|
|
|
|
MACHINE_API void
|
2017-03-21 11:21:25 +00:00
|
|
|
machine_start(machine_t obj)
|
|
|
|
{
|
|
|
|
mm_t *machine = obj;
|
|
|
|
if (machine->online)
|
|
|
|
return;
|
|
|
|
machine->online = 1;
|
|
|
|
for (;;) {
|
|
|
|
if (! machine->online) {
|
|
|
|
if (! mm_scheduler_online(&machine->scheduler))
|
|
|
|
break;
|
|
|
|
}
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_loop_step(&machine->loop);
|
2017-03-21 11:21:25 +00:00
|
|
|
}
|
|
|
|
}
|
2017-03-21 09:47:32 +00:00
|
|
|
|
|
|
|
MACHINE_API void
|
2017-03-21 11:21:25 +00:00
|
|
|
machine_stop(machine_t obj)
|
|
|
|
{
|
|
|
|
mm_t *machine = obj;
|
|
|
|
machine->online = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_sleep_timer_cb(mm_timer_t *handle)
|
2017-03-21 11:21:25 +00:00
|
|
|
{
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_fiber_t *fiber = handle->arg;
|
2017-03-21 11:21:25 +00:00
|
|
|
mm_scheduler_wakeup(fiber);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void
|
|
|
|
mm_sleep_cancel_cb(void *obj, void *arg)
|
|
|
|
{
|
|
|
|
(void)arg;
|
|
|
|
mm_fiber_t *fiber = obj;
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_timer_stop(&fiber->timer);
|
2017-03-21 11:21:25 +00:00
|
|
|
mm_scheduler_wakeup(fiber);
|
|
|
|
}
|
2017-03-21 09:47:32 +00:00
|
|
|
|
|
|
|
MACHINE_API void
|
2017-03-21 11:21:25 +00:00
|
|
|
machine_sleep(machine_t obj, uint64_t time_ms)
|
|
|
|
{
|
|
|
|
mm_t *machine = obj;
|
|
|
|
mm_fiber_t *fiber;
|
|
|
|
fiber = mm_scheduler_current(&machine->scheduler);
|
|
|
|
if (mm_fiber_is_cancelled(fiber))
|
|
|
|
return;
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_timer_init(&fiber->timer, mm_sleep_timer_cb, fiber, time_ms);
|
|
|
|
mm_clock_timer_add(&machine->loop.clock, &fiber->timer);
|
2017-03-21 11:25:54 +00:00
|
|
|
mm_call_begin(&fiber->call, mm_sleep_cancel_cb, NULL);
|
2017-03-21 11:21:25 +00:00
|
|
|
mm_scheduler_yield(&machine->scheduler);
|
2017-03-21 11:25:54 +00:00
|
|
|
mm_call_end(&fiber->call);
|
2017-03-21 11:21:25 +00:00
|
|
|
}
|
2017-03-21 09:47:32 +00:00
|
|
|
|
2017-03-21 13:32:54 +00:00
|
|
|
MACHINE_API int
|
|
|
|
machine_wait(machine_t obj, uint64_t id)
|
2017-03-21 11:21:25 +00:00
|
|
|
{
|
2017-03-21 13:32:54 +00:00
|
|
|
mm_t *machine = obj;
|
|
|
|
mm_fiber_t *fiber = mm_scheduler_find(&machine->scheduler, id);
|
|
|
|
if (fiber == NULL)
|
|
|
|
return -1;
|
2017-03-21 11:21:25 +00:00
|
|
|
mm_fiber_t *waiter = mm_scheduler_current(&machine->scheduler);
|
|
|
|
mm_scheduler_wait(fiber, waiter);
|
|
|
|
mm_scheduler_yield(&machine->scheduler);
|
2017-03-21 13:32:54 +00:00
|
|
|
return 0;
|
2017-03-21 11:21:25 +00:00
|
|
|
}
|
2017-03-21 09:47:32 +00:00
|
|
|
|
2017-03-21 13:32:54 +00:00
|
|
|
MACHINE_API int
|
|
|
|
machine_cancel(machine_t obj, uint64_t id)
|
2017-03-21 11:21:25 +00:00
|
|
|
{
|
2017-03-21 13:32:54 +00:00
|
|
|
mm_t *machine = obj;
|
|
|
|
mm_fiber_t *fiber = mm_scheduler_find(&machine->scheduler, id);
|
|
|
|
if (fiber == NULL)
|
|
|
|
return -1;
|
|
|
|
mm_fiber_cancel(fiber);
|
|
|
|
return 0;
|
2017-03-21 11:21:25 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
static void
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_condition_timer_cb(mm_timer_t *handle)
|
2017-03-21 11:21:25 +00:00
|
|
|
{
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_fiber_t *fiber = handle->arg;
|
2017-03-21 11:21:25 +00:00
|
|
|
assert(fiber->condition);
|
|
|
|
fiber->condition_status = -ETIMEDOUT;
|
|
|
|
mm_scheduler_wakeup(fiber);
|
|
|
|
}
|
2017-04-10 15:07:14 +00:00
|
|
|
|
2017-03-21 11:21:25 +00:00
|
|
|
static inline void
|
|
|
|
mm_condition_cancel_cb(void *obj, void *arg)
|
|
|
|
{
|
|
|
|
(void)arg;
|
|
|
|
mm_fiber_t *fiber = obj;
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_timer_stop(&fiber->timer);
|
2017-03-21 11:21:25 +00:00
|
|
|
assert(fiber->condition);
|
|
|
|
fiber->condition_status = -ECANCELED;
|
|
|
|
mm_scheduler_wakeup(fiber);
|
|
|
|
}
|
2017-03-21 09:47:32 +00:00
|
|
|
|
|
|
|
MACHINE_API int
|
2017-03-21 11:21:25 +00:00
|
|
|
machine_condition(machine_t obj, uint64_t time_ms)
|
|
|
|
{
|
|
|
|
mm_t *machine = obj;
|
|
|
|
mm_fiber_t *fiber = mm_scheduler_current(&machine->scheduler);
|
|
|
|
if (mm_fiber_is_cancelled(fiber))
|
2017-03-29 11:58:27 +00:00
|
|
|
return -1;
|
2017-03-21 11:21:25 +00:00
|
|
|
fiber->condition = 1;
|
2017-03-29 11:58:27 +00:00
|
|
|
fiber->condition_status = 0;
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_timer_init(&fiber->timer, mm_condition_timer_cb, fiber, time_ms);
|
|
|
|
mm_clock_timer_add(&machine->loop.clock, &fiber->timer);
|
2017-03-21 11:25:54 +00:00
|
|
|
mm_call_begin(&fiber->call, mm_condition_cancel_cb, NULL);
|
2017-03-21 11:21:25 +00:00
|
|
|
mm_scheduler_yield(&machine->scheduler);
|
2017-03-21 11:25:54 +00:00
|
|
|
mm_call_end(&fiber->call);
|
2017-03-21 11:21:25 +00:00
|
|
|
fiber->condition = 0;
|
2017-03-29 11:58:27 +00:00
|
|
|
if (fiber->condition_status < 0)
|
|
|
|
return -1;
|
|
|
|
return 0;
|
2017-03-21 11:21:25 +00:00
|
|
|
}
|
2017-03-21 09:47:32 +00:00
|
|
|
|
|
|
|
MACHINE_API int
|
2017-03-21 13:32:54 +00:00
|
|
|
machine_signal(machine_t obj, uint64_t id)
|
2017-03-21 11:21:25 +00:00
|
|
|
{
|
2017-03-21 13:32:54 +00:00
|
|
|
mm_t *machine = obj;
|
|
|
|
mm_fiber_t *fiber = mm_scheduler_find(&machine->scheduler, id);
|
|
|
|
if (fiber == NULL)
|
|
|
|
return -1;
|
2017-03-21 11:21:25 +00:00
|
|
|
if (! fiber->condition)
|
|
|
|
return -1;
|
2017-04-10 15:07:14 +00:00
|
|
|
mm_timer_stop(&fiber->timer);
|
2017-03-21 11:21:25 +00:00
|
|
|
fiber->condition_status = 0;
|
|
|
|
mm_scheduler_wakeup(fiber);
|
|
|
|
return 0;
|
|
|
|
}
|
2017-03-21 09:47:32 +00:00
|
|
|
|
|
|
|
MACHINE_API int
|
2017-03-21 11:48:35 +00:00
|
|
|
machine_active(machine_t obj)
|
2017-03-21 11:21:25 +00:00
|
|
|
{
|
|
|
|
mm_t *machine = obj;
|
|
|
|
return machine->online;
|
|
|
|
}
|
2017-03-21 09:47:32 +00:00
|
|
|
|
|
|
|
MACHINE_API int
|
2017-03-21 11:48:35 +00:00
|
|
|
machine_cancelled(machine_t obj)
|
2017-03-21 11:21:25 +00:00
|
|
|
{
|
|
|
|
mm_t *machine = obj;
|
|
|
|
mm_fiber_t *fiber;
|
|
|
|
fiber = mm_scheduler_current(&machine->scheduler);
|
|
|
|
if (fiber == NULL)
|
|
|
|
return -1;
|
|
|
|
return fiber->cancel > 0;
|
|
|
|
}
|
2017-03-24 13:50:23 +00:00
|
|
|
|
|
|
|
MACHINE_API int
|
|
|
|
machinarium_init(void)
|
|
|
|
{
|
2017-04-10 15:07:14 +00:00
|
|
|
// XXX
|
|
|
|
// mm_tls_init();
|
2017-03-28 11:51:57 +00:00
|
|
|
return 0;
|
2017-03-24 13:50:23 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
MACHINE_API void
|
|
|
|
machinarium_free(void)
|
2017-03-24 14:53:39 +00:00
|
|
|
{ }
|