GCC Code Coverage Report
Directory: ./ Exec Total Coverage
File: src/parsers/urdf/utils.cpp Lines: 5 5 100.0 %
Date: 2024-01-23 21:41:47 Branches: 3 6 50.0 %

Line Branch Exec Source
1
#include "pinocchio/parsers/urdf/utils.hpp"
2
3
namespace pinocchio
4
{
5
  namespace urdf
6
  {
7
    namespace details
8
    {
9
10
2382
      SE3 convertFromUrdf(const ::urdf::Pose & M)
11
      {
12
2382
        const ::urdf::Vector3 & p = M.position;
13
2382
        const ::urdf::Rotation & q = M.rotation;
14

2382
        return SE3(SE3::Quaternion(q.w,q.x,q.y,q.z).matrix(),
15
7146
                   SE3::Vector3(p.x,p.y,p.z));
16
      }
17
    }
18
  }
19
}