Commit 26b62f4f authored by Joseph Mirabel's avatar Joseph Mirabel Committed by Joseph Mirabel
Browse files

Add printer for Quaternion3f

parent 18403aa0
......@@ -46,6 +46,11 @@ namespace fcl
{
typedef Eigen::Quaternion<FCL_REAL> Quaternion3f;
static inline std::ostream& operator << (std::ostream& o, const Quaternion3f& q)
{
o << "(" << q.w() << " " << q.x() << " " << q.y() << " " << q.z() << ")";
return o;
}
inline bool isQuatIdentity (const Quaternion3f& q)
{
......
Markdown is supported
0% or .
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment