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