removed ROS code
improved diagnostics