use crate::utils::haversine::{angular_difference, bearing_deg, haversine_km};
pub fn angle_change_segment_ids(
lats: &[f64],
lngs: &[f64],
times: &[f64],
min_angle_deg: f64,
min_speed_kmh: f64,
) -> Vec<u32> {
let n = lats.len();
let mut out = vec![0u32; n];
if n == 0 {
return out;
}
let mut comp_dir = if n >= 2 {
bearing_deg(lats[0], lngs[0], lats[1], lngs[1])
} else {
0.0
};
let mut group = 0u32;
for i in 1..n {
let dt = times[i] - times[i - 1];
let dist_km = haversine_km(lats[i - 1], lngs[i - 1], lats[i], lngs[i]);
let speed_kmh = if dt > 0.0 { dist_km / dt * 3600.0 } else { 0.0 };
if speed_kmh >= min_speed_kmh {
let direction = bearing_deg(lats[i - 1], lngs[i - 1], lats[i], lngs[i]);
if angular_difference(comp_dir, direction) >= min_angle_deg {
comp_dir = direction;
group += 1;
}
}
out[i] = group;
}
out
}
#[cfg(test)]
mod tests {
use super::*;
fn times_seq(n: usize) -> Vec<f64> {
(0..n).map(|i| i as f64 * 60.0).collect()
}
#[test]
fn empty_and_single_point_inputs() {
assert_eq!(
angle_change_segment_ids(&[], &[], &[], 45.0, 0.0),
Vec::<u32>::new()
);
assert_eq!(
angle_change_segment_ids(&[0.0], &[0.0], &[0.0], 45.0, 0.0),
vec![0]
);
}
#[test]
fn straight_line_never_splits() {
let lats: Vec<f64> = (0..5).map(|i| 48.0 + i as f64 * 0.01).collect();
let lngs = vec![2.0; 5];
let times = times_seq(5);
let ids = angle_change_segment_ids(&lats, &lngs, ×, 45.0, 0.0);
assert_eq!(ids, vec![0, 0, 0, 0, 0]);
}
#[test]
fn a_ninety_degree_turn_splits_at_the_turn_point() {
let lats = vec![48.0, 48.01, 48.01];
let lngs = vec![2.0, 2.0, 2.02];
let times = times_seq(3);
let ids = angle_change_segment_ids(&lats, &lngs, ×, 45.0, 0.0);
assert_eq!(
ids,
vec![0, 0, 1],
"the turn is registered at the point it lands on"
);
}
#[test]
fn below_min_speed_never_splits() {
let lats = vec![48.0, 48.01, 48.01];
let lngs = vec![2.0, 2.0, 2.02];
let times = times_seq(3);
let ids = angle_change_segment_ids(&lats, &lngs, ×, 45.0, 1_000_000.0);
assert_eq!(ids, vec![0, 0, 0]);
}
}