From 43812c328e2fdcb2bebe900fe28b7513f2103572 Mon Sep 17 00:00:00 2001
From: John Hsu <johnhsu@willowgarage.com>
Date: Wed, 10 Oct 2012 16:48:17 -0700
Subject: [PATCH 1/8] adding pr2 gripper model (uses pr2 model meshes)

---
 pr2_gripper/manifest.xml |  20 ++
 pr2_gripper/model.sdf    | 716 +++++++++++++++++++++++++++++++++++++++
 2 files changed, 736 insertions(+)
 create mode 100644 pr2_gripper/manifest.xml
 create mode 100644 pr2_gripper/model.sdf

diff --git a/pr2_gripper/manifest.xml b/pr2_gripper/manifest.xml
new file mode 100644
index 0000000..962f051
--- /dev/null
+++ b/pr2_gripper/manifest.xml
@@ -0,0 +1,20 @@
+<?xml version="1.0"?>
+
+<model>
+  <name>PR2 Gripper</name>
+  <version>1.0</version>
+  <sdf>model.sdf</sdf>
+
+  <author>
+    <name>John Hsu</name>
+    <email>hsu@osrfoundation.org</email>
+  </author>
+
+  <description>
+    The Willow Garage PR2 gripper model.
+  </description>
+
+  <depend>
+    pr2
+  </depend>
+</model>
diff --git a/pr2_gripper/model.sdf b/pr2_gripper/model.sdf
new file mode 100644
index 0000000..587f8af
--- /dev/null
+++ b/pr2_gripper/model.sdf
@@ -0,0 +1,716 @@
+<gazebo version='1.2'>
+  <model name='pr2_gripper'>
+    <pose>-0.771000 0.188000 -0.790675 3.141593 -1.570796 3.141593</pose>
+    <link name='r_wrist_roll_link'>
+      <pose>0.771000 -0.188000 0.790675 0.000000 -0.000000 0.000000</pose>
+      <inertial>
+        <pose>0.056408 0.000451 -0.001014 0.000000 -0.000000 0.000000</pose>
+        <inertia>
+          <ixx>0.011352</ixx>
+          <ixy>-0.000016</ixy>
+          <ixz>-0.000001</ixz>
+          <iyy>0.011677</iyy>
+          <iyz>-0.000001</iyz>
+          <izz>0.011866</izz>
+        </inertia>
+        <mass>0.681070</mass>
+      </inertial>
+      <collision name='r_wrist_roll_link_geom'>
+        <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+        <geometry>
+          <mesh>
+            <uri>model://pr2/forearm_v0/wrist_roll_L.stl</uri>
+            <scale>1.000000 1.000000 1.000000</scale>
+            <uri>__default__</uri>
+          </mesh>
+        </geometry>
+        <surface>
+          <friction>
+            <ode>
+              <mu>-1.000000</mu>
+              <mu2>-1.000000</mu2>
+              <fdir1>0.000000 0.000000 0.000000</fdir1>
+              <slip1>0.000000</slip1>
+              <slip2>0.000000</slip2>
+            </ode>
+          </friction>
+          <bounce>
+            <restitution_coefficient>0.000000</restitution_coefficient>
+            <threshold>100000.000000</threshold>
+          </bounce>
+          <contact>
+            <ode>
+              <soft_cfm>0.000000</soft_cfm>
+              <soft_erp>0.200000</soft_erp>
+              <kp>1000000000000.000000</kp>
+              <kd>1.000000</kd>
+              <max_vel>0.000000</max_vel>
+              <min_depth>0.001000</min_depth>
+            </ode>
+          </contact>
+        </surface>
+        <laser_retro>0.000000</laser_retro>
+      </collision>
+      <visual name='r_wrist_roll_link_geom_visual'>
+        <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+        <geometry>
+          <mesh>
+            <uri>model://pr2/forearm_v0/wrist_roll.stl</uri>
+            <scale>1.000000 1.000000 1.000000</scale>
+            <uri>__default__</uri>
+          </mesh>
+        </geometry>
+        <material>
+          <script>
+            <name>__default__</name>
+          </script>
+        </material>
+        <cast_shadows>1</cast_shadows>
+        <laser_retro>0.000000</laser_retro>
+        <transparency>0.000000</transparency>
+      </visual>
+      <visual name='r_wrist_roll_link_geom_r_gripper_palm_link_visual'>
+        <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+        <geometry>
+          <mesh>
+            <uri>model://pr2/gripper_v0/gripper_palm.dae</uri>
+            <scale>1.000000 1.000000 1.000000</scale>
+            <uri>__default__</uri>
+          </mesh>
+        </geometry>
+        <cast_shadows>1</cast_shadows>
+        <laser_retro>0.000000</laser_retro>
+        <transparency>0.000000</transparency>
+      </visual>
+      <gravity>1</gravity>
+      <self_collide>0</self_collide>
+      <kinematic>0</kinematic>
+      <velocity_decay/>
+    </link>
+    <link name='r_gripper_l_finger_link'>
+      <pose>0.847910 -0.178000 0.790675 0.000000 -0.000000 0.000000</pose>
+      <inertial>
+        <pose>0.035980 0.017300 -0.001640 0.000000 -0.000000 0.000000</pose>
+        <inertia>
+          <ixx>0.000078</ixx>
+          <ixy>0.000001</ixy>
+          <ixz>-0.000010</ixz>
+          <iyy>0.000197</iyy>
+          <iyz>-0.000003</iyz>
+          <izz>0.000181</izz>
+        </inertia>
+        <mass>0.171260</mass>
+      </inertial>
+      <collision name='r_gripper_l_finger_link_geom'>
+        <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+        <geometry>
+          <mesh>
+            <uri>model://pr2/gripper_v0/l_finger.stl</uri>
+            <scale>1.000000 1.000000 1.000000</scale>
+            <uri>__default__</uri>
+          </mesh>
+        </geometry>
+        <surface>
+          <friction>
+            <ode>
+              <mu>500.000000</mu>
+              <mu2>500.000000</mu2>
+              <fdir1>0.000000 0.000000 0.000000</fdir1>
+              <slip1>0.000000</slip1>
+              <slip2>0.000000</slip2>
+            </ode>
+          </friction>
+          <bounce>
+            <restitution_coefficient>0.000000</restitution_coefficient>
+            <threshold>100000.000000</threshold>
+          </bounce>
+          <contact>
+            <ode>
+              <soft_cfm>0.000000</soft_cfm>
+              <soft_erp>0.200000</soft_erp>
+              <kp>1000000.000000</kp>
+              <kd>1.000000</kd>
+              <max_vel>0.000000</max_vel>
+              <min_depth>0.001000</min_depth>
+            </ode>
+          </contact>
+        </surface>
+        <laser_retro>0.000000</laser_retro>
+      </collision>
+      <visual name='r_gripper_l_finger_link_geom_visual'>
+        <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+        <geometry>
+          <mesh>
+            <uri>model://pr2/gripper_v0/l_finger.dae</uri>
+            <scale>1.000000 1.000000 1.000000</scale>
+            <uri>__default__</uri>
+          </mesh>
+        </geometry>
+        <cast_shadows>1</cast_shadows>
+        <laser_retro>0.000000</laser_retro>
+        <transparency>0.000000</transparency>
+      </visual>
+      <gravity>1</gravity>
+      <self_collide>0</self_collide>
+      <kinematic>0</kinematic>
+      <velocity_decay/>
+    </link>
+    <link name='r_gripper_l_finger_tip_link'>
+      <pose>0.939280 -0.173050 0.790675 0.000000 -0.000000 0.000000</pose>
+      <inertial>
+        <pose>0.004230 0.002840 0.000000 0.000000 -0.000000 0.000000</pose>
+        <inertia>
+          <ixx>0.000008</ixx>
+          <ixy>0.000006</ixy>
+          <ixz>0.000000</ixz>
+          <iyy>0.000010</iyy>
+          <iyz>0.000000</iyz>
+          <izz>0.000015</izz>
+        </inertia>
+        <mass>0.044190</mass>
+      </inertial>
+      <collision name='r_gripper_l_finger_tip_link_geom'>
+        <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+        <geometry>
+          <mesh>
+            <uri>model://pr2/gripper_v0/l_finger_tip.stl</uri>
+            <scale>1.000000 1.000000 1.000000</scale>
+            <uri>__default__</uri>
+          </mesh>
+        </geometry>
+        <surface>
+          <friction>
+            <ode>
+              <mu>500.000000</mu>
+              <mu2>500.000000</mu2>
+              <fdir1>0.000000 0.000000 0.000000</fdir1>
+              <slip1>0.000000</slip1>
+              <slip2>0.000000</slip2>
+            </ode>
+          </friction>
+          <bounce>
+            <restitution_coefficient>0.000000</restitution_coefficient>
+            <threshold>100000.000000</threshold>
+          </bounce>
+          <contact>
+            <ode>
+              <soft_cfm>0.000000</soft_cfm>
+              <soft_erp>0.200000</soft_erp>
+              <kp>10000000.000000</kp>
+              <kd>1.000000</kd>
+              <max_vel>0.000000</max_vel>
+              <min_depth>0.001000</min_depth>
+            </ode>
+          </contact>
+        </surface>
+        <laser_retro>0.000000</laser_retro>
+      </collision>
+      <visual name='r_gripper_l_finger_tip_link_geom_visual'>
+        <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+        <geometry>
+          <mesh>
+            <uri>model://pr2/gripper_v0/l_finger_tip.dae</uri>
+            <scale>1.000000 1.000000 1.000000</scale>
+            <uri>__default__</uri>
+          </mesh>
+        </geometry>
+        <cast_shadows>1</cast_shadows>
+        <laser_retro>0.000000</laser_retro>
+        <transparency>0.000000</transparency>
+      </visual>
+      <sensor name='r_gripper_l_finger_tip_contact_sensor' type='contact'>
+        <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+        <contact>
+          <collision>r_gripper_l_finger_tip_link_geom</collision>
+          <topic>__default_topic__</topic>
+        </contact>
+        <always_on>0</always_on>
+        <update_rate>100.000000</update_rate>
+        <visualize>0</visualize>
+      </sensor>
+      <gravity>1</gravity>
+      <self_collide>0</self_collide>
+      <kinematic>0</kinematic>
+      <velocity_decay/>
+    </link>
+    <link name='r_gripper_motor_slider_link'>
+      <pose>0.939280 -0.188000 0.790675 0.000000 -0.000000 0.000000</pose>
+      <inertial>
+        <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+        <inertia>
+          <ixx>0.001000</ixx>
+          <ixy>0.000000</ixy>
+          <ixz>0.000000</ixz>
+          <iyy>0.001000</iyy>
+          <iyz>0.000000</iyz>
+          <izz>0.001000</izz>
+        </inertia>
+        <mass>0.010000</mass>
+      </inertial>
+      <gravity>1</gravity>
+      <self_collide>0</self_collide>
+      <kinematic>0</kinematic>
+      <velocity_decay/>
+    </link>
+    <link name='r_gripper_motor_screw_link'>
+      <pose>0.939280 -0.188000 0.790675 0.000000 -0.000000 0.000000</pose>
+      <inertial>
+        <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+        <inertia>
+          <ixx>0.000100</ixx>
+          <ixy>0.000000</ixy>
+          <ixz>0.000000</ixz>
+          <iyy>0.000100</iyy>
+          <iyz>0.000000</iyz>
+          <izz>0.000100</izz>
+        </inertia>
+        <mass>0.010000</mass>
+      </inertial>
+      <gravity>1</gravity>
+      <self_collide>0</self_collide>
+      <kinematic>0</kinematic>
+      <velocity_decay/>
+    </link>
+    <link name='r_gripper_r_finger_link'>
+      <pose>0.847910 -0.198000 0.790675 0.000000 -0.000000 0.000000</pose>
+      <inertial>
+        <pose>0.035760 -0.017360 -0.000950 0.000000 -0.000000 0.000000</pose>
+        <inertia>
+          <ixx>0.000077</ixx>
+          <ixy>-0.000002</ixy>
+          <ixz>-0.000008</ixz>
+          <iyy>0.000198</iyy>
+          <iyz>0.000002</iyz>
+          <izz>0.000181</izz>
+        </inertia>
+        <mass>0.173890</mass>
+      </inertial>
+      <collision name='r_gripper_r_finger_link_geom'>
+        <pose>0.000000 0.000000 0.000000 -3.141590 -0.000000 0.000000</pose>
+        <geometry>
+          <mesh>
+            <uri>model://pr2/gripper_v0/l_finger.stl</uri>
+            <scale>1.000000 1.000000 1.000000</scale>
+            <uri>__default__</uri>
+          </mesh>
+        </geometry>
+        <surface>
+          <friction>
+            <ode>
+              <mu>500.000000</mu>
+              <mu2>500.000000</mu2>
+              <fdir1>0.000000 0.000000 0.000000</fdir1>
+              <slip1>0.000000</slip1>
+              <slip2>0.000000</slip2>
+            </ode>
+          </friction>
+          <bounce>
+            <restitution_coefficient>0.000000</restitution_coefficient>
+            <threshold>100000.000000</threshold>
+          </bounce>
+          <contact>
+            <ode>
+              <soft_cfm>0.000000</soft_cfm>
+              <soft_erp>0.200000</soft_erp>
+              <kp>1000000.000000</kp>
+              <kd>1.000000</kd>
+              <max_vel>0.000000</max_vel>
+              <min_depth>0.001000</min_depth>
+            </ode>
+          </contact>
+        </surface>
+        <laser_retro>0.000000</laser_retro>
+      </collision>
+      <visual name='r_gripper_r_finger_link_geom_visual'>
+        <pose>0.000000 0.000000 0.000000 -3.141590 0.000000 0.000000</pose>
+        <geometry>
+          <mesh>
+            <uri>model://pr2/gripper_v0/l_finger.dae</uri>
+            <scale>1.000000 1.000000 1.000000</scale>
+            <uri>__default__</uri>
+          </mesh>
+        </geometry>
+        <cast_shadows>1</cast_shadows>
+        <laser_retro>0.000000</laser_retro>
+        <transparency>0.000000</transparency>
+      </visual>
+      <gravity>1</gravity>
+      <self_collide>0</self_collide>
+      <kinematic>0</kinematic>
+      <velocity_decay/>
+    </link>
+    <link name='r_gripper_r_finger_tip_link'>
+      <pose>0.939280 -0.202950 0.790675 0.000000 -0.000000 0.000000</pose>
+      <inertial>
+        <pose>0.004230 -0.002840 0.000000 0.000000 -0.000000 0.000000</pose>
+        <inertia>
+          <ixx>0.000008</ixx>
+          <ixy>-0.000006</ixy>
+          <ixz>0.000000</ixz>
+          <iyy>0.000010</iyy>
+          <iyz>0.000000</iyz>
+          <izz>0.000015</izz>
+        </inertia>
+        <mass>0.044190</mass>
+      </inertial>
+      <collision name='r_gripper_r_finger_tip_link_geom'>
+        <pose>0.000000 0.000000 0.000000 -3.141590 -0.000000 0.000000</pose>
+        <geometry>
+          <mesh>
+            <uri>model://pr2/gripper_v0/l_finger_tip.stl</uri>
+            <scale>1.000000 1.000000 1.000000</scale>
+            <uri>__default__</uri>
+          </mesh>
+        </geometry>
+        <surface>
+          <friction>
+            <ode>
+              <mu>500.000000</mu>
+              <mu2>500.000000</mu2>
+              <fdir1>0.000000 0.000000 0.000000</fdir1>
+              <slip1>0.000000</slip1>
+              <slip2>0.000000</slip2>
+            </ode>
+          </friction>
+          <bounce>
+            <restitution_coefficient>0.000000</restitution_coefficient>
+            <threshold>100000.000000</threshold>
+          </bounce>
+          <contact>
+            <ode>
+              <soft_cfm>0.000000</soft_cfm>
+              <soft_erp>0.200000</soft_erp>
+              <kp>10000000.000000</kp>
+              <kd>1.000000</kd>
+              <max_vel>0.000000</max_vel>
+              <min_depth>0.001000</min_depth>
+            </ode>
+          </contact>
+        </surface>
+        <laser_retro>0.000000</laser_retro>
+      </collision>
+      <visual name='r_gripper_r_finger_tip_link_geom_visual'>
+        <pose>0.000000 0.000000 0.000000 -3.141590 0.000000 0.000000</pose>
+        <geometry>
+          <mesh>
+            <uri>model://pr2/gripper_v0/l_finger_tip.dae</uri>
+            <scale>1.000000 1.000000 1.000000</scale>
+            <uri>__default__</uri>
+          </mesh>
+        </geometry>
+        <cast_shadows>1</cast_shadows>
+        <laser_retro>0.000000</laser_retro>
+        <transparency>0.000000</transparency>
+      </visual>
+      <sensor name='r_gripper_r_finger_tip_contact_sensor' type='contact'>
+        <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+        <contact>
+          <collision>r_gripper_r_finger_tip_link_geom</collision>
+          <topic>__default_topic__</topic>
+        </contact>
+        <always_on>0</always_on>
+        <update_rate>100.000000</update_rate>
+        <visualize>0</visualize>
+      </sensor>
+      <gravity>1</gravity>
+      <self_collide>0</self_collide>
+      <kinematic>0</kinematic>
+      <velocity_decay/>
+    </link>
+    <link name='torso_lift_motor_screw_link'>
+      <pose>-0.150000 0.000000 0.751000 0.000000 -0.000000 0.000000</pose>
+      <inertial>
+        <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+        <inertia>
+          <ixx>0.001000</ixx>
+          <ixy>0.000000</ixy>
+          <ixz>0.000000</ixz>
+          <iyy>0.001000</iyy>
+          <iyz>0.000000</iyz>
+          <izz>0.001000</izz>
+        </inertia>
+        <mass>1.000000</mass>
+      </inertial>
+      <gravity>1</gravity>
+      <self_collide>0</self_collide>
+      <kinematic>0</kinematic>
+      <velocity_decay/>
+    </link>
+    <link name='r_gripper_l_parallel_link'>
+      <pose>0.829910 -0.157000 0.790675 0.000000 -0.000000 0.000000</pose>
+      <inertial>
+        <pose>0.035980 0.017300 -0.001640 0.000000 -0.000000 0.000000</pose>
+        <inertia>
+          <ixx>0.000078</ixx>
+          <ixy>0.000001</ixy>
+          <ixz>-0.000010</ixz>
+          <iyy>0.000197</iyy>
+          <iyz>-0.000003</iyz>
+          <izz>0.000181</izz>
+        </inertia>
+        <mass>0.171260</mass>
+      </inertial>
+      <gravity>1</gravity>
+      <self_collide>0</self_collide>
+      <kinematic>0</kinematic>
+      <velocity_decay/>
+    </link>
+    <link name='r_gripper_r_parallel_link'>
+      <pose>0.829910 -0.219000 0.790675 0.000000 -0.000000 0.000000</pose>
+      <inertial>
+        <pose>0.035760 -0.017360 -0.000950 0.000000 -0.000000 0.000000</pose>
+        <inertia>
+          <ixx>0.000077</ixx>
+          <ixy>-0.000002</ixy>
+          <ixz>-0.000008</ixz>
+          <iyy>0.000198</iyy>
+          <iyz>0.000002</iyz>
+          <izz>0.000181</izz>
+        </inertia>
+        <mass>0.173890</mass>
+      </inertial>
+      <gravity>1</gravity>
+      <self_collide>0</self_collide>
+      <kinematic>0</kinematic>
+      <velocity_decay/>
+    </link>
+    <joint name='r_gripper_l_finger_joint' type='revolute'>
+      <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+      <parent>r_wrist_roll_link</parent>
+      <child>r_gripper_l_finger_link</child>
+      <axis>
+        <dynamics>
+          <damping>0.020000</damping>
+          <friction>0.000000</friction>
+        </dynamics>
+        <limit>
+          <lower>0.000000</lower>
+          <upper>0.548000</upper>
+          <effort>0.000000</effort>
+          <velocity>0.000000</velocity>
+        </limit>
+        <xyz>0.000000 0.000000 1.000000</xyz>
+      </axis>
+    </joint>
+    <joint name='r_gripper_l_finger_tip_joint' type='revolute'>
+      <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+      <parent>r_gripper_l_finger_link</parent>
+      <child>r_gripper_l_finger_tip_link</child>
+      <axis>
+        <dynamics>
+          <damping>0.001000</damping>
+          <friction>0.000000</friction>
+        </dynamics>
+        <limit>
+          <lower>0.000000</lower>
+          <upper>0.548000</upper>
+          <effort>0.000000</effort>
+          <velocity>0.000000</velocity>
+        </limit>
+        <xyz>0.000000 0.000000 -1.000000</xyz>
+      </axis>
+    </joint>
+    <joint name='r_gripper_motor_slider_joint' type='prismatic'>
+      <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+      <parent>r_wrist_roll_link</parent>
+      <child>r_gripper_motor_slider_link</child>
+      <axis>
+        <dynamics>
+          <damping>0.000000</damping>
+          <friction>0.000000</friction>
+        </dynamics>
+        <limit>
+          <lower>-0.100000</lower>
+          <upper>0.100000</upper>
+          <effort>0.000000</effort>
+          <velocity>0.000000</velocity>
+        </limit>
+        <xyz>1.000000 0.000000 0.000000</xyz>
+      </axis>
+    </joint>
+    <joint name='r_gripper_motor_screw_joint' type='revolute'>
+      <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+      <parent>r_gripper_motor_slider_link</parent>
+      <child>r_gripper_motor_screw_link</child>
+      <axis>
+        <dynamics>
+          <damping>0.000100</damping>
+          <friction>0.000000</friction>
+        </dynamics>
+        <limit>
+          <lower>-10000000000000000.000000</lower>
+          <upper>10000000000000000.000000</upper>
+          <effort>0.000000</effort>
+          <velocity>0.000000</velocity>
+        </limit>
+        <xyz>0.000000 1.000000 0.000000</xyz>
+      </axis>
+    </joint>
+    <joint name='r_gripper_r_finger_joint' type='revolute'>
+      <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+      <parent>r_wrist_roll_link</parent>
+      <child>r_gripper_r_finger_link</child>
+      <axis>
+        <dynamics>
+          <damping>0.020000</damping>
+          <friction>0.000000</friction>
+        </dynamics>
+        <limit>
+          <lower>0.000000</lower>
+          <upper>0.548000</upper>
+          <effort>0.000000</effort>
+          <velocity>0.000000</velocity>
+        </limit>
+        <xyz>0.000000 0.000000 -1.000000</xyz>
+      </axis>
+    </joint>
+    <joint name='r_gripper_r_finger_tip_joint' type='revolute'>
+      <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+      <parent>r_gripper_r_finger_link</parent>
+      <child>r_gripper_r_finger_tip_link</child>
+      <axis>
+        <dynamics>
+          <damping>0.001000</damping>
+          <friction>0.000000</friction>
+        </dynamics>
+        <limit>
+          <lower>0.000000</lower>
+          <upper>0.548000</upper>
+          <effort>0.000000</effort>
+          <velocity>0.000000</velocity>
+        </limit>
+        <xyz>0.000000 0.000000 1.000000</xyz>
+      </axis>
+    </joint>
+    <joint name='r_gripper_r_screw_screw_joint' type='screw'>
+      <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+      <parent>r_gripper_r_finger_tip_link</parent>
+      <child>r_gripper_motor_screw_link</child>
+      <thread_pitch>-3141.600000</thread_pitch>
+      <axis>
+        <dynamics>
+          <damping>0.000000</damping>
+          <friction>0.000000</friction>
+        </dynamics>
+        <limit>
+          <lower>-10000000000000000.000000</lower>
+          <upper>10000000000000000.000000</upper>
+          <effort>0.000000</effort>
+          <velocity>0.000000</velocity>
+        </limit>
+        <xyz>0.000000 1.000000 0.000000</xyz>
+      </axis>
+    </joint>
+    <joint name='r_gripper_l_screw_screw_joint' type='screw'>
+      <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+      <parent>r_gripper_l_finger_tip_link</parent>
+      <child>r_gripper_motor_screw_link</child>
+      <thread_pitch>3141.600000</thread_pitch>
+      <axis>
+        <dynamics>
+          <damping>0.000000</damping>
+          <friction>0.000000</friction>
+        </dynamics>
+        <limit>
+          <lower>-10000000000000000.000000</lower>
+          <upper>10000000000000000.000000</upper>
+          <effort>0.000000</effort>
+          <velocity>0.000000</velocity>
+        </limit>
+        <xyz>0.000000 1.000000 0.000000</xyz>
+      </axis>
+    </joint>
+    <joint name='r_gripper_r_parallel_root_joint' type='revolute'>
+      <pose>0.058910 -0.031000 0.000000 0.000000 -0.000000 0.000000</pose>
+      <parent>r_gripper_r_parallel_link</parent>
+      <child>r_wrist_roll_link</child>
+      <axis>
+        <dynamics>
+          <damping>0.200000</damping>
+          <friction>0.000000</friction>
+        </dynamics>
+        <limit>
+          <lower>-10000000000000000.000000</lower>
+          <upper>10000000000000000.000000</upper>
+          <effort>0.000000</effort>
+          <velocity>0.000000</velocity>
+        </limit>
+        <xyz>0.000000 0.000000 -1.000000</xyz>
+      </axis>
+    </joint>
+    <joint name='r_gripper_l_parallel_root_joint' type='revolute'>
+      <pose>0.058910 0.031000 0.000000 0.000000 -0.000000 0.000000</pose>
+      <parent>r_gripper_l_parallel_link</parent>
+      <child>r_wrist_roll_link</child>
+      <axis>
+        <dynamics>
+          <damping>0.200000</damping>
+          <friction>0.000000</friction>
+        </dynamics>
+        <limit>
+          <lower>-10000000000000000.000000</lower>
+          <upper>10000000000000000.000000</upper>
+          <effort>0.000000</effort>
+          <velocity>0.000000</velocity>
+        </limit>
+        <xyz>0.000000 0.000000 1.000000</xyz>
+      </axis>
+    </joint>
+    <joint name='r_gripper_r_parallel_tip_joint' type='revolute'>
+      <pose>-0.018000 -0.021000 0.000000 0.000000 -0.000000 0.000000</pose>
+      <parent>r_gripper_r_parallel_link</parent>
+      <child>r_gripper_r_finger_tip_link</child>
+      <axis>
+        <dynamics>
+          <damping>0.000000</damping>
+          <friction>0.000000</friction>
+        </dynamics>
+        <limit>
+          <lower>-10000000000000000.000000</lower>
+          <upper>10000000000000000.000000</upper>
+          <effort>0.000000</effort>
+          <velocity>0.000000</velocity>
+        </limit>
+        <xyz>0.000000 0.000000 1.000000</xyz>
+      </axis>
+    </joint>
+    <joint name='r_gripper_l_parallel_tip_joint' type='revolute'>
+      <pose>-0.018000 0.021000 0.000000 0.000000 -0.000000 0.000000</pose>
+      <parent>r_gripper_l_parallel_link</parent>
+      <child>r_gripper_l_finger_tip_link</child>
+      <axis>
+        <dynamics>
+          <damping>0.000000</damping>
+          <friction>0.000000</friction>
+        </dynamics>
+        <limit>
+          <lower>-10000000000000000.000000</lower>
+          <upper>10000000000000000.000000</upper>
+          <effort>0.000000</effort>
+          <velocity>0.000000</velocity>
+        </limit>
+        <xyz>0.000000 0.000000 1.000000</xyz>
+      </axis>
+    </joint>
+    <joint name='r_gripper_joint' type='prismatic'>
+      <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
+      <parent>r_gripper_r_finger_tip_link</parent>
+      <child>r_gripper_l_finger_tip_link</child>
+      <axis>
+        <dynamics>
+          <damping>0.000000</damping>
+          <friction>0.000000</friction>
+        </dynamics>
+        <limit>
+          <lower>-10000000000000000.000000</lower>
+          <upper>10000000000000000.000000</upper>
+          <effort>0.000000</effort>
+          <velocity>0.000000</velocity>
+        </limit>
+        <xyz>0.000000 1.000000 0.000000</xyz>
+      </axis>
+    </joint>
+    <static>0</static>
+  </model>
+</gazebo>
+Success

