diff --git a/controls/model/modelParameters.m b/controls/model/modelParameters.m
index f2ccc63145fb06cd10b0b2254b15a154efaa1b56..4d04f572601179be83af8d527a862e4873c026a3 100644
--- a/controls/model/modelParameters.m
+++ b/controls/model/modelParameters.m
@@ -1,22 +1,32 @@
     % Model Parameters
-    m = 1.19;            % Quadrotor + battery mass
-    g = 9.81;            % Acceleration of gravity
-    Jxx = 0.0218;        % Quadrotor and battery motor of inertia around bx (pitch)
-    Jyy = 0.0277;        % Quadrotor and battery motor of inertia around by (roll)
-    Jzz = 0.0332;        % Quadrotor and battery motor of inertia around bz (yaw)
-    Jreq = 4.2012e-05;   % Rotor and motor moment of inertia around axis of rotation
-    Kt = 8.1558*10^-6;   % Rotor thrust constant
-    Kh = 0;              % Rotor in-plane drag constant
-    Kd = 1.8087e-07;     % Rotor drag constant
-    rhx = 0.016;         % X-axis distance from center of mass to a rotor hub
-    rhy = 0.016;         % Y-axis distance from center of mass to a rotor hub
-    rhz = 0.003;         % Z-axis distance from center of mass to a rotor hub
-    Rm = 0.2308;         % Motor resistance
-    Kq = 96.3422;        % Motor torque constant
-    Kv = 96.3422;        % Motor back emf constant
-    If = 0.511;          % Motor internal friction current
-    Pmin = 0.40;         % Minimum zybo output duty cycle command
-    Pmax = 0.80;         % Maximum zybo output duty cycle command
-    Tc = 0.01;           % Camera system sampling period
-    tau_c = 0;           % Camera system total latency
-    Vb = 11.1;           % Nominal battery voltage (V)
\ No newline at end of file
+    m = 1.19;                       % Quadrotor + battery mass
+    g = 9.81;                       % Acceleration of gravity
+    Jxx = 0.0218;                   % Quadrotor and battery motor of inertia around bx (pitch)
+    Jyy = 0.0277;                   % Quadrotor and battery motor of inertia around by (roll)
+    Jzz = 0.0332;                   % Quadrotor and battery motor of inertia around bz (yaw)
+    Jreq = 4.2012e-05;              % Rotor and motor moment of inertia around axis of rotation
+    Kt = 8.1558*10^-6;              % Rotor thrust constant
+    Kh = 0;                         % Rotor in-plane drag constant
+    Kd = 1.8087e-07;                % Rotor drag constant
+    rhx = 0.016;                    % X-axis distance from center of mass to a rotor hub
+    rhy = 0.016;                    % Y-axis distance from center of mass to a rotor hub
+    rhz = 0.003;                    % Z-axis distance from center of mass to a rotor hub
+    Rm = 0.2308;                    % Motor resistance
+    Kq = 96.3422;                   % Motor torque constant
+    Kv = 96.3422;                   % Motor back emf constant
+    If = 0.511;                     % Motor internal friction current
+    Pmin = 0.40;                    % Minimum zybo output duty cycle command
+    Pmax = 0.80;                    % Maximum zybo output duty cycle command
+    Tc = 0.01;                      % Camera system sampling period
+    tau_c = 0;                      % Camera system total latency
+    Vb = 11.1;                      % Nominal battery voltage (V)
+    omega_o = 598.088;              % Equilibrium Rotor Speed
+    x_controlled_o = 0;             % Equilibrium lateral controller output
+    y_controlled_o = 0;             % Equilibrium longitudinal controller output
+    yaw_controlled_o = 0;           % Equilibrium yaw controller output
+    
+    % Equilibrium height controller output
+    height_controlled_o = (((Rm*If + ...
+    + (((omega_o * 2 * Rm * Kv * Kq  ...
+    * Kd + 1)^2) - 1)/(4* Rm*Kv^2*Kq ...
+    *Kd))/Vb)*(Pmax- Pmin)+Pmin)*100;     
\ No newline at end of file
diff --git a/controls/model/test_model.slx b/controls/model/test_model.slx
new file mode 100644
index 0000000000000000000000000000000000000000..39a3e32d6af42371f6da1d27a0c2472428ff38ef
Binary files /dev/null and b/controls/model/test_model.slx differ