nass-simscape/uniaxial/index.org

125 KiB

Simscape Uniaxial Model

Introduction   ignore

The idea is to use the same model as the full Simscape Model but to restrict the motion only in the vertical direction.

This is done in order to more easily study the system and evaluate control techniques.

Simscape Model

<<sec:simscape_model>>

A schematic of the uniaxial model used for simulations is represented in figure fig:uniaxial-model-nass-flexible.

The perturbations $w$ are:

  • $F_s$: direct forces applied to the sample such as inertia forces and cable forces
  • $F_{rz}$: parasitic forces due to the rotation of the spindle
  • $F_{ty}$: parasitic forces due to scans with the translation stage
  • $D_w$: ground motion

The quantity to $z$ to control is:

  • $D$: the position of the sample with respect to the granite

The measured quantities $v$ are:

  • $D$: the position of the sample with respect to the granite

We study the use of an additional sensor:

  • $F_n$: a force sensor located in the nano-hexapod
  • $v_n$: an absolute velocity sensor located on the top platform of the nano-hexapod
  • $d_r$: a relative motion sensor located in the nano-hexapod

The control signal $u$ is:

  • $F$ the force applied by the nano-hexapod actuator

/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-model-nass-flexible.png

Schematic of the uniaxial model used

Few active damping techniques will be compared in order to decide which sensor is to be included in the system. Schematics of the active damping techniques are displayed in figure fig:uniaxial-model-nass-flexible-active-damping.

/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-model-nass-flexible-active-damping.png

Comparison of used active damping techniques

Undamped System

<<sec:undamped>>

Introduction   ignore

Let's start by study the undamped system.

Init

We initialize all the stages with the default parameters. The nano-hexapod is a piezoelectric hexapod and the sample has a mass of 50kg.

All the controllers are set to 0 (Open Loop).

Identification

We identify the dynamics of the system.

  %% Options for Linearized
  options = linearizeOptions;
  options.SampleTime = 0;

  %% Name of the Simulink File
  mdl = 'sim_nano_station_uniaxial';

The inputs and outputs are defined below and corresponds to the name of simulink blocks.

  %% Input/Output definition
  io(1)  = linio([mdl, '/Dw'],   1, 'input'); % Ground Motion
  io(2)  = linio([mdl, '/Fs'],   1, 'input'); % Force applied on the sample
  io(3)  = linio([mdl, '/Fnl'],  1, 'input'); % Force applied by the NASS
  io(4)  = linio([mdl, '/Fdty'], 1, 'input'); % Parasitic force Ty
  io(5)  = linio([mdl, '/Fdrz'], 1, 'input'); % Parasitic force Rz

  io(6)  = linio([mdl, '/Dsm'],  1, 'output'); % Displacement of the sample
  io(7)  = linio([mdl, '/Fnlm'], 1, 'output'); % Force sensor in NASS's legs
  io(8)  = linio([mdl, '/Dnlm'], 1, 'output'); % Displacement of NASS's legs
  io(9)  = linio([mdl, '/Dgm'],  1, 'output'); % Absolute displacement of the granite
  io(10) = linio([mdl, '/Vlm'],  1, 'output'); % Measured absolute velocity of the top NASS platform

Finally, we use the linearize Matlab function to extract a state space model from the simscape model.

  %% Run the linearization
  G = linearize(mdl, io, options);
  G.InputName  = {'Dw',   ... % Ground Motion [m]
                  'Fs',   ... % Force Applied on Sample [N]
                  'Fn',   ... % Force applied by NASS [N]
                  'Fty',  ... % Parasitic Force Ty [N]
                  'Frz'};     % Parasitic Force Rz [N]
  G.OutputName = {'D',    ... % Measured sample displacement x.r.t. granite [m]
                  'Fnm',  ... % Force Sensor in NASS [N]
                  'Dnm',  ... % Displacement Sensor in NASS [m]
                  'Dgm',  ... % Asbolute displacement of Granite [m]
                  'Vlm'}; ... % Absolute Velocity of NASS [m/s]

Finally, we save the identified system dynamics for further analysis.

  save('./uniaxial/mat/plants.mat', 'G');

Sensitivity to Disturbances

