private TimeSpan GotoDecoDepth(ZH_L16 algorithm, double currentDepth, double finalDepth, int runTime, ref Collection<DiveSegment> diveTable, out double stopDepth) { double minDepthAscent = algorithm.MinDepthAscent(CalcGradient(firstDecoDepth, currentDepth, pref)); double decoDepth = GetDecoDepth(minDepthAscent, pref); if (decoDepth >= currentDepth) { stopDepth = decoDepth; return new TimeSpan(); } Logger.Trace("GotoDecoDepth => start deco depth:" + decoDepth); algorithm.AscendDecsend(currentDepth, decoDepth, pref.AscRate); stopDepth = ContinueAscend(algorithm, finalDepth, decoDepth); TimeSpan timeSpentInGoingUp = CalcAscDescTime(currentDepth - stopDepth, pref.AscRate); int timespent = TimeHelper.MinutesRoundedUp(timeSpentInGoingUp); // Round to complete minute double diffTime = Math.Abs(timeSpentInGoingUp.TotalMinutes - timespent); double diffDepth = CalcHalfWayDepth(currentDepth, stopDepth); if (Math.Abs(diffTime - 0) > 0.001) { var algorithm2 = new ZH_L16(algorithm); algorithm2.AddRunTimeInMinutes(diffTime, diffDepth); // Try adding additional runtime to verify if we should go up even more. double newStopDepth = ContinueAscend(algorithm2, finalDepth, stopDepth); if (newStopDepth < stopDepth) { ContinueAscend(algorithm, finalDepth, stopDepth); timeSpentInGoingUp = CalcAscDescTime(currentDepth - newStopDepth, pref.AscRate); timespent = TimeHelper.MinutesRoundedUp(timeSpentInGoingUp); // Round to complete minute diffTime = Math.Abs(timeSpentInGoingUp.TotalMinutes - timespent); diffDepth = CalcHalfWayDepth(currentDepth, stopDepth); if (Math.Abs(diffTime - 0) > 0.001) { algorithm.AddRunTimeInMinutes(diffTime, diffDepth); } stopDepth = newStopDepth; } } double cns = CentralNervousSystem.AscendDescend(algorithm.ActiveGas, currentDepth, stopDepth, Math.Abs(pref.AscRate)); double otu = OxygenToxicityUnit.AscendDescend(algorithm.ActiveGas, currentDepth, stopDepth, Math.Abs(pref.AscRate)); timeSpentInGoingUp = TimeSpan.FromMinutes(timespent); var seg = new DiveSegment(stopDepth, timeSpentInGoingUp, DiveState.Ascend, runTime, runTime + timespent, algorithm.ActiveGas, cns, otu); Logger.Trace("GotoDecoDepth => Segment:" + seg); diveTable.Add(seg); return timeSpentInGoingUp; }
private TimeSpan GoingUp(ZH_L16 algorithm, ref Collection<DiveSegment> divetable, int runTime, double depth, WayPoint waypoint) { var ascdescTime = new TimeSpan(); double minDepthAscent = algorithm.MinDepthAscent(CalcGradient(firstDecoDepth, depth, pref)); //// No deco needed if (minDepthAscent <= waypoint.Depth) { algorithm.AscendDecsend(depth, waypoint.Depth, pref.AscRate); ascdescTime = CalcAscDescTime(depth - waypoint.Depth, pref.AscRate); int timespent = TimeHelper.MinutesRoundedUp(ascdescTime); double cns = CentralNervousSystem.AscendDescend(algorithm.ActiveGas, depth, waypoint.Depth, Math.Abs(pref.AscRate)); double otu = OxygenToxicityUnit.AscendDescend(algorithm.ActiveGas, depth, waypoint.Depth, Math.Abs(pref.AscRate)); // Round to complete minute double diffTime = Math.Abs(ascdescTime.TotalMinutes - timespent); double diffDepth = CalcHalfWayDepth(depth, waypoint.Depth); algorithm.AddRunTimeInMinutes(diffTime, diffDepth); ascdescTime = TimeSpan.FromMinutes(timespent); cns += CentralNervousSystem.ConstantDepth(algorithm.ActiveGas, diffDepth, diffTime); otu += OxygenToxicityUnit.ConstantDepth(algorithm.ActiveGas, diffDepth, diffTime); var seg = new DiveSegment(waypoint.Depth, ascdescTime, DiveState.Ascend, runTime, runTime + timespent, algorithm.ActiveGas, cns, otu); Logger.Trace("Calc => Segment:" + seg); divetable.Add(seg); } else { ascdescTime = GotoDecoDepth(algorithm, depth, waypoint.Depth, runTime, ref divetable, out depth); runTime += TimeHelper.MinutesRoundedUp(ascdescTime); if (Math.Abs(depth - waypoint.Depth) > 0.001) { TimeSpan decoTime = DoDeco(algorithm, depth, waypoint.Depth, runTime, ref divetable); ascdescTime += decoTime; } } return ascdescTime; }
private double ContinueAscend(ZH_L16 algorithm, double finalDepth, double decoDepth) { double stopDepth; double minDepthAscent = algorithm.MinDepthAscent(CalcGradient(firstDecoDepth, decoDepth, pref)); //// deco was not needed if (minDepthAscent <= finalDepth) { Logger.Trace("DoDeco => Deco not needed"); algorithm.AscendDecsend(decoDepth, finalDepth, pref.AscRate); stopDepth = finalDepth; } else { bool done = false; //// Check if we during ascent did get rid of deco obligations for that depth while (!done) { if (minDepthAscent < (decoDepth - pref.DepthBetweenDecoStops)) { double oldDecoDepth = decoDepth; decoDepth = GetDecoDepth(minDepthAscent, pref); //To not go to far if (decoDepth < finalDepth) { decoDepth = finalDepth; done = true; } Logger.Trace( "GotoDecoDepth => During ascent to depth:{0} we have changed celling to next deco depth:{1}", oldDecoDepth, decoDepth); algorithm.AscendDecsend(oldDecoDepth, decoDepth, pref.AscRate); minDepthAscent = algorithm.MinDepthAscent(CalcGradient(firstDecoDepth, decoDepth, pref)); } else { done = true; } } stopDepth = decoDepth; } return stopDepth; }
private TimeSpan DoDeco(ZH_L16 algorithm, double currentDepth, double finalDepth, int runTime, ref Collection<DiveSegment> diveTable) { if (currentDepth < pref.MiniDepthForDeco) { Logger.Error("DoDeco => Can't do deco because of current depth is lower than min deco depth"); throw new ArgumentException("currentDepth can't be smaller then miniDepthForDeco"); } Logger.Trace("DoDeco => currentDepth:{0}, FinalDepth:{1}", currentDepth, finalDepth); double minDepthAscent = algorithm.MinDepthAscent(CalcGradient(firstDecoDepth, currentDepth, pref)); double decoDepth = GetDecoDepth(minDepthAscent, pref); if (Math.Abs(currentDepth - decoDepth) > 0.001) { Logger.Error("DoDeco => Can't do deco because current depth is not deco depth"); throw new ArgumentException("Can't do deco because current depth is not deco depth"); } firstDecoDepth = decoDepth; Logger.Trace("DoDeco => start deco depth:" + decoDepth); var timeSpentDeco = new TimeSpan(); double decoStartDepth = decoDepth; while (minDepthAscent > finalDepth) { decoDepth = GetDecoDepth(minDepthAscent, pref); int timespent = GetDecoStopTime(algorithm, decoDepth, pref, CalcGradient(firstDecoDepth, decoDepth, pref)); TimeSpan decoTime = TimeSpan.FromMinutes(timespent); timeSpentDeco += TimeSpan.FromMinutes(timespent); double cns = CentralNervousSystem.ConstantDepth(algorithm.ActiveGas, decoDepth, timespent); double otu = OxygenToxicityUnit.ConstantDepth(algorithm.ActiveGas, decoDepth, timespent); var seg = new DiveSegment(decoDepth, decoTime, DiveState.Deco, runTime, runTime + timespent, algorithm.ActiveGas, cns, otu); Logger.Trace("DoDeco => Segment:" + seg); diveTable.Add(seg); runTime += timespent; if (Math.Abs(decoDepth - pref.MiniDepthForDeco) < 0.001) { minDepthAscent = 0; } else { minDepthAscent = decoDepth - pref.DepthBetweenDecoStops; } } return timeSpentDeco; }
private static int GetDecoStopTime(ZH_L16 alg, double depth, Preference pref, double gradient) { int timer = 0; double goalDepth = depth - pref.DepthBetweenDecoStops; //// If goal depth is small the min depth for deco and depth is equal to mino deco depth set next deco depth to 0. if (goalDepth < pref.MiniDepthForDeco && Math.Abs(depth - pref.MiniDepthForDeco) < 0.001) { Logger.Trace( "GetDecoStopTime => Goal depth ({0}) is smaller then mini deco depth {1} for deco, on current depth ({2}) is equal to mini deco depth. Setting goal depth to 0", goalDepth, pref.MiniDepthForDeco, depth); goalDepth = 0; } //// If goal deth is small the min depth for deco and depth is bigger that mini deco depth set next deco depth to mnin deco depth. if (goalDepth < pref.MiniDepthForDeco && depth > pref.MiniDepthForDeco) { Logger.Trace( "GetDecoStopTime => Goal depth ({0}) is smaller then mini deco depth {1} for deco, on current depth ({2}) and depth is bigger than mini deco depth. Setting goal depth to min deco depth", goalDepth, pref.MiniDepthForDeco, depth); goalDepth = pref.MiniDepthForDeco; } double startDepth = depth; while (goalDepth < depth) { timer++; alg.AddRunTimeInMinutes(1, startDepth); depth = alg.MinDepthAscent(gradient); } Logger.Trace("GetDecoStopTime => StartDepth:{0}, EndDepth:{1}, Gradient:{2}, Time:{3}", startDepth, depth, gradient, timer); return timer; }