master/ethernet.c
author Florian Pose <fp@igh-essen.com>
Wed, 09 Nov 2011 17:06:04 +0100
branchredundancy
changeset 2159 72ac85ee3729
parent 1921 d9cf40facbc4
child 2020 47db5df5c7b3
child 2235 cd49c2c31dcb
child 2267 2d36f36a433c
permissions -rw-r--r--
Renamed main device to ecmX.
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
 *
1326
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents: 1313
diff changeset
     5
 *  Copyright (C) 2006-2008  Florian Pose, Ingenieurgemeinschaft IgH
197
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
 *
1326
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents: 1313
diff changeset
     9
 *  The IgH EtherCAT Master is free software; you can redistribute it and/or
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents: 1313
diff changeset
    10
 *  modify it under the terms of the GNU General Public License version 2, as
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents: 1313
diff changeset
    11
 *  published by the Free Software Foundation.
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents: 1313
diff changeset
    12
 *
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents: 1313
diff changeset
    13
 *  The IgH EtherCAT Master is distributed in the hope that it will be useful,
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents: 1313
diff changeset
    14
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents: 1313
diff changeset
    15
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents: 1313
diff changeset
    16
 *  Public License for more details.
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents: 1313
diff changeset
    17
 *
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents: 1313
diff changeset
    18
 *  You should have received a copy of the GNU General Public License along
ef907b0b5125 merge -c1603 branches/stable-1.4: Changed licence headers to avoid conflicts with the GPL; restricted licence to GPLv2 only.
Florian Pose <fp@igh-essen.com>
parents: 1313
diff changeset
    19
 *  with the IgH EtherCAT Master; if not, write to the Free Software
197
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
 *
1363
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1340
diff changeset
    22
 *  ---
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1340
diff changeset
    23
 *
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1340
diff changeset
    24
 *  The license mentioned above concerns the source code only. Using the
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1340
diff changeset
    25
 *  EtherCAT technology and brand is only permitted in compliance with the
11c0b2caa253 Improved and added license headers.
Florian Pose <fp@igh-essen.com>
parents: 1340
diff changeset
    26
 *  industrial property and similar rights of Beckhoff Automation GmbH.
246
0bf7c769de06 Changed license headers and added EtherCAT license notice.
Florian Pose <fp@igh-essen.com>
parents: 235
diff changeset
    27
 *
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    28
 *****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    29
199
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    30
/**
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    31
   \file
1327
4d179b06dd3c merge -c1604 branches/stable-1.4: Fixed spelling of EtherCAT terms.
Florian Pose <fp@igh-essen.com>
parents: 1326
diff changeset
    32
   Ethernet over EtherCAT (EoE).
199
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    33
*/
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    34
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    35
/*****************************************************************************/
04ecf40fc2e9 Doxygen added interface modules and file documentation.
Florian Pose <fp@igh-essen.com>
parents: 197
diff changeset
    36
1579
326d47aa986c applied komax patch to version r1822
Martin Troxler <martin.troxler@komaxgroup.com>
parents: 1500
diff changeset
    37
#include <linux/version.h>
294
feea8d850c65 Applied include patch by M. Schwerin.
Florian Pose <fp@igh-essen.com>
parents: 293
diff changeset
    38
#include <linux/netdevice.h>
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
    39
#include <linux/etherdevice.h>
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
    40
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    41
#include "globals.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    42
#include "master.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    43
#include "slave.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    44
#include "mailbox.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    45
#include "ethernet.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    46
629
84a64efca00d Moved a few constants to the files they are needed in.
Florian Pose <fp@igh-essen.com>
parents: 610
diff changeset
    47
/*****************************************************************************/
84a64efca00d Moved a few constants to the files they are needed in.
Florian Pose <fp@igh-essen.com>
parents: 610
diff changeset
    48
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
    49
/** Defines the debug level of EoE processing.
629
84a64efca00d Moved a few constants to the files they are needed in.
Florian Pose <fp@igh-essen.com>
parents: 610
diff changeset
    50
 *
84a64efca00d Moved a few constants to the files they are needed in.
Florian Pose <fp@igh-essen.com>
parents: 610
diff changeset
    51
 * 0 = No debug messages.
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
    52
 * 1 = Output warnings.
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
    53
 * 2 = Output actions.
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
    54
 * 3 = Output actions and frame data.
629
84a64efca00d Moved a few constants to the files they are needed in.
Florian Pose <fp@igh-essen.com>
parents: 610
diff changeset
    55
 */
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
    56
#define EOE_DEBUG_LEVEL 1
215
b021aa6eee38 EoE: TCP traffic possible; TX fragmenting to do.
Florian Pose <fp@igh-essen.com>
parents: 214
diff changeset
    57
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
    58
/** Size of the EoE tx queue.
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
    59
 */
629
84a64efca00d Moved a few constants to the files they are needed in.
Florian Pose <fp@igh-essen.com>
parents: 610
diff changeset
    60
#define EC_EOE_TX_QUEUE_SIZE 100
84a64efca00d Moved a few constants to the files they are needed in.
Florian Pose <fp@igh-essen.com>
parents: 610
diff changeset
    61
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
    62
/** Number of tries.
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
    63
 */
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
    64
#define EC_EOE_TRIES 100
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
    65
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    66
/*****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    67
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
    68
void ec_eoe_flush(ec_eoe_t *);
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
    69
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
    70
// state functions
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
    71
void ec_eoe_state_rx_start(ec_eoe_t *);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
    72
void ec_eoe_state_rx_check(ec_eoe_t *);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
    73
void ec_eoe_state_rx_fetch(ec_eoe_t *);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
    74
void ec_eoe_state_tx_start(ec_eoe_t *);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
    75
void ec_eoe_state_tx_sent(ec_eoe_t *);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
    76
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
    77
// net_device functions
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    78
int ec_eoedev_open(struct net_device *);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    79
int ec_eoedev_stop(struct net_device *);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    80
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
    81
struct net_device_stats *ec_eoedev_stats(struct net_device *);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    82
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    83
/*****************************************************************************/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    84
1561
89f6cd5b90ff Use net_device_ops also for EoE devices from 2.6.29 on.
Florian Pose <fp@igh-essen.com>
parents: 1552
diff changeset
    85
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)
1907
dd276ae226b4 Added missing code documentation.
Florian Pose <fp@igh-essen.com>
parents: 1581
diff changeset
    86
/** Device operations for EoE interfaces.
dd276ae226b4 Added missing code documentation.
Florian Pose <fp@igh-essen.com>
parents: 1581
diff changeset
    87
 */
1561
89f6cd5b90ff Use net_device_ops also for EoE devices from 2.6.29 on.
Florian Pose <fp@igh-essen.com>
parents: 1552
diff changeset
    88
