Add some message fixes and made a test for a new function for stationkeeping.