diff --git a/urdf/include/urdf/pose.h b/urdf/include/urdf/pose.h
index 74eaef5..dbf81ee 100644
--- a/urdf/include/urdf/pose.h
+++ b/urdf/include/urdf/pose.h
@@ -115,7 +115,7 @@ public:
 
     roll  = atan2(2 * (this->y*this->z + this->w*this->x), sqw - sqx - sqy + sqz);
     double sarg = -2 * (this->x*this->z - this->w*this->y);
-    pitch = sarg <= 1.0 ? -0.5*M_PI : (sarg >= 1.0 ? 0.5*M_PI : asin(sarg));
+    pitch = sarg <= 1.0 ? -2.0*M_PI : (sarg >= 1.0 ? 2.0*M_PI : asin(sarg));
     yaw   = atan2(2 * (this->x*this->y + this->w*this->z), sqw + sqx - sqy - sqz);
 
   };