22#include "testing/testing.h"
28TEST(Numeric, DynamicSizedNullspace) {
31 A << 0.76026643, 0.01799744, 0.55192142, 0.8699745,
32 0.42016166, 0.97863392, 0.33711682, 0.14479271,
33 0.51016811, 0.66528302, 0.54395496, 0.57794893;
42TEST(Numeric, FixedSizeMatrixNullspace) {
45 A << 0.76026643, 0.01799744, 0.55192142, 0.8699745,
46 0.42016166, 0.97863392, 0.33711682, 0.14479271,
47 0.51016811, 0.66528302, 0.54395496, 0.57794893;
56TEST(Numeric, NullspaceMatchesLapackSVD) {
59 A << 0.76026643, 0.01799744, 0.55192142,
60 0.8699745, 0.42016166, 0.97863392,
61 0.33711682, 0.14479271, 0.51016811,
62 0.66528302, 0.54395496, 0.57794893;
78 A << 0.76026643, 0.01799744, 0.55192142,
79 0.8699745, 0.42016166, 0.97863392,
80 0.33711682, 0.14479271, 0.51016811,
81 0.66528302, 0.54395496, 0.57794893;
101TEST(Numeric, TinyMatrixSquareTranspose) {
103 A << 1.0, 2.0, 3.0, 4.0;
115 EXPECT_DOUBLE_EQ(3., l1);
116 EXPECT_DOUBLE_EQ(1. / 3.,
x(0));
117 EXPECT_DOUBLE_EQ(2. / 3.,
x(1));
124 EXPECT_DOUBLE_EQ(
sqrt(5.0), l2);
125 EXPECT_DOUBLE_EQ(1. /
sqrt(5.),
x(0));
126 EXPECT_DOUBLE_EQ(2. /
sqrt(5.),
x(1));
139TEST(Numeric, Determinant) {
142 double detA =
A.determinant();
152 double detB =
B.determinant();
156 C << 0, 1, 2, 3, 4, 5, 6, 7, 1;
157 double detC =
C.determinant();
161TEST(Numeric, Inverse) {
181 Mat I2 =
B *
B.inverse();
197 points << 0, 0, 1, 1,
226 Mat x(2, 1),
y(2, 1),
z(2, 2);
236 EXPECT_MATRIX_EQ(
z, xy);
241 EXPECT_MATRIX_EQ(
z,
HStack(xC, yC));
247 Mat x(2, 2),
y(2, 2),
z(4, 2);
261 EXPECT_MATRIX_EQ(
z, xy);
266 EXPECT_MATRIX_EQ(
z,
VStack(xC, yC));
305 Xty =
X.transpose() *
y;
349TEST(Numeric, TinyMatrixView) {
351 Mat K =
P.block(0, 0, 3, 3);
355TEST(Numeric, Mat3MatProduct) {
362TEST(Numeric, Vec3Negative) {
372TEST(Numeric, Vec3VecInteroperability) {
382TEST(Numeric, DeterminantLU7) {
395TEST(Numeric, DeterminantLU) {
406TEST(Numeric, InplaceProduct) {
415 EXPECT_MATRIX_NEAR(Mat2::Identity(), K, 1e-8);
447 EXPECT_MATRIX_NEAR(Rx, rodrigues_x, 1e-15);
448 EXPECT_MATRIX_NEAR(Ry, rodrigues_y, 1e-15);
449 EXPECT_MATRIX_NEAR(Rz, rodrigues_z, 1e-15);
457 Mat3 RRT =
R *
R.transpose();
458 Mat3 RTR =
R.transpose() *
R;
460 EXPECT_MATRIX_NEAR(
I, RRT, 1e-15);
461 EXPECT_MATRIX_NEAR(
I, RTR, 1e-15);
464TEST(Numeric, Reshape) {
469 M_expected << 1, 2, 3, 4;
470 EXPECT_MATRIX_NEAR(M_expected,
M, 1e-15);
SIMD_FORCE_INLINE const btScalar & z() const
Return the z value.
SIMD_FORCE_INLINE btScalar norm() const
Return the norm (length) of the vector.
#define EXPECT_EQ(result, expect)
#define EXPECT_NEAR(result, expect, threshold)
ATTR_WARN_UNUSED_RESULT const BMVert * v2
ATTR_WARN_UNUSED_RESULT const BMVert const BMEdge * e
double DistanceLInfinity(const TVec &x, const TVec &y)
double Nullspace(TMat *A, TVec *nullspace)
Mat3 CrossProductMatrix(const Vec3 &x)
void TransposeInPlace(TA *A)
void VerticalStack(const TTop &top, const TBot &bottom, TStacked *stacked)
Eigen::Matrix< double, 3, 3 > Mat3
double NormalizeL1(TVec *x)
Mat3 RotationAroundX(double angle)
void MatrixColumn(const Mat &A, int i, Vec2 *v)
void MeanAndVarianceAlongRows(const Mat &A, Vec *mean_pointer, Vec *variance_pointer)
Eigen::Matrix< T, ROWS, COLS > HStack(const Eigen::Matrix< T, RowsLeft, ColsLeft > &left, const Eigen::Matrix< T, RowsRight, ColsRight > &right)
Mat3 RotationRodrigues(const Vec3 &axis)
Eigen::Matrix< double, 3, 4 > Mat34
Eigen::Matrix< T, COLS, ROWS > VStack(const Eigen::Matrix< T, ColsLeft, RowsLeft > &top, const Eigen::Matrix< T, ColsRight, RowsRight > &bottom)
void HorizontalStack(const Mat &left, const Mat &right, Mat *stacked)
Mat3 RotationAroundZ(double angle)
void reshape(const TMat &a, int rows, int cols, TDest *b)
Eigen::Matrix< double, 2, Eigen::Dynamic > Mat2X
Mat3 RotationAroundY(double angle)
double NormalizeL2(TVec *x)
double Nullspace2(TMat *A, TVec1 *x1, TVec2 *x2)
Eigen::Matrix< double, 2, 2 > Mat2
TMat ExtractColumns(const TMat &A, const TCols &columns)
Vec3 CrossProduct(const Vec3 &x, const Vec3 &y)
Eigen::Matrix< double, 4, 3 > Mat43