Das wird eher nichts ohne einen vernünftigen Interpolationsalgorithmus. Zum Glück ist in A7 bereits einer implementiert, guck dir mal path_spline an. Die Richtung, in welche die Lok schauen muss, ist dann der Vektor (neue Position - alte Position) in einen Euler-Winkel konvertiert.
"Falls das Resultat nicht einfach nur dermassen gut aussieht, sollten Sie nochmal von vorn anfangen..." - Manual