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

Use faster but less accurate average

Browse Source
This commit is contained in:
Julian Kent
2020-02-25 15:08:17 +01:00
committed by Julian Kent
parent a37b91c96a
commit 649c837b6b
1 changed files with 3 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files
matrix/SquareMatrix.hpp
+3 -3
View File
@@ -194,7 +194,7 @@ public:
if(Width>1) { if(Width>1) {
for (size_t row_idx = first+1; row_idx < first+Width; row_idx++) { for (size_t row_idx = first+1; row_idx < first+Width; row_idx++) {
for (size_t col_idx = first; col_idx < row_idx; col_idx++) { for (size_t col_idx = first; col_idx < row_idx; col_idx++) {
Type tmp = self(row_idx,col_idx) + (self(col_idx,row_idx) - self(row_idx,col_idx)) / Type(2); Type tmp = (self(row_idx,col_idx) + self(col_idx,row_idx)) / Type(2);
self(row_idx,col_idx) = tmp; self(row_idx,col_idx) = tmp;
self(col_idx,row_idx) = tmp; self(col_idx,row_idx) = tmp;
} }
@@ -214,12 +214,12 @@ public:
self.makeBlockSymmetric<Width>(first); self.makeBlockSymmetric<Width>(first);
for (size_t row_idx = first; row_idx < first+Width; row_idx++) { for (size_t row_idx = first; row_idx < first+Width; row_idx++) {
for (size_t col_idx = 0; col_idx < first; col_idx++) { for (size_t col_idx = 0; col_idx < first; col_idx++) {
Type tmp = self(row_idx,col_idx) + (self(col_idx,row_idx) - self(row_idx,col_idx)) / Type(2); Type tmp = (self(row_idx,col_idx) + self(col_idx,row_idx)) / Type(2);
self(row_idx,col_idx) = tmp; self(row_idx,col_idx) = tmp;
self(col_idx,row_idx) = tmp; self(col_idx,row_idx) = tmp;
} }
for (size_t col_idx = first+Width; col_idx < M; col_idx++) { for (size_t col_idx = first+Width; col_idx < M; col_idx++) {
Type tmp = self(row_idx,col_idx) + (self(col_idx,row_idx) - self(row_idx,col_idx)) / 2; Type tmp = (self(row_idx,col_idx) + self(col_idx,row_idx)) / Type(2);
self(row_idx,col_idx) = tmp; self(row_idx,col_idx) = tmp;
self(col_idx,row_idx) = tmp; self(col_idx,row_idx) = tmp;
} }