Mercurial > public > ostc4

comparison Discovery/Src/tInfoCompass.c @ 38:5f11787b4f42

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
include in ostc4 repository
author heinrichsweikamp
date Sat, 28 Apr 2018 11:52:34 +0200
parents
children b7b481df4f22
comparison
equal deleted inserted replaced
37:ccc45c0e1ea2 38:5f11787b4f42
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 ------------------------------------------------------------------*/
30 #include "tInfoCompass.h"
31
32 #include "gfx_fonts.h"
33 #include "tInfo.h"
34
35 #include <string.h>
36
37 /* Private variables ---------------------------------------------------------*/
38
39 uint16_t tInfoCompassTimeout = 0;
40 int16_t minMaxCompassDX[3][2] = { 0 };
41
42 /* Exported functions --------------------------------------------------------*/
43 void openInfo_Compass(void)
44 {
45 set_globalState(StICOMPASS);
46 tInfoCompassTimeout = settingsGetPointer()->timeoutInfoCompass;
47 tInfoCompassTimeout *= 10;
48
49 for(int i = 0; i<3;i ++)
50 {
51 minMaxCompassDX[i][0] = 999;
52 minMaxCompassDX[i][1] = -999;
53 }
54 }
55
56
57 // ===============================================================================
58 // refreshInfo_Compass
59 /// @brief there is only compass_DX_f, compass_DY_f, compass_DZ_f output during this mode
60 /// the accel is not called during this process
61 // ===============================================================================
62 void refreshInfo_Compass(void)
63 {
64 tInfoCompassTimeout--;
65 if(tInfoCompassTimeout == 0)
66 {
67 exitInfo();
68 return;
69 }
70
71 char text[80];
72
73 int16_t compassValues[3];
74
75 compassValues[0] = stateUsed->lifeData.compass_DX_f;
76 compassValues[1] = stateUsed->lifeData.compass_DY_f;
77 compassValues[2] = stateUsed->lifeData.compass_DZ_f;
78
79 for(int i = 0; i<3;i ++)
80 {
81 // do not accept zero
82 if(minMaxCompassDX[i][0] == 0)
83 minMaxCompassDX[i][0] = compassValues[i];
84
85 // do not accept zero
86 if(minMaxCompassDX[i][1] == 0)
87 minMaxCompassDX[i][1] = compassValues[i];
88
89 if(compassValues[i] < minMaxCompassDX[i][0])
90 minMaxCompassDX[i][0] = compassValues[i];
91
92 if(compassValues[i] > minMaxCompassDX[i][1])
93 minMaxCompassDX[i][1] = compassValues[i];
94 }
95
96 snprintf(text,80,"Time left: %u s",(tInfoCompassTimeout+9)/10);
97 tInfo_write_content_simple( 20,800, 20, &FontT42, text, CLUT_InfoCompass);
98
99 for(int i = 0; i<3;i ++)
100 {
101 snprintf(text,80,"%c: %i" "\t(%i, %i)",
102 'X'+i,
103 compassValues[i],
104 minMaxCompassDX[i][0],
105 minMaxCompassDX[i][1]);
106 tInfo_write_content_simple( 20,800, 96 + (i*96), &FontT48, text, CLUT_InfoCompass);
107 }
108
109 snprintf(text,80,"roll %.1f" "\tpitch %.1f",
110 stateUsed->lifeData.compass_roll,
111 stateUsed->lifeData.compass_pitch);
112 tInfo_write_content_simple( 20,800, 96 * 4, &FontT42, text, CLUT_InfoCompass);
113 }