static const struct net_device_ops ec_eoedev_ops = {
1579
326d47aa986c applied komax patch to version r1822
Martin Troxler <martin.troxler@komaxgroup.com>
parents: 1500
diff changeset
    89
    .ndo_open = ec_eoedev_open,
326d47aa986c applied komax patch to version r1822
Martin Troxler <martin.troxler@komaxgroup.com>
parents: 1500
diff changeset
    90
    .ndo_stop = ec_eoedev_stop,
326d47aa986c applied komax patch to version r1822
Martin Troxler <martin.troxler@komaxgroup.com>
parents: 1500
diff changeset
    91
    .ndo_start_xmit = ec_eoedev_tx,
326d47aa986c applied komax patch to version r1822
Martin Troxler <martin.troxler@komaxgroup.com>
parents: 1500
diff changeset
    92
    .ndo_get_stats = ec_eoedev_stats,
326d47aa986c applied komax patch to version r1822
Martin Troxler <martin.troxler@komaxgroup.com>
parents: 1500
diff changeset
    93
};
326d47aa986c applied komax patch to version r1822
Martin Troxler <martin.troxler@komaxgroup.com>
parents: 1500
diff changeset
    94
#endif
326d47aa986c applied komax patch to version r1822
Martin Troxler <martin.troxler@komaxgroup.com>
parents: 1500
diff changeset
    95
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    96
/*****************************************************************************/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
    97
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
    98
/** EoE constructor.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
    99
 *
661
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   100
 * Initializes the EoE handler, creates a net_device and registers it.
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   101
 */
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   102
int ec_eoe_init(
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   103
        ec_eoe_t *eoe, /**< EoE handler */
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   104
        ec_slave_t *slave /**< EtherCAT slave */
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   105
        )
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   106
{
213
8d723b9833a9 removed unnecessary private structure in eoe net_device.
Florian Pose <fp@igh-essen.com>
parents: 212
diff changeset
   107
    ec_eoe_t **priv;
1313
ed15eef57d5c Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents: 1209
diff changeset
   108
    int i, ret = 0;
719
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics
Florian Pose <fp@igh-essen.com>
parents: 712
diff changeset
   109
    char name[EC_DATAGRAM_NAME_SIZE];
661
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   110
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   111
    eoe->slave = slave;
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   112
293
14aeb79aa992 Renamed command structure to datagram.
Florian Pose <fp@igh-essen.com>
parents: 291
diff changeset
   113
    ec_datagram_init(&eoe->datagram);
721
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   114
    eoe->queue_datagram = 0;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   115
    eoe->state = ec_eoe_state_rx_start;
210
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands.
Florian Pose <fp@igh-essen.com>
parents: 208
diff changeset
   116
    eoe->opened = 0;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   117
    eoe->rx_skb = NULL;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   118
    eoe->rx_expected_fragment = 0;
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   119
    INIT_LIST_HEAD(&eoe->tx_queue);
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   120
    eoe->tx_frame = NULL;
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   121
    eoe->tx_queue_active = 0;
1485
5ddc3a455059 ethercat eoe command.
Florian Pose <fp@igh-essen.com>
parents: 1484
diff changeset
   122
    eoe->tx_queue_size = EC_EOE_TX_QUEUE_SIZE;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   123
    eoe->tx_queued_frames = 0;
1579
326d47aa986c applied komax patch to version r1822
Martin Troxler <martin.troxler@komaxgroup.com>
parents: 1500
diff changeset
   124
326d47aa986c applied komax patch to version r1822
Martin Troxler <martin.troxler@komaxgroup.com>
parents: 1500
diff changeset
   125
    sema_init(&eoe->tx_queue_sem, 1);
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   126
    eoe->tx_frame_number = 0xFF;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   127
    memset(&eoe->stats, 0, sizeof(struct net_device_stats));
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   128
336
360e5287c888 EoE rate statistics.
Florian Pose <fp@igh-essen.com>
parents: 325
diff changeset
   129
    eoe->rx_counter = 0;
360e5287c888 EoE rate statistics.
Florian Pose <fp@igh-essen.com>
parents: 325
diff changeset
   130
    eoe->tx_counter = 0;
360e5287c888 EoE rate statistics.
Florian Pose <fp@igh-essen.com>
parents: 325
diff changeset
   131
    eoe->rx_rate = 0;
360e5287c888 EoE rate statistics.
Florian Pose <fp@igh-essen.com>
parents: 325
diff changeset
   132
    eoe->tx_rate = 0;
344
5d8281f1aa2a Replaced longer cycle timestamps with jiffies.
Florian Pose <fp@igh-essen.com>
parents: 340
diff changeset
   133
    eoe->rate_jiffies = 0;
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   134
    eoe->rx_idle = 1;
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   135
    eoe->tx_idle = 1;
336
360e5287c888 EoE rate statistics.
Florian Pose <fp@igh-essen.com>
parents: 325
diff changeset
   136
712
14f899ac51f0 Create network interfaces for EoE devices with alias as eoeXaY.
Florian Pose <fp@igh-essen.com>
parents: 689
diff changeset
   137
    /* device name eoe<MASTER>[as]<SLAVE>, because networking scripts don't
14f899ac51f0 Create network interfaces for EoE devices with alias as eoeXaY.
Florian Pose <fp@igh-essen.com>
parents: 689
diff changeset
   138
     * like hyphens etc. in interface names. */
1909
ea3eb4c74c1b Introduced effective_alias variable to separate reg12 alias from SII alias.
Florian Pose <fp@igh-essen.com>
parents: 1907
diff changeset
   139
    if (slave->effective_alias) {
719
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics
Florian Pose <fp@igh-essen.com>
parents: 712
diff changeset
   140
        snprintf(name, EC_DATAGRAM_NAME_SIZE,
1909
ea3eb4c74c1b Introduced effective_alias variable to separate reg12 alias from SII alias.
Florian Pose <fp@igh-essen.com>
parents: 1907
diff changeset
   141
                "eoe%ua%u", slave->master->index, slave->effective_alias);
712
14f899ac51f0 Create network interfaces for EoE devices with alias as eoeXaY.
Florian Pose <fp@igh-essen.com>
parents: 689
diff changeset
   142
    } else {
719
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics
Florian Pose <fp@igh-essen.com>
parents: 712
diff changeset
   143
        snprintf(name, EC_DATAGRAM_NAME_SIZE,
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics
Florian Pose <fp@igh-essen.com>
parents: 712
diff changeset
   144
                "eoe%us%u", slave->master->index, slave->ring_position);
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics
Florian Pose <fp@igh-essen.com>
parents: 712
diff changeset
   145
    }
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics
Florian Pose <fp@igh-essen.com>
parents: 712
diff changeset
   146
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics
Florian Pose <fp@igh-essen.com>
parents: 712
diff changeset
   147
    snprintf(eoe->datagram.name, EC_DATAGRAM_NAME_SIZE, name);
661
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   148
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   149
    if (!(eoe->dev = alloc_netdev(sizeof(ec_eoe_t *), name, ether_setup))) {
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   150
        EC_SLAVE_ERR(slave, "Unable to allocate net_device %s"
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   151
                " for EoE handler!\n", name);
1313
ed15eef57d5c Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents: 1209
diff changeset
   152
        ret = -ENODEV;
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   153
        goto out_return;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   154
    }
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   155
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   156
    // initialize net_device
1561
89f6cd5b90ff Use net_device_ops also for EoE devices from 2.6.29 on.
Florian Pose <fp@igh-essen.com>
parents: 1552
diff changeset
   157
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 29)
89f6cd5b90ff Use net_device_ops also for EoE devices from 2.6.29 on.
Florian Pose <fp@igh-essen.com>
parents: 1552
diff changeset
   158
    eoe->dev->netdev_ops = &ec_eoedev_ops;
