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

/**

    35

   \file

    36

   EtherCAT process data object entry methods.

    37

*/

    38

    39

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

    40

    41

#include <linux/slab.h>

    42

    43

#include "pdo_entry.h"

    44

    45

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

    46

    47

/** Pdo entry constructor.

    48

 */

    49

void ec_pdo_entry_init(

    50

        ec_pdo_entry_t *entry /**< Pdo entry. */

    51

        )

    52

{

    53

    entry->name = NULL;

    54

}

    55

    56

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

    57

    58

/** Pdo entry copy constructor.

    59

 */

    60

int ec_pdo_entry_init_copy(

    61

        ec_pdo_entry_t *entry, /**< Pdo entry. */

    62

        const ec_pdo_entry_t *other /**< Pdo entry to copy from. */

    63

        )

    64

{

    65

    entry->index = other->index;

    66

    entry->subindex = other->subindex;

    67

    entry->name = NULL;

    68

    entry->bit_length = other->bit_length;

    69

    70

    if (ec_pdo_entry_set_name(entry, other->name))

    71

        return -1;

    72

    73

    return 0;

    74

}

    75

    76

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

    77

    78

/** Pdo entry destructor.

    79

 */

    80

void ec_pdo_entry_clear(ec_pdo_entry_t *entry /**< Pdo entry. */)

    81

{

    82

    if (entry->name)

    83

        kfree(entry->name);

    84

}

    85

    86

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

    87

    88

/** Set Pdo entry name.

    89

 */

    90

int ec_pdo_entry_set_name(

    91

        ec_pdo_entry_t *entry, /**< Pdo entry. */

    92

        const char *name /**< New name. */

    93

        )

    94

{

    95

    unsigned int len;

    96

    97

    if (entry->name && name && !strcmp(entry->name, name))

    98

        return 0;

    99

   100

    if (entry->name)

   101

        kfree(entry->name);

   102

   103

    if (name && (len = strlen(name))) {

   104

        if (!(entry->name = (char *) kmalloc(len + 1, GFP_KERNEL))) {

   105

            EC_ERR("Failed to allocate Pdo entry name.\n");

   106

            return -1;

   107

        }

   108

        memcpy(entry->name, name, len + 1);

   109

    } else {

   110

        entry->name = NULL;

   111

    }

   112

   113

    return 0;

   114

}

   115

   116

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

   117

   118

/** Compares two Pdo entries.

   119

 *

   120

 * \retval 1 The entries are equal.

   121

 * \retval 0 The entries differ.

   122

 */

   123

int ec_pdo_entry_equal(

   124

        const ec_pdo_entry_t *entry1, /**< First Pdo entry. */

   125

        const ec_pdo_entry_t *entry2 /**< Second Pdo entry. */

   126

        )

   127

{

   128

    return entry1->index == entry2->index

   129

        && entry1->subindex == entry2->subindex

   130

        && entry1->bit_length == entry2->bit_length;

   131

}

   132

   133

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