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.
22 lines
483 B
22 lines
483 B
#include "test_macros.hpp" |
|
#include <matrix/math.hpp> |
|
|
|
using matrix::Dcm; |
|
using matrix::Euler; |
|
using matrix::isEqual; |
|
using matrix::Vector3; |
|
|
|
int main() |
|
{ |
|
Euler<float> euler(0.1f, 0.2f, 0.3f); |
|
Dcm<float> R(euler); |
|
Dcm<float> skew = R - R.T(); |
|
Vector3<float> w = skew.vee(); |
|
Vector3<float> w_check(0.1348f, 0.4170f, 0.5647f); |
|
|
|
TEST(isEqual(w, w_check)); |
|
TEST(isEqual(skew, w.hat())); |
|
return 0; |
|
} |
|
|
|
/* vim: set et fenc=utf-8 ff=unix sts=0 sw=4 ts=4 : */
|
|
|