1579
326d47aa986c applied komax patch to version r1822
Martin Troxler <martin.troxler@komaxgroup.com>
parents: 1500
diff changeset
   159
#else
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   160
    eoe->dev->open = ec_eoedev_open;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   161
    eoe->dev->stop = ec_eoedev_stop;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   162
    eoe->dev->hard_start_xmit = ec_eoedev_tx;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   163
    eoe->dev->get_stats = ec_eoedev_stats;
1579
326d47aa986c applied komax patch to version r1822
Martin Troxler <martin.troxler@komaxgroup.com>
parents: 1500
diff changeset
   164
#endif
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   165
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   166
    for (i = 0; i < ETH_ALEN; i++)
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   167
        eoe->dev->dev_addr[i] = i | (i << 4);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   168
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   169
    // initialize private data
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   170
    priv = netdev_priv(eoe->dev);
213
8d723b9833a9 removed unnecessary private structure in eoe net_device.
Florian Pose <fp@igh-essen.com>
parents: 212
diff changeset
   171
    *priv = eoe;
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   172
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   173
    // Usually setting the MTU appropriately makes the upper layers
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   174
    // do the frame fragmenting. In some cases this doesn't work
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   175
    // so the MTU is left on the Ethernet standard value and fragmenting
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   176
    // is done "manually".
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   177
#if 0
1338
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size|offset) members of slave.
Florian Pose <fp@igh-essen.com>
parents: 1337
diff changeset
   178
    eoe->dev->mtu = slave->configured_rx_mailbox_size - ETH_HLEN - 10;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   179
#endif
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   180
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   181
    // connect the net_device to the kernel
1313
ed15eef57d5c Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents: 1209
diff changeset
   182
    ret = register_netdev(eoe->dev);
ed15eef57d5c Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents: 1209
diff changeset
   183
    if (ret) {
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   184
        EC_SLAVE_ERR(slave, "Unable to register net_device:"
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   185
                " error %i\n", ret);
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   186
        goto out_free;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   187
    }
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   188
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   189
    // make the last address octet unique
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   190
    eoe->dev->dev_addr[ETH_ALEN - 1] = (uint8_t) eoe->dev->ifindex;
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   191
    return 0;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   192
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   193
 out_free:
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   194
    free_netdev(eoe->dev);
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   195
    eoe->dev = NULL;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   196
 out_return:
1313
ed15eef57d5c Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents: 1209
diff changeset
   197
    return ret;
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   198
}
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   199
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   200
/*****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   201
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   202
/** EoE destructor.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   203
 *
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   204
 * Unregisteres the net_device and frees allocated memory.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   205
 */
251
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents: 246
diff changeset
   206
void ec_eoe_clear(ec_eoe_t *eoe /**< EoE handler */)
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   207
{
552
029546740810 Minor: Removed warning when EoE interface is up upon master unloading.
Florian Pose <fp@igh-essen.com>
parents: 460
diff changeset
   208
    unregister_netdev(eoe->dev); // possibly calls close callback
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   209
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   210
    // empty transmit queue
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   211
    ec_eoe_flush(eoe);
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   212
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   213
    if (eoe->tx_frame) {
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   214
        dev_kfree_skb(eoe->tx_frame->skb);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   215
        kfree(eoe->tx_frame);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   216
    }
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   217
1552
c9e2c3be294e Later freeing of netdev.
Florian Pose <fp@igh-essen.com>
parents: 1500
diff changeset
   218
    if (eoe->rx_skb)
c9e2c3be294e Later freeing of netdev.
Florian Pose <fp@igh-essen.com>
parents: 1500
diff changeset
   219
        dev_kfree_skb(eoe->rx_skb);
c9e2c3be294e Later freeing of netdev.
Florian Pose <fp@igh-essen.com>
parents: 1500
diff changeset
   220
c9e2c3be294e Later freeing of netdev.
Florian Pose <fp@igh-essen.com>
parents: 1500
diff changeset
   221
    free_netdev(eoe->dev);
279
12f48c1cb143 Removed mbox_command out of slave.
Florian Pose <fp@igh-essen.com>
parents: 261
diff changeset
   222
293
14aeb79aa992 Renamed command structure to datagram.
Florian Pose <fp@igh-essen.com>
parents: 291
diff changeset
   223
    ec_datagram_clear(&eoe->datagram);
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   224
}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   225
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   226
/*****************************************************************************/
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   227
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   228
/** Empties the transmit queue.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   229
 */
251
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents: 246
diff changeset
   230
void ec_eoe_flush(ec_eoe_t *eoe /**< EoE handler */)
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   231
{
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   232
    ec_eoe_frame_t *frame, *next;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   233
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   234
    down(&eoe->tx_queue_sem);
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   235
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   236
    list_for_each_entry_safe(frame, next, &eoe->tx_queue, queue) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   237
        list_del(&frame->queue);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   238
        dev_kfree_skb(frame->skb);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   239
        kfree(frame);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   240
    }
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   241
    eoe->tx_queued_frames = 0;
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   242
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   243
    up(&eoe->tx_queue_sem);
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   244
}
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   245
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   246
/*****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   247
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   248
/** Sends a frame or the next fragment.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   249
 */
251
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents: 246
diff changeset
   250
