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

 * \retval  0 Success.

    61

 * \retval <0 Error code.

    62

 */

    63

int ec_pdo_entry_init_copy(

    64

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

    65

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

    66

        )

    67

{

    68

    entry->index = other->index;

    69

    entry->subindex = other->subindex;

    70

    entry->name = NULL;

    71

    entry->bit_length = other->bit_length;

    72

    73

    return ec_pdo_entry_set_name(entry, other->name);

    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

 * \retval  0 Success.

    91

 * \retval <0 Error code.

    92

 */

    93

int ec_pdo_entry_set_name(

    94

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

    95

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

    96

        )

    97

{

    98

    unsigned int len;

    99

   100

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

   101

        return 0;

   102

   103

    if (entry->name)

   104

        kfree(entry->name);

   105

   106

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

   107

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

   108

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

   109

            return -ENOMEM;

   110

        }

   111

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

   112

    } else {

   113

        entry->name = NULL;

   114

    }

   115

   116

    return 0;

   117

}

   118

   119

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

   120

   121

/** Compares two Pdo entries.

   122

 *

   123

 * \retval 1 The entries are equal.

   124

 * \retval 0 The entries differ.

   125

 */

   126

int ec_pdo_entry_equal(

   127

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

   128

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

   129

        )

   130

{

   131

    return entry1->index == entry2->index

   132

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

   133

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

   134

}

   135

   136

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