X-Git-Url: https://defiant.homedns.org/gitweb/?p=ros_wild_thumper.git;a=blobdiff_plain;f=urdf%2Fwild_thumper.urdf.xacro;h=67e6da7b5602ac6cc180dc406161b34e520c217a;hp=c783cffff36792da7c39d78102995dd0bf82f1a5;hb=1f9bfab5123f0dcdfe0da75c47558f73a572de90;hpb=4958e800772cdb9f790ce42feb89ea87d4b268e7

diff --git a/urdf/wild_thumper.urdf.xacro b/urdf/wild_thumper.urdf.xacro
index c783cff..67e6da7 100644
--- a/urdf/wild_thumper.urdf.xacro
+++ b/urdf/wild_thumper.urdf.xacro
@@ -5,9 +5,9 @@
 
 	<link name="base_link">
 		<visual>
-			<origin xyz="0.09 -0.02 0.07" rpy="${PI} 0 ${-PI/2}"/>
+			<origin xyz="0 0 -0.13" rpy="0 0 0"/>
 			<geometry>
-				<mesh filename="package://wild_thumper/meshes/wild_thumper_assembly_corrected.stl" scale="0.001 0.001 0.001" />
+				<mesh filename="package://wild_thumper/meshes/wild_thumper_4wd.stl" scale="1 1 1" />
 			</geometry>
 		</visual>
 	</link>
@@ -38,6 +38,54 @@
 		<origin xyz="0.107 0.0 0.04" rpy="0 0 0"/>
 	</xacro:asus_camera>
 
+	<link name="sonar_forward">
+		<visual>
+			<geometry>
+				<box size="0.016 0.044 0.02"/>
+			</geometry>
+			<origin xyz="${0.016/2} 0 0" rpy="0 0 0"/>
+			<material name="green">
+				<color rgba="0 1 0 0.8"/>
+			</material>
+		</visual>
+	</link>
+
+	<link name="sonar_backward">
+		<visual>
+			<geometry>
+				<box size="0.016 0.044 0.02"/>
+			</geometry>
+			<origin xyz="${0.016/2} 0 0" rpy="0 0 0"/>
+			<material name="green">
+				<color rgba="0 1 0 0.8"/>
+			</material>
+		</visual>
+	</link>
+
+	<link name="ir_left">
+		<visual>
+			<geometry>
+				<box size="0.015 0.015 0.046"/>
+			</geometry>
+			<origin xyz="${-0.015/2} 0 0" rpy="0 0 0"/>
+			<material name="black">
+				<color rgba="0 0 0 1"/>
+			</material>
+		</visual>
+	</link>
+
+	<link name="ir_right">
+		<visual>
+			<geometry>
+				<box size="0.015 0.015 0.046"/>
+			</geometry>
+			<origin xyz="${-0.015/2} 0 0" rpy="0 0 0"/>
+			<material name="black">
+				<color rgba="0 0 0 1"/>
+			</material>
+		</visual>
+	</link>
+
 	<joint name="imu_joint" type="fixed">
 		<parent link="base_link"/>
 		<child link="base_imu_link"/>
@@ -49,4 +97,28 @@
 		<child link="base_link"/>
 		<origin xyz="0.0 0.0 0.13" rpy="0 0 0"/>
 	</joint>
+
+	<joint name="sonar_forward_joint" type="fixed">
+		<parent link="base_link"/>
+		<child link="sonar_forward"/>
+		<origin xyz="0.115 0.0 -0.012" rpy="0 0 0"/>
+	</joint>
+
+	<joint name="sonar_backward_joint" type="fixed">
+		<parent link="base_link"/>
+		<child link="sonar_backward"/>
+		<origin xyz="-0.115 0.0 -0.012" rpy="0 ${PI} 0"/>
+	</joint>
+
+	<joint name="ir_left_joint" type="fixed">
+		<parent link="base_link"/>
+		<child link="ir_left"/>
+		<origin xyz="0.0 ${0.072+0.015} -0.045" rpy="0 0 ${PI/2}"/>
+	</joint>
+
+	<joint name="ir_right_joint" type="fixed">
+		<parent link="base_link"/>
+		<child link="ir_right"/>
+		<origin xyz="0.0 ${-0.072-0.015} -0.045" rpy="0 0 ${-PI/2}"/>
+	</joint>
 </robot>