- You can use the isStateValid or the checkPathValidity function to check if the trajectory is valid.
- You can also use the checkOccupancy function to check if all the points on the trajectory are obstacle free. To interpolate between the trajectory waypoints, the raycast function can be used.
Graphic intersection: how to trigger a colour change
1 view (last 30 days)
I am plotting real time trajectories on a map full of obstacles.
The obstacles are polygons and my domain is 2D.
I would like to color in red trajectories of bodies that cross an obstacle,
to show that this is unphysical. Of course, that part of the trajectory has to change colour.
Trajectories are plotted in real time according to a running simulation.
I believe that checking at every iteration whether all the trajectories coincide with the contour of the
obstacles would kill the performance.
Amrtanshu Raj on 13 Sep 2021
First you can use a occupancyMap for storing the obstacle and the map.
Then there can be multiple ways to check if a trajectory is valid on not based on your use case.
Hope this helps