diff --git a/clover_blocks/src/clover_blocks b/clover_blocks/src/clover_blocks index dd14312f..abee8383 100755 --- a/clover_blocks/src/clover_blocks +++ b/clover_blocks/src/clover_blocks @@ -10,6 +10,7 @@ from __future__ import print_function +import traceback import rospy import os import threading @@ -116,6 +117,7 @@ def run(req): rospy.loginfo('Program forced to stop') except Exception as e: rospy.logerr(str(e)) + traceback.print_exc() error_pub.publish(str(e)) rospy.loginfo('Program terminated')