adding xacro-based srdf support and increasing rml d gain in simulation