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 <sys/types.h>

    29

#include <sys/stat.h>

    30

#include <fcntl.h>

    31

#include <stdio.h>

    32

#include <stdlib.h>

    33

#include <errno.h>

    34

#include <string.h>

    35

#include <sys/ioctl.h>

    36

#include <sys/mman.h>

    37

    38

#include "master.h"

    39

#include "master/ioctl.h"

    40

    41

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

    42

    43

unsigned int ecrt_version_magic(void)

    44

{

    45

    return ECRT_VERSION_MAGIC;

    46

}

    47

    48

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

    49

    50

#define MAX_PATH_LEN 64

    51

    52

ec_master_t *ecrt_request_master(unsigned int master_index)

    53

{

    54

    char path[MAX_PATH_LEN];

    55

    ec_master_t *master;

    56

    57

    master = malloc(sizeof(ec_master_t));

    58

    if (!master) {

    59

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

    60

        return 0;

    61

    }

    62

    63

    master->process_data = NULL;

    64

    master->process_data_size = 0;

    65

    66

    snprintf(path, MAX_PATH_LEN - 1, "/dev/EtherCAT%u", master_index);

    67

    68

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

    69

    if (master->fd == -1) {

    70

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

    71

        free(master);

    72

        return 0;

    73

    }

    74

    75

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

    76

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

    77

                master_index, strerror(errno));

    78

        close(master->fd);

    79

        free(master);

    80

        return 0; 

    81

    }

    82

    83

    return master;

    84

}

    85

    86

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

    87

    88

void ecrt_release_master(ec_master_t *master)

    89

{

    90

    if (master->process_data)  {

    91

        munmap(master->process_data, master->process_data_size);

    92

    }

    93

    94

    close(master->fd);

    95

    free(master);

    96

}

    97

    98

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