Adding support for waypoints

[Ruishenl]

No description provided.

[rf-ivtdai]

Looks good. Could you please add cpp test flows to visualize:

• Multi-agent waypoints. 2 cars and 2 pedestrians with their own waypoints, potentially having trajectories crossing each other. We currently only care about system validity (feature runs as expected), and not model quality (whether agents wait for each other gracefully).
• Multi-agent waypoint through red lights.

Please update the general descriptions of agent_attributes for drive() and initialize():

• invertedai/api/drive.py
• invertedai/api/initialize.py

[Ruishenl]

Looks good. Could you please add cpp test flows to visualize:

• Multi-agent waypoints. 2 cars and 2 pedestrians with their own waypoints, potentially having trajectories crossing each other. We currently only care about system validity (feature runs as expected), and not model quality (whether agents wait for each other gracefully).
• Multi-agent waypoint through red lights.

Please update the general descriptions of agent_attributes for drive() and initialize():

• invertedai/api/drive.py
• invertedai/api/initialize.py

I added a single misslilenous test flow for multi agent type with waypoints with traffic lights