etherlabmaster: master/ethernet.c@8beb86af5ed0 (annotated)

145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	1	/******************************************************************************
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	2	*
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	3	* $Id$
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	4	*
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	5	* Copyright (C) 2006 Florian Pose, Ingenieurgemeinschaft IgH
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	6	*
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	7	* This file is part of the IgH EtherCAT Master.
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	8	*
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	9	* The IgH EtherCAT Master is free software; you can redistribute it
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	10	* and/or modify it under the terms of the GNU General Public License
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	11	* as published by the Free Software Foundation; version 2 of the License.
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	12	*
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	13	* The IgH EtherCAT Master is distributed in the hope that it will be
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	14	* useful, but WITHOUT ANY WARRANTY; without even the implied warranty of
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	16	* GNU General Public License for more details.
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	17	*
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	18	* You should have received a copy of the GNU General Public License
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	19	* along with the IgH EtherCAT Master; if not, write to the Free Software
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	20	* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	21	*
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	22	*****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	23
199 04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	24	/**
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	25	\file
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	26	Ethernet-over-EtherCAT (EoE).
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	27	*/
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	28
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	29	/*****************************************************************************/
04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	30
210 1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	31	#include <linux/etherdevice.h>
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	32
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	33	#include "../include/ecrt.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	34	#include "globals.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	35	#include "master.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	36	#include "slave.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	37	#include "mailbox.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	38	#include "ethernet.h"
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	39
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	40	/*****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	41
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	42	/**
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	43	Queued frame structure.
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	44	*/
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	45
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	46	typedef struct
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	47	{
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	48	struct list_head queue; /*< list item /
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	49	struct sk_buff skb; /< socket buffer /
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	50	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	51	ec_eoe_frame_t;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	52
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	53	/*****************************************************************************/
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	54
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	55	void ec_eoe_flush(ec_eoe_t *);
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	56	void ec_eoedev_init(struct net_device *);
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	57	int ec_eoedev_open(struct net_device *);
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	58	int ec_eoedev_stop(struct net_device *);
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	59	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	60	struct net_device_stats ec_eoedev_stats(struct net_device );
210 1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	61	void ec_eoedev_rx(struct net_device , const uint8_t , size_t);
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	62
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	63	/*****************************************************************************/
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	64
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	65	/**
199 04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	66	EoE constructor.
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	67	*/
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	68
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	69	int ec_eoe_init(ec_eoe_t eoe, ec_slave_t slave)
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	70	{
213 8d723b9833a9 removed unnecessary private structure in eoe net_device. Florian Pose <fp@igh-essen.com> parents: 212 diff changeset	71	ec_eoe_t **priv;
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	72	int result;
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	73
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	74	eoe->slave = slave;
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	75	eoe->state = EC_EOE_RX_START;
210 1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	76	eoe->opened = 0;
212 82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue. Florian Pose <fp@igh-essen.com> parents: 210 diff changeset	77	eoe->skb = NULL;
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	78	eoe->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	79	INIT_LIST_HEAD(&eoe->tx_queue);
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	80	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	81	eoe->queued_frames = 0;
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue. Florian Pose <fp@igh-essen.com> parents: 210 diff changeset	82	eoe->tx_queue_lock = SPIN_LOCK_UNLOCKED;
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	83	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	84	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	85
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	86	if (!(eoe->dev =
213 8d723b9833a9 removed unnecessary private structure in eoe net_device. Florian Pose <fp@igh-essen.com> parents: 212 diff changeset	87	alloc_netdev(sizeof(ec_eoe_t *), "eoe%d", ec_eoedev_init))) {
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	88	EC_ERR("Unable to allocate net_device for EoE object!\n");
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	89	goto out_return;
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	90	}
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	91
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	92	// set EoE object reference
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	93	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	94	*priv = eoe;
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	95
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	96	//eoe->dev->mtu = slave->sii_rx_mailbox_size - ETH_HLEN - 10;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	97
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	98	// connect the net_device to the kernel
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	99	if ((result = register_netdev(eoe->dev))) {
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	100	EC_ERR("Unable to register net_device: error %i\n", result);
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	101	goto out_free;
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	102	}
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	103
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	104	return 0;
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	105
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	106	out_free:
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	107	free_netdev(eoe->dev);
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	108	eoe->dev = NULL;
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	109	out_return:
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	110	return -1;
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	111	}
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	112
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	113	/*****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	114
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	115	/**
199 04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	116	EoE destructor.
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	117	*/
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	118
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	119	void ec_eoe_clear(ec_eoe_t *eoe)
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	120	{
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	121	if (eoe->dev) {
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	122	unregister_netdev(eoe->dev);
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	123	free_netdev(eoe->dev);
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	124	}
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	125
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	126	// 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	127	ec_eoe_flush(eoe);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	128	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	129
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	130	/*****************************************************************************/
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	131
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	132	/**
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	133	Empties the transmit queue.
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	134	*/
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	135
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	136	void ec_eoe_flush(ec_eoe_t *eoe)
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	137	{
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	138	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	139
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	140	spin_lock_bh(&eoe->tx_queue_lock);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	141
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	142	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	143	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	144	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	145	kfree(frame);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	146	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	147	eoe->queued_frames = 0;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	148
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	149	spin_unlock_bh(&eoe->tx_queue_lock);
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	150	}
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	151
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	152	/*****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	153
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	154	/**
199 04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	155	Runs the EoE state machine.
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	156	*/
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	157
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	158	void ec_eoe_run(ec_eoe_t *eoe)
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	159	{
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	160	uint8_t *data;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	161	ec_master_t *master;
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	162	size_t rec_size, data_size;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	163	off_t offset;
210 1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	164	uint8_t fragment_number, frame_number, last_fragment, time_appended;
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	165	uint8_t fragment_offset, frame_type;
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	166	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	167	unsigned int wakeup = 0;
210 1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	168
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	169	if (!eoe->opened) return;
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	170
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	171	master = eoe->slave->master;
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	172
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	173	switch (eoe->state) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	174	case EC_EOE_RX_START:
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	175	ec_slave_mbox_prepare_check(eoe->slave);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	176	ec_master_queue_command(master, &eoe->slave->mbox_command);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	177	eoe->state = EC_EOE_RX_CHECK;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	178	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	179
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	180	case EC_EOE_RX_CHECK:
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	181	if (eoe->slave->mbox_command.state != EC_CMD_RECEIVED) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	182	eoe->stats.rx_errors++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	183	eoe->state = EC_EOE_TX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	184	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	185	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	186	if (!ec_slave_mbox_check(eoe->slave)) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	187	eoe->state = EC_EOE_TX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	188	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	189	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	190	ec_slave_mbox_prepare_fetch(eoe->slave);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	191	ec_master_queue_command(master, &eoe->slave->mbox_command);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	192	eoe->state = EC_EOE_RX_FETCH;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	193	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	194
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	195	case EC_EOE_RX_FETCH:
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	196	if (eoe->slave->mbox_command.state != EC_CMD_RECEIVED) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	197	eoe->stats.rx_errors++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	198	eoe->state = EC_EOE_TX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	199	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	200	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	201	if (!(data = ec_slave_mbox_fetch(eoe->slave, 0x02, &rec_size))) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	202	eoe->stats.rx_errors++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	203	eoe->state = EC_EOE_TX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	204	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	205	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	206
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	207	frame_type = EC_READ_U16(data) & 0x000F;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	208
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	209	if (frame_type == 0x00) { // EoE Fragment Request
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	210	last_fragment = (EC_READ_U16(data) >> 8) & 0x0001;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	211	time_appended = (EC_READ_U16(data) >> 9) & 0x0001;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	212	fragment_number = EC_READ_U16(data + 2) & 0x003F;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	213	fragment_offset = (EC_READ_U16(data + 2) >> 6) & 0x003F;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	214	frame_number = (EC_READ_U16(data + 2) >> 12) & 0x000F;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	215
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	216	EC_DBG("EoE RX fragment %i, offset %i, frame %i%s%s,"
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	217	" %i octets\n", fragment_number, fragment_offset,
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	218	frame_number,
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	219	last_fragment ? ", last fragment" : "",
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	220	time_appended ? ", + timestamp" : "",
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	221	time_appended ? rec_size - 8 : rec_size - 4);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	222
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	223	data_size = time_appended ? rec_size - 8 : rec_size - 4;
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	if (!fragment_number) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	226	if (eoe->skb) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	227	EC_WARN("EoE RX freeing old socket buffer...\n");
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	228	dev_kfree_skb(eoe->skb);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	229	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	230
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	231	// new socket buffer
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	232	if (!(eoe->skb = dev_alloc_skb(fragment_offset * 32))) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	233	if (printk_ratelimit())
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	234	EC_WARN("EoE RX low on mem. frame dropped.\n");
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	235	eoe->stats.rx_dropped++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	236	eoe->state = EC_EOE_TX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	237	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	238	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	239	eoe->skb_offset = 0;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	240	eoe->skb_size = fragment_offset * 32;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	241	eoe->expected_fragment = 0;
210 1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	242	}
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	243	else {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	244	if (!eoe->skb) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	245	eoe->stats.rx_dropped++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	246	eoe->state = EC_EOE_TX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	247	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	248	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	249
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	250	offset = fragment_offset * 32;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	251	if (offset != eoe->skb_offset \|\|
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	252	offset + data_size > eoe->skb_size \|\|
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	253	fragment_number != eoe->expected_fragment) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	254	eoe->stats.rx_errors++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	255	eoe->state = EC_EOE_TX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	256	dev_kfree_skb(eoe->skb);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	257	eoe->skb = NULL;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	258	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	259	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	260	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	261
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	262	// copy fragment into socket buffer
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	263	memcpy(skb_put(eoe->skb, data_size), data + 4, data_size);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	264	eoe->skb_offset += data_size;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	265
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	266	if (last_fragment) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	267	// update statistics
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	268	eoe->stats.rx_packets++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	269	eoe->stats.rx_bytes += eoe->skb->len;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	270
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	271	EC_DBG("EoE RX frame completed with %u octets.\n",
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	272	eoe->skb->len);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	273
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	274	// pass socket buffer to network stack
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	275	eoe->skb->dev = eoe->dev;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	276	eoe->skb->protocol = eth_type_trans(eoe->skb, eoe->dev);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	277	eoe->skb->ip_summed = CHECKSUM_NONE;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	278	if (netif_rx(eoe->skb)) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	279	EC_WARN("EoE RX netif_rx failed.\n");
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	280	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	281	eoe->skb = NULL;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	282
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	283	eoe->state = EC_EOE_TX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	284	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	285	else {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	286	eoe->expected_fragment++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	287	EC_DBG("EoE RX expecting fragment %i\n",
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	288	eoe->expected_fragment);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	289	eoe->state = EC_EOE_RX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	290	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	291	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	292	else {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	293	EC_DBG("other frame received.\n");
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	294	eoe->stats.rx_dropped++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	295	eoe->state = EC_EOE_TX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	296	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	297	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	298
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	299	case EC_EOE_TX_START:
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	300	spin_lock_bh(&eoe->tx_queue_lock);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	301
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	302	if (!eoe->queued_frames \|\| list_empty(&eoe->tx_queue)) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	303	spin_unlock_bh(&eoe->tx_queue_lock);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	304	eoe->state = EC_EOE_RX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	305	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	306	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	307
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	308	// take the first frame out of the queue
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	309	frame = list_entry(eoe->tx_queue.next, ec_eoe_frame_t, queue);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	310	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	311	if (!eoe->tx_queue_active &&
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	312	eoe->queued_frames == EC_EOE_TX_QUEUE_SIZE / 2) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	313	netif_wake_queue(eoe->dev);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	314	eoe->tx_queue_active = 1;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	315	wakeup = 1;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	316	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	317	eoe->queued_frames--;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	318	spin_unlock_bh(&eoe->tx_queue_lock);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	319
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	320	EC_DBG("EoE TX Sending frame with %i octets."
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	321	" (%i frames queued).\n",
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	322	frame->skb->len, eoe->queued_frames);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	323
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	324	if (wakeup) EC_DBG("waking up TX queue...\n");
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	325
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	326	if (!(data = ec_slave_mbox_prepare_send(eoe->slave, 0x02,
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	327	frame->skb->len + 4))) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	328	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	329	kfree(frame);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	330	eoe->stats.tx_errors++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	331	eoe->state = EC_EOE_RX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	332	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	333	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	334
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	335	eoe->tx_frame_number++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	336	eoe->tx_frame_number %= 16;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	337
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	338	EC_WRITE_U16(data, 0x0100); // eoe fragment req.
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	339	EC_WRITE_U16(data + 2, (eoe->tx_frame_number & 0x0F) << 12);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	340
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	341	memcpy(data + 4, frame->skb->data, frame->skb->len);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	342	ec_master_queue_command(master, &eoe->slave->mbox_command);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	343
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	344	eoe->last_tx_bytes = frame->skb->len;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	345	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	346	kfree(frame);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	347
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	348	eoe->state = EC_EOE_TX_SENT;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	349	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	350
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	351	case EC_EOE_TX_SENT:
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	352	if (eoe->slave->mbox_command.state != EC_CMD_RECEIVED) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	353	eoe->stats.tx_errors++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	354	eoe->state = EC_EOE_RX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	355	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	356	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	357	if (eoe->slave->mbox_command.working_counter != 1) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	358	eoe->stats.tx_errors++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	359	eoe->state = EC_EOE_RX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	360	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	361	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	362
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	363	eoe->stats.tx_packets++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	364	eoe->stats.tx_bytes += eoe->last_tx_bytes;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	365	eoe->state = EC_EOE_RX_START;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	366	break;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	367
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	368	default:
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	369	break;
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	370	}
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	371	}
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	372
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	373	/*****************************************************************************/
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	374
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	375	/**
199 04ecf40fc2e9 Doxygen added interface modules and file documentation. Florian Pose <fp@igh-essen.com> parents: 197 diff changeset	376	Prints EoE object information.
197 b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	377	*/
b9a6e2c22745 GPLv2 License and enhanced Doxygen output. Florian Pose <fp@igh-essen.com> parents: 195 diff changeset	378
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	379	void ec_eoe_print(const ec_eoe_t *eoe)
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	380	{
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	381	EC_INFO(" EoE slave %i\n", eoe->slave->ring_position);
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	382	EC_INFO(" State %i\n", eoe->state);
210 1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	383	EC_INFO(" Assigned device: %s (%s)\n", eoe->dev->name,
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	384	eoe->opened ? "opened" : "closed");
145 11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	385	}
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	386
11a82e4fd31b Mailbox-Interface ausgelagert, erster EOE-Ansatz. Florian Pose <fp@igh-essen.com> parents: diff changeset	387	/*****************************************************************************/
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	388
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	389	/**
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	390	Initializes a net_device structure for an EoE object.
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	391	*/
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	392
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	393	void ec_eoedev_init(struct net_device dev /< pointer to the net_device /)
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	394	{
213 8d723b9833a9 removed unnecessary private structure in eoe net_device. Florian Pose <fp@igh-essen.com> parents: 212 diff changeset	395	ec_eoe_t *priv;
210 1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	396	unsigned int i;
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	397
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	398	// initialize net_device
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	399	ether_setup(dev);
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	400	dev->open = ec_eoedev_open;
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	401	dev->stop = ec_eoedev_stop;
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	402	dev->hard_start_xmit = ec_eoedev_tx;
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	403	dev->get_stats = ec_eoedev_stats;
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	404
210 1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	405	for (i = 0; i < 6; i++) dev->dev_addr[i] = (i + 1) \| (i + 1) << 4;
1cc6bcb1e6ae EoE frame receiving; regarding open/stop commands. Florian Pose <fp@igh-essen.com> parents: 208 diff changeset	406
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	407	// initialize private data
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	408	priv = netdev_priv(dev);
213 8d723b9833a9 removed unnecessary private structure in eoe net_device. Florian Pose <fp@igh-essen.com> parents: 212 diff changeset	409	memset(priv, 0, sizeof(ec_eoe_t *));
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	410	}
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	411
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	412	/*****************************************************************************/
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	413
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	414	/**
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	415	Opens the virtual network device.
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	416	*/
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	417
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	418	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	419	{
213 8d723b9833a9 removed unnecessary private structure in eoe net_device. Florian Pose <fp@igh-essen.com> parents: 212 diff changeset	420	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	421	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	422	eoe->opened = 1;
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	423	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	424	eoe->tx_queue_active = 1;
212 82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue. Florian Pose <fp@igh-essen.com> parents: 210 diff changeset	425	EC_INFO("%s (slave %i) opened.\n", dev->name, eoe->slave->ring_position);
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	426	return 0;
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	427	}
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	428
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	429	/*****************************************************************************/
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	430
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	431	/**
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	432	Stops the virtual network device.
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	433	*/
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	434
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	435	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	436	{
213 8d723b9833a9 removed unnecessary private structure in eoe net_device. Florian Pose <fp@igh-essen.com> parents: 212 diff changeset	437	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	438	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	439	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	440	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	441	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	442	EC_INFO("%s (slave %i) stopped.\n", dev->name, eoe->slave->ring_position);
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	443	return 0;
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	444	}
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	445
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	446	/*****************************************************************************/
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	447
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	448	/**
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	449	Transmits data via the virtual network device.
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	450	*/
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	451
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	452	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	453	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	454	)
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue. Florian Pose <fp@igh-essen.com> parents: 210 diff changeset	455	{
213 8d723b9833a9 removed unnecessary private structure in eoe net_device. Florian Pose <fp@igh-essen.com> parents: 212 diff changeset	456	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	457	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	458
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	459	if (skb->len + 10 > eoe->slave->sii_tx_mailbox_size) {
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	460	EC_WARN("EoE TX frame (%i octets) exceeds MTU. dropping.\n", skb->len);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	461	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	462	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	463	return 0;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	464	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	465
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	466	if (!(frame =
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	467	(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	468	if (printk_ratelimit())
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	469	EC_WARN("EoE TX: low on mem. frame dropped.\n");
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	470	return 1;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	471	}
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	472
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	473	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	474
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue. Florian Pose <fp@igh-essen.com> parents: 210 diff changeset	475	spin_lock_bh(&eoe->tx_queue_lock);
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	476	list_add_tail(&frame->queue, &eoe->tx_queue);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	477	eoe->queued_frames++;
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	478	if (eoe->queued_frames == EC_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	479	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	480	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	481	}
212 82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue. Florian Pose <fp@igh-essen.com> parents: 210 diff changeset	482	spin_unlock_bh(&eoe->tx_queue_lock);
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue. Florian Pose <fp@igh-essen.com> parents: 210 diff changeset	483
214 8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	484	EC_DBG("EoE TX queued frame with %i octets (%i frames queued).\n",
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	485	skb->len, eoe->queued_frames);
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	486	if (!eoe->tx_queue_active)
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	487	EC_WARN("EoE TX queue is now full.\n");
8beb86af5ed0 EoE frame queuing, receiving of fragmented frames; no TCP possible yet. Florian Pose <fp@igh-essen.com> parents: 213 diff changeset	488
203 c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	489	return 0;
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	490	}
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	491
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	492	/*****************************************************************************/
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	493
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	494	/**
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	495	Gets statistics about the virtual network device.
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	496	*/
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	497
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	498	struct net_device_stats ec_eoedev_stats(struct net_device dev
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	499	/*< EoE net_device /)
c1f305e339c6 EoE net_device implementation. Florian Pose <fp@igh-essen.com> parents: 199 diff changeset	500	{
213 8d723b9833a9 removed unnecessary private structure in eoe net_device. Florian Pose <fp@igh-essen.com> parents: 212 diff changeset	501	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	502	return &eoe->stats;
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue. Florian Pose <fp@igh-essen.com> parents: 210 diff changeset	503	}
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue. Florian Pose <fp@igh-essen.com> parents: 210 diff changeset	504
82980deb8b00 moved stats into eoe struct; persistent rx-skb; tx queue. Florian Pose <fp@igh-essen.com> parents: 210 diff changeset	505	/*****************************************************************************/

author	Florian Pose <fp@igh-essen.com>
	Fri, 05 May 2006 07:20:10 +0000
changeset 214	8beb86af5ed0
parent 213	8d723b9833a9
child 215	b021aa6eee38
permissions	-rw-r--r--