master/ethernet.c
author Florian Pose <fp@igh-essen.com>
Wed, 03 May 2006 07:47:04 +0000
changeset 212 82980deb8b00
parent 210 1cc6bcb1e6ae
child 213 8d723b9833a9
permissions -rw-r--r--
moved stats into eoe struct; persistent rx-skb; tx queue.
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     1
/******************************************************************************
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     2
 *
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     3
 *  $Id$
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     4
 *
197
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
     5
 *  Copyright (C) 2006  Florian Pose, Ingenieurgemeinschaft IgH
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
     6
 *
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
     7
 *  This file is part of the IgH EtherCAT Master.
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
     8
 *
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
     9
 *  The IgH EtherCAT Master is free software; you can redistribute it
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    10
 *  and/or modify it under the terms of the GNU General Public License
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    11
 *  as published by the Free Software Foundation; version 2 of the License.
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    12
 *
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    13
 *  The IgH EtherCAT Master is distributed in the hope that it will be
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    14
 *  useful, but WITHOUT ANY WARRANTY; without even the implied warranty of
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    15
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    16
 *  GNU General Public License for more details.
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    17
 *
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    18
 *  You should have received a copy of the GNU General Public License
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    19
 *  along with the IgH EtherCAT Master; if not, write to the Free Software
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    20
 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    21
 *
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    22
 *****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    23
199
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    24
/**
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    25
   \file
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    26
   Ethernet-over-EtherCAT (EoE).
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    27
*/
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    28
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    29
/*****************************************************************************/
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    30
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
    31
#include <linux/etherdevice.h>
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
    32
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    33
#include "../include/ecrt.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    34
#include "globals.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    35
#include "master.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    36
#include "slave.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    37
#include "mailbox.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    38
#include "ethernet.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    39
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    40
/*****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    41
197
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    42
/**
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    43
   Contains the private data of an EoE net_device.
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    44
*/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    45
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    46
typedef struct
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    47
{
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    48
    ec_eoe_t *eoe; /**< pointer to parent eoe object */
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    49
}
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    50
ec_eoedev_priv_t;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    51
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    52
/*****************************************************************************/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    53
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    54
void ec_eoedev_init(struct net_device *);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    55
int ec_eoedev_open(struct net_device *);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    56
int ec_eoedev_stop(struct net_device *);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    57
int ec_eoedev_tx(struct sk_buff *, struct net_device *);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    58
struct net_device_stats *ec_eoedev_stats(struct net_device *);
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
    59
