add macros for easy 2d array support, builds on px4 test build

This commit is contained in:
Thomas Gubler
2014-12-02 10:46:29 +01:00
parent dfb266565a
commit 4d91c61f8f
3 changed files with 9 additions and 3 deletions
@@ -67,6 +67,7 @@
#include <systemlib/perf_counter.h>
#include <systemlib/systemlib.h>
#include <poll.h>
#include <px4_defines.h>
#include "flow_position_estimator_params.h"
@@ -337,7 +338,7 @@ int flow_position_estimator_thread_main(int argc, char *argv[])
{
float sum = 0.0f;
for(uint8_t j = 0; j < 3; j++)
sum = sum + speed[j] * att.R[i][j];
sum = sum + speed[j] * PX4_R(att.R, i, j);
global_speed[i] = sum;
}