def test2_kinematic_angular_eqs(): time = 0 euler_angles = np.array([0, np.pi / 2, 0]) angular_vel = np.array([0, 1, 0], dtype=float) expected_sol = np.array([0, 0, 1], dtype=float) sol = kinematic_angular_eqs(time, euler_angles, angular_vel) assert(np.allclose(expected_sol, sol))
def test2_kinematic_angular_eqs(): time = 0 euler_angles = np.array([0, np.pi / 2, 0]) ang_vel = np.array([0, 1, 0], dtype=float) expected_sol = np.array([0, 0, 1], dtype=float) sol = kinematic_angular_eqs(time, euler_angles, ang_vel) assert (np.allclose(expected_sol, sol))
def test1_kinematic_angular_eqs(): time = 0 euler_angles = np.array([np.pi / 4, np.pi / 4, 0]) angular_vel = np.array([1, 1, 1], dtype=float) expected_sol = np.array([0, 1 + 2 ** 0.5, 2]) sol = kinematic_angular_eqs(time, euler_angles, angular_vel) assert(np.allclose(expected_sol, sol))
def test1_kinematic_angular_eqs(): time = 0 euler_angles = np.array([np.pi / 4, np.pi / 4, 0]) ang_vel = np.array([1, 1, 1], dtype=float) expected_sol = np.array([0, 1 + 2**0.5, 2]) sol = kinematic_angular_eqs(time, euler_angles, ang_vel) assert (np.allclose(expected_sol, sol))