First shot at service lane problem

Works. Can shorten & optimize a lot though