1

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

     2

 *

     3

 *  $Id$

     4

 *

     5

 *  Copyright (C) 2006-2008  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 and/or

    10

 *  modify it under the terms of the GNU General Public License version 2, as

    11

 *  published by the Free Software Foundation.

    12

 *

    13

 *  The IgH EtherCAT Master is distributed in the hope that it will be useful,

    14

 *  but WITHOUT ANY WARRANTY; without even the implied warranty of

    15

 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General

    16

 *  Public License for more details.

    17

 *

    18

 *  You should have received a copy of the GNU General Public License along

    19

 *  with the IgH EtherCAT Master; if not, write to the Free Software

    20

 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA

    21

 *

    22

 *  ---

    23

 *

    24

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

    25

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

    26

 *  industrial property and similar rights of Beckhoff Automation GmbH.

    27

 *

    28

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

    29

    30

/**

    31

   \file

    32

   EtherCAT process data object entry methods.

    33

*/

    34

    35

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

    36

    37

#include <linux/slab.h>

    38

    39

#include "pdo_entry.h"

    40

    41

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

    42

    43

/** PDO entry constructor.

    44

 */

    45

void ec_pdo_entry_init(

    46

        ec_pdo_entry_t *entry /**< PDO entry. */

    47

        )

    48

{

    49

    entry->name = NULL;

    50

}

    51

    52

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

    53

    54

/** PDO entry copy constructor.

    55

 *

    56

 * \retval  0 Success.

    57

 * \retval <0 Error code.

    58

 */

    59

int ec_pdo_entry_init_copy(

    60

        ec_pdo_entry_t *entry, /**< PDO entry. */

    61

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

    62

        )

    63

{

    64

    entry->index = other->index;

    65

    entry->subindex = other->subindex;

    66

    entry->name = NULL;

    67

    entry->bit_length = other->bit_length;

    68

    69

    return ec_pdo_entry_set_name(entry, other->name);

    70

}

    71

    72

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

    73

    74

/** PDO entry destructor.

    75

 */

    76

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

    77

{

    78

    if (entry->name)

    79

        kfree(entry->name);

    80

}

    81

    82

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

    83

    84

/** Set PDO entry name.

    85

 *

    86

 * \retval  0 Success.

    87

 * \retval <0 Error code.

    88

 */

    89

int ec_pdo_entry_set_name(

    90

        ec_pdo_entry_t *entry, /**< PDO entry. */

    91

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

    92

        )

    93

{

    94

    unsigned int len;

    95

    96

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

    97

        return 0;

    98

    99

    if (entry->name)

   100

        kfree(entry->name);

   101

   102

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

   103

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

   104

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

   105

            return -ENOMEM;

   106

        }

   107

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

   108

    } else {

   109

        entry->name = NULL;

   110

    }

   111

   112

    return 0;

   113

}

   114

   115

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

   116

   117

/** Compares two PDO entries.

   118

 *

   119

 * \retval 1 The entries are equal.

   120

 * \retval 0 The entries differ.

   121

 */

   122

int ec_pdo_entry_equal(

   123

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

   124

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

   125

        )

   126

{

   127

    return entry1->index == entry2->index

   128

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

   129

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

   130

}

   131

   132

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