Graphic intersection: how to trigger a colour change

Dear all,

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.

Any suggestions?

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.

Answer 1

[Amrtanshu Raj]

Hi,

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.

1. You can use the isStateValid or the checkPathValidity function to check if the trajectory is valid.
2. 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.

Hope this helps