Changed the build system to catkin and tested with a pair of serie 1 xbees