1

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

     2

 *  

     3

 *  $Id$

     4

 *  

     5

 *  Copyright (C) 2006-2009  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

    12

 *  of 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

 *  Using the EtherCAT technology and brand is permitted in compliance with

    24

 *  the industrial property and similar rights of Beckhoff Automation GmbH.

    25

 *

    26

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

    27

    28

#include <stdlib.h>

    29

#include <sys/ioctl.h>

    30

#include <stdio.h>

    31

#include <errno.h>

    32

#include <string.h>

    33

#include <sys/mman.h>

    34

    35

#include "master.h"

    36

#include "domain.h"

    37

#include "slave_config.h"

    38

#include "master/ioctl.h"

    39

    40

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

    41

    42

ec_domain_t *ecrt_master_create_domain(ec_master_t *master)

    43

{

    44

    ec_domain_t *domain;

    45

    int index;

    46

    47

    domain = malloc(sizeof(ec_domain_t));

    48

    if (!domain) {

    49

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

    50

        return 0;

    51

    }

    52

    53

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

    54

    if (index == -1) {

    55

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

    56

        free(domain);

    57

        return 0; 

    58

    }

    59

    60

    domain->index = (unsigned int) index;

    61

    domain->master = master;

    62

    domain->process_data = NULL;

    63

    return domain;

    64

}

    65

    66

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

    67

    68

ec_slave_config_t *ecrt_master_slave_config(ec_master_t *master,

    69

        uint16_t alias, uint16_t position, uint32_t vendor_id,

    70

        uint32_t product_code)

    71

{

    72

    ec_ioctl_config_t data;

    73

    ec_slave_config_t *sc;

    74

    int index;

    75

    76

    sc = malloc(sizeof(ec_slave_config_t));

    77

    if (!sc) {

    78

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

    79

        return 0;

    80

    }

    81

    82

    data.alias = alias;

    83

    data.position = position;

    84

    data.vendor_id = vendor_id;

    85

    data.product_code = product_code;

    86

    87

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

    88

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

    89

                strerror(errno));

    90

        free(sc);

    91

        return 0; 

    92

    }

    93

    94

    sc->master = master;

    95

    sc->index = data.config_index;

    96

    sc->alias = alias;

    97

    sc->position = position;

    98

    return sc;

    99

}

   100

   101

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

   102

   103

int ecrt_master_activate(ec_master_t *master)

   104

{

   105

    if (ioctl(master->fd, EC_IOCTL_ACTIVATE,

   106

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

   107

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

   108

                strerror(errno));

   109

        return -1; // FIXME

   110

    }

   111

   112

    if (master->process_data_size) {

   113

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

   114

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

   115

        if (master->process_data == MAP_FAILED) {

   116

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

   117

            master->process_data = NULL;

   118

            master->process_data_size = 0;

   119

            return -1; // FIXME

   120

        }

   121

   122

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

   123

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

   124

    }

   125

   126

    return 0;

   127

}

   128

   129

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

   130

   131

void ecrt_master_send(ec_master_t *master)

   132

{

   133

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

   134

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

   135

    }

   136

}

   137

   138

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

   139

   140

void ecrt_master_receive(ec_master_t *master)

   141

{

   142

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

   143

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

   144

    }

   145

}

   146

   147

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

   148

   149

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

   150

{

   151

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

   152

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

   153

    }

   154

}

   155

   156

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