/* * libdivecomputer * * Copyright (C) 2009 Jef Driesen * * This library is free software; you can redistribute it and/or * modify it under the terms of the GNU Lesser General Public * License as published by the Free Software Foundation; either * version 2.1 of the License, or (at your option) any later version. * * This library is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * Lesser General Public License for more details. * * You should have received a copy of the GNU Lesser General Public * License along with this library; if not, write to the Free Software * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, * MA 02110-1301 USA */ #include // memcpy, memcmp #include // malloc, free #include // assert #include "mares_puck.h" #include "mares_common.h" #include "context-private.h" #include "device-private.h" #include "checksum.h" #include "array.h" #define ISINSTANCE(device) dc_device_isinstance((device), &mares_puck_device_vtable) #define NEMOWIDE 1 #define NEMOAIR 4 #define PUCK 7 #define PUCKAIR 19 typedef struct mares_puck_device_t { mares_common_device_t base; const mares_common_layout_t *layout; unsigned char fingerprint[5]; } mares_puck_device_t; static dc_status_t mares_puck_device_set_fingerprint (dc_device_t *abstract, const unsigned char data[], unsigned int size); static dc_status_t mares_puck_device_dump (dc_device_t *abstract, dc_buffer_t *buffer); static dc_status_t mares_puck_device_foreach (dc_device_t *abstract, dc_dive_callback_t callback, void *userdata); static const dc_device_vtable_t mares_puck_device_vtable = { sizeof(mares_puck_device_t), DC_FAMILY_MARES_PUCK, mares_puck_device_set_fingerprint, /* set_fingerprint */ mares_common_device_read, /* read */ NULL, /* write */ mares_puck_device_dump, /* dump */ mares_puck_device_foreach, /* foreach */ NULL, /* timesync */ NULL /* close */ }; static const mares_common_layout_t mares_puck_layout = { 0x4000, /* memsize */ 0x0070, /* rb_profile_begin */ 0x4000, /* rb_profile_end */ 0x4000, /* rb_freedives_begin */ 0x4000 /* rb_freedives_end */ }; static const mares_common_layout_t mares_nemoair_layout = { 0x8000, /* memsize */ 0x0070, /* rb_profile_begin */ 0x8000, /* rb_profile_end */ 0x8000, /* rb_freedives_begin */ 0x8000 /* rb_freedives_end */ }; static const mares_common_layout_t mares_nemowide_layout = { 0x4000, /* memsize */ 0x0070, /* rb_profile_begin */ 0x3400, /* rb_profile_end */ 0x3400, /* rb_freedives_begin */ 0x4000 /* rb_freedives_end */ }; dc_status_t mares_puck_device_open (dc_device_t **out, dc_context_t *context, dc_iostream_t *iostream) { dc_status_t status = DC_STATUS_SUCCESS; mares_puck_device_t *device = NULL; if (out == NULL) return DC_STATUS_INVALIDARGS; // Allocate memory. device = (mares_puck_device_t *) dc_device_allocate (context, &mares_puck_device_vtable); if (device == NULL) { ERROR (context, "Failed to allocate memory."); return DC_STATUS_NOMEMORY; } // Initialize the base class. mares_common_device_init (&device->base, iostream); // Set the default values. device->layout = NULL; memset (device->fingerprint, 0, sizeof (device->fingerprint)); // Set the serial communication protocol (38400 8N1). status = dc_iostream_configure (device->base.iostream, 38400, 8, DC_PARITY_NONE, DC_STOPBITS_ONE, DC_FLOWCONTROL_NONE); if (status != DC_STATUS_SUCCESS) { ERROR (context, "Failed to set the terminal attributes."); goto error_free; } // Set the timeout for receiving data (1000 ms). status = dc_iostream_set_timeout (device->base.iostream, 1000); if (status != DC_STATUS_SUCCESS) { ERROR (context, "Failed to set the timeout."); goto error_free; } // Clear the DTR line. status = dc_iostream_set_dtr (device->base.iostream, 0); if (status != DC_STATUS_SUCCESS) { ERROR (context, "Failed to clear the DTR line."); goto error_free; } // Clear the RTS line. status = dc_iostream_set_rts (device->base.iostream, 0); if (status != DC_STATUS_SUCCESS) { ERROR (context, "Failed to clear the RTS line."); goto error_free; } // Make sure everything is in a sane state. dc_iostream_purge (device->base.iostream, DC_DIRECTION_ALL); // Identify the model number. unsigned char header[PACKETSIZE] = {0}; status = mares_common_device_read ((dc_device_t *) device, 0, header, sizeof (header)); if (status != DC_STATUS_SUCCESS) { goto error_free; } // Override the base class values. switch (header[1]) { case NEMOWIDE: device->layout = &mares_nemowide_layout; break; case NEMOAIR: case PUCKAIR: device->layout = &mares_nemoair_layout; break; case PUCK: device->layout = &mares_puck_layout; break; default: // Unknown, try puck device->layout = &mares_puck_layout; break; } *out = (dc_device_t*) device; return DC_STATUS_SUCCESS; error_free: dc_device_deallocate ((dc_device_t *) device); return status; } static dc_status_t mares_puck_device_set_fingerprint (dc_device_t *abstract, const unsigned char data[], unsigned int size) { mares_puck_device_t *device = (mares_puck_device_t *) abstract; if (size && size != sizeof (device->fingerprint)) return DC_STATUS_INVALIDARGS; if (size) memcpy (device->fingerprint, data, sizeof (device->fingerprint)); else memset (device->fingerprint, 0, sizeof (device->fingerprint)); return DC_STATUS_SUCCESS; } static dc_status_t mares_puck_device_dump (dc_device_t *abstract, dc_buffer_t *buffer) { dc_status_t status = DC_STATUS_SUCCESS; mares_puck_device_t *device = (mares_puck_device_t *) abstract; assert (device->layout != NULL); // Allocate the required amount of memory. if (!dc_buffer_resize (buffer, device->layout->memsize)) { ERROR (abstract->context, "Insufficient buffer space available."); return DC_STATUS_NOMEMORY; } // Download the memory dump. status = device_dump_read (abstract, 0, dc_buffer_get_data (buffer), dc_buffer_get_size (buffer), PACKETSIZE); if (status != DC_STATUS_SUCCESS) { return status; } // Emit a device info event. unsigned char *data = dc_buffer_get_data (buffer); dc_event_devinfo_t devinfo; devinfo.model = data[1]; devinfo.firmware = 0; devinfo.serial = array_uint16_be (data + 8); device_event_emit (abstract, DC_EVENT_DEVINFO, &devinfo); return status; } static dc_status_t mares_puck_device_foreach (dc_device_t *abstract, dc_dive_callback_t callback, void *userdata) { mares_puck_device_t *device = (mares_puck_device_t *) abstract; assert (device->layout != NULL); dc_buffer_t *buffer = dc_buffer_new (device->layout->memsize); if (buffer == NULL) return DC_STATUS_NOMEMORY; dc_status_t rc = mares_puck_device_dump (abstract, buffer); if (rc != DC_STATUS_SUCCESS) { dc_buffer_free (buffer); return rc; } rc = mares_common_extract_dives (abstract->context, device->layout, device->fingerprint, dc_buffer_get_data (buffer), callback, userdata); dc_buffer_free (buffer); return rc; }