author | Patrick Bruenn <p.bruenn@beckhoff.com> |
Thu, 05 Jun 2014 16:07:52 +0200 | |
branch | stable-1.5 |
changeset 2567 | d70aad2f131f |
parent 2565 | f7b06b264646 |
child 2568 | 2f3078ec9ffb |
permissions | -rw-r--r-- |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
1 |
/** |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
2 |
Network Driver for Beckhoff CCAT communication controller |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
3 |
Copyright (C) 2014 Beckhoff Automation GmbH |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
4 |
Author: Patrick Bruenn <p.bruenn@beckhoff.com> |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
5 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
6 |
This program is free software; you can redistribute it and/or modify |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
7 |
it under the terms of the GNU General Public License as published by |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
8 |
the Free Software Foundation; either version 2 of the License, or |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
9 |
(at your option) any later version. |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
10 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
11 |
This program is distributed in the hope that it will be useful, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
12 |
but WITHOUT ANY WARRANTY; without even the implied warranty of |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
13 |
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
14 |
GNU General Public License for more details. |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
15 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
16 |
You should have received a copy of the GNU General Public License along |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
17 |
with this program; if not, write to the Free Software Foundation, Inc., |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
18 |
51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
19 |
*/ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
20 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
21 |
#include <linux/etherdevice.h> |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
22 |
#include <linux/init.h> |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
23 |
#include <linux/kernel.h> |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
24 |
#include <linux/module.h> |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
25 |
#include <linux/netdevice.h> |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
26 |
#include <linux/spinlock.h> |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
27 |
|
2552
6e419c23b1b3
added ccat support for kernel 2.6.32
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2551
diff
changeset
|
28 |
#include "compat.h" |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
29 |
#include "module.h" |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
30 |
#include "netdev.h" |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
31 |
#include "print.h" |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
32 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
33 |
/** |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
34 |
* EtherCAT frame to enable forwarding on EtherCAT Terminals |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
35 |
*/ |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
36 |
static const u8 frameForwardEthernetFrames[] = { |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
37 |
0x01, 0x01, 0x05, 0x01, 0x00, 0x00, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
38 |
0x00, 0x1b, 0x21, 0x36, 0x1b, 0xce, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
39 |
0x88, 0xa4, 0x0e, 0x10, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
40 |
0x08, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
41 |
0x00, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
42 |
0x00, 0x00, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
43 |
0x00, 0x01, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
44 |
0x02, 0x00, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
45 |
0x00, 0x00, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
46 |
0x00, 0x00, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
47 |
0x00, 0x00 |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
48 |
}; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
49 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
50 |
#define FIFO_LENGTH 64 |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
51 |
static void ec_poll(struct net_device *dev); |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
52 |
static enum hrtimer_restart poll_timer_callback(struct hrtimer *timer); |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
53 |
|
2552
6e419c23b1b3
added ccat support for kernel 2.6.32
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2551
diff
changeset
|
54 |
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35) |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
55 |
static struct rtnl_link_stats64 *ccat_eth_get_stats64(struct net_device *dev, struct rtnl_link_stats64 |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
56 |
*storage); |
2552
6e419c23b1b3
added ccat support for kernel 2.6.32
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2551
diff
changeset
|
57 |
#endif |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
58 |
static int ccat_eth_open(struct net_device *dev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
59 |
static netdev_tx_t ccat_eth_start_xmit(struct sk_buff *skb, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
60 |
struct net_device *dev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
61 |
static int ccat_eth_stop(struct net_device *dev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
62 |
static void ccat_eth_xmit_raw(struct net_device *dev, const char *data, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
63 |
size_t len); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
64 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
65 |
static const struct net_device_ops ccat_eth_netdev_ops = { |
2552
6e419c23b1b3
added ccat support for kernel 2.6.32
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2551
diff
changeset
|
66 |
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35) |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
67 |
.ndo_get_stats64 = ccat_eth_get_stats64, |
2552
6e419c23b1b3
added ccat support for kernel 2.6.32
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2551
diff
changeset
|
68 |
#endif |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
69 |
.ndo_open = ccat_eth_open, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
70 |
.ndo_start_xmit = ccat_eth_start_xmit, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
71 |
.ndo_stop = ccat_eth_stop, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
72 |
}; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
73 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
74 |
static void ecdev_kfree_skb_any(struct sk_buff *skb) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
75 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
76 |
/* never release a skb in EtherCAT mode */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
77 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
78 |
|
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
79 |
static bool ecdev_carrier_ok(struct net_device *const netdev) |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
80 |
{ |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
81 |
struct ccat_eth_priv *const priv = netdev_priv(netdev); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
82 |
return ecdev_get_link(priv->ecdev); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
83 |
} |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
84 |
|
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
85 |
static void ecdev_carrier_on(struct net_device *const netdev) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
86 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
87 |
struct ccat_eth_priv *const priv = netdev_priv(netdev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
88 |
ecdev_set_link(priv->ecdev, 1); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
89 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
90 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
91 |
static void ecdev_carrier_off(struct net_device *const netdev) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
92 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
93 |
struct ccat_eth_priv *const priv = netdev_priv(netdev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
94 |
ecdev_set_link(priv->ecdev, 0); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
95 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
96 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
97 |
static void ecdev_nop(struct net_device *const netdev) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
98 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
99 |
/* dummy called if nothing has to be done in EtherCAT operation mode */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
100 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
101 |
|
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
102 |
static void ecdev_tx_fifo_full(struct ccat_eth_priv *const priv, |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
103 |
const struct ccat_eth_frame *const frame) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
104 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
105 |
/* we are polled -> there is nothing we can do in EtherCAT mode */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
106 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
107 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
108 |
static void unregister_ecdev(struct net_device *const netdev) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
109 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
110 |
struct ccat_eth_priv *const priv = netdev_priv(netdev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
111 |
ecdev_close(priv->ecdev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
112 |
ecdev_withdraw(priv->ecdev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
113 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
114 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
115 |
typedef void (*fifo_add_function) (struct ccat_eth_frame *, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
116 |
struct ccat_eth_dma_fifo *); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
117 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
118 |
static void ccat_eth_rx_fifo_add(struct ccat_eth_frame *frame, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
119 |
struct ccat_eth_dma_fifo *fifo) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
120 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
121 |
const size_t offset = ((void *)(frame) - fifo->dma.virt); |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
122 |
const u32 addr_and_length = (1 << 31) | offset; |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
123 |
|
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
124 |
frame->received = 0; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
125 |
iowrite32(addr_and_length, fifo->reg); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
126 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
127 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
128 |
static void ccat_eth_tx_fifo_add_free(struct ccat_eth_frame *frame, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
129 |
struct ccat_eth_dma_fifo *fifo) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
130 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
131 |
/* mark frame as ready to use for tx */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
132 |
frame->sent = 1; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
133 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
134 |
|
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
135 |
static void ccat_eth_tx_fifo_full(struct ccat_eth_priv *const priv, |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
136 |
const struct ccat_eth_frame *const frame) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
137 |
{ |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
138 |
priv->stop_queue(priv->netdev); |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
139 |
priv->next_tx_frame = frame; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
140 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
141 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
142 |
static void ccat_eth_dma_fifo_reset(struct ccat_eth_dma_fifo *fifo) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
143 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
144 |
struct ccat_eth_frame *frame = fifo->dma.virt; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
145 |
const struct ccat_eth_frame *const end = frame + FIFO_LENGTH; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
146 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
147 |
/* reset hw fifo */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
148 |
iowrite32(0, fifo->reg + 0x8); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
149 |
wmb(); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
150 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
151 |
if (fifo->add) { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
152 |
while (frame < end) { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
153 |
fifo->add(frame, fifo); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
154 |
++frame; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
155 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
156 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
157 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
158 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
159 |
static int ccat_eth_dma_fifo_init(struct ccat_eth_dma_fifo *fifo, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
160 |
void __iomem * const fifo_reg, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
161 |
fifo_add_function add, size_t channel, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
162 |
struct ccat_eth_priv *const priv) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
163 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
164 |
if (0 != |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
165 |
ccat_dma_init(&fifo->dma, channel, priv->ccatdev->bar[2].ioaddr, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
166 |
&priv->ccatdev->pdev->dev)) { |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
167 |
pr_info("init DMA%llu memory failed.\n", (u64) channel); |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
168 |
return -1; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
169 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
170 |
fifo->add = add; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
171 |
fifo->reg = fifo_reg; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
172 |
return 0; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
173 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
174 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
175 |
/** |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
176 |
* Stop both (Rx/Tx) DMA fifo's and free related management structures |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
177 |
*/ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
178 |
static void ccat_eth_priv_free_dma(struct ccat_eth_priv *priv) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
179 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
180 |
/* reset hw fifo's */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
181 |
iowrite32(0, priv->rx_fifo.reg + 0x8); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
182 |
iowrite32(0, priv->tx_fifo.reg + 0x8); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
183 |
wmb(); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
184 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
185 |
/* release dma */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
186 |
ccat_dma_free(&priv->rx_fifo.dma); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
187 |
ccat_dma_free(&priv->tx_fifo.dma); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
188 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
189 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
190 |
/** |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
191 |
* Initalizes both (Rx/Tx) DMA fifo's and related management structures |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
192 |
*/ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
193 |
static int ccat_eth_priv_init_dma(struct ccat_eth_priv *priv) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
194 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
195 |
if (ccat_eth_dma_fifo_init |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
196 |
(&priv->rx_fifo, priv->reg.rx_fifo, ccat_eth_rx_fifo_add, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
197 |
priv->info.rxDmaChn, priv)) { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
198 |
pr_warn("init Rx DMA fifo failed.\n"); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
199 |
return -1; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
200 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
201 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
202 |
if (ccat_eth_dma_fifo_init |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
203 |
(&priv->tx_fifo, priv->reg.tx_fifo, ccat_eth_tx_fifo_add_free, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
204 |
priv->info.txDmaChn, priv)) { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
205 |
pr_warn("init Tx DMA fifo failed.\n"); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
206 |
ccat_dma_free(&priv->rx_fifo.dma); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
207 |
return -1; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
208 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
209 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
210 |
/* disable MAC filter */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
211 |
iowrite8(0, priv->reg.mii + 0x8 + 6); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
212 |
wmb(); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
213 |
return 0; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
214 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
215 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
216 |
/** |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
217 |
* Initializes the CCat... members of the ccat_eth_priv structure. |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
218 |
* Call this function only if info and ioaddr are already initialized! |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
219 |
*/ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
220 |
static void ccat_eth_priv_init_mappings(struct ccat_eth_priv *priv) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
221 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
222 |
CCatInfoBlockOffs offsets; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
223 |
void __iomem *const func_base = |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
224 |
priv->ccatdev->bar[0].ioaddr + priv->info.nAddr; |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
225 |
|
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
226 |
memcpy_fromio(&offsets, func_base, sizeof(offsets)); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
227 |
priv->reg.mii = func_base + offsets.nMMIOffs; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
228 |
priv->reg.tx_fifo = func_base + offsets.nTxFifoOffs; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
229 |
priv->reg.rx_fifo = func_base + offsets.nTxFifoOffs + 0x10; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
230 |
priv->reg.mac = func_base + offsets.nMacRegOffs; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
231 |
priv->reg.rx_mem = func_base + offsets.nRxMemOffs; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
232 |
priv->reg.tx_mem = func_base + offsets.nTxMemOffs; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
233 |
priv->reg.misc = func_base + offsets.nMiscOffs; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
234 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
235 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
236 |
/** |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
237 |
* Read link state from CCAT hardware |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
238 |
* @return 1 if link is up, 0 if not |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
239 |
*/ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
240 |
inline static size_t ccat_eth_priv_read_link_state(const struct ccat_eth_priv |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
241 |
*const priv) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
242 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
243 |
return (1 << 24) == (ioread32(priv->reg.mii + 0x8 + 4) & (1 << 24)); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
244 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
245 |
|
2552
6e419c23b1b3
added ccat support for kernel 2.6.32
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2551
diff
changeset
|
246 |
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 35) |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
247 |
static struct rtnl_link_stats64 *ccat_eth_get_stats64(struct net_device *dev, struct rtnl_link_stats64 |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
248 |
*storage) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
249 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
250 |
struct ccat_eth_priv *const priv = netdev_priv(dev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
251 |
CCatMacRegs mac; |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
252 |
|
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
253 |
memcpy_fromio(&mac, priv->reg.mac, sizeof(mac)); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
254 |
storage->rx_packets = mac.rxFrameCnt; /* total packets received */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
255 |
storage->tx_packets = mac.txFrameCnt; /* total packets transmitted */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
256 |
storage->rx_bytes = atomic64_read(&priv->rx_bytes); /* total bytes received */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
257 |
storage->tx_bytes = atomic64_read(&priv->tx_bytes); /* total bytes transmitted */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
258 |
storage->rx_errors = mac.frameLenErrCnt + mac.dropFrameErrCnt + mac.crcErrCnt + mac.rxErrCnt; /* bad packets received */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
259 |
//TODO __u64 tx_errors; /* packet transmit problems */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
260 |
storage->rx_dropped = atomic64_read(&priv->rx_dropped); /* no space in linux buffers */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
261 |
storage->tx_dropped = atomic64_read(&priv->tx_dropped); /* no space available in linux */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
262 |
//TODO __u64 multicast; /* multicast packets received */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
263 |
//TODO __u64 collisions; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
264 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
265 |
/* detailed rx_errors: */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
266 |
storage->rx_length_errors = mac.frameLenErrCnt; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
267 |
storage->rx_over_errors = mac.dropFrameErrCnt; /* receiver ring buff overflow */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
268 |
storage->rx_crc_errors = mac.crcErrCnt; /* recved pkt with crc error */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
269 |
storage->rx_frame_errors = mac.rxErrCnt; /* recv'd frame alignment error */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
270 |
storage->rx_fifo_errors = mac.dropFrameErrCnt; /* recv'r fifo overrun */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
271 |
//TODO __u64 rx_missed_errors; /* receiver missed packet */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
272 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
273 |
/* detailed tx_errors */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
274 |
//TODO __u64 tx_aborted_errors; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
275 |
//TODO __u64 tx_carrier_errors; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
276 |
//TODO __u64 tx_fifo_errors; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
277 |
//TODO __u64 tx_heartbeat_errors; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
278 |
//TODO __u64 tx_window_errors; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
279 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
280 |
/* for cslip etc */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
281 |
//TODO __u64 rx_compressed; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
282 |
//TODO __u64 tx_compressed; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
283 |
return storage; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
284 |
} |
2552
6e419c23b1b3
added ccat support for kernel 2.6.32
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2551
diff
changeset
|
285 |
#endif |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
286 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
287 |
struct ccat_eth_priv *ccat_eth_init(const struct ccat_device *const ccatdev, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
288 |
const void __iomem * const addr) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
289 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
290 |
struct ccat_eth_priv *priv; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
291 |
struct net_device *const netdev = alloc_etherdev(sizeof(*priv)); |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
292 |
|
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
293 |
priv = netdev_priv(netdev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
294 |
priv->netdev = netdev; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
295 |
priv->ccatdev = ccatdev; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
296 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
297 |
/* ccat register mappings */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
298 |
memcpy_fromio(&priv->info, addr, sizeof(priv->info)); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
299 |
ccat_eth_priv_init_mappings(priv); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
300 |
ccat_print_function_info(priv); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
301 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
302 |
if (ccat_eth_priv_init_dma(priv)) { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
303 |
pr_warn("%s(): DMA initialization failed.\n", __FUNCTION__); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
304 |
free_netdev(netdev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
305 |
return NULL; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
306 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
307 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
308 |
/* init netdev with MAC and stack callbacks */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
309 |
memcpy_fromio(netdev->dev_addr, priv->reg.mii + 8, 6); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
310 |
netdev->netdev_ops = &ccat_eth_netdev_ops; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
311 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
312 |
/* use as EtherCAT device? */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
313 |
priv->ecdev = ecdev_offer(netdev, ec_poll, THIS_MODULE); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
314 |
if (priv->ecdev) { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
315 |
priv->carrier_off = ecdev_carrier_off; |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
316 |
priv->carrier_ok = ecdev_carrier_ok; |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
317 |
priv->carrier_on = ecdev_carrier_on; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
318 |
priv->kfree_skb_any = ecdev_kfree_skb_any; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
319 |
priv->start_queue = ecdev_nop; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
320 |
priv->stop_queue = ecdev_nop; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
321 |
priv->tx_fifo_full = ecdev_tx_fifo_full; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
322 |
priv->unregister = unregister_ecdev; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
323 |
if (ecdev_open(priv->ecdev)) { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
324 |
pr_info("unable to register network device.\n"); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
325 |
ecdev_withdraw(priv->ecdev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
326 |
ccat_eth_priv_free_dma(priv); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
327 |
free_netdev(netdev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
328 |
return NULL; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
329 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
330 |
return priv; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
331 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
332 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
333 |
/* EtherCAT disabled -> prepare normal ethernet mode */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
334 |
priv->carrier_off = netif_carrier_off; |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
335 |
priv->carrier_ok = netif_carrier_ok; |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
336 |
priv->carrier_on = netif_carrier_on; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
337 |
priv->kfree_skb_any = dev_kfree_skb_any; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
338 |
priv->start_queue = netif_start_queue; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
339 |
priv->stop_queue = netif_stop_queue; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
340 |
priv->tx_fifo_full = ccat_eth_tx_fifo_full; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
341 |
priv->unregister = unregister_netdev; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
342 |
if (register_netdev(netdev)) { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
343 |
pr_info("unable to register network device.\n"); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
344 |
ccat_eth_priv_free_dma(priv); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
345 |
free_netdev(netdev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
346 |
return NULL; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
347 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
348 |
pr_info("registered %s as network device.\n", netdev->name); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
349 |
return priv; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
350 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
351 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
352 |
void ccat_eth_remove(struct ccat_eth_priv *const priv) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
353 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
354 |
priv->unregister(priv->netdev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
355 |
ccat_eth_priv_free_dma(priv); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
356 |
free_netdev(priv->netdev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
357 |
pr_debug("%s(): done\n", __FUNCTION__); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
358 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
359 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
360 |
static int ccat_eth_open(struct net_device *dev) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
361 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
362 |
struct ccat_eth_priv *const priv = netdev_priv(dev); |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
363 |
|
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
364 |
priv->carrier_off(dev); |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
365 |
hrtimer_init(&priv->poll_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
366 |
priv->poll_timer.function = poll_timer_callback; |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
367 |
hrtimer_start(&priv->poll_timer, ktime_set(0, 100000), |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
368 |
HRTIMER_MODE_REL); |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
369 |
return 0; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
370 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
371 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
372 |
static const size_t CCATRXDESC_HEADER_LEN = 20; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
373 |
static void ccat_eth_receive(struct net_device *const dev, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
374 |
const struct ccat_eth_frame *const frame) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
375 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
376 |
struct ccat_eth_priv *const priv = netdev_priv(dev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
377 |
const size_t len = frame->length - CCATRXDESC_HEADER_LEN; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
378 |
struct sk_buff *skb = dev_alloc_skb(len + NET_IP_ALIGN); |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
379 |
|
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
380 |
if (!skb) { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
381 |
pr_info("%s() out of memory :-(\n", __FUNCTION__); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
382 |
atomic64_inc(&priv->rx_dropped); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
383 |
return; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
384 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
385 |
skb->dev = dev; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
386 |
skb_reserve(skb, NET_IP_ALIGN); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
387 |
skb_copy_to_linear_data(skb, frame->data, len); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
388 |
skb_put(skb, len); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
389 |
skb->protocol = eth_type_trans(skb, dev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
390 |
skb->ip_summed = CHECKSUM_UNNECESSARY; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
391 |
atomic64_add(len, &priv->rx_bytes); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
392 |
netif_rx(skb); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
393 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
394 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
395 |
/** |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
396 |
* Rx handler in EtherCAT operation mode |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
397 |
* priv->ecdev should always be valid! |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
398 |
*/ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
399 |
static void ec_poll(struct net_device *dev) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
400 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
401 |
static size_t next = 0; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
402 |
struct ccat_eth_priv *const priv = netdev_priv(dev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
403 |
struct ccat_eth_frame *frame = |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
404 |
((struct ccat_eth_frame *)priv->rx_fifo.dma.virt) + next; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
405 |
if (frame->received) { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
406 |
ecdev_receive(priv->ecdev, frame->data, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
407 |
frame->length - CCATRXDESC_HEADER_LEN); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
408 |
frame->received = 0; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
409 |
ccat_eth_rx_fifo_add(frame, &priv->rx_fifo); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
410 |
next = (next + 1) % FIFO_LENGTH; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
411 |
} else { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
412 |
//TODO dev_warn(&dev->dev, "%s(): frame was not ready\n", __FUNCTION__); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
413 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
414 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
415 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
416 |
static netdev_tx_t ccat_eth_start_xmit(struct sk_buff *skb, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
417 |
struct net_device *dev) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
418 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
419 |
static size_t next = 0; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
420 |
struct ccat_eth_priv *const priv = netdev_priv(dev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
421 |
struct ccat_eth_frame *const frame = |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
422 |
((struct ccat_eth_frame *)priv->tx_fifo.dma.virt); |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
423 |
u32 addr_and_length; |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
424 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
425 |
if (skb_is_nonlinear(skb)) { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
426 |
pr_warn("Non linear skb not supported -> drop frame.\n"); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
427 |
atomic64_inc(&priv->tx_dropped); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
428 |
priv->kfree_skb_any(skb); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
429 |
return NETDEV_TX_OK; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
430 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
431 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
432 |
if (skb->len > sizeof(frame->data)) { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
433 |
pr_warn("skb.len %llu exceeds dma buffer %llu -> drop frame.\n", |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
434 |
(u64) skb->len, (u64) sizeof(frame->data)); |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
435 |
atomic64_inc(&priv->tx_dropped); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
436 |
priv->kfree_skb_any(skb); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
437 |
return NETDEV_TX_OK; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
438 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
439 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
440 |
if (!frame[next].sent) { |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
441 |
netdev_err(dev, "BUG! Tx Ring full when queue awake!\n"); |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
442 |
ccat_eth_tx_fifo_full(priv, &frame[next]); |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
443 |
return NETDEV_TX_BUSY; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
444 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
445 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
446 |
/* prepare frame in DMA memory */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
447 |
frame[next].sent = 0; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
448 |
frame[next].length = skb->len; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
449 |
memcpy(frame[next].data, skb->data, skb->len); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
450 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
451 |
priv->kfree_skb_any(skb); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
452 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
453 |
addr_and_length = 8 + (next * sizeof(*frame)); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
454 |
addr_and_length += |
2551
000da5069f1a
clean up CCatDefinitions.h
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2550
diff
changeset
|
455 |
((frame[next].length + CCAT_DMA_FRAME_HEADER_LENGTH) / 8) << 24; |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
456 |
iowrite32(addr_and_length, priv->reg.tx_fifo); /* add to DMA fifo */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
457 |
atomic64_add(frame[next].length, &priv->tx_bytes); /* update stats */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
458 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
459 |
next = (next + 1) % FIFO_LENGTH; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
460 |
/* stop queue if tx ring is full */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
461 |
if (!frame[next].sent) { |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
462 |
ccat_eth_tx_fifo_full(priv, &frame[next]); |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
463 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
464 |
return NETDEV_TX_OK; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
465 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
466 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
467 |
static int ccat_eth_stop(struct net_device *dev) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
468 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
469 |
struct ccat_eth_priv *const priv = netdev_priv(dev); |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
470 |
|
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
471 |
priv->stop_queue(dev); |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
472 |
hrtimer_cancel(&priv->poll_timer); |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
473 |
netdev_info(dev, "stopped.\n"); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
474 |
return 0; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
475 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
476 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
477 |
static void ccat_eth_link_down(struct net_device *dev) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
478 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
479 |
struct ccat_eth_priv *const priv = netdev_priv(dev); |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
480 |
|
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
481 |
priv->stop_queue(dev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
482 |
priv->carrier_off(dev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
483 |
netdev_info(dev, "NIC Link is Down\n"); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
484 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
485 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
486 |
static void ccat_eth_link_up(struct net_device *const dev) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
487 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
488 |
struct ccat_eth_priv *const priv = netdev_priv(dev); |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
489 |
|
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
490 |
netdev_info(dev, "NIC Link is Up\n"); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
491 |
/* TODO netdev_info(dev, "NIC Link is Up %u Mbps %s Duplex\n", |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
492 |
speed == SPEED_100 ? 100 : 10, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
493 |
cmd.duplex == DUPLEX_FULL ? "Full" : "Half"); */ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
494 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
495 |
ccat_eth_dma_fifo_reset(&priv->rx_fifo); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
496 |
ccat_eth_dma_fifo_reset(&priv->tx_fifo); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
497 |
ccat_eth_xmit_raw(dev, frameForwardEthernetFrames, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
498 |
sizeof(frameForwardEthernetFrames)); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
499 |
priv->carrier_on(dev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
500 |
priv->start_queue(dev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
501 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
502 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
503 |
/** |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
504 |
* Function to transmit a raw buffer to the network (f.e. frameForwardEthernetFrames) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
505 |
* @dev a valid net_device |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
506 |
* @data pointer to your raw buffer |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
507 |
* @len number of bytes in the raw buffer to transmit |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
508 |
*/ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
509 |
static void ccat_eth_xmit_raw(struct net_device *dev, const char *const data, |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
510 |
size_t len) |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
511 |
{ |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
512 |
struct sk_buff *skb = dev_alloc_skb(len); |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
513 |
|
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
514 |
skb->dev = dev; |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
515 |
skb_copy_to_linear_data(skb, data, len); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
516 |
skb_put(skb, len); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
517 |
ccat_eth_start_xmit(skb, dev); |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
518 |
} |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
519 |
|
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
520 |
/** |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
521 |
* Poll for link state changes |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
522 |
*/ |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
523 |
static void poll_link(struct ccat_eth_priv *const priv) |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
524 |
{ |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
525 |
const size_t link = ccat_eth_priv_read_link_state(priv); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
526 |
|
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
527 |
if (link != priv->carrier_ok(priv->netdev)) { |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
528 |
if (link) |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
529 |
ccat_eth_link_up(priv->netdev); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
530 |
else |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
531 |
ccat_eth_link_down(priv->netdev); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
532 |
} |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
533 |
} |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
534 |
|
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
535 |
/** |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
536 |
* Poll for available rx dma descriptors in ethernet operating mode |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
537 |
*/ |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
538 |
static void poll_rx(struct ccat_eth_priv *const priv) |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
539 |
{ |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
540 |
struct ccat_eth_frame *const frame = priv->rx_fifo.dma.virt; |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
541 |
static size_t next = 0; |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
542 |
|
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
543 |
/* TODO omit possible deadlock in situations with heavy traffic */ |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
544 |
while (frame[next].received) { |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
545 |
ccat_eth_receive(priv->netdev, frame + next); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
546 |
frame[next].received = 0; |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
547 |
ccat_eth_rx_fifo_add(frame + next, &priv->rx_fifo); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
548 |
next = (next + 1) % FIFO_LENGTH; |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
549 |
} |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
550 |
} |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
551 |
|
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
552 |
/** |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
553 |
* Poll for available tx dma descriptors in ethernet operating mode |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
554 |
*/ |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
555 |
static void poll_tx(struct ccat_eth_priv *const priv) |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
556 |
{ |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
557 |
if (priv->next_tx_frame && priv->next_tx_frame->sent) { |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
558 |
priv->next_tx_frame = NULL; |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
559 |
netif_wake_queue(priv->netdev); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
560 |
} |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
561 |
} |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
562 |
|
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
563 |
/** |
2550
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
564 |
* Since CCAT doesn't support interrupts until now, we have to poll |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
565 |
* some status bits to recognize things like link change etc. |
7e25950ea941
replace not working symlinks with real copies from the ccat main repository(git)
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2549
diff
changeset
|
566 |
*/ |
2567
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
567 |
static enum hrtimer_restart poll_timer_callback(struct hrtimer *timer) |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
568 |
{ |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
569 |
struct ccat_eth_priv *priv = container_of(timer, struct ccat_eth_priv, |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
570 |
poll_timer); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
571 |
|
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
572 |
poll_link(priv); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
573 |
if(!priv->ecdev) |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
574 |
poll_rx(priv); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
575 |
poll_tx(priv); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
576 |
hrtimer_forward_now(timer, ktime_set(0, 100 * NSEC_PER_USEC)); |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
577 |
return HRTIMER_RESTART; |
d70aad2f131f
- use short kernel types, add empty lines after variable declaration to conform better with linux coding style
Patrick Bruenn <p.bruenn@beckhoff.com>
parents:
2565
diff
changeset
|
578 |
} |