Added rework of payload arduino code