int ec_eoe_send(ec_eoe_t *eoe /**< EoE handler */)
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   251
{
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   252
    size_t remaining_size, current_size, complete_offset;
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   253
    unsigned int last_fragment;
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   254
    uint8_t *data;
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   255
#if EOE_DEBUG_LEVEL >= 3
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   256
    unsigned int i;
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   257
#endif
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   258
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   259
    remaining_size = eoe->tx_frame->skb->len - eoe->tx_offset;
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   260
1338
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size|offset) members of slave.
Florian Pose <fp@igh-essen.com>
parents: 1337
diff changeset
   261
    if (remaining_size <= eoe->slave->configured_tx_mailbox_size - 10) {
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   262
        current_size = remaining_size;
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   263
        last_fragment = 1;
1337
0253c74d0940 merge -c1619 branches/1.4-foe: Implemented going to bootstrap state BOOT.
Florian Pose <fp@igh-essen.com>
parents: 1327
diff changeset
   264
    } else {
1338
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size|offset) members of slave.
Florian Pose <fp@igh-essen.com>
parents: 1337
diff changeset
   265
        current_size = ((eoe->slave->configured_tx_mailbox_size - 10) / 32) * 32;
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   266
        last_fragment = 0;
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   267
    }
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   268
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   269
    if (eoe->tx_fragment_number) {
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   270
        complete_offset = eoe->tx_offset / 32;
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   271
    }
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   272
    else {
319
88f2e8c4face Minor changes.
Florian Pose <fp@igh-essen.com>
parents: 314
diff changeset
   273
        // complete size in 32 bit blocks, rounded up.
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   274
        complete_offset = remaining_size / 32 + 1;
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   275
    }
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   276
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   277
#if EOE_DEBUG_LEVEL >= 2
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   278
    EC_SLAVE_DBG(slave, 0, "EoE %s TX sending fragment %u%s"
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   279
            " with %u octets (%u). %u frames queued.\n",
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   280
            eoe->dev->name, eoe->tx_fragment_number,
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   281
            last_fragment ? "" : "+", current_size, complete_offset,
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   282
            eoe->tx_queued_frames);
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   283
#endif
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   284
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   285
#if EOE_DEBUG_LEVEL >= 3
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   286
    EC_SLAVE_DBG(master, 0, "");
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   287
    for (i = 0; i < current_size; i++) {
340
5a5f5a14c847 Fixed EoE debugging.
Florian Pose <fp@igh-essen.com>
parents: 339
diff changeset
   288
        printk("%02X ", eoe->tx_frame->skb->data[eoe->tx_offset + i]);
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   289
        if ((i + 1) % 16 == 0) {
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   290
            printk("\n");
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   291
            EC_SLAVE_DBG(master, 0, "");
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   292
        }
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   293
    }
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   294
    printk("\n");
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   295
#endif
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   296
1313
ed15eef57d5c Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents: 1209
diff changeset
   297
    data = ec_slave_mbox_prepare_send(eoe->slave, &eoe->datagram,
ed15eef57d5c Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents: 1209
diff changeset
   298
            0x02, current_size + 4);
ed15eef57d5c Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents: 1209
diff changeset
   299
    if (IS_ERR(data))
ed15eef57d5c Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents: 1209
diff changeset
   300
        return PTR_ERR(data);
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   301
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   302
    EC_WRITE_U8 (data,     0x00); // eoe fragment req.
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   303
    EC_WRITE_U8 (data + 1, last_fragment);
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   304
    EC_WRITE_U16(data + 2, ((eoe->tx_fragment_number & 0x3F) |
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   305
                            (complete_offset & 0x3F) << 6 |
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   306
                            (eoe->tx_frame_number & 0x0F) << 12));
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   307
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   308
    memcpy(data + 4, eoe->tx_frame->skb->data + eoe->tx_offset, current_size);
721
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   309
    eoe->queue_datagram = 1;
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   310
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   311
    eoe->tx_offset += current_size;
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   312
    eoe->tx_fragment_number++;
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   313
    return 0;
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   314
}
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   315
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   316
/*****************************************************************************/
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   317
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   318
/** Runs the EoE state machine.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   319
 */
251
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents: 246
diff changeset
   320
void ec_eoe_run(ec_eoe_t *eoe /**< EoE handler */)
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   321
{
1484
1c9151455b65 Debug statements with EC_DBG() in EoE code.
Florian Pose <fp@igh-essen.com>
parents: 1363
diff changeset
   322
    if (!eoe->opened)
1c9151455b65 Debug statements with EC_DBG() in EoE code.
Florian Pose <fp@igh-essen.com>
parents: 1363
diff changeset
   323
        return;
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   324
721
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   325
    // if the datagram was not sent, or is not yet received, skip this cycle
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   326
    if (eoe->queue_datagram || eoe->datagram.state == EC_DATAGRAM_SENT)
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   327
        return;
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   328
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   329
    // call state function
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   330
    eoe->state(eoe);
336
360e5287c888 EoE rate statistics.
Florian Pose <fp@igh-essen.com>
parents: 325
diff changeset
   331
360e5287c888 EoE rate statistics.
Florian Pose <fp@igh-essen.com>
parents: 325
diff changeset
   332
    // update statistics
344
5d8281f1aa2a Replaced longer cycle timestamps with jiffies.
Florian Pose <fp@igh-essen.com>
parents: 340
diff changeset
   333
    if (jiffies - eoe->rate_jiffies > HZ) {
1485
5ddc3a455059 ethercat eoe command.
Florian Pose <fp@igh-essen.com>
parents: 1484
diff changeset
   334
        eoe->rx_rate = eoe->rx_counter;
5ddc3a455059 ethercat eoe command.
Florian Pose <fp@igh-essen.com>
parents: 1484
diff changeset
   335
        eoe->tx_rate = eoe->tx_counter;
336
360e5287c888 EoE rate statistics.
Florian Pose <fp@igh-essen.com>
parents: 325
diff changeset
   336
        eoe->rx_counter = 0;
360e5287c888 EoE rate statistics.
Florian Pose <fp@igh-essen.com>
parents: 325
diff changeset
   337
        eoe->tx_counter = 0;
344
5d8281f1aa2a Replaced longer cycle timestamps with jiffies.
Florian Pose <fp@igh-essen.com>
parents: 340
diff changeset
   338
        eoe->rate_jiffies = jiffies;
336
360e5287c888 EoE rate statistics.
Florian Pose <fp@igh-essen.com>
parents: 325
diff changeset
   339
    }
721
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   340
719
03d5b96632fb Store skipped information in datagrams; name datagrams for statistics
Florian Pose <fp@igh-essen.com>
parents: 712
diff changeset
   341
    ec_datagram_output_stats(&eoe->datagram);
145
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   342
}
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   343
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   344
/*****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   345
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   346
/** Queues the datagram, if necessary.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   347
 */
721
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   348
void ec_eoe_queue(ec_eoe_t *eoe /**< EoE handler */)
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   349
{
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   350
   if (eoe->queue_datagram) {
1500
ed1a733efbc5 Improved the callback mechanism.
Florian Pose <fp@igh-essen.com>
parents: 1489
diff changeset
   351
       ec_master_queue_datagram_ext(eoe->slave->master, &eoe->datagram);
721
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   352
       eoe->queue_datagram = 0;
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   353
   }
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   354
}
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   355
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   356
/*****************************************************************************/
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   357
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   358
/** Returns the state of the device.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   359
 *
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   360
 * \return 1 if the device is "up", 0 if it is "down"
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   361
 */
661
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   362
int ec_eoe_is_open(const ec_eoe_t *eoe /**< EoE handler */)
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   363
{
bc1de1362efb Dynamic creation of EoE handlers.
Florian Pose <fp@igh-essen.com>
parents: 629
diff changeset
   364
    return eoe->opened;
251
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents: 246
diff changeset
   365
}
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents: 246
diff changeset
   366
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   367
/*****************************************************************************/
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   368
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   369
/** Returns the idle state.
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   370
 *
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   371
 * \retval 1 The device is idle.
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   372
 * \retval 0 The device is busy.
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   373
 */
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   374
int ec_eoe_is_idle(const ec_eoe_t *eoe /**< EoE handler */)
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   375
{
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   376
    return eoe->rx_idle && eoe->tx_idle;
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   377
}
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   378
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   379
/******************************************************************************
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   380
 *  STATE PROCESSING FUNCTIONS
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   381
 *****************************************************************************/
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   382
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   383
/** State: RX_START.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   384
 *
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   385
 * Starts a new receiving sequence by queueing a datagram that checks the
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   386
 * slave's mailbox for a new EoE datagram.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   387
 */
