first huddle test
This commit is contained in:
commit
979186e75d
36
.gitignore
vendored
Normal file
36
.gitignore
vendored
Normal file
@ -0,0 +1,36 @@
|
||||
# Windows default autosave extension
|
||||
*.asv
|
||||
*rtw/
|
||||
|
||||
# OSX / *nix default autosave extension
|
||||
*.m~
|
||||
|
||||
# Compiled MEX binaries (all platforms)
|
||||
*.mex*
|
||||
|
||||
# Packaged app and toolbox files
|
||||
*.mlappinstall
|
||||
*.slxc
|
||||
*.mldatx
|
||||
*.mltbx
|
||||
*.xml
|
||||
piezoapa_slrt_rtw/
|
||||
|
||||
# Generated helpsearch folders
|
||||
helpsearch*/
|
||||
|
||||
# Simulink code generation folders
|
||||
slprj/
|
||||
sccprj/
|
||||
|
||||
# Matlab code generation folders
|
||||
codegen/
|
||||
|
||||
# Simulink autosave extension
|
||||
*.autosave
|
||||
|
||||
# Simulink cache files
|
||||
*.slxc
|
||||
|
||||
# Octave session info
|
||||
octave-workspace
|
BIN
mat/huddle_test.mat
Normal file
BIN
mat/huddle_test.mat
Normal file
Binary file not shown.
113
runtest.m
Normal file
113
runtest.m
Normal file
@ -0,0 +1,113 @@
|
||||
tg = slrt;
|
||||
|
||||
%%
|
||||
f = SimulinkRealTime.openFTP(tg);
|
||||
mget(f, 'apa95ml.dat', 'data');
|
||||
close(f);
|
||||
|
||||
%% Convert the Data
|
||||
data = SimulinkRealTime.utils.getFileScopeData('data/apa95ml.dat').data;
|
||||
|
||||
acc_1 = data(:, 1);
|
||||
acc_2 = data(:, 2);
|
||||
geo_1 = data(:, 3);
|
||||
geo_2 = data(:, 4);
|
||||
t = data(:, 5);
|
||||
|
||||
save('./mat/huddle_test.mat', 'acc_1', 'acc_2', 'geo_1', 'geo_2', 't');
|
||||
|
||||
%%
|
||||
figure;
|
||||
subplot(1,2,1);
|
||||
plot(t, u)
|
||||
subplot(1,2,2);
|
||||
plot(t, y)
|
||||
|
||||
%%
|
||||
load('../mat/apa95ml_5kg_10V.mat', 'u', 't', 'y');
|
||||
ht = load('../mat/huddle_test.mat', 'u', 't', 'y');
|
||||
u = u - mean(u);
|
||||
y = y - mean(y);
|
||||
|
||||
%%
|
||||
[pxx, f] = pwelch(y, win, [], [], 1/Ts);
|
||||
[pht, ~] = pwelch(ht.y, win, [], [], 1/Ts);
|
||||
|
||||
figure;
|
||||
|
||||
hold on;
|
||||
plot(f, pxx);
|
||||
plot(f, pht);
|
||||
hold off;
|
||||
set(gca, 'Xscale', 'log'); set(gca, 'Yscale', 'log');
|
||||
ylabel('PSD'); xlabel('Frequency [Hz]');
|
||||
|
||||
%%
|
||||
run setup;
|
||||
|
||||
win = hann(ceil(0.1/Ts));
|
||||
|
||||
[tf_est, f] = tfestimate(u, y, win, [], [], 1/Ts);
|
||||
[co_est, ~] = mscohere(u, y, win, [], [], 1/Ts);
|
||||
|
||||
%%
|
||||
figure;
|
||||
|
||||
hold on;
|
||||
plot(f, co_est, 'k-')
|
||||
set(gca, 'Xscale', 'log'); set(gca, 'Yscale', 'lin');
|
||||
ylabel('Coherence'); xlabel('Frequency [Hz]');
|
||||
hold off;
|
||||
|
||||
%%
|
||||
figure;
|
||||
ax1 = subplot(2, 1, 1);
|
||||
hold on;
|
||||
plot(f, abs(tf_est), 'k-', 'DisplayName', 'Identified')
|
||||
set(gca, 'Xscale', 'log'); set(gca, 'Yscale', 'log');
|
||||
ylabel('Amplitude'); xlabel('Frequency [Hz]');
|
||||
hold off;
|
||||
|
||||
ax2 = subplot(2, 1, 2);
|
||||
hold on;
|
||||
plot(f, 180/pi*unwrap(angle(-tf_est)), 'k-')
|
||||
set(gca, 'Xscale', 'log'); set(gca, 'Yscale', 'lin');
|
||||
ylabel('Phase'); xlabel('Frequency [Hz]');
|
||||
hold off;
|
||||
|
||||
linkaxes([ax1,ax2], 'x');
|
||||
xlim([10, 5000]);
|
||||
|
||||
%%
|
||||
win = hann(ceil(0.2/Ts));
|
||||
|
||||
[tf_est, f] = tfestimate(u, v, win, [], [], 1/Ts);
|
||||
[co_est, ~] = mscohere(u, v, win, [], [], 1/Ts);
|
||||
|
||||
%%
|
||||
figure;
|
||||
|
||||
hold on;
|
||||
plot(f, co_est, 'k-')
|
||||
set(gca, 'Xscale', 'log'); set(gca, 'Yscale', 'lin');
|
||||
ylabel('Coherence'); xlabel('Frequency [Hz]');
|
||||
hold off;
|
||||
|
||||
%%
|
||||
figure;
|
||||
ax1 = subplot(2, 1, 1);
|
||||
hold on;
|
||||
plot(f, abs(tf_est), 'k-', 'DisplayName', 'Identified')
|
||||
set(gca, 'Xscale', 'log'); set(gca, 'Yscale', 'log');
|
||||
ylabel('Amplitude'); xlabel('Frequency [Hz]');
|
||||
hold off;
|
||||
|
||||
ax2 = subplot(2, 1, 2);
|
||||
hold on;
|
||||
plot(f, 180/pi*unwrap(angle(-tf_est)), 'k-')
|
||||
set(gca, 'Xscale', 'log'); set(gca, 'Yscale', 'lin');
|
||||
ylabel('Phase'); xlabel('Frequency [Hz]');
|
||||
hold off;
|
||||
|
||||
linkaxes([ax1,ax2], 'x');
|
||||
xlim([10, 5000]);
|
BIN
sensor_fusion_test_bench.slx
Normal file
BIN
sensor_fusion_test_bench.slx
Normal file
Binary file not shown.
Loading…
Reference in New Issue
Block a user