Fixed gateselection (could be nicer) and got autopilot to start
Fixed gateselection (could be nicer) and got autopilot to start

martinappo/robotiina2015,martinappo/robotiina2015,martinappo/robotiina2015,martinappo/robotiina2015