106 lines
1.6 KiB
C
106 lines
1.6 KiB
C
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <stdarg.h>
|
|
|
|
#include "simulation.h"
|
|
|
|
uint8_t ACSR;
|
|
uint8_t TIMSK1;
|
|
|
|
|
|
/* -- debugging ------------------------------------------------------------ */
|
|
|
|
void sim_info(const char fmt[], ...)
|
|
{
|
|
va_list ap;
|
|
fputs("\033[0;32m" , stdout);
|
|
va_start(ap, fmt);
|
|
vprintf(fmt, ap);
|
|
va_end(ap);
|
|
fputs("\033[m\n", stdout);
|
|
}
|
|
|
|
void sim_error(const char msg[])
|
|
{
|
|
printf("\033[0;31mERROR: %s\033[m\n", msg);
|
|
exit(-1);
|
|
}
|
|
|
|
void sim_assert(bool cond, const char msg[])
|
|
{
|
|
if (!cond)
|
|
{
|
|
sim_error(msg);
|
|
}
|
|
}
|
|
|
|
|
|
/* -- interrupts ----------------------------------------------------------- */
|
|
|
|
volatile bool sim_interrupts = false;
|
|
void sei(void)
|
|
{
|
|
sim_interrupts = true;
|
|
}
|
|
|
|
|
|
/* -- PIN I/O ------------------------------------------------------------ */
|
|
|
|
#define out true
|
|
#define in false
|
|
|
|
static int x = 0, y = 0, z = 0, e = 0;
|
|
|
|
static bool direction[PIN_NB];
|
|
static bool state[PIN_NB];
|
|
|
|
static void print_pos(void)
|
|
{
|
|
sim_info("x:%5d y:%5d z:%5d e:%5d", x, y, z, e);
|
|
}
|
|
|
|
void WRITE(pin_t pin, bool s)
|
|
{
|
|
bool old_state = state[pin];
|
|
|
|
if (direction[pin] == out)
|
|
{
|
|
state[pin] = s;
|
|
}
|
|
if (s && !old_state) /* rising edge */
|
|
{
|
|
switch (pin)
|
|
{
|
|
case X_STEP_PIN:
|
|
x += state[X_DIR_PIN] ? 1 : -1;
|
|
print_pos();
|
|
break;
|
|
case Y_STEP_PIN:
|
|
y += state[Y_DIR_PIN] ? 1 : -1;
|
|
print_pos();
|
|
break;
|
|
case Z_STEP_PIN:
|
|
z += state[Z_DIR_PIN] ? 1 : -1;
|
|
print_pos();
|
|
break;
|
|
case E_STEP_PIN:
|
|
e += state[E_DIR_PIN] ? 1 : -1;
|
|
print_pos();
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
void SET_OUTPUT(pin_t pin)
|
|
{
|
|
direction[pin] = out;
|
|
}
|
|
|
|
void SET_INPUT(pin_t pin)
|
|
{
|
|
direction[pin] = in;
|
|
}
|
|
|