From 37cde3d5dcd9c135f2ef2bb128d1ac5d0911b31a Mon Sep 17 00:00:00 2001
From: John Hsu <johnhsu@willowgarage.com>
Date: Wed, 10 Oct 2012 16:49:35 -0700
Subject: [PATCH 2/8] update pr2_gripper model

---
 pr2_gripper/manifest.xml | 5 ++++-
 1 file changed, 4 insertions(+), 1 deletion(-)

diff --git a/pr2_gripper/manifest.xml b/pr2_gripper/manifest.xml
index 962f051..1ca1c62 100644
--- a/pr2_gripper/manifest.xml
+++ b/pr2_gripper/manifest.xml
@@ -15,6 +15,9 @@
   </description>
 
   <depend>
-    pr2
+    <model>
+      <uri>model://pr2</uri>
+      <version>1.0</version>
+    </model>
   </depend>
 </model>

From 855557345fb8ee81f7bbdeeb357ffddbac1bbcd1 Mon Sep 17 00:00:00 2001
From: John Hsu <johnhsu@willowgarage.com>
Date: Wed, 10 Oct 2012 16:50:48 -0700
Subject: [PATCH 3/8] add pr2_gripper to CMakeLists.txt

---
 CMakeLists.txt | 1 +
 1 file changed, 1 insertion(+)

