diff --git a/main.c b/main.c index a5dbf5d..b2ab7bd 100644 --- a/main.c +++ b/main.c @@ -36,6 +36,8 @@ #define REGISTER_SERVOB_KDC 26 #define REGISTER_SERVOB_KDD 27 +const char version[] = "ServoMotor"; + // Motor Pins #define MOTOR_A_POT 2 #define MOTOR_A_PIN_A PD5 @@ -390,6 +392,8 @@ ISR(TWI_vect) { default: if (reg_pointer < REGISTER_COUNT) { data_to_send = registers[reg_pointer]; + } else { + data_to_send = version[reg_pointer % sizeof(version)]; } break; } @@ -533,7 +537,7 @@ int main(void) { // Heartbeat LED - toggle every ~0.5 seconds heartbeat_counter++; - if (heartbeat_counter >= 10000) { + if (heartbeat_counter >= 500) { PORTA ^= (1 << PA7); heartbeat_counter = 0; }