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

#include <stdlib.h>

    34

#include <sys/ioctl.h>

    35

#include <stdio.h>

    36

#include <errno.h>

    37

#include <string.h>

    38

#include <sys/mman.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

    domain->process_data = NULL;

    68

    return domain;

    69

}

    70

    71

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

    72

    73

ec_slave_config_t *ecrt_master_slave_config(ec_master_t *master,

    74

        uint16_t alias, uint16_t position, uint32_t vendor_id,

    75

        uint32_t product_code)

    76

{

    77

    ec_ioctl_config_t data;

    78

    ec_slave_config_t *sc;

    79

    int index;

    80

    81

    sc = malloc(sizeof(ec_slave_config_t));

    82

    if (!sc) {

    83

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

    84

        return 0;

    85

    }

    86

    87

    data.alias = alias;

    88

    data.position = position;

    89

    data.vendor_id = vendor_id;

    90

    data.product_code = product_code;

    91

    92

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

    93

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

    94

                strerror(errno));

    95

        free(sc);

    96

        return 0; 

    97

    }

    98

    99

    sc->master = master;

   100

    sc->index = data.config_index;

   101

    sc->alias = alias;

   102

    sc->position = position;

   103

    return sc;

   104

}

   105

   106

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

   107

   108

int ecrt_master_activate(ec_master_t *master)

   109

{

   110

    if (ioctl(master->fd, EC_IOCTL_ACTIVATE,

   111

                &master->process_data_size) == -1) {

   112

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

   113

                strerror(errno));

   114

        return -1; 

   115

    }

   116

   117

    if (master->process_data_size) {

   118

        master->process_data = mmap(0, master->process_data_size,

   119

                PROT_READ | PROT_WRITE, MAP_SHARED, master->fd, 0);

   120

        if (master->process_data == MAP_FAILED) {

   121

            fprintf(stderr, "Failed to map process data: %s", strerror(errno));

   122

            master->process_data = NULL;

   123

            master->process_data_size = 0;

   124

            return -1;

   125

        }

   126

   127

        // Access the mapped region to cause the initial page fault

   128

        printf("pd: %x\n", master->process_data[0]);

   129

    }

   130

   131

    return 0;

   132

}

   133

   134

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

   135

   136

void ecrt_master_send(ec_master_t *master)

   137

{

   138

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

   139

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

   140

    }

   141

}

   142

   143

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

   144

   145

void ecrt_master_receive(ec_master_t *master)

   146

{

   147

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

   148

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

   149

    }

   150

}

   151

   152

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

   153

   154

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

   155

{

   156

    if (ioctl(master->fd, EC_IOCTL_MASTER_STATE, state) == -1) {

   157

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

   158

    }

   159

}

   160

   161

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