Improved route vertex generation
Implemented joint joining in route vertex generation