add version string
This commit is contained in:
6
main.c
6
main.c
@@ -36,6 +36,8 @@
|
|||||||
#define REGISTER_SERVOB_KDC 26
|
#define REGISTER_SERVOB_KDC 26
|
||||||
#define REGISTER_SERVOB_KDD 27
|
#define REGISTER_SERVOB_KDD 27
|
||||||
|
|
||||||
|
const char version[] = "ServoMotor";
|
||||||
|
|
||||||
// Motor Pins
|
// Motor Pins
|
||||||
#define MOTOR_A_POT 2
|
#define MOTOR_A_POT 2
|
||||||
#define MOTOR_A_PIN_A PD5
|
#define MOTOR_A_PIN_A PD5
|
||||||
@@ -390,6 +392,8 @@ ISR(TWI_vect) {
|
|||||||
default:
|
default:
|
||||||
if (reg_pointer < REGISTER_COUNT) {
|
if (reg_pointer < REGISTER_COUNT) {
|
||||||
data_to_send = registers[reg_pointer];
|
data_to_send = registers[reg_pointer];
|
||||||
|
} else {
|
||||||
|
data_to_send = version[reg_pointer % sizeof(version)];
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
@@ -533,7 +537,7 @@ int main(void) {
|
|||||||
|
|
||||||
// Heartbeat LED - toggle every ~0.5 seconds
|
// Heartbeat LED - toggle every ~0.5 seconds
|
||||||
heartbeat_counter++;
|
heartbeat_counter++;
|
||||||
if (heartbeat_counter >= 10000) {
|
if (heartbeat_counter >= 500) {
|
||||||
PORTA ^= (1 << PA7);
|
PORTA ^= (1 << PA7);
|
||||||
heartbeat_counter = 0;
|
heartbeat_counter = 0;
|
||||||
}
|
}
|
||||||
|
Reference in New Issue
Block a user