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