Add a few extra ROS_DEBUG outputs for when things aren't quite going as expected.