38
+ − 1 ///////////////////////////////////////////////////////////////////////////////
+ − 2 /// -*- coding: UTF-8 -*-
+ − 3 ///
+ − 4 /// \file Discovery/Src/timer.c
+ − 5 /// \brief Contains timer related functionality like stopwatch and security stop
766
+ − 6 /// \author heinrichs weikamp gmbh
38
+ − 7 /// \date 5. Feb.2015 (maybe)
+ − 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 #include "data_central.h"
+ − 30
186
+ − 31 static _Bool bStopWatch = false;
+ − 32 static float stopWatchAverageDepth_Meter = 0.0f;
+ − 33 static long safetyStopCountDown_Second = 0;
311
+ − 34 static long stopWatchOffset = 0;
38
+ − 35
+ − 36 void timer_init(void)
+ − 37 {
+ − 38 stopWatchAverageDepth_Meter = 0.0f;
+ − 39 bStopWatch = true;
+ − 40 safetyStopCountDown_Second = 0;
311
+ − 41 stopWatchOffset = 0;
38
+ − 42 }
+ − 43
+ − 44 void timer_UpdateSecond(_Bool checkOncePerSecond)
+ − 45 {
+ − 46 static int last_second = -1;
+ − 47 static _Bool bSafetyStop = false;
+ − 48 static float last_depth_meter = 0;
519
+ − 49 static uint8_t safetyStopResetCnt = 0;
+ − 50 static uint16_t safetyStopRestartCnt = 0;
311
+ − 51 long stopWatchTime_Second = 0;
186
+ − 52
38
+ − 53 if(checkOncePerSecond)
+ − 54 {
+ − 55 int now = current_second();
+ − 56 if( last_second == now)
+ − 57 return;
+ − 58 last_second = now;
+ − 59 }
+ − 60
+ − 61 /** Stopwatch **/
311
+ − 62 stopWatchTime_Second = stateUsed->lifeData.dive_time_seconds_without_surface_time - stopWatchOffset;
303
+ − 63 if(bStopWatch && !is_ambient_pressure_close_to_surface(&stateUsedWrite->lifeData))
38
+ − 64 {
303
+ − 65 if(stopWatchTime_Second == 0)
+ − 66 stopWatchAverageDepth_Meter = stateUsed->lifeData.depth_meter;
38
+ − 67 else
+ − 68 stopWatchAverageDepth_Meter = (stopWatchAverageDepth_Meter * stopWatchTime_Second + stateUsed->lifeData.depth_meter)/ (stopWatchTime_Second + 1);
+ − 69 }
+ − 70
+ − 71 /** SafetyStop **/
+ − 72 float depthToStopSafetyStopCount;
+ − 73 if(settingsGetPointer()->safetystopDuration && (stateUsed->lifeData.max_depth_meter > 10.0f) && (stateUsed->lifeData.dive_time_seconds > 60))
+ − 74 {
+ − 75
+ − 76 //No deco when 10 meters are crossed from below => Activate SecurityStop
+ − 77 if( last_depth_meter > 10.0f && stateUsed->lifeData.depth_meter <= 10.0f)
+ − 78 {
+ − 79 if(stateUsed->diveSettings.deco_type.ub.standard == GF_MODE)
+ − 80 {
+ − 81 if(stateUsed->decolistBuehlmann.output_ndl_seconds > 0)
+ − 82 bSafetyStop = true;
+ − 83 }
+ − 84 else
+ − 85 {
+ − 86 if(stateUsed->decolistVPM.output_ndl_seconds > 0)
+ − 87 bSafetyStop = true;
+ − 88 }
+ − 89 }
+ − 90
519
+ − 91 /* Has the diver left safety stop depth (descend)? => need to restart safety stop timer? */
+ − 92 if(safetyStopCountDown_Second != 0)
+ − 93 {
+ − 94 if(stateUsed->lifeData.depth_meter >= (settingsGetPointer()->safetystopDepth + 2.0))
+ − 95 {
+ − 96 safetyStopRestartCnt = safetyStopCountDown_Second;
+ − 97 safetyStopCountDown_Second = 0;
+ − 98 safetyStopResetCnt = 60; /* restart safety stop from scratch if depth is left for more than one minute */
+ − 99 }
+ − 100 }
+ − 101 else if(safetyStopResetCnt)
+ − 102 {
+ − 103 safetyStopResetCnt--;
+ − 104 if(safetyStopResetCnt == 0)
+ − 105 {
+ − 106 safetyStopRestartCnt = 0;
+ − 107 }
+ − 108 }
+ − 109
38
+ − 110 //Countdown starts at 5 meters
+ − 111 if(bSafetyStop && (stateUsed->lifeData.depth_meter - 0.0001f <= (settingsGetPointer()->safetystopDepth) ))
+ − 112 {
+ − 113 if(safetyStopCountDown_Second == 0)
+ − 114 {
519
+ − 115 if(safetyStopRestartCnt) /* just a short interrupt of the safetystop => continue using old count */
+ − 116 {
+ − 117 safetyStopCountDown_Second = safetyStopRestartCnt;
+ − 118 safetyStopRestartCnt = 0;
+ − 119 }
+ − 120 else /* setup safety stop duration */
+ − 121 {
+ − 122 safetyStopCountDown_Second = (settingsGetPointer()->safetystopDuration) * 60;
+ − 123 }
38
+ − 124 }
+ − 125 else
519
+ − 126 {
38
+ − 127 safetyStopCountDown_Second--;
519
+ − 128 }
38
+ − 129 }
+ − 130
+ − 131 // after safetystopDuration minutes or below 3 (2) meter safetyStop is disabled
+ − 132 if(settingsGetPointer()->safetystopDepth == 3)
+ − 133 depthToStopSafetyStopCount = 1.999f; // instead of 2
+ − 134 else
+ − 135 depthToStopSafetyStopCount = 2.999f;// instead of 3
+ − 136
+ − 137 if((safetyStopCountDown_Second == 1) || (stateUsed->lifeData.depth_meter <= depthToStopSafetyStopCount))
+ − 138 {
+ − 139 bSafetyStop = false;
+ − 140 safetyStopCountDown_Second = 0;
+ − 141 }
+ − 142 }
+ − 143 else
+ − 144 {
+ − 145 bSafetyStop = false;
+ − 146 safetyStopCountDown_Second = 0;
+ − 147 }
+ − 148 last_depth_meter = stateUsed->lifeData.depth_meter;
+ − 149 }
+ − 150
+ − 151
+ − 152 void timer_Stopwatch_Restart(void)
+ − 153 {
+ − 154 stopWatchAverageDepth_Meter = stateUsed->lifeData.depth_meter;
+ − 155 bStopWatch = true;
311
+ − 156 stopWatchOffset = stateUsed->lifeData.dive_time_seconds_without_surface_time;
38
+ − 157 }
+ − 158
+ − 159 void timer_Stopwatch_Stop(void)
+ − 160 {
+ − 161 bStopWatch = false;
+ − 162 }
+ − 163
+ − 164 long timer_Stopwatch_GetTime(void)
+ − 165 {
311
+ − 166 return stateUsed->lifeData.dive_time_seconds_without_surface_time - stopWatchOffset;
38
+ − 167 }
+ − 168
+ − 169 float timer_Stopwatch_GetAvarageDepth_Meter(void)
+ − 170 {
+ − 171 return stopWatchAverageDepth_Meter;
+ − 172 }
+ − 173
+ − 174 long timer_Safetystop_GetCountDown(void)
+ − 175 {
+ − 176 return safetyStopCountDown_Second;
+ − 177 }
+ − 178
+ − 179 uint8_t timer_Safetystop_GetDepthUpperLimit(void)
+ − 180 {
+ − 181 if(settingsGetPointer()->safetystopDepth == 3)
+ − 182 return 2;
+ − 183 else
+ − 184 return 3;
+ − 185 }
+ − 186
