Integrated comments from TFoote: cleaner initialisation and ROS_DEBUG