LUMZ-bioz/bioz-firmware-rs
1
0
Fork 0
mirror of https://github.com/hubaldv/bioz-firmware-rs.git synced 2025-12-06 05:01:18 +00:00
Code Issues Packages Projects Releases Wiki Activity

Prevent phase wrap.

Browse Source
This commit is contained in:
Hubald Verzijl
2025-11-06 14:09:11 +01:00
parent 11dbf2a8d8
commit 04959ce9cb
1 changed files with 19 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

21
src/impedance.rs
View File

@@ -12,6 +12,7 @@ use static_cell::StaticCell;
use heapless::Vec;
use num::complex::Complex;
use core::f32::consts::PI;
use crate::ad5940::*;
use crate::ad5940_registers::*;
@@ -911,7 +912,15 @@ pub fn calculate_impedance_2_lead(data: [u32; 4]) -> ImpedanceResult {
let (rz_mag, rz_phase) = dft_rz.to_polar();
let magnitude = (rcal_mag / rz_mag) * RCAL;
let phase = rcal_phase - rz_phase;
let mut phase = rcal_phase - rz_phase;
// Normalize phase to [-π, π]
if phase > PI {
phase -= 2.0 * PI;
}
else if phase < -PI {
phase += 2.0 * PI;
}
ImpedanceResult { magnitude, phase }
}
@@ -940,7 +949,15 @@ pub fn calculate_impedance_4_lead(data: [u32; 4], rtia: &RtiaCalibrationResult)
// Calculate impedance using calibrated Rtia
let magnitude = volt_mag / curr_mag * rtia.magnitude;
let phase = volt_phase - curr_phase + rtia.phase;
let mut phase = volt_phase - curr_phase + rtia.phase;
// Normalize phase to [-π, π]
if phase > PI {
phase -= 2.0 * PI;
}
else if phase < -PI {
phase += 2.0 * PI;
}
let data = ImpedanceResult {
magnitude,