private void _node_CapturedData(float[] data, float deltaT)
{
Quaternion q = new Quaternion();
// Quaternion Data
lbl_qtn_w.Text = "W: " + q.w.ToString("{0:0.0000}");
lbl_qtn_x.Text = "X: " + q.x.ToString("{0:0.0000}");
lbl_qtn_y.Text = "Y: " + q.y.ToString("{0:0.0000}");
lbl_qtn_z.Text = "Z: " + q.z.ToString("{0:0.0000}");
// Accelerometer Data
lbl_accel_x.Text = "X: " + data[0].ToString("{0:0.0000}");
lbl_accel_y.Text = "Y: " + data[1].ToString("{0:0.0000}");
lbl_accel_z.Text = "Z: " + data[2].ToString("{0:0.0000}");
// Gyroscope Data
lbl_gyro_x.Text = "X: " + data[3].ToString("{0:0.0000}");
lbl_gyro_y.Text = "Y: " + data[4].ToString("{0:0.0000}");
lbl_gyro_z.Text = "Z: " + data[5].ToString("{0:0.0000}");
// Magnometer Data
lbl_mag_x.Text = "X: " + data[6].ToString("{0:0.0000}");
lbl_mag_y.Text = "Y: " + data[7].ToString("{0:0.0000}");
lbl_mag_z.Text = "Z: " + data[8].ToString("{0:0.0000}");
if (graphs != null)
{
float[] angles = Fusion.GetTiltArray(data, deltaT);
for (int i = 0; i < 3; i++)
{
graphs[i].AddPoint(deltaT, angles[i]);
}
}
}
