ein pid controller ist nicht so kompliziert. ich habe mal einen link mit gut verständlichem beispielcode gepostet. find ich nicht mehr, aber es war ein thread von heelx glaube ich.
ich wüsste nicht, wie man physikobjekte einfacher gezielt zu bestimmten positionen bewegen kann.
