forked from HQU-gxy/CVTH3PE
Epoch timestamps are ~1.7 × 10⁹; storing them in float32 wipes out sub‑second detail (resolution ≈ 200 ms). Keep them in float64 until after subtraction so we preserve Δt‑on‑the‑order‑of‑milliseconds. - Introduced a `_DEBUG_CURRENT_TRACKING` variable to track the current indices of tracking and detection during calculations. - Added a `_global_current_tracking_str` function to format the current tracking state for debugging purposes. - Enhanced `calculate_distance_2d` and `calculate_tracking_detection_affinity` functions with debug print statements to log intermediate values, improving traceability of calculations. - Updated `perpendicular_distance_camera_2d_points_to_tracking_raycasting` to accept `delta_t` from the caller while ensuring it adheres to a minimum threshold. - Refactored timestamp handling in `calculate_camera_affinity_matrix_jax` to maintain precision during calculations.
39 KiB
39 KiB