RRT-Rope

To use the demo:

The path is in blue and the tree in grey. If RRT-Rope or RRT-connect is selected, the start tree is in green and the goal tree is in red. 

If you're using RRT-Rope, the raw path (before shortening) is in dark blue. If you select Interm. Display, the intermediate shortcuts are shown in yellow.

Enjoy!

The source code is available here.