test-bench-nano-hexapod/test-bench-nano-hexapod.org

15 KiB

Nano-Hexapod - Test Bench


This report is also available as a pdf.


Introduction   ignore

Test-Bench Description

Here are the documentation of the equipment used for this test bench:

  • Voltage Amplifier: PiezoDrive PD200
  • Amplified Piezoelectric Actuator: Cedrat APA300ML
  • DAC/ADC: Speedgoat IO313
  • Encoder: Renishaw Vionic and used Ruler
  • Interferometers: Attocube
/tdehaeze/test-bench-nano-hexapod/media/commit/81808a93d405a52a5dc63771f87758b628b16be0/figs/IMG_20210608_152917.jpg
Nano-Hexapod
/tdehaeze/test-bench-nano-hexapod/media/commit/81808a93d405a52a5dc63771f87758b628b16be0/figs/IMG_20210608_154722.jpg
Nano-Hexapod and the control electronics

Encoders fixed to the Struts

Introduction

Load Data

meas_data_lf = {};

for i = 1:6
    meas_data_lf(i) = {load(sprintf('mat/frf_data_exc_strut_%i_noise_lf.mat', i), 't', 'Va', 'Vs', 'de')};
    meas_data_hf(i) = {load(sprintf('mat/frf_data_exc_strut_%i_noise_hf.mat', i), 't', 'Va', 'Vs', 'de')};
end

Spectral Analysis - Setup

% Sampling Time [s]
Ts = (meas_data_lf{1}.t(end) - (meas_data_lf{1}.t(1)))/(length(meas_data_lf{1}.t)-1);

% Sampling Frequency [Hz]
Fs = 1/Ts;

% Hannning Windows
win = hanning(ceil(1*Fs));

And we get the frequency vector.

[~, f] = tfestimate(meas_data_lf{1}.Va, meas_data_lf{1}.de, win, [], [], 1/Ts);
i_lf = f < 250; % Points for low frequency excitation
i_hf = f > 250; % Points for high frequency excitation

DVF Plant

First, let's compute the coherence from the excitation voltage and the displacement as measured by the encoders (Figure fig:enc_struts_dvf_coh).

%% Coherence
coh_dvf_lf = zeros(length(f), 6, 6);
coh_dvf_hf = zeros(length(f), 6, 6);

for i = 1:6
    coh_dvf_lf(:, :, i) = mscohere(meas_data_lf{i}.Va, meas_data_lf{i}.de, win, [], [], 1/Ts);
    coh_dvf_hf(:, :, i) = mscohere(meas_data_hf{i}.Va, meas_data_hf{i}.de, win, [], [], 1/Ts);
end

/tdehaeze/test-bench-nano-hexapod/media/commit/81808a93d405a52a5dc63771f87758b628b16be0/figs/enc_struts_dvf_coh.png

Obtained coherence for the DVF plant

Then the 6x6 transfer function matrix is estimated (Figure fig:enc_struts_dvf_frf).

%% DVF Plant
G_dvf_lf = zeros(length(f), 6, 6);
G_dvf_hf = zeros(length(f), 6, 6);

for i = 1:6
    G_dvf_lf(:, :, i) = tfestimate(meas_data_lf{i}.Va, meas_data_lf{i}.de, win, [], [], 1/Ts);
    G_dvf_hf(:, :, i) = tfestimate(meas_data_hf{i}.Va, meas_data_hf{i}.de, win, [], [], 1/Ts);
end

/tdehaeze/test-bench-nano-hexapod/media/commit/81808a93d405a52a5dc63771f87758b628b16be0/figs/enc_struts_dvf_frf.png

Measured FRF for the DVF plant

IFF Plant

First, let's compute the coherence from the excitation voltage and the displacement as measured by the encoders (Figure fig:enc_struts_iff_coh).

%% Coherence
coh_iff_lf = zeros(length(f), 6, 6);
coh_iff_hf = zeros(length(f), 6, 6);

for i = 1:6
    coh_iff_lf(:, :, i) = mscohere(meas_data_lf{i}.Va, meas_data_lf{i}.Vs, win, [], [], 1/Ts);
    coh_iff_hf(:, :, i) = mscohere(meas_data_hf{i}.Va, meas_data_hf{i}.Vs, win, [], [], 1/Ts);
end

/tdehaeze/test-bench-nano-hexapod/media/commit/81808a93d405a52a5dc63771f87758b628b16be0/figs/enc_struts_iff_coh.png

Obtained coherence for the IFF plant

Then the 6x6 transfer function matrix is estimated (Figure fig:enc_struts_iff_frf).

%% IFF Plant
G_iff_lf = zeros(length(f), 6, 6);
G_iff_hf = zeros(length(f), 6, 6);

for i = 1:6
    G_iff_lf(:, :, i) = tfestimate(meas_data_lf{i}.Va, meas_data_lf{i}.Vs, win, [], [], 1/Ts);
    G_iff_hf(:, :, i) = tfestimate(meas_data_hf{i}.Va, meas_data_hf{i}.Vs, win, [], [], 1/Ts);
end

/tdehaeze/test-bench-nano-hexapod/media/commit/81808a93d405a52a5dc63771f87758b628b16be0/figs/enc_struts_iff_frf.png

Measured FRF for the IFF plant

Jacobian

load('jacobian.mat', 'J');

DVF Plant

G_dvf_J_lf = permute(pagemtimes(inv(J), pagemtimes(permute(G_dvf_lf, [2 3 1]), inv(J'))), [3 1 2]);
G_dvf_J_hf = permute(pagemtimes(inv(J), pagemtimes(permute(G_dvf_hf, [2 3 1]), inv(J'))), [3 1 2]);

IFF Plant

G_iff_J_lf = permute(pagemtimes(inv(J), pagemtimes(permute(G_iff_lf, [2 3 1]), inv(J'))), [3 1 2]);
G_iff_J_hf = permute(pagemtimes(inv(J), pagemtimes(permute(G_iff_hf, [2 3 1]), inv(J'))), [3 1 2]);