Migrate to catkin build system