From 80d446e8579e56347b3b02d074bea403dcea27ce Mon Sep 17 00:00:00 2001
From: Oleg Kalachev <okalachev@gmail.com>
Date: Thu, 13 May 2021 14:36:15 +0300
Subject: [PATCH] blocks: show traceback in error alert

---
 clover_blocks/src/clover_blocks | 10 +++++++---
 1 file changed, 7 insertions(+), 3 deletions(-)

diff --git a/clover_blocks/src/clover_blocks b/clover_blocks/src/clover_blocks
index abee8383..82a12854 100755
--- a/clover_blocks/src/clover_blocks
+++ b/clover_blocks/src/clover_blocks
@@ -10,9 +10,9 @@
 
 from __future__ import print_function
 
-import traceback
 import rospy
-import os
+import os, sys
+import traceback
 import threading
 import re
 import uuid
@@ -118,7 +118,11 @@ def run(req):
             except Exception as e:
                 rospy.logerr(str(e))
                 traceback.print_exc()
-                error_pub.publish(str(e))
+                etype, value, tb = sys.exc_info()
+                fmt = traceback.format_exception(etype, value, tb)
+                fmt.pop(1) # remove 'clover_blocks' file frame
+                exc_info = ''.join(fmt)
+                error_pub.publish(str(e) + '\n\n' + exc_info)
 
             rospy.loginfo('Program terminated')
             running_lock.release()