#include "simulator.h" #include static void record_event(struct simulator *sim, char operation, int pin, int raw, int result) { struct sim_event *event = &sim->events[sim->event_count++]; event->operation = operation; event->pin = pin; event->raw = raw; event->result = result; } void sim_init(struct simulator *sim) { memset(sim, 0, sizeof(*sim)); } void sim_frame(struct simulator *sim, int request, int direction, int write) { sim->event_count = 0; sim->fail_request = request; sim->fail_direction = direction; sim->fail_write = write; sim->request_count = 0; sim->direction_count = 0; sim->write_count = 0; } void sim_external(struct simulator *sim, int pin, int raw) { sim->pins[pin].owner = 2; sim->pins[pin].direction = 1; sim->pins[pin].raw = raw; } static int sim_request(void *context, int pin) { struct simulator *sim = context; int result = 0; ++sim->request_count; if (sim->request_count == sim->fail_request) result = -1; if (pin < 0 || pin >= LB_PIN_COUNT) result = -1; if (result == 0 && sim->pins[pin].owner != 0) result = -1; if (result == 0) { sim->pins[pin].owner = 1; sim->pins[pin].direction = 0; sim->pins[pin].raw = 0; } record_event(sim, 'R', pin, -1, result); return result; } static int sim_direction(void *context, int pin, int raw) { struct simulator *sim = context; int result = 0; ++sim->direction_count; if (sim->direction_count == sim->fail_direction) result = -1; if (pin < 0 || pin >= LB_PIN_COUNT || (raw != 0 && raw != 1)) result = -1; if (result == 0 && sim->pins[pin].owner != 1) result = -1; if (result == 0) { sim->pins[pin].direction = 1; sim->pins[pin].raw = raw; } record_event(sim, 'D', pin, raw, result); return result; } static int sim_write(void *context, int pin, int raw) { struct simulator *sim = context; int result = 0; ++sim->write_count; if (sim->write_count == sim->fail_write) result = -1; if (pin < 0 || pin >= LB_PIN_COUNT || (raw != 0 && raw != 1)) result = -1; if (result == 0 && (sim->pins[pin].owner != 1 || !sim->pins[pin].direction)) result = -1; if (result == 0) sim->pins[pin].raw = raw; record_event(sim, 'W', pin, raw, result); return result; } static void sim_release(void *context, int pin) { struct simulator *sim = context; int result = -1; if (pin >= 0 && pin < LB_PIN_COUNT && sim->pins[pin].owner == 1) { memset(&sim->pins[pin], 0, sizeof(sim->pins[pin])); result = 0; } record_event(sim, 'X', pin, -1, result); } struct lb_bus sim_bus(struct simulator *sim) { static const struct lb_ops operations = { sim_request, sim_direction, sim_write, sim_release }; struct lb_bus bus; bus.ops = &operations; bus.context = sim; return bus; }