Modularizing and adding depot to point cost vector