Mercurial > public > ostc4
view Discovery/Src/tInfoCompass.c @ 826:a370741a743b Evo_2_23
Bugfix Line order of info screen with flip screen active:
In the previous version the order of the line in flipping mode (top to bottom) was 6,5,4,3,2,1 instead of 1,2,3,4,5,6. This effected the compass calibration as well as the sensor info view. The problem was solved by adapting the Y calculation.
In addition the size of the SensorInfo screen was corrected to avoid clipping issues in flipped mode.
author | Ideenmodellierer |
---|---|
date | Wed, 11 Oct 2023 17:49:19 +0200 |
parents | b7b481df4f22 |
children |
line wrap: on
line source
/////////////////////////////////////////////////////////////////////////////// /// -*- coding: UTF-8 -*- /// /// \file Discovery/Src/tInfoCompass.c /// \brief there is only compass_DX_f, compass_DY_f, compass_DZ_f output during this mode /// \author heinrichs weikamp gmbh /// \date 23-Feb-2015 /// /// \details /// /// $Id$ /////////////////////////////////////////////////////////////////////////////// /// \par Copyright (c) 2014-2018 Heinrichs Weikamp gmbh /// /// This program is free software: you can redistribute it and/or modify /// it under the terms of the GNU General Public License as published by /// the Free Software Foundation, either version 3 of the License, or /// (at your option) any later version. /// /// This program is distributed in the hope that it will be useful, /// but WITHOUT ANY WARRANTY; without even the implied warranty of /// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the /// GNU General Public License for more details. /// /// You should have received a copy of the GNU General Public License /// along with this program. If not, see <http://www.gnu.org/licenses/>. ////////////////////////////////////////////////////////////////////////////// /* Includes ------------------------------------------------------------------*/ #include "gfx_engine.h" #include "gfx_fonts.h" #include "tHome.h" #include "tInfo.h" #include "tInfoCompass.h" #include <string.h> /* Private variables ---------------------------------------------------------*/ uint16_t tInfoCompassTimeout = 0; int16_t minMaxCompassDX[3][2] = { 0 }; /* Exported functions --------------------------------------------------------*/ void openInfo_Compass(void) { set_globalState(StICOMPASS); tInfoCompassTimeout = settingsGetPointer()->timeoutInfoCompass; tInfoCompassTimeout *= 10; for(int i = 0; i<3;i ++) { minMaxCompassDX[i][0] = 999; minMaxCompassDX[i][1] = -999; } } // =============================================================================== // refreshInfo_Compass /// @brief there is only compass_DX_f, compass_DY_f, compass_DZ_f output during this mode /// the accel is not called during this process // =============================================================================== void refreshInfo_Compass(GFX_DrawCfgScreen s) { tHome_show_lost_connection_count(&s); tInfoCompassTimeout--; if(tInfoCompassTimeout == 0) { exitInfo(); return; } char text[80]; int16_t compassValues[3]; compassValues[0] = stateUsed->lifeData.compass_DX_f; compassValues[1] = stateUsed->lifeData.compass_DY_f; compassValues[2] = stateUsed->lifeData.compass_DZ_f; for(int i = 0; i<3;i ++) { // do not accept zero if(minMaxCompassDX[i][0] == 0) minMaxCompassDX[i][0] = compassValues[i]; // do not accept zero if(minMaxCompassDX[i][1] == 0) minMaxCompassDX[i][1] = compassValues[i]; if(compassValues[i] < minMaxCompassDX[i][0]) minMaxCompassDX[i][0] = compassValues[i]; if(compassValues[i] > minMaxCompassDX[i][1]) minMaxCompassDX[i][1] = compassValues[i]; } snprintf(text,80,"Time left: %u s",(tInfoCompassTimeout+9)/10); tInfo_write_content_simple( 20,800, 25, &FontT42, text, CLUT_InfoCompass); for(int i = 0; i<3;i ++) { snprintf(text,80,"%c: %i" "\t(%i, %i)", 'X'+i, compassValues[i], minMaxCompassDX[i][0], minMaxCompassDX[i][1]); tInfo_write_content_simple( 20,800, 96 + (i*96), &FontT48, text, CLUT_InfoCompass); } snprintf(text,80,"roll %.1f" "\tpitch %.1f", stateUsed->lifeData.compass_roll, stateUsed->lifeData.compass_pitch); tInfo_write_content_simple( 20,800, 96 * 4, &FontT42, text, CLUT_InfoCompass); }