/********************************************************************* * * Filename: irlan_eth.c * Version: * Description: * Status: Experimental. * Author: Dag Brattli * Created at: Thu Oct 15 08:37:58 1998 * Modified at: Tue Mar 21 09:06:41 2000 * Modified by: Dag Brattli * Sources: skeleton.c by Donald Becker * slip.c by Laurence Culhane, * Fred N. van Kempen, * * Copyright (c) 1998-2000 Dag Brattli, All Rights Reserved. * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License as * published by the Free Software Foundation; either version 2 of * the License, or (at your option) any later version. * * Neither Dag Brattli nor University of Troms° admit liability nor * provide warranty for any of this software. This material is * provided "AS-IS" and at no charge. * ********************************************************************/ #include #include #include #include #include #include #include #include #include #include #include #include #include /* * Function irlan_eth_init (dev) * * The network device initialization function. * */ int irlan_eth_init(struct net_device *dev) { struct irlan_cb *self; IRDA_DEBUG(2, __FUNCTION__"()\n"); ASSERT(dev != NULL, return -1;); self = (struct irlan_cb *) dev->priv; dev->open = irlan_eth_open; dev->stop = irlan_eth_close; dev->hard_start_xmit = irlan_eth_xmit; dev->get_stats = irlan_eth_get_stats; dev->set_multicast_list = irlan_eth_set_multicast_list; dev->features |= NETIF_F_DYNALLOC; ether_setup(dev); /* * Lets do all queueing in IrTTP instead of this device driver. * Queueing here as well can introduce some strange latency * problems, which we will avoid by setting the queue size to 0. */ dev->tx_queue_len = 0; if (self->provider.access_type == ACCESS_DIRECT) { /* * Since we are emulating an IrLAN sever we will have to * give ourself an ethernet address! */ dev->dev_addr[0] = 0x40; dev->dev_addr[1] = 0x00; dev->dev_addr[2] = 0x00; dev->dev_addr[3] = 0x00; get_random_bytes(dev->dev_addr+4, 1); get_random_bytes(dev->dev_addr+5, 1); } return 0; } /* * Function irlan_eth_open (dev) * * Network device has been opened by user * */ int irlan_eth_open(struct net_device *dev) { struct irlan_cb *self; IRDA_DEBUG(2, __FUNCTION__ "()\n"); ASSERT(dev != NULL, return -1;); self = (struct irlan_cb *) dev->priv; ASSERT(self != NULL, return -1;); /* Ready to play! */ netif_stop_queue(dev); /* Wait until data link is ready */ /* We are now open, so time to do some work */ self->disconnect_reason = 0; irlan_client_wakeup(self, self->saddr, self->daddr); irlan_mod_inc_use_count(); /* Make sure we have a hardware address before we return, so DHCP clients gets happy */ interruptible_sleep_on(&self->open_wait); return 0; } /* * Function irlan_eth_close (dev) * * Stop the ether network device, his function will usually be called by * ifconfig down. We should now disconnect the link, We start the * close timer, so that the instance will be removed if we are unable * to discover the remote device after the disconnect. */ int irlan_eth_close(struct net_device *dev) { struct irlan_cb *self = (struct irlan_cb *) dev->priv; struct sk_buff *skb; IRDA_DEBUG(2, __FUNCTION__ "()\n"); /* Stop device */ netif_stop_queue(dev); irlan_mod_dec_use_count(); irlan_close_data_channel(self); irlan_close_tsaps(self); irlan_do_client_event(self, IRLAN_LMP_DISCONNECT, NULL); irlan_do_provider_event(self, IRLAN_LMP_DISCONNECT, NULL); /* Remove frames queued on the control channel */ while ((skb = skb_dequeue(&self->client.txq))) dev_kfree_skb(skb); self->client.tx_busy = 0; return 0; } /* * Function irlan_eth_tx (skb) * * Transmits ethernet frames over IrDA link. * */ int irlan_eth_xmit(struct sk_buff *skb, struct net_device *dev) { struct irlan_cb *self; int ret; self = (struct irlan_cb *) dev->priv; ASSERT(self != NULL, return 0;); ASSERT(self->magic == IRLAN_MAGIC, return 0;); /* skb headroom large enough to contain all IrDA-headers? */ if ((skb_headroom(skb) < self->max_header_size) || (skb_shared(skb))) { struct sk_buff *new_skb = skb_realloc_headroom(skb, self->max_header_size); /* We have to free the original skb anyway */ dev_kfree_skb(skb); /* Did the realloc succeed? */ if (new_skb == NULL) return 0; /* Use the new skb instead */ skb = new_skb; } dev->trans_start = jiffies; /* Now queue the packet in the transport layer */ if (self->use_udata) ret = irttp_udata_request(self->tsap_data, skb); else ret = irttp_data_request(self->tsap_data, skb); if (ret < 0) { /* * IrTTPs tx queue is full, so we just have to * drop the frame! You might think that we should * just return -1 and don't deallocate the frame, * but that is dangerous since it's possible that * we have replaced the original skb with a new * one with larger headroom, and that would really * confuse do_dev_queue_xmit() in dev.c! I have * tried :-) DB */ dev_kfree_skb(skb); self->stats.tx_dropped++; } else { self->stats.tx_packets++; self->stats.tx_bytes += skb->len; } return 0; } /* * Function irlan_eth_receive (handle, skb) * * This function gets the data that is received on the data channel * */ int irlan_eth_receive(void *instance, void *sap, struct sk_buff *skb) { struct irlan_cb *self; self = (struct irlan_cb *) instance; if (skb == NULL) { ++self->stats.rx_dropped; return 0; } ASSERT(skb->len > 1, return 0;); /* * Adopt this frame! Important to set all these fields since they * might have been previously set by the low level IrDA network * device driver */ skb->dev = &self->dev; skb->protocol=eth_type_trans(skb, skb->dev); /* Remove eth header */ self->stats.rx_packets++; self->stats.rx_bytes += skb->len; netif_rx(skb); /* Eat it! */ return 0; } /* * Function irlan_eth_flow (status) * * Do flow control between IP/Ethernet and IrLAN/IrTTP. This is done by * controlling the queue stop/start. */ void irlan_eth_flow_indication(void *instance, void *sap, LOCAL_FLOW flow) { struct irlan_cb *self; struct net_device *dev; self = (struct irlan_cb *) instance; ASSERT(self != NULL, return;); ASSERT(self->magic == IRLAN_MAGIC, return;); dev = &self->dev; ASSERT(dev != NULL, return;); switch (flow) { case FLOW_STOP: netif_stop_queue(dev); break; case FLOW_START: default: /* Tell upper layers that its time to transmit frames again */ /* Schedule network layer */ netif_start_queue(dev); break; } } /* * Function irlan_eth_rebuild_header (buff, dev, dest, skb) * * If we don't want to use ARP. Currently not used!! * */ void irlan_eth_rebuild_header(void *buff, struct net_device *dev, unsigned long dest, struct sk_buff *skb) { struct ethhdr *eth = (struct ethhdr *) buff; memcpy(eth->h_source, dev->dev_addr, dev->addr_len); memcpy(eth->h_dest, dev->dev_addr, dev->addr_len); /* return 0; */ } /* * Function irlan_etc_send_gratuitous_arp (dev) * * Send gratuitous ARP to announce that we have changed * hardware address, so that all peers updates their ARP tables */ void irlan_eth_send_gratuitous_arp(struct net_device *dev) { struct in_device *in_dev; /* * When we get a new MAC address do a gratuitous ARP. This * is useful if we have changed access points on the same * subnet. */ #ifdef CONFIG_INET IRDA_DEBUG(4, "IrLAN: Sending gratuitous ARP\n"); in_dev = in_dev_get(dev); if (in_dev == NULL) return; read_lock(&in_dev->lock); if (in_dev->ifa_list) arp_send(ARPOP_REQUEST, ETH_P_ARP, in_dev->ifa_list->ifa_address, dev, in_dev->ifa_list->ifa_address, NULL, dev->dev_addr, NULL); read_unlock(&in_dev->lock); in_dev_put(in_dev); #endif /* CONFIG_INET */ } /* * Function set_multicast_list (dev) * * Configure the filtering of the device * */ #define HW_MAX_ADDRS 4 /* Must query to get it! */ void irlan_eth_set_multicast_list(struct net_device *dev) { struct irlan_cb *self; self = dev->priv; IRDA_DEBUG(2, __FUNCTION__ "()\n"); ASSERT(self != NULL, return;); ASSERT(self->magic == IRLAN_MAGIC, return;); /* Check if data channel has been connected yet */ if (self->client.state != IRLAN_DATA) { IRDA_DEBUG(1, __FUNCTION__ "(), delaying!\n"); return; } if (dev->flags & IFF_PROMISC) { /* Enable promiscuous mode */ WARNING("Promiscous mode not implemented by IrLAN!\n"); } else if ((dev->flags & IFF_ALLMULTI) || dev->mc_count > HW_MAX_ADDRS) { /* Disable promiscuous mode, use normal mode. */ IRDA_DEBUG(4, __FUNCTION__ "(), Setting multicast filter\n"); /* hardware_set_filter(NULL); */ irlan_set_multicast_filter(self, TRUE); } else if (dev->mc_count) { IRDA_DEBUG(4, __FUNCTION__ "(), Setting multicast filter\n"); /* Walk the address list, and load the filter */ /* hardware_set_filter(dev->mc_list); */ irlan_set_multicast_filter(self, TRUE); } else { IRDA_DEBUG(4, __FUNCTION__ "(), Clearing multicast filter\n"); irlan_set_multicast_filter(self, FALSE); } if (dev->flags & IFF_BROADCAST) irlan_set_broadcast_filter(self, TRUE); else irlan_set_broadcast_filter(self, FALSE); } /* * Function irlan_get_stats (dev) * * Get the current statistics for this device * */ struct net_device_stats *irlan_eth_get_stats(struct net_device *dev) { struct irlan_cb *self = (struct irlan_cb *) dev->priv; ASSERT(self != NULL, return NULL;); ASSERT(self->magic == IRLAN_MAGIC, return NULL;); return &self->stats; }