[ros6] Updates to readynas package