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

   CANopen SDO functions.

    30

*/

    31

    32

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

    33

    34

#include <linux/slab.h>

    35

    36

#include "master.h"

    37

    38

#include "sdo.h"

    39

    40

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

    41

    42

/** Constructor.

    43

 */

    44

void ec_sdo_init(

    45

        ec_sdo_t *sdo, /**< SDO. */

    46

        ec_slave_t *slave, /**< Parent slave. */

    47

        uint16_t index /**< SDO index. */

    48

        )

    49

{

    50

    sdo->slave = slave;

    51

    sdo->index = index;

    52

    sdo->object_code = 0x00;

    53

    sdo->name = NULL;

    54

    sdo->max_subindex = 0;

    55

    INIT_LIST_HEAD(&sdo->entries);

    56

}

    57

    58

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

    59

    60

/** SDO destructor.

    61

 *

    62

 * Clears and frees an SDO object.

    63

 */

    64

void ec_sdo_clear(

    65

        ec_sdo_t *sdo /**< SDO. */

    66

        )

    67

{

    68

    ec_sdo_entry_t *entry, *next;

    69

    70

    // free all entries

    71

    list_for_each_entry_safe(entry, next, &sdo->entries, list) {

    72

        list_del(&entry->list);

    73

        ec_sdo_entry_clear(entry);

    74

        kfree(entry);

    75

    }

    76

    77

    if (sdo->name)

    78

        kfree(sdo->name);

    79

}

    80

    81

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

    82

    83

/** Get an SDO entry from an SDO via its subindex.

    84

 * 

    85

 * \retval >0 Pointer to the requested SDO entry.

    86

 * \retval NULL SDO entry not found.

    87

 */

    88

ec_sdo_entry_t *ec_sdo_get_entry(

    89

        ec_sdo_t *sdo, /**< SDO. */

    90

        uint8_t subindex /**< Entry subindex. */

    91

        )

    92

{

    93

    ec_sdo_entry_t *entry;

    94

    95

    list_for_each_entry(entry, &sdo->entries, list) {

    96

        if (entry->subindex != subindex)

    97

            continue;

    98

        return entry;

    99

    }

   100

   101

    return NULL;

   102

}

   103

   104

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

   105

   106

/** Get an SDO entry from an SDO via its subindex.

   107

 *

   108

 * const version.

   109

 * 

   110

 * \retval >0 Pointer to the requested SDO entry.

   111

 * \retval NULL SDO entry not found.

   112

 */

   113

const ec_sdo_entry_t *ec_sdo_get_entry_const(

   114

        const ec_sdo_t *sdo, /**< SDO. */

   115

        uint8_t subindex /**< Entry subindex. */

   116

        )

   117

{

   118

    const ec_sdo_entry_t *entry;

   119

   120

    list_for_each_entry(entry, &sdo->entries, list) {

   121

        if (entry->subindex != subindex)

   122

            continue;

   123

        return entry;

   124

    }

   125

   126

    return NULL;

   127

}

   128

   129

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