Vehicles moving and attaching to segments correctly.

bugs in lane change
fixing some lane changing problems and removing delay for re-changing

WIP: adding ability to update worker count (add/remove)