This PR fixes a previous bug where the configured RMF to robot (and vice versa) coordinate transformation is only added to the FleetConfiguration after the EasyFullControl robot handle is added and created. By moving the add_easy_fleet call down, we can ensure that these transformations are stored in the fleet and used properly.
This PR fixes a previous bug where the configured RMF to robot (and vice versa) coordinate transformation is only added to the FleetConfiguration after the EasyFullControl robot handle is added and created. By moving the
add_easy_fleetcall down, we can ensure that these transformations are stored in the fleet and used properly.