Motor testing routine for the Romeo