19 #include "gmock/gmock.h"
20 #include "gtest/gtest.h"
28 using ::testing::ElementsAre;
30 const double kInfinity = std::numeric_limits<double>::infinity();
32 TEST(ShardedQuadraticProgramTest, BasicTest) {
33 const int num_threads = 2;
34 const int num_shards = 10;
37 const int primal_size = 2;
38 const int dual_size = 1;
39 EXPECT_EQ(sharded_qp.DualSize(), dual_size);
40 EXPECT_EQ(sharded_qp.PrimalSize(), primal_size);
41 EXPECT_THAT(
ToDense(sharded_qp.TransposedConstraintMatrix()),
42 EigenArrayEq<double>({{1}, {1}}));
43 EXPECT_EQ(sharded_qp.ConstraintMatrixSharder().NumElements(), primal_size);
44 EXPECT_EQ(sharded_qp.DualSharder().NumElements(), dual_size);
45 EXPECT_EQ(sharded_qp.PrimalSharder().NumElements(), primal_size);
46 EXPECT_EQ(sharded_qp.TransposedConstraintMatrixSharder().NumElements(),
50 TEST(ShardedQuadraticProgramTest, SwapVariableBounds) {
51 const int num_threads = 2;
52 const int num_shards = 2;
55 Eigen::VectorXd new_lb{{-
kInfinity, 0.0}};
56 Eigen::VectorXd new_ub{{0.0, 1.0}};
57 sharded_qp.SwapVariableBounds(new_lb, new_ub);
58 EXPECT_THAT(new_lb, ElementsAre(1.0, -2.0));
59 EXPECT_THAT(new_ub, ElementsAre(2.0, 4.0));
60 EXPECT_THAT(sharded_qp.Qp().variable_lower_bounds,
62 EXPECT_THAT(sharded_qp.Qp().variable_upper_bounds, ElementsAre(0.0, 1.0));
65 TEST(ShardedQuadraticProgramTest, SwapConstraintBounds) {
66 const int num_threads = 2;
67 const int num_shards = 2;
70 Eigen::VectorXd new_lb{{1.0}};
71 Eigen::VectorXd new_ub{{5.0}};
72 sharded_qp.SwapConstraintBounds(new_lb, new_ub);
73 EXPECT_THAT(new_lb, ElementsAre(-
kInfinity));
74 EXPECT_THAT(new_ub, ElementsAre(1.0));
75 EXPECT_THAT(sharded_qp.Qp().constraint_lower_bounds, ElementsAre(1.0));
76 EXPECT_THAT(sharded_qp.Qp().constraint_upper_bounds, ElementsAre(5.0));
79 TEST(ShardedQuadraticProgramTest, SwapObjectiveVector) {
80 const int num_threads = 2;
81 const int num_shards = 2;
84 Eigen::VectorXd new_objective{{1.0, 2.0}};
85 sharded_qp.SwapObjectiveVector(new_objective);
86 EXPECT_THAT(new_objective, ElementsAre(-1.0, -1.0));
87 EXPECT_THAT(sharded_qp.Qp().objective_vector, ElementsAre(1.0, 2.0));
90 TEST(RescaleProblem, BasicTest) {
100 const int num_threads = 2;
101 const int num_shards = 10;
104 Eigen::VectorXd col_scaling_vec(2);
105 Eigen::VectorXd row_scaling_vec(1);
106 col_scaling_vec << 1, 0.5;
107 row_scaling_vec << 0.5;
108 sharded_qp.RescaleQuadraticProgram(col_scaling_vec, row_scaling_vec);
110 EXPECT_THAT(sharded_qp.Qp().constraint_lower_bounds, ElementsAre(-
kInfinity));
111 EXPECT_THAT(sharded_qp.Qp().constraint_upper_bounds, ElementsAre(0.5));
112 EXPECT_THAT(sharded_qp.Qp().variable_lower_bounds, ElementsAre(1, -4));
113 EXPECT_THAT(sharded_qp.Qp().variable_upper_bounds, ElementsAre(2, 8));
114 EXPECT_THAT(sharded_qp.Qp().objective_vector, ElementsAre(-1, -0.5));
115 EXPECT_THAT(
ToDense(sharded_qp.Qp().constraint_matrix),
116 EigenArrayEq<double>({{0.5, 0.25}}));
117 EXPECT_THAT(
ToDense(sharded_qp.TransposedConstraintMatrix()),
118 EigenArrayEq<double>({{0.5}, {0.25}}));
119 EXPECT_THAT(sharded_qp.Qp().objective_matrix->diagonal(),
120 EigenArrayEq<double>({4, 0.25}));
::Eigen::ArrayXXd ToDense(const Eigen::SparseMatrix< double, Eigen::ColMajor, int64_t > &sparse_mat)
constexpr double kInfinity
QuadraticProgram TestDiagonalQp1()
TEST(LinearAssignmentTest, NullMatrix)