7575aee987
Lot's of new things: - try to use less .mat files - computation of setpoint and error in the cartesian frame fixed to the granite - change of base to have the errors w.r.t. the NASS base - add script to plot setpoint, position and error
51 lines
1.1 KiB
Matlab
51 lines
1.1 KiB
Matlab
%% Plot all 6 errors expressed in the NASS base
|
|
figure;
|
|
|
|
%% Tx
|
|
subaxis(2, 3, 1);
|
|
hold on;
|
|
plot(error_nass.Time, error_nass.Data(:, 1), 'k-', 'DisplayName', '$\epsilon_x$');
|
|
legend();
|
|
hold off;
|
|
xlabel('Time (s)'); ylabel('Position (m)');
|
|
|
|
%% Ty
|
|
subaxis(2, 3, 2);
|
|
hold on;
|
|
plot(error_nass.Time, error_nass.Data(:, 2), 'k-', 'DisplayName', '$\epsilon_y$');
|
|
legend();
|
|
hold off;
|
|
xlabel('Time (s)'); ylabel('Position (m)');
|
|
|
|
%% Tz
|
|
subaxis(2, 3, 3);
|
|
hold on;
|
|
plot(error_nass.Time, error_nass.Data(:, 3), 'k-', 'DisplayName', '$\epsilon_z$');
|
|
legend();
|
|
hold off;
|
|
xlabel('Time (s)'); ylabel('Position (m)');
|
|
|
|
%% Rx
|
|
subaxis(2, 3, 4);
|
|
hold on;
|
|
plot(error_nass.Time, error_nass.Data(:, 4), 'k-', 'DisplayName', '$\epsilon_{\theta_x}$');
|
|
legend();
|
|
hold off;
|
|
xlabel('Time (s)'); ylabel('Rotation (rad)');
|
|
|
|
%% Ry
|
|
subaxis(2, 3, 5);
|
|
hold on;
|
|
plot(error_nass.Time, error_nass.Data(:, 5), 'k-', 'DisplayName', '$\epsilon_{\theta_y}$');
|
|
legend();
|
|
hold off;
|
|
xlabel('Time (s)'); ylabel('Rotation (rad)');
|
|
|
|
%% Rz
|
|
subaxis(2, 3, 6);
|
|
hold on;
|
|
plot(error_nass.Time, error_nass.Data(:, 6), 'k-', 'DisplayName', '$\epsilon_{\theta_z}$');
|
|
legend();
|
|
hold off;
|
|
xlabel('Time (s)'); ylabel('Rotation (rad)');
|