add addLink function to add_sensor_to_urdf.py
Merge pull request #80 from garaemon/hotfix

add addLink function to add_sensor_to_urdf.py