Fixed PID controller
Better takeoff procedure
Fixed multiple targets bug
Fixed bug with copter world
Made final target optional