blocks: print exception info on error

This commit is contained in:
Oleg Kalachev
2021-05-13 11:46:03 +03:00
parent c0d9bd7ef0
commit 609a7ab014

View File

@@ -10,6 +10,7 @@
from __future__ import print_function from __future__ import print_function
import traceback
import rospy import rospy
import os import os
import threading import threading
@@ -116,6 +117,7 @@ def run(req):
rospy.loginfo('Program forced to stop') rospy.loginfo('Program forced to stop')
except Exception as e: except Exception as e:
rospy.logerr(str(e)) rospy.logerr(str(e))
traceback.print_exc()
error_pub.publish(str(e)) error_pub.publish(str(e))
rospy.loginfo('Program terminated') rospy.loginfo('Program terminated')