We show several plots representing the sensitivity to disturbances:

  • in figure fig:uniaxial-sensitivity-disturbances the transfer functions from ground motion $D_w$ to the sample position $D$ and the transfer function from direct force on the sample $F_s$ to the sample position $D$ are shown
  • in figure fig:uniaxial-sensitivity-force-dist, it is the effect of parasitic forces of the positioning stages ($F_{ty}$ and $F_{rz}$) on the position $D$ of the sample that are shown
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-sensitivity-disturbances.png
Sensitivity to disturbances (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-sensitivity-force-dist.png
Sensitivity to disturbances (png, pdf)

Noise Budget

We first load the measured PSD of the disturbance.

  load('./disturbances/mat/dist_psd.mat', 'dist_f');

The effect of these disturbances on the distance $D$ is computed below.

The PSD of the obtain distance $D$ due to each of the perturbation is shown in figure fig:uniaxial-psd-dist and the Cumulative Amplitude Spectrum is shown in figure fig:uniaxial-cas-dist.

The Root Mean Square value of the obtained displacement $D$ is computed below and can be determined from the figure fig:uniaxial-cas-dist.

3.3793e-06
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-psd-dist.png
PSD of the effect of disturbances on $D$ (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-cas-dist.png
CAS of the effect of disturbances on $D$ (png, pdf)

Plant

The transfer function from the force $F$ applied by the nano-hexapod to the position of the sample $D$ is shown in figure fig:uniaxial-plant. It corresponds to the plant to control.

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-plant.png
Bode plot of the Plant (png, pdf)

Integral Force Feedback

<<sec:iff>>

Introduction   ignore

/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-model-nass-flexible-iff.png

Uniaxial IFF Control Schematic

Control Design

  load('./uniaxial/mat/plants.mat', 'G');

Let's look at the transfer function from actuator forces in the nano-hexapod to the force sensor in the nano-hexapod legs for all 6 pairs of actuator/sensor.

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_iff_plant.png
Transfer function from forces applied in the legs to force sensor (png, pdf)

The controller for each pair of actuator/sensor is:

  K_iff = -1000/s;
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_iff_open_loop.png
Loop Gain for the Integral Force Feedback (png, pdf)

Identification

Let's initialize the system prior to identification.

  initializeGround();
  initializeGranite();
  initializeTy();
  initializeRy();
  initializeRz();
  initializeMicroHexapod();
  initializeAxisc();
  initializeMirror();
  initializeNanoHexapod(struct('actuator', 'piezo'));
  initializeSample(struct('mass', 50));

All the controllers are set to 0.

  K = tf(0);
  save('./mat/controllers.mat', 'K', '-append');
  K_iff = -K_iff;
  save('./mat/controllers.mat', 'K_iff', '-append');
  K_rmc = tf(0);
  save('./mat/controllers.mat', 'K_rmc', '-append');
  K_dvf = tf(0);
  save('./mat/controllers.mat', 'K_dvf', '-append');
  %% Options for Linearized
  options = linearizeOptions;
  options.SampleTime = 0;

  %% Name of the Simulink File
  mdl = 'sim_nano_station_uniaxial';
  %% Input/Output definition
  io(1)  = linio([mdl, '/Dw'],    1, 'input');  % Ground Motion
  io(2)  = linio([mdl, '/Fs'],    1, 'input');  % Force applied on the sample
  io(3)  = linio([mdl, '/Fnl'],   1, 'input');  % Force applied by the NASS
  io(4)  = linio([mdl, '/Fdty'],  1, 'input');  % Parasitic force Ty
  io(5)  = linio([mdl, '/Fdrz'],  1, 'input');  % Parasitic force Rz

  io(6)  = linio([mdl, '/Dsm'],  1, 'output'); % Displacement of the sample
  io(7)  = linio([mdl, '/Fnlm'], 1, 'output'); % Force sensor in NASS's legs
  io(8)  = linio([mdl, '/Dnlm'], 1, 'output'); % Displacement of NASS's legs
  io(9)  = linio([mdl, '/Dgm'],  1, 'output'); % Absolute displacement of the granite
  io(10) = linio([mdl, '/Vlm'],  1, 'output'); % Measured absolute velocity of the top NASS platform
  %% Run the linearization
  G_iff = linearize(mdl, io, options);
  G_iff.InputName  = {'Dw',   ... % Ground Motion [m]
                      'Fs',   ... % Force Applied on Sample [N]
                      'Fn',   ... % Force applied by NASS [N]
                      'Fty',  ... % Parasitic Force Ty [N]
                      'Frz'};     % Parasitic Force Rz [N]
  G_iff.OutputName = {'D',    ... % Measured sample displacement x.r.t. granite [m]
                      'Fnm',  ... % Force Sensor in NASS [N]
                      'Dnm',  ... % Displacement Sensor in NASS [m]
                      'Dgm',  ... % Asbolute displacement of Granite [m]
                      'Vlm'}; ... % Absolute Velocity of NASS [m/s]
  save('./uniaxial/mat/plants.mat', 'G_iff', '-append');

Sensitivity to Disturbance

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_sensitivity_dist_iff.png
Sensitivity to disturbance once the IFF controller is applied to the system (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_sensitivity_dist_stages_iff.png
Sensitivity to force disturbances in various stages when IFF is applied (png, pdf)

Damped Plant

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_plant_iff_damped.png
Damped Plant after IFF is applied (png, pdf)

Conclusion

Integral Force Feedback:

Relative Motion Control

<<sec:rmc>>

Introduction   ignore

In the Relative Motion Control (RMC), a derivative feedback is applied between the measured actuator displacement to the actuator force input.

/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-model-nass-flexible-rmc.png

Uniaxial RMC Control Schematic

Control Design

  load('./uniaxial/mat/plants.mat', 'G');

Let's look at the transfer function from actuator forces in the nano-hexapod to the measured displacement of the actuator for all 6 pairs of actuator/sensor.

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_rmc_plant.png
Transfer function from forces applied in the legs to leg displacement sensor (png, pdf)

The Relative Motion Controller is defined below. A Low pass Filter is added to make the controller transfer function proper.

  K_rmc = s*50000/(1 + s/2/pi/10000);
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_rmc_open_loop.png
Loop Gain for the Integral Force Feedback (png, pdf)

Identification

Let's initialize the system prior to identification.

  initializeGround();
  initializeGranite();
  initializeTy();
  initializeRy();
  initializeRz();
  initializeMicroHexapod();
  initializeAxisc();
  initializeMirror();
  initializeNanoHexapod(struct('actuator', 'piezo'));
  initializeSample(struct('mass', 50));

And initialize the controllers.

  K = tf(0);
  save('./mat/controllers.mat', 'K', '-append');
  K_iff = tf(0);
  save('./mat/controllers.mat', 'K_iff', '-append');
  K_rmc = -K_rmc;
  save('./mat/controllers.mat', 'K_rmc', '-append');
  K_dvf = tf(0);
  save('./mat/controllers.mat', 'K_dvf', '-append');
  %% Options for Linearized
  options = linearizeOptions;
  options.SampleTime = 0;

  %% Name of the Simulink File
  mdl = 'sim_nano_station_uniaxial';
  %% Input/Output definition
  io(1)  = linio([mdl, '/Dw'],    1, 'input');  % Ground Motion
  io(2)  = linio([mdl, '/Fs'],    1, 'input');  % Force applied on the sample
  io(3)  = linio([mdl, '/Fnl'],   1, 'input');  % Force applied by the NASS
  io(4)  = linio([mdl, '/Fdty'],  1, 'input');  % Parasitic force Ty
  io(5)  = linio([mdl, '/Fdrz'],  1, 'input');  % Parasitic force Rz

  io(6)  = linio([mdl, '/Dsm'],  1, 'output'); % Displacement of the sample
  io(7)  = linio([mdl, '/Fnlm'], 1, 'output'); % Force sensor in NASS's legs
  io(8)  = linio([mdl, '/Dnlm'], 1, 'output'); % Displacement of NASS's legs
  io(9)  = linio([mdl, '/Dgm'],  1, 'output'); % Absolute displacement of the granite
  io(10) = linio([mdl, '/Vlm'],  1, 'output'); % Measured absolute velocity of the top NASS platform
  %% Run the linearization
  G_rmc = linearize(mdl, io, options);
  G_rmc.InputName  = {'Dw',   ... % Ground Motion [m]
                      'Fs',   ... % Force Applied on Sample [N]
                      'Fn',   ... % Force applied by NASS [N]
                      'Fty',  ... % Parasitic Force Ty [N]
                      'Frz'};     % Parasitic Force Rz [N]
  G_rmc.OutputName = {'D',    ... % Measured sample displacement x.r.t. granite [m]
                      'Fnm',  ... % Force Sensor in NASS [N]
                      'Dnm',  ... % Displacement Sensor in NASS [m]
                      'Dgm',  ... % Asbolute displacement of Granite [m]
                      'Vlm'}; ... % Absolute Velocity of NASS [m/s]
  save('./uniaxial/mat/plants.mat', 'G_rmc', '-append');

Sensitivity to Disturbance

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_sensitivity_dist_rmc.png
Sensitivity to disturbance once the RMC controller is applied to the system (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_sensitivity_dist_stages_rmc.png
Sensitivity to force disturbances in various stages when RMC is applied (png, pdf)

Damped Plant

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_plant_rmc_damped.png
Damped Plant after RMC is applied (png, pdf)

Conclusion

Relative Motion Control:

Direct Velocity Feedback

<<sec:dvf>>

Introduction   ignore

In the Relative Motion Control (RMC), a feedback is applied between the measured velocity of the platform to the actuator force input.

/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-model-nass-flexible-dvf.png

Uniaxial DVF Control Schematic

Control Design

  load('./uniaxial/mat/plants.mat', 'G');
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_dvf_plant.png
Transfer function from forces applied in the legs to leg velocity sensor (png, pdf)
  K_dvf = tf(5e4);
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_dvf_loop_gain.png
Transfer function from forces applied in the legs to leg velocity sensor (png, pdf)

Identification

Let's initialize the system prior to identification.

  initializeGround();
  initializeGranite();
  initializeTy();
  initializeRy();
  initializeRz();
  initializeMicroHexapod();
  initializeAxisc();
  initializeMirror();
  initializeNanoHexapod(struct('actuator', 'piezo'));
  initializeSample(struct('mass', 50));

And initialize the controllers.

  K = tf(0);
  save('./mat/controllers.mat', 'K', '-append');
  K_iff = tf(0);
  save('./mat/controllers.mat', 'K_iff', '-append');
  K_rmc = tf(0);
  save('./mat/controllers.mat', 'K_rmc', '-append');
  K_dvf = -K_dvf;
  save('./mat/controllers.mat', 'K_dvf', '-append');
  %% Options for Linearized
  options = linearizeOptions;
  options.SampleTime = 0;

  %% Name of the Simulink File
  mdl = 'sim_nano_station_uniaxial';
  %% Input/Output definition
  io(1)  = linio([mdl, '/Dw'],    1, 'input');  % Ground Motion
  io(2)  = linio([mdl, '/Fs'],    1, 'input');  % Force applied on the sample
  io(3)  = linio([mdl, '/Fnl'],   1, 'input');  % Force applied by the NASS
  io(4)  = linio([mdl, '/Fdty'],  1, 'input');  % Parasitic force Ty
  io(5)  = linio([mdl, '/Fdrz'],  1, 'input');  % Parasitic force Rz

  io(6)  = linio([mdl, '/Dsm'],  1, 'output'); % Displacement of the sample
  io(7)  = linio([mdl, '/Fnlm'], 1, 'output'); % Force sensor in NASS's legs
  io(8)  = linio([mdl, '/Dnlm'], 1, 'output'); % Displacement of NASS's legs
  io(9)  = linio([mdl, '/Dgm'],  1, 'output'); % Absolute displacement of the granite
  io(10) = linio([mdl, '/Vlm'],  1, 'output'); % Measured absolute velocity of the top NASS platform
  %% Run the linearization
  G_dvf = linearize(mdl, io, options);
  G_dvf.InputName  = {'Dw',   ... % Ground Motion [m]
                      'Fs',   ... % Force Applied on Sample [N]
                      'Fn',   ... % Force applied by NASS [N]
                      'Fty',  ... % Parasitic Force Ty [N]
                      'Frz'};     % Parasitic Force Rz [N]
  G_dvf.OutputName = {'D',    ... % Measured sample displacement x.r.t. granite [m]
                      'Fnm',  ... % Force Sensor in NASS [N]
                      'Dnm',  ... % Displacement Sensor in NASS [m]
                      'Dgm',  ... % Asbolute displacement of Granite [m]
                      'Vlm'}; ... % Absolute Velocity of NASS [m/s]
  save('./uniaxial/mat/plants.mat', 'G_dvf', '-append');

Sensitivity to Disturbance

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_sensitivity_dist_dvf.png
Sensitivity to disturbance once the DVF controller is applied to the system (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_sensitivity_dist_stages_dvf.png
Sensitivity to force disturbances in various stages when DVF is applied (png, pdf)

Damped Plant

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_plant_dvf_damped.png
Damped Plant after DVF is applied (png, pdf)

Conclusion

Direct Velocity Feedback:

With Cedrat Piezo-electric Actuators

<<sec:cedrat_actuator>>

Introduction   ignore

The model used for the Cedrat actuator is shown in figure fig:cedrat_schematic.

/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/cedrat-uniaxial-actuator.png

Schematic of the model used for the Cedrat Actuator

Identification

Let's initialize the system prior to identification.

  initializeGround();
  initializeGranite();
  initializeTy();
  initializeRy();
  initializeRz();
  initializeMicroHexapod();
  initializeAxisc();
  initializeMirror();
  initializeNanoHexapod(struct('actuator', 'piezo'));
  initializeCedratPiezo();
  initializeSample(struct('mass', 50));

And initialize the controllers.

  K = tf(0);
  save('./mat/controllers.mat', 'K', '-append');
  K_iff = tf(0);
  save('./mat/controllers.mat', 'K_iff', '-append');
  K_rmc = tf(0);
  save('./mat/controllers.mat', 'K_rmc', '-append');
  K_dvf = tf(0);
  save('./mat/controllers.mat', 'K_dvf', '-append');

We identify the dynamics of the system.

  %% Options for Linearized
  options = linearizeOptions;
  options.SampleTime = 0;

  %% Name of the Simulink File
  mdl = 'sim_nano_station_uniaxial_cedrat_bis';

The inputs and outputs are defined below and corresponds to the name of simulink blocks.

  %% Input/Output definition
  io(1)  = linio([mdl, '/Dw'],   1, 'input'); % Ground Motion
  io(2)  = linio([mdl, '/Fs'],   1, 'input'); % Force applied on the sample
  io(3)  = linio([mdl, '/Fnl'],  1, 'input'); % Force applied by the NASS
  io(4)  = linio([mdl, '/Fdty'], 1, 'input'); % Parasitic force Ty
  io(5)  = linio([mdl, '/Fdrz'], 1, 'input'); % Parasitic force Rz

  io(6)  = linio([mdl, '/Dsm'],  1, 'output'); % Displacement of the sample
  io(7)  = linio([mdl, '/Fnlm'], 1, 'output'); % Force sensor in NASS's legs
  io(8)  = linio([mdl, '/Dnlm'], 1, 'output'); % Displacement of NASS's legs
  io(9)  = linio([mdl, '/Dgm'],  1, 'output'); % Absolute displacement of the granite
  io(10) = linio([mdl, '/Vlm'],  1, 'output'); % Measured absolute velocity of the top NASS platform

Finally, we use the linearize Matlab function to extract a state space model from the simscape model.

  %% Run the linearization
  G = linearize(mdl, io, options);
  G.InputName  = {'Dw',   ... % Ground Motion [m]
                  'Fs',   ... % Force Applied on Sample [N]
                  'Fn',   ... % Force applied by NASS [N]
                  'Fty',  ... % Parasitic Force Ty [N]
                  'Frz'};     % Parasitic Force Rz [N]
  G.OutputName = {'D',    ... % Measured sample displacement x.r.t. granite [m]
                  'Fnm',  ... % Force Sensor in NASS [N]
                  'Dnm',  ... % Displacement Sensor in NASS [m]
                  'Dgm',  ... % Asbolute displacement of Granite [m]
                  'Vlm'}; ... % Absolute Velocity of NASS [m/s]

Control Design

Let's look at the transfer function from actuator forces in the nano-hexapod to the force sensor in the nano-hexapod legs for all 6 pairs of actuator/sensor.

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_cedrat_plant.png
Transfer function from forces applied in the legs to force sensor (png, pdf)

The controller for each pair of actuator/sensor is:

  K_cedrat = -5000/s;
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_cedrat_open_loop.png
Loop Gain for the Integral Force Feedback (png, pdf)

Identification

Let's initialize the system prior to identification.

  initializeGround();
  initializeGranite();
  initializeTy();
  initializeRy();
  initializeRz();
  initializeMicroHexapod();
  initializeAxisc();
  initializeMirror();
  initializeNanoHexapod(struct('actuator', 'piezo'));
  initializeCedratPiezo();
  initializeSample(struct('mass', 50));

All the controllers are set to 0.

  K = tf(0);
  save('./mat/controllers.mat', 'K', '-append');
  K_iff = -K_cedrat;
  save('./mat/controllers.mat', 'K_iff', '-append');
  K_rmc = tf(0);
  save('./mat/controllers.mat', 'K_rmc', '-append');
  K_dvf = tf(0);
  save('./mat/controllers.mat', 'K_dvf', '-append');
  %% Options for Linearized
  options = linearizeOptions;
  options.SampleTime = 0;

  %% Name of the Simulink File
  mdl = 'sim_nano_station_uniaxial_cedrat_bis';
  %% Input/Output definition
  io(1)  = linio([mdl, '/Dw'],    1, 'input');  % Ground Motion
  io(2)  = linio([mdl, '/Fs'],    1, 'input');  % Force applied on the sample
  io(3)  = linio([mdl, '/Fnl'],   1, 'input');  % Force applied by the NASS
  io(4)  = linio([mdl, '/Fdty'],  1, 'input');  % Parasitic force Ty
  io(5)  = linio([mdl, '/Fdrz'],  1, 'input');  % Parasitic force Rz

  io(6)  = linio([mdl, '/Dsm'],  1, 'output'); % Displacement of the sample
  io(7)  = linio([mdl, '/Fnlm'], 1, 'output'); % Force sensor in NASS's legs
  io(8)  = linio([mdl, '/Dnlm'], 1, 'output'); % Displacement of NASS's legs
  io(9)  = linio([mdl, '/Dgm'],  1, 'output'); % Absolute displacement of the granite
  io(10) = linio([mdl, '/Vlm'],  1, 'output'); % Measured absolute velocity of the top NASS platform
  %% Run the linearization
  G_cedrat = linearize(mdl, io, options);
  G_cedrat.InputName  = {'Dw',   ... % Ground Motion [m]
                      'Fs',   ... % Force Applied on Sample [N]
                      'Fn',   ... % Force applied by NASS [N]
                      'Fty',  ... % Parasitic Force Ty [N]
                      'Frz'};     % Parasitic Force Rz [N]
  G_cedrat.OutputName = {'D',    ... % Measured sample displacement x.r.t. granite [m]
                      'Fnm',  ... % Force Sensor in NASS [N]
                      'Dnm',  ... % Displacement Sensor in NASS [m]
                      'Dgm',  ... % Asbolute displacement of Granite [m]
                      'Vlm'}; ... % Absolute Velocity of NASS [m/s]
  % save('./uniaxial/mat/plants.mat', 'G_cedrat', '-append');

Sensitivity to Disturbance

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_sensitivity_dist_cedrat.png
Sensitivity to disturbance once the CEDRAT controller is applied to the system (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_sensitivity_dist_stages_cedrat.png
Sensitivity to force disturbances in various stages when CEDRAT is applied (png, pdf)

Damped Plant

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_plant_cedrat_damped.png
Damped Plant after CEDRAT is applied (png, pdf)

Conclusion

This gives similar results than with a classical force sensor.

Comparison of Active Damping Techniques

<<sec:comparison>>

Load the plants

  load('./uniaxial/mat/plants.mat', 'G', 'G_iff', 'G_rmc', 'G_dvf');

Sensitivity to Disturbance

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_sensitivity_ground_motion.png
Sensitivity to Ground Motion - Comparison (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_sensitivity_direct_force.png
Sensitivity to disturbance - Comparison (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_sensitivity_fty.png
Sensitivity to force disturbances - Comparison (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_sensitivity_frz.png
Sensitivity to force disturbances - Comparison (png, pdf)

Noise Budget

We first load the measured PSD of the disturbance.

  load('./disturbances/mat/dist_psd.mat', 'dist_f');

The effect of these disturbances on the distance $D$ is computed for all active damping techniques.

We then compute the Cumulative Amplitude Spectrum (figure fig:uniaxial-comp-cas-dist).

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-comp-cas-dist.png
Comparison of the Cumulative Amplitude Spectrum of $D$ for different active damping techniques (png, pdf)

The obtained Root Mean Square Value for each active damping technique is shown below.

D [m rms]
OL 3.38e-06
IFF 3.40e-06
RMC 3.37e-06
DVF 3.38e-06
Obtain Root Mean Square value of $D$ for each Active Damping Technique applied

It is important to note that the effect of direct forces applied to the sample are not taken into account here.

Damped Plant

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_plant_damped_comp.png
Damped Plant - Comparison (png, pdf)

Conclusion

IFF RMC DVF
Sensor Type Force sensor Relative Motion Inertial
Guaranteed Stability + + -
Sensitivity ($D_w$) - + -
Sensitivity ($F_s$) - (at low freq) + +
Sensitivity ($F_{ty,rz}$) + - +
Overall RMS of $D$ = = =
Comparison of proposed active damping techniques

Voice Coil

<<sec:voice_coil>>

Init

We initialize all the stages with the default parameters. The nano-hexapod is an hexapod with voice coils and the sample has a mass of 50kg.

All the controllers are set to 0 (Open Loop).

Identification

We identify the dynamics of the system.

  %% Options for Linearized
  options = linearizeOptions;
  options.SampleTime = 0;

  %% Name of the Simulink File
  mdl = 'sim_nano_station_uniaxial';

The inputs and outputs are defined below and corresponds to the name of simulink blocks.

  %% Input/Output definition
  io(1)  = linio([mdl, '/Dw'],   1, 'input'); % Ground Motion
  io(2)  = linio([mdl, '/Fs'],   1, 'input'); % Force applied on the sample
  io(3)  = linio([mdl, '/Fnl'],  1, 'input'); % Force applied by the NASS
  io(4)  = linio([mdl, '/Fdty'], 1, 'input'); % Parasitic force Ty
  io(5)  = linio([mdl, '/Fdrz'], 1, 'input'); % Parasitic force Rz

  io(6)  = linio([mdl, '/Dsm'],  1, 'output'); % Displacement of the sample
  io(7)  = linio([mdl, '/Fnlm'], 1, 'output'); % Force sensor in NASS's legs
  io(8)  = linio([mdl, '/Dnlm'], 1, 'output'); % Displacement of NASS's legs
  io(9)  = linio([mdl, '/Dgm'],  1, 'output'); % Absolute displacement of the granite
  io(10) = linio([mdl, '/Vlm'],  1, 'output'); % Measured absolute velocity of the top NASS platform

Finally, we use the linearize Matlab function to extract a state space model from the simscape model.

  %% Run the linearization
  G_vc = linearize(mdl, io, options);
  G_vc.InputName  = {'Dw',   ... % Ground Motion [m]
                     'Fs',   ... % Force Applied on Sample [N]
                     'Fn',   ... % Force applied by NASS [N]
                     'Fty',  ... % Parasitic Force Ty [N]
                     'Frz'};     % Parasitic Force Rz [N]
  G_vc.OutputName = {'D',    ... % Measured sample displacement x.r.t. granite [m]
                     'Fnm',  ... % Force Sensor in NASS [N]
                     'Dnm',  ... % Displacement Sensor in NASS [m]
                     'Dgm',  ... % Asbolute displacement of Granite [m]
                     'Vlm'}; ... % Absolute Velocity of NASS [m/s]

Finally, we save the identified system dynamics for further analysis.

  save('./uniaxial/mat/plants.mat', 'G_vc', '-append');

Sensitivity to Disturbances

We load the dynamics when using a piezo-electric nano hexapod to compare the results.

  load('./uniaxial/mat/plants.mat', 'G');

We show several plots representing the sensitivity to disturbances:

  • in figure fig:uniaxial-sensitivity-vc-disturbances the transfer functions from ground motion $D_w$ to the sample position $D$ and the transfer function from direct force on the sample $F_s$ to the sample position $D$ are shown
  • in figure fig:uniaxial-sensitivity-vc-force-dist, it is the effect of parasitic forces of the positioning stages ($F_{ty}$ and $F_{rz}$) on the position $D$ of the sample that are shown
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-sensitivity-vc-disturbances.png
Sensitivity to disturbances (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-sensitivity-vc-force-dist.png
Sensitivity to disturbances (png, pdf)

Noise Budget

We first load the measured PSD of the disturbance.

  load('./disturbances/mat/dist_psd.mat', 'dist_f');

The effect of these disturbances on the distance $D$ is computed below.

The PSD of the obtain distance $D$ due to each of the perturbation is shown in figure fig:uniaxial-vc-psd-dist and the Cumulative Amplitude Spectrum is shown in figure fig:uniaxial-vc-cas-dist.

The Root Mean Square value of the obtained displacement $D$ is computed below and can be determined from the figure fig:uniaxial-vc-cas-dist.

4.8793e-06
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-vc-psd-dist.png
PSD of the displacement $D$ due to disturbances (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-vc-cas-dist.png
CAS of the displacement $D$ due the disturbances (png, pdf)

Even though the RMS value of the displacement $D$ is lower when using a piezo-electric actuator, the motion is mainly due to high frequency disturbances which are more difficult to control (an higher control bandwidth is required).

Thus, it may be desirable to use voice coil actuators.

Integral Force Feedback

  K_iff = -20/s;
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial_iff_vc_open_loop.png
Open Loop Transfer Function for IFF control when using a voice coil actuator (png, pdf)

Identification of the Damped Plant

Let's initialize the system prior to identification.

  initializeGround();
  initializeGranite();
  initializeTy();
  initializeRy();
  initializeRz();
  initializeMicroHexapod();
  initializeAxisc();
  initializeMirror();
  initializeNanoHexapod(struct('actuator', 'lorentz'));
  initializeSample(struct('mass', 50));

All the controllers are set to 0.

  K = tf(0);
  save('./mat/controllers.mat', 'K', '-append');
  K_iff = -K_iff;
  save('./mat/controllers.mat', 'K_iff', '-append');
  K_rmc = tf(0);
  save('./mat/controllers.mat', 'K_rmc', '-append');
  K_dvf = tf(0);
  save('./mat/controllers.mat', 'K_dvf', '-append');
  %% Options for Linearized
  options = linearizeOptions;
  options.SampleTime = 0;

  %% Name of the Simulink File
  mdl = 'sim_nano_station_uniaxial';
  %% Input/Output definition
  io(1)  = linio([mdl, '/Dw'],    1, 'input');  % Ground Motion
  io(2)  = linio([mdl, '/Fs'],    1, 'input');  % Force applied on the sample
  io(3)  = linio([mdl, '/Fnl'],   1, 'input');  % Force applied by the NASS
  io(4)  = linio([mdl, '/Fdty'],  1, 'input');  % Parasitic force Ty
  io(5)  = linio([mdl, '/Fdrz'],  1, 'input');  % Parasitic force Rz

  io(6)  = linio([mdl, '/Dsm'],  1, 'output'); % Displacement of the sample
  io(7)  = linio([mdl, '/Fnlm'], 1, 'output'); % Force sensor in NASS's legs
  io(8)  = linio([mdl, '/Dnlm'], 1, 'output'); % Displacement of NASS's legs
  io(9)  = linio([mdl, '/Dgm'],  1, 'output'); % Absolute displacement of the granite
  io(10) = linio([mdl, '/Vlm'],  1, 'output'); % Measured absolute velocity of the top NASS platform
  %% Run the linearization
  G_vc_iff = linearize(mdl, io, options);
  G_vc_iff.InputName  = {'Dw',   ... % Ground Motion [m]
                         'Fs',   ... % Force Applied on Sample [N]
                         'Fn',   ... % Force applied by NASS [N]
                         'Fty',  ... % Parasitic Force Ty [N]
                         'Frz'};     % Parasitic Force Rz [N]
  G_vc_iff.OutputName = {'D',    ... % Measured sample displacement x.r.t. granite [m]
                         'Fnm',  ... % Force Sensor in NASS [N]
                         'Dnm',  ... % Displacement Sensor in NASS [m]
                         'Dgm',  ... % Asbolute displacement of Granite [m]
                         'Vlm'}; ... % Absolute Velocity of NASS [m/s]

Noise Budget

We compute the obtain PSD of the displacement $D$ when using IFF.

  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/d70c7cbe90797d0353f220a57a435c7f91df0f04/uniaxial/figs/uniaxial-cas-iff-vc.png
CAS of the displacement $D$ (png, pdf)

Conclusion

The use of voice coil actuators would allow a better disturbance rejection for a fixed bandwidth compared with a piezo-electric hexapod.

Similarly, it would require much lower bandwidth to attain the same level of disturbance rejection for $D$.