Wrapped up ExtendTree method definition

Adds vertex to tree upon finding no collision of edge

Sets vid as parent to sto vertex