Plane: use set_mode() in do_RTL()

thanks to Randy for spotting this
AP_GPS: fixed example builds with change to init()