annotate Discovery/Src/tCCR.c @ 627:189f945ae4ba

Improve in / out of focus transitions: Added a function which detects if the yaw value changed significant while in focus state. This event is typically pointing to a arm movment => diver is no longer focussing at the OSTC. Improve custom view mapping: Added a direction indicator to the focus distance value (now +/- values instead of absolut values before). With this modification custom view sectors may have the double size and are threrfore easier to be controlled.
author Ideenmodellierer
date Fri, 12 Feb 2021 21:43:27 +0100
parents 64bf41faab83
children 7c73f066cd16
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
1 ///////////////////////////////////////////////////////////////////////////////
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
2 /// -*- coding: UTF-8 -*-
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
3 ///
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
4 /// \file Discovery/Src/tCCR.c
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
5 /// \brief HUD data via optical port
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
6 /// \author Heinrichs Weikamp gmbh
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
7 /// \date 18-Dec-2014
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
8 ///
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
9 /// \details
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
10 ///
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
11 /// $Id$
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
12 ///////////////////////////////////////////////////////////////////////////////
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
13 /// \par Copyright (c) 2014-2018 Heinrichs Weikamp gmbh
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
14 ///
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
15 /// This program is free software: you can redistribute it and/or modify
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
16 /// it under the terms of the GNU General Public License as published by
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
17 /// the Free Software Foundation, either version 3 of the License, or
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
18 /// (at your option) any later version.
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
19 ///
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
20 /// This program is distributed in the hope that it will be useful,
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
21 /// but WITHOUT ANY WARRANTY; without even the implied warranty of
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
22 /// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
23 /// GNU General Public License for more details.
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
24 ///
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
25 /// You should have received a copy of the GNU General Public License
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
26 /// along with this program. If not, see <http://www.gnu.org/licenses/>.
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
27 //////////////////////////////////////////////////////////////////////////////
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
28
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
29 /* Includes ------------------------------------------------------------------*/
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
30 #include <string.h>
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
31 #include "tCCR.h"
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
32 #include "ostc.h"
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
33 #include "data_central.h"
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
34 #include "data_exchange.h"
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
35 #include "check_warning.h"
446
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
36 #include "configuration.h"
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
37
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
38 /* Private types -------------------------------------------------------------*/
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
39 typedef struct
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
40 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
41 uint8_t hud_firmwareVersion;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
42 bit8_Type status_byte;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
43 uint16_t sensor_voltage_100uV[3];
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
44 uint8_t sensor_ppo2_cbar[3];
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
45 uint8_t temp1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
46 uint16_t battery_voltage_mV;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
47 uint16_t checksum;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
48 } SIrLink;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
49
322
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
50 #define HUD_BABBLING_IDIOT (30u) /* 30 Bytes received without break */
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
51 #define HUD_RX_FRAME_LENGTH (15u) /* Length of a HUD data frame */
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
52 #define HUD_RX_FRAME_BREAK_MS (100u) /* Time used to detect a gap between two byte receptions => frame start */
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
53 #define HUD_RX_START_DELAY_MS (500u) /* Delay for start of RX function to avoid start of reception while a transmission is ongoing. */
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
54 /* Based on an assumed cycle time by the sensor of 1 second. Started at time of last RX */
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
55
449
91a939915bfa Added initialization of bottle sensor data age counter
ideenmodellierer
parents: 446
diff changeset
56 #define BOTTLE_SENSOR_TIMEOUT (6000u) /* signal pressure budget as not received after 10 minutes (6000 * 100ms) */
91a939915bfa Added initialization of bottle sensor data age counter
ideenmodellierer
parents: 446
diff changeset
57
322
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
58 /* Private variables ---------------------------------------------------------*/
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
59 static SIrLink receiveHUD[2];
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
60 static uint8_t boolHUDdata = 0;
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
61 static uint8_t data_old__lost_connection_to_HUD = 1;
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
62
322
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
63 static uint8_t receiveHUDraw[16];
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
64
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
65 static uint8_t StartListeningToUART_HUD = 0;
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
66 static uint16_t HUDTimeoutCount = 0;
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
67
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
68 static __IO ITStatus UartReadyHUD = RESET;
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
69 static uint32_t LastReceivedTick_HUD = 0;
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
70
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
71 /* Private variables with external access via get_xxx() function -------------*/
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
72
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
73 /* Private function prototypes -----------------------------------------------*/
272
74a8296a2318 cleanup: simplify stateUsed usage
Jan Mulder <jlmulder@xs4all.nl>
parents: 38
diff changeset
74 static void tCCR_fallbackToFixedSetpoint(void);
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
75
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
76 #ifndef USART_IR_HUD
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
77
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
78 void tCCR_init(void)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
79 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
80 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
81 void tCCR_control(void)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
82 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
83 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
84 void tCCR_test(void)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
85 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
86 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
87 void tCCR_restart(void)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
88 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
89 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
90 float get_ppO2Sensor_bar(uint8_t sensor_id)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
91 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
92 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
93 float get_sensorVoltage_mV(uint8_t sensor_id)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
94 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
95 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
96 float get_HUD_battery_voltage_V(void)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
97 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
98 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
99 void tCCR_tick(void)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
100 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
101 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
102
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
103 #else
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
104 /* Exported functions --------------------------------------------------------*/
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
105
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
106 float get_ppO2Sensor_bar(uint8_t sensor_id)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
107 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
108 if((sensor_id > 2) || data_old__lost_connection_to_HUD)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
109 return 0;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
110
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
111 return (float)(receiveHUD[boolHUDdata].sensor_ppo2_cbar[sensor_id]) / 100.0f;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
112 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
113
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
114 float get_sensorVoltage_mV(uint8_t sensor_id)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
115 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
116 if((sensor_id > 2) || data_old__lost_connection_to_HUD)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
117 return 0;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
118
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
119 return (float)(receiveHUD[boolHUDdata].sensor_voltage_100uV[sensor_id]) / 10.0f;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
120 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
121
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
122 float get_HUD_battery_voltage_V(void)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
123 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
124 if(data_old__lost_connection_to_HUD)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
125 return 0;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
126
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
127 return (float)(receiveHUD[boolHUDdata].battery_voltage_mV) / 1000.0f;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
128 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
129
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
130
563
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
131 void test_O2_sensor_values_outOfBounds(int8_t * outOfBouds1, int8_t * outOfBouds2, int8_t * outOfBouds3)
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
132 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
133 uint8_t sensorNotActiveBinary;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
134 uint8_t sensorActive[3];
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
135
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
136 // test1: user deactivation
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
137 sensorNotActiveBinary = stateUsed->diveSettings.ppo2sensors_deactivated;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
138
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
139 for(int i=0;i<3;i++)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
140 sensorActive[i] = 1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
141
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
142 if(sensorNotActiveBinary)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
143 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
144 if(sensorNotActiveBinary & 1)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
145 sensorActive[0] = 0;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
146
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
147 if(sensorNotActiveBinary & 2)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
148 sensorActive[1] = 0;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
149
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
150 if(sensorNotActiveBinary & 4)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
151 sensorActive[2] = 0;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
152 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
153
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
154 // test2: mV of remaining sensors
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
155 for(int i=0;i<3;i++)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
156 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
157 if(sensorActive[i])
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
158 {
563
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
159 if( (stateUsed->lifeData.sensorVoltage_mV[i] < 8) ||
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
160 (stateUsed->lifeData.sensorVoltage_mV[i] > 250))
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
161 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
162 sensorActive[i] = 0;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
163 switch(i)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
164 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
165 case 0:
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
166 sensorNotActiveBinary |= 1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
167 break;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
168 case 1:
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
169 sensorNotActiveBinary |= 2;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
170 break;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
171 case 2:
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
172 sensorNotActiveBinary |= 4;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
173 break;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
174 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
175 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
176 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
177 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
178
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
179 *outOfBouds1 = 0;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
180 *outOfBouds2 = 0;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
181 *outOfBouds3 = 0;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
182
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
183 /* with two, one or no sensor, there is nothing to compare anymore
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
184 */
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
185 if(sensorNotActiveBinary)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
186 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
187 // set outOfBounds for both tests
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
188 if(!sensorActive[0])
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
189 *outOfBouds1 = 1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
190
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
191 if(!sensorActive[1])
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
192 *outOfBouds2 = 1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
193
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
194 if(!sensorActive[2])
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
195 *outOfBouds3 = 1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
196 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
197 else
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
198 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
199 uint8_t sensor_id_ordered[3];
563
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
200 float difference[2];
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
201
563
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
202 if((stateUsed->lifeData.ppO2Sensor_bar[1] > stateUsed->lifeData.ppO2Sensor_bar[0]))
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
203 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
204 sensor_id_ordered[0] = 0;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
205 sensor_id_ordered[1] = 1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
206 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
207 else
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
208 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
209 sensor_id_ordered[0] = 1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
210 sensor_id_ordered[1] = 0;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
211 }
563
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
212 if(stateUsed->lifeData.ppO2Sensor_bar[2] > stateUsed->lifeData.ppO2Sensor_bar[sensor_id_ordered[1]])
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
213 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
214 sensor_id_ordered[2] = 2;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
215 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
216 else
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
217 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
218 sensor_id_ordered[2] = sensor_id_ordered[1];
563
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
219 if(stateUsed->lifeData.ppO2Sensor_bar[2] > stateUsed->lifeData.ppO2Sensor_bar[sensor_id_ordered[0]])
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
220 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
221 sensor_id_ordered[1] = 2;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
222 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
223 else
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
224 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
225 sensor_id_ordered[1] = sensor_id_ordered[0];
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
226 sensor_id_ordered[0] = 2;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
227 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
228 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
229
563
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
230 difference[0] = stateUsed->lifeData.ppO2Sensor_bar[sensor_id_ordered[1]]- stateUsed->lifeData.ppO2Sensor_bar[sensor_id_ordered[0]];
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
231 difference[1] = stateUsed->lifeData.ppO2Sensor_bar[sensor_id_ordered[2]]- stateUsed->lifeData.ppO2Sensor_bar[sensor_id_ordered[1]];
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
232
563
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
233 if((difference[0] > difference[1]) && (difference[0] > 0.15)) /* was 15cBar ==> 0.15 bar */
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
234 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
235 switch(sensor_id_ordered[0])
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
236 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
237 case 0:
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
238 *outOfBouds1 = 1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
239 break;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
240 case 1:
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
241 *outOfBouds2 = 1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
242 break;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
243 case 2:
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
244 *outOfBouds3 = 1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
245 break;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
246 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
247 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
248 else
563
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
249 if((difference[0] < difference[1]) && (difference[1] > 0.15))
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
250 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
251 switch(sensor_id_ordered[2])
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
252 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
253 case 0:
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
254 *outOfBouds1 = 1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
255 break;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
256 case 1:
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
257 *outOfBouds2 = 1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
258 break;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
259 case 2:
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
260 *outOfBouds3 = 1;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
261 break;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
262 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
263 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
264 }
582
64bf41faab83 Show Fallback if no valid sensor value is available:
Ideenmodellierer
parents: 563
diff changeset
265
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
266 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
267
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
268
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
269 uint8_t get_ppO2SensorWeightedResult_cbar(void)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
270 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
271 int8_t sensorOutOfBound[3];
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
272 uint16_t result = 0;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
273 uint8_t count = 0;
582
64bf41faab83 Show Fallback if no valid sensor value is available:
Ideenmodellierer
parents: 563
diff changeset
274 uint8_t retVal = 0;
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
275
563
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
276 test_O2_sensor_values_outOfBounds(&sensorOutOfBound[0], &sensorOutOfBound[1], &sensorOutOfBound[2]);
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
277
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
278 for(int i=0;i<3;i++)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
279 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
280 if(!sensorOutOfBound[i])
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
281 {
563
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
282 result += stateUsed->lifeData.ppO2Sensor_bar[i] * 100.0; /* convert centibar used by HUB */
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
283 count++;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
284 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
285 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
286 if(count == 0) // all sensors out of bounds!
582
64bf41faab83 Show Fallback if no valid sensor value is available:
Ideenmodellierer
parents: 563
diff changeset
287 {
64bf41faab83 Show Fallback if no valid sensor value is available:
Ideenmodellierer
parents: 563
diff changeset
288 set_warning_fallback();
64bf41faab83 Show Fallback if no valid sensor value is available:
Ideenmodellierer
parents: 563
diff changeset
289 }
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
290 else
582
64bf41faab83 Show Fallback if no valid sensor value is available:
Ideenmodellierer
parents: 563
diff changeset
291 {
64bf41faab83 Show Fallback if no valid sensor value is available:
Ideenmodellierer
parents: 563
diff changeset
292 retVal = (uint8_t)(result / count);
64bf41faab83 Show Fallback if no valid sensor value is available:
Ideenmodellierer
parents: 563
diff changeset
293 }
64bf41faab83 Show Fallback if no valid sensor value is available:
Ideenmodellierer
parents: 563
diff changeset
294 return retVal;
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
295 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
296
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
297
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
298 void tCCR_init(void)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
299 {
449
91a939915bfa Added initialization of bottle sensor data age counter
ideenmodellierer
parents: 446
diff changeset
300 uint8_t loop;
91a939915bfa Added initialization of bottle sensor data age counter
ideenmodellierer
parents: 446
diff changeset
301
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
302 StartListeningToUART_HUD = 1;
449
91a939915bfa Added initialization of bottle sensor data age counter
ideenmodellierer
parents: 446
diff changeset
303
91a939915bfa Added initialization of bottle sensor data age counter
ideenmodellierer
parents: 446
diff changeset
304 SDiveState* pDiveData = stateRealGetPointerWrite();
91a939915bfa Added initialization of bottle sensor data age counter
ideenmodellierer
parents: 446
diff changeset
305 for(loop=0;loop<(2*NUM_GASES+1);loop++)
91a939915bfa Added initialization of bottle sensor data age counter
ideenmodellierer
parents: 446
diff changeset
306 {
91a939915bfa Added initialization of bottle sensor data age counter
ideenmodellierer
parents: 446
diff changeset
307 pDiveData->lifeData.bottle_bar_age_MilliSeconds[loop] = BOTTLE_SENSOR_TIMEOUT;
91a939915bfa Added initialization of bottle sensor data age counter
ideenmodellierer
parents: 446
diff changeset
308 }
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
309 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
310
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
311
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
312 /* after 3 seconds without update from HUD
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
313 * data is considered old
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
314 */
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
315 void tCCR_tick(void)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
316 {
563
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
317 if(settingsGetPointer()->ppo2sensors_source == O2_SENSOR_SOURCE_OPTIC)
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
318 {
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
319 if(HUDTimeoutCount < 3 * 10)
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
320 HUDTimeoutCount++;
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
321 else
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
322 {
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
323 data_old__lost_connection_to_HUD = 1;
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
324 if(HUDTimeoutCount < 20 * 10)
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
325 HUDTimeoutCount++;
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
326 else
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
327 tCCR_fallbackToFixedSetpoint();
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
328 }
d97f0e395058 Refine o2 sensor diagnostic functions:
Ideenmodellierer
parents: 457
diff changeset
329 }
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
330 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
331
322
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
332 void tCCR_SetRXIndication(void)
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
333 {
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
334 static uint8_t floatingRXCount = 0;
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
335
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
336 if((UartIR_HUD_Handle.RxXferSize == HUD_RX_FRAME_LENGTH) || (UartIR_HUD_Handle.RxXferSize == HUD_RX_FRAME_LENGTH - 1)) /* we expected a complete frame */
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
337 {
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
338 UartReadyHUD = SET;
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
339 LastReceivedTick_HUD = HAL_GetTick();
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
340 floatingRXCount = 0;
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
341 }
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
342 else /* follow up of error handling */
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
343 {
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
344 if(time_elapsed_ms(LastReceivedTick_HUD, HAL_GetTick()) > HUD_RX_FRAME_BREAK_MS) /* Reception took a while => frame start detected */
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
345 {
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
346 HAL_UART_Receive_IT(&UartIR_HUD_Handle, &receiveHUDraw[1], 14); /* We have already the first byte => get the missing 14 */
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
347 }
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
348 else
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
349 {
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
350 if(floatingRXCount++ < HUD_BABBLING_IDIOT)
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
351 {
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
352 HAL_UART_Receive_IT(&UartIR_HUD_Handle, receiveHUDraw, 1); /* Start polling of incoming bytes */
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
353 }
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
354 else /* Significant amount of data comming in without break => disable input */
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
355 { /* by not reactivation HUD RX, no recovery fromthis state */
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
356 stateUsedWrite->diveSettings.ppo2sensors_deactivated = 0x07; /* Display deactivation */
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
357 }
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
358 }
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
359 }
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
360
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
361 }
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
362
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
363 void tCCR_restart(void)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
364 {
322
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
365 HAL_UART_AbortReceive_IT(&UartIR_HUD_Handle); /* Called by the error handler. RX will be restarted by control function */
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
366 StartListeningToUART_HUD = 1;
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
367 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
368
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
369
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
370 void tCCR_control(void)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
371 {
446
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
372 uint16_t checksum = 0;
457
4bd01f48c285 Eliminated some minor warnings
ideenmodellierer
parents: 449
diff changeset
373 #ifdef ENABLE_BOTTLE_SENSOR
446
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
374 SDiveState *pLivedata = stateRealGetPointerWrite();
457
4bd01f48c285 Eliminated some minor warnings
ideenmodellierer
parents: 449
diff changeset
375 #endif
322
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
376
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
377 if((UartReadyHUD == RESET) && StartListeningToUART_HUD && (time_elapsed_ms(LastReceivedTick_HUD, HAL_GetTick()) > HUD_RX_START_DELAY_MS))
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
378 {
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
379 StartListeningToUART_HUD = 0;
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
380 HAL_UART_Receive_IT(&UartIR_HUD_Handle, receiveHUDraw, HUD_RX_FRAME_LENGTH);
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
381 }
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
382
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
383 if(UartReadyHUD == SET)
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
384 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
385 UartReadyHUD = RESET;
322
31e471d60797 Added start of frame detection for HUD data
ideenmodellierer
parents: 272
diff changeset
386 StartListeningToUART_HUD = 1;
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
387
446
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
388 /* check if received package is valid */
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
389 for(int i=0;i<13;i++)
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
390 {
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
391 checksum += receiveHUDraw[i];
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
392 }
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
393 receiveHUD[!boolHUDdata].checksum = receiveHUDraw[13] + (256 * receiveHUDraw[14]);
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
394 if(checksum == receiveHUD[!boolHUDdata].checksum)
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
395 {
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
396 #ifdef ENABLE_BOTTLE_SENSOR
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
397 if(receiveHUDraw[0] == 0xA5) /* code for pressure sensor */
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
398 {
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
399 pLivedata->lifeData.bottle_bar[pLivedata->lifeData.actualGas.GasIdInSettings] = receiveHUDraw[10];
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
400 pLivedata->lifeData.bottle_bar_age_MilliSeconds[pLivedata->lifeData.actualGas.GasIdInSettings] = 0;
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
401 }
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
402 else
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
403 #endif
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
404 /* handle O2 sensor data */
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
405 {
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
406 memcpy(&receiveHUD[!boolHUDdata], receiveHUDraw, 11);
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
407 receiveHUD[!boolHUDdata].battery_voltage_mV = receiveHUDraw[11] + (256 * receiveHUDraw[12]);
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
408 }
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
409
446
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
410 boolHUDdata = !boolHUDdata;
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
411 HUDTimeoutCount = 0;
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
412 data_old__lost_connection_to_HUD = 0;
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
413 }
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
414 else
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
415 {
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
416 if(data_old__lost_connection_to_HUD) /* we lost connection, maybe due to RX shift => start single byte read to resynchronize */
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
417 {
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
418 HAL_UART_Receive_IT(&UartIR_HUD_Handle, receiveHUDraw, 1);
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
419 StartListeningToUART_HUD = 0;
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
420 }
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
421 }
f1257a32f2d4 Introduced configuration header for variant managment:
ideenmodellierer
parents: 322
diff changeset
422 memset(receiveHUDraw,0,sizeof(receiveHUDraw));
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
423 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
424 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
425
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
426 #endif
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
427 /* Private functions ---------------------------------------------------------*/
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
428
272
74a8296a2318 cleanup: simplify stateUsed usage
Jan Mulder <jlmulder@xs4all.nl>
parents: 38
diff changeset
429 static void tCCR_fallbackToFixedSetpoint(void)
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
430 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
431 if((stateUsed->mode == MODE_DIVE) && (stateUsed->diveSettings.diveMode == DIVEMODE_CCR) && (stateUsed->diveSettings.CCR_Mode == CCRMODE_Sensors) && (stateUsed->diveSettings.fallbackOption))
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
432 {
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
433 uint8_t setpointCbar, actualGasID;
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
434
272
74a8296a2318 cleanup: simplify stateUsed usage
Jan Mulder <jlmulder@xs4all.nl>
parents: 38
diff changeset
435 setpointCbar = stateUsed->diveSettings.setpoint[1].setpoint_cbar;
74a8296a2318 cleanup: simplify stateUsed usage
Jan Mulder <jlmulder@xs4all.nl>
parents: 38
diff changeset
436 stateUsedWrite->diveSettings.CCR_Mode = CCRMODE_FixedSetpoint;
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
437
272
74a8296a2318 cleanup: simplify stateUsed usage
Jan Mulder <jlmulder@xs4all.nl>
parents: 38
diff changeset
438 actualGasID = stateUsed->lifeData.actualGas.GasIdInSettings;
74a8296a2318 cleanup: simplify stateUsed usage
Jan Mulder <jlmulder@xs4all.nl>
parents: 38
diff changeset
439 setActualGas_DM(&stateUsedWrite->lifeData,actualGasID,setpointCbar);
38
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
440
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
441 set_warning_fallback();
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
442 }
5f11787b4f42 include in ostc4 repository
heinrichsweikamp
parents:
diff changeset
443 }