|
38
|
1 ///////////////////////////////////////////////////////////////////////////////
|
|
|
2 /// -*- coding: UTF-8 -*-
|
|
|
3 ///
|
|
|
4 /// \file Discovery/Src/tInfoCompass.c
|
|
|
5 /// \brief there is only compass_DX_f, compass_DY_f, compass_DZ_f output during this mode
|
|
|
6 /// \author heinrichs weikamp gmbh
|
|
|
7 /// \date 23-Feb-2015
|
|
|
8 ///
|
|
|
9 /// \details
|
|
|
10 ///
|
|
|
11 /// $Id$
|
|
|
12 ///////////////////////////////////////////////////////////////////////////////
|
|
|
13 /// \par Copyright (c) 2014-2018 Heinrichs Weikamp gmbh
|
|
|
14 ///
|
|
|
15 /// This program is free software: you can redistribute it and/or modify
|
|
|
16 /// it under the terms of the GNU General Public License as published by
|
|
|
17 /// the Free Software Foundation, either version 3 of the License, or
|
|
|
18 /// (at your option) any later version.
|
|
|
19 ///
|
|
|
20 /// This program is distributed in the hope that it will be useful,
|
|
|
21 /// but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
22 /// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
23 /// GNU General Public License for more details.
|
|
|
24 ///
|
|
|
25 /// You should have received a copy of the GNU General Public License
|
|
|
26 /// along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
|
27 //////////////////////////////////////////////////////////////////////////////
|
|
|
28
|
|
|
29 /* Includes ------------------------------------------------------------------*/
|
|
243
|
30
|
|
|
31 #include "gfx_engine.h"
|
|
|
32 #include "gfx_fonts.h"
|
|
|
33 #include "tHome.h"
|
|
|
34 #include "tInfo.h"
|
|
38
|
35 #include "tInfoCompass.h"
|
|
|
36
|
|
|
37 #include <string.h>
|
|
|
38
|
|
|
39 /* Private variables ---------------------------------------------------------*/
|
|
|
40
|
|
|
41 uint16_t tInfoCompassTimeout = 0;
|
|
|
42 int16_t minMaxCompassDX[3][2] = { 0 };
|
|
|
43
|
|
|
44 /* Exported functions --------------------------------------------------------*/
|
|
|
45 void openInfo_Compass(void)
|
|
|
46 {
|
|
|
47 set_globalState(StICOMPASS);
|
|
|
48 tInfoCompassTimeout = settingsGetPointer()->timeoutInfoCompass;
|
|
|
49 tInfoCompassTimeout *= 10;
|
|
|
50
|
|
|
51 for(int i = 0; i<3;i ++)
|
|
|
52 {
|
|
|
53 minMaxCompassDX[i][0] = 999;
|
|
|
54 minMaxCompassDX[i][1] = -999;
|
|
|
55 }
|
|
|
56 }
|
|
|
57
|
|
|
58
|
|
|
59 // ===============================================================================
|
|
|
60 // refreshInfo_Compass
|
|
|
61 /// @brief there is only compass_DX_f, compass_DY_f, compass_DZ_f output during this mode
|
|
|
62 /// the accel is not called during this process
|
|
|
63 // ===============================================================================
|
|
243
|
64 void refreshInfo_Compass(GFX_DrawCfgScreen s)
|
|
38
|
65 {
|
|
243
|
66
|
|
|
67 tHome_show_lost_connection_count(&s);
|
|
38
|
68 tInfoCompassTimeout--;
|
|
|
69 if(tInfoCompassTimeout == 0)
|
|
|
70 {
|
|
|
71 exitInfo();
|
|
|
72 return;
|
|
|
73 }
|
|
|
74
|
|
|
75 char text[80];
|
|
|
76
|
|
|
77 int16_t compassValues[3];
|
|
|
78
|
|
|
79 compassValues[0] = stateUsed->lifeData.compass_DX_f;
|
|
|
80 compassValues[1] = stateUsed->lifeData.compass_DY_f;
|
|
|
81 compassValues[2] = stateUsed->lifeData.compass_DZ_f;
|
|
|
82
|
|
|
83 for(int i = 0; i<3;i ++)
|
|
|
84 {
|
|
|
85 // do not accept zero
|
|
|
86 if(minMaxCompassDX[i][0] == 0)
|
|
|
87 minMaxCompassDX[i][0] = compassValues[i];
|
|
|
88
|
|
|
89 // do not accept zero
|
|
|
90 if(minMaxCompassDX[i][1] == 0)
|
|
|
91 minMaxCompassDX[i][1] = compassValues[i];
|
|
|
92
|
|
|
93 if(compassValues[i] < minMaxCompassDX[i][0])
|
|
|
94 minMaxCompassDX[i][0] = compassValues[i];
|
|
|
95
|
|
|
96 if(compassValues[i] > minMaxCompassDX[i][1])
|
|
|
97 minMaxCompassDX[i][1] = compassValues[i];
|
|
|
98 }
|
|
|
99
|
|
|
100 snprintf(text,80,"Time left: %u s",(tInfoCompassTimeout+9)/10);
|
|
243
|
101 tInfo_write_content_simple( 20,800, 25, &FontT42, text, CLUT_InfoCompass);
|
|
38
|
102
|
|
|
103 for(int i = 0; i<3;i ++)
|
|
|
104 {
|
|
|
105 snprintf(text,80,"%c: %i" "\t(%i, %i)",
|
|
|
106 'X'+i,
|
|
|
107 compassValues[i],
|
|
|
108 minMaxCompassDX[i][0],
|
|
|
109 minMaxCompassDX[i][1]);
|
|
|
110 tInfo_write_content_simple( 20,800, 96 + (i*96), &FontT48, text, CLUT_InfoCompass);
|
|
|
111 }
|
|
|
112
|
|
|
113 snprintf(text,80,"roll %.1f" "\tpitch %.1f",
|
|
|
114 stateUsed->lifeData.compass_roll,
|
|
|
115 stateUsed->lifeData.compass_pitch);
|
|
|
116 tInfo_write_content_simple( 20,800, 96 * 4, &FontT42, text, CLUT_InfoCompass);
|
|
|
117 }
|
