- fix pathplanning tsp
- patch up flightcontroller. needs flighttest!