initialize lz = lz_ and HAlfLength = lz_/2

include/hpp/fcl/shape/geometric_shapes.h

@@ -149,12 +149,10 @@ class Capsule : public ShapeBase
 public:
   Capsule(FCL_REAL radius_, FCL_REAL lz_) : ShapeBase(), radius(radius_), lz(lz_)
   {
-    lz = 0;
-    HalfLength = lz/2;
+    lz = lz_
+    HalfLength = lz_/2;
   }
 
- // Capsule::Capsule() : HalfLength(lz/2), lz(0){} 
-
   /// @brief Radius of capsule 
   FCL_REAL radius;
 
@@ -196,12 +194,10 @@ class Cone : public ShapeBase
 public:
   Cone(FCL_REAL radius_, FCL_REAL lz_) : ShapeBase(), radius(radius_), lz(lz_)
   {
-    lz = 0;
-    HalfLength = lz/2;
+    lz = lz_
+    HalfLength = lz_/2;
   }
 
-  //Cone::Cone() : HalfLength(lz/2), lz(0){} 
-
   /// @brief Radius of the cone 
   FCL_REAL radius;
 
@@ -245,11 +241,9 @@ class Cylinder : public ShapeBase
 public:
   Cylinder(FCL_REAL radius_, FCL_REAL lz_) : ShapeBase(), radius(radius_), lz(lz_)
   {
-    lz = 0;
-    HalfLength = lz/2;
+    lz = lz_
+    HalfLength = lz_/2;
   }
-
- // Cylinder::Cylinder() : HalfLength(lz/2), lz(0){} 
   
   /// @brief Radius of the cylinder 
   FCL_REAL radius;