net/llc/llc_output.c

   1 /*
   2  * llc_output.c - LLC minimal output path
   3  *
   4  * Copyright (c) 1997 by Procom Technology, Inc.
   5  *               2001-2003 by Arnaldo Carvalho de Melo <acme@conectiva.com.br>
   6  *
   7  * This program can be redistributed or modified under the terms of the
   8  * GNU General Public License version 2 as published by the Free Software
   9  * Foundation.
  10  * This program is distributed without any warranty or implied warranty
  11  * of merchantability or fitness for a particular purpose.
  12  *
  13  * See the GNU General Public License version 2 for more details.
  14  */
  15
  16 #include <linux/if_arp.h>
  17 #include <linux/if_tr.h>
  18 #include <linux/netdevice.h>
  19 #include <linux/trdevice.h>
  20 #include <linux/skbuff.h>
  21 #include <net/llc.h>
  22 #include <net/llc_pdu.h>
  23
  24 /**
  25  *      llc_mac_hdr_init - fills MAC header fields
  26  *      @skb: Address of the frame to initialize its MAC header
  27  *      @sa: The MAC source address
  28  *      @da: The MAC destination address
  29  *
  30  *      Fills MAC header fields, depending on MAC type. Returns 0, If MAC type
  31  *      is a valid type and initialization completes correctly 1, otherwise.
  32  */
  33 int llc_mac_hdr_init(struct sk_buff *skb,
  34                      const unsigned char *sa, const unsigned char *da)
  35 {
  36         int rc = 0;
  37
  38         switch (skb->dev->type) {
  39 #ifdef CONFIG_TR
  40         case ARPHRD_IEEE802_TR: {
  41                 struct net_device *dev = skb->dev;
  42                 struct trh_hdr *trh;
  43
  44                 skb->mac.raw = skb_push(skb, sizeof(*trh));
  45                 trh = tr_hdr(skb);
  46                 trh->ac = AC;
  47                 trh->fc = LLC_FRAME;
  48                 if (sa)
  49                         memcpy(trh->saddr, sa, dev->addr_len);
  50                 else
  51                         memset(trh->saddr, 0, dev->addr_len);
  52                 if (da) {
  53                         memcpy(trh->daddr, da, dev->addr_len);
  54                         tr_source_route(skb, trh, dev);
  55                         skb_reset_mac_header(skb);
  56                 }
  57                 break;
  58         }
  59 #endif
  60         case ARPHRD_ETHER:
  61         case ARPHRD_LOOPBACK: {
  62                 unsigned short len = skb->len;
  63                 struct ethhdr *eth;
  64
  65                 skb->mac.raw = skb_push(skb, sizeof(*eth));
  66                 eth = eth_hdr(skb);
  67                 eth->h_proto = htons(len);
  68                 memcpy(eth->h_dest, da, ETH_ALEN);
  69                 memcpy(eth->h_source, sa, ETH_ALEN);
  70                 break;
  71         }
  72         default:
  73                 printk(KERN_WARNING "device type not supported: %d\n",
  74                        skb->dev->type);
  75                 rc = -EINVAL;
  76         }
  77         return rc;
  78 }
  79
  80 /**
  81  *      llc_build_and_send_ui_pkt - unitdata request interface for upper layers
  82  *      @sap: sap to use
  83  *      @skb: packet to send
  84  *      @dmac: destination mac address
  85  *      @dsap: destination sap
  86  *
  87  *      Upper layers calls this function when upper layer wants to send data
  88  *      using connection-less mode communication (UI pdu).
  89  *
  90  *      Accept data frame from network layer to be sent using connection-
  91  *      less mode communication; timeout/retries handled by network layer;
  92  *      package primitive as an event and send to SAP event handler
  93  */
  94 int llc_build_and_send_ui_pkt(struct llc_sap *sap, struct sk_buff *skb,
  95                               unsigned char *dmac, unsigned char dsap)
  96 {
  97         int rc;
  98         llc_pdu_header_init(skb, LLC_PDU_TYPE_U, sap->laddr.lsap,
  99                             dsap, LLC_PDU_CMD);
 100         llc_pdu_init_as_ui_cmd(skb);
 101         rc = llc_mac_hdr_init(skb, skb->dev->dev_addr, dmac);
 102         if (likely(!rc))
 103                 rc = dev_queue_xmit(skb);
 104         return rc;
 105 }
 106
 107 EXPORT_SYMBOL(llc_mac_hdr_init);
 108 EXPORT_SYMBOL(llc_build_and_send_ui_pkt);