This PR fixes https://github.com/jrl-umi3218/mc_rtc/issues/284.
The current implementation was overriding the robot attitude with the default one from the robot module until the controller became activated. However, the recent changes to robot initialization make use of the floating base pose (robot.posW()) during the initialization process, which in turns overrides the init_pos configuration.
This PR fixes https://github.com/jrl-umi3218/mc_rtc/issues/284. The current implementation was overriding the robot attitude with the default one from the robot module until the controller became activated. However, the recent changes to robot initialization make use of the floating base pose (
robot.posW()
) during the initialization process, which in turns overrides theinit_pos
configuration.