diff --git a/examples/Makefile.am b/examples/Makefile.am index b2c7d0e..794bb34 100644 --- a/examples/Makefile.am +++ b/examples/Makefile.am @@ -10,7 +10,8 @@ bin_PROGRAMS = \ sensusultra \ aladin \ memomouse \ - atom2 + atom2 \ + veo250 if IRDA bin_PROGRAMS += smart @@ -34,6 +35,8 @@ memomouse_SOURCES = uwatec_memomouse_test.c atom2_SOURCES = oceanic_atom2_test.c +veo250_SOURCES = oceanic_veo250_test.c + if IRDA smart_SOURCES = uwatec_smart_test.c endif diff --git a/examples/oceanic_veo250_test.c b/examples/oceanic_veo250_test.c new file mode 100644 index 0000000..898d00c --- /dev/null +++ b/examples/oceanic_veo250_test.c @@ -0,0 +1,130 @@ +/* + * libdivecomputer + * + * Copyright (C) 2008 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 // fopen, fwrite, fclose + +#include "oceanic_veo250.h" +#include "utils.h" + +#define WARNING(expr) \ +{ \ + message ("%s:%d: %s\n", __FILE__, __LINE__, expr); \ +} + +device_status_t +test_dump_memory (const char* name, const char* filename) +{ + unsigned char data[OCEANIC_VEO250_MEMORY_SIZE] = {0}; + device_t *device = NULL; + + message ("oceanic_veo250_device_open\n"); + device_status_t rc = oceanic_veo250_device_open (&device, name); + if (rc != DEVICE_STATUS_SUCCESS) { + WARNING ("Error opening serial port."); + return rc; + } + + message ("device_version\n"); + unsigned char version[OCEANIC_VEO250_PACKET_SIZE] = {0}; + rc = device_version (device, version, sizeof (version)); + if (rc != DEVICE_STATUS_SUCCESS) { + WARNING ("Cannot identify computer."); + device_close (device); + return rc; + } + + message ("device_read\n"); + rc = device_read (device, 0x00, data, sizeof (data)); + if (rc != DEVICE_STATUS_SUCCESS) { + WARNING ("Cannot read memory."); + device_close (device); + return rc; + } + + message ("Dumping data\n"); + FILE* fp = fopen (filename, "wb"); + if (fp != NULL) { + fwrite (data, sizeof (unsigned char), sizeof (data), fp); + fclose (fp); + } + + message ("device_close\n"); + rc = device_close (device); + if (rc != DEVICE_STATUS_SUCCESS) { + WARNING ("Cannot close device."); + return rc; + } + + return DEVICE_STATUS_SUCCESS; +} + + +const char* +errmsg (device_status_t rc) +{ + switch (rc) { + case DEVICE_STATUS_SUCCESS: + return "Success"; + case DEVICE_STATUS_UNSUPPORTED: + return "Unsupported operation"; + case DEVICE_STATUS_TYPE_MISMATCH: + return "Device type mismatch"; + case DEVICE_STATUS_ERROR: + return "Generic error"; + case DEVICE_STATUS_IO: + return "Input/output error"; + case DEVICE_STATUS_MEMORY: + return "Memory error"; + case DEVICE_STATUS_PROTOCOL: + return "Protocol error"; + case DEVICE_STATUS_TIMEOUT: + return "Timeout"; + default: + return "Unknown error"; + } +} + +int main(int argc, char *argv[]) +{ + message_set_logfile ("VEO250.LOG"); + +#ifdef _WIN32 + const char* name = "COM1"; +#else + const char* name = "/dev/ttyS0"; +#endif + + if (argc > 1) { + name = argv[1]; + } + + message ("DEVICE=%s\n", name); + + device_status_t a = test_dump_memory (name, "VEO250.DMP"); + + message ("\nSUMMARY\n"); + message ("-------\n"); + message ("test_dump_memory: %s\n", errmsg (a)); + + message_set_logfile (NULL); + + return 0; +} diff --git a/src/Makefile.am b/src/Makefile.am index 05e1cf9..56144a4 100644 --- a/src/Makefile.am +++ b/src/Makefile.am @@ -21,7 +21,8 @@ libdivecomputer_HEADERS = \ uwatec_memomouse.h \ uwatec_smart.h \ oceanic.h \ - oceanic_atom2.h + oceanic_atom2.h \ + oceanic_veo250.h # # Source files. @@ -50,6 +51,7 @@ libdivecomputer_la_SOURCES = \ uwatec_memomouse.h uwatec_memomouse.c uwatec_memomouse_parser.c \ oceanic.h \ oceanic_atom2.h oceanic_atom2.c \ + oceanic_veo250.h oceanic_veo250.c \ ringbuffer.h ringbuffer.c \ checksum.h checksum.c \ array.h array.c \ diff --git a/src/device.h b/src/device.h index 8737595..16a1121 100644 --- a/src/device.h +++ b/src/device.h @@ -37,7 +37,8 @@ typedef enum device_type_t { DEVICE_TYPE_UWATEC_ALADIN, DEVICE_TYPE_UWATEC_MEMOMOUSE, DEVICE_TYPE_UWATEC_SMART, - DEVICE_TYPE_OCEANIC_ATOM2 + DEVICE_TYPE_OCEANIC_ATOM2, + DEVICE_TYPE_OCEANIC_VEO250 } device_type_t; typedef enum device_status_t { diff --git a/src/libdivecomputer.symbols b/src/libdivecomputer.symbols index 2468d32..9026f34 100644 --- a/src/libdivecomputer.symbols +++ b/src/libdivecomputer.symbols @@ -30,6 +30,7 @@ message_set_logfile oceanic_atom2_device_handshake oceanic_atom2_device_open oceanic_atom2_device_quit +oceanic_veo250_device_open reefnet_sensuspro_device_open reefnet_sensuspro_device_set_timestamp reefnet_sensuspro_device_write_interval diff --git a/src/oceanic_veo250.c b/src/oceanic_veo250.c new file mode 100644 index 0000000..3a27727 --- /dev/null +++ b/src/oceanic_veo250.c @@ -0,0 +1,396 @@ +/* + * libdivecomputer + * + * Copyright (C) 2008 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 +#include // malloc, free +#include // assert + +#include "device-private.h" +#include "oceanic_veo250.h" +#include "serial.h" +#include "utils.h" +#include "ringbuffer.h" +#include "checksum.h" + +#define MAXRETRIES 2 + +#define WARNING(expr) \ +{ \ + message ("%s:%d: %s\n", __FILE__, __LINE__, expr); \ +} + +#define EXITCODE(rc) \ +( \ + rc == -1 ? DEVICE_STATUS_IO : DEVICE_STATUS_TIMEOUT \ +) + +#define ACK 0x5A +#define NAK 0xA5 + + +typedef struct oceanic_veo250_device_t oceanic_veo250_device_t; + +struct oceanic_veo250_device_t { + device_t base; + struct serial *port; +}; + +static device_status_t oceanic_veo250_device_version (device_t *abstract, unsigned char data[], unsigned int size); +static device_status_t oceanic_veo250_device_read (device_t *abstract, unsigned int address, unsigned char data[], unsigned int size); +static device_status_t oceanic_veo250_device_dump (device_t *abstract, unsigned char data[], unsigned int size, unsigned int *result); +static device_status_t oceanic_veo250_device_close (device_t *abstract); + +static const device_backend_t oceanic_veo250_device_backend = { + DEVICE_TYPE_OCEANIC_VEO250, + NULL, /* handshake */ + oceanic_veo250_device_version, /* version */ + oceanic_veo250_device_read, /* read */ + NULL, /* write */ + oceanic_veo250_device_dump, /* dump */ + NULL, /* foreach */ + oceanic_veo250_device_close /* close */ +}; + +static int +device_is_oceanic_veo250 (device_t *abstract) +{ + if (abstract == NULL) + return 0; + + return abstract->backend == &oceanic_veo250_device_backend; +} + + +static device_status_t +oceanic_veo250_send (oceanic_veo250_device_t *device, const unsigned char command[], unsigned int csize) +{ + // Send the command to the dive computer and + // wait until all data has been transmitted. + serial_write (device->port, command, csize); + serial_drain (device->port); + + return DEVICE_STATUS_SUCCESS; +} + + +static device_status_t +oceanic_veo250_transfer (oceanic_veo250_device_t *device, const unsigned char command[], unsigned int csize, unsigned char answer[], unsigned int asize) +{ + assert (asize == OCEANIC_VEO250_PACKET_SIZE + 2); + + // Send the command to the device. If the device responds with an + // ACK byte, the command was received successfully and the answer + // (if any) follows after the ACK byte. If the device responds with + // a NAK byte, we try to resend the command a number of times before + // returning an error. + + unsigned int nretries = 0; + unsigned char response = NAK; + while (response == NAK) { + // Send the command to the dive computer. + device_status_t rc = oceanic_veo250_send (device, command, csize); + if (rc != DEVICE_STATUS_SUCCESS) { + WARNING ("Failed to send the command."); + return rc; + } + + // Receive the response (ACK/NAK) of the dive computer. + int n = serial_read (device->port, &response, 1); + if (n != 1) { + WARNING ("Failed to receive the answer."); + return EXITCODE (n); + } + +#ifndef NDEBUG + if (response != ACK) + message ("Received unexpected response (%02x).\n", response); +#endif + + // Abort if the maximum number of retries is reached. + if (nretries++ >= MAXRETRIES) + break; + } + + // Verify the response of the dive computer. + if (response != ACK) { + WARNING ("Unexpected answer start byte(s)."); + return DEVICE_STATUS_PROTOCOL; + } + + // Receive the answer of the dive computer. + int n = serial_read (device->port, answer, OCEANIC_VEO250_PACKET_SIZE + 2); + if (n != OCEANIC_VEO250_PACKET_SIZE + 2) { + WARNING ("Failed to receive the answer."); + return EXITCODE (n); + } + + // Verify the checksum of the answer. + unsigned char crc = answer[OCEANIC_VEO250_PACKET_SIZE]; + unsigned char ccrc = checksum_add_uint8 (answer, OCEANIC_VEO250_PACKET_SIZE, 0x00); + if (crc != ccrc) { + WARNING ("Unexpected answer CRC."); + return DEVICE_STATUS_PROTOCOL; + } + + // Verify the last byte of the answer. + if (answer[OCEANIC_VEO250_PACKET_SIZE + 1] != NAK) { + WARNING ("Unexpected answer byte."); + return DEVICE_STATUS_PROTOCOL; + } + + return DEVICE_STATUS_SUCCESS; +} + + +static device_status_t +oceanic_veo250_init (oceanic_veo250_device_t *device) +{ + // Send the command to the dive computer. + unsigned char command[2] = {0x55, 0x00}; + device_status_t rc = oceanic_veo250_send (device, command, sizeof (command)); + if (rc != DEVICE_STATUS_SUCCESS) { + WARNING ("Failed to send the command."); + return rc; + } + + return DEVICE_STATUS_SUCCESS; +} + + +static device_status_t +oceanic_veo250_handshake (oceanic_veo250_device_t *device) +{ + // Send the command to the dive computer. + unsigned char command[2] = {0x98, 0x00}; + device_status_t rc = oceanic_veo250_send (device, command, sizeof (command)); + if (rc != DEVICE_STATUS_SUCCESS) { + WARNING ("Failed to send the command."); + return rc; + } + + // Receive the answer of the dive computer. + unsigned char answer[14] = {0}; + int n = serial_read (device->port, answer, sizeof (answer)); + if (n != sizeof (answer)) { + WARNING ("Failed to receive the answer."); + return EXITCODE (n); + } + + // Verify the answer. + const unsigned char response[14] = { + 0x50, 0x50, 0x53, 0x2D, 0x2D, 0x4F, 0x4B, + 0x5F, 0x56, 0x32, 0x2E, 0x30, 0x30, 0x00}; + if (memcmp (answer, response, sizeof (response)) != 0) { + WARNING ("Unexpected answer byte(s)."); + return DEVICE_STATUS_PROTOCOL; + } + + return DEVICE_STATUS_SUCCESS; +} + + +device_status_t +oceanic_veo250_device_open (device_t **out, const char* name) +{ + if (out == NULL) + return DEVICE_STATUS_ERROR; + + // Allocate memory. + oceanic_veo250_device_t *device = (oceanic_veo250_device_t *) malloc (sizeof (oceanic_veo250_device_t)); + if (device == NULL) { + WARNING ("Failed to allocate memory."); + return DEVICE_STATUS_MEMORY; + } + + // Initialize the base class. + device_init (&device->base, &oceanic_veo250_device_backend); + + // Set the default values. + device->port = NULL; + + // Open the device. + int rc = serial_open (&device->port, name); + if (rc == -1) { + WARNING ("Failed to open the serial port."); + free (device); + return DEVICE_STATUS_IO; + } + + // Set the serial communication protocol (9600 8N1). + rc = serial_configure (device->port, 9600, 8, SERIAL_PARITY_NONE, 1, SERIAL_FLOWCONTROL_NONE); + if (rc == -1) { + WARNING ("Failed to set the terminal attributes."); + serial_close (device->port); + free (device); + return DEVICE_STATUS_IO; + } + + // Set the timeout for receiving data (3000 ms). + if (serial_set_timeout (device->port, 3000) == -1) { + WARNING ("Failed to set the timeout."); + serial_close (device->port); + free (device); + return DEVICE_STATUS_IO; + } + + // Set the DTR and RTS lines. + if (serial_set_dtr (device->port, 1) == -1 || + serial_set_rts (device->port, 1) == -1) { + WARNING ("Failed to set the DTR/RTS line."); + serial_close (device->port); + free (device); + return DEVICE_STATUS_IO; + } + + // Give the interface 100 ms to settle and draw power up. + serial_sleep (100); + + // Make sure everything is in a sane state. + serial_flush (device->port, SERIAL_QUEUE_BOTH); + + // Send the init and handshake commands. + oceanic_veo250_init (device); + oceanic_veo250_handshake (device); + + *out = (device_t*) device; + + return DEVICE_STATUS_SUCCESS; +} + + +static device_status_t +oceanic_veo250_device_close (device_t *abstract) +{ + oceanic_veo250_device_t *device = (oceanic_veo250_device_t*) abstract; + + if (! device_is_oceanic_veo250 (abstract)) + return DEVICE_STATUS_TYPE_MISMATCH; + + // Send the handshake command again. + oceanic_veo250_handshake (device); + + // Close the device. + if (serial_close (device->port) == -1) { + free (device); + return DEVICE_STATUS_IO; + } + + // Free memory. + free (device); + + return DEVICE_STATUS_SUCCESS; +} + + +static device_status_t +oceanic_veo250_device_version (device_t *abstract, unsigned char data[], unsigned int size) +{ + oceanic_veo250_device_t *device = (oceanic_veo250_device_t*) abstract; + + if (! device_is_oceanic_veo250 (abstract)) + return DEVICE_STATUS_TYPE_MISMATCH; + + if (size < OCEANIC_VEO250_PACKET_SIZE) + return DEVICE_STATUS_MEMORY; + + unsigned char answer[OCEANIC_VEO250_PACKET_SIZE + 2] = {0}; + unsigned char command[2] = {0x90, 0x00}; + device_status_t rc = oceanic_veo250_transfer (device, command, sizeof (command), answer, sizeof (answer)); + if (rc != DEVICE_STATUS_SUCCESS) + return rc; + + memcpy (data, answer, OCEANIC_VEO250_PACKET_SIZE); + +#ifndef NDEBUG + answer[OCEANIC_VEO250_PACKET_SIZE] = 0; + message ("VEO250ReadVersion()=\"%s\"\n", answer); +#endif + + return DEVICE_STATUS_SUCCESS; +} + + +static device_status_t +oceanic_veo250_device_read (device_t *abstract, unsigned int address, unsigned char data[], unsigned int size) +{ + oceanic_veo250_device_t *device = (oceanic_veo250_device_t*) abstract; + + if (! device_is_oceanic_veo250 (abstract)) + return DEVICE_STATUS_TYPE_MISMATCH; + + assert (address % OCEANIC_VEO250_PACKET_SIZE == 0); + assert (size % OCEANIC_VEO250_PACKET_SIZE == 0); + + // The data transmission is split in packages + // of maximum $OCEANIC_VEO250_PACKET_SIZE bytes. + + unsigned int nbytes = 0; + while (nbytes < size) { + // Read the package. + unsigned int number = address / OCEANIC_VEO250_PACKET_SIZE; + unsigned char answer[OCEANIC_VEO250_PACKET_SIZE + 2] = {0}; + unsigned char command[6] = {0x20, + (number ) & 0xFF, // low + (number >> 8) & 0xFF, // high + (number ) & 0xFF, // low + (number >> 8) & 0xFF, // high + 0}; + device_status_t rc = oceanic_veo250_transfer (device, command, sizeof (command), answer, sizeof (answer)); + if (rc != DEVICE_STATUS_SUCCESS) + return rc; + + memcpy (data, answer, OCEANIC_VEO250_PACKET_SIZE); + +#ifndef NDEBUG + message ("VEO250Read(0x%04x,%d)=\"", address, OCEANIC_VEO250_PACKET_SIZE); + for (unsigned int i = 0; i < OCEANIC_VEO250_PACKET_SIZE; ++i) { + message("%02x", data[i]); + } + message("\"\n"); +#endif + + nbytes += OCEANIC_VEO250_PACKET_SIZE; + address += OCEANIC_VEO250_PACKET_SIZE; + data += OCEANIC_VEO250_PACKET_SIZE; + } + + return DEVICE_STATUS_SUCCESS; +} + + +static device_status_t +oceanic_veo250_device_dump (device_t *abstract, unsigned char data[], unsigned int size, unsigned int *result) +{ + if (! device_is_oceanic_veo250 (abstract)) + return DEVICE_STATUS_TYPE_MISMATCH; + + if (size < OCEANIC_VEO250_MEMORY_SIZE) + return DEVICE_STATUS_ERROR; + + device_status_t rc = oceanic_veo250_device_read (abstract, 0x00, data, OCEANIC_VEO250_MEMORY_SIZE); + if (rc != DEVICE_STATUS_SUCCESS) + return rc; + + if (result) + *result = OCEANIC_VEO250_MEMORY_SIZE; + + return DEVICE_STATUS_SUCCESS; +} diff --git a/src/oceanic_veo250.h b/src/oceanic_veo250.h new file mode 100644 index 0000000..6e0235f --- /dev/null +++ b/src/oceanic_veo250.h @@ -0,0 +1,40 @@ +/* + * libdivecomputer + * + * Copyright (C) 2008 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 + */ + +#ifndef OCEANIC_VEO250_H +#define OCEANIC_VEO250_H + +#ifdef __cplusplus +extern "C" { +#endif /* __cplusplus */ + +#include "device.h" + +#define OCEANIC_VEO250_MEMORY_SIZE 0x8000 +#define OCEANIC_VEO250_PACKET_SIZE 0x10 + +device_status_t +oceanic_veo250_device_open (device_t **device, const char* name); + +#ifdef __cplusplus +} +#endif /* __cplusplus */ +#endif /* OCEANIC_VEO250_H */