Added the initial implementation for the Uwatec Aladin.
This commit is contained in:
parent
7f3382dfd7
commit
6ca4159149
13
uwatec.h
Normal file
13
uwatec.h
Normal file
@ -0,0 +1,13 @@
|
||||
#ifndef UWATEC_H
|
||||
#define UWATEC_H
|
||||
|
||||
#define UWATEC_SUCCESS 0
|
||||
#define UWATEC_ERROR -1
|
||||
#define UWATEC_ERROR_IO -2
|
||||
#define UWATEC_ERROR_MEMORY -3
|
||||
#define UWATEC_ERROR_PROTOCOL -4
|
||||
#define UWATEC_ERROR_TIMEOUT -5
|
||||
|
||||
#include "uwatec_aladin.h"
|
||||
|
||||
#endif /* UWATEC_H */
|
||||
166
uwatec_aladin.c
Normal file
166
uwatec_aladin.c
Normal file
@ -0,0 +1,166 @@
|
||||
#include <stdlib.h> // malloc, free
|
||||
|
||||
#include "uwatec.h"
|
||||
#include "serial.h"
|
||||
#include "utils.h"
|
||||
|
||||
#define WARNING(expr) \
|
||||
{ \
|
||||
message ("%s:%d: %s\n", __FILE__, __LINE__, expr); \
|
||||
}
|
||||
|
||||
|
||||
struct aladin {
|
||||
struct serial *port;
|
||||
};
|
||||
|
||||
|
||||
int
|
||||
uwatec_aladin_open (aladin **out, const char* name)
|
||||
{
|
||||
if (out == NULL)
|
||||
return UWATEC_ERROR;
|
||||
|
||||
// Allocate memory.
|
||||
struct aladin *device = malloc (sizeof (struct aladin));
|
||||
if (device == NULL) {
|
||||
WARNING ("Failed to allocate memory.");
|
||||
return UWATEC_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 UWATEC_ERROR_IO;
|
||||
}
|
||||
|
||||
// Set the serial communication protocol (19200 8N1).
|
||||
rc = serial_configure (device->port, 19200, 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 UWATEC_ERROR_IO;
|
||||
}
|
||||
|
||||
// Set the timeout for receiving data (INFINITE).
|
||||
if (serial_set_timeout (device->port, -1) == -1) {
|
||||
WARNING ("Failed to set the timeout.");
|
||||
serial_close (device->port);
|
||||
free (device);
|
||||
return UWATEC_ERROR_IO;
|
||||
}
|
||||
|
||||
// Clear the RTS line and set the DTR line.
|
||||
if (serial_set_dtr (device->port, 1) == -1 ||
|
||||
serial_set_rts (device->port, 0) == -1) {
|
||||
WARNING ("Failed to set the DTR/RTS line.");
|
||||
serial_close (device->port);
|
||||
free (device);
|
||||
return UWATEC_ERROR_IO;
|
||||
}
|
||||
|
||||
*out = device;
|
||||
|
||||
return UWATEC_SUCCESS;
|
||||
}
|
||||
|
||||
|
||||
int
|
||||
uwatec_aladin_close (aladin *device)
|
||||
{
|
||||
if (device == NULL)
|
||||
return UWATEC_SUCCESS;
|
||||
|
||||
// Close the device.
|
||||
if (serial_close (device->port) == -1) {
|
||||
free (device);
|
||||
return UWATEC_ERROR_IO;
|
||||
}
|
||||
|
||||
// Free memory.
|
||||
free (device);
|
||||
|
||||
return UWATEC_SUCCESS;
|
||||
}
|
||||
|
||||
|
||||
static void
|
||||
uwatec_aladin_reverse (unsigned char data[], unsigned int size)
|
||||
{
|
||||
for (unsigned int i = 0; i < size; ++i) {
|
||||
unsigned char j = 0;
|
||||
j = (data[i] & 0x01) << 7;
|
||||
j += (data[i] & 0x02) << 5;
|
||||
j += (data[i] & 0x04) << 3;
|
||||
j += (data[i] & 0x08) << 1;
|
||||
j += (data[i] & 0x10) >> 1;
|
||||
j += (data[i] & 0x20) >> 3;
|
||||
j += (data[i] & 0x40) >> 5;
|
||||
j += (data[i] & 0x80) >> 7;
|
||||
data[i] = j;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static unsigned short
|
||||
uwatec_aladin_checksum (unsigned char data[], unsigned int size)
|
||||
{
|
||||
unsigned short crc = 0x00;
|
||||
for (unsigned int i = 0; i < size; ++i)
|
||||
crc += data[i];
|
||||
|
||||
return crc;
|
||||
}
|
||||
|
||||
|
||||
int
|
||||
uwatec_aladin_read (aladin *device, unsigned char data[], unsigned int size)
|
||||
{
|
||||
if (device == NULL)
|
||||
return UWATEC_ERROR;
|
||||
|
||||
if (size < UWATEC_ALADIN_MEMORY_SIZE)
|
||||
return UWATEC_ERROR_MEMORY;
|
||||
|
||||
// Receive the header of the package.
|
||||
for (unsigned int i = 0; i < 4;) {
|
||||
int rc = serial_read (device->port, data + i, 1);
|
||||
if (rc != 1) {
|
||||
WARNING ("Cannot read from device.");
|
||||
return UWATEC_ERROR;
|
||||
}
|
||||
if (data[i] == (i < 3 ? 0x55 : 0x00)) {
|
||||
i++; // Continue.
|
||||
} else {
|
||||
i = 0; // Reset.
|
||||
}
|
||||
}
|
||||
|
||||
// Receive the contents of the package.
|
||||
int rc = serial_read (device->port, data + 4, 2046);
|
||||
if (rc != 2046) {
|
||||
WARNING ("Unexpected EOF in answer.");
|
||||
return UWATEC_ERROR;
|
||||
}
|
||||
|
||||
// Reverse the bit order.
|
||||
uwatec_aladin_reverse (data, 2050);
|
||||
|
||||
// Calculate the checksum.
|
||||
unsigned short ccrc = uwatec_aladin_checksum (data, 2048);
|
||||
|
||||
// Verify the checksum of the package.
|
||||
unsigned short crc = (data[2049] << 8) + data[2048];
|
||||
if (ccrc != crc) {
|
||||
WARNING ("Unexpected answer CRC.");
|
||||
return UWATEC_ERROR;
|
||||
}
|
||||
|
||||
return UWATEC_SUCCESS;
|
||||
}
|
||||
21
uwatec_aladin.h
Normal file
21
uwatec_aladin.h
Normal file
@ -0,0 +1,21 @@
|
||||
#ifndef UWATEC_ALADIN_H
|
||||
#define UWATEC_ALADIN_H
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif /* __cplusplus */
|
||||
|
||||
typedef struct aladin aladin;
|
||||
|
||||
#define UWATEC_ALADIN_MEMORY_SIZE 2050
|
||||
|
||||
int uwatec_aladin_open (aladin **device, const char* name);
|
||||
|
||||
int uwatec_aladin_close (aladin *device);
|
||||
|
||||
int uwatec_aladin_read (aladin *device, unsigned char data[], unsigned int size);
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif /* __cplusplus */
|
||||
#endif /* UWATEC_ALADIN_H */
|
||||
95
uwatec_aladin_test.c
Normal file
95
uwatec_aladin_test.c
Normal file
@ -0,0 +1,95 @@
|
||||
#include <stdio.h> // fopen, fwrite, fclose
|
||||
|
||||
#include "uwatec.h"
|
||||
#include "utils.h"
|
||||
|
||||
#define WARNING(expr) \
|
||||
{ \
|
||||
message ("%s:%d: %s\n", __FILE__, __LINE__, expr); \
|
||||
}
|
||||
|
||||
|
||||
int test_dump_memory (const char* name, const char* filename)
|
||||
{
|
||||
aladin *device = NULL;
|
||||
unsigned char data[UWATEC_ALADIN_MEMORY_SIZE] = {0};
|
||||
|
||||
message ("uwatec_aladin_open\n");
|
||||
int rc = uwatec_aladin_open (&device, name);
|
||||
if (rc != UWATEC_SUCCESS) {
|
||||
WARNING ("Error opening serial port.");
|
||||
return rc;
|
||||
}
|
||||
|
||||
message ("uwatec_aladin_read\n");
|
||||
rc = uwatec_aladin_read (device, data, sizeof (data));
|
||||
if (rc != UWATEC_SUCCESS) {
|
||||
WARNING ("Cannot read memory.");
|
||||
uwatec_aladin_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 ("uwatec_aladin_close\n");
|
||||
rc = uwatec_aladin_close (device);
|
||||
if (rc != UWATEC_SUCCESS) {
|
||||
WARNING ("Cannot close device.");
|
||||
return rc;
|
||||
}
|
||||
|
||||
return UWATEC_SUCCESS;
|
||||
}
|
||||
|
||||
|
||||
const char* errmsg (int rc)
|
||||
{
|
||||
switch (rc) {
|
||||
case UWATEC_SUCCESS:
|
||||
return "Success";
|
||||
case UWATEC_ERROR:
|
||||
return "Generic error";
|
||||
case UWATEC_ERROR_IO:
|
||||
return "Input/output error";
|
||||
case UWATEC_ERROR_MEMORY:
|
||||
return "Memory error";
|
||||
case UWATEC_ERROR_PROTOCOL:
|
||||
return "Protocol error";
|
||||
case UWATEC_ERROR_TIMEOUT:
|
||||
return "Timeout";
|
||||
default:
|
||||
return "Unknown error";
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
int main(int argc, char *argv[])
|
||||
{
|
||||
message_set_logfile ("ALADIN.LOG");
|
||||
|
||||
#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, "ALADIN.DMP");
|
||||
|
||||
message ("\nSUMMARY\n");
|
||||
message ("-------\n");
|
||||
message ("test_dump_memory: %s\n", errmsg (a));
|
||||
|
||||
message_set_logfile (NULL);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
Loading…
x
Reference in New Issue
Block a user