From c237b4dd12244c1fa035495b0307398d5808b740 Mon Sep 17 00:00:00 2001
From: Brian Delhaisse <briandelhaisse@gmail.com>
Date: Fri, 3 May 2019 18:51:17 +0200
Subject: [PATCH] fix urdf color for quadcopter and wam

---
 .../robots/urdfs/quadcopter/quadcopter.urdf   | 36 ++++++++++++++++++
 pyrobolearn/robots/urdfs/wam/wam.urdf         | 38 ++++++++++++++++---
 2 files changed, 69 insertions(+), 5 deletions(-)

diff --git a/pyrobolearn/robots/urdfs/quadcopter/quadcopter.urdf b/pyrobolearn/robots/urdfs/quadcopter/quadcopter.urdf
index 5a8b2ab..720821f 100644
--- a/pyrobolearn/robots/urdfs/quadcopter/quadcopter.urdf
+++ b/pyrobolearn/robots/urdfs/quadcopter/quadcopter.urdf
@@ -4,6 +4,37 @@
 <!-- |    EDITING THIS FILE BY HAND IS NOT RECOMMENDED                                 | -->
 <!-- =================================================================================== -->
 <robot name="quad" xmlns:xacro="http://ros.org/wiki/xacro">
+  <material name="black">
+    <color rgba="0.2 0.2 0.2 1"/>
+  </material>
+  <material name="white">
+    <color rgba="0.9 0.9 0.9 1"/>
+  </material>
+  <material name="dark_gray">
+    <color rgba="0.3 0.3 0.3 1"/>
+  </material>
+  <material name="gray">
+    <color rgba="0.5 0.5 0.5 1"/>
+  </material>
+  <material name="light_gray">
+    <color rgba="0.7 0.7 0.7 1"/>
+  </material>
+  <material name="pure_red">
+    <color rgba="1.0 0.0 0.0 1"/>
+  </material>
+  <material name="red">
+    <color rgba="0.5 0.1 0.2 1"/>
+  </material>
+  <material name="pure_green">
+    <color rgba="0.0 1.0 0.0 1"/>
+  </material>
+  <material name="pure_blue">
+    <color rgba="0.0 0.0 1.0 1"/>
+  </material>
+  <material name="blue">
+    <color rgba="0.0 0.2 0.8 1"/>
+  </material>
+
   <!-- Properties -->
   <!-- "propeller" -->
   <!-- [kg] -->
@@ -44,6 +75,7 @@
       <inertia ixx="0.05" ixy="0.0" ixz="0.0" iyy="0.05" iyz="0.0" izz="0.24"/>
     </inertial>
     <visual>
+      <material name="black"/>
       <origin rpy="0 0 0" xyz="0 0 0"/>
       <geometry>
         <mesh filename="meshes/hummingbird.dae" scale="1 1 1"/>
@@ -89,6 +121,7 @@
       <inertia ixx="9.75e-07" ixy="0.0" ixz="0.0" iyy="0.000326704166667" iyz="0.0" izz="0.000327604166667"/>
     </inertial>
     <visual>
+      <material name="blue"/>
       <geometry>
         <!-- <cylinder length="0.005" radius="${radius_rotor}"/> -->
         <!-- [m] -->
@@ -144,6 +177,7 @@
       <inertia ixx="9.75e-07" ixy="0.0" ixz="0.0" iyy="0.000326704166667" iyz="0.0" izz="0.000327604166667"/>
     </inertial>
     <visual>
+      <material name="blue"/>
       <geometry>
         <!-- <cylinder length="0.005" radius="${radius_rotor}"/> -->
         <!-- [m] -->
@@ -199,6 +233,7 @@
       <inertia ixx="9.75e-07" ixy="0.0" ixz="0.0" iyy="0.000326704166667" iyz="0.0" izz="0.000327604166667"/>
     </inertial>
     <visual>
+      <material name="blue"/>
       <geometry>
         <!-- <cylinder length="0.005" radius="${radius_rotor}"/> -->
         <!-- [m] -->
@@ -254,6 +289,7 @@
       <inertia ixx="9.75e-07" ixy="0.0" ixz="0.0" iyy="0.000326704166667" iyz="0.0" izz="0.000327604166667"/>
     </inertial>
     <visual>
+      <material name="blue"/>
       <geometry>
         <!-- <cylinder length="0.005" radius="${radius_rotor}"/> -->
         <!-- [m] -->
diff --git a/pyrobolearn/robots/urdfs/wam/wam.urdf b/pyrobolearn/robots/urdfs/wam/wam.urdf
index 01da36a..99e3f9e 100644
--- a/pyrobolearn/robots/urdfs/wam/wam.urdf
+++ b/pyrobolearn/robots/urdfs/wam/wam.urdf
@@ -8,6 +8,36 @@
   <material name="WAMGrey">
     <color rgba="0.6 0.6 0.6 1.0"/>
   </material>
+  <material name="black">
+    <color rgba="0.2 0.2 0.2 1"/>
+  </material>
+  <material name="white">
+    <color rgba="0.9 0.9 0.9 1"/>
+  </material>
+  <material name="dark_gray">
+    <color rgba="0.3 0.3 0.3 1"/>
+  </material>
+  <material name="gray">
+    <color rgba="0.5 0.5 0.5 1"/>
+  </material>
+  <material name="light_gray">
+    <color rgba="0.6 0.6 0.6 1"/>
+  </material>
+  <material name="pure_red">
+    <color rgba="1.0 0.0 0.0 1"/>
+  </material>
+  <material name="red">
+    <color rgba="0.5 0.1 0.2 1"/>
+  </material>
+  <material name="pure_green">
+    <color rgba="0.0 1.0 0.0 1"/>
+  </material>
+  <material name="pure_blue">
+    <color rgba="0.0 0.0 1.0 1"/>
+  </material>
+  <material name="blue">
+    <color rgba="0.0 0.2 0.8 1"/>
+  </material>
   <!-- Root link is in the world frame-->
   <!--link name="world">
     <inertial>
@@ -28,9 +58,7 @@
       <inertia ixx="0.1" ixy="0" ixz="0" iyy="0.1" iyz="0" izz="0.1"/>
     </inertial>
     <visual>
-      <material name="WAMGrey">
-        <color rgba="0.6 0.6 0.6 1.0"/>
-      </material>
+      <material name="gray"/>
       <geometry>
         <mesh filename="meshes/base_link_fine.stl"/>
       </geometry>
@@ -65,7 +93,7 @@
     </inertial>
     <visual>
       <material name="WAMGrey">
-        <color rgba="0.6 0.6 0.6 1.0"/>
+        <color rgba="0.3 0.3 0.3 1.0"/>
       </material>
       <geometry>
         <mesh filename="meshes/shoulder_link_fine.stl"/>
@@ -96,7 +124,7 @@
   <link name="wam/shoulder_pitch_link">
     <visual>
       <material name="WAMGrey">
-        <color rgba="0.6 0.6 0.6 1.0"/>
+        <color rgba="0.3 0.3 0.3 1.0"/>
       </material>
       <geometry>
         <mesh filename="meshes/shoulder_pitch_link_fine.stl"/>