1 |
|
|
/** |
2 |
|
|
* @file |
3 |
|
|
* @copyright Copyright (c) 2022, LAAS-CNRS, Toward, PalRobotics |
4 |
|
|
* @brief |
5 |
|
|
*/ |
6 |
|
|
|
7 |
|
|
#ifndef NDEBUG // debug mode |
8 |
|
|
#include <iostream> |
9 |
|
|
#endif |
10 |
|
|
#include "aig/arm_ig.hpp" |
11 |
|
|
|
12 |
|
|
namespace aig { |
13 |
|
|
|
14 |
|
|
ArmIG::ArmIG() { |
15 |
|
|
#ifndef NDEBUG // debug mode |
16 |
|
|
std::cout << "DEBUG: ArmIG::ArmIG(): Not implemented" << std::endl; |
17 |
|
|
#endif |
18 |
|
|
} |
19 |
|
|
|
20 |
|
|
Eigen::VectorXd ArmIG::solve(const pinocchio::SE3& /*base*/, |
21 |
|
|
const pinocchio::SE3& /*endEffector*/) { |
22 |
|
|
#ifndef NDEBUG // debug mode |
23 |
|
|
std::cout << "DEBUG: ArmIG::solve(): Not implemented" << std::endl; |
24 |
|
|
#endif |
25 |
|
|
Eigen::VectorXd q; |
26 |
|
|
return q; |
27 |
|
|
} |
28 |
|
|
|
29 |
|
|
} // namespace aig |