From 67776ea0497ecf331f14074387dbeb7cfda4074b Mon Sep 17 00:00:00 2001
From: Thomas Timm Andersen <thomas.timm.dk@gmail.com>
Date: Mon, 16 Nov 2015 10:28:45 +0100
Subject: [PATCH] Kill servo_thread in urscript. Fixes #15

---
 src/ur_driver.cpp | 1 +
 1 file changed, 1 insertion(+)

diff --git a/src/ur_driver.cpp b/src/ur_driver.cpp
index 70503e9..fe30c2c 100644
--- a/src/ur_driver.cpp
+++ b/src/ur_driver.cpp
@@ -213,6 +213,7 @@ bool UrDriver::uploadProg() {
 	cmd_str += "\tend\n";
 	cmd_str += "\tsleep(.1)\n";
 	cmd_str += "\tsocket_close()\n";
+	cmd_str += "\tkill thread_servo\n";
 	cmd_str += "end\n";
 
 	rt_interface_->addCommandToQueue(cmd_str);