Adding Path Following

Now we can tell a train to go to any landmark. Many things still
don't work properlly, but the basic functionality is there.

Doesn't work:
  - Reversing after a merge
  - Stopping distnace isn't very accurate and doesn't consider
    current speed of the train (which leads to other errors).