update add_sensor_to_collada.py for adding sensor from yaml file

update add_sensor_to_collada.py for adding sensor information to collada file from yaml file