Adding program for travel on one line (working) and work in progress for switching lines