Python RRT algorithm with visualization, kinodynamic constraints and other optimizations/extensions