Remove a number of unnecessary functions.

This commit is contained in:
Jef Driesen 2010-01-25 19:46:09 +00:00
parent a14b0b7b98
commit 87236f505a
4 changed files with 52 additions and 97 deletions

View File

@ -85,18 +85,6 @@ device_is_oceanic_atom2 (device_t *abstract)
}
static device_status_t
oceanic_atom2_send (oceanic_atom2_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_atom2_transfer (oceanic_atom2_device_t *device, const unsigned char command[], unsigned int csize, unsigned char answer[], unsigned int asize)
{
@ -110,14 +98,14 @@ oceanic_atom2_transfer (oceanic_atom2_device_t *device, const unsigned char comm
unsigned char response = NAK;
while (response == NAK) {
// Send the command to the dive computer.
device_status_t rc = oceanic_atom2_send (device, command, csize);
if (rc != DEVICE_STATUS_SUCCESS) {
int n = serial_write (device->port, command, csize);
if (n != csize) {
WARNING ("Failed to send the command.");
return rc;
return EXITCODE (n);
}
// Receive the response (ACK/NAK) of the dive computer.
int n = serial_read (device->port, &response, 1);
n = serial_read (device->port, &response, 1);
if (n != 1) {
WARNING ("Failed to receive the answer.");
return EXITCODE (n);
@ -165,15 +153,15 @@ oceanic_atom2_init (oceanic_atom2_device_t *device)
{
// Send the command to the dive computer.
unsigned char command[3] = {0xA8, 0x99, 0x00};
device_status_t rc = oceanic_atom2_send (device, command, sizeof (command));
if (rc != DEVICE_STATUS_SUCCESS) {
int n = serial_write (device->port, command, sizeof (command));
if (n != sizeof (command)) {
WARNING ("Failed to send the command.");
return rc;
return EXITCODE (n);
}
// Receive the answer of the dive computer.
unsigned char answer[3] = {0};
int n = serial_read (device->port, answer, sizeof (answer));
n = serial_read (device->port, answer, sizeof (answer));
if (n != sizeof (answer)) {
WARNING ("Failed to receive the answer.");
return EXITCODE (n);
@ -194,15 +182,15 @@ oceanic_atom2_quit (oceanic_atom2_device_t *device)
{
// Send the command to the dive computer.
unsigned char command[4] = {0x6A, 0x05, 0xA5, 0x00};
device_status_t rc = oceanic_atom2_send (device, command, sizeof (command));
if (rc != DEVICE_STATUS_SUCCESS) {
int n = serial_write (device->port, command, sizeof (command));
if (n != sizeof (command)) {
WARNING ("Failed to send the command.");
return rc;
return EXITCODE (n);
}
// Receive the answer of the dive computer.
unsigned char answer[1] = {0};
int n = serial_read (device->port, answer, sizeof (answer));
n = serial_read (device->port, answer, sizeof (answer));
if (n != sizeof (answer)) {
WARNING ("Failed to receive the answer.");
return EXITCODE (n);

View File

@ -86,21 +86,6 @@ device_is_oceanic_veo250 (device_t *abstract)
}
static device_status_t
oceanic_veo250_send (oceanic_veo250_device_t *device, const unsigned char command[], unsigned int csize)
{
// Discard garbage bytes.
serial_flush (device->port, SERIAL_QUEUE_INPUT);
// 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)
{
@ -113,15 +98,18 @@ oceanic_veo250_transfer (oceanic_veo250_device_t *device, const unsigned char co
unsigned int nretries = 0;
unsigned char response = NAK;
while (response == NAK) {
// Discard garbage bytes.
serial_flush (device->port, SERIAL_QUEUE_INPUT);
// Send the command to the dive computer.
device_status_t rc = oceanic_veo250_send (device, command, csize);
if (rc != DEVICE_STATUS_SUCCESS) {
int n = serial_write (device->port, command, csize);
if (n != csize) {
WARNING ("Failed to send the command.");
return rc;
return EXITCODE (n);
}
// Receive the response (ACK/NAK) of the dive computer.
int n = serial_read (device->port, &response, 1);
n = serial_read (device->port, &response, 1);
if (n != 1) {
WARNING ("Failed to receive the answer.");
return EXITCODE (n);
@ -165,15 +153,15 @@ 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) {
int n = serial_write (device->port, command, sizeof (command));
if (n != sizeof (command)) {
WARNING ("Failed to send the command.");
return rc;
return EXITCODE (n);
}
// Receive the answer of the dive computer.
unsigned char answer[14] = {0};
int n = serial_read (device->port, answer, sizeof (answer));
n = serial_read (device->port, answer, sizeof (answer));
if (n != sizeof (answer)) {
WARNING ("Failed to receive the answer.");
return EXITCODE (n);
@ -197,10 +185,10 @@ oceanic_veo250_quit (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) {
int n = serial_write (device->port, command, sizeof (command));
if (n != sizeof (command)) {
WARNING ("Failed to send the command.");
return rc;
return EXITCODE (n);
}
return DEVICE_STATUS_SUCCESS;

View File

@ -86,18 +86,6 @@ device_is_oceanic_vtpro (device_t *abstract)
}
static device_status_t
oceanic_vtpro_send (oceanic_vtpro_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_vtpro_transfer (oceanic_vtpro_device_t *device, const unsigned char command[], unsigned int csize, unsigned char answer[], unsigned int asize)
{
@ -111,14 +99,14 @@ oceanic_vtpro_transfer (oceanic_vtpro_device_t *device, const unsigned char comm
unsigned char response = NAK;
while (response == NAK) {
// Send the command to the dive computer.
device_status_t rc = oceanic_vtpro_send (device, command, csize);
if (rc != DEVICE_STATUS_SUCCESS) {
int n = serial_write (device->port, command, csize);
if (n != csize) {
WARNING ("Failed to send the command.");
return rc;
return EXITCODE (n);
}
// Receive the response (ACK/NAK) of the dive computer.
int n = serial_read (device->port, &response, 1);
n = serial_read (device->port, &response, 1);
if (n != 1) {
WARNING ("Failed to receive the answer.");
return EXITCODE (n);
@ -156,15 +144,15 @@ oceanic_vtpro_init (oceanic_vtpro_device_t *device)
{
// Send the command to the dive computer.
unsigned char command[2] = {0xAA, 0x00};
device_status_t rc = oceanic_vtpro_send (device, command, sizeof (command));
if (rc != DEVICE_STATUS_SUCCESS) {
int n = serial_write (device->port, command, sizeof (command));
if (n != sizeof (command)) {
WARNING ("Failed to send the command.");
return rc;
return EXITCODE (n);
}
// Receive the answer of the dive computer.
unsigned char answer[13] = {0};
int n = serial_read (device->port, answer, sizeof (answer));
n = serial_read (device->port, answer, sizeof (answer));
if (n != sizeof (answer)) {
WARNING ("Failed to receive the answer.");
return EXITCODE (n);

View File

@ -195,22 +195,6 @@ uwatec_memomouse_device_set_fingerprint (device_t *abstract, const unsigned char
}
static device_status_t
uwatec_memomouse_confirm (uwatec_memomouse_device_t *device, unsigned char value)
{
// Send the value to the device.
int rc = serial_write (device->port, &value, 1);
if (rc != 1) {
WARNING ("Failed to send the value.");
return EXITCODE (rc);
}
serial_drain (device->port);
return DEVICE_STATUS_SUCCESS;
}
static device_status_t
uwatec_memomouse_read_packet (uwatec_memomouse_device_t *device, unsigned char data[], unsigned int size, unsigned int *result)
{
@ -271,9 +255,12 @@ uwatec_memomouse_read_packet_outer (uwatec_memomouse_device_t *device, unsigned
serial_flush (device->port, SERIAL_QUEUE_INPUT);
// Reject the packet.
rc = uwatec_memomouse_confirm (device, NAK);
if (rc != DEVICE_STATUS_SUCCESS)
return rc;
unsigned char value = NAK;
int n = serial_write (device->port, &value, 1);
if (n != 1) {
WARNING ("Failed to reject the packet.");
return EXITCODE (n);
}
}
return DEVICE_STATUS_SUCCESS;
@ -304,9 +291,12 @@ uwatec_memomouse_read_packet_inner (uwatec_memomouse_device_t *device, dc_buffer
return rc;
// Accept the packet.
rc = uwatec_memomouse_confirm (device, ACK);
if (rc != DEVICE_STATUS_SUCCESS)
return rc;
unsigned char value = ACK;
int n = serial_write (device->port, &value, 1);
if (n != 1) {
WARNING ("Failed to accept the packet.");
return EXITCODE (n);
}
if (nbytes == 0) {
// The first packet should contain at least
@ -370,9 +360,12 @@ uwatec_memomouse_dump_internal (uwatec_memomouse_device_t *device, dc_buffer_t *
serial_flush (device->port, SERIAL_QUEUE_INPUT);
// Reject the packet.
device_status_t rc = uwatec_memomouse_confirm (device, NAK);
if (rc != DEVICE_STATUS_SUCCESS)
return rc;
unsigned char value = NAK;
int n = serial_write (device->port, &value, 1);
if (n != 1) {
WARNING ("Failed to reject the packet.");
return EXITCODE (n);
}
serial_sleep (300);
}
@ -413,8 +406,6 @@ uwatec_memomouse_dump_internal (uwatec_memomouse_device_t *device, dc_buffer_t *
return EXITCODE (n);
}
serial_drain (device->port);
// Wait for the answer (ACK).
n = serial_read (device->port, &answer, 1);
if (n != 1) {