55 lines
1.3 KiB
Matlab
55 lines
1.3 KiB
Matlab
function [ry] = initializeRy(args)
|
|
|
|
arguments
|
|
args.type char {mustBeMember(args.type,{'none', 'rigid', 'flexible', 'modal-analysis', 'init'})} = 'flexible'
|
|
args.Foffset logical {mustBeNumericOrLogical} = false
|
|
args.Ry_init (1,1) double {mustBeNumeric} = 0
|
|
end
|
|
|
|
ry = struct();
|
|
|
|
switch args.type
|
|
case 'none'
|
|
ry.type = 0;
|
|
case 'rigid'
|
|
ry.type = 1;
|
|
case 'flexible'
|
|
ry.type = 2;
|
|
case 'modal-analysis'
|
|
ry.type = 3;
|
|
case 'init'
|
|
ry.type = 4;
|
|
end
|
|
|
|
% Ry - Guide for the tilt stage
|
|
ry.guide.density = 7800; % [kg/m3]
|
|
ry.guide.STEP = './STEPS/ry/Tilt_Guide.STEP';
|
|
|
|
% Ry - Rotor of the motor
|
|
ry.rotor.density = 2400; % [kg/m3]
|
|
ry.rotor.STEP = './STEPS/ry/Tilt_Motor_Axis.STEP';
|
|
|
|
% Ry - Motor
|
|
ry.motor.density = 3200; % [kg/m3]
|
|
ry.motor.STEP = './STEPS/ry/Tilt_Motor.STEP';
|
|
|
|
% Ry - Plateau Tilt
|
|
ry.stage.density = 7800; % [kg/m3]
|
|
ry.stage.STEP = './STEPS/ry/Tilt_Stage.STEP';
|
|
|
|
ry.z_offset = 0.58178; % [m]
|
|
|
|
ry.Ry_init = args.Ry_init; % [rad]
|
|
|
|
ry.K = [3.8e8; 4e8; 3.8e8; 1.2e8; 6e4; 1.2e8];
|
|
ry.C = [1e5; 1e5; 1e5; 3e4; 1e3; 3e4];
|
|
|
|
if args.Foffset && ~strcmp(args.type, 'none') && ~strcmp(args.type, 'rigid') && ~strcmp(args.type, 'init')
|
|
load('mat/Foffset.mat', 'Fym');
|
|
ry.Deq = -Fym'./ry.K;
|
|
else
|
|
ry.Deq = zeros(6,1);
|
|
end
|
|
|
|
save('./mat/stages.mat', 'ry', '-append');
|