Skip to content

Commit 6459059

Browse files
authored
Fix linear fit eq (#41)
Signed-off-by: Guillaume W. Bres <[email protected]>
1 parent 492a7e5 commit 6459059

File tree

1 file changed

+12
-12
lines changed

1 file changed

+12
-12
lines changed

src/tracker/fit.rs

Lines changed: 12 additions & 12 deletions
Original file line numberDiff line numberDiff line change
@@ -154,16 +154,16 @@ impl SVTracker {
154154
fitted.azimuth_deg = azim_mid;
155155
fitted.elevation_deg = elev_mid;
156156

157-
// retrieve x_t
158-
let x_t = self
157+
// retrieve x_s
158+
let x_s = self
159159
.buffer
160160
.iter()
161161
.map(|data| data.epoch.duration.to_unit(Unit::Second))
162162
.collect::<Vec<_>>();
163163

164164
// REFSV
165165
let fit = polyfit(
166-
&x_t,
166+
&x_s,
167167
self.buffer
168168
.iter()
169169
.map(|data| data.refsv)
@@ -173,12 +173,12 @@ impl SVTracker {
173173
)
174174
.or(Err(FitError::LinearRegressionFailure))?;
175175

176-
let (srsv, srsv_b) = (fit[0], fit[1]);
176+
let (srsv, srsv_b) = (fit[1], fit[0]);
177177
let refsv = srsv * t_mid_s + srsv_b;
178178

179179
// REFSYS
180180
let fit = polyfit(
181-
&x_t,
181+
&x_s,
182182
self.buffer
183183
.iter()
184184
.map(|data| data.refsys)
@@ -188,7 +188,7 @@ impl SVTracker {
188188
)
189189
.or(Err(FitError::LinearRegressionFailure))?;
190190

191-
let (srsys, srsys_b) = (fit[0], fit[1]);
191+
let (srsys, srsys_b) = (fit[1], fit[0]);
192192
let refsys_fit = srsys * t_mid_s + srsys_b;
193193

194194
// DSG
@@ -201,7 +201,7 @@ impl SVTracker {
201201

202202
// MDTR
203203
let fit = polyfit(
204-
&x_t,
204+
&x_s,
205205
self.buffer
206206
.iter()
207207
.map(|data| data.mdtr)
@@ -211,12 +211,12 @@ impl SVTracker {
211211
)
212212
.or(Err(FitError::LinearRegressionFailure))?;
213213

214-
let (smdt, smdt_b) = (fit[0], fit[1]);
214+
let (smdt, smdt_b) = (fit[1], fit[0]);
215215
let mdtr = smdt * t_mid_s + smdt_b;
216216

217217
// MDIO
218218
let fit = polyfit(
219-
&x_t,
219+
&x_s,
220220
self.buffer
221221
.iter()
222222
.map(|data| data.mdio)
@@ -226,7 +226,7 @@ impl SVTracker {
226226
)
227227
.or(Err(FitError::LinearRegressionFailure))?;
228228

229-
let (smdi, smdi_b) = (fit[0], fit[1]);
229+
let (smdi, smdi_b) = (fit[1], fit[0]);
230230
let mdio = smdi * t_mid_s + smdi_b;
231231

232232
// MSIO
@@ -245,9 +245,9 @@ impl SVTracker {
245245
let msio_len = msio.len();
246246

247247
if msio_len > 0 {
248-
let fit = polyfit(&x_t, &msio, 1).or(Err(FitError::LinearRegressionFailure))?;
248+
let fit = polyfit(&x_s, &msio, 1).or(Err(FitError::LinearRegressionFailure))?;
249249

250-
let (smsi, smsi_b) = (fit[0], fit[1]);
250+
let (smsi, smsi_b) = (fit[1], fit[0]);
251251
let msio_fit = smsi * t_mid_s + smsi_b;
252252

253253
// ISG

0 commit comments

Comments
 (0)