bugfixes in position controller

- todo test