mirror of
https://github.com/cjfranko/NTP-Timeturner.git
synced 2025-11-08 10:22:02 +00:00
version3 with fractional decode and updated indication
This commit is contained in:
parent
2e8bc9ac5e
commit
a91dd3b91e
1 changed files with 224 additions and 0 deletions
224
firmware/ltc_audiohat_lock_v3.ino
Normal file
224
firmware/ltc_audiohat_lock_v3.ino
Normal file
|
|
@ -0,0 +1,224 @@
|
||||||
|
/* Linear Timecode for Audio Library for Teensy 3.x / 4.x
|
||||||
|
Copyright (c) 2019, Frank Bösing, f.boesing (at) gmx.de
|
||||||
|
|
||||||
|
Development of this audio library was funded by PJRC.COM, LLC by sales of
|
||||||
|
Teensy and Audio Adaptor boards. Please support PJRC's efforts to develop
|
||||||
|
open source software by purchasing Teensy or other PJRC products.
|
||||||
|
|
||||||
|
Permission is hereby granted, free of charge, to any person obtaining a copy
|
||||||
|
of this software and associated documentation files (the "Software"), to deal
|
||||||
|
in the Software without restriction, including without limitation the rights
|
||||||
|
to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
||||||
|
copies of the Software, and to permit persons to whom the Software is
|
||||||
|
furnished to do so, subject to the following conditions:
|
||||||
|
|
||||||
|
The above copyright notice, development funding notice, and this permission
|
||||||
|
notice shall be included in all copies or substantial portions of the Software.
|
||||||
|
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||||||
|
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
||||||
|
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
||||||
|
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
||||||
|
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||||||
|
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
||||||
|
THE SOFTWARE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/*
|
||||||
|
|
||||||
|
https://forum.pjrc.com/threads/41584-Audio-Library-for-Linear-Timecode-(LTC)
|
||||||
|
|
||||||
|
LTC example audio at: https://www.youtube.com/watch?v=uzje8fDyrgg
|
||||||
|
|
||||||
|
Forked by Chris Frankland-Wright 2025 for Teensy Audio Shield Input with autodetect FPS for the Fetch | Haichi
|
||||||
|
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <Arduino.h>
|
||||||
|
#include <Audio.h>
|
||||||
|
#include "analyze_ltc.h"
|
||||||
|
|
||||||
|
// —— Configuration ——
|
||||||
|
const float FORCE_FPS = 0.0f; // 0 → auto‑detect
|
||||||
|
const int FRAME_OFFSET = 4; // compensation in frames
|
||||||
|
const unsigned long LOSS_TIMEOUT = 1000UL; // ms before we go into LOST
|
||||||
|
// BLINK_PERIOD is now the half-period (on or off time)
|
||||||
|
const unsigned long BLINK_PERIOD[3] = {100, 500, 100}; // ACTIVE, LOST, NO_LTC (base)
|
||||||
|
|
||||||
|
AudioInputI2S i2s1;
|
||||||
|
AudioAnalyzeLTC ltc1;
|
||||||
|
AudioControlSGTL5000 sgtl5000;
|
||||||
|
AudioConnection patchCord(i2s1, 0, ltc1, 0);
|
||||||
|
|
||||||
|
enum State { NO_LTC=0, LTC_ACTIVE, LTC_LOST };
|
||||||
|
State ltcState = NO_LTC;
|
||||||
|
bool ledOn = false;
|
||||||
|
unsigned long lastDecode = 0;
|
||||||
|
unsigned long lastBlink = 0;
|
||||||
|
// Variables for NO_LTC double-blink pattern
|
||||||
|
int noLtcBlinkCount = 0;
|
||||||
|
unsigned long noLtcPauseTime = 600;
|
||||||
|
|
||||||
|
// FPS detection
|
||||||
|
float currentFps = 25.0f;
|
||||||
|
float periodMs = 0;
|
||||||
|
const float SMOOTH_ALPHA = 0.1f;
|
||||||
|
unsigned long lastDetectTs = 0;
|
||||||
|
|
||||||
|
// free‑run
|
||||||
|
long freeAbsFrame = 0;
|
||||||
|
unsigned long lastFreeRun = 0;
|
||||||
|
|
||||||
|
void setup() {
|
||||||
|
Serial.begin(115200);
|
||||||
|
AudioMemory(12);
|
||||||
|
sgtl5000.enable();
|
||||||
|
sgtl5000.inputSelect(AUDIO_INPUT_LINEIN);
|
||||||
|
pinMode(LED_BUILTIN, OUTPUT);
|
||||||
|
}
|
||||||
|
|
||||||
|
void loop() {
|
||||||
|
unsigned long now = millis();
|
||||||
|
// compute framePeriod from currentFps
|
||||||
|
unsigned long framePeriod = (unsigned long)(1000.0f / currentFps + 0.5f);
|
||||||
|
|
||||||
|
// 1) If in ACTIVE and we've gone > LOSS_TIMEOUT w/o decode, enter LOST
|
||||||
|
if (ltcState == LTC_ACTIVE && (now - lastDecode) >= LOSS_TIMEOUT) {
|
||||||
|
ltcState = LTC_LOST;
|
||||||
|
// bump freeAbsFrame by 1 second worth of frames:
|
||||||
|
int nominal = (currentFps>29.5f) ? 30 : int(currentFps+0.5f);
|
||||||
|
long dayFrames= 24L*3600L*nominal;
|
||||||
|
freeAbsFrame = (freeAbsFrame + nominal) % dayFrames;
|
||||||
|
// reset free‑run timer so we start next tick fresh
|
||||||
|
lastFreeRun = now;
|
||||||
|
}
|
||||||
|
|
||||||
|
// 2) Handle incoming LTC frame
|
||||||
|
if (ltc1.available()) {
|
||||||
|
ltcframe_t frame = ltc1.read();
|
||||||
|
int h = ltc1.hour(&frame),
|
||||||
|
m = ltc1.minute(&frame),
|
||||||
|
s = ltc1.second(&frame),
|
||||||
|
f = ltc1.frame(&frame);
|
||||||
|
bool isDF = ltc1.bit10(&frame);
|
||||||
|
|
||||||
|
// — FPS detect or force —
|
||||||
|
if (FORCE_FPS > 0.0f) {
|
||||||
|
currentFps = FORCE_FPS;
|
||||||
|
} else {
|
||||||
|
if (isDF) {
|
||||||
|
// Drop-frame flag is only used for 29.97fps.
|
||||||
|
currentFps = 29.97f;
|
||||||
|
} else {
|
||||||
|
if (lastDetectTs) {
|
||||||
|
float dt = now - lastDetectTs;
|
||||||
|
// Use an IIR filter to smooth the measured period
|
||||||
|
periodMs = (periodMs == 0) ? dt : (SMOOTH_ALPHA * dt + (1.0f - SMOOTH_ALPHA) * periodMs);
|
||||||
|
float measFps = 1000.0f / periodMs;
|
||||||
|
|
||||||
|
// More comprehensive list of standard frame rates
|
||||||
|
const float choices[] = {23.98f, 24.0f, 25.0f, 29.97f, 30.0f};
|
||||||
|
float bestFit = 25.0f;
|
||||||
|
float minDiff = 1e6;
|
||||||
|
|
||||||
|
for (auto rate : choices) {
|
||||||
|
float diff = fabsf(measFps - rate);
|
||||||
|
if (diff < minDiff) {
|
||||||
|
minDiff = diff;
|
||||||
|
bestFit = rate;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
// Refine detection for near-integer rates
|
||||||
|
if (fabsf(bestFit - 24.0f) < 0.01f) { // Is it 23.98 or 24?
|
||||||
|
// 23.98 is 0.083% slower than 24. Threshold is ~halfway.
|
||||||
|
currentFps = (measFps < 23.99f) ? 23.98f : 24.0f;
|
||||||
|
} else if (fabsf(bestFit - 30.0f) < 0.01f) { // Is it 29.97 or 30?
|
||||||
|
// 29.97 is 0.1% slower than 30. Threshold is ~halfway.
|
||||||
|
// We already handled DF case, this is for NDF 29.97 vs 30.
|
||||||
|
currentFps = (measFps < 29.985f) ? 29.97f : 30.0f;
|
||||||
|
} else {
|
||||||
|
currentFps = bestFit; // For 25fps or other rates
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
lastDetectTs = now;
|
||||||
|
}
|
||||||
|
|
||||||
|
// — pack + offset + wrap —
|
||||||
|
int nominal = (currentFps>29.5f) ? 30 : int(currentFps+0.5f);
|
||||||
|
long dayFrames = 24L*3600L*nominal;
|
||||||
|
long absF = ((long)h*3600 + m*60 + s)*nominal + f + FRAME_OFFSET;
|
||||||
|
absF = (absF % dayFrames + dayFrames) % dayFrames;
|
||||||
|
|
||||||
|
// — reset anchors & state —
|
||||||
|
freeAbsFrame = absF;
|
||||||
|
lastFreeRun = now;
|
||||||
|
lastDecode = now;
|
||||||
|
ltcState = LTC_ACTIVE;
|
||||||
|
|
||||||
|
// — print LOCK —
|
||||||
|
long totSec = absF/nominal;
|
||||||
|
int outF = absF % nominal;
|
||||||
|
int outS = totSec % 60;
|
||||||
|
long totMin = totSec/60;
|
||||||
|
int outM = totMin % 60;
|
||||||
|
int outH = (totMin/60) % 24;
|
||||||
|
char sep = isDF?';':':';
|
||||||
|
Serial.printf("[LOCK] %02d:%02d:%02d%c%02d | %.2ffps\r\n",
|
||||||
|
outH,outM,outS,sep,outF,currentFps);
|
||||||
|
|
||||||
|
// — LED → ACTIVE immediately —
|
||||||
|
lastBlink = now;
|
||||||
|
ledOn = true;
|
||||||
|
digitalWrite(LED_BUILTIN, HIGH);
|
||||||
|
noLtcBlinkCount = 0; // Reset pattern when LTC becomes active
|
||||||
|
}
|
||||||
|
// 3) If in LOST, do free‑run printing
|
||||||
|
else if (ltcState == LTC_LOST) {
|
||||||
|
if ((now - lastFreeRun) >= framePeriod) {
|
||||||
|
freeAbsFrame = (freeAbsFrame + 1) % (24L*3600L*((int)(currentFps+0.5f)));
|
||||||
|
lastFreeRun += framePeriod;
|
||||||
|
|
||||||
|
// — print FREE —
|
||||||
|
int nominal = (currentFps>29.5f) ? 30 : int(currentFps+0.5f);
|
||||||
|
long totSec = freeAbsFrame/nominal;
|
||||||
|
int outF = freeAbsFrame % nominal;
|
||||||
|
int outS = totSec % 60;
|
||||||
|
long totMin = totSec/60;
|
||||||
|
int outM = totMin % 60;
|
||||||
|
int outH = (totMin/60)%24;
|
||||||
|
Serial.printf("[FREE] %02d:%02d:%02d:%02d | %.2ffps\r\n",
|
||||||
|
outH,outM,outS,outF,currentFps);
|
||||||
|
}
|
||||||
|
noLtcBlinkCount = 0; // Reset pattern when LTC is lost
|
||||||
|
}
|
||||||
|
|
||||||
|
// 4) LED heartbeat
|
||||||
|
unsigned long now_led = millis();
|
||||||
|
if (ltcState == NO_LTC) {
|
||||||
|
unsigned long blinkInterval = BLINK_PERIOD[NO_LTC];
|
||||||
|
if (noLtcBlinkCount < 4) { // First two blinks (on-off-on-off)
|
||||||
|
if (now_led - lastBlink >= blinkInterval) {
|
||||||
|
ledOn = !ledOn;
|
||||||
|
digitalWrite(LED_BUILTIN, ledOn);
|
||||||
|
lastBlink = now_led;
|
||||||
|
noLtcBlinkCount++;
|
||||||
|
}
|
||||||
|
} else { // Pause
|
||||||
|
if (now_led - lastBlink >= noLtcPauseTime) {
|
||||||
|
noLtcBlinkCount = 0; // Reset for next double-blink
|
||||||
|
lastBlink = now_led;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
} else { // LTC_ACTIVE or LTC_LOST
|
||||||
|
// LTC_ACTIVE: 5Hz flash (100ms on/off). Period = 200ms.
|
||||||
|
// LTC_LOST: 1Hz flash (500ms on/off). Period = 1000ms.
|
||||||
|
unsigned long blinkInterval = (ltcState == LTC_ACTIVE) ? 100 : BLINK_PERIOD[LTC_LOST];
|
||||||
|
if (now_led - lastBlink >= blinkInterval) {
|
||||||
|
ledOn = !ledOn;
|
||||||
|
digitalWrite(LED_BUILTIN, ledOn);
|
||||||
|
lastBlink = now_led;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
Loading…
Add table
Add a link
Reference in a new issue