Line |
Branch |
Exec |
Source |
1 |
|
|
#include <iostream> |
2 |
|
|
|
3 |
|
|
#include "pinocchio/multibody/sample-models.hpp" |
4 |
|
|
#include "pinocchio/algorithm/joint-configuration.hpp" |
5 |
|
|
#include "pinocchio/algorithm/rnea.hpp" |
6 |
|
|
|
7 |
|
✗ |
int main() |
8 |
|
|
{ |
9 |
|
✗ |
pinocchio::Model model; |
10 |
|
✗ |
pinocchio::buildModels::manipulator(model); |
11 |
|
✗ |
pinocchio::Data data(model); |
12 |
|
|
|
13 |
|
✗ |
Eigen::VectorXd q = pinocchio::neutral(model); |
14 |
|
✗ |
Eigen::VectorXd v = Eigen::VectorXd::Zero(model.nv); |
15 |
|
✗ |
Eigen::VectorXd a = Eigen::VectorXd::Zero(model.nv); |
16 |
|
|
|
17 |
|
✗ |
const Eigen::VectorXd & tau = pinocchio::rnea(model, data, q, v, a); |
18 |
|
✗ |
std::cout << "tau = " << tau.transpose() << std::endl; |
19 |
|
|
} |
20 |
|
|
|