added incremental_edges and rrtconnect_edges support to hacked-up colored prm implementation