test: play Twinkle Twinkle Little Star
This commit is contained in:
parent
adb9d5444b
commit
534850a4ff
34
main.cpp
34
main.cpp
|
@ -33,15 +33,39 @@ int main() {
|
||||||
motors[i].Init();
|
motors[i].Init();
|
||||||
}
|
}
|
||||||
|
|
||||||
// Test: play a C chord
|
// Test: play Twinkle Twinkle Little Star
|
||||||
motors[0].TickAtPitch(60); // C4
|
unsigned long note_time = 500ul * 1000ul; // 500 ms
|
||||||
motors[1].TickAtPitch(64); // E4
|
unsigned int seq_motor[4][15] = {
|
||||||
motors[2].TickAtPitch(67); // G4
|
{ 60, 60, 67, 67, 69, 69, 67, 0, 65, 65, 64, 64, 62, 62, 60 },
|
||||||
|
{ 57, 57, 64, 64, 65, 65, 64, 0, 62, 62, 60, 60, 59, 59, 57},
|
||||||
|
{ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0},
|
||||||
|
{ 48, 48, 53, 53, 48, 48, 0, 0, 53, 53, 48, 48, 55, 55, 48},
|
||||||
|
};
|
||||||
|
unsigned long last_note_ts = 0;
|
||||||
|
int cur_note = -1;
|
||||||
|
|
||||||
while (true) {
|
while (true) {
|
||||||
unsigned long cur_micros = micros();
|
unsigned long cur_micros = micros();
|
||||||
|
|
||||||
handle_tick(cur_micros);
|
handle_tick(cur_micros);
|
||||||
|
|
||||||
|
if (cur_micros - last_note_ts >= note_time) {
|
||||||
|
last_note_ts = cur_micros;
|
||||||
|
cur_note += 1;
|
||||||
|
|
||||||
|
for (int i = 0; i < 4; i++) {
|
||||||
|
if (seq_motor[i][cur_note] != 0) {
|
||||||
|
motors[i].TickAtPitch(seq_motor[i][cur_note]);
|
||||||
|
} else {
|
||||||
|
motors[i].TickOff();
|
||||||
|
}
|
||||||
|
|
||||||
|
// Prevent out of bounds access
|
||||||
|
if (cur_note >= 15) {
|
||||||
|
motors[i].TickOff();
|
||||||
|
while (true) {}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
Loading…
Reference in a new issue