First commit of source files. All necessary packages are catkin-compatible.