Package Catkinized

I've opened a new pull request due to the change of brach...