sorting sensor order of urdfmodel

Sorting sensor depend on sensor_id was added.