def __init__(self, Ts):
    self._ts_simulation = Ts
    self._state = np.array([[MAV.pn0], [MAV.pe0], [MAV.pd0], [MAV.u0], [MAV.v0], [MAV.w0], [MAV.e0], [MAV.e1], [MAV.e2], [MAV.e3], [MAV.p0], [MAV.q0], [MAV.r0]])
    self._wind = np.array([[0.0], [0.0], [0.0]])
    self._update_velocity_data()
    self._forces = np.array([[], [], []])
    ur = self._state.item(3)
    vr = self._state.item(4)
    wr = self._state.item(5)
    self._Va = np.sqrt((((ur ** 2) + (vr ** 2)) + (wr ** 2)))
    self._alpha = np.arctan2(wr, ur)
    self._beta = np.arcsin((vr / self._Va))
    self.true_state = msgState()
def __init__(self, Ts):
    self._ts_simulation = Ts
    self._state = np.array([[MAV.pn0], [MAV.pe0], [MAV.pd0], [MAV.u0], [MAV.v0], [MAV.w0], [MAV.e0], [MAV.e1], [MAV.e2], [MAV.e3], [MAV.p0], [MAV.q0], [MAV.r0]])
    self._wind = np.array([[0.0], [0.0], [0.0]])
    self._update_velocity_data()
    self._forces = np.array([[], [], []])
    ur = self._state.item(3)
    vr = self._state.item(4)
    wr = self._state.item(5)
    self._Va = np.sqrt((((ur ** 2) + (vr ** 2)) + (wr ** 2)))
    self._alpha = np.arctan2(wr, ur)
    self._beta = np.arcsin((vr / self._Va))
    self.true_state = msgState()