Hallo,
Das hört sich schonmal gut an. Es ist sowieso besser wenn du es langsam angehst, weil du es dann besser verstehst und besser auf deine Wünsche anpassen kannst.
Ich hab ja auch nicht gleich diese Formel aufgestellt und programmiert. Meien erste Funktion sah noch ganz anders aus. Dann habe ich es einfach angepasst.
Ich habe euch noch ein Video gedreht. Da sieht man schln wie das funktioniert:
http://www.youtube.com/watch?v=RRPJmG_tzRY
Bei der ersten Kiste fährt er scön ruhig und sanft eine Kurve um der Kiste auszuweichen. Bei der zweiten Kiste muss er sich aber schond rehen weil er sonst kollidieren möchte.
man sieht, dass der Roboter sowohl sanft Hindernissen mit einer leichten kurve ausweichen kann alsauch mittels Drehung bei nahen Hindernissen.
Lg