Working on IMU extended calibration- have visual representation in JavaFX 3D and can calculate calibration ellipse- now need to figure out how to show ellips ein 3D so human can manually check calibration is OK. Also, fixed bug in Madgwick- not entirley sure if MATLAB is wrong so now Java is wrong or Java was wrong and now right....