nass-simscape/experiment_tomography/index.org

19 KiB

Tomography Experiment

Introduction   ignore

The goal here is to simulate some scientific experiments with the tuned Simscape model when no control is applied to the nano-hexapod.

This has several goals:

  • Validate the model
  • Estimate the expected error motion for the experiments
  • Estimate the stroke that we may need for the nano-hexapod

The document in organized as follow:

  • In section sec:simscape_model the Simscape model is initialized
  • In section sec:tomo_no_dist a tomography experiment is performed where the sample is aligned with the rotation axis. No disturbance is included
  • In section sec:tomo_dist, the same is done but with disturbance included
  • In section sec:tomo_hexa_trans the micro-hexapod translate the sample such that its center of mass is no longer aligned with the rotation axis. No disturbance is included
  • In section sec:ty_scans, scans with the translation stage are simulated with no perturbation included

Simscape Model

<<sec:simscape_model>>

The simulink file to do tomography experiments is sim_nano_station_tomo.slx.

  open('experiment_tomography/matlab/sim_nano_station_tomo.slx')

We load the shared simulink configuration and we set the StopTime.

  load('mat/conf_simscape.mat');
  set_param(conf_simscape, 'StopTime', '5');

We first initialize all the stages.

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

We initialize the reference path for all the stages. All stage is set to its zero position except the Spindle which is rotating at 60rpm.

  initializeReferences('Rz_type', 'rotating', 'Rz_period', 1);

Tomography Experiment with no disturbances

<<sec:tomo_no_dist>>

Introduction   ignore

Simulation Setup

And we initialize the disturbances to be equal to zero.

  initializeDisturbances(...
      'Dwx', false, ... % Ground Motion - X direction
      'Dwy', false, ... % Ground Motion - Y direction
      'Dwz', false, ... % Ground Motion - Z direction
      'Fty_x', false, ... % Translation Stage - X direction
      'Fty_z', false, ... % Translation Stage - Z direction
      'Frz_z', false  ... % Spindle - Z direction
      );

We simulate the model.

  sim('sim_nano_station_tomo');

And we save the obtained data.

  tomo_align_no_dist = struct('t', t, 'MTr', MTr);
  save('experiment_tomography/mat/experiment.mat', 'tomo_align_no_dist', '-append');

