X-Git-Url: http://git.tdb.fi/?p=ext%2Fsubsurface.git;a=blobdiff_plain;f=uemis.c;h=06ef5b4231c6f85e6474d182b04a5cf7911d8f2b;hp=7f431cba6b82e2599e5abb21a010a3082ca28237;hb=HEAD;hpb=9ddef6854e8f54cd8d1431c15ba37c2c18d32ca7 diff --git a/uemis.c b/uemis.c index 7f431cb..06ef5b4 100644 --- a/uemis.c +++ b/uemis.c @@ -14,12 +14,8 @@ #include #define __USE_XOPEN #include -#include - -#include #include "dive.h" -#include "display.h" #include "uemis.h" /* @@ -76,65 +72,25 @@ static void decode( uint8_t *inbuf, uint8_t *outbuf, int inbuf_len ) { } /* end code from Bob Trower */ -/* small helper functions */ -/* simpleregex allocates (and reallocates) the found buffer - * don't forget to free it when you are done - */ -static int simpleregex(char *buffer, char *regex, char **found) { - int status; - regex_t re; - regmatch_t match[5]; - - if (regcomp(&re, regex, 0) !=0) { - fprintf(stderr,"internal error, regex failed!\n"); - exit(1); - } - status = regexec(&re,buffer,5,match,0); - if(status == 0) { - *found = realloc(*found,match[1].rm_eo-match[1].rm_so + 1); - strncpy(*found,buffer+match[1].rm_so,match[1].rm_eo-match[1].rm_so); - (*found)[match[1].rm_eo-match[1].rm_so] = '\0'; - } - return(status == 0); -} - -/* read in line of arbitrary length (important for SDA files that can - * have lines that are tens of kB long - * don't forget to free it when you are done +/* + * pressure_to_depth: In centibar. And when converting to + * depth, I'm just going to always use saltwater, because I + * think "true depth" is just stupid. From a diving standpoint, + * "true depth" is pretty much completely pointless, unless + * you're doing some kind of underwater surveying work. + * + * So I give water depths in "pressure depth", always assuming + * salt water. So one atmosphere per 10m. */ -#define MYGETL_INCR 1024 -static char * mygetline(FILE * f) { - size_t size = 0; - size_t len = 0; - char * buf = NULL; - - do { - size += MYGETL_INCR; - if ((buf = realloc(buf,size)) == NULL) - break; - fgets(buf+len,MYGETL_INCR,f); - len = strlen(buf); - } while (!feof(f) && buf[len-1]!='\n'); - return buf; -} +static int pressure_to_depth(uint16_t value) +{ + double atm, cm; -/* text matching, used to build very poor man's XML parser */ -int matchit(FILE *infd, char *regex, char *typeregex, char **found) { - char *buffer; - - while (!feof(infd)) { - buffer = mygetline(infd); - if (buffer && simpleregex(buffer,regex,found)) { - buffer = mygetline(infd); - if (buffer && simpleregex(buffer,typeregex,found)) { - return 1; - } - } - } - return 0; + atm = bar_to_atm(value / 100.0); + cm = 100 * atm + 0.5; + return (cm > 0) ? 10 * (long)cm : 0; } - /* * convert the base64 data blog */ @@ -162,114 +118,123 @@ bail: return datalen; } +/* Create events from the flag bits; + * These bits basically represent what is displayed on screen at sample time. + * Many of these 'warnings' are way hyper-active and seriously clutter the + * profile plot - so these are disabled by default + */ +void uemis_event(struct dive *dive, struct sample *sample, uemis_sample_t *u_sample) +{ + uint8_t *flags = u_sample->flags; + + if (flags[1] & 0x01) + add_event(dive, sample->time.seconds, 0, 0, 0, "Safety Stop Violation"); + if (flags[1] & 0x08) + add_event(dive, sample->time.seconds, 0, 0, 0, "Speed Alarm"); +#if WANT_CRAZY_WARNINGS + if (flags[1] & 0x06) /* both bits 1 and 2 are a warning */ + add_event(dive, sample->time.seconds, 0, 0, 0, "Speed Warning"); + if (flags[1] & 0x10) + add_event(dive, sample->time.seconds, 0, 0, 0, "PO2 Green Warning"); +#endif + if (flags[1] & 0x20) + add_event(dive, sample->time.seconds, 0, 0, 0, "PO2 Ascend Warning"); + if (flags[1] & 0x40) + add_event(dive, sample->time.seconds, 0, 0, 0, "PO2 Ascend Alarm"); + /* flags[2] reflects the deco / time bar + * flags[3] reflects more display details on deco and pO2 */ + if (flags[4] & 0x01) + add_event(dive, sample->time.seconds, 0, 0, 0, "Tank Pressure Info"); + if (flags[4] & 0x04) + add_event(dive, sample->time.seconds, 0, 0, 0, "RGT Warning"); + if (flags[4] & 0x08) + add_event(dive, sample->time.seconds, 0, 0, 0, "RGT Alert"); + if (flags[4] & 0x40) + add_event(dive, sample->time.seconds, 0, 0, 0, "Tank Change Suggested"); + if (flags[4] & 0x80) + add_event(dive, sample->time.seconds, 0, 0, 0, "Depth Limit Exceeded"); + if (flags[5] & 0x01) + add_event(dive, sample->time.seconds, 0, 0, 0, "Max Deco Time Warning"); + if (flags[5] & 0x04) + add_event(dive, sample->time.seconds, 0, 0, 0, "Dive Time Info"); + if (flags[5] & 0x08) + add_event(dive, sample->time.seconds, 0, 0, 0, "Dive Time Alert"); + if (flags[5] & 0x10) + add_event(dive, sample->time.seconds, 0, 0, 0, "Marker"); + if (flags[6] & 0x02) + add_event(dive, sample->time.seconds, 0, 0, 0, "No Tank Data"); + if (flags[6] & 0x04) + add_event(dive, sample->time.seconds, 0, 0, 0, "Low Battery Warning"); + if (flags[6] & 0x08) + add_event(dive, sample->time.seconds, 0, 0, 0, "Low Battery Alert"); + /* flags[7] reflects the little on screen icons that remind of previous + * warnings / alerts - not useful for events */ +} + /* * parse uemis base64 data blob into struct dive */ -static void parse_divelog_binary(char *base64, struct dive **divep) { +void uemis_parse_divelog_binary(char *base64, void *datap) { int datalen; int i; uint8_t *data; struct sample *sample; + uemis_sample_t *u_sample; + struct dive **divep = datap; + struct dive *dive = *divep; + int template, gasoffset; datalen = uemis_convert_base64(base64, &data); + /* dive template in use: + 0 = air + 1 = nitrox (B) + 2 = nitrox (B+D) + 3 = nitrox (B+T+D) + uemis cylinder data is insane - it stores seven tank settings in a block + and the template tells us which of the four groups of tanks we need to look at + */ + gasoffset = template = *(uint8_t *)(data+115); + if (template == 3) + gasoffset = 4; + if (template == 0) + template = 1; + for (i = 0; i < template; i++) { + float volume = *(float *)(data+116+25*(gasoffset + i)) * 1000.0; + /* uemis always assumes a working pressure of 202.6bar (!?!?) - I first thought + * it was 3000psi, but testing against all my dives gets me that strange number. + * Still, that's of course completely bogus and shows they don't get how + * cylinders are named in non-metric parts of the world... + * we store the incorrect working pressure to get the SAC calculations "close" + * but the user will have to correct this manually + */ + dive->cylinder[i].type.size.mliter = volume; + dive->cylinder[i].type.workingpressure.mbar = 202600; + dive->cylinder[i].gasmix.o2.permille = *(uint8_t *)(data+120+25*(gasoffset + i)) * 10 + 0.5; + dive->cylinder[i].gasmix.he.permille = 0; + } /* first byte of divelog data is at offset 0x123 */ i = 0x123; - while ((i < datalen) && (*(uint16_t *)(data+i))) { + u_sample = (uemis_sample_t *)(data + i); + while ((i < datalen) && (u_sample->dive_time)) { /* it seems that a dive_time of 0 indicates the end of the valid readings */ + /* the SDA usually records more samples after the end of the dive -- + * we want to discard those, but not cut the dive short; sadly the dive + * duration in the header is a) in minutes and b) up to 3 minutes short */ + if (u_sample->dive_time > dive->duration.seconds + 180) + break; sample = prepare_sample(divep); - sample->time.seconds = *(uint16_t *)(data+i); - sample->depth.mm = (*(uint16_t *)(data+i+2) - 100) / 0.101428571 + 0.5; - sample->temperature.mkelvin = (*(uint16_t *)(data+i+4) * 100) + 273150; - sample->cylinderpressure.mbar= *(uint16_t *)(data+i+23) * 10; - sample->cylinderindex = *(uint8_t *)(data+i+22); - finish_sample(*divep, sample); + dive = *divep; /* prepare_sample might realloc the dive */ + sample->time.seconds = u_sample->dive_time; + sample->depth.mm = pressure_to_depth(u_sample->water_pressure); + sample->temperature.mkelvin = (u_sample->dive_temperature * 100) + 273150; + sample->cylinderindex = u_sample->active_tank; + sample->cylinderpressure.mbar= u_sample->tank_pressure * 10; + uemis_event(dive, sample, u_sample); + finish_sample(dive); i += 0x25; + u_sample++; } + dive->duration.seconds = sample->time.seconds - 1; return; } - -void -parse_uemis_file(char *divelogfilename,GError **error) { - char *found=NULL; - struct tm tm; - struct dive *dive; - - FILE *divelogfile = fopen(divelogfilename,"r"); - - dive = alloc_dive(); - - if (! matchit(divelogfile,"val key=\"date\"","\\([^<]*\\)",&found)) { - /* some error handling */ - goto bail; - } - strptime(found, "%Y-%m-%dT%H:%M:%S", &tm); - dive->when = utc_mktime(&tm); - if (! matchit(divelogfile,"", - "\\([0-9.]*\\)", &found)) { - /* some error handling */ - goto bail; - } - dive->duration.seconds = 60.0 * atof(found); - - if (! matchit(divelogfile,"", - "\\([0-9.]*\\)", &found)) { - /* some error handling */ - goto bail; - } - dive->maxdepth.mm = atof(found) / 0.10143 + 0.5; - - if (! matchit(divelogfile,"", - ">\\([a-zA-Z0-9+/]*\\)<", &found)) { - /* some error handling */ - goto bail; - } - parse_divelog_binary(found,&dive); - record_dive(dive); -bail: - if (found) - free(found); -} - -/* - * parse the two files extracted from the SDA - */ -void -uemis_import() { - GtkWidget *dialog; - GtkFileFilter *filter = gtk_file_filter_new (); - gtk_file_filter_add_pattern (filter, "*.SDA"); - gtk_file_filter_set_name(filter, "uemis Zurich SDA files"); - dialog = gtk_file_chooser_dialog_new("Open File", - GTK_WINDOW(main_window), - GTK_FILE_CHOOSER_ACTION_OPEN, - GTK_STOCK_CANCEL, GTK_RESPONSE_CANCEL, - GTK_STOCK_OPEN, GTK_RESPONSE_ACCEPT, - NULL); - gtk_file_chooser_set_select_multiple(GTK_FILE_CHOOSER(dialog), TRUE); - gtk_file_chooser_add_filter(GTK_FILE_CHOOSER(dialog),filter); - - if (gtk_dialog_run(GTK_DIALOG(dialog)) == GTK_RESPONSE_ACCEPT) { - GSList *filenames; - char *filename; - filenames = gtk_file_chooser_get_filenames(GTK_FILE_CHOOSER(dialog)); - - GError *error = NULL; - while(filenames != NULL) { - filename = (char *)filenames->data; - parse_uemis_file(filename, &error); - if (error != NULL) - { - report_error(error); - g_error_free(error); - error = NULL; - } - - g_free(filename); - filenames = g_slist_next(filenames); - } - g_slist_free(filenames); - report_dives(); - } - gtk_widget_destroy(dialog); -}