From 6711879db7d3bbe90d79f34f2a08ce3f7112d64a Mon Sep 17 00:00:00 2001
From: "G.A. vd. Hoorn" <g.a.vanderhoorn@tudelft.nl>
Date: Thu, 18 Jun 2020 13:58:01 +0200
Subject: [PATCH] description: add missing safety_ctrlr for shoulder pan.
 (#514)

---
 ur_description/urdf/ur_macro.xacro | 3 +++
 1 file changed, 3 insertions(+)

diff --git a/ur_description/urdf/ur_macro.xacro b/ur_description/urdf/ur_macro.xacro
index ca73488e9..f23fd1186 100644
--- a/ur_description/urdf/ur_macro.xacro
+++ b/ur_description/urdf/ur_macro.xacro
@@ -237,6 +237,9 @@
       <axis xyz="0 0 1" />
       <limit lower="${shoulder_pan_lower_limit}" upper="${shoulder_pan_upper_limit}"
         effort="${shoulder_pan_effort_limit}" velocity="${shoulder_pan_velocity_limit}"/>
+      <xacro:if value="${safety_limits}">
+         <safety_controller soft_lower_limit="${shoulder_pan_lower_limit + safety_pos_margin}" soft_upper_limit="${shoulder_pan_upper_limit - safety_pos_margin}" k_position="${safety_k_position}" k_velocity="0.0"/>
+      </xacro:if>
       <dynamics damping="0" friction="0"/>
     </joint>
     <joint name="${prefix}shoulder_lift_joint" type="revolute">