net: Add MHI support for RMC PegaPCI.
[linux-3.10.git] / net / mhi / l3phonet.c
1 /*
2  * File: l3phonet.c
3  *
4  * L2 PHONET channel to AF_PHONET binding.
5  *
6  * Copyright (C) 2011 Renesas Mobile Corporation. All rights reserved.
7  *
8  * Author: Petri To Mattila <petri.to.mattila@renesasmobile.com>
9  *
10  * This program is free software; you can redistribute it and/or
11  * modify it under the terms of the GNU General Public License
12  * version 2 as published by the Free Software Foundation.
13  *
14  * This program is distributed in the hope that it will be useful, but
15  * WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. ┬áSee the GNU
17  * General Public License for more details.
18  *
19  * You should have received a copy of the GNU General Public License
20  * along with this program; if not, write to the Free Software
21  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
22  * 02110-1301 USA
23  *
24  */
25
26 #include <linux/kernel.h>
27 #include <linux/module.h>
28 #include <linux/socket.h>
29 #include <linux/mhi.h>
30 #include <linux/l2mux.h>
31
32
33 /* Functions */
34
35 static int
36 mhi_pn_netif_rx(struct sk_buff *skb, struct net_device *dev)
37 {
38         /* Set Protocol Family */
39         skb->protocol = htons(ETH_P_PHONET);
40
41         /* Remove L2MUX header and Phonet media byte */
42         skb_pull(skb, L2MUX_HDR_SIZE + 1);
43
44         /* Pass upwards to the Procotol Family */
45         return netif_rx(skb);
46 }
47
48 static int
49 mhi_pn_netif_tx(struct sk_buff *skb, struct net_device *dev)
50 {
51         struct l2muxhdr *l2hdr;
52         int l3len;
53         u8  *ptr;
54
55         /* Add media byte */
56         ptr = skb_push(skb, 1);
57
58         /* Set media byte */
59         ptr[0] = dev->dev_addr[0];
60
61         /* L3 length */
62         l3len = skb->len;
63
64         /* Add L2MUX header */
65         skb_push(skb, L2MUX_HDR_SIZE);
66
67         /* Mac header starts here */
68         skb_reset_mac_header(skb);
69
70         /* L2MUX header pointer */
71         l2hdr = l2mux_hdr(skb);
72
73         /* L3 Proto ID */
74         l2mux_set_proto(l2hdr, MHI_L3_PHONET);
75
76         /* L3 payload length */
77         l2mux_set_length(l2hdr, l3len);
78
79         return 0;
80 }
81
82
83 /* Module registration */
84
85 int __init mhi_pn_init(void)
86 {
87         int err;
88
89         err = l2mux_netif_rx_register(MHI_L3_PHONET, mhi_pn_netif_rx);
90         if (err)
91                 goto err1;
92
93         err = l2mux_netif_tx_register(ETH_P_PHONET, mhi_pn_netif_tx);
94         if (err)
95                 goto err2;
96
97         return 0;
98
99 err2:
100         l2mux_netif_rx_unregister(MHI_L3_PHONET);
101 err1:
102         return err;
103 }
104
105 void __exit mhi_pn_exit(void)
106 {
107         l2mux_netif_rx_unregister(MHI_L3_PHONET);
108         l2mux_netif_tx_unregister(ETH_P_PHONET);
109 }
110
111
112 module_init(mhi_pn_init);
113 module_exit(mhi_pn_exit);
114
115 MODULE_AUTHOR("Petri Mattila <petri.to.mattila@renesasmobile.com>");
116 MODULE_DESCRIPTION("MHI Phonet protocol family bridge");
117 MODULE_LICENSE("GPL");
118