Remove testresult writer
Wait for the robot to be initialized
Package to preare robot for navigation simulation