You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
36 lines
871 B
36 lines
871 B
#include <assert.h> |
|
#include <stdio.h> |
|
|
|
#include <matrix/math.hpp> |
|
|
|
using namespace matrix; |
|
|
|
template class SquareMatrix<float, 3>; |
|
|
|
int main() |
|
{ |
|
float data[9] = {1, 2, 3, |
|
4, 5, 6, |
|
7, 8, 10 |
|
}; |
|
SquareMatrix<float, 3> A(data); |
|
Vector3<float> diag_check(1, 5, 10); |
|
A.diag().T().print(); |
|
|
|
assert(A.diag() == diag_check); |
|
|
|
float data_check[9] = { |
|
1.01158503f, 0.02190432f, 0.03238144f, |
|
0.04349195f, 1.05428524f, 0.06539627f, |
|
0.07576783f, 0.08708946f, 1.10894048f |
|
}; |
|
|
|
printf("expm(A*t)\n"); |
|
float dt = 0.01f; |
|
SquareMatrix<float, 3> eA = expm(SquareMatrix<float, 3>(A*dt), 5); |
|
SquareMatrix<float, 3> eA_check(data_check); |
|
assert((eA - eA_check).abs().max() < 1e-3); |
|
return 0; |
|
} |
|
|
|
/* vim: set et fenc=utf-8 ff=unix sts=0 sw=4 ts=4 : */
|
|
|