fn vertex_distance(v1: &[f64; 3], v2: &[f64; 3]) -> f64
Compute distance between two vertices (already in mm)