teleop + Collision detection
What is the most effective way to implement teleop (twist) with collision detection, basically how to query the costmap to determine if is clear of free to send the twist msg ?
Cheers, Tiago