void ec_eoedev_rx(struct net_device *, const uint8_t *, size_t);
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    60
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    61
/*****************************************************************************/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    62
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    63
/**
199
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    64
   EoE constructor.
197
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    65
*/
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
    66
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    67
int ec_eoe_init(ec_eoe_t *eoe, ec_slave_t *slave)
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    68
{
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    69
    ec_eoedev_priv_t *priv;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    70
    int result;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    71
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    72
    eoe->slave = slave;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    73
    eoe->rx_state = EC_EOE_IDLE;
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
    74
    eoe->opened = 0;
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
    75
    eoe->skb = NULL;
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
    76
    INIT_LIST_HEAD(&eoe->tx_queue);
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
    77
    eoe->queued_frames = 0;
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
    78
    eoe->tx_queue_lock = SPIN_LOCK_UNLOCKED;
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    79
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    80
    if (!(eoe->dev =
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    81
          alloc_netdev(sizeof(ec_eoedev_priv_t), "eoe%d", ec_eoedev_init))) {
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    82
        EC_ERR("Unable to allocate net_device for EoE object!\n");
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    83
        goto out_return;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    84
    }
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    85
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    86
    // set EoE object reference
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    87
    priv = netdev_priv(eoe->dev);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    88
    priv->eoe = eoe;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    89
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    90
    // connect the net_device to the kernel
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    91
    if ((result = register_netdev(eoe->dev))) {
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    92
        EC_ERR("Unable to register net_device: error %i\n", result);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    93
        goto out_free;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    94
    }
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    95
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    96
    return 0;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    97
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    98
 out_free:
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    99
    free_netdev(eoe->dev);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   100
    eoe->dev = NULL;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   101
 out_return:
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   102
    return -1;
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   103
}
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   104
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   105
/*****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   106
197
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
   107
/**
199
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
   108
   EoE destructor.
197
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
   109
*/
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
   110
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   111
void ec_eoe_clear(ec_eoe_t *eoe)
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   112
{
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   113
    if (eoe->dev) {
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   114
        unregister_netdev(eoe->dev);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   115
        free_netdev(eoe->dev);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   116
    }
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   117
}
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   118
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   119
/*****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   120
197
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
   121
/**
199
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
   122
   Runs the EoE state machine.
197
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
   123
*/
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
   124
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   125
void ec_eoe_run(ec_eoe_t *eoe)
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   126
{
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   127
    uint8_t *data;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   128
    ec_master_t *master;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   129
    size_t rec_size;
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   130
    uint8_t fragment_number, frame_number, last_fragment, time_appended;
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   131
    uint8_t fragment_offset, frame_type;
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   132
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   133
    if (!eoe->opened) return;
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   134
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   135
    master = eoe->slave->master;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   136
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   137
    if (eoe->rx_state == EC_EOE_IDLE) {
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   138
        ec_slave_mbox_prepare_check(eoe->slave);
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   139
        ec_master_queue_command(master, &eoe->slave->mbox_command);
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   140
        eoe->rx_state = EC_EOE_CHECKING;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   141
        return;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   142
    }
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   143
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   144
    if (eoe->rx_state == EC_EOE_CHECKING) {
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   145
        if (eoe->slave->mbox_command.state != EC_CMD_RECEIVED) {
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   146
            master->stats.eoe_errors++;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   147
            eoe->rx_state = EC_EOE_IDLE;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   148
            return;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   149
        }
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   150
        if (!ec_slave_mbox_check(eoe->slave)) {
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   151
            eoe->rx_state = EC_EOE_IDLE;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   152
            return;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   153
        }
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   154
        ec_slave_mbox_prepare_fetch(eoe->slave);
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   155
        ec_master_queue_command(master, &eoe->slave->mbox_command);
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   156
        eoe->rx_state = EC_EOE_FETCHING;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   157
        return;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   158
    }
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   159
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   160
    if (eoe->rx_state == EC_EOE_FETCHING) {
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   161
        if (eoe->slave->mbox_command.state != EC_CMD_RECEIVED) {
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   162
            master->stats.eoe_errors++;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   163
            eoe->rx_state = EC_EOE_IDLE;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   164
            return;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   165
        }
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   166
        if (!(data = ec_slave_mbox_fetch(eoe->slave, 0x02, &rec_size))) {
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   167
            master->stats.eoe_errors++;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   168
            eoe->rx_state = EC_EOE_IDLE;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   169
            return;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   170
        }
146
73a5f7dd3024 Versuche mit EoE.
Florian Pose <fp@igh-essen.com>
parents: 145
diff changeset
   171
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   172
        frame_type = EC_READ_U16(data) & 0x000F;
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   173
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   174
        if (frame_type == 0x00) { // EoE Fragment Request
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   175
            last_fragment = (EC_READ_U16(data) >> 8) & 0x0001;
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   176
            time_appended = (EC_READ_U16(data) >> 9) & 0x0001;
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   177
            fragment_number = EC_READ_U16(data + 2) & 0x003F;
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   178
            fragment_offset = (EC_READ_U16(data + 2) >> 6) & 0x003F;
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   179
            frame_number = (EC_READ_U16(data + 2) >> 12) & 0x000F;
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   180
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   181
#if 0
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   182
            EC_DBG("EOE fragment req received, fragment: %i, offset: %i,"
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   183
                   " frame %i%s%s, %i bytes\n", fragment_number,
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   184
                   fragment_offset, frame_number,
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   185
                   last_fragment ? ", last fragment" : "",
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   186
                   time_appended ? ", + timestamp" : "",
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   187
                   time_appended ? rec_size - 8 : rec_size - 4);
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   188
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   189
#if 0
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   190
            EC_DBG("");
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   191
            for (i = 0; i < rec_size - 4; i++) {
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   192
                printk("%02X ", data[i + 4]);
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   193
                if ((i + 1) % 16 == 0) {
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   194
                    printk("\n");
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   195
                    EC_DBG("");
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   196
                }
146
73a5f7dd3024 Versuche mit EoE.
Florian Pose <fp@igh-essen.com>
parents: 145
diff changeset
   197
            }
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   198
            printk("\n");
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   199
#endif
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   200
#endif
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   201
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   202
            ec_eoedev_rx(eoe->dev, data + 4,
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   203
                         time_appended ? rec_size - 8 : rec_size - 4);
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   204
        }
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   205
        else {
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   206
#if 1
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   207
            EC_DBG("other frame received.\n");
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   208
#endif
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   209
        }
146
73a5f7dd3024 Versuche mit EoE.
Florian Pose <fp@igh-essen.com>
parents: 145
diff changeset
   210
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   211
        eoe->rx_state = EC_EOE_IDLE;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   212
        return;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   213
    }
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   214
}
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   215
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   216
/*****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   217
197
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
   218
/**
199
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
   219
   Prints EoE object information.
197
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
   220
*/
b9a6e2c22745 GPLv2 License and enhanced Doxygen output.
Florian Pose <fp@igh-essen.com>
parents: 195
diff changeset
   221
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   222
void ec_eoe_print(const ec_eoe_t *eoe)
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   223
{
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   224
    EC_INFO("  EoE slave %i\n", eoe->slave->ring_position);
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   225
    EC_INFO("    RX State %i\n", eoe->rx_state);
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   226
    EC_INFO("    Assigned device: %s (%s)\n", eoe->dev->name,
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   227
            eoe->opened ? "opened" : "closed");
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   228
}
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   229
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   230
/*****************************************************************************/
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   231
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   232
/**
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   233
   Initializes a net_device structure for an EoE object.
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   234
*/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   235
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   236
void ec_eoedev_init(struct net_device *dev /**< pointer to the net_device */)
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   237
{
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   238
    ec_eoedev_priv_t *priv;
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   239
    unsigned int i;
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   240
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   241
    // initialize net_device
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   242
    ether_setup(dev);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   243
    dev->open = ec_eoedev_open;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   244
    dev->stop = ec_eoedev_stop;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   245
    dev->hard_start_xmit = ec_eoedev_tx;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   246
    dev->get_stats = ec_eoedev_stats;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   247
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   248
    for (i = 0; i < 6; i++) dev->dev_addr[i] = (i + 1) | (i + 1) << 4;
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   249
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   250
    // initialize private data
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   251
    priv = netdev_priv(dev);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   252
    memset(priv, 0, sizeof(ec_eoedev_priv_t));
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   253
}
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   254
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   255
/*****************************************************************************/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   256
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   257
/**
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   258
   Opens the virtual network device.
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   259
*/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   260
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   261
int ec_eoedev_open(struct net_device *dev /**< EoE net_device */)
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   262
{
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   263
    ec_eoe_t *eoe = ((ec_eoedev_priv_t *) netdev_priv(dev))->eoe;
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   264
    eoe->opened = 1;
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   265
    netif_start_queue(dev);
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   266
    EC_INFO("%s (slave %i) opened.\n", dev->name, eoe->slave->ring_position);
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   267
    return 0;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   268
}
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   269
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   270
/*****************************************************************************/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   271
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   272
/**
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   273
   Stops the virtual network device.
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   274
*/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   275
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   276
int ec_eoedev_stop(struct net_device *dev /**< EoE net_device */)
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   277
{
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   278
    ec_eoe_t *eoe = ((ec_eoedev_priv_t *) netdev_priv(dev))->eoe;
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   279
    netif_stop_queue(dev);
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   280
    eoe->opened = 0;
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   281
    EC_INFO("%s (slave %i) stopped.\n", dev->name, eoe->slave->ring_position);
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   282
    return 0;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   283
}
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   284
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   285
/*****************************************************************************/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   286
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   287
/**
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   288
   Transmits data via the virtual network device.
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   289
*/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   290
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   291
int ec_eoedev_tx(struct sk_buff *skb, /**< transmit socket buffer */
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   292
                 struct net_device *dev /**< EoE net_device */
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   293
                )
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   294
{
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   295
    ec_eoe_t *eoe = ((ec_eoedev_priv_t *) netdev_priv(dev))->eoe;
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   296
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   297
    spin_lock_bh(&eoe->tx_queue_lock);
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   298
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   299
#if 0
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   300
    eoe->stats.tx_packets++;
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   301
    dev_kfree_skb(skb);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   302
    EC_INFO("EoE device sent %i octets.\n", skb->len);
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   303
#endif
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   304
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   305
    if (eoe->queued_frames == EC_EOE_TX_QUEUE_SIZE)
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   306
        netif_stop_queue(dev);
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   307
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   308
    spin_unlock_bh(&eoe->tx_queue_lock);
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   309
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   310
    return 0;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   311
}
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   312
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   313
/*****************************************************************************/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   314
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   315
/**
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   316
   Receives data from the bus and passes it to the network stack.
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   317
*/
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   318
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   319
void ec_eoedev_rx(struct net_device *dev, /**< EoE net_device */
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   320
                  const uint8_t *data, /**< pointer to the data */
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   321
                  size_t size /**< size of the received data */
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   322
                 )
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   323
{
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   324
    ec_eoe_t *eoe = ((ec_eoedev_priv_t *) netdev_priv(dev))->eoe;
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   325
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   326
    // allocate socket buffer
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   327
    if (!(eoe->skb = dev_alloc_skb(size + 2))) {
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   328
        if (printk_ratelimit())
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   329
            EC_WARN("EoE RX: low on mem. frame dropped.\n");
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   330
        eoe->stats.rx_dropped++;
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   331
        return;
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   332
    }
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   333
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   334
    // copy received data to socket buffer
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   335
    memcpy(skb_put(eoe->skb, size), data, size);
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   336
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   337
    // set socket buffer fields
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   338
    eoe->skb->dev = dev;
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   339
    eoe->skb->protocol = eth_type_trans(eoe->skb, dev);
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   340
    eoe->skb->ip_summed = CHECKSUM_UNNECESSARY;
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   341
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   342
    // update statistics
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   343
    eoe->stats.rx_packets++;
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   344
    eoe->stats.rx_bytes += size;
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   345
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   346
    // pass socket buffer to network stack
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   347
    netif_rx(eoe->skb);
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   348
    eoe->skb = NULL;
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   349
}
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   350
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   351
/*****************************************************************************/
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   352
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   353
/**
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   354
   Gets statistics about the virtual network device.
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   355
*/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   356
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   357
struct net_device_stats *ec_eoedev_stats(struct net_device *dev
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   358
                                         /**< EoE net_device */)
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   359
{
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   360
    ec_eoe_t *eoe = ((ec_eoedev_priv_t *) netdev_priv(dev))->eoe;
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   361
    return &eoe->stats;
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   362
}
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   363
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   364
/*****************************************************************************/