diff options
Diffstat (limited to 'profile.c')
| -rw-r--r-- | profile.c | 93 |
1 files changed, 83 insertions, 10 deletions
@@ -417,6 +417,22 @@ static void dump_pr_track(pr_track_t **track_pr) } #endif +typedef struct pr_interpolate_struct pr_interpolate_t; +struct pr_interpolate_struct { + int start; + int end; + int pressure_time; + int acc_pressure_time; +}; + +#ifdef DEBUG_PR_INTERPOLATE +static void dump_pr_interpolate(int i, pr_interpolate_t interpolate_pr) +{ + printf("Interpolate for entry %d: start %d - end %d - pt %d - acc_pt %d\n", i, + interpolate_pr.start, interpolate_pr.end, interpolate_pr.pressure_time, interpolate_pr.acc_pressure_time); +} +#endif + /* * This looks at the pressures for one cylinder, and * calculates any missing beginning/end pressures for @@ -506,6 +522,57 @@ static inline int pressure_time(struct dive *dive, struct divecomputer *dc, stru return depth_to_mbar(depth, dive) * time; } +static struct pr_interpolate_struct get_pr_interpolate_data(pr_track_t *segment, struct plot_info *pi, int cur) +{ + struct pr_interpolate_struct interpolate; + int i; + struct plot_data *entry; + + interpolate.start = segment->start; + interpolate.end = segment->end; + interpolate.acc_pressure_time = 0; + interpolate.pressure_time = 0; + + for (i = 0; i < pi->nr; i++) { + entry = pi->entry + i; + if (entry->sec < segment->t_start) + continue; + if (entry->sec >= segment->t_end) { + interpolate.pressure_time += entry->pressure_time; + break; + } + if (entry->sec == segment->t_start) { + interpolate.acc_pressure_time = 0; + interpolate.pressure_time = 0; + if (SENSOR_PRESSURE(entry)) + interpolate.start = SENSOR_PRESSURE(entry); + continue; + } + if (i < cur) { + if (SENSOR_PRESSURE(entry)) { + interpolate.start = SENSOR_PRESSURE(entry); + interpolate.acc_pressure_time = 0; + interpolate.pressure_time = 0; + } else { + interpolate.acc_pressure_time += entry->pressure_time; + interpolate.pressure_time += entry->pressure_time; + } + continue; + } + if (i == cur) { + interpolate.acc_pressure_time += entry->pressure_time; + interpolate.pressure_time += entry->pressure_time; + continue; + } + interpolate.pressure_time += entry->pressure_time; + if (SENSOR_PRESSURE(entry)) { + interpolate.end = SENSOR_PRESSURE(entry); + break; + } + } + return interpolate; +} + static void fill_missing_tank_pressures(struct dive *dive, struct plot_info *pi, pr_track_t **track_pr) { int cyl, i; @@ -526,9 +593,9 @@ static void fill_missing_tank_pressures(struct dive *dive, struct plot_info *pi, /* The first two are "fillers", but in case we don't have a sample * at time 0 we need to process the second of them here */ for (i = 1; i < pi->nr; i++) { - double magic, cur_pt; + double magic; pr_track_t *segment; - int pressure; + pr_interpolate_t interpolate; entry = pi->entry + i; cyl = entry->cylinderindex; @@ -549,14 +616,19 @@ static void fill_missing_tank_pressures(struct dive *dive, struct plot_info *pi, continue; } - /* Overall pressure change over total pressure-time for this segment*/ - magic = (segment->end - segment->start) / (double) segment->pressure_time; + interpolate = get_pr_interpolate_data(segment, pi, i); +#ifdef DEBUG_PR_INTERPOLATE + dump_pr_interpolate(i, interpolate); +#endif + /* if this segment has pressure time, calculate a new interpolated pressure */ + if (interpolate.pressure_time) { + /* Overall pressure change over total pressure-time for this segment*/ + magic = (interpolate.end - interpolate.start) / (double) interpolate.pressure_time; - /* Use that overall pressure change to update the current pressure */ - cur_pt = pressure_time(dive, &dive->dc, entry-1, entry); - pressure = cur_pr[cyl] + cur_pt * magic + 0.5; - INTERPOLATED_PRESSURE(entry) = pressure; - cur_pr[cyl] = pressure; + /* Use that overall pressure change to update the current pressure */ + cur_pr[cyl] = interpolate.start + magic * interpolate.acc_pressure_time + 0.5; + } + INTERPOLATED_PRESSURE(entry) = cur_pr[cyl]; } } @@ -906,7 +978,8 @@ static void populate_pressure_information(struct dive *dive, struct divecomputer /* discrete integration of pressure over time to get the SAC rate equivalent */ if (current) { - current->pressure_time += pressure_time(dive, dc, entry-1, entry); + entry->pressure_time = pressure_time(dive, dc, entry-1, entry); + current->pressure_time += entry->pressure_time; current->t_end = entry->sec; } |