FS_option logic to avoid crash

Not a bug. During RTL the drone will reach the RTL Altitude before it heads for the home waypoint. Check your RTL Altitude setting. I usually RTL at 300ft. Once the drone is hovering over the home waypoint the drone will descend.