Plane: fixed previous_mode error in geofence 

when we were in MANUAL we would switch back to STABILIZE