1

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

     2

 *

     3

 *  $Id$

     4

 *

     5

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

 *  ---

    24

 *

    25

 *  The license mentioned above concerns the source code only. Using the

    26

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

    27

 *  industrial property and similar rights of Beckhoff Automation GmbH.

    28

 *

    29

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

    30

    31

#include <sys/types.h>

    32

#include <sys/stat.h>

    33

#include <fcntl.h>

    34

#include <stdio.h>

    35

#include <stdlib.h>

    36

#include <string.h>

    37

#include <sys/mman.h>

    38

#include <unistd.h>

    39

#include <sys/socket.h>

    40

    41

#include "ioctl.h"

    42

#include "master.h"

    43

    44

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

    45

    46

unsigned int ecrt_version_magic(void)

    47

{

    48

    return ECRT_VERSION_MAGIC;

    49

}

    50

    51

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

    52

    53

ec_master_t *ecrt_request_master(unsigned int master_index)

    54

{

    55

    ec_master_t *master = ecrt_open_master(master_index);

    56

    if (master) {

    57

        if (ecrt_master_reserve(master) < 0) {

    58

            ec_master_clear(master);

    59

            free(master);

    60

            master = NULL;

    61

        }

    62

    }

    63

    64

    return master;

    65

}

    66

    67

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

    68

    69

#define MAX_PATH_LEN 64

    70

    71

ec_master_t *ecrt_open_master(unsigned int master_index)

    72

{

    73

    char path[MAX_PATH_LEN];

    74

    ec_master_t *master = NULL;

    75

    ec_ioctl_module_t module_data;

    76

    int ret;

    77

    78

    master = malloc(sizeof(ec_master_t));

    79

    if (!master) {

    80

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

    81

        return 0;

    82

    }

    83

    84

    master->process_data = NULL;

    85

    master->process_data_size = 0;

    86

    master->first_domain = NULL;

    87

    master->first_config = NULL;

    88

    89

    snprintf(path, MAX_PATH_LEN - 1,

    90

#ifdef USE_RTDM

    91

            "EtherCAT%u",

    92

#else

    93

            "/dev/EtherCAT%u",

    94

#endif

    95

            master_index);

    96

    97

#ifdef USE_RTDM

    98

    master->fd = rt_dev_open(path, O_RDWR);

    99

#else

   100

    master->fd = open(path, O_RDWR);

   101

#endif

   102

    if (EC_IOCTL_IS_ERROR(master->fd)) {

   103

        fprintf(stderr, "Failed to open %s: %s\n", path,

   104

                strerror(EC_IOCTL_ERRNO(master->fd)));

   105

        goto out_clear;

   106

    }

   107

   108

    ret = ioctl(master->fd, EC_IOCTL_MODULE, &module_data);

   109

    if (EC_IOCTL_IS_ERROR(ret)) {

   110

        fprintf(stderr, "Failed to get module information from %s: %s\n",

   111

                path, strerror(EC_IOCTL_ERRNO(ret)));

   112

        goto out_clear;

   113

    }

   114

   115

    if (module_data.ioctl_version_magic != EC_IOCTL_VERSION_MAGIC) {

   116

        fprintf(stderr, "ioctl() version magic is differing:"

   117

                " %s: %u, libethercat: %u.\n",

   118

                path, module_data.ioctl_version_magic,

   119

                EC_IOCTL_VERSION_MAGIC);

   120

        goto out_clear;

   121

    }

   122

   123

    return master;

   124

   125

out_clear:

   126

    ec_master_clear(master);

   127

    free(master);

   128

    return 0;

   129

}

   130

   131

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

   132

   133

void ecrt_release_master(ec_master_t *master)

   134

{

   135

    ec_master_clear(master);

   136

    free(master);

   137

}

   138

   139

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