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

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

    23

 *  the industrial property and similar rights of Beckhoff Automation GmbH.

    24

 *

    25

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

    26

    27

/**

    28

   \file

    29

   EtherCAT process data object entry methods.

    30

*/

    31

    32

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

    33

    34

#include <linux/slab.h>

    35

    36

#include "pdo_entry.h"

    37

    38

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

    39

    40

/** PDO entry constructor.

    41

 */

    42

void ec_pdo_entry_init(

    43

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

    44

        )

    45

{

    46

    entry->name = NULL;

    47

}

    48

    49

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

    50

    51

/** PDO entry copy constructor.

    52

 *

    53

 * \retval  0 Success.

    54

 * \retval <0 Error code.

    55

 */

    56

int ec_pdo_entry_init_copy(

    57

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

    58

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

    59

        )

    60

{

    61

    entry->index = other->index;

    62

    entry->subindex = other->subindex;

    63

    entry->name = NULL;

    64

    entry->bit_length = other->bit_length;

    65

    66

    return ec_pdo_entry_set_name(entry, other->name);

    67

}

    68

    69

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

    70

    71

/** PDO entry destructor.

    72

 */

    73

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

    74

{

    75

    if (entry->name)

    76

        kfree(entry->name);

    77

}

    78

    79

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

    80

    81

/** Set PDO entry name.

    82

 *

    83

 * \retval  0 Success.

    84

 * \retval <0 Error code.

    85

 */

    86

int ec_pdo_entry_set_name(

    87

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

    88

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

    89

        )

    90

{

    91

    unsigned int len;

    92

    93

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

    94

        return 0;

    95

    96

    if (entry->name)

    97

        kfree(entry->name);

    98

    99

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

   100

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

   101

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

   102

            return -ENOMEM;

   103

        }

   104

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

   105

    } else {

   106

        entry->name = NULL;

   107

    }

   108

   109

    return 0;

   110

}

   111

   112

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

   113

   114

/** Compares two PDO entries.

   115

 *

   116

 * \retval 1 The entries are equal.

   117

 * \retval 0 The entries differ.

   118

 */

   119

int ec_pdo_entry_equal(

   120

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

   121

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

   122

        )

   123

{

   124

    return entry1->index == entry2->index

   125

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

   126

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

   127

}

   128

   129

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