1use crate::tag::{Tag, TagGroup, TagId};
8use crate::value::Value;
9
10const KNOTS_TO_KPH: f64 = 1.852;
12const MPS_TO_KPH: f64 = 3.6;
13const MPH_TO_KPH: f64 = 1.60934;
14
15#[derive(Debug, Clone, Default)]
19pub struct TrackInfo {
20 pub handler_type: [u8; 4],
22 pub meta_format: Option<String>,
24 pub media_timescale: u32,
26 pub stco: Vec<u64>,
28 pub stsc: Vec<(u32, u32, u32)>,
30 pub stsz: Vec<u32>,
32 pub stts: Vec<(u32, u32)>,
34}
35
36#[derive(Debug, Clone, Default)]
38pub struct StreamState {
39 pub tracks: Vec<TrackInfo>,
40 pub current: TrackInfo,
42 pub in_stbl: bool,
44}
45
46pub fn extract_stream_tags(data: &[u8], tracks: &[TrackInfo], _extract_embedded: u8) -> Vec<Tag> {
51 let mut tags = Vec::new();
52 let mut doc_count: u32 = 0;
53
54 for track in tracks {
55 let handler = &track.handler_type;
56 if handler == b"soun" || handler == b"vide" {
58 continue;
59 }
60
61 let samples = compute_samples(track);
63 if samples.is_empty() {
64 continue;
65 }
66
67 let meta_format = track.meta_format.as_deref().unwrap_or("");
68
69 for s in &samples {
70 if s.offset as usize + s.size as usize > data.len() || s.size == 0 {
71 continue;
72 }
73 let sample_data = &data[s.offset as usize..(s.offset as usize + s.size as usize)];
74
75 let mut sample_tags = Vec::new();
76
77 let dispatched = dispatch_sample(
79 sample_data,
80 handler,
81 meta_format,
82 s.time,
83 s.duration,
84 &mut sample_tags,
85 );
86
87 if dispatched && !sample_tags.is_empty() {
88 doc_count += 1;
89 if let Some(t) = s.time {
91 sample_tags.insert(
92 0,
93 mk_stream(
94 "SampleTime",
95 "Sample Time",
96 Value::String(format!("{:.6}", t)),
97 ),
98 );
99 }
100 if let Some(d) = s.duration {
101 sample_tags.insert(
102 1,
103 mk_stream(
104 "SampleDuration",
105 "Sample Duration",
106 Value::String(format!("{:.6}", d)),
107 ),
108 );
109 }
110 for t in &mut sample_tags {
112 t.description = format!("{} (Doc{})", t.description, doc_count);
113 }
114 tags.extend(sample_tags);
115 }
116 }
117 }
118
119 if doc_count == 0 {
121 scan_mdat_for_freegps(data, &mut tags, &mut doc_count);
122 }
123
124 tags
125}
126
127struct SampleInfo {
130 offset: u64,
131 size: u32,
132 time: Option<f64>,
133 duration: Option<f64>,
134}
135
136fn compute_samples(track: &TrackInfo) -> Vec<SampleInfo> {
137 let mut result = Vec::new();
138 if track.stsz.is_empty() || track.stco.is_empty() || track.stsc.is_empty() {
139 return result;
140 }
141
142 let ts = if track.media_timescale > 0 {
143 track.media_timescale as f64
144 } else {
145 1.0
146 };
147
148 let mut stts_flat: Vec<(u32, u32)> = Vec::new();
150 for &(count, delta) in &track.stts {
151 stts_flat.push((count, delta));
152 }
153 let mut stts_idx = 0;
154 let mut stts_remaining: u32 = if !stts_flat.is_empty() {
155 stts_flat[0].0
156 } else {
157 0
158 };
159 let mut stts_delta: u32 = if !stts_flat.is_empty() {
160 stts_flat[0].1
161 } else {
162 0
163 };
164 let mut time_acc: u64 = 0;
165 let has_time = !stts_flat.is_empty();
166
167 let mut stsc_idx = 0;
169 let mut samples_per_chunk = track.stsc[0].1;
170 let mut next_first_chunk: Option<u32> = if track.stsc.len() > 1 {
171 Some(track.stsc[1].0)
172 } else {
173 None
174 };
175
176 let mut sample_idx: usize = 0;
177
178 for (chunk_idx_0, &chunk_offset) in track.stco.iter().enumerate() {
179 let chunk_num = chunk_idx_0 as u32 + 1; if let Some(nfc) = next_first_chunk {
183 if chunk_num >= nfc {
184 stsc_idx += 1;
185 if stsc_idx < track.stsc.len() {
186 samples_per_chunk = track.stsc[stsc_idx].1;
187 next_first_chunk = if stsc_idx + 1 < track.stsc.len() {
188 Some(track.stsc[stsc_idx + 1].0)
189 } else {
190 None
191 };
192 }
193 }
194 }
195
196 let mut offset_in_chunk: u64 = 0;
197 for _ in 0..samples_per_chunk {
198 if sample_idx >= track.stsz.len() {
199 break;
200 }
201 let sz = track.stsz[sample_idx];
202 let sample_time = if has_time {
203 Some(time_acc as f64 / ts)
204 } else {
205 None
206 };
207 let sample_dur = if has_time {
208 Some(stts_delta as f64 / ts)
209 } else {
210 None
211 };
212
213 result.push(SampleInfo {
214 offset: chunk_offset + offset_in_chunk,
215 size: sz,
216 time: sample_time,
217 duration: sample_dur,
218 });
219
220 offset_in_chunk += sz as u64;
221 sample_idx += 1;
222
223 if has_time {
225 time_acc += stts_delta as u64;
226 stts_remaining = stts_remaining.saturating_sub(1);
227 if stts_remaining == 0 {
228 stts_idx += 1;
229 if stts_idx < stts_flat.len() {
230 stts_remaining = stts_flat[stts_idx].0;
231 stts_delta = stts_flat[stts_idx].1;
232 }
233 }
234 }
235 }
236 }
237
238 result
239}
240
241fn dispatch_sample(
244 sample: &[u8],
245 handler: &[u8; 4],
246 meta_format: &str,
247 _time: Option<f64>,
248 _dur: Option<f64>,
249 tags: &mut Vec<Tag>,
250) -> bool {
251 match meta_format {
253 "camm" => return process_camm(sample, tags),
254 "gpmd" => return process_gpmd(sample, tags),
255 "mebx" => return process_mebx(sample, tags),
256 "tx3g" => return process_tx3g(sample, tags),
257 _ => {}
258 }
259
260 match handler {
262 b"text" | b"sbtl" => {
263 if meta_format == "tx3g" {
265 return process_tx3g(sample, tags);
266 }
267 return process_text(sample, tags);
268 }
269 b"gps " => {
270 if sample.len() >= 12 && &sample[4..12] == b"freeGPS " {
272 return process_freegps(sample, tags);
273 }
274 return process_nmea(sample, tags);
276 }
277 b"meta" | b"data" => {
278 match meta_format {
280 "RVMI" => return process_rvmi(sample, tags),
281 _ => {
282 if sample.len() >= 12 && &sample[4..12] == b"freeGPS " {
283 return process_freegps(sample, tags);
284 }
285 }
286 }
287 }
288 _ => {
289 if sample.starts_with(b"VIDEO") && sample.windows(2).any(|w| w == b"\xfe\xfe") {
291 return process_kenwood(sample, tags);
292 }
293 }
294 }
295 false
296}
297
298fn process_freegps(data: &[u8], tags: &mut Vec<Tag>) -> bool {
301 if data.len() < 82 {
302 return false;
303 }
304
305 if data.len() > 26 && &data[18..26] == b"\xaa\xaa\xf2\xe1\xf0\xee\x54\x54" {
307 return process_freegps_type1_encrypted(data, tags);
308 }
309
310 if data.len() > 64 {
312 if let Some(dt) = try_ascii_digits(&data[52..], 14) {
313 if dt.len() == 14 {
314 return process_freegps_type2_nmea(data, tags);
315 }
316 }
317 }
318
319 if data.len() > 75 && data[72] == b'A' && is_ns(data[73]) && is_ew(data[74]) && data[75] == 0 {
321 return process_freegps_novatek(data, tags);
322 }
323
324 if data.len() > 44 && &data[37..41] == b"\0\0\0A" && is_ns(data[41]) && is_ew(data[42]) {
326 return process_freegps_viofo(data, 0, tags);
327 }
328 if data.len() > 92 && &data[85..89] == b"\0\0\0A" && is_ns(data[89]) && is_ew(data[90]) {
329 return process_freegps_viofo(data, 48, tags);
331 }
332
333 if data.len() > 96
335 && data[60] == b'A'
336 && data[61] == 0
337 && data[62] == 0
338 && data[63] == 0
339 && is_ns(data[68])
340 && is_ew(data[76])
341 {
342 return process_freegps_akaso(data, tags);
343 }
344
345 if data.len() > 100 && data[64] == b'A' && is_ns(data[65]) && is_ew(data[66]) && data[67] == 0 {
347 return process_freegps_vantrue_s1(data, tags);
348 }
349
350 if data.len() >= 0x88
352 && data[60] == b'A'
353 && data[61] == 0
354 && is_ns(data[72])
355 && data[73] == 0
356 && is_ew(data[88])
357 && data[89] == 0
358 {
359 return process_freegps_type12(data, tags);
360 }
361
362 if data.len() > 48 && data[16] == b'A' && is_ns(data[17]) && is_ew(data[18]) && data[19] == 0 {
364 return process_freegps_innovv(data, tags);
365 }
366
367 if data.len() > 80 && data[28] == b'A' && is_ns(data[40]) && is_ew(data[56]) {
369 return process_freegps_vantrue_n4(data, tags);
370 }
371
372 if data.len() > 0x50 {
374 return process_freegps_nextbase_binary(data, tags);
375 }
376
377 false
378}
379
380fn process_freegps_type1_encrypted(data: &[u8], tags: &mut Vec<Tag>) -> bool {
383 let n = (data.len() - 18).min(0x101);
384 let decrypted: Vec<u8> = data[18..18 + n].iter().map(|b| b ^ 0xaa).collect();
385
386 if decrypted.len() < 66 {
387 return false;
388 }
389
390 let dt_bytes = &decrypted[8..22];
392 let dt_str = match std::str::from_utf8(dt_bytes) {
393 Ok(s) if s.chars().all(|c| c.is_ascii_digit()) => s,
394 _ => return false,
395 };
396 if dt_str.len() < 14 {
397 return false;
398 }
399 let yr = &dt_str[0..4];
400 let mo = &dt_str[4..6];
401 let dy = &dt_str[6..8];
402 let hr = &dt_str[8..10];
403 let mi = &dt_str[10..12];
404 let se = &dt_str[12..14];
405
406 if decrypted.len() < 57 {
408 return false;
409 }
410 let lat_ref = decrypted[37];
411 if lat_ref != b'N' && lat_ref != b'S' {
412 return false;
413 }
414 let lon_ref = decrypted[46];
415 if lon_ref != b'E' && lon_ref != b'W' {
416 return false;
417 }
418 let lat_str = match std::str::from_utf8(&decrypted[38..46]) {
419 Ok(s) if s.chars().all(|c| c.is_ascii_digit()) => s,
420 _ => return false,
421 };
422 let lon_str = match std::str::from_utf8(&decrypted[47..56]) {
423 Ok(s) if s.chars().all(|c| c.is_ascii_digit()) => s,
424 _ => return false,
425 };
426 let lat: f64 = lat_str.parse::<f64>().unwrap_or(0.0) / 1e4;
427 let lon: f64 = lon_str.parse::<f64>().unwrap_or(0.0) / 1e4;
428 let (lat_dd, lon_dd) = convert_lat_lon(lat, lon);
429 let lat_final = lat_dd * if lat_ref == b'S' { -1.0 } else { 1.0 };
430 let lon_final = lon_dd * if lon_ref == b'W' { -1.0 } else { 1.0 };
431
432 tags.push(mk_gps_dt(&format!(
433 "{}:{}:{} {}:{}:{}Z",
434 yr, mo, dy, hr, mi, se
435 )));
436 tags.push(mk_gps_lat(lat_final));
437 tags.push(mk_gps_lon(lon_final));
438
439 if decrypted.len() >= 65 {
441 if let Ok(s) = std::str::from_utf8(&decrypted[56..64]) {
442 if let Ok(spd) = s.trim_start_matches('0').parse::<f64>() {
443 tags.push(mk_gps_spd(spd));
444 }
445 }
446 }
447
448 true
449}
450
451fn process_freegps_type2_nmea(data: &[u8], tags: &mut Vec<Tag>) -> bool {
454 if let Some(dt) = try_ascii_digits(&data[52..], 14) {
456 if dt.len() >= 14 {
457 let cam_dt = format!(
458 "{}:{}:{} {}:{}:{}",
459 &dt[0..4],
460 &dt[4..6],
461 &dt[6..8],
462 &dt[8..10],
463 &dt[10..12],
464 &dt[12..14]
465 );
466 tags.push(mk_stream(
467 "CameraDateTime",
468 "Camera Date/Time",
469 Value::String(cam_dt),
470 ));
471 }
472 }
473
474 let text = crate::encoding::decode_utf8_or_latin1(data);
476 if parse_nmea_rmc(&text, tags) {
477 return true;
478 }
479 if parse_nmea_gga(&text, tags) {
480 return true;
481 }
482 false
483}
484
485fn process_freegps_novatek(data: &[u8], tags: &mut Vec<Tag>) -> bool {
488 if data.len() < 0x5c {
493 return false;
494 }
495 let hr = get_u32_le(data, 0x30);
496 let min = get_u32_le(data, 0x34);
497 let sec = get_u32_le(data, 0x38);
498 let yr = get_u32_le(data, 0x3c);
499 let mon = get_u32_le(data, 0x40);
500 let day = get_u32_le(data, 0x44);
501 let lat_ref = data[0x49];
502 let lon_ref = data[0x4a];
503
504 if !(1..=12).contains(&mon) || !(1..=31).contains(&day) {
505 return false;
506 }
507
508 let full_yr = if yr < 2000 { yr + 2000 } else { yr };
509
510 let lat = get_f32_le(data, 0x4c) as f64;
511 let lon = get_f32_le(data, 0x50) as f64;
512 let spd = get_f32_le(data, 0x54) as f64 * KNOTS_TO_KPH;
513 let trk = get_f32_le(data, 0x58) as f64;
514
515 let (lat_dd, lon_dd) = convert_lat_lon(lat, lon);
516 let lat_final = lat_dd * if lat_ref == b'S' { -1.0 } else { 1.0 };
517 let lon_final = lon_dd * if lon_ref == b'W' { -1.0 } else { 1.0 };
518
519 tags.push(mk_gps_dt(&format!(
520 "{:04}:{:02}:{:02} {:02}:{:02}:{:02}Z",
521 full_yr, mon, day, hr, min, sec
522 )));
523 tags.push(mk_gps_lat(lat_final));
524 tags.push(mk_gps_lon(lon_final));
525 tags.push(mk_gps_spd(spd));
526 tags.push(mk_gps_trk(trk));
527
528 true
529}
530
531fn process_freegps_viofo(data: &[u8], extra_offset: usize, tags: &mut Vec<Tag>) -> bool {
534 let d = if extra_offset > 0 && data.len() > extra_offset {
535 &data[extra_offset..]
536 } else {
537 data
538 };
539 if d.len() < 0x3c {
540 return false;
541 }
542
543 let hr = get_u32_le(d, 0x10);
544 let min = get_u32_le(d, 0x14);
545 let sec = get_u32_le(d, 0x18);
546 let yr = get_u32_le(d, 0x1c);
547 let mon = get_u32_le(d, 0x20);
548 let day = get_u32_le(d, 0x24);
549
550 let lat_ref = d[0x29]; let lon_ref = d[0x2a]; if !(1..=12).contains(&mon) || !(1..=31).contains(&day) {
554 return false;
555 }
556
557 let full_yr = if yr < 2000 { yr + 2000 } else { yr };
558
559 let lat = get_f32_le(d, 0x2c) as f64;
560 let lon = get_f32_le(d, 0x30) as f64;
561 let spd = get_f32_le(d, 0x34) as f64 * KNOTS_TO_KPH;
562 let trk = get_f32_le(d, 0x38) as f64;
563
564 tags.push(mk_gps_dt(&format!(
565 "{:04}:{:02}:{:02} {:02}:{:02}:{:02}Z",
566 full_yr, mon, day, hr, min, sec
567 )));
568 tags.push(mk_gps_lat(lat * if lat_ref == b'S' { -1.0 } else { 1.0 }));
569 tags.push(mk_gps_lon(lon * if lon_ref == b'W' { -1.0 } else { 1.0 }));
570 tags.push(mk_gps_spd(spd));
571 tags.push(mk_gps_trk(trk));
572
573 true
574}
575
576fn process_freegps_akaso(data: &[u8], tags: &mut Vec<Tag>) -> bool {
579 if data.len() < 0x58 {
580 return false;
581 }
582 let lat_ref = data[68];
583 let lon_ref = data[76];
584 let hr = get_u32_le(data, 48);
585 let min = get_u32_le(data, 52);
586 let sec = get_u32_le(data, 56);
587 let yr = get_u32_le(data, 84);
588 let mon = get_u32_le(data, 88);
589 let day = get_u32_le(data, 92);
590
591 if !(1..=12).contains(&mon) {
592 return false;
593 }
594
595 let lat = get_f32_le(data, 0x40) as f64;
596 let lon = get_f32_le(data, 0x48) as f64;
597 let spd = get_f32_le(data, 0x50) as f64;
598 let trk = get_f32_le(data, 0x54) as f64;
599
600 tags.push(mk_gps_dt(&format!(
601 "{:04}:{:02}:{:02} {:02}:{:02}:{:02}Z",
602 yr, mon, day, hr, min, sec
603 )));
604 tags.push(mk_gps_lat(lat * if lat_ref == b'S' { -1.0 } else { 1.0 }));
605 tags.push(mk_gps_lon(lon * if lon_ref == b'W' { -1.0 } else { 1.0 }));
606 tags.push(mk_gps_spd(spd));
607 tags.push(mk_gps_trk(trk));
608
609 true
610}
611
612fn process_freegps_vantrue_s1(data: &[u8], tags: &mut Vec<Tag>) -> bool {
615 if data.len() < 0x70 {
616 return false;
617 }
618 let lat_ref = data[65];
619 let lon_ref = data[66];
620
621 let yr = get_u32_le(data, 68);
622 let mon = get_u32_le(data, 72);
623 let day = get_u32_le(data, 76);
624 let hr = get_u32_le(data, 80);
625 let min = get_u32_le(data, 84);
626 let sec = get_u32_le(data, 88);
627
628 if !(1..=12).contains(&mon) || !(1..=31).contains(&day) {
629 return false;
630 }
631
632 let lon = get_f32_le(data, 0x5c) as f64;
633 let lat = get_f32_le(data, 0x60) as f64;
634 let spd = get_f32_le(data, 0x64) as f64 * KNOTS_TO_KPH;
635 let trk = get_f32_le(data, 0x68) as f64;
636 let alt = get_f32_le(data, 0x6c) as f64;
637
638 tags.push(mk_gps_dt(&format!(
639 "{:04}:{:02}:{:02} {:02}:{:02}:{:02}Z",
640 yr, mon, day, hr, min, sec
641 )));
642 tags.push(mk_gps_lat(lat * if lat_ref == b'S' { -1.0 } else { 1.0 }));
643 tags.push(mk_gps_lon(lon * if lon_ref == b'W' { -1.0 } else { 1.0 }));
644 tags.push(mk_gps_spd(spd));
645 tags.push(mk_gps_trk(trk));
646 tags.push(mk_gps_alt(alt));
647
648 true
649}
650
651fn process_freegps_type12(data: &[u8], tags: &mut Vec<Tag>) -> bool {
654 if data.len() < 0x88 {
655 return false;
656 }
657 let lat_ref = data[72];
658 let lon_ref = data[88];
659
660 let hr = get_u32_le(data, 48);
661 let min = get_u32_le(data, 52);
662 let sec = get_u32_le(data, 56);
663 let yr = get_u32_le(data, 0x70);
664 let mon = get_u32_le(data, 0x74);
665 let day = get_u32_le(data, 0x78);
666
667 if !(1..=12).contains(&mon) {
668 return false;
669 }
670
671 let full_yr = if yr < 2000 { yr + 2000 } else { yr };
672
673 let lat = get_f64_le(data, 0x40);
674 let lon = get_f64_le(data, 0x50);
675 let spd = get_f64_le(data, 0x60) * KNOTS_TO_KPH;
676 let trk = get_f64_le(data, 0x68);
677
678 let (lat_dd, lon_dd) = convert_lat_lon(lat, lon);
679
680 tags.push(mk_gps_dt(&format!(
681 "{:04}:{:02}:{:02} {:02}:{:02}:{:02}Z",
682 full_yr, mon, day, hr, min, sec
683 )));
684 tags.push(mk_gps_lat(
685 lat_dd * if lat_ref == b'S' { -1.0 } else { 1.0 },
686 ));
687 tags.push(mk_gps_lon(
688 lon_dd * if lon_ref == b'W' { -1.0 } else { 1.0 },
689 ));
690 tags.push(mk_gps_spd(spd));
691 tags.push(mk_gps_trk(trk));
692
693 true
694}
695
696fn process_freegps_innovv(data: &[u8], tags: &mut Vec<Tag>) -> bool {
699 let mut pos = 16;
701 let mut found = false;
702 while pos + 32 <= data.len() {
703 if data[pos] != b'A' || !is_ns(data[pos + 1]) || !is_ew(data[pos + 2]) || data[pos + 3] != 0
704 {
705 break;
706 }
707 let lat_ref = data[pos + 1];
708 let lon_ref = data[pos + 2];
709 let lat = get_f32_le(data, pos + 4).abs() as f64;
710 let lon = get_f32_le(data, pos + 8).abs() as f64;
711 let spd = get_f32_le(data, pos + 12) as f64 * KNOTS_TO_KPH;
712 let trk = get_f32_le(data, pos + 16) as f64;
713
714 let (lat_dd, lon_dd) = convert_lat_lon(lat, lon);
715 tags.push(mk_gps_lat(
716 lat_dd * if lat_ref == b'S' { -1.0 } else { 1.0 },
717 ));
718 tags.push(mk_gps_lon(
719 lon_dd * if lon_ref == b'W' { -1.0 } else { 1.0 },
720 ));
721 tags.push(mk_gps_spd(spd));
722 tags.push(mk_gps_trk(trk));
723 found = true;
724 pos += 32;
725 }
726 found
727}
728
729fn process_freegps_vantrue_n4(data: &[u8], tags: &mut Vec<Tag>) -> bool {
732 if data.len() < 80 {
733 return false;
734 }
735 let lat_ref = data[40];
736 let lon_ref = data[56];
737
738 let hr = get_u32_le(data, 16);
739 let min = get_u32_le(data, 20);
740 let sec = get_u32_le(data, 24);
741
742 if data.len() < 92 {
744 return false;
745 }
746 let yr = get_u32_le(data, 80);
747 let mon = get_u32_le(data, 84);
748 let day = get_u32_le(data, 88);
749
750 if !(1..=12).contains(&mon) {
751 return false;
752 }
753
754 let lat = get_f64_le(data, 32).abs();
755 let lon = get_f64_le(data, 48).abs();
756 let spd = get_f64_le(data, 64) * KNOTS_TO_KPH;
757 let trk = get_f64_le(data, 72);
758
759 tags.push(mk_gps_dt(&format!(
760 "{:04}:{:02}:{:02} {:02}:{:02}:{:02}Z",
761 yr, mon, day, hr, min, sec
762 )));
763 tags.push(mk_gps_lat(lat * if lat_ref == b'S' { -1.0 } else { 1.0 }));
764 tags.push(mk_gps_lon(lon * if lon_ref == b'W' { -1.0 } else { 1.0 }));
765 tags.push(mk_gps_spd(spd));
766 tags.push(mk_gps_trk(trk));
767
768 true
769}
770
771fn process_freegps_nextbase_binary(data: &[u8], tags: &mut Vec<Tag>) -> bool {
774 let mut pos = 0x32usize;
777 let mut found = false;
778 while pos + 0x1e <= data.len() {
779 let spd_raw = get_u16_be(data, pos);
780 let trk_raw = get_u16_be(data, pos + 2) as i16;
781 let yr = get_u16_be(data, pos + 4);
782 let mon = data[pos + 6];
783 let day = data[pos + 7];
784 let hr = data[pos + 8];
785 let min = data[pos + 9];
786 let sec10 = get_u16_be(data, pos + 10);
787
788 if !(2000..=2200).contains(&yr)
789 || !(1..=12).contains(&mon)
790 || !(1..=31).contains(&day)
791 || hr > 59
792 || min > 59
793 || sec10 > 600
794 {
795 break;
796 }
797
798 let lat_raw = get_u32_be(data, pos + 13);
799 let lon_raw = get_u32_be(data, pos + 17);
800 let lat = signed_u32(lat_raw) as f64 / 1e7;
801 let lon = signed_u32(lon_raw) as f64 / 1e7;
802 let mut trk = trk_raw as f64 / 100.0;
803 if trk < 0.0 {
804 trk += 360.0;
805 }
806
807 let time = format!(
808 "{:04}:{:02}:{:02} {:02}:{:02}:{:04.1}Z",
809 yr,
810 mon,
811 day,
812 hr,
813 min,
814 sec10 as f64 / 10.0
815 );
816 tags.push(mk_gps_dt(&time));
817 tags.push(mk_gps_lat(lat));
818 tags.push(mk_gps_lon(lon));
819 tags.push(mk_gps_spd(spd_raw as f64 / 100.0 * MPS_TO_KPH));
820 tags.push(mk_gps_trk(trk));
821 found = true;
822
823 pos += 0x20;
824 }
825 found
826}
827
828fn process_camm(data: &[u8], tags: &mut Vec<Tag>) -> bool {
831 if data.len() < 4 {
832 return false;
833 }
834 let camm_type = get_u16_le(data, 2);
835
836 match camm_type {
837 0 => {
838 if data.len() >= 16 {
840 let x = get_f32_le(data, 4);
841 let y = get_f32_le(data, 8);
842 let z = get_f32_le(data, 12);
843 tags.push(mk_stream(
844 "AngleAxis",
845 "Angle Axis",
846 Value::String(format!("{} {} {}", x, y, z)),
847 ));
848 return true;
849 }
850 }
851 2 => {
852 if data.len() >= 16 {
854 let x = get_f32_le(data, 4);
855 let y = get_f32_le(data, 8);
856 let z = get_f32_le(data, 12);
857 tags.push(mk_stream(
858 "AngularVelocity",
859 "Angular Velocity",
860 Value::String(format!("{} {} {}", x, y, z)),
861 ));
862 return true;
863 }
864 }
865 3 => {
866 if data.len() >= 16 {
868 let x = get_f32_le(data, 4);
869 let y = get_f32_le(data, 8);
870 let z = get_f32_le(data, 12);
871 tags.push(mk_stream(
872 "Accelerometer",
873 "Accelerometer",
874 Value::String(format!("{} {} {}", x, y, z)),
875 ));
876 return true;
877 }
878 }
879 5 => {
880 if data.len() >= 28 {
882 let lat = get_f64_le(data, 4);
883 let lon = get_f64_le(data, 12);
884 let alt = get_f64_le(data, 20);
885 tags.push(mk_gps_lat(lat));
886 tags.push(mk_gps_lon(lon));
887 tags.push(mk_gps_alt(alt));
888 return true;
889 }
890 }
891 6 => {
892 if data.len() >= 60 {
894 let _timestamp = get_f64_le(data, 4);
895 let lat = get_f64_le(data, 0x10);
896 let lon = get_f64_le(data, 0x18);
897 let alt = get_f32_le(data, 0x20) as f64;
898
899 tags.push(mk_gps_lat(lat));
900 tags.push(mk_gps_lon(lon));
901 tags.push(mk_gps_alt(alt));
902
903 if data.len() >= 0x38 {
904 let vel_east = get_f32_le(data, 0x2c);
905 let vel_north = get_f32_le(data, 0x30);
906 let speed =
907 ((vel_east * vel_east + vel_north * vel_north) as f64).sqrt() * MPS_TO_KPH;
908 tags.push(mk_gps_spd(speed));
909 }
910 return true;
911 }
912 }
913 7
914 if data.len() >= 16 => {
916 let x = get_f32_le(data, 4);
917 let y = get_f32_le(data, 8);
918 let z = get_f32_le(data, 12);
919 tags.push(mk_stream(
920 "MagneticField",
921 "Magnetic Field",
922 Value::String(format!("{} {} {}", x, y, z)),
923 ));
924 return true;
925 }
926 _ => {}
927 }
928 false
929}
930
931fn process_gpmd(data: &[u8], tags: &mut Vec<Tag>) -> bool {
934 process_gpmf_klv(data, 0, data.len(), tags)
937}
938
939fn process_gpmf_klv(data: &[u8], start: usize, end: usize, tags: &mut Vec<Tag>) -> bool {
940 let mut pos = start;
941 let mut found = false;
942
943 while pos + 8 <= end {
944 let fourcc = &data[pos..pos + 4];
945 let type_byte = data[pos + 4];
946 let size_byte = data[pos + 5];
947 let repeat = get_u16_be(data, pos + 6) as usize;
948
949 let struct_size = size_byte as usize;
950 let total_data = struct_size * repeat;
951 let padded = (total_data + 3) & !3;
953 let data_start = pos + 8;
954
955 if data_start + padded > end {
956 break;
957 }
958
959 if type_byte == 0 && struct_size == 4 {
960 if process_gpmf_klv(data, data_start, data_start + total_data, tags) {
962 found = true;
963 }
964 } else if fourcc == b"GPS5" && struct_size >= 20 && type_byte == b'l' {
965 for i in 0..repeat {
967 let off = data_start + i * struct_size;
968 if off + 20 > end {
969 break;
970 }
971 let lat = get_i32_be(data, off) as f64 / 1e7;
972 let lon = get_i32_be(data, off + 4) as f64 / 1e7;
973 let alt = get_i32_be(data, off + 8) as f64 / 100.0;
974 let speed2d = get_i32_be(data, off + 12) as f64 / 100.0 * MPS_TO_KPH;
975
976 tags.push(mk_gps_lat(lat));
977 tags.push(mk_gps_lon(lon));
978 tags.push(mk_gps_alt(alt));
979 tags.push(mk_gps_spd(speed2d));
980 found = true;
981 }
982 } else if fourcc == b"GPSU" && type_byte == b'U' && total_data >= 16 {
983 if let Ok(s) = std::str::from_utf8(&data[data_start..data_start + total_data.min(16)]) {
985 let s = s.trim_end_matches('\0');
986 if s.len() >= 12 {
987 let dt = format!(
988 "20{}:{}:{} {}:{}:{}Z",
989 &s[0..2],
990 &s[2..4],
991 &s[4..6],
992 &s[6..8],
993 &s[8..10],
994 &s[10..]
995 );
996 tags.push(mk_gps_dt(&dt));
997 found = true;
998 }
999 }
1000 } else if fourcc == b"ACCL" && type_byte == b's' && struct_size >= 6 {
1001 for i in 0..repeat.min(1) {
1003 let off = data_start + i * struct_size;
1004 if off + 6 > end {
1005 break;
1006 }
1007 let x = get_i16_be(data, off) as f64 / 100.0;
1008 let y = get_i16_be(data, off + 2) as f64 / 100.0;
1009 let z = get_i16_be(data, off + 4) as f64 / 100.0;
1010 tags.push(mk_stream(
1011 "Accelerometer",
1012 "Accelerometer",
1013 Value::String(format!("{:.4} {:.4} {:.4}", x, y, z)),
1014 ));
1015 found = true;
1016 }
1017 } else if fourcc == b"GYRO" && type_byte == b's' && struct_size >= 6 {
1018 for i in 0..repeat.min(1) {
1020 let off = data_start + i * struct_size;
1021 if off + 6 > end {
1022 break;
1023 }
1024 let x = get_i16_be(data, off) as f64 / 100.0;
1025 let y = get_i16_be(data, off + 2) as f64 / 100.0;
1026 let z = get_i16_be(data, off + 4) as f64 / 100.0;
1027 tags.push(mk_stream(
1028 "AngularVelocity",
1029 "Angular Velocity",
1030 Value::String(format!("{:.4} {:.4} {:.4}", x, y, z)),
1031 ));
1032 found = true;
1033 }
1034 }
1035
1036 pos = data_start + padded;
1037 }
1038
1039 found
1040}
1041
1042fn process_mebx(data: &[u8], tags: &mut Vec<Tag>) -> bool {
1045 let mut pos = 0;
1047 let mut found = false;
1048 while pos + 8 < data.len() {
1049 let len = get_u32_be(data, pos) as usize;
1050 if len < 8 || pos + len > data.len() {
1051 break;
1052 }
1053 let key = &data[pos + 4..pos + 8];
1054 let val_data = &data[pos + 8..pos + len];
1055
1056 if let Ok(s) = std::str::from_utf8(val_data) {
1058 let key_str = crate::encoding::decode_utf8_or_latin1(key).to_string();
1059 let name = key_str.trim().to_string();
1060 if !name.is_empty() {
1061 tags.push(mk_stream(&name, &name, Value::String(s.trim().to_string())));
1062 found = true;
1063 }
1064 }
1065 pos += len;
1066 }
1067 found
1068}
1069
1070fn process_tx3g(data: &[u8], tags: &mut Vec<Tag>) -> bool {
1073 if data.len() < 2 {
1074 return false;
1075 }
1076 let text = crate::encoding::decode_utf8_or_latin1(&data[2..]); let text = text.trim();
1078 if text.is_empty() {
1079 return false;
1080 }
1081
1082 if text.starts_with("HOME(") {
1084 return process_tx3g_autel(text, tags);
1085 }
1086
1087 let mut found = false;
1089 for line in text.lines() {
1091 let line = line.trim();
1092 for cap in line.split_whitespace() {
1094 if let Some((k, v)) = cap.split_once(':') {
1095 match k {
1096 "Lat" => {
1097 if let Ok(val) = v.parse::<f64>() {
1098 tags.push(mk_gps_lat(val));
1099 found = true;
1100 }
1101 }
1102 "Lon" => {
1103 if let Ok(val) = v.parse::<f64>() {
1104 tags.push(mk_gps_lon(val));
1105 found = true;
1106 }
1107 }
1108 "Alt" => {
1109 if let Ok(val) = v.trim_end_matches('m').trim().parse::<f64>() {
1110 tags.push(mk_gps_alt(val));
1111 found = true;
1112 }
1113 }
1114 _ => {}
1115 }
1116 }
1117 }
1118 }
1119
1120 if !found {
1121 tags.push(mk_stream("Text", "Text", Value::String(text.to_string())));
1123 let _ = parse_nmea_rmc(text, tags) || parse_nmea_gga(text, tags);
1125 found = true;
1126 }
1127 found
1128}
1129
1130fn process_tx3g_autel(text: &str, tags: &mut Vec<Tag>) -> bool {
1131 let mut found = false;
1132 for line in text.lines() {
1133 let line = line.trim();
1134 if line.starts_with("HOME(") {
1136 if let Some(rest) = line.strip_prefix("HOME(") {
1138 if let Some(paren_end) = rest.find(')') {
1139 let coords = &rest[..paren_end];
1140 let after = rest[paren_end + 1..].trim();
1141 let parts: Vec<&str> = coords.split(',').collect();
1143 if parts.len() == 2 {
1144 for part in &parts {
1145 let part = part.trim();
1146 if let Some((dir, val_s)) = part.split_once(':') {
1147 let dir = dir.trim();
1148 let val_s = val_s.trim();
1149 if let Ok(val) = val_s.parse::<f64>() {
1150 match dir {
1151 "N" | "S" => {
1152 let v = if dir == "S" { -val } else { val };
1153 tags.push(mk_stream(
1154 "GPSHomeLatitude",
1155 "GPS Home Latitude",
1156 Value::String(format!("{:.6}", v)),
1157 ));
1158 found = true;
1159 }
1160 "E" | "W" => {
1161 let v = if dir == "W" { -val } else { val };
1162 tags.push(mk_stream(
1163 "GPSHomeLongitude",
1164 "GPS Home Longitude",
1165 Value::String(format!("{:.6}", v)),
1166 ));
1167 found = true;
1168 }
1169 _ => {}
1170 }
1171 }
1172 }
1173 }
1174 }
1175 if !after.is_empty() {
1177 let dt = after.replace('-', ":");
1178 tags.push(mk_gps_dt(&dt));
1179 found = true;
1180 }
1181 }
1182 }
1183 } else if line.starts_with("GPS(") {
1184 if let Some(rest) = line.strip_prefix("GPS(") {
1186 if let Some(paren_end) = rest.find(')') {
1187 let inner = &rest[..paren_end];
1188 let parts: Vec<&str> = inner.split(',').collect();
1189 for part in &parts {
1190 let part = part.trim();
1191 if let Some((dir, val_s)) = part.split_once(':') {
1192 let dir = dir.trim();
1193 let val_s = val_s.trim();
1194 if let Ok(val) = val_s.parse::<f64>() {
1195 match dir {
1196 "N" | "S" => {
1197 let v = if dir == "S" { -val } else { val };
1198 tags.push(mk_gps_lat(v));
1199 found = true;
1200 }
1201 "E" | "W" => {
1202 let v = if dir == "W" { -val } else { val };
1203 tags.push(mk_gps_lon(v));
1204 found = true;
1205 }
1206 _ => {}
1207 }
1208 }
1209 } else if part.ends_with('m') {
1210 if let Ok(alt) = part.trim_end_matches('m').trim().parse::<f64>() {
1211 tags.push(mk_gps_alt(alt));
1212 found = true;
1213 }
1214 }
1215 }
1216 }
1217 }
1218 }
1219 }
1220 found
1221}
1222
1223fn process_nmea(data: &[u8], tags: &mut Vec<Tag>) -> bool {
1226 let text = crate::encoding::decode_utf8_or_latin1(data);
1227 parse_nmea_rmc(&text, tags) || parse_nmea_gga(&text, tags)
1228}
1229
1230fn parse_nmea_rmc(text: &str, tags: &mut Vec<Tag>) -> bool {
1231 let rmc_patterns = ["$GPRMC,", "$GNRMC,", "$GBRMC,"];
1234 for pat in &rmc_patterns {
1235 if let Some(start) = text.find(pat) {
1236 let rest = &text[start + pat.len()..];
1237 return parse_rmc_fields(rest, tags);
1238 }
1239 }
1240 false
1241}
1242
1243fn parse_rmc_fields(rest: &str, tags: &mut Vec<Tag>) -> bool {
1244 let fields: Vec<&str> = rest.split(',').collect();
1245 if fields.len() < 12 {
1246 return false;
1247 }
1248
1249 let time_str = fields[0];
1252 let status = fields[1];
1253 if status != "A" && !status.is_empty() {
1254 }
1256 let lat_str = fields[2];
1257 let lat_ref = fields[3];
1258 let lon_str = fields[4];
1259 let lon_ref = fields[5];
1260 let spd_str = fields[6];
1261 let trk_str = fields[7];
1262 let date_str = fields[8];
1263
1264 let lat = match parse_nmea_coord(lat_str) {
1266 Some(v) => v * if lat_ref == "S" { -1.0 } else { 1.0 },
1267 None => return false,
1268 };
1269 let lon = match parse_nmea_coord(lon_str) {
1270 Some(v) => v * if lon_ref == "W" { -1.0 } else { 1.0 },
1271 None => return false,
1272 };
1273
1274 if date_str.len() >= 6 && time_str.len() >= 6 {
1276 let dd = &date_str[0..2];
1277 let mm = &date_str[2..4];
1278 let yy = &date_str[4..6];
1279 let yr: u32 = yy.parse().unwrap_or(0);
1280 let full_yr = if yr >= 70 { 1900 + yr } else { 2000 + yr };
1281 let time_part = if time_str.len() > 6 {
1282 &time_str[..6]
1283 } else {
1284 time_str
1285 };
1286 let dt = format!(
1287 "{:04}:{:02}:{:02} {}:{}:{}Z",
1288 full_yr,
1289 mm,
1290 dd,
1291 &time_part[0..2],
1292 &time_part[2..4],
1293 &time_part[4..6]
1294 );
1295 tags.push(mk_gps_dt(&dt));
1296 }
1297
1298 tags.push(mk_gps_lat(lat));
1299 tags.push(mk_gps_lon(lon));
1300
1301 if let Ok(spd) = spd_str.parse::<f64>() {
1302 tags.push(mk_gps_spd(spd * KNOTS_TO_KPH));
1303 }
1304 if let Ok(trk) = trk_str.parse::<f64>() {
1305 tags.push(mk_gps_trk(trk));
1306 }
1307
1308 true
1309}
1310
1311fn parse_nmea_gga(text: &str, tags: &mut Vec<Tag>) -> bool {
1312 let patterns = ["$GPGGA,", "$GNGGA,"];
1313 for pat in &patterns {
1314 if let Some(start) = text.find(pat) {
1315 let rest = &text[start + pat.len()..];
1316 let fields: Vec<&str> = rest.split(',').collect();
1317 if fields.len() < 10 {
1318 continue;
1319 }
1320
1321 let lat_str = fields[1];
1322 let lat_ref = fields[2];
1323 let lon_str = fields[3];
1324 let lon_ref = fields[4];
1325
1326 let lat = match parse_nmea_coord(lat_str) {
1327 Some(v) => v * if lat_ref == "S" { -1.0 } else { 1.0 },
1328 None => continue,
1329 };
1330 let lon = match parse_nmea_coord(lon_str) {
1331 Some(v) => v * if lon_ref == "W" { -1.0 } else { 1.0 },
1332 None => continue,
1333 };
1334
1335 tags.push(mk_gps_lat(lat));
1336 tags.push(mk_gps_lon(lon));
1337
1338 if fields.len() > 8 {
1340 if let Ok(alt) = fields[8].parse::<f64>() {
1341 tags.push(mk_gps_alt(alt));
1342 }
1343 }
1344 if let Ok(sats) = fields[6].parse::<u32>() {
1346 tags.push(mk_stream(
1347 "GPSSatellites",
1348 "GPS Satellites",
1349 Value::String(sats.to_string()),
1350 ));
1351 }
1352 return true;
1353 }
1354 }
1355 false
1356}
1357
1358fn parse_nmea_coord(s: &str) -> Option<f64> {
1359 if s.is_empty() {
1361 return None;
1362 }
1363 let val: f64 = s.parse().ok()?;
1364 let deg = (val / 100.0).floor();
1365 let min = val - deg * 100.0;
1366 Some(deg + min / 60.0)
1367}
1368
1369fn process_text(data: &[u8], tags: &mut Vec<Tag>) -> bool {
1372 let text = crate::encoding::decode_utf8_or_latin1(data);
1373 let text = text.trim();
1374 if text.is_empty() {
1375 return false;
1376 }
1377
1378 if parse_nmea_rmc(text, tags) || parse_nmea_gga(text, tags) {
1380 return true;
1381 }
1382
1383 if text.contains("GPS (") || text.contains("GPS(") {
1385 return process_dji_text(text, tags);
1386 }
1387
1388 if data.len() >= 20
1390 && (data.starts_with(b"PNDM") || (data.len() > 4 && &data[4..8.min(data.len())] == b"PNDM"))
1391 {
1392 return process_garmin_pndm(data, tags);
1393 }
1394
1395 false
1396}
1397
1398fn process_dji_text(text: &str, tags: &mut Vec<Tag>) -> bool {
1399 let gps_start = text.find("GPS (").or_else(|| text.find("GPS("));
1401 if let Some(idx) = gps_start {
1402 let rest = &text[idx..];
1403 if let Some(paren_start) = rest.find('(') {
1404 if let Some(paren_end) = rest.find(')') {
1405 let inner = &rest[paren_start + 1..paren_end];
1406 let parts: Vec<&str> = inner.split(',').collect();
1407 if parts.len() >= 2 {
1408 if let (Ok(lon), Ok(lat)) = (
1409 parts[0].trim().parse::<f64>(),
1410 parts[1].trim().parse::<f64>(),
1411 ) {
1412 tags.push(mk_gps_lat(lat));
1413 tags.push(mk_gps_lon(lon));
1414 if parts.len() >= 3 {
1415 if let Ok(alt) = parts[2].trim().parse::<f64>() {
1416 tags.push(mk_gps_alt(alt));
1417 }
1418 }
1419 }
1420 }
1421 }
1422 }
1423 }
1424
1425 if let Some(idx) = text.find("H.S ") {
1427 let rest = &text[idx + 4..];
1428 if let Some(end) = rest.find("m/s") {
1429 if let Ok(spd) = rest[..end].trim().parse::<f64>() {
1430 tags.push(mk_gps_spd(spd * MPS_TO_KPH));
1431 }
1432 }
1433 }
1434
1435 if let Some(idx) = text.find("ISO ") {
1437 let rest = &text[idx + 4..];
1438 let val: String = rest.chars().take_while(|c| c.is_ascii_digit()).collect();
1439 if !val.is_empty() {
1440 tags.push(mk_stream("ISO", "ISO", Value::String(val)));
1441 }
1442 }
1443
1444 true
1445}
1446
1447fn process_garmin_pndm(data: &[u8], tags: &mut Vec<Tag>) -> bool {
1448 let offset = if data.starts_with(b"PNDM") { 0 } else { 4 };
1449 if data.len() < offset + 20 {
1450 return false;
1451 }
1452 let lat = get_i32_be(data, offset + 12) as f64 * 180.0 / 0x80000000u32 as f64;
1453 let lon = get_i32_be(data, offset + 16) as f64 * 180.0 / 0x80000000u32 as f64;
1454 let spd = get_u16_be(data, offset + 8) as f64 * MPH_TO_KPH;
1455
1456 tags.push(mk_gps_lat(lat));
1457 tags.push(mk_gps_lon(lon));
1458 tags.push(mk_gps_spd(spd));
1459 true
1460}
1461
1462fn process_rvmi(data: &[u8], tags: &mut Vec<Tag>) -> bool {
1465 if data.len() < 20 {
1466 return false;
1467 }
1468 if &data[0..4] == b"gReV" {
1469 let lat = get_i32_le(data, 4) as f64 / 1e6;
1471 let lon = get_i32_le(data, 8) as f64 / 1e6;
1472 let spd = get_i16_le(data, 16) as f64 / 10.0;
1473 let trk = get_u16_le(data, 18) as f64 * 2.0;
1474 tags.push(mk_gps_lat(lat));
1475 tags.push(mk_gps_lon(lon));
1476 tags.push(mk_gps_spd(spd));
1477 tags.push(mk_gps_trk(trk));
1478 return true;
1479 }
1480 if &data[0..4] == b"sReV" {
1481 if data.len() >= 10 {
1483 let x = get_i16_le(data, 4) as f64 / 1000.0;
1484 let y = get_i16_le(data, 6) as f64 / 1000.0;
1485 let z = get_i16_le(data, 8) as f64 / 1000.0;
1486 tags.push(mk_stream(
1487 "GSensor",
1488 "G Sensor",
1489 Value::String(format!("{} {} {}", x, y, z)),
1490 ));
1491 return true;
1492 }
1493 }
1494 false
1495}
1496
1497fn process_kenwood(data: &[u8], tags: &mut Vec<Tag>) -> bool {
1500 let mut found = false;
1502 let mut pos = 0;
1503 while pos + 2 < data.len() {
1504 if let Some(idx) = data[pos..].windows(2).position(|w| w == b"\xfe\xfe") {
1506 let start = pos + idx + 2;
1507 if start + 40 > data.len() {
1508 break;
1509 }
1510 let dat = &data[start..];
1511 if let Some(dt) = try_ascii_digits(dat, 14) {
1513 if dt.len() == 14 {
1514 let time = format!(
1515 "{}:{}:{} {}:{}:{}",
1516 &dt[0..4],
1517 &dt[4..6],
1518 &dt[6..8],
1519 &dt[8..10],
1520 &dt[10..12],
1521 &dt[12..14]
1522 );
1523
1524 let after = &dat[15..]; if after.len() < 20 {
1527 pos = start + 14;
1528 continue;
1529 }
1530 let after2 = if after.len() > 15 {
1532 &after[15..]
1533 } else {
1534 after
1535 };
1536
1537 if !after2.is_empty() && is_ns(after2[0]) {
1539 let lat_ref = after2[0];
1540 let mut ew_pos = 1;
1542 while ew_pos < after2.len() && !is_ew(after2[ew_pos]) {
1543 ew_pos += 1;
1544 }
1545 if ew_pos < after2.len() {
1546 let lon_ref = after2[ew_pos];
1547 let lat_digits = &after2[1..ew_pos];
1548 let lon_start = ew_pos + 1;
1550 let mut lon_end = lon_start;
1551 while lon_end < after2.len() && after2[lon_end].is_ascii_digit() {
1552 lon_end += 1;
1553 }
1554 let lon_digits = &after2[lon_start..lon_end];
1555
1556 if let (Ok(lat_s), Ok(lon_s)) = (
1557 std::str::from_utf8(lat_digits),
1558 std::str::from_utf8(lon_digits),
1559 ) {
1560 if let (Ok(lat_raw), Ok(lon_raw)) =
1561 (lat_s.parse::<f64>(), lon_s.parse::<f64>())
1562 {
1563 let lat = lat_raw / 1e4;
1564 let lon = lon_raw / 1e4;
1565 let (lat_dd, lon_dd) = convert_lat_lon(lat, lon);
1566
1567 tags.push(mk_gps_dt(&time));
1568 tags.push(mk_gps_lat(
1569 lat_dd * if lat_ref == b'S' { -1.0 } else { 1.0 },
1570 ));
1571 tags.push(mk_gps_lon(
1572 lon_dd * if lon_ref == b'W' { -1.0 } else { 1.0 },
1573 ));
1574 found = true;
1575
1576 if lon_end + 9 <= after2.len() {
1578 if let Ok(rest) =
1579 std::str::from_utf8(&after2[lon_end..lon_end + 9])
1580 {
1581 if rest.starts_with('+') || rest.starts_with('-') {
1583 if let Ok(alt) = rest[0..5].parse::<f64>() {
1584 tags.push(mk_gps_alt(alt));
1585 }
1586 if let Ok(spd) = rest[5..].parse::<f64>() {
1587 tags.push(mk_gps_spd(spd));
1588 }
1589 }
1590 }
1591 }
1592 }
1593 }
1594 }
1595 }
1596 }
1597 }
1598 pos = start + 40;
1599 } else {
1600 break;
1601 }
1602 }
1603 found
1604}
1605
1606fn scan_mdat_for_freegps(data: &[u8], tags: &mut Vec<Tag>, doc_count: &mut u32) {
1609 let pattern = b"freeGPS ";
1611 let mut pos = 0;
1612 let limit = data.len().min(20_000_000); while pos + 12 < limit {
1615 if let Some(idx) = data[pos..limit].windows(8).position(|w| w == pattern) {
1616 let abs_pos = pos + idx;
1617 if abs_pos >= 4 {
1619 let atom_start = abs_pos - 4;
1620 let atom_size = u32::from_be_bytes([
1621 data[atom_start],
1622 data[atom_start + 1],
1623 data[atom_start + 2],
1624 data[atom_start + 3],
1625 ]) as usize;
1626 let atom_size = if atom_size < 12 { 12 } else { atom_size };
1627 let end = (atom_start + atom_size).min(data.len());
1628 let block = &data[atom_start..end];
1629
1630 let mut sample_tags = Vec::new();
1631 if process_freegps(block, &mut sample_tags) && !sample_tags.is_empty() {
1632 *doc_count += 1;
1633 for t in &mut sample_tags {
1634 t.description = format!("{} (Doc{})", t.description, doc_count);
1635 }
1636 tags.extend(sample_tags);
1637 }
1638 pos = end;
1639 } else {
1640 pos = abs_pos + 8;
1641 }
1642 } else {
1643 break;
1644 }
1645 }
1646}
1647
1648fn is_ns(b: u8) -> bool {
1651 b == b'N' || b == b'S'
1652}
1653fn is_ew(b: u8) -> bool {
1654 b == b'E' || b == b'W'
1655}
1656
1657fn convert_lat_lon(lat: f64, lon: f64) -> (f64, f64) {
1659 let lat_deg = (lat / 100.0).floor();
1660 let lat_dd = lat_deg + (lat - lat_deg * 100.0) / 60.0;
1661 let lon_deg = (lon / 100.0).floor();
1662 let lon_dd = lon_deg + (lon - lon_deg * 100.0) / 60.0;
1663 (lat_dd, lon_dd)
1664}
1665
1666fn signed_u32(v: u32) -> i32 {
1667 v as i32 }
1669
1670fn get_u16_be(data: &[u8], off: usize) -> u16 {
1671 u16::from_be_bytes([data[off], data[off + 1]])
1672}
1673
1674fn get_u16_le(data: &[u8], off: usize) -> u16 {
1675 u16::from_le_bytes([data[off], data[off + 1]])
1676}
1677
1678fn get_u32_be(data: &[u8], off: usize) -> u32 {
1679 u32::from_be_bytes([data[off], data[off + 1], data[off + 2], data[off + 3]])
1680}
1681
1682fn get_u32_le(data: &[u8], off: usize) -> u32 {
1683 u32::from_le_bytes([data[off], data[off + 1], data[off + 2], data[off + 3]])
1684}
1685
1686fn get_i32_be(data: &[u8], off: usize) -> i32 {
1687 i32::from_be_bytes([data[off], data[off + 1], data[off + 2], data[off + 3]])
1688}
1689
1690fn get_i32_le(data: &[u8], off: usize) -> i32 {
1691 i32::from_le_bytes([data[off], data[off + 1], data[off + 2], data[off + 3]])
1692}
1693
1694fn get_i16_be(data: &[u8], off: usize) -> i16 {
1695 i16::from_be_bytes([data[off], data[off + 1]])
1696}
1697
1698fn get_i16_le(data: &[u8], off: usize) -> i16 {
1699 i16::from_le_bytes([data[off], data[off + 1]])
1700}
1701
1702fn get_f32_le(data: &[u8], off: usize) -> f32 {
1703 f32::from_le_bytes([data[off], data[off + 1], data[off + 2], data[off + 3]])
1704}
1705
1706fn get_f64_le(data: &[u8], off: usize) -> f64 {
1707 f64::from_le_bytes([
1708 data[off],
1709 data[off + 1],
1710 data[off + 2],
1711 data[off + 3],
1712 data[off + 4],
1713 data[off + 5],
1714 data[off + 6],
1715 data[off + 7],
1716 ])
1717}
1718
1719fn try_ascii_digits(data: &[u8], max_len: usize) -> Option<String> {
1720 let end = data.len().min(max_len);
1721 let slice = &data[..end];
1722 if slice.iter().all(|b| b.is_ascii_digit()) {
1723 Some(crate::encoding::decode_utf8_or_latin1(slice).to_string())
1724 } else {
1725 None
1726 }
1727}
1728
1729fn mk_stream(name: &str, description: &str, value: Value) -> Tag {
1732 let print_value = value.to_display_string();
1733 Tag {
1734 id: TagId::Text(name.to_string()),
1735 name: name.to_string(),
1736 description: description.to_string(),
1737 group: TagGroup {
1738 family0: "QuickTime".into(),
1739 family1: "QuickTime".into(),
1740 family2: "Location".into(),
1741 },
1742 raw_value: value,
1743 print_value,
1744 priority: 0,
1745 }
1746}
1747
1748fn mk_gps_dt(dt: &str) -> Tag {
1749 Tag {
1750 id: TagId::Text("GPSDateTime".into()),
1751 name: "GPSDateTime".into(),
1752 description: "GPS Date/Time".into(),
1753 group: TagGroup {
1754 family0: "QuickTime".into(),
1755 family1: "QuickTime".into(),
1756 family2: "Time".into(),
1757 },
1758 raw_value: Value::String(dt.to_string()),
1759 print_value: dt.to_string(),
1760 priority: 0,
1761 }
1762}
1763
1764fn mk_gps_lat(val: f64) -> Tag {
1765 let abs_val = val.abs();
1766 let d = abs_val.floor() as u32;
1767 let m_total = (abs_val - d as f64) * 60.0;
1768 let m = m_total.floor() as u32;
1769 let s = (m_total - m as f64) * 60.0;
1770 let ref_c = if val >= 0.0 { "N" } else { "S" };
1771 let print = format!("{} deg {}' {:.2}\" {}", d, m, s, ref_c);
1772 Tag {
1773 id: TagId::Text("GPSLatitude".into()),
1774 name: "GPSLatitude".into(),
1775 description: "GPS Latitude".into(),
1776 group: TagGroup {
1777 family0: "QuickTime".into(),
1778 family1: "QuickTime".into(),
1779 family2: "Location".into(),
1780 },
1781 raw_value: Value::F64(val),
1782 print_value: print,
1783 priority: 0,
1784 }
1785}
1786
1787fn mk_gps_lon(val: f64) -> Tag {
1788 let abs_val = val.abs();
1789 let d = abs_val.floor() as u32;
1790 let m_total = (abs_val - d as f64) * 60.0;
1791 let m = m_total.floor() as u32;
1792 let s = (m_total - m as f64) * 60.0;
1793 let ref_c = if val >= 0.0 { "E" } else { "W" };
1794 let print = format!("{} deg {}' {:.2}\" {}", d, m, s, ref_c);
1795 Tag {
1796 id: TagId::Text("GPSLongitude".into()),
1797 name: "GPSLongitude".into(),
1798 description: "GPS Longitude".into(),
1799 group: TagGroup {
1800 family0: "QuickTime".into(),
1801 family1: "QuickTime".into(),
1802 family2: "Location".into(),
1803 },
1804 raw_value: Value::F64(val),
1805 print_value: print,
1806 priority: 0,
1807 }
1808}
1809
1810fn mk_gps_alt(val: f64) -> Tag {
1811 Tag {
1812 id: TagId::Text("GPSAltitude".into()),
1813 name: "GPSAltitude".into(),
1814 description: "GPS Altitude".into(),
1815 group: TagGroup {
1816 family0: "QuickTime".into(),
1817 family1: "QuickTime".into(),
1818 family2: "Location".into(),
1819 },
1820 raw_value: Value::F64(val),
1821 print_value: format!("{:.4} m", val),
1822 priority: 0,
1823 }
1824}
1825
1826fn mk_gps_spd(val: f64) -> Tag {
1827 Tag {
1828 id: TagId::Text("GPSSpeed".into()),
1829 name: "GPSSpeed".into(),
1830 description: "GPS Speed".into(),
1831 group: TagGroup {
1832 family0: "QuickTime".into(),
1833 family1: "QuickTime".into(),
1834 family2: "Location".into(),
1835 },
1836 raw_value: Value::F64(val),
1837 print_value: format!("{:.4}", val),
1838 priority: 0,
1839 }
1840}
1841
1842fn mk_gps_trk(val: f64) -> Tag {
1843 Tag {
1844 id: TagId::Text("GPSTrack".into()),
1845 name: "GPSTrack".into(),
1846 description: "GPS Track".into(),
1847 group: TagGroup {
1848 family0: "QuickTime".into(),
1849 family1: "QuickTime".into(),
1850 family2: "Location".into(),
1851 },
1852 raw_value: Value::F64(val),
1853 print_value: format!("{:.4}", val),
1854 priority: 0,
1855 }
1856}