251
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents: 246
diff changeset
   388
void ec_eoe_state_rx_start(ec_eoe_t *eoe /**< EoE handler */)
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   389
{
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   390
    if (eoe->slave->error_flag ||
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   391
            !eoe->slave->master->main_device.link_state) {
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   392
        eoe->rx_idle = 1;
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   393
        eoe->tx_idle = 1;
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   394
        return;
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   395
    }
261
44a3a5833c49 Better state-dependent behaviour for EoE-capable slaves.
Florian Pose <fp@igh-essen.com>
parents: 251
diff changeset
   396
293
14aeb79aa992 Renamed command structure to datagram.
Florian Pose <fp@igh-essen.com>
parents: 291
diff changeset
   397
    ec_slave_mbox_prepare_check(eoe->slave, &eoe->datagram);
721
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   398
    eoe->queue_datagram = 1;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   399
    eoe->state = ec_eoe_state_rx_check;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   400
}
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   401
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   402
/*****************************************************************************/
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   403
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   404
/** State: RX_CHECK.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   405
 *
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   406
 * Processes the checking datagram sent in RX_START and issues a receive
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   407
 * datagram, if new data is available.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   408
 */
251
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents: 246
diff changeset
   409
void ec_eoe_state_rx_check(ec_eoe_t *eoe /**< EoE handler */)
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   410
{
325
7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines.
Florian Pose <fp@igh-essen.com>
parents: 322
diff changeset
   411
    if (eoe->datagram.state != EC_DATAGRAM_RECEIVED) {
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   412
        eoe->stats.rx_errors++;
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   413
#if EOE_DEBUG_LEVEL >= 1
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   414
        EC_SLAVE_WARN(eoe->slave, "Failed to receive mbox"
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   415
                " check datagram for %s.\n", eoe->dev->name);
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   416
#endif
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   417
        eoe->state = ec_eoe_state_tx_start;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   418
        return;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   419
    }
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   420
293
14aeb79aa992 Renamed command structure to datagram.
Florian Pose <fp@igh-essen.com>
parents: 291
diff changeset
   421
    if (!ec_slave_mbox_check(&eoe->datagram)) {
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   422
        eoe->rx_idle = 1;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   423
        eoe->state = ec_eoe_state_tx_start;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   424
        return;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   425
    }
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   426
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   427
    eoe->rx_idle = 0;
293
14aeb79aa992 Renamed command structure to datagram.
Florian Pose <fp@igh-essen.com>
parents: 291
diff changeset
   428
    ec_slave_mbox_prepare_fetch(eoe->slave, &eoe->datagram);
721
ebc2fd3e09e5 Improved EoE handling: Avoided skipping of datagrams and release lock
Florian Pose <fp@igh-essen.com>
parents: 719
diff changeset
   429
    eoe->queue_datagram = 1;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   430
    eoe->state = ec_eoe_state_rx_fetch;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   431
}
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   432
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   433
/*****************************************************************************/
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   434
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   435
/** State: RX_FETCH.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   436
 *
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   437
 * Checks if the requested data of RX_CHECK was received and processes the EoE
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   438
 * datagram.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   439
 */
251
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents: 246
diff changeset
   440
