% Tilt Stage
%   :PROPERTIES:
%   :header-args:matlab+: :tangle src/initializeRy.m
%   :header-args:matlab+: :comments org :mkdirp yes
%   :header-args:matlab+: :eval no :results none
%   :END:
%   <<sec:initializeRy>>

% This Matlab function is accessible [[file:src/initializeRy.m][here]].


function [ry] = initializeRy(opts_param)
    %% Default values for opts
    opts = struct('rigid', false);

    %% Populate opts with input parameters
    if exist('opts_param','var')
        for opt = fieldnames(opts_param)'
            opts.(opt{1}) = opts_param.(opt{1});
        end
    end

    %%
    ry = struct();

    %% Tilt Stage - Static Properties
    % Ry - Guide for the tilt stage
    ry.guide.density = 7800; % [kg/m3]
    ry.guide.color   = [0.792 0.820 0.933];
    ry.guide.STEP    = './STEPS/ry/Tilt_Guide.STEP';
    % Ry - Rotor of the motor
    ry.rotor.density = 2400; % [kg/m3]
    ry.rotor.color   = [0.792 0.820 0.933];
    ry.rotor.STEP    = './STEPS/ry/Tilt_Motor_Axis.STEP';
    % Ry - Motor
    ry.motor.density = 3200; % [kg/m3]
    ry.motor.color   = [0.792 0.820 0.933];
    ry.motor.STEP    = './STEPS/ry/Tilt_Motor.STEP';
    % Ry - Plateau Tilt
    ry.stage.density = 7800; % [kg/m3]
    ry.stage.color   = [0.792 0.820 0.933];
    ry.stage.STEP    = './STEPS/ry/Tilt_Stage.STEP';

    ry.m = 200; % TODO [kg]

    %% Tilt Stage - Dynamical Properties
    if opts.rigid
        ry.k.tilt = 1e10; % Rotation stiffness around y [N*m/deg]
    else
        ry.k.tilt = 1e4; % Rotation stiffness around y [N*m/deg]
    end

    ry.k.h    = 357e6/4; % Stiffness in the direction of the guidance [N/m]
    ry.k.rad  = 555e6/4; % Stiffness in the top direction [N/m]
    ry.k.rrad = 238e6/4; % Stiffness in the side direction [N/m]

    ry.c.h    = 10*(1/5)*sqrt(ry.k.h/ry.m);
    ry.c.rad  = 10*(1/5)*sqrt(ry.k.rad/ry.m);
    ry.c.rrad = 10*(1/5)*sqrt(ry.k.rrad/ry.m);
    ry.c.tilt = 10*(1/1)*sqrt(ry.k.tilt/ry.m);

    %% Positioning parameters
    ry.z_offset = 0.58178; % Z-Offset so that the center of rotation matches the sample center [m]

    %% Save
    save('./mat/stages.mat', 'ry', '-append');
end