Catkinized the package

Converted the package to use catkin. Works on indigo