Skip to content

Commit a05d924

Browse files
committed
normalize some timeouts
1 parent 703f6b0 commit a05d924

File tree

1 file changed

+3
-3
lines changed

1 file changed

+3
-3
lines changed

src/sensor/calibration.c

Lines changed: 3 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -584,7 +584,7 @@ int sensor_offsetBias(float *dest1, float *dest2)
584584
return -2; // Timeout
585585
int64_t sampling_start_time = k_uptime_get();
586586
int i = 0;
587-
while (k_uptime_get() < sampling_start_time + 3000)
587+
while (k_uptime_get() - sampling_start_time < 3000)
588588
{
589589
if (sensor_wait_accel(rawData, K_MSEC(1000)))
590590
return -2; // Timeout
@@ -680,14 +680,14 @@ int sensor_6_sideBias(float a_inv[][3])
680680

681681
int64_t sampling_start_time = k_uptime_get();
682682
uint8_t i = 0;
683-
while (k_uptime_get() < sampling_start_time + 1000)
683+
while (k_uptime_get() - sampling_start_time < 1000)
684684
{
685685
if (sensor_wait_accel(rawData, K_MSEC(1000)))
686686
return -2; // Timeout, magneto state not handled here
687687
if (!v_epsilon(rawData, pre_acc, 0.1))
688688
return -1; // Motion detected
689689
magneto_sample(rawData[0], rawData[1], rawData[2], ata, &norm_sum, &sample_count);
690-
if (k_uptime_get() >= sampling_start_time + i * 100)
690+
if (k_uptime_get() - sampling_start_time >= i * 100)
691691
{
692692
printk("#");
693693
i++;

0 commit comments

Comments
 (0)