29 {
32 const MatrixXd& inequality_constraint_matrix =
34 const MatrixXd& inequality_constraint_boundary =
36 const MatrixXd& equality_constraint_matrix =
38 const MatrixXd& equality_constraint_boundary =
40
41 qp_proto->set_param_size(static_cast<int32_t>(kernel_matrix.rows()));
43
44 for (int i = 0; i < offset.rows(); ++i) {
45 qp_proto->add_bias(offset(i, 0));
46 }
47
49 qp_proto->mutable_inequality_matrix());
50
51 for (int i = 0; i < inequality_constraint_boundary.rows(); ++i) {
52 qp_proto->add_inequality_value(inequality_constraint_boundary(i, 0));
53 }
54
56 qp_proto->mutable_equality_matrix());
57
58 for (int i = 0; i < equality_constraint_boundary.rows(); ++i) {
59 qp_proto->add_equality_value(equality_constraint_boundary(i, 0));
60 }
61
62
64 for (const auto& spline_seg : splines) {
65 const auto& param_seg = spline_seg.spline_func().params();
66 for (const auto value : param_seg) {
67 qp_proto->add_optimal_param(value);
68 }
69 }
70}
const Eigen::MatrixXd & constraint_boundary() const
const Eigen::MatrixXd & constraint_matrix() const
const AffineConstraint & equality_constraint() const
const AffineConstraint & inequality_constraint() const
: output interface inequality constraint
const Eigen::MatrixXd & kernel_matrix() const
const Eigen::MatrixXd & offset() const
void ConvertMatrixXdToProto(const Eigen::MatrixXd &matrix, QPMatrix *const proto) const
const std::vector< Spline1dSeg > & splines() const