Added the initial implementation for the Suunto Vyper2.
This commit is contained in:
Jef Driesen
parent
50bc70d89a
commit
a63a1e4576
1
suunto.h
1
suunto.h
@ -9,5 +9,6 @@
|
||||
#define SUUNTO_ERROR_TIMEOUT -5
|
||||
|
||||
#include "suunto_vyper.h"
|
||||
#include "suunto_vyper2.h"
|
||||
|
||||
#endif /* SUUNTO_H */
|
||||
|
||||
321
suunto_vyper2.c
Normal file
321
suunto_vyper2.c
Normal file
@ -0,0 +1,321 @@
|
||||
#include <stdio.h> // fprintf
|
||||
#include <string.h> // memcmp, memcpy
|
||||
#include <stdlib.h> // malloc, free
|
||||
|
||||
#include "suunto.h"
|
||||
#include "serial.h"
|
||||
|
||||
#define MIN(a,b) (((a) < (b)) ? (a) : (b))
|
||||
#define MAX(a,b) (((a) > (b)) ? (a) : (b))
|
||||
|
||||
#define WARNING(expr) \
|
||||
{ \
|
||||
fprintf (stderr, "%s:%d: %s\n", __FILE__, __LINE__, expr); \
|
||||
}
|
||||
|
||||
#define EXITCODE(rc, n) \
|
||||
( \
|
||||
rc == -1 ? \
|
||||
SUUNTO_ERROR_IO : \
|
||||
(rc != n ? SUUNTO_ERROR_TIMEOUT : SUUNTO_ERROR_PROTOCOL) \
|
||||
)
|
||||
|
||||
|
||||
struct vyper2 {
|
||||
struct serial *port;
|
||||
};
|
||||
|
||||
|
||||
int
|
||||
suunto_vyper2_open (vyper2 **out, const char* name)
|
||||
{
|
||||
if (out == NULL)
|
||||
return SUUNTO_ERROR;
|
||||
|
||||
// Allocate memory.
|
||||
struct vyper2 *device = malloc (sizeof (struct vyper2));
|
||||
if (device == NULL) {
|
||||
WARNING ("Failed to allocate memory.");
|
||||
return SUUNTO_ERROR_MEMORY;
|
||||
}
|
||||
|
||||
// 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 SUUNTO_ERROR_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 SUUNTO_ERROR_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 SUUNTO_ERROR_IO;
|
||||
}
|
||||
|
||||
// Set the DTR line (power supply for the interface).
|
||||
if (serial_set_dtr (device->port, 1) == -1) {
|
||||
WARNING ("Failed to set the DTR line.");
|
||||
serial_close (device->port);
|
||||
free (device);
|
||||
return SUUNTO_ERROR_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);
|
||||
|
||||
*out = device;
|
||||
|
||||
return SUUNTO_SUCCESS;
|
||||
}
|
||||
|
||||
|
||||
int
|
||||
suunto_vyper2_close (vyper2 *device)
|
||||
{
|
||||
if (device == NULL)
|
||||
return SUUNTO_SUCCESS;
|
||||
|
||||
// Close the device.
|
||||
if (serial_close (device->port) == -1) {
|
||||
free (device);
|
||||
return SUUNTO_ERROR_IO;
|
||||
}
|
||||
|
||||
// Free memory.
|
||||
free (device);
|
||||
|
||||
return SUUNTO_SUCCESS;
|
||||
}
|
||||
|
||||
|
||||
static unsigned char
|
||||
suunto_vyper2_checksum (const unsigned char data[], unsigned int size, unsigned char init)
|
||||
{
|
||||
unsigned char crc = init;
|
||||
for (unsigned int i = 0; i < size; ++i)
|
||||
crc ^= data[i];
|
||||
|
||||
return crc;
|
||||
}
|
||||
|
||||
|
||||
static int
|
||||
suunto_vyper2_send (vyper2 *device, const unsigned char command[], unsigned int csize)
|
||||
{
|
||||
serial_sleep (0x190 + 0xC8);
|
||||
|
||||
// Set RTS to send the command.
|
||||
serial_set_rts (device->port, 1);
|
||||
|
||||
// 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);
|
||||
|
||||
serial_sleep (0x9);
|
||||
|
||||
// Clear RTS to receive the reply.
|
||||
serial_set_rts (device->port, 0);
|
||||
|
||||
return SUUNTO_SUCCESS;
|
||||
}
|
||||
|
||||
|
||||
static int
|
||||
suunto_vyper2_transfer (vyper2 *device, const unsigned char command[], unsigned int csize, unsigned char header[], unsigned int hsize, unsigned char data[], unsigned int size)
|
||||
{
|
||||
// Send the command to the dive computer.
|
||||
int rc = suunto_vyper2_send (device, command, csize);
|
||||
if (rc != SUUNTO_SUCCESS) {
|
||||
WARNING ("Failed to send the command.");
|
||||
return rc;
|
||||
}
|
||||
|
||||
// Initial checksum value.
|
||||
unsigned char ccrc = 0x00;
|
||||
|
||||
// Receive the header of the package.
|
||||
rc = serial_read (device->port, header, hsize);
|
||||
header[2] -= size;
|
||||
if (rc != hsize || memcmp (command, header, hsize) != 0) {
|
||||
WARNING ("Unexpected answer start byte(s).");
|
||||
if (rc == 0) {
|
||||
WARNING ("Interface present, but the DC does not answer. Check the connection.");
|
||||
}
|
||||
return EXITCODE (rc, hsize);
|
||||
}
|
||||
header[2] += size;
|
||||
// Update the checksum.
|
||||
ccrc = suunto_vyper2_checksum (header, hsize, ccrc);
|
||||
|
||||
if (data) {
|
||||
// Receive the contents of the package.
|
||||
rc = serial_read (device->port, data, size);
|
||||
if (rc != size) {
|
||||
WARNING ("Unexpected EOF in answer.");
|
||||
return EXITCODE (rc, size);
|
||||
}
|
||||
// Update the checksum.
|
||||
ccrc = suunto_vyper2_checksum (data, size, ccrc);
|
||||
}
|
||||
|
||||
// Receive (and verify) the checksum of the package.
|
||||
unsigned char crc = 0x00;
|
||||
rc = serial_read (device->port, &crc, 1);
|
||||
if (rc != 1 || ccrc != crc) {
|
||||
WARNING ("Unexpected answer CRC.");
|
||||
return EXITCODE (rc, 1);
|
||||
}
|
||||
|
||||
return SUUNTO_SUCCESS;
|
||||
}
|
||||
|
||||
|
||||
int
|
||||
suunto_vyper2_read_version (vyper2 *device, unsigned char data[], unsigned int size)
|
||||
{
|
||||
if (device == NULL)
|
||||
return SUUNTO_ERROR;
|
||||
|
||||
if (size < 4)
|
||||
return SUUNTO_ERROR_MEMORY;
|
||||
|
||||
unsigned char header[3] = {0};
|
||||
unsigned char command[4] = {0x0F, 0x00, 0x00, 0};
|
||||
command[3] = suunto_vyper2_checksum (command, 3, 0x00);
|
||||
int rc = suunto_vyper2_transfer (device, command, 4, header, 3, data, 4);
|
||||
if (rc != SUUNTO_SUCCESS)
|
||||
return rc;
|
||||
|
||||
#ifndef NDEBUG
|
||||
printf ("Vyper2ReadVersion()=\"%02x %02x %02x %02x\"\n", data[0], data[1], data[2], data[3]);
|
||||
#endif
|
||||
|
||||
return SUUNTO_SUCCESS;
|
||||
}
|
||||
|
||||
|
||||
int
|
||||
suunto_vyper2_reset_maxdepth (vyper2 *device)
|
||||
{
|
||||
if (device == NULL)
|
||||
return SUUNTO_ERROR;
|
||||
|
||||
unsigned char header[3] = {0};
|
||||
unsigned char command[4] = {0x20, 0x00, 0x00, 0};
|
||||
command[3] = suunto_vyper2_checksum (command, 3, 0x00);
|
||||
int rc = suunto_vyper2_transfer (device, command, 4, header, 3, NULL, 0);
|
||||
if (rc != SUUNTO_SUCCESS)
|
||||
return rc;
|
||||
|
||||
#ifndef NDEBUG
|
||||
printf ("Vyper2ResetMaxDepth()\n");
|
||||
#endif
|
||||
|
||||
return SUUNTO_SUCCESS;
|
||||
}
|
||||
|
||||
|
||||
int
|
||||
suunto_vyper2_read_memory (vyper2 *device, unsigned int address, unsigned char data[], unsigned int size)
|
||||
{
|
||||
if (device == NULL)
|
||||
return SUUNTO_ERROR;
|
||||
|
||||
// The data transmission is split in packages
|
||||
// of maximum $SUUNTO_VYPER2_PACKET_SIZE bytes.
|
||||
|
||||
unsigned int nbytes = 0;
|
||||
while (nbytes < size) {
|
||||
// Calculate the package size.
|
||||
unsigned int len = MIN (size - nbytes, SUUNTO_VYPER2_PACKET_SIZE);
|
||||
|
||||
// Read the package.
|
||||
unsigned char header[6] = {0};
|
||||
unsigned char command[7] = {0x05, 0x00, 0x03,
|
||||
(address >> 8) & 0xFF, // high
|
||||
(address ) & 0xFF, // low
|
||||
len, // count
|
||||
0}; // CRC
|
||||
command[6] = suunto_vyper2_checksum (command, 6, 0x00);
|
||||
int rc = suunto_vyper2_transfer (device, command, 7, header, 6, data, len);
|
||||
if (rc != SUUNTO_SUCCESS)
|
||||
return rc;
|
||||
|
||||
#ifndef NDEBUG
|
||||
printf ("Vyper2Read(0x%04x,%d)=\"", address, len);
|
||||
for (unsigned int i = 0; i < len; ++i) {
|
||||
printf("%02x", data[i]);
|
||||
}
|
||||
printf("\"\n");
|
||||
#endif
|
||||
|
||||
nbytes += len;
|
||||
address += len;
|
||||
data += len;
|
||||
}
|
||||
|
||||
return SUUNTO_SUCCESS;
|
||||
}
|
||||
|
||||
|
||||
int
|
||||
suunto_vyper2_write_memory (vyper2 *device, unsigned int address, const unsigned char data[], unsigned int size)
|
||||
{
|
||||
if (device == NULL)
|
||||
return SUUNTO_ERROR;
|
||||
|
||||
// The data transmission is split in packages
|
||||
// of maximum $SUUNTO_VYPER2_PACKET_SIZE bytes.
|
||||
|
||||
unsigned int nbytes = 0;
|
||||
while (nbytes < size) {
|
||||
// Calculate the package size.
|
||||
unsigned int len = MIN (size - nbytes, SUUNTO_VYPER2_PACKET_SIZE);
|
||||
|
||||
// Write the package.
|
||||
unsigned char header[6] = {0};
|
||||
unsigned char command[SUUNTO_VYPER2_PACKET_SIZE + 7] = {0x06, 0x00, 0x03,
|
||||
(address >> 8) & 0xFF, // high
|
||||
(address ) & 0xFF, // low
|
||||
len, // count
|
||||
0}; // data + CRC
|
||||
memcpy (command + 6, data, len);
|
||||
command[len + 6] = suunto_vyper2_checksum (command, len + 6, 0x00);
|
||||
int rc = suunto_vyper2_transfer (device, command, len + 7, header, 6, NULL, 0);
|
||||
if (rc != SUUNTO_SUCCESS)
|
||||
return rc;
|
||||
|
||||
#ifndef NDEBUG
|
||||
printf ("Vyper2Write(0x%04x,%d,\"", address, len);
|
||||
for (unsigned int i = 0; i < len; ++i) {
|
||||
printf ("%02x", data[i]);
|
||||
}
|
||||
printf ("\");\n");
|
||||
#endif
|
||||
|
||||
nbytes += len;
|
||||
address += len;
|
||||
data += len;
|
||||
}
|
||||
|
||||
return SUUNTO_SUCCESS;
|
||||
}
|
||||
26
suunto_vyper2.h
Normal file
26
suunto_vyper2.h
Normal file
@ -0,0 +1,26 @@
|
||||
#ifndef SUUNTO_VYPER2_H
|
||||
#define SUUNTO_VYPER2_H
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif /* __cplusplus */
|
||||
|
||||
typedef struct vyper2 vyper2;
|
||||
|
||||
#define SUUNTO_VYPER2_MEMORY_SIZE 0x8000
|
||||
#define SUUNTO_VYPER2_PACKET_SIZE 0x78
|
||||
|
||||
int suunto_vyper2_open (vyper2 **device, const char* name);
|
||||
|
||||
int suunto_vyper2_close (vyper2 *device);
|
||||
|
||||
int suunto_vyper2_read_version (vyper2 *device, unsigned char data[], unsigned int size);
|
||||
|
||||
int suunto_vyper2_read_memory (vyper2 *device, unsigned int address, unsigned char data[], unsigned int size);
|
||||
|
||||
int suunto_vyper2_write_memory (vyper2 *device, unsigned int address, const unsigned char data[], unsigned int size);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif /* __cplusplus */
|
||||
#endif /* SUUNTO_VYPER2_H */
|
||||
90
suunto_vyper2_test.c
Normal file
90
suunto_vyper2_test.c
Normal file
@ -0,0 +1,90 @@
|
||||
#include <stdio.h> // fprintf
|
||||
|
||||
#include "suunto.h"
|
||||
|
||||
int test_dump_memory (const char* name, const char* filename)
|
||||
{
|
||||
unsigned char data[SUUNTO_VYPER2_MEMORY_SIZE] = {0};
|
||||
vyper2 *device = NULL;
|
||||
|
||||
printf ("suunto_vyper2_open\n");
|
||||
int rc = suunto_vyper2_open (&device, name);
|
||||
if (rc != SUUNTO_SUCCESS) {
|
||||
fprintf (stderr, "Error opening serial port.\n");
|
||||
return rc;
|
||||
}
|
||||
|
||||
printf ("suunto_vyper2_read_version\n");
|
||||
unsigned char version[4] = {0};
|
||||
rc = suunto_vyper2_read_version (device, version, sizeof (version));
|
||||
if (rc != SUUNTO_SUCCESS) {
|
||||
fprintf (stderr, "Cannot identify computer.\n");
|
||||
suunto_vyper2_close (device);
|
||||
return rc;
|
||||
}
|
||||
|
||||
printf ("suunto_vyper2_read_memory\n");
|
||||
rc = suunto_vyper2_read_memory (device, 0x00, data, sizeof (data));
|
||||
if (rc != SUUNTO_SUCCESS) {
|
||||
fprintf (stderr, "Cannot read memory.\n");
|
||||
suunto_vyper2_close (device);
|
||||
return rc;
|
||||
}
|
||||
|
||||
printf ("Dumping data\n");
|
||||
FILE* fp = fopen (filename, "wb");
|
||||
if (fp != NULL) {
|
||||
fwrite (data, sizeof (unsigned char), sizeof (data), fp);
|
||||
fclose (fp);
|
||||
}
|
||||
|
||||
printf ("suunto_vyper2_close\n");
|
||||
rc = suunto_vyper2_close (device);
|
||||
if (rc != SUUNTO_SUCCESS) {
|
||||
fprintf (stderr, "Cannot close device.");
|
||||
return rc;
|
||||
}
|
||||
|
||||
return SUUNTO_SUCCESS;
|
||||
}
|
||||
|
||||
const char* errmsg (int rc)
|
||||
{
|
||||
switch (rc) {
|
||||
case SUUNTO_SUCCESS:
|
||||
return "Success";
|
||||
case SUUNTO_ERROR:
|
||||
return "Generic error";
|
||||
case SUUNTO_ERROR_IO:
|
||||
return "Input/output error";
|
||||
case SUUNTO_ERROR_MEMORY:
|
||||
return "Memory error";
|
||||
case SUUNTO_ERROR_PROTOCOL:
|
||||
return "Protocol error";
|
||||
case SUUNTO_ERROR_TIMEOUT:
|
||||
return "Timeout";
|
||||
default:
|
||||
return "Unknown error";
|
||||
}
|
||||
}
|
||||
|
||||
int main(int argc, char *argv[])
|
||||
{
|
||||
#ifdef _WIN32
|
||||
const char* name = "COM1";
|
||||
#else
|
||||
const char* name = "/dev/ttyS0";
|
||||
#endif
|
||||
|
||||
if (argc > 1) {
|
||||
name = argv[1];
|
||||
}
|
||||
|
||||
int a = test_dump_memory (name, "VYPER2.DMP");
|
||||
|
||||
printf ("\nSUMMARY\n");
|
||||
printf ("-------\n");
|
||||
printf ("test_dump_memory: %s\n", errmsg (a));
|
||||
|
||||
return 0;
|
||||
}
|
||||
Loading…
x
Reference in New Issue
Block a user