fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-29 06:43:34 +08:00
Code Issues Packages Projects Releases Wiki Activity

added more quaternion methods

Browse Source
This commit is contained in:
Roman
2015-12-19 09:47:03 +01:00
parent 9cd6ac3dd9
commit 10b395a782
5 changed files with 167 additions and 13 deletions
Download Patch File Download Diff File Expand all files Collapse all files
matrix/Matrix.hpp
+6 -6
View File
@@ -361,8 +361,8 @@ public:
Matrix<Type, M, N> abs()
{
Matrix<Type, M, N> r;
for (int i=0; i<M; i++) {
for (int j=0; j<M; j++) {
for (size_t i=0; i<M; i++) {
for (size_t j=0; j<M; j++) {
r(i,j) = Type(fabs((*this)(i,j)));
}
}
@@ -372,8 +372,8 @@ public:
Type max()
{
Type max_val = (*this)(0,0);
for (int i=0; i<M; i++) {
for (int j=0; j<M; j++) {
for (size_t i=0; i<M; i++) {
for (size_t j=0; j<M; j++) {
Type val = (*this)(i,j);
if (val > max_val) {
max_val = val;
@@ -386,8 +386,8 @@ public:
Type min()
{
Type min_val = (*this)(0,0);
for (int i=0; i<M; i++) {
for (int j=0; j<M; j++) {
for (size_t i=0; i<M; i++) {
for (size_t j=0; j<M; j++) {
Type val = (*this)(i,j);
if (val < min_val) {
min_val = val;