|  | 
|  | 1 | +<?xml version="1.0"?> | 
|  | 2 | + | 
|  | 3 | +<robot name="Fourbar"> | 
|  | 4 | +	<link name="base_link"> | 
|  | 5 | +	</link> | 
|  | 6 | + | 
|  | 7 | +  <link name="link1"> | 
|  | 8 | +    <inertial> | 
|  | 9 | +      <origin xyz="0 0 -0.5" rpy="0 0. 0." /> | 
|  | 10 | +      <mass value="1" /> | 
|  | 11 | +      <inertia ixx=".0841667" ixy="0" ixz="0" iyy=".0841667" iyz="0" izz=".00166667" /> | 
|  | 12 | +    </inertial> | 
|  | 13 | +    <visual> | 
|  | 14 | +      <origin xyz="0 0 -0.5" rpy="0 0. 0." /> | 
|  | 15 | +      <geometry> | 
|  | 16 | +         <!-- <cylinder length="1" radius=".05" /> --> | 
|  | 17 | +         <box size=".1 .1 1" /> | 
|  | 18 | +      </geometry> | 
|  | 19 | +      <material name="green"> | 
|  | 20 | +	       <color rgba="1 0 1 1" /> | 
|  | 21 | +      </material> | 
|  | 22 | +    </visual> | 
|  | 23 | +  </link> | 
|  | 24 | + | 
|  | 25 | +  <link name="link2"> | 
|  | 26 | +    <inertial> | 
|  | 27 | +      <origin xyz="0 0 -0.5" rpy="0 0. 0." /> | 
|  | 28 | +      <mass value="1" /> | 
|  | 29 | +      <inertia ixx=".0841667" ixy="0" ixz="0" iyy=".0841667" iyz="0" izz=".00166667" /> | 
|  | 30 | +    </inertial> | 
|  | 31 | +    <visual> | 
|  | 32 | +      <origin xyz="0 0 -0.5" rpy="0 0. 0." /> | 
|  | 33 | +      <geometry> | 
|  | 34 | +         <box size=".1 .1 1" /> | 
|  | 35 | +      </geometry> | 
|  | 36 | +      <material name="green"> | 
|  | 37 | +	       <color rgba="1 0 0 1" /> | 
|  | 38 | +      </material> | 
|  | 39 | +    </visual> | 
|  | 40 | +  </link> | 
|  | 41 | + | 
|  | 42 | +  <link name="link3"> | 
|  | 43 | +    <inertial> | 
|  | 44 | +      <origin xyz="0 0 -0.5" rpy="0 0. 0." /> | 
|  | 45 | +      <mass value="1" /> | 
|  | 46 | +      <inertia ixx=".0841667" ixy="0" ixz="0" iyy=".0841667" iyz="0" izz=".00166667" /> | 
|  | 47 | +    </inertial> | 
|  | 48 | +    <visual> | 
|  | 49 | +      <origin xyz="0 0 -0.5" rpy="0 0. 0." /> | 
|  | 50 | +      <geometry> | 
|  | 51 | +         <!-- <cylinder length="1" radius=".05" /> --> | 
|  | 52 | +         <box size=".1 .1 1" /> | 
|  | 53 | +      </geometry> | 
|  | 54 | +      <material name="green"> | 
|  | 55 | +	       <color rgba="1 0 1 1" /> | 
|  | 56 | +      </material> | 
|  | 57 | +    </visual> | 
|  | 58 | +  </link> | 
|  | 59 | + | 
|  | 60 | +  <link name="link4"> | 
|  | 61 | +    <inertial> | 
|  | 62 | +      <origin xyz="0 0 -0.5" rpy="0 0. 0." /> | 
|  | 63 | +      <mass value="1" /> | 
|  | 64 | +      <inertia ixx=".0841667" ixy="0" ixz="0" iyy=".0841667" iyz="0" izz=".00166667" /> | 
|  | 65 | +    </inertial> | 
|  | 66 | +    <visual> | 
|  | 67 | +      <origin xyz="0 0 -0.5" rpy="0 0. 0." /> | 
|  | 68 | +      <geometry> | 
|  | 69 | +         <box size=".1 .1 1" /> | 
|  | 70 | +      </geometry> | 
|  | 71 | +      <material name="green"> | 
|  | 72 | +	       <color rgba="1 0 0 1" /> | 
|  | 73 | +      </material> | 
|  | 74 | +    </visual> | 
|  | 75 | +  </link> | 
|  | 76 | + | 
|  | 77 | +	 | 
|  | 78 | + | 
|  | 79 | +	<joint name="jointb1" type="continuous"> | 
|  | 80 | +		<parent link="base_link" /> | 
|  | 81 | +		<child link="link1" /> | 
|  | 82 | +		<origin rpy="0.1 0 0" xyz="0 0 0" /> | 
|  | 83 | +		<axis xyz="1 0 0" /> | 
|  | 84 | +	</joint> | 
|  | 85 | + | 
|  | 86 | +  <joint name="joint12" type="continuous"> | 
|  | 87 | +		<parent link="link1" /> | 
|  | 88 | +		<child link="link2" /> | 
|  | 89 | +		<origin rpy="0.2 0 0" xyz="0 0 -1" /> | 
|  | 90 | +		<axis xyz="1 0 0" /> | 
|  | 91 | +	</joint> | 
|  | 92 | + | 
|  | 93 | +  <joint name="joint13" type="continuous"> | 
|  | 94 | +		<parent link="link1" /> | 
|  | 95 | +		<child link="link3" /> | 
|  | 96 | +		<origin rpy="-0.2 0 0" xyz="0 0 0" /> | 
|  | 97 | +		<axis xyz="1 0 0" /> | 
|  | 98 | +	</joint> | 
|  | 99 | + | 
|  | 100 | +  <joint name="joint34" type="continuous"> | 
|  | 101 | +		<parent link="link3" /> | 
|  | 102 | +		<child link="link4" /> | 
|  | 103 | +		<origin rpy="-0.4 0 0" xyz="0 0 -1" /> | 
|  | 104 | +		<axis xyz="1 0 0" /> | 
|  | 105 | +	</joint> | 
|  | 106 | + | 
|  | 107 | +  <loop_joint name="joint24" type="continuous"> | 
|  | 108 | +    <axis xyz="1 0 0"/> | 
|  | 109 | +    <link1 link="link2" rpy="0 0 0" xyz="0 0 -1"/> | 
|  | 110 | +    <link2 link="link4" rpy="0 0 0" xyz="0 0 -1"/> | 
|  | 111 | +	</loop_joint> | 
|  | 112 | + | 
|  | 113 | +	 | 
|  | 114 | + | 
|  | 115 | +</robot> | 
0 commit comments