register uint8_t done asm("r3");
register uint8_t portval asm("r4");
register uint8_t rxidx asm("r5");
+#define BYPASS_ENABLE 14
+#define BYPASS_DISABLE 15
/*
* SPI protocol:
val += byte1.val_lsb;
servo_table[byte0.cmd_num].command = val;
}
- else if (byte0.cmd_num == 14) {
+ else if (byte0.cmd_num == BYPASS_ENABLE) {
bypass = 1;
}
- else if (byte0.cmd_num == 15) {
+ else if (byte0.cmd_num == BYPASS_DISABLE) {
bypass = 0;
}
}
sei();
+ bypass = 0;
while (1) {
t = TCNT0;
for (i = 0; i < NB_SERVO; i++) {