catkin port

Hi

ported all package to catkin

compile under groovy