Update RRTPlanner.py

Adding code for calculating number of vertex