bkinnightskytw
/
ethercat
mirror of https://gitlab.com/bkinnightskytw/ethercat.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Fixed VoE data reading in userspace.

This commit is contained in:
Florian Pose 2008-10-15 16:08:29 +00:00
parent 70604a971f
commit 71257f2291
1 changed files with 21 additions and 14 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

35
lib/voe_handler.c
View File

@ -36,7 +36,11 @@
/*****************************************************************************/
#include <stdlib.h>
#include <sys/ioctl.h>
#include <stdio.h>
#include <errno.h>
#include <string.h>
#include "voe_handler.h"
#include "slave_config.h"
@ -55,9 +59,9 @@ void ecrt_voe_handler_send_header(ec_voe_handler_t *voe, uint32_t vendor_id,
data.vendor_id = &vendor_id;
data.vendor_type = &vendor_type;
if (ioctl(voe->config->master->fd, EC_IOCTL_VOE_SEND_HEADER, &data) == -1) {
fprintf(stderr, "Failed to set VoE send header.\n");
}
if (ioctl(voe->config->master->fd, EC_IOCTL_VOE_SEND_HEADER, &data) == -1)
fprintf(stderr, "Failed to set VoE send header: %s\n",
strerror(errno));
}
/*****************************************************************************/
@ -72,9 +76,9 @@ void ecrt_voe_handler_received_header(const ec_voe_handler_t *voe,
data.vendor_id = vendor_id;
data.vendor_type = vendor_type;
if (ioctl(voe->config->master->fd, EC_IOCTL_VOE_REC_HEADER, &data) == -1) {
fprintf(stderr, "Failed to get received VoE header.\n");
}
if (ioctl(voe->config->master->fd, EC_IOCTL_VOE_REC_HEADER, &data) == -1)
fprintf(stderr, "Failed to get received VoE header: %s\n",
strerror(errno));
}
/*****************************************************************************/
@ -100,9 +104,9 @@ void ecrt_voe_handler_read(ec_voe_handler_t *voe)
data.config_index = voe->config->index;
data.voe_index = voe->index;
if (ioctl(voe->config->master->fd, EC_IOCTL_VOE_READ, &data) == -1) {
fprintf(stderr, "Failed to initiate VoE reading.\n");
}
if (ioctl(voe->config->master->fd, EC_IOCTL_VOE_READ, &data) == -1)
fprintf(stderr, "Failed to initiate VoE reading: %s\n",
strerror(errno));
}
/*****************************************************************************/
@ -116,9 +120,9 @@ void ecrt_voe_handler_write(ec_voe_handler_t *voe, size_t size)
data.size = size;
data.data = voe->data;
if (ioctl(voe->config->master->fd, EC_IOCTL_VOE_WRITE, &data) == -1) {
fprintf(stderr, "Failed to initiate VoE reading.\n");
}
if (ioctl(voe->config->master->fd, EC_IOCTL_VOE_WRITE, &data) == -1)
fprintf(stderr, "Failed to initiate VoE writing: %s\n",
strerror(errno));
}
/*****************************************************************************/
@ -132,7 +136,8 @@ ec_request_state_t ecrt_voe_handler_execute(ec_voe_handler_t *voe)
data.size = 0;
if (ioctl(voe->config->master->fd, EC_IOCTL_VOE_EXEC, &data) == -1) {
fprintf(stderr, "Failed to initiate VoE reading.\n");
fprintf(stderr, "Failed to execute VoE handler: %s\n",
strerror(errno));
return EC_REQUEST_ERROR;
}
@ -149,8 +154,10 @@ ec_request_state_t ecrt_voe_handler_execute(ec_voe_handler_t *voe)
voe->mem_size = data.size;
}
data.data = voe->data;
if (ioctl(voe->config->master->fd, EC_IOCTL_VOE_DATA, &data) == -1) {
fprintf(stderr, "Failed to get VoE data!\n");
fprintf(stderr, "Failed to get VoE data: %s\n", strerror(errno));
return EC_REQUEST_ERROR;
}
voe->data_size = data.size;