The image attached below are the equations needed and the simulink model I have so far, using the following code. The Step 1 is: Step time = 1, Initial value = 0 and final value = 5. Step 2 is: Step time = 4, Initial value = 5, and final value = 0. The bottom two are just the opposite of these two. However the pitch rate and pitch graphs do not look right, but I can't seem to see whats gone wrong.
zeta = sqrt((rho*S*c)/(8*(h_n-h_fwd)*a*I_yy))*(V_bar_t*a_1*d_T);
omega_n_cruise = V_cruise*sqrt(((rho*S*c*a*(h_n-h_fwd))/(2*I_yy)));
omega_d_cruise = omega_n_cruise*sqrt(1-(zeta^2));
k_eta = (-1*V_bar_t*a_2)/((h_n - h_fwd)*a);
eta_coefficient = k_eta * (omega_n_cruise)^2;
theta = (omega_n_cruise)^2;
theta_dot = 2*zeta*omega_n_cruise;