Local planner with objectives and checkpoints
StmFFT sensor
Tower control