mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-05-02 05:04:08 +08:00
27 lines
429 B
C++
27 lines
429 B
C++
#include "Matrix.hpp"
|
|
#include <assert.h>
|
|
#include <stdio.h>
|
|
|
|
using namespace matrix;
|
|
|
|
int main()
|
|
{
|
|
float data[9] = {1, 0, 0, 0, 1, 0, 1, 0, 1};
|
|
Matrix3f A(data);
|
|
float data_check[9] = {1, 0, 0, 0, 1, 0, -1, 0, 1};
|
|
Matrix3f A_I(data_check);
|
|
Matrix3f I;
|
|
I.setIdentity();
|
|
A.print();
|
|
A_I.print();
|
|
Matrix3f R = A * A_I;
|
|
R.print();
|
|
assert(R == I);
|
|
|
|
Matrix3f R2 = A;
|
|
R2 *= A_I;
|
|
R2.print();
|
|
assert(R2 == I);
|
|
return 0;
|
|
}
|