]>
Commit | Line | Data |
---|---|---|
9dcaec04 | 1 | /* Copyright (c) 2013-2018, The Linux Foundation. All rights reserved. |
ceed73a2 SAK |
2 | * |
3 | * This program is free software; you can redistribute it and/or modify | |
4 | * it under the terms of the GNU General Public License version 2 and | |
5 | * only version 2 as published by the Free Software Foundation. | |
6 | * | |
7 | * This program is distributed in the hope that it will be useful, | |
8 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
9 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
10 | * GNU General Public License for more details. | |
11 | * | |
12 | * RMNET Data ingress/egress handler | |
13 | * | |
14 | */ | |
15 | ||
16 | #include <linux/netdevice.h> | |
17 | #include <linux/netdev_features.h> | |
74692caf | 18 | #include <linux/if_arp.h> |
4e8683a9 | 19 | #include <net/sock.h> |
ceed73a2 SAK |
20 | #include "rmnet_private.h" |
21 | #include "rmnet_config.h" | |
22 | #include "rmnet_vnd.h" | |
23 | #include "rmnet_map.h" | |
24 | #include "rmnet_handlers.h" | |
25 | ||
26 | #define RMNET_IP_VERSION_4 0x40 | |
27 | #define RMNET_IP_VERSION_6 0x60 | |
28 | ||
29 | /* Helper Functions */ | |
30 | ||
31 | static void rmnet_set_skb_proto(struct sk_buff *skb) | |
32 | { | |
33 | switch (skb->data[0] & 0xF0) { | |
34 | case RMNET_IP_VERSION_4: | |
35 | skb->protocol = htons(ETH_P_IP); | |
36 | break; | |
37 | case RMNET_IP_VERSION_6: | |
38 | skb->protocol = htons(ETH_P_IPV6); | |
39 | break; | |
40 | default: | |
41 | skb->protocol = htons(ETH_P_MAP); | |
42 | break; | |
43 | } | |
44 | } | |
45 | ||
46 | /* Generic handler */ | |
47 | ||
2ffbbf0f | 48 | static void |
d8bbb07a | 49 | rmnet_deliver_skb(struct sk_buff *skb) |
ceed73a2 | 50 | { |
ca32fb03 SAK |
51 | struct rmnet_priv *priv = netdev_priv(skb->dev); |
52 | ||
d8bbb07a SAK |
53 | skb_reset_transport_header(skb); |
54 | skb_reset_network_header(skb); | |
55 | rmnet_vnd_rx_fixup(skb, skb->dev); | |
ceed73a2 | 56 | |
d8bbb07a SAK |
57 | skb->pkt_type = PACKET_HOST; |
58 | skb_set_mac_header(skb, 0); | |
ca32fb03 | 59 | gro_cells_receive(&priv->gro_cells, skb); |
ceed73a2 SAK |
60 | } |
61 | ||
ceed73a2 SAK |
62 | /* MAP handler */ |
63 | ||
2ffbbf0f | 64 | static void |
ceed73a2 | 65 | __rmnet_map_ingress_handler(struct sk_buff *skb, |
b665f4f8 | 66 | struct rmnet_port *port) |
ceed73a2 SAK |
67 | { |
68 | struct rmnet_endpoint *ep; | |
bbd21b24 | 69 | u16 len, pad; |
ceed73a2 | 70 | u8 mux_id; |
ceed73a2 SAK |
71 | |
72 | if (RMNET_MAP_GET_CD_BIT(skb)) { | |
14452ca3 | 73 | if (port->data_format & RMNET_FLAGS_INGRESS_MAP_COMMANDS) |
b665f4f8 | 74 | return rmnet_map_command(skb, port); |
ceed73a2 | 75 | |
3352e6c4 | 76 | goto free_skb; |
ceed73a2 SAK |
77 | } |
78 | ||
79 | mux_id = RMNET_MAP_GET_MUX_ID(skb); | |
bbd21b24 SAK |
80 | pad = RMNET_MAP_GET_PAD(skb); |
81 | len = RMNET_MAP_GET_LENGTH(skb) - pad; | |
ceed73a2 | 82 | |
3352e6c4 SAK |
83 | if (mux_id >= RMNET_MAX_LOGICAL_EP) |
84 | goto free_skb; | |
ceed73a2 | 85 | |
3352e6c4 SAK |
86 | ep = rmnet_get_endpoint(port, mux_id); |
87 | if (!ep) | |
88 | goto free_skb; | |
ceed73a2 | 89 | |
85355d77 | 90 | skb->dev = ep->egress_dev; |
ceed73a2 SAK |
91 | |
92 | /* Subtract MAP header */ | |
93 | skb_pull(skb, sizeof(struct rmnet_map_header)); | |
ceed73a2 | 94 | rmnet_set_skb_proto(skb); |
bbd21b24 | 95 | |
14452ca3 | 96 | if (port->data_format & RMNET_FLAGS_INGRESS_MAP_CKSUMV4) { |
bbd21b24 SAK |
97 | if (!rmnet_map_checksum_downlink_packet(skb, len + pad)) |
98 | skb->ip_summed = CHECKSUM_UNNECESSARY; | |
99 | } | |
100 | ||
101 | skb_trim(skb, len); | |
2ffbbf0f SAK |
102 | rmnet_deliver_skb(skb); |
103 | return; | |
3352e6c4 SAK |
104 | |
105 | free_skb: | |
106 | kfree_skb(skb); | |
ceed73a2 SAK |
107 | } |
108 | ||
2ffbbf0f | 109 | static void |
ceed73a2 | 110 | rmnet_map_ingress_handler(struct sk_buff *skb, |
b665f4f8 | 111 | struct rmnet_port *port) |
ceed73a2 SAK |
112 | { |
113 | struct sk_buff *skbn; | |
ceed73a2 | 114 | |
74692caf SAK |
115 | if (skb->dev->type == ARPHRD_ETHER) { |
116 | if (pskb_expand_head(skb, ETH_HLEN, 0, GFP_KERNEL)) { | |
117 | kfree_skb(skb); | |
118 | return; | |
119 | } | |
120 | ||
121 | skb_push(skb, ETH_HLEN); | |
122 | } | |
123 | ||
14452ca3 | 124 | if (port->data_format & RMNET_FLAGS_INGRESS_DEAGGREGATION) { |
bbd21b24 | 125 | while ((skbn = rmnet_map_deaggregate(skb, port)) != NULL) |
b665f4f8 | 126 | __rmnet_map_ingress_handler(skbn, port); |
ceed73a2 SAK |
127 | |
128 | consume_skb(skb); | |
ceed73a2 | 129 | } else { |
2ffbbf0f | 130 | __rmnet_map_ingress_handler(skb, port); |
ceed73a2 | 131 | } |
ceed73a2 SAK |
132 | } |
133 | ||
134 | static int rmnet_map_egress_handler(struct sk_buff *skb, | |
56470c92 | 135 | struct rmnet_port *port, u8 mux_id, |
ceed73a2 SAK |
136 | struct net_device *orig_dev) |
137 | { | |
138 | int required_headroom, additional_header_len; | |
139 | struct rmnet_map_header *map_header; | |
140 | ||
141 | additional_header_len = 0; | |
142 | required_headroom = sizeof(struct rmnet_map_header); | |
143 | ||
14452ca3 | 144 | if (port->data_format & RMNET_FLAGS_EGRESS_MAP_CKSUMV4) { |
5eb5f860 SAK |
145 | additional_header_len = sizeof(struct rmnet_map_ul_csum_header); |
146 | required_headroom += additional_header_len; | |
147 | } | |
148 | ||
ceed73a2 | 149 | if (skb_headroom(skb) < required_headroom) { |
6392ff3c | 150 | if (pskb_expand_head(skb, required_headroom, 0, GFP_ATOMIC)) |
1eece799 | 151 | return -ENOMEM; |
ceed73a2 SAK |
152 | } |
153 | ||
14452ca3 | 154 | if (port->data_format & RMNET_FLAGS_EGRESS_MAP_CKSUMV4) |
5eb5f860 SAK |
155 | rmnet_map_checksum_uplink_packet(skb, orig_dev); |
156 | ||
ceed73a2 SAK |
157 | map_header = rmnet_map_add_map_header(skb, additional_header_len, 0); |
158 | if (!map_header) | |
1eece799 | 159 | return -ENOMEM; |
ceed73a2 | 160 | |
0b59a234 | 161 | map_header->mux_id = mux_id; |
ceed73a2 SAK |
162 | |
163 | skb->protocol = htons(ETH_P_MAP); | |
164 | ||
cf2fe57b | 165 | return 0; |
ceed73a2 SAK |
166 | } |
167 | ||
2ffbbf0f | 168 | static void |
60d58f97 SAK |
169 | rmnet_bridge_handler(struct sk_buff *skb, struct net_device *bridge_dev) |
170 | { | |
171 | if (bridge_dev) { | |
172 | skb->dev = bridge_dev; | |
173 | dev_queue_xmit(skb); | |
174 | } | |
60d58f97 SAK |
175 | } |
176 | ||
ceed73a2 SAK |
177 | /* Ingress / Egress Entry Points */ |
178 | ||
179 | /* Processes packet as per ingress data format for receiving device. Logical | |
180 | * endpoint is determined from packet inspection. Packet is then sent to the | |
181 | * egress device listed in the logical endpoint configuration. | |
182 | */ | |
183 | rx_handler_result_t rmnet_rx_handler(struct sk_buff **pskb) | |
184 | { | |
ceed73a2 | 185 | struct sk_buff *skb = *pskb; |
60d58f97 | 186 | struct rmnet_port *port; |
ceed73a2 | 187 | struct net_device *dev; |
ceed73a2 SAK |
188 | |
189 | if (!skb) | |
2ffbbf0f | 190 | goto done; |
ceed73a2 | 191 | |
a07f388e ST |
192 | if (skb->pkt_type == PACKET_LOOPBACK) |
193 | return RX_HANDLER_PASS; | |
194 | ||
ceed73a2 | 195 | dev = skb->dev; |
b665f4f8 | 196 | port = rmnet_get_port(dev); |
ceed73a2 | 197 | |
60d58f97 SAK |
198 | switch (port->rmnet_mode) { |
199 | case RMNET_EPMODE_VND: | |
8de721e2 | 200 | rmnet_map_ingress_handler(skb, port); |
60d58f97 SAK |
201 | break; |
202 | case RMNET_EPMODE_BRIDGE: | |
2ffbbf0f | 203 | rmnet_bridge_handler(skb, port->bridge_ep); |
60d58f97 SAK |
204 | break; |
205 | } | |
ceed73a2 | 206 | |
2ffbbf0f SAK |
207 | done: |
208 | return RX_HANDLER_CONSUMED; | |
ceed73a2 SAK |
209 | } |
210 | ||
211 | /* Modifies packet as per logical endpoint configuration and egress data format | |
212 | * for egress device configured in logical endpoint. Packet is then transmitted | |
213 | * on the egress device. | |
214 | */ | |
56470c92 | 215 | void rmnet_egress_handler(struct sk_buff *skb) |
ceed73a2 | 216 | { |
ceed73a2 | 217 | struct net_device *orig_dev; |
b665f4f8 | 218 | struct rmnet_port *port; |
56470c92 SAK |
219 | struct rmnet_priv *priv; |
220 | u8 mux_id; | |
ceed73a2 | 221 | |
4e8683a9 SAK |
222 | sk_pacing_shift_update(skb->sk, 8); |
223 | ||
ceed73a2 | 224 | orig_dev = skb->dev; |
56470c92 SAK |
225 | priv = netdev_priv(orig_dev); |
226 | skb->dev = priv->real_dev; | |
227 | mux_id = priv->mux_id; | |
ceed73a2 | 228 | |
b665f4f8 | 229 | port = rmnet_get_port(skb->dev); |
1eece799 SAK |
230 | if (!port) |
231 | goto drop; | |
ceed73a2 | 232 | |
8de721e2 | 233 | if (rmnet_map_egress_handler(skb, port, mux_id, orig_dev)) |
1eece799 | 234 | goto drop; |
ceed73a2 | 235 | |
91489632 | 236 | rmnet_vnd_tx_fixup(skb, orig_dev); |
ceed73a2 SAK |
237 | |
238 | dev_queue_xmit(skb); | |
1eece799 SAK |
239 | return; |
240 | ||
241 | drop: | |
242 | this_cpu_inc(priv->pcpu_stats->stats.tx_drops); | |
243 | kfree_skb(skb); | |
ceed73a2 | 244 | } |