diff --git a/talos_description/urdf/sensors/ftsensor.urdf.xacro b/talos_description/urdf/sensors/ftsensor.urdf.xacro index fa9625bdc7858c66f3722ceb40a8325b588d8cfb..bcbd2be8e8b258b9e0eda556f0910251e7920415 100644 --- a/talos_description/urdf/sensors/ftsensor.urdf.xacro +++ b/talos_description/urdf/sensors/ftsensor.urdf.xacro @@ -38,7 +38,7 @@ <joint name="${name}_${side}_ft_joint" type="fixed"> <parent link="${parent}" /> <child link="${name}_${side}_ft_link" /> - <origin xyz="0 0 -0.051" rpy="${0.0 * deg_to_rad} 0 ${-90.0 * deg_to_rad}" /> + <origin xyz="0 0 -0.051" rpy="${0.0 * deg_to_rad} 0 ${(-60 + 90.0*reflect) * deg_to_rad}" /> </joint> <!--***********************--> @@ -67,7 +67,7 @@ <joint name="${name}_${side}_tool_joint" type="fixed"> <parent link="${name}_${side}_ft_link" /> <child link="${name}_${side}_ft_tool_link" /> - <origin xyz="0 0 ${-1.0 * (0.0157*0.5 + 0.00975*0.5)}" rpy="0 0 ${-90.0 * reflect * deg_to_rad}" /> + <origin xyz="0 0 ${-1.0 * (0.0157*0.5 + 0.00975*0.5)}" rpy="0 0 ${(-30 - 180.0 * reflect) * deg_to_rad}" /> </joint>