blob: 729e251082754c0d772392a0f58e8bde5c98ca87 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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 */
Stephen Hemmingerf4ad2b12006-03-20 22:59:36 -080033int llc_mac_hdr_init(struct sk_buff *skb,
34 const unsigned char *sa, const unsigned char *da)
Linus Torvalds1da177e2005-04-16 15:20:36 -070035{
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;
YOSHIFUJI Hideakid57b1862007-02-09 23:25:01 +090043
Linus Torvalds1da177e2005-04-16 15:20:36 -070044 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);
Arnaldo Carvalho de Melo459a98e2007-03-19 15:30:44 -070055 skb_reset_mac_header(skb);
Linus Torvalds1da177e2005-04-16 15:20:36 -070056 }
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 */
94int 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);
Arnaldo Carvalho de Melo249ff1c2005-09-22 04:32:10 -0300102 if (likely(!rc))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103 rc = dev_queue_xmit(skb);
104 return rc;
105}
106
107EXPORT_SYMBOL(llc_mac_hdr_init);
108EXPORT_SYMBOL(llc_build_and_send_ui_pkt);