1

/******************************************************************************

     2

 *  

     3

 * $Id$

     4

 * 

     5

 * Copyright (C) 2006-2008  Florian Pose, Ingenieurgemeinschaft IgH

     6

 * 

     7

 * This file is part of the IgH EtherCAT master userspace library.

     8

 * 

     9

 * The IgH EtherCAT master userspace library is free software; you can

    10

 * redistribute it and/or modify it under the terms of the GNU Lesser General

    11

 * Public License as published by the Free Software Foundation; version 2.1 of

    12

 * the License.

    13

 *

    14

 * The IgH EtherCAT master userspace library is distributed in the hope that

    15

 * it will be useful, but WITHOUT ANY WARRANTY; without even the implied

    16

 * warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

    17

 * GNU Lesser General Public License for more details.

    18

 *

    19

 * You should have received a copy of the GNU Lesser General Public License

    20

 * along with the IgH EtherCAT master userspace library. If not, see

    21

 * <http://www.gnu.org/licenses/>.

    22

 * 

    23

 * The right to use EtherCAT Technology is granted and comes free of charge

    24

 * under condition of compatibility of product made by Licensee. People

    25

 * intending to distribute/sell products based on the code, have to sign an

    26

 * agreement to guarantee that products using software based on IgH EtherCAT

    27

 * master stay compatible with the actual EtherCAT specification (which are

    28

 * released themselves as an open standard) as the (only) precondition to have

    29

 * the right to use EtherCAT Technology, IP and trade marks.

    30

 *

    31

 *****************************************************************************/

    32

    33

/**

    34

   \file

    35

   EtherCAT domain methods.

    36

*/

    37

    38

/*****************************************************************************/

    39

    40

#include <sys/ioctl.h>

    41

#include <sys/mman.h>

    42

#include <stdio.h>

    43

#include <errno.h>

    44

#include <string.h>

    45

    46

#include "domain.h"

    47

#include "master.h"

    48

#include "master/ioctl.h"

    49

    50

/*****************************************************************************/

    51

    52

int ecrt_domain_reg_pdo_entry_list(ec_domain_t *domain,

    53

        const ec_pdo_entry_reg_t *regs)

    54

{

    55

    const ec_pdo_entry_reg_t *reg;

    56

    ec_slave_config_t *sc;

    57

    int ret;

    58

    59

    for (reg = regs; reg->index; reg++) {

    60

        if (!(sc = ecrt_master_slave_config(domain->master, reg->alias,

    61

                        reg->position, reg->vendor_id, reg->product_code)))

    62

            return -1; // FIXME

    63

    64

        if ((ret = ecrt_slave_config_reg_pdo_entry(sc, reg->index,

    65

                        reg->subindex, domain, reg->bit_position)) < 0)

    66

            return -1; // FIXME

    67

    68

        *reg->offset = ret;

    69

    }

    70

    71

    return 0;

    72

}

    73

    74

/*****************************************************************************/

    75

    76

uint8_t *ecrt_domain_data(ec_domain_t *domain)

    77

{

    78

    if (!domain->process_data) {

    79

        int offset = 0;

    80

    81

        offset = ioctl(domain->master->fd, EC_IOCTL_DOMAIN_OFFSET,

    82

                domain->index);

    83

        if (offset == -1) {

    84

            fprintf(stderr, "Failed to get domain offset: %s\n",

    85

                    strerror(errno));

    86

            return NULL; 

    87

        }

    88

    89

        domain->process_data = domain->master->process_data + offset;

    90

    }

    91

    92

    return domain->process_data;

    93

}

    94

    95

/*****************************************************************************/

    96

    97

void ecrt_domain_process(ec_domain_t *domain)

    98

{

    99

    if (ioctl(domain->master->fd, EC_IOCTL_DOMAIN_PROCESS,

   100

                domain->index) == -1) {

   101

        fprintf(stderr, "Failed to process domain: %s\n", strerror(errno));

   102

    }

   103

}

   104

   105

/*****************************************************************************/

   106

   107

void ecrt_domain_queue(ec_domain_t *domain)

   108

{

   109

    if (ioctl(domain->master->fd, EC_IOCTL_DOMAIN_QUEUE,

   110

                domain->index) == -1) {

   111

        fprintf(stderr, "Failed to queue domain: %s\n", strerror(errno));

   112

    }

   113

}

   114

   115

/*****************************************************************************/

   116

   117

void ecrt_domain_state(const ec_domain_t *domain, ec_domain_state_t *state)

   118

{

   119

    ec_ioctl_domain_state_t data;

   120

   121

    data.domain_index = domain->index;

   122

    data.state = state;

   123

   124

    if (ioctl(domain->master->fd, EC_IOCTL_DOMAIN_STATE, &data) == -1) {

   125

        fprintf(stderr, "Failed to get domain state: %s\n",

   126

                strerror(errno));

   127

    }

   128

}

   129

   130

/*****************************************************************************/