Added calculation of route length
Added getter for route length vector
Route length test