Apply suggestions from code review

Co-authored-by: Addisu Z. Taddese <addisuzt@intrinsic.ai>
Signed-off-by: Benjamin Perseghetti <bperseghetti@rudislabs.com>

src/Geometry.cc

@@ -352,7 +352,7 @@ std::optional<gz::math::Inertiald> Geometry::CalculateInertial(
       geomInertial = this->dataPtr->capsule->CalculateInertial(_density);
       break;
     case GeometryType::CONE:
-      geomInertial = this->dataPtr->capsule->CalculateInertial(_density);
+      geomInertial = this->dataPtr->cone->CalculateInertial(_density);
       break;
     case GeometryType::CYLINDER:
       geomInertial = this->dataPtr->cylinder->CalculateInertial(_density);