-
Notifications
You must be signed in to change notification settings - Fork 0
/
DEFAULT.m
115 lines (86 loc) · 2.4 KB
/
DEFAULT.m
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
% This script sets default values for the Paint Booth Factory
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% Values you should not change %
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% Initial joint position assigned to velocity integrators
InitQ0 = 1.759; % Initial position
InitQ1 = -112.05; % Initial position
InitQ2 = 7.245; % Initial position
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% Values you should set in Controller.m %
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% ================
% CONTROLLER GAINS
% ================
% PID Controller
PID0 = [1 0 0];
PID1 = [1 0 0];
PID2 = [1 0 0];
% ==========
% THROUGHPUT
% ==========
PaintTime = 9.0; % Time spent painting truck
ResetTime = 1.0; % Time spent resetting robot position for next truck
StartX = 0.0; % Initial position of truck when painting starts
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% Values you should set in Robot.m %
%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%%
% ========
% Q0
% ========
% Pump Dynamics & Saturation
Pump0n = [1]; % Numerator
Pump0d = [1]; % Denominator
Pump0sat = Big;
% Mechanical Dynamics
Mech0n = [1]; % Numerator
Mech0d = [1]; % Denominator
% Joint Limit
JntMin0 = -Big;
JntMax0 = Big;
% Controller Feedback Gain
FB0 = 0;
% ========
% Q1
% ========
% Amplifier Dynamics & Saturation
Amp1n = [1]; % Numerator
Amp1d = [1]; % Denominator
AmpSat1 = Big;
% Electrical Dynamics & Torque Constant
Elec1n = [1]; % Numerator
Elec1d = [1]; % Denominator
TConst1 = 1;
% Mechanical Dynamics & Back EMF
Mech1n = [1]; % Numerator
Mech1d = [1]; % Denominator
BackEMF1 = 0;
% Gearbox Reduction Ratio & Joint Limit
Gear1 = 1;
JntMin1 = -Big;
JntMax1 = Big;
% Gravity
Grav = 0;
% Controller Feedback Gain
FB1 = 0;
% ========
% Q2
% ========
% Amplifier Dynamics & Saturation
Amp2n = [1]; % Numerator
Amp2d = [1]; % Denominator
AmpSat2 = Big;
% Electrical Dynamics & Torque Constant
Elec2n = [1]; % Numerator
Elec2d = [1]; % Denominator
TConst2 = 1;
% Mechanical Dynamics & Back EMF
Mech2n = [1]; % Numerator
Mech2d = [1]; % Denominator
BackEMF2 = 0;
% Gearbox Reduction Ratio & Joint Limit
Gear2 = 1;
JntMin2 = -Big;
JntMax2 = Big;
% Controller Feedback Gain
FB2 = 0;