Update RRTConnectPlanner.py

adding code for calculating number of vertex