void WRITE(pin_t pin, bool s) {
bool old_state = state[pin];
uint64_t nseconds = sim_runtime_ns();
sim_assert(pin < PIN_NB, "WRITE: Pin number out of range");
if (direction[pin] == out) {
state[pin] = s;
}
if (old_state != s) {
record_pin(TRACE_PINS + pin, s, nseconds);
#ifdef TRACE_ALL_PINS
fgreen();
for (int i = 0; i < PIN_NB; i++) {
if (state[i]) bred(); else bblack();
fputc('A' + i, stdout);
}
fbreset();
printf("\n");
#else
bred();
if (s)
sim_tick('A' + pin);
else
sim_tick('a' + pin);
fbreset();
#endif
}
if (s && !old_state) { /* rising edge */
int axis = AXIS_NONE;
int dir;
switch (pin) {
case X_STEP_PIN:
dir = state[X_DIR_PIN] ? 1 : -1;
axis = X_AXIS;
break;
case Y_STEP_PIN:
dir = state[Y_DIR_PIN] ? 1 : -1;
axis = Y_AXIS;
break;
case Z_STEP_PIN:
dir = state[Z_DIR_PIN] ? 1 : -1;
axis = Z_AXIS;
break;
case E_STEP_PIN:
dir = state[E_DIR_PIN] ? 1 : -1;
axis = E_AXIS;
break;
default:
break;
}
if ( axis != AXIS_NONE ) {
pos[axis] += dir;
record_pin(TRACE_POS + axis, pos[axis], nseconds);
print_pos();
}
}
}
void _WRITE(pin_t pin, bool s) {
bool old_state = state[pin];
uint64_t nseconds = sim_runtime_ns();
sim_assert(pin < PIN_NB, "WRITE: Pin number out of range");
if (direction[pin] == out) {
state[pin] = s;
}
if (old_state != s) {
record_pin(TRACE_PINS + pin, s, nseconds);
#ifdef TRACE_ALL_PINS
fgreen();
for (int i = 0; i < PIN_NB; i++) {
if (state[i]) bred(); else bblack();
fputc('A' + i, stdout);
}
fbreset();
printf("\n");
#else
bred();
if (s)
sim_tick('A' + pin);
else
sim_tick('a' + pin);
fbreset();
#endif
}
if (s && !old_state) { /* rising edge */
int axis = AXIS_NONE;
int dir;
switch (pin) {
case X_STEP_PIN:
dir = state[X_DIR_PIN] ? 1 : -1;
#ifdef X_INVERT_DIR
dir = -dir;
#endif
axis = X_AXIS;
break;
case Y_STEP_PIN:
dir = state[Y_DIR_PIN] ? 1 : -1;
#ifdef Y_INVERT_DIR
dir = -dir;
#endif
axis = Y_AXIS;
break;
case Z_STEP_PIN:
dir = state[Z_DIR_PIN] ? 1 : -1;
#ifdef Z_INVERT_DIR
dir = -dir;
#endif
axis = Z_AXIS;
break;
case E_STEP_PIN:
dir = state[E_DIR_PIN] ? 1 : -1;
#ifdef E_INVERT_DIR
dir = -dir;
#endif
axis = E_AXIS;
break;
default:
break;
}
switch ( axis ) {
#ifdef KINEMATICS_COREXY
case X_AXIS:
pos[X_AXIS] += dir;
pos[Y_AXIS] += dir;
break;
case Y_AXIS:
pos[X_AXIS] += dir;
pos[Y_AXIS] -= dir;
break;
#endif
case Z_AXIS:
case E_AXIS:
default:
pos[axis] += 2 * dir;
break;
case AXIS_NONE:
break;
}
if ( axis != AXIS_NONE ) {
for (int a = X_AXIS; a <= E_AXIS; a++)
record_pin(TRACE_POS + axis, pos[axis] / 2, nseconds);
static uint64_t prev_ns = -1;
if (prev_ns != nseconds)
print_pos();
prev_ns = nseconds;
for (int a = X_AXIS; a < E_AXIS; a++)
sim_endstop(a);
}
}
}