void ec_eoe_state_rx_fetch(ec_eoe_t *eoe /**< EoE handler */)
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   441
{
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   442
    size_t rec_size, data_size;
391
7d67195702dd Removed additional loop in coe_down FSM; renamed mbox_type to mbox_prot.
Florian Pose <fp@igh-essen.com>
parents: 390
diff changeset
   443
    uint8_t *data, frame_type, last_fragment, time_appended, mbox_prot;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   444
    uint8_t frame_number, fragment_offset, fragment_number;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   445
    off_t offset;
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   446
#if EOE_DEBUG_LEVEL >= 3
340
5a5f5a14c847 Fixed EoE debugging.
Florian Pose <fp@igh-essen.com>
parents: 339
diff changeset
   447
    unsigned int i;
5a5f5a14c847 Fixed EoE debugging.
Florian Pose <fp@igh-essen.com>
parents: 339
diff changeset
   448
#endif
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   449
325
7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines.
Florian Pose <fp@igh-essen.com>
parents: 322
diff changeset
   450
    if (eoe->datagram.state != EC_DATAGRAM_RECEIVED) {
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   451
        eoe->stats.rx_errors++;
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   452
#if EOE_DEBUG_LEVEL >= 1
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   453
        EC_SLAVE_WARN(eoe->slave, "Failed to receive mbox"
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   454
                " fetch datagram for %s.\n", eoe->dev->name);
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   455
#endif
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   456
        eoe->state = ec_eoe_state_tx_start;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   457
        return;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   458
    }
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   459
1313
ed15eef57d5c Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents: 1209
diff changeset
   460
    data = ec_slave_mbox_fetch(eoe->slave, &eoe->datagram,
ed15eef57d5c Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents: 1209
diff changeset
   461
            &mbox_prot, &rec_size);
ed15eef57d5c Improved error case return codes of many functions.
Florian Pose <fp@igh-essen.com>
parents: 1209
diff changeset
   462
    if (IS_ERR(data)) {
390
685c267d80d8 Fixed mailbox bug, added mailbox error codes.
Florian Pose <fp@igh-essen.com>
parents: 344
diff changeset
   463
        eoe->stats.rx_errors++;
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   464
#if EOE_DEBUG_LEVEL >= 1
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   465
        EC_SLAVE_WARN(eoe->slave, "Invalid mailbox response for %s.\n",
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   466
                eoe->dev->name);
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   467
#endif
390
685c267d80d8 Fixed mailbox bug, added mailbox error codes.
Florian Pose <fp@igh-essen.com>
parents: 344
diff changeset
   468
        eoe->state = ec_eoe_state_tx_start;
685c267d80d8 Fixed mailbox bug, added mailbox error codes.
Florian Pose <fp@igh-essen.com>
parents: 344
diff changeset
   469
        return;
685c267d80d8 Fixed mailbox bug, added mailbox error codes.
Florian Pose <fp@igh-essen.com>
parents: 344
diff changeset
   470
    }
685c267d80d8 Fixed mailbox bug, added mailbox error codes.
Florian Pose <fp@igh-essen.com>
parents: 344
diff changeset
   471
689
880b556a6efc Removed checking for NULL slave pointer in EoE handler; added comments.
Florian Pose <fp@igh-essen.com>
parents: 683
diff changeset
   472
    if (mbox_prot != 0x02) { // EoE FIXME mailbox handler necessary
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   473
        eoe->stats.rx_errors++;
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   474
#if EOE_DEBUG_LEVEL >= 1
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   475
        EC_SLAVE_WARN(eoe->slave, "Other mailbox protocol response for %s.\n",
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   476
                eoe->dev->name);
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   477
#endif
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   478
        eoe->state = ec_eoe_state_tx_start;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   479
        return;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   480
    }
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   481
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   482
    frame_type = EC_READ_U16(data) & 0x000F;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   483
322
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   484
    if (frame_type != 0x00) {
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   485
#if EOE_DEBUG_LEVEL >= 1
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   486
        EC_SLAVE_WARN(eoe->slave, "%s: Other frame received."
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   487
                " Dropping.\n", eoe->dev->name);
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   488
#endif
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   489
        eoe->stats.rx_dropped++;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   490
        eoe->state = ec_eoe_state_tx_start;
322
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   491
        return;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   492
    }
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   493
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   494
    // EoE Fragment Request received
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   495
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   496
    last_fragment = (EC_READ_U16(data) >> 8) & 0x0001;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   497
    time_appended = (EC_READ_U16(data) >> 9) & 0x0001;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   498
    fragment_number = EC_READ_U16(data + 2) & 0x003F;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   499
    fragment_offset = (EC_READ_U16(data + 2) >> 6) & 0x003F;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   500
    frame_number = (EC_READ_U16(data + 2) >> 12) & 0x000F;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   501
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   502
#if EOE_DEBUG_LEVEL >= 2
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   503
    EC_SLAVE_DBG(eoe->slave, 0, "EoE %s RX fragment %u%s, offset %u,"
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   504
            " frame %u%s, %u octets\n", eoe->dev->name, fragment_number,
770
efa5af306318 Improved EoE debugging.
Florian Pose <fp@igh-essen.com>
parents: 721
diff changeset
   505
           last_fragment ? "" : "+", fragment_offset, frame_number, 
322
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   506
           time_appended ? ", + timestamp" : "",
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   507
           time_appended ? rec_size - 8 : rec_size - 4);
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   508
#endif
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   509
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   510
#if EOE_DEBUG_LEVEL >= 3
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   511
    EC_SLAVE_DBG(eoe->slave, 0, "");
322
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   512
    for (i = 0; i < rec_size - 4; i++) {
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   513
        printk("%02X ", data[i + 4]);
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   514
        if ((i + 1) % 16 == 0) {
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   515
            printk("\n");
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   516
            EC_SLAVE_DBG(eoe->slave, 0, "");
322
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   517
        }
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   518
    }
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   519
    printk("\n");
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   520
#endif
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   521
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   522
    data_size = time_appended ? rec_size - 8 : rec_size - 4;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   523
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   524
    if (!fragment_number) {
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   525
        if (eoe->rx_skb) {
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   526
            EC_SLAVE_WARN(eoe->slave, "EoE RX freeing old socket buffer.\n");
322
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   527
            dev_kfree_skb(eoe->rx_skb);
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   528
        }
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   529
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   530
        // new socket buffer
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   531
        if (!(eoe->rx_skb = dev_alloc_skb(fragment_offset * 32))) {
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   532
            if (printk_ratelimit())
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   533
                EC_SLAVE_WARN(eoe->slave, "EoE RX low on mem,"
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   534
                        " frame dropped.\n");
322
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   535
            eoe->stats.rx_dropped++;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   536
            eoe->state = ec_eoe_state_tx_start;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   537
            return;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   538
        }
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   539
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   540
        eoe->rx_skb_offset = 0;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   541
        eoe->rx_skb_size = fragment_offset * 32;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   542
        eoe->rx_expected_fragment = 0;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   543
    }
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   544
    else {
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   545
        if (!eoe->rx_skb) {
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   546
            eoe->stats.rx_dropped++;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   547
            eoe->state = ec_eoe_state_tx_start;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   548
            return;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   549
        }
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   550
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   551
        offset = fragment_offset * 32;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   552
        if (offset != eoe->rx_skb_offset ||
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   553
            offset + data_size > eoe->rx_skb_size ||
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   554
            fragment_number != eoe->rx_expected_fragment) {
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   555
            dev_kfree_skb(eoe->rx_skb);
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   556
            eoe->rx_skb = NULL;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   557
            eoe->stats.rx_errors++;
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   558
#if EOE_DEBUG_LEVEL >= 1
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   559
            EC_SLAVE_WARN(eoe->slave, "Fragmenting error at %s.\n",
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   560
                    eoe->dev->name);
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   561
#endif
322
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   562
            eoe->state = ec_eoe_state_tx_start;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   563
            return;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   564
        }
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   565
    }
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   566
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   567
    // copy fragment into socket buffer
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   568
    memcpy(skb_put(eoe->rx_skb, data_size), data + 4, data_size);
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   569
    eoe->rx_skb_offset += data_size;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   570
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   571
    if (last_fragment) {
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   572
        // update statistics
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   573
        eoe->stats.rx_packets++;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   574
        eoe->stats.rx_bytes += eoe->rx_skb->len;
336
360e5287c888 EoE rate statistics.
Florian Pose <fp@igh-essen.com>
parents: 325
diff changeset
   575
        eoe->rx_counter += eoe->rx_skb->len;
322
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   576
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   577
#if EOE_DEBUG_LEVEL >= 2
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   578
        EC_SLAVE_DBG(eoe->slave, 0, "EoE %s RX frame completed"
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   579
                " with %u octets.\n", eoe->dev->name, eoe->rx_skb->len);
322
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   580
#endif
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   581
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   582
        // pass socket buffer to network stack
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   583
        eoe->rx_skb->dev = eoe->dev;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   584
        eoe->rx_skb->protocol = eth_type_trans(eoe->rx_skb, eoe->dev);
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   585
        eoe->rx_skb->ip_summed = CHECKSUM_UNNECESSARY;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   586
        if (netif_rx(eoe->rx_skb)) {
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   587
            EC_SLAVE_WARN(eoe->slave, "EoE RX netif_rx failed.\n");
322
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   588
        }
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   589
        eoe->rx_skb = NULL;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   590
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   591
        eoe->state = ec_eoe_state_tx_start;
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   592
    }
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   593
    else {
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   594
        eoe->rx_expected_fragment++;
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   595
#if EOE_DEBUG_LEVEL >= 2
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   596
        EC_SLAVE_DBG(eoe->slave, 0, "EoE %s RX expecting fragment %u\n",
770
efa5af306318 Improved EoE debugging.
Florian Pose <fp@igh-essen.com>
parents: 721
diff changeset
   597
               eoe->dev->name, eoe->rx_expected_fragment);
322
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   598
#endif
fceb7b6e0a06 Improved EoE state machine.
Florian Pose <fp@igh-essen.com>
parents: 319
diff changeset
   599
        eoe->state = ec_eoe_state_rx_start;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   600
    }
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   601
}
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   602
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   603
/*****************************************************************************/
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   604
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   605
/** State: TX START.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   606
 *
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   607
 * Starts a new transmit sequence. If no data is available, a new receive
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   608
 * sequence is started instead.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   609
 */
251
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents: 246
diff changeset
   610
