fix segmentation fault in robot control package for systems test and robot main