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

   Ethernet interface for debugging purposes.

    30

*/

    31

    32

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

    33

    34

#include <linux/netdevice.h>

    35

#include <linux/etherdevice.h>

    36

    37

#include "globals.h"

    38

#include "debug.h"

    39

    40

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

    41

    42

// net_device functions

    43

int ec_dbgdev_open(struct net_device *);

    44

int ec_dbgdev_stop(struct net_device *);

    45

int ec_dbgdev_tx(struct sk_buff *, struct net_device *);

    46

struct net_device_stats *ec_dbgdev_stats(struct net_device *);

    47

    48

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

    49

    50

/**

    51

   Debug constructor.

    52

   Initializes the debug object, creates a net_device and registeres it.

    53

*/

    54

    55

int ec_debug_init(

    56

        ec_debug_t *dbg, /**< debug object */

    57

        const char *name /**< interface name */

    58

        )

    59

{

    60

    int result;

    61

    62

    dbg->opened = 0;

    63

    memset(&dbg->stats, 0, sizeof(struct net_device_stats));

    64

    65

    if (!(dbg->dev =

    66

          alloc_netdev(sizeof(ec_debug_t *), name, ether_setup))) {

    67

        EC_ERR("Unable to allocate net_device for debug object!\n");

    68

        goto out_return;

    69

    }

    70

    71

    // initialize net_device

    72

    dbg->dev->open = ec_dbgdev_open;

    73

    dbg->dev->stop = ec_dbgdev_stop;

    74

    dbg->dev->hard_start_xmit = ec_dbgdev_tx;

    75

    dbg->dev->get_stats = ec_dbgdev_stats;

    76

    77

    // initialize private data

    78

    *((ec_debug_t **) netdev_priv(dbg->dev)) = dbg;

    79

    80

    // connect the net_device to the kernel

    81

    if ((result = register_netdev(dbg->dev))) {

    82

        EC_ERR("Unable to register net_device: error %i\n", result);

    83

        goto out_free;

    84

    }

    85

    86

    return 0;

    87

    88

 out_free:

    89

    free_netdev(dbg->dev);

    90

    dbg->dev = NULL;

    91

 out_return:

    92

    return -1;

    93

}

    94

    95

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

    96

    97

/**

    98

   Debug destructor.

    99

   Unregisteres the net_device and frees allocated memory.

   100

*/

   101

   102

void ec_debug_clear(ec_debug_t *dbg /**< debug object */)

   103

{

   104

    if (dbg->dev) {

   105

        unregister_netdev(dbg->dev);

   106

        free_netdev(dbg->dev);

   107

    }

   108

}

   109

   110

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

   111

   112

/**

   113

   Sends frame data to the interface.

   114

*/

   115

   116

void ec_debug_send(ec_debug_t *dbg, /**< debug object */

   117

                   const uint8_t *data, /**< frame data */

   118

                   size_t size /**< size of the frame data */

   119

                   )

   120

{

   121

    struct sk_buff *skb;

   122

   123

    if (!dbg->opened) return;

   124

   125

    // allocate socket buffer

   126

    if (!(skb = dev_alloc_skb(size))) {

   127

        dbg->stats.rx_dropped++;

   128

        return;

   129

    }

   130

   131

    // copy frame contents into socket buffer

   132

    memcpy(skb_put(skb, size), data, size);

   133

   134

    // update device statistics

   135

    dbg->stats.rx_packets++;

   136

    dbg->stats.rx_bytes += size;

   137

   138

    // pass socket buffer to network stack

   139

    skb->dev = dbg->dev;

   140

    skb->protocol = eth_type_trans(skb, dbg->dev);

   141

    skb->ip_summed = CHECKSUM_UNNECESSARY;

   142

    netif_rx(skb);

   143

}

   144

   145

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

   146

 *  NET_DEVICE functions

   147

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

   148

   149

/**

   150

   Opens the virtual network device.

   151

*/

   152

   153

int ec_dbgdev_open(struct net_device *dev /**< debug net_device */)

   154

{

   155

    ec_debug_t *dbg = *((ec_debug_t **) netdev_priv(dev));

   156

    dbg->opened = 1;

   157

    EC_INFO("Debug interface %s opened.\n", dev->name);

   158

    return 0;

   159

}

   160

   161

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

   162

   163

/**

   164

   Stops the virtual network device.

   165

*/

   166

   167

int ec_dbgdev_stop(struct net_device *dev /**< debug net_device */)

   168

{

   169

    ec_debug_t *dbg = *((ec_debug_t **) netdev_priv(dev));

   170

    dbg->opened = 0;

   171

    EC_INFO("Debug interface %s stopped.\n", dev->name);

   172

    return 0;

   173

}

   174

   175

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

   176

   177

/**

   178

   Transmits data via the virtual network device.

   179

*/

   180

   181

int ec_dbgdev_tx(struct sk_buff *skb, /**< transmit socket buffer */

   182

                 struct net_device *dev /**< EoE net_device */

   183

                 )

   184

{

   185

    ec_debug_t *dbg = *((ec_debug_t **) netdev_priv(dev));

   186

   187

    dev_kfree_skb(skb);

   188

    dbg->stats.tx_dropped++;

   189

    return 0;

   190

}

   191

   192

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

   193

   194

/**

   195

   Gets statistics about the virtual network device.

   196

*/

   197

   198

struct net_device_stats *ec_dbgdev_stats(struct net_device *dev

   199

                                         /**< debug net_device */)

   200

{

   201

    ec_debug_t *dbg = *((ec_debug_t **) netdev_priv(dev));

   202

    return &dbg->stats;

   203

}

   204

   205

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