devices/generic.c
author Florian Pose <fp@igh-essen.com>
Thu, 15 Oct 2009 17:38:53 +0200
changeset 1541 26ac1c611100
parent 1540 49430a3fe73d
child 1542 91ae9c95dd2e
permissions -rw-r--r--
Sending via generic device works.
1540
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     1
/******************************************************************************
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     2
 *
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     3
 *  $Id$
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     4
 *
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     5
 *  Copyright (C) 2006-2008  Florian Pose, Ingenieurgemeinschaft IgH
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     6
 *
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     7
 *  This file is part of the IgH EtherCAT Master.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     8
 *
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
     9
 *  The IgH EtherCAT Master is free software; you can redistribute it and/or
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    10
 *  modify it under the terms of the GNU General Public License version 2, as
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    11
 *  published by the Free Software Foundation.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    12
 *
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    13
 *  The IgH EtherCAT Master is distributed in the hope that it will be useful,
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    14
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    15
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    16
 *  Public License for more details.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    17
 *
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    18
 *  You should have received a copy of the GNU General Public License along
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    19
 *  with the IgH EtherCAT Master; if not, write to the Free Software
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    20
 *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    21
 *
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    22
 *  ---
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    23
 *
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    24
 *  The license mentioned above concerns the source code only. Using the
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    25
 *  EtherCAT technology and brand is only permitted in compliance with the
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    26
 *  industrial property and similar rights of Beckhoff Automation GmbH.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    27
 *
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    28
 *****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    29
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    30
/** \file
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    31
 * EtherCAT generic Ethernet device module.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    32
 */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    33
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    34
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    35
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    36
#include <linux/module.h>
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    37
#include <linux/device.h>
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    38
#include <linux/err.h>
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    39
#include <linux/version.h>
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    40
#include <linux/if_arp.h> /* ARPHRD_ETHER */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    41
#include <linux/etherdevice.h>
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    42
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    43
#include "../globals.h"
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    44
#include "ecdev.h"
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    45
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    46
#define PFX "ec_generic: "
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    47
1541
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
    48
#define ETH_P_ETHERCAT 0x88A4
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
    49
