Made the package a catkin library, wil reorganize so you only need to link against one thing