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 TimeSpan GoingDown(ZH_L16 algorithm, ref Collection<DiveSegment> divetable, int runTime, double currentDepth, WayPoint waypoint) { algorithm.AscendDecsend(currentDepth, waypoint.Depth, pref.DescRate); TimeSpan ascdescTime = CalcAscDescTime(waypoint.Depth - currentDepth, pref.DescRate); int timespent = TimeHelper.MinutesRoundedUp(ascdescTime); double cns = CentralNervousSystem.AscendDescend(algorithm.ActiveGas, currentDepth, waypoint.Depth, Math.Abs(pref.DescRate)); double otu = OxygenToxicityUnit.AscendDescend(algorithm.ActiveGas, currentDepth, waypoint.Depth, Math.Abs(pref.DescRate)); // Round to complete minute double diffTime = Math.Abs(ascdescTime.TotalMinutes - timespent); double diffDepth = CalcHalfWayDepth(currentDepth, waypoint.Depth); if (Math.Abs(diffTime - 0) > 0.001) { 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.Desend, runTime, runTime + timespent, algorithm.ActiveGas, cns, otu); Logger.Trace("Calc => Segment:" + seg); divetable.Add(seg); return ascdescTime; }
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 void StayAtDepth(ZH_L16 algorithm, ref Collection<DiveSegment> divetable, int runTime, double depth, double time) { algorithm.AddRunTimeInMinutes(time, depth); double cns = CentralNervousSystem.ConstantDepth(algorithm.ActiveGas, depth, time); double otu = OxygenToxicityUnit.ConstantDepth(algorithm.ActiveGas, depth, time); var seg = new DiveSegment(depth, TimeSpan.FromMinutes(time), DiveState.Diving, runTime, runTime + TimeHelper.MinutesRoundedUp(TimeSpan.FromMinutes(time)), algorithm.ActiveGas, cns, otu); Logger.Trace("Calc => Segment:" + seg); divetable.Add(seg); }
public Collection<DiveSegment> Calc(Collection<WayPoint> waypoints, ZH_L16 algorithm, Preference preference) { pref = preference; var divetable = new Collection<DiveSegment>(); int runTime = 0; double depth = 0; if (algorithm.ActiveGas == null) { algorithm.ActiveGas = waypoints[0].Gas; } foreach (WayPoint waypoint in waypoints) { var ascdescTime = new TimeSpan(); //// Going down if (waypoint.Depth > depth) { ascdescTime = GoingDown(algorithm, ref divetable, runTime, depth, waypoint); } //// Going upp if (waypoint.Depth < depth) { ascdescTime = GoingUp(algorithm, ref divetable, runTime, depth, waypoint); } int timeSpentAscDesc = TimeHelper.MinutesRoundedUp(ascdescTime); runTime += timeSpentAscDesc; // Gas swith if (!Equals(algorithm.ActiveGas, waypoint.Gas)) { if (this.pref.TimeToSwitchGas > 0) { algorithm.AddRunTimeInMinutes(pref.TimeToSwitchGas, waypoint.Depth); } double cns = CentralNervousSystem.ConstantDepth(algorithm.ActiveGas, waypoint.Depth, pref.TimeToSwitchGas); double otu = OxygenToxicityUnit.ConstantDepth(algorithm.ActiveGas, waypoint.Depth, pref.TimeToSwitchGas); var seg = new DiveSegment(waypoint.Depth, new TimeSpan(0, 0, (int) pref.TimeToSwitchGas, 0, 0), DiveState.GasSwitch, runTime, runTime + (int) pref.TimeToSwitchGas, algorithm.ActiveGas, cns, otu); Logger.Trace("Calc => Segment:" + seg); divetable.Add(seg); runTime += (int) pref.TimeToSwitchGas; algorithm.ActiveGas = waypoint.Gas; } //// still time left to stay at depth if (timeSpentAscDesc < waypoint.Time) { double timeLeft = waypoint.Time - timeSpentAscDesc; StayAtDepth(algorithm, ref divetable, runTime, waypoint.Depth, timeLeft); runTime += (int) waypoint.Time - timeSpentAscDesc; } depth = waypoint.Depth; } return divetable; }