1

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

     2

 *

     3

 *  $Id$

     4

 *

     5

 *  Copyright (C) 2006  Florian Pose, Ingenieurgemeinschaft IgH

     6

 *

     7

 *  This file is part of the IgH EtherCAT Master.

     8

 *

     9

 *  The IgH EtherCAT Master is free software; you can redistribute it

    10

 *  and/or modify it under the terms of the GNU General Public License

    11

 *  as published by the Free Software Foundation; either version 2 of the

    12

 *  License, or (at your option) any later version.

    13

 *

    14

 *  The IgH EtherCAT Master is distributed in the hope that it will be

    15

 *  useful, but WITHOUT ANY WARRANTY; without even the implied warranty of

    16

 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

    17

 *  GNU General Public License for more details.

    18

 *

    19

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

    20

 *  along with the IgH EtherCAT Master; if not, write to the Free Software

    21

 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA

    22

 *

    23

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

    24

 *  charge under condition of compatibility of product made by

    25

 *  Licensee. People intending to distribute/sell products based on the

    26

 *  code, have to sign an agreement to guarantee that products using

    27

 *  software based on IgH EtherCAT master stay compatible with the actual

    28

 *  EtherCAT specification (which are released themselves as an open

    29

 *  standard) as the (only) precondition to have the right to use EtherCAT

    30

 *  Technology, IP and trade marks.

    31

 *

    32

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

    33

    34

#include <stdlib.h>

    35

#include <sys/ioctl.h>

    36

#include <stdio.h>

    37

#include <errno.h>

    38

#include <string.h>

    39

    40

#include "master.h"

    41

#include "domain.h"

    42

#include "slave_config.h"

    43

#include "master/ioctl.h"

    44

    45

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

    46

    47

ec_domain_t *ecrt_master_create_domain(ec_master_t *master)

    48

{

    49

    ec_domain_t *domain;

    50

    int index;

    51

    52

    domain = malloc(sizeof(ec_domain_t));

    53

    if (!domain) {

    54

        fprintf(stderr, "Failed to allocate memory.\n");

    55

        return 0;

    56

    }

    57

    58

    index = ioctl(master->fd, EC_IOCTL_CREATE_DOMAIN, NULL);

    59

    if (index == -1) {

    60

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

    61

        free(domain);

    62

        return 0; 

    63

    }

    64

    65

    domain->index = (unsigned int) index;

    66

    domain->master = master;

    67

    return domain;

    68

}

    69

    70

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

    71

    72

ec_slave_config_t *ecrt_master_slave_config(ec_master_t *master,

    73

        uint16_t alias, uint16_t position, uint32_t vendor_id,

    74

        uint32_t product_code)

    75

{

    76

    ec_ioctl_config_t data;

    77

    ec_slave_config_t *sc;

    78

    int index;

    79

    80

    sc = malloc(sizeof(ec_slave_config_t));

    81

    if (!sc) {

    82

        fprintf(stderr, "Failed to allocate memory.\n");

    83

        return 0;

    84

    }

    85

    86

    data.alias = alias;

    87

    data.position = position;

    88

    data.vendor_id = vendor_id;

    89

    data.product_code = product_code;

    90

    91

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

    92

        fprintf(stderr, "Failed to create slave config: %s\n",

    93

                strerror(errno));

    94

        free(sc);

    95

        return 0; 

    96

    }

    97

    98

    sc->master = master;

    99

    sc->index = data.config_index;

   100

    sc->alias = alias;

   101

    sc->position = position;

   102

    return sc;

   103

}

   104

   105

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

   106

   107

int ecrt_master_activate(ec_master_t *master)

   108

{

   109

    if (ioctl(master->fd, EC_IOCTL_ACTIVATE, NULL) == -1) {

   110

        fprintf(stderr, "Failed to activate master: %s\n",

   111

                strerror(errno));

   112

        return -1; 

   113

    }

   114

   115

    return 0;

   116

}

   117

   118

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

   119

   120

void ecrt_master_send(ec_master_t *master)

   121

{

   122

    if (ioctl(master->fd, EC_IOCTL_SEND, NULL) == -1) {

   123

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

   124

    }

   125

}

   126

   127

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

   128

   129

void ecrt_master_receive(ec_master_t *master)

   130

{

   131

    if (ioctl(master->fd, EC_IOCTL_RECEIVE, NULL) == -1) {

   132

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

   133

    }

   134

}

   135

   136

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

   137

   138

void ecrt_master_state(const ec_master_t *master, ec_master_state_t *state)

   139

{

   140

}

   141

   142

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