3 * arch/xtensa/platforms/iss/network.c
5 * Platform specific initialization.
7 * Authors: Chris Zankel <chris@zankel.net>
8 * Based on work form the UML team.
10 * Copyright 2005 Tensilica Inc.
12 * This program is free software; you can redistribute it and/or modify it
13 * under the terms of the GNU General Public License as published by the
14 * Free Software Foundation; either version 2 of the License, or (at your
15 * option) any later version.
19 #include <linux/list.h>
20 #include <linux/irq.h>
21 #include <linux/spinlock.h>
22 #include <linux/slab.h>
23 #include <linux/timer.h>
24 #include <linux/if_ether.h>
25 #include <linux/inetdevice.h>
26 #include <linux/init.h>
27 #include <linux/if_tun.h>
28 #include <linux/etherdevice.h>
29 #include <linux/interrupt.h>
30 #include <linux/ioctl.h>
31 #include <linux/bootmem.h>
32 #include <linux/ethtool.h>
33 #include <linux/rtnetlink.h>
34 #include <linux/platform_device.h>
36 #include <platform/simcall.h>
38 #define DRIVER_NAME "iss-netdev"
39 #define ETH_MAX_PACKET 1500
40 #define ETH_HEADER_OTHER 14
41 #define ISS_NET_TIMER_VALUE (2 * HZ)
44 static DEFINE_SPINLOCK(opened_lock
);
45 static LIST_HEAD(opened
);
47 static DEFINE_SPINLOCK(devices_lock
);
48 static LIST_HEAD(devices
);
50 /* ------------------------------------------------------------------------- */
52 /* We currently only support the TUNTAP transport protocol. */
54 #define TRANSPORT_TUNTAP_NAME "tuntap"
55 #define TRANSPORT_TUNTAP_MTU ETH_MAX_PACKET
58 char dev_name
[IFNAMSIZ
];
60 unsigned char gw
[ETH_ALEN
];
64 /* ------------------------------------------------------------------------- */
67 /* This structure contains out private information for the driver. */
69 struct iss_net_private
{
71 struct list_head device_list
;
72 struct list_head opened_list
;
75 struct net_device
*dev
;
76 struct platform_device pdev
;
78 struct net_device_stats stats
;
80 struct timer_list timer
;
81 unsigned int timer_val
;
86 unsigned char mac
[ETH_ALEN
];
91 struct tuntap_info tuntap
;
94 int (*open
)(struct iss_net_private
*lp
);
95 void (*close
)(struct iss_net_private
*lp
);
96 int (*read
)(struct iss_net_private
*lp
, struct sk_buff
**skb
);
97 int (*write
)(struct iss_net_private
*lp
, struct sk_buff
**skb
);
98 unsigned short (*protocol
)(struct sk_buff
*skb
);
99 int (*poll
)(struct iss_net_private
*lp
);
104 /* ================================ HELPERS ================================ */
107 static char *split_if_spec(char *str
, ...)
113 while ((arg
= va_arg(ap
, char**)) != NULL
) {
116 end
= strchr(str
, ',');
132 struct sk_buff
*ether_adjust_skb(struct sk_buff
*skb
, int extra
)
134 if ((skb
!= NULL
) && (skb_tailroom(skb
) < extra
)) {
135 struct sk_buff
*skb2
;
137 skb2
= skb_copy_expand(skb
, 0, extra
, GFP_ATOMIC
);
148 /* Return the IP address as a string for a given device. */
150 static void dev_ip_addr(void *d
, char *buf
, char *bin_buf
)
152 struct net_device
*dev
= d
;
153 struct in_device
*ip
= dev
->ip_ptr
;
154 struct in_ifaddr
*in
;
157 if ((ip
== NULL
) || ((in
= ip
->ifa_list
) == NULL
)) {
158 printk(KERN_WARNING
"Device not assigned an IP address!\n");
162 addr
= in
->ifa_address
;
163 sprintf(buf
, "%d.%d.%d.%d", addr
& 0xff, (addr
>> 8) & 0xff,
164 (addr
>> 16) & 0xff, addr
>> 24);
167 bin_buf
[0] = addr
& 0xff;
168 bin_buf
[1] = (addr
>> 8) & 0xff;
169 bin_buf
[2] = (addr
>> 16) & 0xff;
170 bin_buf
[3] = addr
>> 24;
174 /* Set Ethernet address of the specified device. */
176 static void inline set_ether_mac(void *d
, unsigned char *addr
)
178 struct net_device
*dev
= d
;
179 memcpy(dev
->dev_addr
, addr
, ETH_ALEN
);
183 /* ======================= TUNTAP TRANSPORT INTERFACE ====================== */
185 static int tuntap_open(struct iss_net_private
*lp
)
188 char *dev_name
= lp
->tp
.info
.tuntap
.dev_name
;
192 /* We currently only support a fixed configuration. */
194 if (!lp
->tp
.info
.tuntap
.fixed_config
)
197 if ((fd
= simc_open("/dev/net/tun", 02, 0)) < 0) { /* O_RDWR */
198 printk("Failed to open /dev/net/tun, returned %d "
199 "(errno = %d)\n", fd
, errno
);
203 memset(&ifr
, 0, sizeof ifr
);
204 ifr
.ifr_flags
= IFF_TAP
| IFF_NO_PI
;
205 strlcpy(ifr
.ifr_name
, dev_name
, sizeof ifr
.ifr_name
);
207 if ((err
= simc_ioctl(fd
, TUNSETIFF
, (void*) &ifr
)) < 0) {
208 printk("Failed to set interface, returned %d "
209 "(errno = %d)\n", err
, errno
);
214 lp
->tp
.info
.tuntap
.fd
= fd
;
218 static void tuntap_close(struct iss_net_private
*lp
)
221 if (lp
->tp
.info
.tuntap
.fixed_config
)
222 iter_addresses(lp
->tp
.info
.tuntap
.dev
, close_addr
, lp
->host
.dev_name
);
224 simc_close(lp
->tp
.info
.tuntap
.fd
);
225 lp
->tp
.info
.tuntap
.fd
= -1;
228 static int tuntap_read (struct iss_net_private
*lp
, struct sk_buff
**skb
)
231 *skb
= ether_adjust_skb(*skb
, ETH_HEADER_OTHER
);
236 return simc_read(lp
->tp
.info
.tuntap
.fd
,
237 (*skb
)->data
, (*skb
)->dev
->mtu
+ ETH_HEADER_OTHER
);
240 static int tuntap_write (struct iss_net_private
*lp
, struct sk_buff
**skb
)
242 return simc_write(lp
->tp
.info
.tuntap
.fd
, (*skb
)->data
, (*skb
)->len
);
245 unsigned short tuntap_protocol(struct sk_buff
*skb
)
247 return eth_type_trans(skb
, skb
->dev
);
250 static int tuntap_poll(struct iss_net_private
*lp
)
252 return simc_poll(lp
->tp
.info
.tuntap
.fd
);
256 * Currently only a device name is supported.
257 * ethX=tuntap[,[mac address][,[device name]]]
260 static int tuntap_probe(struct iss_net_private
*lp
, int index
, char *init
)
262 const int len
= strlen(TRANSPORT_TUNTAP_NAME
);
263 char *dev_name
= NULL
, *mac_str
= NULL
, *rem
= NULL
;
265 /* Transport should be 'tuntap': ethX=tuntap,mac,dev_name */
267 if (strncmp(init
, TRANSPORT_TUNTAP_NAME
, len
))
270 if (*(init
+= strlen(TRANSPORT_TUNTAP_NAME
)) == ',') {
271 if ((rem
=split_if_spec(init
+1, &mac_str
, &dev_name
)) != NULL
) {
272 printk("Extra garbage on specification : '%s'\n", rem
);
275 } else if (*init
!= '\0') {
276 printk("Invalid argument: %s. Skipping device!\n", init
);
281 strncpy(lp
->tp
.info
.tuntap
.dev_name
, dev_name
,
282 sizeof lp
->tp
.info
.tuntap
.dev_name
);
283 lp
->tp
.info
.tuntap
.fixed_config
= 1;
285 strcpy(lp
->tp
.info
.tuntap
.dev_name
, TRANSPORT_TUNTAP_NAME
);
289 if (setup_etheraddr(mac_str
, lp
->mac
))
292 lp
->mtu
= TRANSPORT_TUNTAP_MTU
;
294 //lp->info.tuntap.gate_addr = gate_addr;
296 lp
->tp
.info
.tuntap
.fd
= -1;
298 lp
->tp
.open
= tuntap_open
;
299 lp
->tp
.close
= tuntap_close
;
300 lp
->tp
.read
= tuntap_read
;
301 lp
->tp
.write
= tuntap_write
;
302 lp
->tp
.protocol
= tuntap_protocol
;
303 lp
->tp
.poll
= tuntap_poll
;
305 printk("TUN/TAP backend - ");
307 if (lp
->host
.gate_addr
!= NULL
)
308 printk("IP = %s", lp
->host
.gate_addr
);
315 /* ================================ ISS NET ================================ */
317 static int iss_net_rx(struct net_device
*dev
)
319 struct iss_net_private
*lp
= netdev_priv(dev
);
323 /* Check if there is any new data. */
325 if (lp
->tp
.poll(lp
) == 0)
328 /* Try to allocate memory, if it fails, try again next round. */
330 if ((skb
= dev_alloc_skb(dev
->mtu
+ 2 + ETH_HEADER_OTHER
)) == NULL
) {
331 lp
->stats
.rx_dropped
++;
340 skb_reset_mac_header(skb
);
341 pkt_len
= lp
->tp
.read(lp
, &skb
);
342 skb_put(skb
, pkt_len
);
345 skb_trim(skb
, pkt_len
);
346 skb
->protocol
= lp
->tp
.protocol(skb
);
348 lp
->stats
.rx_bytes
+= skb
->len
;
349 lp
->stats
.rx_packets
++;
358 static int iss_net_poll(void)
360 struct list_head
*ele
;
363 spin_lock(&opened_lock
);
365 list_for_each(ele
, &opened
) {
366 struct iss_net_private
*lp
;
368 lp
= list_entry(ele
, struct iss_net_private
, opened_list
);
370 if (!netif_running(lp
->dev
))
373 spin_lock(&lp
->lock
);
375 while ((err
= iss_net_rx(lp
->dev
)) > 0)
378 spin_unlock(&lp
->lock
);
381 printk(KERN_ERR
"Device '%s' read returned %d, "
382 "shutting it down\n", lp
->dev
->name
, err
);
385 // FIXME reactivate_fd(lp->fd, ISS_ETH_IRQ);
389 spin_unlock(&opened_lock
);
394 static void iss_net_timer(unsigned long priv
)
396 struct iss_net_private
* lp
= (struct iss_net_private
*) priv
;
398 spin_lock(&lp
->lock
);
402 mod_timer(&lp
->timer
, jiffies
+ lp
->timer_val
);
404 spin_unlock(&lp
->lock
);
408 static int iss_net_open(struct net_device
*dev
)
410 struct iss_net_private
*lp
= netdev_priv(dev
);
411 char addr
[sizeof "255.255.255.255\0"];
414 spin_lock(&lp
->lock
);
416 if ((err
= lp
->tp
.open(lp
)) < 0)
420 dev_ip_addr(dev
, addr
, &lp
->mac
[2]);
421 set_ether_mac(dev
, lp
->mac
);
424 netif_start_queue(dev
);
426 /* clear buffer - it can happen that the host side of the interface
427 * is full when we get here. In this case, new data is never queued,
428 * SIGIOs never arrive, and the net never works.
430 while ((err
= iss_net_rx(dev
)) > 0)
433 spin_lock(&opened_lock
);
434 list_add(&lp
->opened_list
, &opened
);
435 spin_unlock(&opened_lock
);
437 init_timer(&lp
->timer
);
438 lp
->timer_val
= ISS_NET_TIMER_VALUE
;
439 lp
->timer
.data
= (unsigned long) lp
;
440 lp
->timer
.function
= iss_net_timer
;
441 mod_timer(&lp
->timer
, jiffies
+ lp
->timer_val
);
444 spin_unlock(&lp
->lock
);
448 static int iss_net_close(struct net_device
*dev
)
450 struct iss_net_private
*lp
= netdev_priv(dev
);
451 printk("iss_net_close!\n");
452 netif_stop_queue(dev
);
453 spin_lock(&lp
->lock
);
455 spin_lock(&opened_lock
);
457 spin_unlock(&opened_lock
);
459 del_timer_sync(&lp
->timer
);
463 spin_unlock(&lp
->lock
);
467 static int iss_net_start_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
469 struct iss_net_private
*lp
= netdev_priv(dev
);
473 netif_stop_queue(dev
);
474 spin_lock_irqsave(&lp
->lock
, flags
);
476 len
= lp
->tp
.write(lp
, &skb
);
478 if (len
== skb
->len
) {
479 lp
->stats
.tx_packets
++;
480 lp
->stats
.tx_bytes
+= skb
->len
;
481 dev
->trans_start
= jiffies
;
482 netif_start_queue(dev
);
484 /* this is normally done in the interrupt when tx finishes */
485 netif_wake_queue(dev
);
487 } else if (len
== 0) {
488 netif_start_queue(dev
);
489 lp
->stats
.tx_dropped
++;
492 netif_start_queue(dev
);
493 printk(KERN_ERR
"iss_net_start_xmit: failed(%d)\n", len
);
496 spin_unlock_irqrestore(&lp
->lock
, flags
);
503 static struct net_device_stats
*iss_net_get_stats(struct net_device
*dev
)
505 struct iss_net_private
*lp
= netdev_priv(dev
);
509 static void iss_net_set_multicast_list(struct net_device
*dev
)
512 if (dev
->flags
& IFF_PROMISC
)
514 else if (!netdev_mc_empty(dev
))
515 dev
->flags
|= IFF_ALLMULTI
;
517 dev
->flags
&= ~IFF_ALLMULTI
;
521 static void iss_net_tx_timeout(struct net_device
*dev
)
524 dev
->trans_start
= jiffies
;
525 netif_wake_queue(dev
);
529 static int iss_net_set_mac(struct net_device
*dev
, void *addr
)
532 struct iss_net_private
*lp
= netdev_priv(dev
);
533 struct sockaddr
*hwaddr
= addr
;
535 spin_lock(&lp
->lock
);
536 memcpy(dev
->dev_addr
, hwaddr
->sa_data
, ETH_ALEN
);
537 spin_unlock(&lp
->lock
);
543 static int iss_net_change_mtu(struct net_device
*dev
, int new_mtu
)
546 struct iss_net_private
*lp
= netdev_priv(dev
);
549 spin_lock(&lp
->lock
);
551 // FIXME not needed new_mtu = transport_set_mtu(new_mtu, &lp->user);
558 spin_unlock(&lp
->lock
);
564 void iss_net_user_timer_expire(unsigned long _conn
)
569 static struct platform_driver iss_net_driver
= {
575 static int driver_registered
;
577 static const struct net_device_ops iss_netdev_ops
= {
578 .ndo_open
= iss_net_open
,
579 .ndo_stop
= iss_net_close
,
580 .ndo_get_stats
= iss_net_get_stats
,
581 .ndo_start_xmit
= iss_net_start_xmit
,
582 .ndo_validate_addr
= eth_validate_addr
,
583 .ndo_change_mtu
= iss_net_change_mtu
,
584 .ndo_set_mac_address
= iss_net_set_mac
,
585 //.ndo_do_ioctl = iss_net_ioctl,
586 .ndo_tx_timeout
= iss_net_tx_timeout
,
587 .ndo_set_rx_mode
= iss_net_set_multicast_list
,
590 static int iss_net_configure(int index
, char *init
)
592 struct net_device
*dev
;
593 struct iss_net_private
*lp
;
596 if ((dev
= alloc_etherdev(sizeof *lp
)) == NULL
) {
597 printk(KERN_ERR
"eth_configure: failed to allocate device\n");
601 /* Initialize private element. */
603 lp
= netdev_priv(dev
);
604 *lp
= ((struct iss_net_private
) {
605 .device_list
= LIST_HEAD_INIT(lp
->device_list
),
606 .opened_list
= LIST_HEAD_INIT(lp
->opened_list
),
607 .lock
= __SPIN_LOCK_UNLOCKED(lp
.lock
),
611 .mac
= { 0xfe, 0xfd, 0x0, 0x0, 0x0, 0x0 },
616 * Try all transport protocols.
617 * Note: more protocols can be added by adding '&& !X_init(lp, eth)'.
620 if (!tuntap_probe(lp
, index
, init
)) {
621 printk("Invalid arguments. Skipping device!\n");
625 printk(KERN_INFO
"Netdevice %d ", index
);
627 printk("(%pM) ", lp
->mac
);
632 if (!driver_registered
) {
633 platform_driver_register(&iss_net_driver
);
634 driver_registered
= 1;
637 spin_lock(&devices_lock
);
638 list_add(&lp
->device_list
, &devices
);
639 spin_unlock(&devices_lock
);
642 lp
->pdev
.name
= DRIVER_NAME
;
643 platform_device_register(&lp
->pdev
);
644 SET_NETDEV_DEV(dev
,&lp
->pdev
.dev
);
647 * If this name ends up conflicting with an existing registered
648 * netdevice, that is OK, register_netdev{,ice}() will notice this
651 snprintf(dev
->name
, sizeof dev
->name
, "eth%d", index
);
653 dev
->netdev_ops
= &iss_netdev_ops
;
655 dev
->watchdog_timeo
= (HZ
>> 1);
659 err
= register_netdevice(dev
);
663 printk("Error registering net device!\n");
664 /* XXX: should we call ->remove() here? */
670 lp
->tl
.function
= iss_net_user_timer_expire
;
674 set_ether_mac(dev
, lp
->mac
);
679 // FIXME: unregister; free, etc..
684 /* ------------------------------------------------------------------------- */
686 /* Filled in during early boot */
688 struct list_head eth_cmd_line
= LIST_HEAD_INIT(eth_cmd_line
);
690 struct iss_net_init
{
691 struct list_head list
;
692 char *init
; /* init string */
697 * Parse the command line and look for 'ethX=...' fields, and register all
698 * those fields. They will be later initialized in iss_net_init.
701 #define ERR KERN_ERR "iss_net_setup: "
703 static int __init
iss_net_setup(char *str
)
705 struct iss_net_private
*device
= NULL
;
706 struct iss_net_init
*new;
707 struct list_head
*ele
;
711 n
= simple_strtoul(str
, &end
, 0);
713 printk(ERR
"Failed to parse '%s'\n", str
);
717 printk(ERR
"Device %d is negative\n", n
);
720 if (*(str
= end
) != '=') {
721 printk(ERR
"Expected '=' after device number\n");
725 spin_lock(&devices_lock
);
727 list_for_each(ele
, &devices
) {
728 device
= list_entry(ele
, struct iss_net_private
, device_list
);
729 if (device
->index
== n
)
733 spin_unlock(&devices_lock
);
735 if (device
&& device
->index
== n
) {
736 printk(ERR
"Device %d already configured\n", n
);
740 if ((new = alloc_bootmem(sizeof new)) == NULL
) {
741 printk("Alloc_bootmem failed\n");
745 INIT_LIST_HEAD(&new->list
);
749 list_add_tail(&new->list
, ð_cmd_line
);
755 __setup("eth=", iss_net_setup
);
758 * Initialize all ISS Ethernet devices previously registered in iss_net_setup.
761 static int iss_net_init(void)
763 struct list_head
*ele
, *next
;
765 /* Walk through all Ethernet devices specified in the command line. */
767 list_for_each_safe(ele
, next
, ð_cmd_line
) {
768 struct iss_net_init
*eth
;
769 eth
= list_entry(ele
, struct iss_net_init
, list
);
770 iss_net_configure(eth
->index
, eth
->init
);
776 module_init(iss_net_init
);