def test_waypoints_sensor(scenarios):
    scenario = next(scenarios)
    sim = mock.Mock()
    vehicle = mock.Mock()
    vehicle.pose = Pose(position=np.array([33, (- 65), 0]), orientation=[0, 0, 0, 0], heading_=Heading(0))
    mission = scenario.missions[AGENT_ID]
    plan = Plan(scenario.road_map, mission)
    sensor = WaypointsSensor(vehicle, plan)
    waypoints = sensor()
    assert (len(waypoints) == 3)
def test_waypoints_sensor(scenarios):
    scenario = next(scenarios)
    sim = mock.Mock()
    vehicle = mock.Mock()
    vehicle.pose = Pose(position=np.array([33, (- 65), 0]), orientation=[0, 0, 0, 0], heading_=Heading(0))
    mission = scenario.missions[AGENT_ID]
    plan = Plan(scenario.road_map, mission)
    sensor = WaypointsSensor(vehicle, plan)
    waypoints = sensor()
    assert (len(waypoints) == 3)