a simple auto pilot for docking

works not perfect