1540
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    50
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    51
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    52
int __init ec_gen_init_module(void);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    53
void __exit ec_gen_cleanup_module(void);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    54
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    55
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    56
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    57
/** \cond */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    58
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    59
MODULE_AUTHOR("Florian Pose <fp@igh-essen.com>");
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    60
MODULE_DESCRIPTION("EtherCAT master generic Ethernet device module");
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    61
MODULE_LICENSE("GPL");
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    62
MODULE_VERSION(EC_MASTER_VERSION);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    63
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    64
/** \endcond */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    65
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    66
struct list_head generic_devices;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    67
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    68
typedef struct {
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    69
    struct list_head list;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    70
    struct net_device *netdev;
1541
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
    71
    struct socket *socket;
1540
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    72
    ec_device_t *ecdev;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    73
} ec_gen_device_t;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    74
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    75
int ec_gen_device_open(ec_gen_device_t *);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    76
int ec_gen_device_stop(ec_gen_device_t *);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    77
int ec_gen_device_start_xmit(ec_gen_device_t *, struct sk_buff *);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    78
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    79
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    80
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    81
static int ec_gen_netdev_open(struct net_device *dev)
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    82
{
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    83
    ec_gen_device_t *gendev = *((ec_gen_device_t **) netdev_priv(dev));
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    84
    return ec_gen_device_open(gendev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    85
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    86
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    87
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    88
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    89
static int ec_gen_netdev_stop(struct net_device *dev)
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    90
{
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    91
    ec_gen_device_t *gendev = *((ec_gen_device_t **) netdev_priv(dev));
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    92
    return ec_gen_device_stop(gendev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    93
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    94
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    95
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    96
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    97
static int ec_gen_netdev_start_xmit(
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    98
        struct sk_buff *skb,
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
    99
        struct net_device *dev
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   100
        )
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   101
{
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   102
    ec_gen_device_t *gendev = *((ec_gen_device_t **) netdev_priv(dev));
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   103
    return ec_gen_device_start_xmit(gendev, skb);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   104
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   105
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   106
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   107
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   108
void ec_gen_poll(struct net_device *dev)
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   109
{
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   110
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   111
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   112
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   113
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   114
static const struct net_device_ops ec_gen_netdev_ops = {
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   115
	.ndo_open		= ec_gen_netdev_open,
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   116
	.ndo_stop		= ec_gen_netdev_stop,
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   117
	.ndo_start_xmit	= ec_gen_netdev_start_xmit,
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   118
};
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   119
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   120
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   121
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   122
/** Init generic device.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   123
 */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   124
int ec_gen_device_init(
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   125
        ec_gen_device_t *dev,
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   126
        struct net_device *real_netdev
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   127
        )
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   128
{
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   129
    ec_gen_device_t **priv;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   130
    char null = 0x00;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   131
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   132
    dev->ecdev = NULL;
1541
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   133
    dev->socket = NULL;
1540
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   134
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   135
	dev->netdev = alloc_netdev(sizeof(ec_gen_device_t *), &null, ether_setup);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   136
	if (!dev->netdev) {
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   137
		return -ENOMEM;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   138
	}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   139
    memcpy(dev->netdev->dev_addr, real_netdev->dev_addr, ETH_ALEN);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   140
    dev->netdev->netdev_ops = &ec_gen_netdev_ops;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   141
    priv = netdev_priv(dev->netdev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   142
    *priv = dev;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   143
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   144
    return 0;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   145
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   146
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   147
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   148
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   149
/** Clear generic device.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   150
 */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   151
void ec_gen_device_clear(
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   152
        ec_gen_device_t *dev
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   153
        )
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   154
{
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   155
    if (dev->ecdev) {
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   156
        ecdev_close(dev->ecdev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   157
        ecdev_withdraw(dev->ecdev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   158
    }
1541
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   159
    if (dev->socket) {
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   160
        sock_release(dev->socket);
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   161
    }
1540
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   162
    free_netdev(dev->netdev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   163
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   164
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   165
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   166
1541
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   167
/** Creates a network socket.
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   168
 */
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   169
int ec_gen_device_create_socket(
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   170
        ec_gen_device_t *dev,
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   171
        struct net_device *real_netdev
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   172
        )
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   173
{
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   174
    int ret;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   175
    struct sockaddr_ll sa;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   176
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   177
    ret = sock_create_kern(PF_PACKET, SOCK_RAW, htons(ETH_P_ETHERCAT), &dev->socket);
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   178
    if (ret) {
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   179
        printk(KERN_ERR PFX "Failed to create socket.\n");
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   180
        return ret;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   181
    }
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   182
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   183
    printk(KERN_ERR PFX "Binding socket to interface %i (%s).\n",
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   184
            real_netdev->ifindex, real_netdev->name);
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   185
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   186
    memset(&sa, 0x00, sizeof(sa));
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   187
    sa.sll_family = AF_PACKET;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   188
    sa.sll_protocol = htons(ETH_P_ETHERCAT);
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   189
    sa.sll_ifindex = real_netdev->ifindex;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   190
    ret = kernel_bind(dev->socket, (struct sockaddr *) &sa, sizeof(sa));
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   191
    if (ret) {
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   192
        printk(KERN_ERR PFX "Failed to bind() socket to interface.\n");
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   193
        sock_release(dev->socket);
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   194
        dev->socket = NULL;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   195
        return ret;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   196
    }
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   197
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   198
    return 0;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   199
}
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   200
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   201
/*****************************************************************************/
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   202
1540
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   203
/** Offer generic device to master.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   204
 */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   205
int ec_gen_device_offer(
1541
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   206
        ec_gen_device_t *dev,
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   207
        struct net_device *real_netdev
1540
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   208
        )
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   209
{
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   210
    int ret = 0;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   211
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   212
	dev->ecdev = ecdev_offer(dev->netdev, ec_gen_poll, THIS_MODULE);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   213
    if (dev->ecdev) {
1541
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   214
        if (ec_gen_device_create_socket(dev, real_netdev)) {
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   215
            ecdev_withdraw(dev->ecdev);
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   216
            dev->ecdev = NULL;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   217
        } else if (ecdev_open(dev->ecdev)) {
1540
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   218
            ecdev_withdraw(dev->ecdev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   219
            dev->ecdev = NULL;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   220
        } else {
1541
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   221
            ecdev_set_link(dev->ecdev, 1); // FIXME
1540
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   222
            ret = 1;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   223
        }
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   224
    }
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   225
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   226
    return ret;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   227
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   228
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   229
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   230
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   231
/** Open the device.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   232
 */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   233
int ec_gen_device_open(
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   234
        ec_gen_device_t *dev
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   235
        )
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   236
{
1541
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   237
    return 0;
1540
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   238
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   239
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   240
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   241
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   242
/** Stop the device.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   243
 */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   244
int ec_gen_device_stop(
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   245
        ec_gen_device_t *dev
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   246
        )
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   247
{
1541
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   248
    return 0;
1540
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   249
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   250
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   251
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   252
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   253
int ec_gen_device_start_xmit(
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   254
        ec_gen_device_t *dev,
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   255
        struct sk_buff *skb
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   256
        )
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   257
{
1541
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   258
    struct msghdr msg;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   259
    struct kvec iov;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   260
    size_t len = skb->len;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   261
    int ret;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   262
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   263
    iov.iov_base = skb->data;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   264
    iov.iov_len = len;
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   265
    memset(&msg, 0, sizeof(msg));
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   266
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   267
    ret = kernel_sendmsg(dev->socket, &msg, &iov, 1, len);
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   268
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   269
    return ret == len ? NETDEV_TX_OK : NETDEV_TX_BUSY;
1540
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   270
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   271
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   272
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   273
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   274
/** Offer device.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   275
 */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   276
int offer_device(
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   277
        struct net_device *netdev
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   278
        )
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   279
{
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   280
    ec_gen_device_t *gendev;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   281
    int ret = 0;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   282
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   283
    gendev = kmalloc(sizeof(ec_gen_device_t), GFP_KERNEL);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   284
    if (!gendev) {
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   285
        return -ENOMEM;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   286
    }
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   287
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   288
    ret = ec_gen_device_init(gendev, netdev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   289
    if (ret) {
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   290
        kfree(gendev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   291
        return ret;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   292
    }
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   293
1541
26ac1c611100 Sending via generic device works.
Florian Pose <fp@igh-essen.com>
parents: 1540
diff changeset
   294
    if (ec_gen_device_offer(gendev, netdev)) {
1540
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   295
        list_add_tail(&gendev->list, &generic_devices);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   296
    } else {
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   297
        ec_gen_device_clear(gendev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   298
        kfree(gendev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   299
    }
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   300
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   301
    return ret;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   302
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   303
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   304
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   305
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   306
/** Clear devices.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   307
 */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   308
void clear_devices(void)
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   309
{
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   310
    ec_gen_device_t *gendev, *next;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   311
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   312
    list_for_each_entry_safe(gendev, next, &generic_devices, list) {
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   313
        list_del(&gendev->list);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   314
        ec_gen_device_clear(gendev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   315
        kfree(gendev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   316
    }
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   317
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   318
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   319
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   320
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   321
/** Module initialization.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   322
 *
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   323
 * Initializes \a master_count masters.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   324
 * \return 0 on success, else < 0
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   325
 */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   326
int __init ec_gen_init_module(void)
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   327
{
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   328
    int ret = 0;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   329
    struct net_device *netdev;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   330
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   331
    printk(KERN_INFO PFX "EtherCAT master generic Ethernet device module %s\n",
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   332
            EC_MASTER_VERSION);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   333
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   334
    INIT_LIST_HEAD(&generic_devices);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   335
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   336
    read_lock(&dev_base_lock);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   337
    for_each_netdev(&init_net, netdev) {
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   338
        if (netdev->type != ARPHRD_ETHER)
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   339
            continue;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   340
        ret = offer_device(netdev);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   341
        if (ret) {
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   342
            read_unlock(&dev_base_lock);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   343
            goto out_err;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   344
        }
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   345
    }
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   346
    read_unlock(&dev_base_lock);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   347
    return ret;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   348
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   349
out_err:
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   350
    clear_devices();
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   351
    return ret;
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   352
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   353
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   354
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   355
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   356
/** Module cleanup.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   357
 *
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   358
 * Clears all master instances.
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   359
 */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   360
void __exit ec_gen_cleanup_module(void)
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   361
{
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   362
    clear_devices();
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   363
    printk(KERN_INFO PFX "Unloading.\n");
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   364
}
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   365
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   366
/*****************************************************************************/
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   367
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   368
/** \cond */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   369
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   370
module_init(ec_gen_init_module);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   371
module_exit(ec_gen_cleanup_module);
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   372
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   373
/** \endcond */
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   374
49430a3fe73d Basic generic Ethernet device module.
Florian Pose <fp@igh-essen.com>
parents:
diff changeset
   375
/*****************************************************************************/