25#define LOG_TRACE(refinement, ...) U_LOG_IFL_T(refinement->log_level, __VA_ARGS__)
26#define LOG_DEBUG(refinement, ...) U_LOG_IFL_D(refinement->log_level, __VA_ARGS__)
27#define LOG_INFO(refinement, ...) U_LOG_IFL_I(refinement->log_level, __VA_ARGS__)
28#define LOG_WARN(refinement, ...) U_LOG_IFL_W(refinement->log_level, __VA_ARGS__)
29#define LOG_ERROR(refinement, ...) U_LOG_IFL_E(refinement->log_level, __VA_ARGS__)
32#define MAX_SAMPLE_LATENCY 3
46 default:
return false;
54 if (refinement->period_estimate.
period_ns > 0.0) {
55 return refinement->period_estimate.
period_ns;
65 return refinement->optical_driven_offset.saved_offset + clock_offset_ns +
100 .timestamp.device_host_latency_ns = clock_offset_ns,
102 .fudge_offset_ns = fudge_offset_ns,
103 .blink_duration_ns = blink_duration_ns,
104 .pssense = pssense_data,
105 .pssense_mode = pssense_mode,
110 refinement->optical_driven_offset.has_saved_offset) {
129 LOG_TRACE(refinement,
130 "Setting offset to %" PRId64
"ns with fudge %" PRId64
"ns and blink duration to %" PRId64
"ns",
131 clock_offset_ns, fudge_offset_ns, blink_duration_ns);
143 .leds = {0xFF, 0xFF, 0xFF, 0xFF},
146 set_offset_duration_pssense(refinement,
165 set_offset_duration(refinement, new_clock_offset_ns, new_fudge_offset_ns, blink_duration_ns);
174 .base_time_offset_ns = 0,
184 memcpy(data.leds,
leds,
sizeof(data.leds));
187 set_offset_duration_pssense(refinement,
213 data.base_time_offset_ns = (int32_t)offset_ns;
215 set_offset_duration_pssense(refinement,
229 refinement->
phase = new_phase;
231 LOG_INFO(refinement,
"Transitioning from search phase %d -> %d", old_phase, new_phase);
238 refinement->optical_driven_offset.has_saved_offset =
true;
239 refinement->optical_driven_offset.saved_offset =
256 if (phase_uses_led_selection(new_phase)) {
258 refinement->leds_seen.num_samples = 0;
268 refinement->optical_driven_offset.has_saved_offset =
false;
272 memset(&refinement->delta_sync, 0,
sizeof(refinement->delta_sync));
283 refinement->binary_search_state.
right_bound_ns = max_right_edge(refinement);
285 LOG_DEBUG(refinement,
286 "Starting binary search for right edge, left bound at: %" PRId64
287 "ns, right bound at: %" PRId64
"ns",
307 LOG_DEBUG(refinement,
"Starting binary search for left edge, right edge at: %" PRId64
"ns",
329 refinement->delta_sync.anchor_ns = refinement->last_exposure_ns;
333 set_offset_duration(refinement, new_clock_offset_ns, new_fudge_offset_ns, new_blink_duration_ns);
359 sizeof(refinement->optimize_brightness_curve.
leds));
362 sizeof(refinement->optimize_brightness_curve.
leds));
363 bg->has_led_error =
false;
365 bg->sum_t = bg->sum_tt = bg->sum_d = bg->sum_td = 0.0;
373 LOG_INFO(refinement,
"BG base period %.1fns (estimate %.1fns, per-frame interval %" PRId64
"ns)",
377 set_offset_duration_pssense(refinement,
380 new_blink_duration_ns,
400 .leds = {0xFF, 0xFF, 0xFF, 0xFF},
403 LOG_INFO(refinement,
"Entering STABLE, skew %f ppm, last offset %" PRId64
"ns",
404 refinement->delta_sync.
skew * 1e6, residual_ns);
406 set_offset_duration_pssense(refinement,
409 new_blink_duration_ns,
416 refinement->blink_time_refinement_state.
backing_off =
false;
static int64_t os_monotonic_get_ns(void)
Return a monotonic clock in nanoseconds.
Definition os_time.h:317
int64_t time_duration_ns
Integer duration type in nanoseconds.
Definition u_time.h:88
static time_duration_ns model_clock_offset_ns(struct t_led_sync_refinement *refinement, time_duration_ns clock_offset_ns)
The host->device offset to publish, corrected by the LEDs' offset from the exposure so it follows the...
Definition led_sync_internal.h:63
static double frame_period_ns(struct t_led_sync_refinement *refinement)
The best frame period estimate, falling back to the per-frame interval until there is a long-run one.
Definition led_sync_internal.h:52
Wrapper around OS native time functions.
Clock sync from BROAD on: the LED cycle, the clock model kept on it, and BG's offset servo and skew f...
Definition t_led_sync_refinement.h:210
uint32_t num_windows
Skew windows fitted since BG was entered.
Definition t_led_sync_refinement.h:233
timepoint_ns converged_since_ns
When the fitted rate last started staying under the STABLE gate, 0 if it isn't.
Definition t_led_sync_refinement.h:235
bool trim_pending
The skew changed and the new cycle still has to be sent.
Definition t_led_sync_refinement.h:228
timepoint_ns epoch_ns
Host time the published offset is valid at, the skew extrapolates from here.
Definition t_led_sync_refinement.h:216
uint32_t num_samples
Least-squares window of the phase deviation against time.
Definition t_led_sync_refinement.h:242
uint64_t anchor_sequence_id
The camera frame the clock model last matched the LED cycle at, its drift is measured from here.
Definition t_led_sync_refinement.h:212
double base_period_ns
The frame period the LED cycle is trimmed from, set when BROAD starts and moved onto each trusted est...
Definition t_led_sync_refinement.h:226
double skew
Estimated clock skew, device vs host, in ns per ns.
Definition t_led_sync_refinement.h:218
double led_error_ns
Smoothed offset of the LEDs from the exposure, as the servo correction that would center them.
Definition t_led_sync_refinement.h:222
bool been_stable
Whether this sync has reached STABLE, BG comes back from it warm.
Definition t_led_sync_refinement.h:237
timepoint_ns stable_entry_ns
Host time STABLE was entered.
Definition t_led_sync_refinement.h:239
timepoint_ns last_measurement_ns
Host time of the last accepted measurement, for the no-data watchdog.
Definition t_led_sync_refinement.h:230
double period_ns
The last trusted estimate, 0 until there is one.
Definition t_led_sync_refinement.h:205
enum t_led_sync_refinement_flags flags
The flags to use when refining.
Definition t_led_sync_refinement.h:74
time_duration_ns initial_blink_duration_ns
How long the LEDs should be initially blinking for, in nanoseconds.
Definition t_led_sync_refinement.h:77
time_duration_ns latency_cap_ns
The maximum latency offset to use, if using a latency cap.
Definition t_led_sync_refinement.h:90
Definition t_led_sync_refinement.h:248
uint64_t last_exposure_sequence_id
The latest timing event's frame and exposure time.
Definition t_led_sync_refinement.h:274
timepoint_ns last_selection_ns
The time when we last selected the set of LEDs.
Definition t_led_sync_refinement.h:337
time_duration_ns found_left_edge_ns
The found left edge of the exposure, -1 if not found yet.
Definition t_led_sync_refinement.h:319
timepoint_ns last_accepted_gray_code_ns
The last time we had an accepted gray code (or the start of this phase).
Definition t_led_sync_refinement.h:378
time_duration_ns found_right_edge_ns
The found right edge of the exposure, -1 if not found yet.
Definition t_led_sync_refinement.h:321
time_duration_ns right_bound_ns
The current right bound of the binary search, if we're in a find edge phase.
Definition t_led_sync_refinement.h:328
bool has_sample_for_driver
Whether we have a sample ready to be sent to the driver/device.
Definition t_led_sync_refinement.h:282
time_duration_ns left_bound_ns
The current left bound of the binary search, if we're in a find edge phase.
Definition t_led_sync_refinement.h:326
bool sample_applied
Whether the sample has been applied.
Definition t_led_sync_refinement.h:286
uint64_t window_start_sequence_id
The first frame the next measurement may use.
Definition t_led_sync_refinement.h:386
bool backing_off
Whether we're currently trying to back off a lower blink duration.
Definition t_led_sync_refinement.h:399
struct t_led_sync_sample sample_for_driver
The sample to be sent to the driver/device on it's next convenience.
Definition t_led_sync_refinement.h:284
uint64_t current_sequence_id
The sequence ID of the latest timing event we processed.
Definition t_led_sync_refinement.h:313
uint8_t leds[2]
The LEDs frames were recorded for.
Definition t_led_sync_refinement.h:384
time_duration_ns last_good_blink_duration_ns
The last blink duration that didn't cause the device to become unstable.
Definition t_led_sync_refinement.h:396
time_duration_ns exposure_time_ns
The known time the frame was exposed for.
Definition t_led_sync_refinement.h:269
time_duration_ns current_blink_duration_ns
How long the LEDs blink for, each frame.
Definition t_led_sync_refinement.h:307
enum t_led_sync_phase phase
The current search phase.
Definition t_led_sync_refinement.h:293
time_duration_ns current_blink_fudge_ns
The amount of fudge between the latency offset and the actual blink start time, in nanoseconds,...
Definition t_led_sync_refinement.h:304
bool applied_gray_start
Whether or not we have applied the final cycle position or not.
Definition t_led_sync_refinement.h:353
time_duration_ns driver_host_device_clock_offset_ns
The latest estimated host->device clock offset from the driver.
Definition t_led_sync_refinement.h:405
time_duration_ns current_clock_offset_ns
The current estimated latency offset between the device and the host, in nanoseconds.
Definition t_led_sync_refinement.h:299
time_duration_ns exposure_interval_ns
The known interval between frames.
Definition t_led_sync_refinement.h:271
uint8_t decoded_gray_code
The gray code we're trying.
Definition t_led_sync_refinement.h:376
struct t_led_sync_refinement_options options
The options to use for refinement.
Definition t_led_sync_refinement.h:255
uint32_t matching_decodes
How many decodes we've had that match in a row, see GRAY_CODE_MATCHES_NEEDED.
Definition t_led_sync_refinement.h:374
Definition t_led_sync_refinement.h:121
time_duration_ns base_time_offset_ns
The base time offset to send to the controller (in nanoseconds).
Definition t_led_sync_refinement.h:123
uint8_t leds[4]
The LEDs to enable, or 0xff if we don't have a selection.
Definition t_led_sync_refinement.h:125
A sample read out from the driver, to pass to the device in question.
Definition t_led_sync_refinement.h:130
double cycle_period_ns
The LED cycle period in device ns, already trimmed for the skew. 0 lets the driver use its own estima...
Definition t_led_sync_refinement.h:148
time_duration_ns host_device_clock_offset_ns
The clock offset from the host timestamp to the device.
Definition t_led_sync_refinement.h:136
double clock_skew
Clock skew (device vs host, in ns per ns) and its host-time epoch.
Definition t_led_sync_refinement.h:144
A routine to automatically refine latency offsets of LED blink times using constellation samples.
@ T_LED_SYNC_SAMPLE_TIMESTAMP_MODE_HOST_DEVICE_CLOCK_OFFSET
Used when the LED sync refinement is fully deriving the clock offset, latency included.
Definition t_led_sync_refinement.h:99
@ T_LED_SYNC_SAMPLE_TIMESTAMP_MODE_DEVICE_HOST_LATENCY
Used when the LED sync refinement is just computing a basic latency offset.
Definition t_led_sync_refinement.h:97
t_led_sync_sample_pssense_mode
Definition t_led_sync_refinement.h:103
@ T_LED_SYNC_SAMPLE_PSSENSE_MODE_PRESCAN
"PRESCAN", used to scan for an initial offset to then refine.
Definition t_led_sync_refinement.h:105
@ T_LED_SYNC_SAMPLE_PSSENSE_MODE_BG
"BG", blink certain LEDs with a brightness curve over a set of frames, then fit a curve to that measu...
Definition t_led_sync_refinement.h:115
@ T_LED_SYNC_SAMPLE_PSSENSE_MODE_STABLE
"STABLE", all LEDs blink narrowly on the trimmed cycle, holding sync with nothing measured.
Definition t_led_sync_refinement.h:117
@ T_LED_SYNC_REFINEMENT_FLAGS_PS_SENSE
Whether the device we're syncing is specifically a PS VR2 controller ("pssense"), and so has access t...
Definition t_led_sync_refinement.h:67
@ T_LED_SYNC_REFINEMENT_FLAGS_OPTICAL_DRIVEN_OFFSET
Whether to lock in a clock offset and have it be driven entirely by the sync refinement,...
Definition t_led_sync_refinement.h:57
@ T_LED_SYNC_REFINEMENT_FLAGS_HAS_LATENCY_CAP
Whether the device has specified a maximum latency cap.
Definition t_led_sync_refinement.h:62
t_led_sync_phase
Definition t_led_sync_refinement.h:160
@ T_LED_SYNC_PHASE_MAINTAIN_OFFSET
We've found an offset and optimized the center of the LED blink to the center of the exposure.
Definition t_led_sync_refinement.h:176
@ T_LED_SYNC_PHASE_REFINE_BLINK_DURATION
We've found an offset, now we can optimize the blink duration to something that keeps it tracking.
Definition t_led_sync_refinement.h:174
@ T_LED_SYNC_PHASE_OPTIMIZE_BRIGHTNESS_CURVE
Trying to optimize the brightness curve for the correct time offset.
Definition t_led_sync_refinement.h:172
@ T_LED_SYNC_PHASE_FIND_INITIAL_OFFSET
Trying to find some offset that gets us in sync at all.
Definition t_led_sync_refinement.h:164
@ T_LED_SYNC_PHASE_FIND_LEFT_EDGE
Trying to align the falling edge of the LED blinks with the rising edge of the camera exposure.
Definition t_led_sync_refinement.h:168
@ T_LED_SYNC_PHASE_STABLE
PS Sense only, BG has converged so the LEDs hold sync on the trimmed cycle until BG checks them again...
Definition t_led_sync_refinement.h:178
@ T_LED_SYNC_PHASE_DECODE_GRAY
Trying to decode the Gray codes present in the LEDs we've selected.
Definition t_led_sync_refinement.h:170
@ T_LED_SYNC_PHASE_FIND_RIGHT_EDGE
Trying to align the rising edge of the LED blinks with the falling edge of the camera exposure.
Definition t_led_sync_refinement.h:166
Time-keeping: a clock that is steady, convertible to system time, and ideally high-resolution.
#define U_TIME_1US_IN_NS
The number of nanoseconds in a microsecond.
Definition u_time.h:61