Feature/catkinization

@furgalep A lot of testing needs to be done, but for the packages I have here it works (also together with rosbuild)