first stage of clean-up and recovery from linking attempt
This commit is contained in:
parent
f4e2a211e2
commit
fd37ad6b50
3 changed files with 32 additions and 329 deletions
|
|
@ -298,14 +298,25 @@ void calibrate()
|
|||
int16_t y_offset = 0;
|
||||
int16_t z_offset = 0;
|
||||
|
||||
uint32_t sample_counter = 0;
|
||||
|
||||
|
||||
MagnetometerData data;
|
||||
while (i < range) {
|
||||
i += 1;
|
||||
|
||||
if (magnetometer->isDataReady()) {
|
||||
|
||||
sample_counter++;
|
||||
magnetometer->readData(data);
|
||||
|
||||
Serial.print("CALRAW ");
|
||||
Serial.print("X:");
|
||||
Serial.print(data.raw.x);
|
||||
Serial.print(" Y:");
|
||||
Serial.print(data.raw.y);
|
||||
Serial.print(" Z:");
|
||||
Serial.println(data.raw.z);
|
||||
|
||||
x = (data.raw.x + x) / 2;
|
||||
y = (data.raw.y + y) / 2;
|
||||
z = (data.raw.z + z) / 2;
|
||||
|
|
@ -333,13 +344,29 @@ void calibrate()
|
|||
z_max = z;
|
||||
i = 0;
|
||||
}
|
||||
int j = round(10 * i / range);
|
||||
/* int j = round(10 * i / range);
|
||||
|
||||
Serial.print("[");
|
||||
for (int k = 0; k < j; ++k) {
|
||||
Serial.print("*");
|
||||
}
|
||||
Serial.println("]");
|
||||
Serial.println("]"); */
|
||||
if ((sample_counter % 100) == 0) {
|
||||
Serial.print("CALSTAT i=");
|
||||
Serial.print(i);
|
||||
Serial.print(" x_min=");
|
||||
Serial.print(x_min);
|
||||
Serial.print(" x_max=");
|
||||
Serial.print(x_max);
|
||||
Serial.print(" y_min=");
|
||||
Serial.print(y_min);
|
||||
Serial.print(" y_max=");
|
||||
Serial.print(y_max);
|
||||
Serial.print(" z_min=");
|
||||
Serial.print(z_min);
|
||||
Serial.print(" z_max=");
|
||||
Serial.println(z_max);
|
||||
}
|
||||
}
|
||||
delay(5);
|
||||
}
|
||||
|
|
|
|||
Loading…
Add table
Add a link
Reference in a new issue