public G3dMPF(Plane plane, Ship ship, IControlModule module)
{
this.plane = plane;
this.ship = ship;
ControlModule = module;
current_deck_position_ship = ship.Position.Clone();
}
public L1Adaptive(Ship ship, Plane plane, IControlModule module)
{
Ship = ship;
Plane = plane;
ControlModule = module;
k_pr = mb.DenseOfDiagonalArray(new[] { k_p, k_r });
Amq = -1 / T_pitch;
w_cq = 1 / T_cq;
Asq = Amq + ksq;
Amp = -1 / T_roll;
w_cp = 1 / T_cp;
Amr = -1 / T_yaw;
w_cr = 1 / T_cr;
pr_ad_dot = vb.Dense(new[] { p_ad_dot, r_ad_dot });
}
/// <summary>
/// Registers a new control module
/// </summary>
/// <param name="module">Module to add</param>
public void RegisterModule(IControlModule module)
{
_modules[module.Identifier] = module;
lstModules.Items.Add(module.Identifier);
}
/// <summary>
/// Registers a new control module
/// </summary>
/// <param name="module">Module to add</param>
public void RegisterModule(IControlModule module)
{
_modules[module.Identifier] = module;
lstModules.Items.Add(module.Identifier);
}
