Files
sas_robot_driver_franka/constraints_manager/constraints_manager_example/main.cpp
2024-12-16 22:49:21 +09:00

27 lines
583 B
C++

#include <iostream>
#include "constraints_manager.h"
using namespace Eigen;
int main()
{
auto manager = ConstraintsManager(3);
auto A1 = MatrixXd::Zero(3,3);
auto b1 = VectorXd::Zero(3);
auto A2 = MatrixXd::Ones(1,3);
auto b2 = VectorXd::Ones(1);
manager.add_inequality_constraint(A1, b1);
manager.add_inequality_constraint(A2, b2);
MatrixXd A;
VectorXd b;
std::tie(A,b) = manager.get_inequality_constraints();
std::cout<<"A: "<<std::endl;
std::cout<<A<<std::endl;
std::cout<<"b: "<<std::endl;
std::cout<<b<<std::endl;
}