controllers rework
bugfixes
removed unused code
final position controller