void ec_eoe_state_tx_start(ec_eoe_t *eoe /**< EoE handler */)
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   611
{
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   612
#if EOE_DEBUG_LEVEL >= 2
340
5a5f5a14c847 Fixed EoE debugging.
Florian Pose <fp@igh-essen.com>
parents: 339
diff changeset
   613
    unsigned int wakeup = 0;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   614
#endif
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   615
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   616
    if (eoe->slave->error_flag ||
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   617
            !eoe->slave->master->main_device.link_state) {
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   618
        eoe->rx_idle = 1;
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   619
        eoe->tx_idle = 1;
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   620
        return;
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   621
    }
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   622
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   623
    down(&eoe->tx_queue_sem);
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   624
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   625
    if (!eoe->tx_queued_frames || list_empty(&eoe->tx_queue)) {
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   626
        up(&eoe->tx_queue_sem);
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   627
        eoe->tx_idle = 1;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   628
        // no data available.
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   629
        // start a new receive immediately.
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   630
        ec_eoe_state_rx_start(eoe);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   631
        return;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   632
    }
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   633
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   634
    // take the first frame out of the queue
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   635
    eoe->tx_frame = list_entry(eoe->tx_queue.next, ec_eoe_frame_t, queue);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   636
    list_del(&eoe->tx_frame->queue);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   637
    if (!eoe->tx_queue_active &&
1485
5ddc3a455059 ethercat eoe command.
Florian Pose <fp@igh-essen.com>
parents: 1484
diff changeset
   638
        eoe->tx_queued_frames == eoe->tx_queue_size / 2) {
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   639
        netif_wake_queue(eoe->dev);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   640
        eoe->tx_queue_active = 1;
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   641
#if EOE_DEBUG_LEVEL >= 2
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   642
        wakeup = 1;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   643
#endif
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   644
    }
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   645
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   646
    eoe->tx_queued_frames--;
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   647
    up(&eoe->tx_queue_sem);
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   648
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   649
    eoe->tx_idle = 0;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   650
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   651
    eoe->tx_frame_number++;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   652
    eoe->tx_frame_number %= 16;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   653
    eoe->tx_fragment_number = 0;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   654
    eoe->tx_offset = 0;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   655
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   656
    if (ec_eoe_send(eoe)) {
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   657
        dev_kfree_skb(eoe->tx_frame->skb);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   658
        kfree(eoe->tx_frame);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   659
        eoe->tx_frame = NULL;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   660
        eoe->stats.tx_errors++;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   661
        eoe->state = ec_eoe_state_rx_start;
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   662
#if EOE_DEBUG_LEVEL >= 1
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   663
        EC_SLAVE_WARN(eoe->slave, "Send error at %s.\n", eoe->dev->name);
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   664
#endif
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   665
        return;
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   666
    }
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   667
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   668
#if EOE_DEBUG_LEVEL >= 2
1484
1c9151455b65 Debug statements with EC_DBG() in EoE code.
Florian Pose <fp@igh-essen.com>
parents: 1363
diff changeset
   669
    if (wakeup)
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   670
        EC_SLAVE_DBG(eoe->slave, 0, "EoE %s waking up TX queue...\n",
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   671
                eoe->dev->name);
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   672
#endif
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   673
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   674
    eoe->tries = EC_EOE_TRIES;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   675
    eoe->state = ec_eoe_state_tx_sent;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   676
}
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   677
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   678
/*****************************************************************************/
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   679
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   680
/** State: TX SENT.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   681
 *
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   682
 * Checks is the previous transmit datagram succeded and sends the next
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   683
 * fragment, if necessary.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   684
 */
251
c1d0b63a9302 EoE in Free-Run mode; Finished slave configuration state machine.
Florian Pose <fp@igh-essen.com>
parents: 246
diff changeset
   685
