84563c6303
The low level serial and IrDA functions are modified to: - Use the libdivecomputer namespace prefix. - Return a more detailed status code instead of the zero on success and negative on error return value. This will allow to return more fine-grained error codes. - The read and write functions have an additional output parameter to return the actual number of bytes transferred. Since these functions are not atomic, some data might still be transferred successfully if an error occurs. The dive computer backends are updated to use the new api.
308 lines
8.5 KiB
C
308 lines
8.5 KiB
C
/*
|
|
* 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 <string.h> // memcpy, memcmp
|
|
#include <stdlib.h> // malloc, free
|
|
#include <assert.h> // assert
|
|
|
|
#include <libdivecomputer/mares_puck.h>
|
|
|
|
#include "context-private.h"
|
|
#include "device-private.h"
|
|
#include "mares_common.h"
|
|
#include "serial.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 dc_status_t mares_puck_device_close (dc_device_t *abstract);
|
|
|
|
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 */
|
|
mares_puck_device_close /* 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, const char *name)
|
|
{
|
|
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);
|
|
|
|
// Set the default values.
|
|
device->layout = NULL;
|
|
memset (device->fingerprint, 0, sizeof (device->fingerprint));
|
|
|
|
// Open the device.
|
|
status = dc_serial_open (&device->base.port, context, name);
|
|
if (status != DC_STATUS_SUCCESS) {
|
|
ERROR (context, "Failed to open the serial port.");
|
|
goto error_free;
|
|
}
|
|
|
|
// Set the serial communication protocol (38400 8N1).
|
|
status = dc_serial_configure (device->base.port, 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_close;
|
|
}
|
|
|
|
// Set the timeout for receiving data (1000 ms).
|
|
status = dc_serial_set_timeout (device->base.port, 1000);
|
|
if (status != DC_STATUS_SUCCESS) {
|
|
ERROR (context, "Failed to set the timeout.");
|
|
goto error_close;
|
|
}
|
|
|
|
// Clear the DTR line.
|
|
status = dc_serial_set_dtr (device->base.port, 0);
|
|
if (status != DC_STATUS_SUCCESS) {
|
|
ERROR (context, "Failed to clear the DTR line.");
|
|
goto error_close;
|
|
}
|
|
|
|
// Clear the RTS line.
|
|
status = dc_serial_set_rts (device->base.port, 0);
|
|
if (status != DC_STATUS_SUCCESS) {
|
|
ERROR (context, "Failed to clear the RTS line.");
|
|
goto error_close;
|
|
}
|
|
|
|
// Make sure everything is in a sane state.
|
|
dc_serial_purge (device->base.port, 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_close;
|
|
}
|
|
|
|
// 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_close:
|
|
dc_serial_close (device->base.port);
|
|
error_free:
|
|
dc_device_deallocate ((dc_device_t *) device);
|
|
return status;
|
|
}
|
|
|
|
|
|
static dc_status_t
|
|
mares_puck_device_close (dc_device_t *abstract)
|
|
{
|
|
dc_status_t status = DC_STATUS_SUCCESS;
|
|
mares_puck_device_t *device = (mares_puck_device_t*) abstract;
|
|
dc_status_t rc = DC_STATUS_SUCCESS;
|
|
|
|
// Close the device.
|
|
rc = dc_serial_close (device->base.port);
|
|
if (rc != DC_STATUS_SUCCESS) {
|
|
dc_status_set_error(&status, rc);
|
|
}
|
|
|
|
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)
|
|
{
|
|
mares_puck_device_t *device = (mares_puck_device_t *) abstract;
|
|
|
|
assert (device->layout != NULL);
|
|
|
|
// Erase the current contents of the buffer and
|
|
// allocate the required amount of memory.
|
|
if (!dc_buffer_clear (buffer) || !dc_buffer_resize (buffer, device->layout->memsize)) {
|
|
ERROR (abstract->context, "Insufficient buffer space available.");
|
|
return DC_STATUS_NOMEMORY;
|
|
}
|
|
|
|
return device_dump_read (abstract, dc_buffer_get_data (buffer),
|
|
dc_buffer_get_size (buffer), PACKETSIZE);
|
|
}
|
|
|
|
|
|
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;
|
|
}
|
|
|
|
// 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);
|
|
|
|
rc = mares_common_extract_dives (abstract->context, device->layout, device->fingerprint, data, callback, userdata);
|
|
|
|
dc_buffer_free (buffer);
|
|
|
|
return rc;
|
|
}
|
|
|
|
|
|
dc_status_t
|
|
mares_puck_extract_dives (dc_device_t *abstract, const unsigned char data[], unsigned int size, dc_dive_callback_t callback, void *userdata)
|
|
{
|
|
mares_puck_device_t *device = (mares_puck_device_t*) abstract;
|
|
|
|
if (abstract && !ISINSTANCE (abstract))
|
|
return DC_STATUS_INVALIDARGS;
|
|
|
|
if (size < PACKETSIZE)
|
|
return DC_STATUS_DATAFORMAT;
|
|
|
|
dc_context_t *context = (abstract ? abstract->context : NULL);
|
|
unsigned char *fingerprint = (device ? device->fingerprint : NULL);
|
|
|
|
const mares_common_layout_t *layout = NULL;
|
|
switch (data[1]) {
|
|
case NEMOWIDE:
|
|
layout = &mares_nemowide_layout;
|
|
break;
|
|
case NEMOAIR:
|
|
case PUCKAIR:
|
|
layout = &mares_nemoair_layout;
|
|
break;
|
|
case PUCK:
|
|
layout = &mares_puck_layout;
|
|
break;
|
|
default: // Unknown, try puck
|
|
layout = &mares_puck_layout;
|
|
break;
|
|
}
|
|
|
|
if (size < layout->memsize)
|
|
return DC_STATUS_DATAFORMAT;
|
|
|
|
return mares_common_extract_dives (context, layout, fingerprint, data, callback, userdata);
|
|
}
|