Analysis

  load('experiment_tomography/mat/experiment.mat', 'tomo_align_no_dist');
  t = tomo_align_no_dist.t;
  MTr = tomo_align_no_dist.MTr;
  Edx = squeeze(MTr(1, 4, :));
  Edy = squeeze(MTr(2, 4, :));
  Edz = squeeze(MTr(3, 4, :));
  % The angles obtained are u-v-w Euler angles (rotations in the moving frame)
  Ery = atan2( squeeze(MTr(1, 3, :)),           squeeze(sqrt(MTr(1, 1, :).^2 + MTr(1, 2, :).^2)));
  Erx = atan2(-squeeze(MTr(2, 3, :))./cos(Ery), squeeze(MTr(3, 3, :))./cos(Ery));
  Erz = atan2(-squeeze(MTr(1, 2, :))./cos(Ery), squeeze(MTr(1, 1, :))./cos(Ery));
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/9a5841f3c075ebc17c06725712eab0efae186c97/experiment_tomography/figs/exp_tomo_without_dist_trans.png
X-Y-Z translation of the sample w.r.t. granite when performing tomography experiment with no disturbances (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/9a5841f3c075ebc17c06725712eab0efae186c97/experiment_tomography/figs/exp_tomo_without_dist_rot.png
X-Y-Z rotations of the sample w.r.t. granite when performing tomography experiment with no disturbances (png, pdf)

Conclusion

When everything is aligned, the resulting error motion is very small (nm range) and is quite negligible with respect to the error when disturbances are included. This residual error motion probably comes from a small misalignment somewhere.

Tomography Experiment with included perturbations

<<sec:tomo_dist>>

Introduction   ignore

Simulation Setup

We now activate the disturbances.

  initializeDisturbances(...
      'Dwx', true, ... % Ground Motion - X direction
      'Dwy', true, ... % Ground Motion - Y direction
      'Dwz', true, ... % Ground Motion - Z direction
      'Fty_x', true, ... % Translation Stage - X direction
      'Fty_z', true, ... % Translation Stage - Z direction
      'Frz_z', true  ... % Spindle - Z direction
      );

We simulate the model.

  sim('sim_nano_station_tomo');

And we save the obtained data.

  tomo_align_dist = struct('t', t, 'MTr', MTr);
  save('experiment_tomography/mat/experiment.mat', 'tomo_align_dist', '-append');

Analysis

  load('experiment_tomography/mat/experiment.mat', 'tomo_align_dist');
  t = tomo_align_dist.t;
  MTr = tomo_align_dist.MTr;
  Edx = squeeze(MTr(1, 4, :));
  Edy = squeeze(MTr(2, 4, :));
  Edz = squeeze(MTr(3, 4, :));
  % The angles obtained are u-v-w Euler angles (rotations in the moving frame)
  Ery = atan2( squeeze(MTr(1, 3, :)),           squeeze(sqrt(MTr(1, 1, :).^2 + MTr(1, 2, :).^2)));
  Erx = atan2(-squeeze(MTr(2, 3, :))./cos(Ery), squeeze(MTr(3, 3, :))./cos(Ery));
  Erz = atan2(-squeeze(MTr(1, 2, :))./cos(Ery), squeeze(MTr(1, 1, :))./cos(Ery));
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/9a5841f3c075ebc17c06725712eab0efae186c97/experiment_tomography/figs/exp_tomo_dist_trans.png
X-Y-Z translation of the sample w.r.t. the granite when performing tomography experiment with disturbances (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/9a5841f3c075ebc17c06725712eab0efae186c97/experiment_tomography/figs/exp_tomo_dist_rot.png
X-Y-Z rotations of the sample w.r.t. the granite when performing tomography experiment with disturbances (png, pdf)

Conclusion

Error motion is what expected from the disturbance measurements.

Tomography when the micro-hexapod is not centered

<<sec:tomo_hexa_trans>>

Introduction   ignore

Simulation Setup

We first set the wanted translation of the Micro Hexapod.

  P_micro_hexapod = [0.01; 0; 0]; % [m]

We initialize the reference path.

  initializeReferences('Dh_pos', [P_micro_hexapod; 0; 0; 0], 'Rz_type', 'rotating', 'Rz_period', 1);

We initialize the stages.

  initializeMicroHexapod('AP', P_micro_hexapod);

And we initialize the disturbances to zero.

  initializeDisturbances(...
      'Dwx', false, ... % Ground Motion - X direction
      'Dwy', false, ... % Ground Motion - Y direction
      'Dwz', false, ... % Ground Motion - Z direction
      'Fty_x', false, ... % Translation Stage - X direction
      'Fty_z', false, ... % Translation Stage - Z direction
      'Frz_z', false  ... % Spindle - Z direction
      );

We simulate the model.

  sim('sim_nano_station_tomo');

And we save the obtained data.

  tomo_not_align = struct('t', t, 'MTr', MTr);
  save('experiment_tomography/mat/experiment.mat', 'tomo_not_align', '-append');

Analysis

  load('experiment_tomography/mat/experiment.mat', 'tomo_not_align');
  t = tomo_not_align.t;
  MTr = tomo_not_align.MTr;
  Edx = squeeze(MTr(1, 4, :));
  Edy = squeeze(MTr(2, 4, :));
  Edz = squeeze(MTr(3, 4, :));
  % The angles obtained are u-v-w Euler angles (rotations in the moving frame)
  Ery = atan2( squeeze(MTr(1, 3, :)),           squeeze(sqrt(MTr(1, 1, :).^2 + MTr(1, 2, :).^2)));
  Erx = atan2(-squeeze(MTr(2, 3, :))./cos(Ery), squeeze(MTr(3, 3, :))./cos(Ery));
  Erz = atan2(-squeeze(MTr(1, 2, :))./cos(Ery), squeeze(MTr(1, 1, :))./cos(Ery));
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/9a5841f3c075ebc17c06725712eab0efae186c97/experiment_tomography/figs/exp_tomo_offset_trans.png
X-Y-Z translation of the sample w.r.t. granite when performing tomography experiment with no disturbances (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/9a5841f3c075ebc17c06725712eab0efae186c97/experiment_tomography/figs/exp_tomo_offset_rot.png
X-Y-Z rotations of the sample w.r.t. granite when performing tomography experiment with no disturbances (png, pdf)

Conclusion

The main motions are translations in the X direction of the mobile platform (corresponds to the eccentricity of the micro-hexapod) and rotations along the rotating Y axis.

Raster Scans with the translation stage

<<sec:ty_scans>>

Introduction   ignore

Simulation Setup

We set the reference path.

  initializeReferences('Dy_type', 'triangular', 'Dy_amplitude', 10e-3, 'Dy_period', 1);

We initialize the stages.

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

And we initialize the disturbances to zero.

  initializeDisturbances(...
      'Dwx', false, ... % Ground Motion - X direction
      'Dwy', false, ... % Ground Motion - Y direction
      'Dwz', false, ... % Ground Motion - Z direction
      'Fty_x', false, ... % Translation Stage - X direction
      'Fty_z', false, ... % Translation Stage - Z direction
      'Frz_z', false  ... % Spindle - Z direction
      );

We simulate the model.

  sim('sim_nano_station_tomo');

And we save the obtained data.

  ty_scan = struct('t', t, 'MTr', MTr);
  save('experiment_tomography/mat/experiment.mat', 'ty_scan', '-append');

Analysis

  load('experiment_tomography/mat/experiment.mat', 'ty_scan');
  t = ty_scan.t;
  MTr = ty_scan.MTr;
  Edx = squeeze(MTr(1, 4, :));
  Edy = squeeze(MTr(2, 4, :));
  Edz = squeeze(MTr(3, 4, :));
  % The angles obtained are u-v-w Euler angles (rotations in the moving frame)
  Ery = atan2( squeeze(MTr(1, 3, :)),           squeeze(sqrt(MTr(1, 1, :).^2 + MTr(1, 2, :).^2)));
  Erx = atan2(-squeeze(MTr(2, 3, :))./cos(Ery), squeeze(MTr(3, 3, :))./cos(Ery));
  Erz = atan2(-squeeze(MTr(1, 2, :))./cos(Ery), squeeze(MTr(1, 1, :))./cos(Ery));
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/9a5841f3c075ebc17c06725712eab0efae186c97/experiment_tomography/figs/exp_ty_scan_trans.png
X-Y-Z translation of the sample w.r.t. granite when performing tomography experiment with no disturbances (png, pdf)
  <<plt-matlab>>
/tdehaeze/nass-simscape/media/commit/9a5841f3c075ebc17c06725712eab0efae186c97/experiment_tomography/figs/exp_ty_scan_rot.png
X-Y-Z rotations of the sample w.r.t. granite when performing tomography experiment with no disturbances (png, pdf)

Conclusion

This is logic that the main error moving is translation along the Y axis and rotation along the X axis. In order to reduce the errors, we can make a smoother reference path for the translation stage.