From 6c163072f679f200221a4ce755d8822eaea85b41 Mon Sep 17 00:00:00 2001
From: Matthew Powelson <matthew.powelson@swri.org>
Date: Mon, 20 May 2019 15:26:36 -0500
Subject: [PATCH] Add MultiSphere

---
 urdf_model/include/urdf_model/link.h | 19 ++++++++++++++++++-
 1 file changed, 18 insertions(+), 1 deletion(-)

diff --git a/urdf_model/include/urdf_model/link.h b/urdf_model/include/urdf_model/link.h
index e470b43..f571bf7 100644
--- a/urdf_model/include/urdf_model/link.h
+++ b/urdf_model/include/urdf_model/link.h
@@ -50,7 +50,7 @@ namespace urdf{
 class Geometry
 {
 public:
-  enum {SPHERE, BOX, CYLINDER, MESH} type;
+  enum {SPHERE, BOX, CYLINDER, MESH, MULTISPHERE} type;
 
   virtual ~Geometry(void)
   {
@@ -112,6 +112,23 @@ class Mesh : public Geometry
   };
 };
 
+class MultiSphere : public Geometry
+{
+public:
+  MultiSphere() { this->clear(); type = MULTISPHERE; };
+  std::string filename;
+  Vector3 scale;
+
+  void clear()
+  {
+    filename.clear();
+    // default scale
+    scale.x = 1;
+    scale.y = 1;
+    scale.z = 1;
+  };
+};
+
 class Material
 {
 public: