fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-16 05:53:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

Matlab tools: Add ellipsoid fit

Browse Source
This commit is contained in:
Lorenz Meier
2015-06-25 14:44:23 +02:00
parent baca229b95
commit a4a6e69521
2 changed files with 199 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
Tools/Matlab/plot_mag.m
+25 -6
View File
@@ -1,6 +1,19 @@
%
% Tool for plotting mag data
%
% Reference values:
% telem> [cal] mag #0 off: x:0.15 y:0.07 z:0.14 Ga
% MATLAB: x:0.1581 y: 0.0701 z: 0.1439 Ga
% telem> [cal] mag #0 scale: x:1.10 y:0.97 z:1.02
% MATLAB: 0.5499, 0.5190, 0.4907
%
% telem> [cal] mag #1 off: x:-0.18 y:0.11 z:-0.09 Ga
% MATLAB: x:-0.1827 y:0.1147 z:-0.0848 Ga
% telem> [cal] mag #1 scale: x:1.00 y:1.00 z:1.00
% MATLAB: 0.5122, 0.5065, 0.4915
%
%
close all;
clear all;
@@ -13,11 +26,11 @@ ymin = -ymax;
zmax = plot_scale;
zmin = -zmax;
mag0_raw = load('../../mag0_raw.csv');
mag1_raw = load('../../mag1_raw.csv');
mag0_raw = load('../../mag0_raw2.csv');
mag1_raw = load('../../mag1_raw2.csv');
mag0_cal = load('../../mag0_cal.csv');
mag1_cal = load('../../mag1_cal.csv');
mag0_cal = load('../../mag0_cal2.csv');
mag1_cal = load('../../mag1_cal2.csv');
fm0r = figure();
@@ -25,15 +38,21 @@ mag0_x_scale = 1.07;
mag0_y_scale = 0.95;
mag0_z_scale = 1.00;
plot3(mag0_raw(:,1) .* mag0_x_scale, mag0_raw(:,2) .* mag0_y_scale, mag0_raw(:,3) .* mag0_z_scale, '*r');
plot3(mag0_raw(:,1), mag0_raw(:,2), mag0_raw(:,3), '*r');
[center, radii, evecs, pars ] = ellipsoid_fit( [mag0_raw(:,1) mag0_raw(:,2) mag0_raw(:,3)] );
center
radii
axis([xmin xmax ymin ymax zmin zmax])
fm1r = figure();
plot3(mag1_raw(:,1), mag1_raw(:,2), mag1_raw(:,3), '*r');
[center, radii, evecs, pars ] = ellipsoid_fit( [mag1_raw(:,1) mag1_raw(:,2) mag1_raw(:,3)] );
center
radii
axis([xmin xmax ymin ymax zmin zmax])
fm0c = figure();
plot3(mag0_cal(:,1), mag0_cal(:,2), mag0_cal(:,3), '*b');
plot3(mag0_cal(:,1) .* mag0_x_scale, mag0_cal(:,2) .* mag0_y_scale, mag0_cal(:,3) .* mag0_z_scale, '*b');
axis([xmin xmax ymin ymax zmin zmax])
fm1c = figure();