mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-05 01:54:09 +08:00
97fb5e8d9b
Based on 1 normalized pattern(s): this program is free software you can redistribute it and or modify it under the terms of the gnu general public license version 2 and only version 2 as published by the free software foundation this program is distributed in the hope that it will be useful but without any warranty without even the implied warranty of merchantability or fitness for a particular purpose see the gnu general public license for more details extracted by the scancode license scanner the SPDX license identifier GPL-2.0-only has been chosen to replace the boilerplate/reference in 294 file(s). Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Reviewed-by: Allison Randal <allison@lohutok.net> Reviewed-by: Alexios Zavras <alexios.zavras@intel.com> Cc: linux-spdx@vger.kernel.org Link: https://lkml.kernel.org/r/20190529141900.825281744@linutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
98 lines
2.2 KiB
C
98 lines
2.2 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/* Copyright (c) 2013-2018, The Linux Foundation. All rights reserved.
|
|
*/
|
|
|
|
#include <linux/netdevice.h>
|
|
#include "rmnet_config.h"
|
|
#include "rmnet_map.h"
|
|
#include "rmnet_private.h"
|
|
#include "rmnet_vnd.h"
|
|
|
|
static u8 rmnet_map_do_flow_control(struct sk_buff *skb,
|
|
struct rmnet_port *port,
|
|
int enable)
|
|
{
|
|
struct rmnet_endpoint *ep;
|
|
struct net_device *vnd;
|
|
u8 mux_id;
|
|
int r;
|
|
|
|
mux_id = RMNET_MAP_GET_MUX_ID(skb);
|
|
|
|
if (mux_id >= RMNET_MAX_LOGICAL_EP) {
|
|
kfree_skb(skb);
|
|
return RX_HANDLER_CONSUMED;
|
|
}
|
|
|
|
ep = rmnet_get_endpoint(port, mux_id);
|
|
if (!ep) {
|
|
kfree_skb(skb);
|
|
return RX_HANDLER_CONSUMED;
|
|
}
|
|
|
|
vnd = ep->egress_dev;
|
|
|
|
/* Ignore the ip family and pass the sequence number for both v4 and v6
|
|
* sequence. User space does not support creating dedicated flows for
|
|
* the 2 protocols
|
|
*/
|
|
r = rmnet_vnd_do_flow_control(vnd, enable);
|
|
if (r) {
|
|
kfree_skb(skb);
|
|
return RMNET_MAP_COMMAND_UNSUPPORTED;
|
|
} else {
|
|
return RMNET_MAP_COMMAND_ACK;
|
|
}
|
|
}
|
|
|
|
static void rmnet_map_send_ack(struct sk_buff *skb,
|
|
unsigned char type,
|
|
struct rmnet_port *port)
|
|
{
|
|
struct rmnet_map_control_command *cmd;
|
|
struct net_device *dev = skb->dev;
|
|
|
|
if (port->data_format & RMNET_FLAGS_INGRESS_MAP_CKSUMV4)
|
|
skb_trim(skb,
|
|
skb->len - sizeof(struct rmnet_map_dl_csum_trailer));
|
|
|
|
skb->protocol = htons(ETH_P_MAP);
|
|
|
|
cmd = RMNET_MAP_GET_CMD_START(skb);
|
|
cmd->cmd_type = type & 0x03;
|
|
|
|
netif_tx_lock(dev);
|
|
dev->netdev_ops->ndo_start_xmit(skb, dev);
|
|
netif_tx_unlock(dev);
|
|
}
|
|
|
|
/* Process MAP command frame and send N/ACK message as appropriate. Message cmd
|
|
* name is decoded here and appropriate handler is called.
|
|
*/
|
|
void rmnet_map_command(struct sk_buff *skb, struct rmnet_port *port)
|
|
{
|
|
struct rmnet_map_control_command *cmd;
|
|
unsigned char command_name;
|
|
unsigned char rc = 0;
|
|
|
|
cmd = RMNET_MAP_GET_CMD_START(skb);
|
|
command_name = cmd->command_name;
|
|
|
|
switch (command_name) {
|
|
case RMNET_MAP_COMMAND_FLOW_ENABLE:
|
|
rc = rmnet_map_do_flow_control(skb, port, 1);
|
|
break;
|
|
|
|
case RMNET_MAP_COMMAND_FLOW_DISABLE:
|
|
rc = rmnet_map_do_flow_control(skb, port, 0);
|
|
break;
|
|
|
|
default:
|
|
rc = RMNET_MAP_COMMAND_UNSUPPORTED;
|
|
kfree_skb(skb);
|
|
break;
|
|
}
|
|
if (rc == RMNET_MAP_COMMAND_ACK)
|
|
rmnet_map_send_ack(skb, rc, port);
|
|
}
|