Example #1
0
def test2_navigation_eqs():

    time = 0
    linear_vel = np.array([1, 0, 1], dtype=float)
    euler_angles = np.array([0, np.pi / 2, 0])

    expected_sol = np.array([1, - 1, 0], dtype=float)
    sol = navigation_eqs(time, linear_vel, euler_angles)

    assert(np.allclose(expected_sol, sol))
Example #2
0
def test2_navigation_eqs():

    time = 0
    lin_vel = np.array([1, 0, 1], dtype=float)
    euler_angles = np.array([0, np.pi / 2, 0])

    expected_sol = np.array([1, -1, 0], dtype=float)
    sol = navigation_eqs(time, lin_vel, euler_angles)

    assert (np.allclose(expected_sol, sol))
Example #3
0
def test1_navigation_eqs():

    time = 0
    linear_vel = np.array([1, 1, 1], dtype=float)
    euler_angles = np.array([np.pi / 4, np.pi / 4, 0])

    expected_sol = np.array([1 + (2 ** 0.5) / 2, 0, 1 - (2 ** 0.5) / 2])
    sol = navigation_eqs(time, linear_vel, euler_angles)

    assert(np.allclose(expected_sol, sol))
Example #4
0
def test1_navigation_eqs():

    time = 0
    lin_vel = np.array([1, 1, 1], dtype=float)
    euler_angles = np.array([np.pi / 4, np.pi / 4, 0])

    expected_sol = np.array([1 + (2**0.5) / 2, 0, 1 - (2**0.5) / 2])
    sol = navigation_eqs(time, lin_vel, euler_angles)

    assert (np.allclose(expected_sol, sol))