diff --git a/include/hpp/fcl/shape/geometric_shapes.h b/include/hpp/fcl/shape/geometric_shapes.h
index 2aa5b444fbd1b665993b5946f3810467bc9753c8..776183ecce0d2ee4ece467918ae63cee4a909450 100644
--- a/include/hpp/fcl/shape/geometric_shapes.h
+++ b/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;