Figure 1: Real Tiago robot safely interacts in a real-world environment, while avoiding collision with complex geometries