Added extra RPY msg and code for debugging