Modified the set RPY command to be independent of optical flow for now
Also reset the is_RPY flag on timeout of last received command