Fuerte devel

Adapted package to work with ROS Fuerte