for k in range(0,
int(Nmodel / Ncontrol)): # loop for environment-cycle
# Set satellite parameters
# state is set inside solver
Advitiy.setPos(m_sgp_output_i[i * int(Nmodel / Ncontrol) + k, 1:4])
Advitiy.setVel(m_sgp_output_i[i * int(Nmodel / Ncontrol) + k, 4:7])
Advitiy.setLight(m_light_output[i * int(Nmodel / Ncontrol) + k, 1])
Advitiy.setSun_i(m_si_output_b[i * int(Nmodel / Ncontrol) + k,
1:4])
Advitiy.setMag_i(
m_magnetic_field_i[(i + 1) * int(Nmodel / Ncontrol) + k, 1:4])
# disturbance torque
if (distbool == 0):
# getting default disturbance torque (zero in our case)
Advitiy.setDisturbance_b(defblock.disturbance(Advitiy))
if (distbool == 1):
# getting disturbance torque by disturbance model
dist.ggTorqueb(Advitiy)
dist.aeroTorqueb(Advitiy)
dist.solarTorqueb(Advitiy)
torque_dist_gg[i * int(Nmodel / Ncontrol) +
k, :] = Advitiy.getggDisturbance_b()
torque_dist_aero[i * int(Nmodel / Ncontrol) +
k, :] = Advitiy.getaeroDisturbance_b()
torque_dist_solar[i * int(Nmodel / Ncontrol) +
k, :] = Advitiy.getsolarDisturbance_b()
torque_dist_total[
i * int(Nmodel / Ncontrol) +
def test_disturbance(self): qBO = np.array([.0,0.,0.,1.]) state = np.hstack((qBO,np.array([0.10050588,-0.05026119,-0.3014887]))) mySat = satellite.Satellite(state,128.05) self.assertTrue(np.allclose(defblock.disturbance(mySat),np.zeros(3)))