|
| 1 | +<?xml version="1.0" ?> |
| 2 | +<sdf version="1.6"> |
| 3 | + <!-- |
| 4 | + 3-sided ArUco post (URC mission post). |
| 5 | +
|
| 6 | + Geometry: |
| 7 | + * Support post: cylinder, r=0.03 m, from ground (z=0) up to z=0.9 m. |
| 8 | + * Three identical tag faces forming a triangular prism, centred at z=1.0 m. |
| 9 | + Each face is a thin 0.20 x 0.20 m panel (X=thickness, Y=width, Z=height) |
| 10 | + textured with the same DICT_4X4_50 marker on its outward face. |
| 11 | + The three panels sit at yaw 0 / 120 / 240 deg, offset radially by the |
| 12 | + equilateral-triangle apothem (0.20 / (2*sqrt(3)) = 0.057735 m) so their |
| 13 | + edges meet to form a closed prism. |
| 14 | +
|
| 15 | + Texture: materials/textures/aruco_4x4_50_id4.png — pre-baked, NOT generated |
| 16 | + at spawn time. Regenerate for a different id with |
| 17 | + nav_sim_harness/scripts/gen_aruco_texture.py and re-commit the PNG. |
| 18 | +
|
| 19 | + Model origin is the base of the post (z=0), so when spawned you set the |
| 20 | + include <pose> z to the ground height at the drop point. |
| 21 | + --> |
| 22 | + <model name="aruco_post"> |
| 23 | + <static>true</static> |
| 24 | + <link name="link"> |
| 25 | + |
| 26 | + <!-- Support post --> |
| 27 | + <visual name="post_visual"> |
| 28 | + <pose>0 0 0.45 0 0 0</pose> |
| 29 | + <geometry> |
| 30 | + <cylinder> |
| 31 | + <radius>0.03</radius> |
| 32 | + <length>0.9</length> |
| 33 | + </cylinder> |
| 34 | + </geometry> |
| 35 | + <material> |
| 36 | + <ambient>0.5 0.5 0.5 1</ambient> |
| 37 | + <diffuse>0.6 0.6 0.6 1</diffuse> |
| 38 | + <specular>0.1 0.1 0.1 1</specular> |
| 39 | + </material> |
| 40 | + </visual> |
| 41 | + <collision name="post_collision"> |
| 42 | + <pose>0 0 0.45 0 0 0</pose> |
| 43 | + <geometry> |
| 44 | + <cylinder> |
| 45 | + <radius>0.03</radius> |
| 46 | + <length>0.9</length> |
| 47 | + </cylinder> |
| 48 | + </geometry> |
| 49 | + </collision> |
| 50 | + |
| 51 | + <!-- Tag face 0 (yaw 0) --> |
| 52 | + <visual name="tag_face_0"> |
| 53 | + <pose>0.057735 0 1.0 0 0 0</pose> |
| 54 | + <geometry> |
| 55 | + <box> |
| 56 | + <size>0.005 0.20 0.20</size> |
| 57 | + </box> |
| 58 | + </geometry> |
| 59 | + <material> |
| 60 | + <ambient>1 1 1 1</ambient> |
| 61 | + <diffuse>1 1 1 1</diffuse> |
| 62 | + <pbr> |
| 63 | + <metal> |
| 64 | + <albedo_map>materials/textures/aruco_4x4_50_id4.png</albedo_map> |
| 65 | + <metalness>0.0</metalness> |
| 66 | + <roughness>1.0</roughness> |
| 67 | + </metal> |
| 68 | + </pbr> |
| 69 | + </material> |
| 70 | + </visual> |
| 71 | + |
| 72 | + <!-- Tag face 1 (yaw 120 deg) --> |
| 73 | + <visual name="tag_face_1"> |
| 74 | + <pose>-0.0288675 0.05 1.0 0 0 2.0943951</pose> |
| 75 | + <geometry> |
| 76 | + <box> |
| 77 | + <size>0.005 0.20 0.20</size> |
| 78 | + </box> |
| 79 | + </geometry> |
| 80 | + <material> |
| 81 | + <ambient>1 1 1 1</ambient> |
| 82 | + <diffuse>1 1 1 1</diffuse> |
| 83 | + <pbr> |
| 84 | + <metal> |
| 85 | + <albedo_map>materials/textures/aruco_4x4_50_id4.png</albedo_map> |
| 86 | + <metalness>0.0</metalness> |
| 87 | + <roughness>1.0</roughness> |
| 88 | + </metal> |
| 89 | + </pbr> |
| 90 | + </material> |
| 91 | + </visual> |
| 92 | + |
| 93 | + <!-- Tag face 2 (yaw 240 deg) --> |
| 94 | + <visual name="tag_face_2"> |
| 95 | + <pose>-0.0288675 -0.05 1.0 0 0 4.1887902</pose> |
| 96 | + <geometry> |
| 97 | + <box> |
| 98 | + <size>0.005 0.20 0.20</size> |
| 99 | + </box> |
| 100 | + </geometry> |
| 101 | + <material> |
| 102 | + <ambient>1 1 1 1</ambient> |
| 103 | + <diffuse>1 1 1 1</diffuse> |
| 104 | + <pbr> |
| 105 | + <metal> |
| 106 | + <albedo_map>materials/textures/aruco_4x4_50_id4.png</albedo_map> |
| 107 | + <metalness>0.0</metalness> |
| 108 | + <roughness>1.0</roughness> |
| 109 | + </metal> |
| 110 | + </pbr> |
| 111 | + </material> |
| 112 | + </visual> |
| 113 | + |
| 114 | + <!-- Prism collision (bounding cylinder around the three faces) --> |
| 115 | + <collision name="prism_collision"> |
| 116 | + <pose>0 0 1.0 0 0 0</pose> |
| 117 | + <geometry> |
| 118 | + <cylinder> |
| 119 | + <radius>0.063</radius> |
| 120 | + <length>0.20</length> |
| 121 | + </cylinder> |
| 122 | + </geometry> |
| 123 | + </collision> |
| 124 | + |
| 125 | + </link> |
| 126 | + </model> |
| 127 | +</sdf> |
0 commit comments