Fix rrt and stomp example