From 97d9e67e67014a1eb2dccd08f35906e5ba1a5f84 Mon Sep 17 00:00:00 2001 From: Lorenz Meier Date: Mon, 27 Aug 2012 15:44:50 +0200 Subject: Really ugly but safe hack to make 30 deg rotations work --- apps/px4/attitude_estimator_bm/attitude_bm.c | 12 ++++++++++++ 1 file changed, 12 insertions(+) (limited to 'apps') diff --git a/apps/px4/attitude_estimator_bm/attitude_bm.c b/apps/px4/attitude_estimator_bm/attitude_bm.c index 1ffe9f7bd..cb17a356d 100644 --- a/apps/px4/attitude_estimator_bm/attitude_bm.c +++ b/apps/px4/attitude_estimator_bm/attitude_bm.c @@ -221,6 +221,18 @@ void attitude_blackmagic(const float_vect3 *accel, const float_vect3 *mag, const m_elem mask[9] = { 1.0f, 1.0f, 1.0f, 1.0f, 1.0f, 1.0f, 1.0f, 1.0f, 1.0f }; + // XXX Hack - stop updating accel if upside down + + if (accel->z > 0) { + mask[0] = 0.0f; + mask[1] = 0.0f; + mask[2] = 0.0f; + } else { + mask[0] = 1.0f; + mask[1] = 1.0f; + mask[2] = 1.0f; + } + measurement[0] = accel->x; measurement[1] = accel->y; measurement[2] = accel->z; -- cgit v1.2.3