X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=libdivecomputer.c;h=ab75a89e72245ed48248c34fddf267bbfae635da;hb=d5b7f7dc06827cab8dd57d6d373a08d6be111c79;hp=c9255e0242324bc3a4cd4f3ed417b0a554775e3e;hpb=a9f74044ae228f912515bebc983f872aa7f37695;p=ext%2Fsubsurface.git diff --git a/libdivecomputer.c b/libdivecomputer.c index c9255e0..ab75a89 100644 --- a/libdivecomputer.c +++ b/libdivecomputer.c @@ -17,6 +17,266 @@ #include #include +static void error(const char *fmt, ...) +{ + va_list args; + GError *error; + + va_start(args, fmt); + error = g_error_new_valist( + g_quark_from_string("divelog"), + DIVE_ERROR_PARSE, fmt, args); + va_end(args); + report_error(error); + g_error_free(error); +} + +typedef struct device_data_t { + device_type_t type; + const char *name; + device_devinfo_t devinfo; + device_clock_t clock; +} device_data_t; + +static parser_status_t create_parser(device_data_t *devdata, parser_t **parser) +{ + switch (devdata->type) { + case DEVICE_TYPE_SUUNTO_SOLUTION: + return suunto_solution_parser_create(parser); + + case DEVICE_TYPE_SUUNTO_EON: + return suunto_eon_parser_create(parser, 0); + + case DEVICE_TYPE_SUUNTO_VYPER: + if (devdata->devinfo.model == 0x01) + return suunto_eon_parser_create(parser, 1); + return suunto_vyper_parser_create(parser); + + case DEVICE_TYPE_SUUNTO_VYPER2: + case DEVICE_TYPE_SUUNTO_D9: + return suunto_d9_parser_create(parser, devdata->devinfo.model); + + case DEVICE_TYPE_UWATEC_ALADIN: + case DEVICE_TYPE_UWATEC_MEMOMOUSE: + return uwatec_memomouse_parser_create(parser, devdata->clock.devtime, devdata->clock.systime); + + case DEVICE_TYPE_UWATEC_SMART: + return uwatec_smart_parser_create(parser, devdata->devinfo.model, devdata->clock.devtime, devdata->clock.systime); + + case DEVICE_TYPE_REEFNET_SENSUS: + return reefnet_sensus_parser_create(parser, devdata->clock.devtime, devdata->clock.systime); + + case DEVICE_TYPE_REEFNET_SENSUSPRO: + return reefnet_sensuspro_parser_create(parser, devdata->clock.devtime, devdata->clock.systime); + + case DEVICE_TYPE_REEFNET_SENSUSULTRA: + return reefnet_sensusultra_parser_create(parser, devdata->clock.devtime, devdata->clock.systime); + + case DEVICE_TYPE_OCEANIC_VTPRO: + return oceanic_vtpro_parser_create(parser); + + case DEVICE_TYPE_OCEANIC_VEO250: + return oceanic_veo250_parser_create(parser, devdata->devinfo.model); + + case DEVICE_TYPE_OCEANIC_ATOM2: + return oceanic_atom2_parser_create(parser, devdata->devinfo.model); + + case DEVICE_TYPE_MARES_NEMO: + case DEVICE_TYPE_MARES_PUCK: + return mares_nemo_parser_create(parser, devdata->devinfo.model); + + case DEVICE_TYPE_MARES_ICONHD: + return mares_iconhd_parser_create(parser); + + case DEVICE_TYPE_HW_OSTC: + return hw_ostc_parser_create(parser); + + case DEVICE_TYPE_CRESSI_EDY: + case DEVICE_TYPE_ZEAGLE_N2ITION3: + return cressi_edy_parser_create(parser, devdata->devinfo.model); + + case DEVICE_TYPE_ATOMICS_COBALT: + return atomics_cobalt_parser_create(parser); + + default: + return PARSER_STATUS_ERROR; + } +} + +static int parse_gasmixes(parser_t *parser, int ngases) +{ + int i; + + for (i = 0; i < ngases; i++) { + int rc; + gasmix_t gasmix = {0}; + + rc = parser_get_field(parser, FIELD_TYPE_GASMIX, i, &gasmix); + if (rc != PARSER_STATUS_SUCCESS && rc != PARSER_STATUS_UNSUPPORTED) + return rc; + + printf("\n" + " %.1f\n" + " %.1f\n" + " %.1f\n" + "\n", + gasmix.helium * 100.0, + gasmix.oxygen * 100.0, + gasmix.nitrogen * 100.0); + } + return PARSER_STATUS_SUCCESS; +} + +void +sample_cb (parser_sample_type_t type, parser_sample_value_t value, void *userdata) +{ + int i; + static const char *events[] = { + "none", "deco", "rbt", "ascent", "ceiling", "workload", "transmitter", + "violation", "bookmark", "surface", "safety stop", "gaschange", + "safety stop (voluntary)", "safety stop (mandatory)", "deepstop", + "ceiling (safety stop)", "unknown", "divetime", "maxdepth", + "OLF", "PO2", "airtime", "rgbm", "heading", "tissue level warning"}; + + switch (type) { + case SAMPLE_TYPE_TIME: + printf("\n"); + printf(" \n", value.time / 60, value.time % 60); + break; + case SAMPLE_TYPE_DEPTH: + printf(" %.2f\n", value.depth); + break; + case SAMPLE_TYPE_PRESSURE: + printf(" %.2f\n", value.pressure.tank, value.pressure.value); + break; + case SAMPLE_TYPE_TEMPERATURE: + printf(" %.2f\n", value.temperature); + break; + case SAMPLE_TYPE_EVENT: + printf(" %s\n", + value.event.type, value.event.time, value.event.flags, value.event.value, events[value.event.type]); + break; + case SAMPLE_TYPE_RBT: + printf(" %u\n", value.rbt); + break; + case SAMPLE_TYPE_HEARTBEAT: + printf(" %u\n", value.heartbeat); + break; + case SAMPLE_TYPE_BEARING: + printf(" %u\n", value.bearing); + break; + case SAMPLE_TYPE_VENDOR: + printf(" ", value.vendor.type, value.vendor.size); + for (i = 0; i < value.vendor.size; ++i) + printf("%02X", ((unsigned char *) value.vendor.data)[i]); + printf("\n"); + break; + default: + break; + } +} + + +static int parse_samples(parser_t *parser) +{ + // Parse the sample data. + printf("Parsing the sample data.\n"); + return parser_samples_foreach(parser, sample_cb, NULL); +} + +static int dive_cb(const unsigned char *data, unsigned int size, + const unsigned char *fingerprint, unsigned int fsize, + void *userdata) +{ + int rc; + parser_t *parser = NULL; + device_data_t *devdata = userdata; + dc_datetime_t dt = {0}; + + rc = create_parser(devdata, &parser); + if (rc != PARSER_STATUS_SUCCESS) { + error("Unable to create parser for %s", devdata->name); + return rc; + } + + rc = parser_set_data(parser, data, size); + if (rc != PARSER_STATUS_SUCCESS) { + error("Error registering the data."); + parser_destroy(parser); + return rc; + } + + rc = parser_get_datetime(parser, &dt); + if (rc != PARSER_STATUS_SUCCESS && rc != PARSER_STATUS_UNSUPPORTED) { + error("Error parsing the datetime."); + parser_destroy (parser); + return rc; + } + + printf("%04i-%02i-%02i %02i:%02i:%02i\n", + dt.year, dt.month, dt.day, + dt.hour, dt.minute, dt.second); + + // Parse the divetime. + printf("Parsing the divetime.\n"); + unsigned int divetime = 0; + rc = parser_get_field (parser, FIELD_TYPE_DIVETIME, 0, &divetime); + if (rc != PARSER_STATUS_SUCCESS && rc != PARSER_STATUS_UNSUPPORTED) { + error("Error parsing the divetime."); + parser_destroy(parser); + return rc; + } + + printf("%02u:%02u\n", + divetime / 60, divetime % 60); + + // Parse the maxdepth. + printf("Parsing the maxdepth.\n"); + double maxdepth = 0.0; + rc = parser_get_field(parser, FIELD_TYPE_MAXDEPTH, 0, &maxdepth); + if (rc != PARSER_STATUS_SUCCESS && rc != PARSER_STATUS_UNSUPPORTED) { + error("Error parsing the maxdepth."); + parser_destroy(parser); + return rc; + } + + printf("%.2f\n", maxdepth); + + // Parse the gas mixes. + printf("Parsing the gas mixes.\n"); + unsigned int ngases = 0; + rc = parser_get_field(parser, FIELD_TYPE_GASMIX_COUNT, 0, &ngases); + if (rc != PARSER_STATUS_SUCCESS && rc != PARSER_STATUS_UNSUPPORTED) { + error("Error parsing the gas mix count."); + parser_destroy(parser); + return rc; + } + + rc = parse_gasmixes(parser, ngases); + if (rc != PARSER_STATUS_SUCCESS) { + error("Error parsing the gas mix."); + parser_destroy(parser); + return rc; + } + + // Initialize the sample data. + rc = parse_samples(parser); + if (rc != PARSER_STATUS_SUCCESS) { + error("Error parsing the samples."); + parser_destroy(parser); + return rc; + } + + parser_destroy(parser); + return 1; +} + + +static device_status_t import_device_data(device_t *device, device_data_t *devicedata) +{ + return device_foreach(device, dive_cb, devicedata); +} + static device_status_t device_open(const char *devname, device_type_t type, device_t **device) @@ -90,23 +350,38 @@ static device_status_t device_open(const char *devname, } } -static void error(const char *fmt, ...) -{ - va_list args; - GError *error; - - va_start(args, fmt); - error = g_error_new_valist( - g_quark_from_string("divelog"), - DIVE_ERROR_PARSE, fmt, args); - va_end(args); - report_error(error); - g_error_free(error); -} - static void event_cb (device_t *device, device_event_t event, const void *data, void *userdata) { + const device_progress_t *progress = (device_progress_t *) data; + const device_devinfo_t *devinfo = (device_devinfo_t *) data; + const device_clock_t *clock = (device_clock_t *) data; + device_data_t *devdata = (device_data_t *) userdata; + + switch (event) { + case DEVICE_EVENT_WAITING: + printf("Event: waiting for user action\n"); + break; + case DEVICE_EVENT_PROGRESS: + printf("Event: progress %3.2f%% (%u/%u)\n", + 100.0 * (double) progress->current / (double) progress->maximum, + progress->current, progress->maximum); + break; + case DEVICE_EVENT_DEVINFO: + devdata->devinfo = *devinfo; + printf("Event: model=%u (0x%08x), firmware=%u (0x%08x), serial=%u (0x%08x)\n", + devinfo->model, devinfo->model, + devinfo->firmware, devinfo->firmware, + devinfo->serial, devinfo->serial); + break; + case DEVICE_EVENT_CLOCK: + devdata->clock = *clock; + printf("Event: systime=%lld, devtime=%u\n", + clock->systime, clock->devtime); + break; + default: + break; + } } static int @@ -121,6 +396,10 @@ static void do_import(const char *computer, device_type_t type) const char *devname = "/dev/ttyUSB0"; device_t *device = NULL; device_status_t rc; + device_data_t devicedata = { + .type = type, + .name = computer, + }; rc = device_open(devname, type, &device); if (rc != DEVICE_STATUS_SUCCESS) { @@ -130,7 +409,7 @@ static void do_import(const char *computer, device_type_t type) // Register the event handler. int events = DEVICE_EVENT_WAITING | DEVICE_EVENT_PROGRESS | DEVICE_EVENT_DEVINFO | DEVICE_EVENT_CLOCK; - rc = device_set_events(device, events, event_cb, NULL); + rc = device_set_events(device, events, event_cb, &devicedata); if (rc != DEVICE_STATUS_SUCCESS) { error("Error registering the event handler."); device_close(device); @@ -138,14 +417,21 @@ static void do_import(const char *computer, device_type_t type) } // Register the cancellation handler. - rc = device_set_cancel(device, cancel_cb, NULL); + rc = device_set_cancel(device, cancel_cb, &devicedata); if (rc != DEVICE_STATUS_SUCCESS) { error("Error registering the cancellation handler."); device_close(device); return; } - error("No actual code yet for importing (%s: %s)", computer, devname); + rc = import_device_data(device, &devicedata); + if (rc != DEVICE_STATUS_SUCCESS) { + error("Dive data import error"); + device_close(device); + return; + } + + device_close(device); } /*