amesh: fix backnforth order
This MR update the motor trajectory on amesh using backnforth in order to use the start position as the first position.
This MR update the motor trajectory on amesh using backnforth in order to use the start position as the first position.