small fixes
started position controller

- compiles
- doesn't work