void ec_eoe_state_tx_sent(ec_eoe_t *eoe /**< EoE handler */)
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   686
{
325
7833cf70c4f2 VERSION 1.1: New realtime interface, only state machines.
Florian Pose <fp@igh-essen.com>
parents: 322
diff changeset
   687
    if (eoe->datagram.state != EC_DATAGRAM_RECEIVED) {
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   688
        if (eoe->tries) {
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   689
            eoe->tries--; // try again
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   690
            eoe->queue_datagram = 1;
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   691
        } else {
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   692
            eoe->stats.tx_errors++;
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   693
#if EOE_DEBUG_LEVEL >= 1
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   694
            EC_SLAVE_WARN(eoe->slave, "Failed to receive send"
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   695
                    " datagram for %s after %u tries.\n",
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   696
                    eoe->dev->name, EC_EOE_TRIES);
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   697
#endif
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   698
            eoe->state = ec_eoe_state_rx_start;
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   699
        }
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   700
        return;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   701
    }
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   702
293
14aeb79aa992 Renamed command structure to datagram.
Florian Pose <fp@igh-essen.com>
parents: 291
diff changeset
   703
    if (eoe->datagram.working_counter != 1) {
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   704
        if (eoe->tries) {
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   705
            eoe->tries--; // try again
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   706
            eoe->queue_datagram = 1;
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   707
        } else {
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   708
            eoe->stats.tx_errors++;
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   709
#if EOE_DEBUG_LEVEL >= 1
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   710
            EC_SLAVE_WARN(eoe->slave, "No sending response"
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   711
                    " for %s after %u tries.\n",
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   712
                    eoe->dev->name, EC_EOE_TRIES);
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   713
#endif
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   714
            eoe->state = ec_eoe_state_rx_start;
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   715
        }
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   716
        return;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   717
    }
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   718
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   719
    // frame completely sent
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   720
    if (eoe->tx_offset >= eoe->tx_frame->skb->len) {
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   721
        eoe->stats.tx_packets++;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   722
        eoe->stats.tx_bytes += eoe->tx_frame->skb->len;
336
360e5287c888 EoE rate statistics.
Florian Pose <fp@igh-essen.com>
parents: 325
diff changeset
   723
        eoe->tx_counter += eoe->tx_frame->skb->len;
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   724
        dev_kfree_skb(eoe->tx_frame->skb);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   725
        kfree(eoe->tx_frame);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   726
        eoe->tx_frame = NULL;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   727
        eoe->state = ec_eoe_state_rx_start;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   728
    }
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   729
    else { // send next fragment
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   730
        if (ec_eoe_send(eoe)) {
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   731
            dev_kfree_skb(eoe->tx_frame->skb);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   732
            kfree(eoe->tx_frame);
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   733
            eoe->tx_frame = NULL;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   734
            eoe->stats.tx_errors++;
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   735
#if EOE_DEBUG_LEVEL >= 1
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   736
            EC_SLAVE_WARN(eoe->slave, "Send error at %s.\n", eoe->dev->name);
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   737
#endif
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   738
            eoe->state = ec_eoe_state_rx_start;
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   739
        }
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   740
    }
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   741
}
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   742
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   743
/******************************************************************************
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   744
 *  NET_DEVICE functions
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   745
 *****************************************************************************/
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   746
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   747
/** Opens the virtual network device.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   748
 */
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   749
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
   750
{
213
8d723b9833a9 removed unnecessary private structure in eoe net_device.
Florian Pose <fp@igh-essen.com>
parents: 212
diff changeset
   751
    ec_eoe_t *eoe = *((ec_eoe_t **) netdev_priv(dev));
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   752
    ec_eoe_flush(eoe);
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   753
    eoe->opened = 1;
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   754
    eoe->rx_idle = 0;
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   755
    eoe->tx_idle = 0;
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   756
    netif_start_queue(dev);
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   757
    eoe->tx_queue_active = 1;
1488
3fb343e3fac0 Output device opened/closed only on debug level 2.
Florian Pose <fp@igh-essen.com>
parents: 1487
diff changeset
   758
#if EOE_DEBUG_LEVEL >= 2
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   759
    EC_SLAVE_DBG(eoe->slave, 0, "%s opened.\n", dev->name);
1488
3fb343e3fac0 Output device opened/closed only on debug level 2.
Florian Pose <fp@igh-essen.com>
parents: 1487
diff changeset
   760
#endif
689
880b556a6efc Removed checking for NULL slave pointer in EoE handler; added comments.
Florian Pose <fp@igh-essen.com>
parents: 683
diff changeset
   761
    ec_slave_request_state(eoe->slave, EC_SLAVE_STATE_OP);
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   762
    return 0;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   763
}
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   764
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   765
/*****************************************************************************/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   766
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   767
/** Stops the virtual network device.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   768
 */
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   769
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
   770
{
213
8d723b9833a9 removed unnecessary private structure in eoe net_device.
Florian Pose <fp@igh-essen.com>
parents: 212
diff changeset
   771
    ec_eoe_t *eoe = *((ec_eoe_t **) netdev_priv(dev));
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   772
    netif_stop_queue(dev);
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   773
    eoe->rx_idle = 1;
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   774
    eoe->tx_idle = 1;
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   775
    eoe->tx_queue_active = 0;
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   776
    eoe->opened = 0;
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   777
    ec_eoe_flush(eoe);
1488
3fb343e3fac0 Output device opened/closed only on debug level 2.
Florian Pose <fp@igh-essen.com>
parents: 1487
diff changeset
   778
#if EOE_DEBUG_LEVEL >= 2
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   779
    EC_SLAVE_DBG(eoe->slave, 0, "%s stopped.\n", dev->name);
1488
3fb343e3fac0 Output device opened/closed only on debug level 2.
Florian Pose <fp@igh-essen.com>
parents: 1487
diff changeset
   780
#endif
689
880b556a6efc Removed checking for NULL slave pointer in EoE handler; added comments.
Florian Pose <fp@igh-essen.com>
parents: 683
diff changeset
   781
    ec_slave_request_state(eoe->slave, EC_SLAVE_STATE_PREOP);
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   782
    return 0;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   783
}
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   784
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   785
/*****************************************************************************/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   786
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   787
/** Transmits data via the virtual network device.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   788
 */
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   789
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
   790
                 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
   791
                )
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   792
{
213
8d723b9833a9 removed unnecessary private structure in eoe net_device.
Florian Pose <fp@igh-essen.com>
parents: 212
diff changeset
   793
    ec_eoe_t *eoe = *((ec_eoe_t **) netdev_priv(dev));
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   794
    ec_eoe_frame_t *frame;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   795
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   796
#if 0
1338
eb31b5a135da merge -c1621 branches/1.4-foe: Introduced configured_[tr]x_mailbox(size|offset) members of slave.
Florian Pose <fp@igh-essen.com>
parents: 1337
diff changeset
   797
    if (skb->len > eoe->slave->configured_tx_mailbox_size - 10) {
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   798
        EC_SLAVE_WARN(eoe->slave, "EoE TX frame (%u octets)"
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   799
                " exceeds MTU. dropping.\n", skb->len);
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   800
        dev_kfree_skb(skb);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   801
        eoe->stats.tx_dropped++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   802
        return 0;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   803
    }
217
dcfd406e7786 EoE - TX fragmenting works. TCP traffic possible.
Florian Pose <fp@igh-essen.com>
parents: 216
diff changeset
   804
#endif
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   805
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   806
    if (!(frame =
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   807
          (ec_eoe_frame_t *) kmalloc(sizeof(ec_eoe_frame_t), GFP_ATOMIC))) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   808
        if (printk_ratelimit())
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   809
            EC_SLAVE_WARN(eoe->slave, "EoE TX: low on mem. frame dropped.\n");
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   810
        return 1;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   811
    }
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   812
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   813
    frame->skb = skb;
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   814
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   815
    down(&eoe->tx_queue_sem);
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   816
    list_add_tail(&frame->queue, &eoe->tx_queue);
218
80fb87518f3d EoE: State machine with function pointers, documentation.
Florian Pose <fp@igh-essen.com>
parents: 217
diff changeset
   817
    eoe->tx_queued_frames++;
1485
5ddc3a455059 ethercat eoe command.
Florian Pose <fp@igh-essen.com>
parents: 1484
diff changeset
   818
    if (eoe->tx_queued_frames == eoe->tx_queue_size) {
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   819
        netif_stop_queue(dev);
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   820
        eoe->tx_queue_active = 0;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   821
    }
1489
f77a1182b6f4 EoE processing with kthread.
Florian Pose <fp@igh-essen.com>
parents: 1488
diff changeset
   822
    up(&eoe->tx_queue_sem);
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   823
1486
dac749e74956 EoE transmit retry; EoE warnings.
Florian Pose <fp@igh-essen.com>
parents: 1485
diff changeset
   824
#if EOE_DEBUG_LEVEL >= 2
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   825
    EC_SLAVE_DBG(eoe->slave, 0, "EoE %s TX queued frame"
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   826
            " with %u octets (%u frames queued).\n",
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   827
            eoe->dev->name, skb->len, eoe->tx_queued_frames);
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   828
    if (!eoe->tx_queue_active)
1921
d9cf40facbc4 Improved syslog macros.
Florian Pose <fp@igh-essen.com>
parents: 1909
diff changeset
   829
        EC_SLAVE_WARN(eoe->slave, "EoE TX queue is now full.\n");
215
b021aa6eee38 EoE: TCP traffic possible; TX fragmenting to do.
Florian Pose <fp@igh-essen.com>
parents: 214
diff changeset
   830
#endif
214
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet.
Florian Pose <fp@igh-essen.com>
parents: 213
diff changeset
   831
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   832
    return 0;
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   833
}
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   834
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   835
/*****************************************************************************/
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   836
1487
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   837
/** Gets statistics about the virtual network device.
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   838
 */
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   839
struct net_device_stats *ec_eoedev_stats(
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   840
        struct net_device *dev /**< EoE net_device */
1c67e19f24b8 Minor: Changed comment style.
Florian Pose <fp@igh-essen.com>
parents: 1486
diff changeset
   841
        )
203
c1f305e339c6 EoE net_device implementation.
Florian Pose <fp@igh-essen.com>
parents: 199
diff changeset
   842
{
213
8d723b9833a9 removed unnecessary private structure in eoe net_device.
Florian Pose <fp@igh-essen.com>
parents: 212
diff changeset
   843
    ec_eoe_t *eoe = *((ec_eoe_t **) netdev_priv(dev));
212
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   844
    return &eoe->stats;
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   845
}
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   846
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue.
Florian Pose <fp@igh-essen.com>
parents: 210
diff changeset
   847
/*****************************************************************************/