camera and control of UR5
Hi all. I am using Ros1 Kinetic on Ubuntu 16.04LTS, gazebo7 and rviz 1.12.17, I am simulating Universal robot UR5 but there are problems one of them is the robot is shakey and 2nd is I cant controll the robot I want to simulate and add a camera to it.
the following is my launch file:
<launch> <arg name="gui" default="True"/>
<group ns="camera1"> <node pkg="tf" type="static_transform_publisher" name="camera_broadcaster" args="-15 0 15 1.57 3.14 1.1 map camera1 10"/> <node name="camera_info" pkg="rostopic" type="rostopic" args="pub camera_info sensor_msgs/CameraInfo '{header: {seq: 0, stamp: {secs: 0, nsecs: 0}, frame_id: 'camera1'}, height: 480, width: 640, distortion_model: 'plumb_bob', D: [0], K: [500.0, 0.0, 320, 0.0, 500.0, 240.0, 0.0, 0.0, 1.0], R: [1.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 1.0], P: [500.0, 0.0, 320, 0.0, 0.0, 500, 240, 0.0, 0.0, 0.0, 1.0, 0.0], binning_x: 0, binning_y: 0, roi: {x_offset: 0, y_offset: 0, height: 480, width: 640, do_rectify: false}}' -r 2" output="screen"/> </group>
<include file="$(find gazebo_ros)/launch/empty_world.launch"> <arg name="debug" value="false"/> <arg name="gui" value="true"/> <arg name="paused" value="false"/> <arg name="use_sim_time" value="false"/> <arg name="headless" value="false"/> <arg name="verbose" value="true"/> </include>
<node name="robot_state_publisher" pkg="robot_state_publisher" type="state_publisher"/>
<node name="joint_state_publisher" pkg="joint_state_publisher" type="joint_state_publisher"/>
<node name="spawn_model" pkg="gazebo_ros" type="spawn_model" args="-urdf -param robot_description -model UR5 -verbose" output="screen"/>
<node name="rviz" pkg="rviz" type="rviz" args="-d $(find ur5_description)/config/ur5.rviz" required="true"/>
</launch>
and this is my ur5_robotiq85_gripper.urdf.xacro file
<robot <a="" href="http://xmlns:xacro=" http:="">www.ros.org="" wiki="" xacro%22"="" name="ur5">xmlns:xacro="http://www.ros.org/wiki/...></robot>
<xacro:include filename="$(find ur5_description)/urdf/ur5_joint_limited_robot.urdf.xacro"/> <xacro:include filename="$(find robotiq_description)/urdf/robotiq_85_gripper.urdf.xacro"/> <xacro:property name="camera_link" value="0.05"/> <xacro:property name="height3" value="0.05"/> <xacro:property name="axel_offset" value="0.05"/>
<link name="robotiq_coupler"> <visual> <geometry> <mesh filename="package://robotiq_description/meshes/robotiq_85_coupler.stl"/> </geometry> <material name="flat_black"/> </visual> <collision> <geometry> <mesh filename="package://robotiq_description/meshes/robotiq_85_coupler.stl"/> </geometry> </collision> <inertial> <origin xyz="2.073e-05 1.45286e-03 -1.1049e-03" rpy="0 0 0"/> <mass value="0.168"/> <inertia ixx="6.69695624e-05" ixy="5.21511788e-09" ixz="-2.74383009e-08" iyy="7.85088161e-05" iyz="5.41105193e-07" izz="1.41819717e-04"/> </inertial> </link>
<joint name="robotiq_coupler_joint" type="fixed"> <origin xyz="0 0 0.004" rpy="0 0 ${-pi/2.0}"/> <parent link="tool0"/> <child link="robotiq_coupler"/> </joint> <gazebo reference="robotiq_coupler"> <mu1>0.9</mu1> <mu2>0.9</mu2> <material>Gazebo/FlatBlack</material> </gazebo>
<xacro:robotiq_85_gripper prefix="" parent="robotiq_coupler" >="" <origin="" xyz="0 0 0.004" rpy="0 ${-pi/2} ${pi}"/> </xacro:robotiq_85_gripper>
<gazebo reference="wrist_3_joint"> <providefeedback>true</providefeedback> </gazebo> <gazebo> <plugin name="ft_sensor_plugin" filename="libgazebo_ros_ft_sensor.so"> <updaterate>250.0</updaterate> <topicname>ft_sensor/raw</topicname> <gaussiannoise ...
