The SimRobotConfig should save the robot id and attach it geom and joint string when set on demand instead of adding it to the string once. This allows the id to be used in other unforeseen contexts such as access to other sensors and makes the system more robust.