diff --git a/CMakeLists.txt b/CMakeLists.txt
index 82bbba7..9bdb579 100644
--- a/CMakeLists.txt
+++ b/CMakeLists.txt
@@ -47,6 +47,7 @@ set (dirs
   pioneer2dx
   powerplant
   pr2
+  pr2_gripper
   saucepan
   simple_arm
   simple_arm_gripper

From 201c32d06888a451735101b227e7d5c423694958 Mon Sep 17 00:00:00 2001
From: John Hsu <johnhsu@willowgarage.com>
Date: Wed, 10 Oct 2012 16:51:08 -0700
Subject: [PATCH 4/8] add pr2_gripper to database manifest.xml

---
 manifest.xml | 1 +
 1 file changed, 1 insertion(+)

diff --git a/manifest.xml b/manifest.xml
index 81b6e62..24142bd 100644
--- a/manifest.xml
+++ b/manifest.xml
@@ -20,6 +20,7 @@
     <uri>file://pioneer2dx</uri>
     <uri>file://powerplant</uri>
     <uri>file://pr2</uri>
+    <uri>file://pr2_gripper</uri>
     <uri>file://saucepan</uri>
     <uri>file://simple_arm</uri>
     <uri>file://simple_arm_gripper</uri>

From aa7234b28719441b3888e6cdae8dbbb661be3354 Mon Sep 17 00:00:00 2001
From: John Hsu <johnhsu@willowgarage.com>
Date: Wed, 10 Oct 2012 16:55:59 -0700
Subject: [PATCH 5/8] fix pr2_gripper mesh paths

---
 pr2_gripper/model.sdf | 23 ++++++++++++-----------
 1 file changed, 12 insertions(+), 11 deletions(-)

diff --git a/pr2_gripper/model.sdf b/pr2_gripper/model.sdf
index 587f8af..295f3e3 100644
--- a/pr2_gripper/model.sdf
+++ b/pr2_gripper/model.sdf
@@ -1,3 +1,4 @@
+<?xml version="1.0" ?>
 <gazebo version='1.2'>
   <model name='pr2_gripper'>
     <pose>-0.771000 0.188000 -0.790675 3.141593 -1.570796 3.141593</pose>
@@ -19,7 +20,7 @@
         <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
         <geometry>
           <mesh>
-            <uri>model://pr2/forearm_v0/wrist_roll_L.stl</uri>
+            <uri>model://pr2/meshes/forearm_v0/wrist_roll_L.stl</uri>
             <scale>1.000000 1.000000 1.000000</scale>
             <uri>__default__</uri>
           </mesh>
@@ -55,7 +56,7 @@
         <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
         <geometry>
           <mesh>
-            <uri>model://pr2/forearm_v0/wrist_roll.stl</uri>
+            <uri>model://pr2/meshes/forearm_v0/wrist_roll.stl</uri>
             <scale>1.000000 1.000000 1.000000</scale>
             <uri>__default__</uri>
           </mesh>
@@ -73,7 +74,7 @@
         <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
         <geometry>
           <mesh>
-            <uri>model://pr2/gripper_v0/gripper_palm.dae</uri>
+            <uri>model://pr2/meshes/gripper_v0/gripper_palm.dae</uri>
             <scale>1.000000 1.000000 1.000000</scale>
             <uri>__default__</uri>
           </mesh>
@@ -105,7 +106,7 @@
         <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
         <geometry>
           <mesh>
-            <uri>model://pr2/gripper_v0/l_finger.stl</uri>
+            <uri>model://pr2/meshes/gripper_v0/l_finger.stl</uri>
             <scale>1.000000 1.000000 1.000000</scale>
             <uri>__default__</uri>
           </mesh>
@@ -141,7 +142,7 @@
         <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
         <geometry>
           <mesh>
-            <uri>model://pr2/gripper_v0/l_finger.dae</uri>
+            <uri>model://pr2/meshes/gripper_v0/l_finger.dae</uri>
             <scale>1.000000 1.000000 1.000000</scale>
             <uri>__default__</uri>
           </mesh>
@@ -173,7 +174,7 @@
         <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
         <geometry>
           <mesh>
-            <uri>model://pr2/gripper_v0/l_finger_tip.stl</uri>
+            <uri>model://pr2/meshes/gripper_v0/l_finger_tip.stl</uri>
             <scale>1.000000 1.000000 1.000000</scale>
             <uri>__default__</uri>
           </mesh>
@@ -209,7 +210,7 @@
         <pose>0.000000 0.000000 0.000000 0.000000 -0.000000 0.000000</pose>
         <geometry>
           <mesh>
-            <uri>model://pr2/gripper_v0/l_finger_tip.dae</uri>
+            <uri>model://pr2/meshes/gripper_v0/l_finger_tip.dae</uri>
             <scale>1.000000 1.000000 1.000000</scale>
             <uri>__default__</uri>
           </mesh>
@@ -289,7 +290,7 @@
         <pose>0.000000 0.000000 0.000000 -3.141590 -0.000000 0.000000</pose>
         <geometry>
           <mesh>
-            <uri>model://pr2/gripper_v0/l_finger.stl</uri>
+            <uri>model://pr2/meshes/gripper_v0/l_finger.stl</uri>
             <scale>1.000000 1.000000 1.000000</scale>
             <uri>__default__</uri>
           </mesh>
@@ -325,7 +326,7 @@
         <pose>0.000000 0.000000 0.000000 -3.141590 0.000000 0.000000</pose>
         <geometry>
           <mesh>
-            <uri>model://pr2/gripper_v0/l_finger.dae</uri>
+            <uri>model://pr2/meshes/gripper_v0/l_finger.dae</uri>
             <scale>1.000000 1.000000 1.000000</scale>
             <uri>__default__</uri>
           </mesh>
@@ -357,7 +358,7 @@
         <pose>0.000000 0.000000 0.000000 -3.141590 -0.000000 0.000000</pose>
         <geometry>
           <mesh>
-            <uri>model://pr2/gripper_v0/l_finger_tip.stl</uri>
+            <uri>model://pr2/meshes/gripper_v0/l_finger_tip.stl</uri>
             <scale>1.000000 1.000000 1.000000</scale>
             <uri>__default__</uri>
           </mesh>
@@ -393,7 +394,7 @@
         <pose>0.000000 0.000000 0.000000 -3.141590 0.000000 0.000000</pose>
         <geometry>
           <mesh>
-            <uri>model://pr2/gripper_v0/l_finger_tip.dae</uri>
+            <uri>model://pr2/meshes/gripper_v0/l_finger_tip.dae</uri>
             <scale>1.000000 1.000000 1.000000</scale>
             <uri>__default__</uri>
           </mesh>

From af301c5e96b1e69460bf101be6375b21fd6d5f7f Mon Sep 17 00:00:00 2001
From: John Hsu <johnhsu@willowgarage.com>
Date: Wed, 10 Oct 2012 17:11:36 -0700
Subject: [PATCH 6/8] add dependency for simple_arm_gripper

---
 simple_arm_gripper/manifest.xml | 7 +++++++
 1 file changed, 7 insertions(+)

diff --git a/simple_arm_gripper/manifest.xml b/simple_arm_gripper/manifest.xml
index d9f2ea8..8aace6d 100644
--- a/simple_arm_gripper/manifest.xml
+++ b/simple_arm_gripper/manifest.xml
@@ -10,6 +10,13 @@
     <email>hsu@osrfoundation.org</email>
   </author>
 
+  <depend>
+    <model>
+      <uri>model://simple_gripper</uri>
+      <version>1.0</version>
+    </model>
+  </depend>
+
   <description>
     A simple arm and pinch gripper.
   </description>

From bcca3bb67f3590f59a9d58315aadfbcda4962d0a Mon Sep 17 00:00:00 2001
From: John Hsu <johnhsu@willowgarage.com>
Date: Wed, 10 Oct 2012 17:16:46 -0700
Subject: [PATCH 7/8] fix simple arm simple gripper model

---
 simple_arm_gripper/model.sdf |  1 +
 simple_gripper/model.sdf     | 12 ++----------
 2 files changed, 3 insertions(+), 10 deletions(-)

diff --git a/simple_arm_gripper/model.sdf b/simple_arm_gripper/model.sdf
index a2d31a5..88b52e4 100644
--- a/simple_arm_gripper/model.sdf
+++ b/simple_arm_gripper/model.sdf
@@ -7,6 +7,7 @@
 
     <include>
       <uri>model://simple_gripper</uri>
+      <pose>1.8 0 1 0 0 0</pose>
     </include>
 
     <plugin name="simple_arm_plugin" filename="libJointTrajectoryPlugin.so"/>
diff --git a/simple_gripper/model.sdf b/simple_gripper/model.sdf
index e9fa1e3..01e2c18 100644
--- a/simple_gripper/model.sdf
+++ b/simple_gripper/model.sdf
@@ -9,7 +9,7 @@
       <collision name="collision">
         <geometry>
           <box>
-            <size>0.2 0.2 1.0</size>
+            <size>0.05 0.05 1.0</size>
           </box>
         </geometry>
         <surface>
@@ -23,7 +23,7 @@
       <visual name="visual">
         <geometry>
           <box>
-            <size>0.2 0.2 1.0</size>
+            <size>0.05 0.05 1.0</size>
           </box>
         </geometry>
         <material>
@@ -249,14 +249,6 @@
         <xyz>0 0 1</xyz>
       </axis>
     </joint>
-    <joint name="fixed_riser" type="revolute">
-      <child>riser</child>
-      <parent>world</parent>
-      <axis>
-        <limit><lower>0</lower><upper>0</upper></limit>
-        <xyz>0 0 1</xyz>
-      </axis>
-    </joint>
 
     <gripper name="simple_gripper">
       <grasp_check>

From 918e4f33ccab21d7e8b9f9ae53cdd28e89c4258a Mon Sep 17 00:00:00 2001
From: John Hsu <johnhsu@willowgarage.com>
Date: Fri, 12 Oct 2012 10:11:30 -0700
Subject: [PATCH 8/8] fix projector direction

---
 pr2/model.sdf | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/pr2/model.sdf b/pr2/model.sdf
index 8c91745..e1d5a81 100644
--- a/pr2/model.sdf
+++ b/pr2/model.sdf
@@ -550,7 +550,7 @@
         <fov>0.959931</fov>
         <near_clip>0.100000</near_clip>
         <far_clip>10.000000</far_clip>
-        <pose>0.023200 0.110000 0.119100 3.141593 -1.570793 3.141593</pose>
+        <pose>0.023200 0.110000 0.119100 0 -1.570793 0</pose>
       </projector>
 
       <self_collide>0</self_collide>