mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2025-01-25 17:40:00 +07:00
Merge branch 'qualcomm-rmnet-Fix-comments-on-initial-patchset'
Subash Abhinov Kasiviswanathan says: ==================== net: qualcomm: rmnet: Fix comments on initial patchset This series fixes the comments from Dan on the first patch series. Fixes a memory corruption which could occur if mux_id was higher than 32. Remove the RMNET_LOCAL_LOGICAL_ENDPOINT which is no longer used. Make a log message more useful. Combine __rmnet_set_endpoint_config() with rmnet_set_endpoint_config(). Set the mux_id in rmnet_vnd_newlink(). Set the ingress and egress data format directly in newlink. Implement ndo_get_iflink to find the real_dev. Rename the real_dev_info to port to make it similar to other drivers. The conversion of rmnet_devices to a list and hash lookup will be sent as part of a seperate patch. ==================== Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
commit
f98ce38927
@ -42,12 +42,11 @@
|
|||||||
*/
|
*/
|
||||||
|
|
||||||
/* Local Definitions and Declarations */
|
/* Local Definitions and Declarations */
|
||||||
#define RMNET_LOCAL_LOGICAL_ENDPOINT -1
|
|
||||||
|
|
||||||
struct rmnet_walk_data {
|
struct rmnet_walk_data {
|
||||||
struct net_device *real_dev;
|
struct net_device *real_dev;
|
||||||
struct list_head *head;
|
struct list_head *head;
|
||||||
struct rmnet_real_dev_info *real_dev_info;
|
struct rmnet_port *port;
|
||||||
};
|
};
|
||||||
|
|
||||||
static int rmnet_is_real_dev_registered(const struct net_device *real_dev)
|
static int rmnet_is_real_dev_registered(const struct net_device *real_dev)
|
||||||
@ -58,19 +57,9 @@ static int rmnet_is_real_dev_registered(const struct net_device *real_dev)
|
|||||||
return (rx_handler == rmnet_rx_handler);
|
return (rx_handler == rmnet_rx_handler);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Needs either rcu_read_lock() or rtnl lock */
|
|
||||||
static struct rmnet_real_dev_info*
|
|
||||||
__rmnet_get_real_dev_info(const struct net_device *real_dev)
|
|
||||||
{
|
|
||||||
if (rmnet_is_real_dev_registered(real_dev))
|
|
||||||
return rcu_dereference_rtnl(real_dev->rx_handler_data);
|
|
||||||
else
|
|
||||||
return NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Needs rtnl lock */
|
/* Needs rtnl lock */
|
||||||
static struct rmnet_real_dev_info*
|
static struct rmnet_port*
|
||||||
rmnet_get_real_dev_info_rtnl(const struct net_device *real_dev)
|
rmnet_get_port_rtnl(const struct net_device *real_dev)
|
||||||
{
|
{
|
||||||
return rtnl_dereference(real_dev->rx_handler_data);
|
return rtnl_dereference(real_dev->rx_handler_data);
|
||||||
}
|
}
|
||||||
@ -78,33 +67,27 @@ rmnet_get_real_dev_info_rtnl(const struct net_device *real_dev)
|
|||||||
static struct rmnet_endpoint*
|
static struct rmnet_endpoint*
|
||||||
rmnet_get_endpoint(struct net_device *dev, int config_id)
|
rmnet_get_endpoint(struct net_device *dev, int config_id)
|
||||||
{
|
{
|
||||||
struct rmnet_real_dev_info *r;
|
|
||||||
struct rmnet_endpoint *ep;
|
struct rmnet_endpoint *ep;
|
||||||
|
struct rmnet_port *port;
|
||||||
|
|
||||||
if (!rmnet_is_real_dev_registered(dev)) {
|
if (!rmnet_is_real_dev_registered(dev)) {
|
||||||
ep = rmnet_vnd_get_endpoint(dev);
|
ep = rmnet_vnd_get_endpoint(dev);
|
||||||
} else {
|
} else {
|
||||||
r = __rmnet_get_real_dev_info(dev);
|
port = rmnet_get_port_rtnl(dev);
|
||||||
|
|
||||||
if (!r)
|
ep = &port->muxed_ep[config_id];
|
||||||
return NULL;
|
|
||||||
|
|
||||||
if (config_id == RMNET_LOCAL_LOGICAL_ENDPOINT)
|
|
||||||
ep = &r->local_ep;
|
|
||||||
else
|
|
||||||
ep = &r->muxed_ep[config_id];
|
|
||||||
}
|
}
|
||||||
|
|
||||||
return ep;
|
return ep;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int rmnet_unregister_real_device(struct net_device *real_dev,
|
static int rmnet_unregister_real_device(struct net_device *real_dev,
|
||||||
struct rmnet_real_dev_info *r)
|
struct rmnet_port *port)
|
||||||
{
|
{
|
||||||
if (r->nr_rmnet_devs)
|
if (port->nr_rmnet_devs)
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
kfree(r);
|
kfree(port);
|
||||||
|
|
||||||
netdev_rx_handler_unregister(real_dev);
|
netdev_rx_handler_unregister(real_dev);
|
||||||
|
|
||||||
@ -117,7 +100,7 @@ static int rmnet_unregister_real_device(struct net_device *real_dev,
|
|||||||
|
|
||||||
static int rmnet_register_real_device(struct net_device *real_dev)
|
static int rmnet_register_real_device(struct net_device *real_dev)
|
||||||
{
|
{
|
||||||
struct rmnet_real_dev_info *r;
|
struct rmnet_port *port;
|
||||||
int rc;
|
int rc;
|
||||||
|
|
||||||
ASSERT_RTNL();
|
ASSERT_RTNL();
|
||||||
@ -125,14 +108,14 @@ static int rmnet_register_real_device(struct net_device *real_dev)
|
|||||||
if (rmnet_is_real_dev_registered(real_dev))
|
if (rmnet_is_real_dev_registered(real_dev))
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
r = kzalloc(sizeof(*r), GFP_ATOMIC);
|
port = kzalloc(sizeof(*port), GFP_ATOMIC);
|
||||||
if (!r)
|
if (!port)
|
||||||
return -ENOMEM;
|
return -ENOMEM;
|
||||||
|
|
||||||
r->dev = real_dev;
|
port->dev = real_dev;
|
||||||
rc = netdev_rx_handler_register(real_dev, rmnet_rx_handler, r);
|
rc = netdev_rx_handler_register(real_dev, rmnet_rx_handler, port);
|
||||||
if (rc) {
|
if (rc) {
|
||||||
kfree(r);
|
kfree(port);
|
||||||
return -EBUSY;
|
return -EBUSY;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -143,74 +126,23 @@ static int rmnet_register_real_device(struct net_device *real_dev)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int rmnet_set_ingress_data_format(struct net_device *dev, u32 idf)
|
static void rmnet_set_endpoint_config(struct net_device *dev,
|
||||||
|
u8 mux_id, u8 rmnet_mode,
|
||||||
|
struct net_device *egress_dev)
|
||||||
{
|
{
|
||||||
struct rmnet_real_dev_info *r;
|
struct rmnet_endpoint *ep;
|
||||||
|
|
||||||
netdev_dbg(dev, "Ingress format 0x%08X\n", idf);
|
|
||||||
|
|
||||||
r = __rmnet_get_real_dev_info(dev);
|
|
||||||
|
|
||||||
r->ingress_data_format = idf;
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int rmnet_set_egress_data_format(struct net_device *dev, u32 edf,
|
|
||||||
u16 agg_size, u16 agg_count)
|
|
||||||
{
|
|
||||||
struct rmnet_real_dev_info *r;
|
|
||||||
|
|
||||||
netdev_dbg(dev, "Egress format 0x%08X agg size %d cnt %d\n",
|
|
||||||
edf, agg_size, agg_count);
|
|
||||||
|
|
||||||
r = __rmnet_get_real_dev_info(dev);
|
|
||||||
|
|
||||||
r->egress_data_format = edf;
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int __rmnet_set_endpoint_config(struct net_device *dev, int config_id,
|
|
||||||
struct rmnet_endpoint *ep)
|
|
||||||
{
|
|
||||||
struct rmnet_endpoint *dev_ep;
|
|
||||||
|
|
||||||
dev_ep = rmnet_get_endpoint(dev, config_id);
|
|
||||||
|
|
||||||
if (!dev_ep)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
memcpy(dev_ep, ep, sizeof(struct rmnet_endpoint));
|
|
||||||
if (config_id == RMNET_LOCAL_LOGICAL_ENDPOINT)
|
|
||||||
dev_ep->mux_id = 0;
|
|
||||||
else
|
|
||||||
dev_ep->mux_id = config_id;
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int rmnet_set_endpoint_config(struct net_device *dev,
|
|
||||||
int config_id, u8 rmnet_mode,
|
|
||||||
struct net_device *egress_dev)
|
|
||||||
{
|
|
||||||
struct rmnet_endpoint ep;
|
|
||||||
|
|
||||||
netdev_dbg(dev, "id %d mode %d dev %s\n",
|
netdev_dbg(dev, "id %d mode %d dev %s\n",
|
||||||
config_id, rmnet_mode, egress_dev->name);
|
mux_id, rmnet_mode, egress_dev->name);
|
||||||
|
|
||||||
if (config_id < RMNET_LOCAL_LOGICAL_ENDPOINT ||
|
|
||||||
config_id >= RMNET_MAX_LOGICAL_EP)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
|
ep = rmnet_get_endpoint(dev, mux_id);
|
||||||
/* This config is cleared on every set, so its ok to not
|
/* This config is cleared on every set, so its ok to not
|
||||||
* clear it on a device delete.
|
* clear it on a device delete.
|
||||||
*/
|
*/
|
||||||
memset(&ep, 0, sizeof(struct rmnet_endpoint));
|
memset(ep, 0, sizeof(struct rmnet_endpoint));
|
||||||
ep.rmnet_mode = rmnet_mode;
|
ep->rmnet_mode = rmnet_mode;
|
||||||
ep.egress_dev = egress_dev;
|
ep->egress_dev = egress_dev;
|
||||||
|
ep->mux_id = mux_id;
|
||||||
return __rmnet_set_endpoint_config(dev, config_id, &ep);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int rmnet_newlink(struct net *src_net, struct net_device *dev,
|
static int rmnet_newlink(struct net *src_net, struct net_device *dev,
|
||||||
@ -222,9 +154,9 @@ static int rmnet_newlink(struct net *src_net, struct net_device *dev,
|
|||||||
RMNET_INGRESS_FORMAT_MAP;
|
RMNET_INGRESS_FORMAT_MAP;
|
||||||
int egress_format = RMNET_EGRESS_FORMAT_MUXING |
|
int egress_format = RMNET_EGRESS_FORMAT_MUXING |
|
||||||
RMNET_EGRESS_FORMAT_MAP;
|
RMNET_EGRESS_FORMAT_MAP;
|
||||||
struct rmnet_real_dev_info *r;
|
|
||||||
struct net_device *real_dev;
|
struct net_device *real_dev;
|
||||||
int mode = RMNET_EPMODE_VND;
|
int mode = RMNET_EPMODE_VND;
|
||||||
|
struct rmnet_port *port;
|
||||||
int err = 0;
|
int err = 0;
|
||||||
u16 mux_id;
|
u16 mux_id;
|
||||||
|
|
||||||
@ -241,8 +173,8 @@ static int rmnet_newlink(struct net *src_net, struct net_device *dev,
|
|||||||
if (err)
|
if (err)
|
||||||
goto err0;
|
goto err0;
|
||||||
|
|
||||||
r = rmnet_get_real_dev_info_rtnl(real_dev);
|
port = rmnet_get_port_rtnl(real_dev);
|
||||||
err = rmnet_vnd_newlink(mux_id, dev, r);
|
err = rmnet_vnd_newlink(mux_id, dev, port, real_dev);
|
||||||
if (err)
|
if (err)
|
||||||
goto err1;
|
goto err1;
|
||||||
|
|
||||||
@ -250,25 +182,27 @@ static int rmnet_newlink(struct net *src_net, struct net_device *dev,
|
|||||||
if (err)
|
if (err)
|
||||||
goto err2;
|
goto err2;
|
||||||
|
|
||||||
rmnet_vnd_set_mux(dev, mux_id);
|
netdev_dbg(dev, "data format [ingress 0x%08X] [egress 0x%08X]\n",
|
||||||
rmnet_set_egress_data_format(real_dev, egress_format, 0, 0);
|
ingress_format, egress_format);
|
||||||
rmnet_set_ingress_data_format(real_dev, ingress_format);
|
port->egress_data_format = egress_format;
|
||||||
|
port->ingress_data_format = ingress_format;
|
||||||
|
|
||||||
rmnet_set_endpoint_config(real_dev, mux_id, mode, dev);
|
rmnet_set_endpoint_config(real_dev, mux_id, mode, dev);
|
||||||
rmnet_set_endpoint_config(dev, mux_id, mode, real_dev);
|
rmnet_set_endpoint_config(dev, mux_id, mode, real_dev);
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
err2:
|
err2:
|
||||||
rmnet_vnd_dellink(mux_id, r);
|
rmnet_vnd_dellink(mux_id, port);
|
||||||
err1:
|
err1:
|
||||||
rmnet_unregister_real_device(real_dev, r);
|
rmnet_unregister_real_device(real_dev, port);
|
||||||
err0:
|
err0:
|
||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void rmnet_dellink(struct net_device *dev, struct list_head *head)
|
static void rmnet_dellink(struct net_device *dev, struct list_head *head)
|
||||||
{
|
{
|
||||||
struct rmnet_real_dev_info *r;
|
|
||||||
struct net_device *real_dev;
|
struct net_device *real_dev;
|
||||||
|
struct rmnet_port *port;
|
||||||
u8 mux_id;
|
u8 mux_id;
|
||||||
|
|
||||||
rcu_read_lock();
|
rcu_read_lock();
|
||||||
@ -278,12 +212,12 @@ static void rmnet_dellink(struct net_device *dev, struct list_head *head)
|
|||||||
if (!real_dev || !rmnet_is_real_dev_registered(real_dev))
|
if (!real_dev || !rmnet_is_real_dev_registered(real_dev))
|
||||||
return;
|
return;
|
||||||
|
|
||||||
r = rmnet_get_real_dev_info_rtnl(real_dev);
|
port = rmnet_get_port_rtnl(real_dev);
|
||||||
|
|
||||||
mux_id = rmnet_vnd_get_mux(dev);
|
mux_id = rmnet_vnd_get_mux(dev);
|
||||||
rmnet_vnd_dellink(mux_id, r);
|
rmnet_vnd_dellink(mux_id, port);
|
||||||
netdev_upper_dev_unlink(dev, real_dev);
|
netdev_upper_dev_unlink(dev, real_dev);
|
||||||
rmnet_unregister_real_device(real_dev, r);
|
rmnet_unregister_real_device(real_dev, port);
|
||||||
|
|
||||||
unregister_netdevice_queue(dev, head);
|
unregister_netdevice_queue(dev, head);
|
||||||
}
|
}
|
||||||
@ -295,7 +229,7 @@ static int rmnet_dev_walk_unreg(struct net_device *rmnet_dev, void *data)
|
|||||||
|
|
||||||
mux_id = rmnet_vnd_get_mux(rmnet_dev);
|
mux_id = rmnet_vnd_get_mux(rmnet_dev);
|
||||||
|
|
||||||
rmnet_vnd_dellink(mux_id, d->real_dev_info);
|
rmnet_vnd_dellink(mux_id, d->port);
|
||||||
netdev_upper_dev_unlink(rmnet_dev, d->real_dev);
|
netdev_upper_dev_unlink(rmnet_dev, d->real_dev);
|
||||||
unregister_netdevice_queue(rmnet_dev, d->head);
|
unregister_netdevice_queue(rmnet_dev, d->head);
|
||||||
|
|
||||||
@ -305,8 +239,8 @@ static int rmnet_dev_walk_unreg(struct net_device *rmnet_dev, void *data)
|
|||||||
static void rmnet_force_unassociate_device(struct net_device *dev)
|
static void rmnet_force_unassociate_device(struct net_device *dev)
|
||||||
{
|
{
|
||||||
struct net_device *real_dev = dev;
|
struct net_device *real_dev = dev;
|
||||||
struct rmnet_real_dev_info *r;
|
|
||||||
struct rmnet_walk_data d;
|
struct rmnet_walk_data d;
|
||||||
|
struct rmnet_port *port;
|
||||||
LIST_HEAD(list);
|
LIST_HEAD(list);
|
||||||
|
|
||||||
if (!rmnet_is_real_dev_registered(real_dev))
|
if (!rmnet_is_real_dev_registered(real_dev))
|
||||||
@ -317,15 +251,15 @@ static void rmnet_force_unassociate_device(struct net_device *dev)
|
|||||||
d.real_dev = real_dev;
|
d.real_dev = real_dev;
|
||||||
d.head = &list;
|
d.head = &list;
|
||||||
|
|
||||||
r = rmnet_get_real_dev_info_rtnl(dev);
|
port = rmnet_get_port_rtnl(dev);
|
||||||
d.real_dev_info = r;
|
d.port = port;
|
||||||
|
|
||||||
rcu_read_lock();
|
rcu_read_lock();
|
||||||
netdev_walk_all_lower_dev_rcu(real_dev, rmnet_dev_walk_unreg, &d);
|
netdev_walk_all_lower_dev_rcu(real_dev, rmnet_dev_walk_unreg, &d);
|
||||||
rcu_read_unlock();
|
rcu_read_unlock();
|
||||||
unregister_netdevice_many(&list);
|
unregister_netdevice_many(&list);
|
||||||
|
|
||||||
rmnet_unregister_real_device(real_dev, r);
|
rmnet_unregister_real_device(real_dev, port);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int rmnet_config_notify_cb(struct notifier_block *nb,
|
static int rmnet_config_notify_cb(struct notifier_block *nb,
|
||||||
@ -384,10 +318,13 @@ struct rtnl_link_ops rmnet_link_ops __read_mostly = {
|
|||||||
.get_size = rmnet_get_size,
|
.get_size = rmnet_get_size,
|
||||||
};
|
};
|
||||||
|
|
||||||
struct rmnet_real_dev_info*
|
/* Needs either rcu_read_lock() or rtnl lock */
|
||||||
rmnet_get_real_dev_info(struct net_device *real_dev)
|
struct rmnet_port *rmnet_get_port(struct net_device *real_dev)
|
||||||
{
|
{
|
||||||
return __rmnet_get_real_dev_info(real_dev);
|
if (rmnet_is_real_dev_registered(real_dev))
|
||||||
|
return rcu_dereference_rtnl(real_dev->rx_handler_data);
|
||||||
|
else
|
||||||
|
return NULL;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* Startup/Shutdown */
|
/* Startup/Shutdown */
|
||||||
|
@ -19,7 +19,6 @@
|
|||||||
#define _RMNET_CONFIG_H_
|
#define _RMNET_CONFIG_H_
|
||||||
|
|
||||||
#define RMNET_MAX_LOGICAL_EP 255
|
#define RMNET_MAX_LOGICAL_EP 255
|
||||||
#define RMNET_MAX_VND 32
|
|
||||||
|
|
||||||
/* Information about the next device to deliver the packet to.
|
/* Information about the next device to deliver the packet to.
|
||||||
* Exact usage of this parameter depends on the rmnet_mode.
|
* Exact usage of this parameter depends on the rmnet_mode.
|
||||||
@ -33,13 +32,13 @@ struct rmnet_endpoint {
|
|||||||
/* One instance of this structure is instantiated for each real_dev associated
|
/* One instance of this structure is instantiated for each real_dev associated
|
||||||
* with rmnet.
|
* with rmnet.
|
||||||
*/
|
*/
|
||||||
struct rmnet_real_dev_info {
|
struct rmnet_port {
|
||||||
struct net_device *dev;
|
struct net_device *dev;
|
||||||
struct rmnet_endpoint local_ep;
|
struct rmnet_endpoint local_ep;
|
||||||
struct rmnet_endpoint muxed_ep[RMNET_MAX_LOGICAL_EP];
|
struct rmnet_endpoint muxed_ep[RMNET_MAX_LOGICAL_EP];
|
||||||
u32 ingress_data_format;
|
u32 ingress_data_format;
|
||||||
u32 egress_data_format;
|
u32 egress_data_format;
|
||||||
struct net_device *rmnet_devices[RMNET_MAX_VND];
|
struct net_device *rmnet_devices[RMNET_MAX_LOGICAL_EP];
|
||||||
u8 nr_rmnet_devs;
|
u8 nr_rmnet_devs;
|
||||||
};
|
};
|
||||||
|
|
||||||
@ -48,9 +47,9 @@ extern struct rtnl_link_ops rmnet_link_ops;
|
|||||||
struct rmnet_priv {
|
struct rmnet_priv {
|
||||||
struct rmnet_endpoint local_ep;
|
struct rmnet_endpoint local_ep;
|
||||||
u8 mux_id;
|
u8 mux_id;
|
||||||
|
struct net_device *real_dev;
|
||||||
};
|
};
|
||||||
|
|
||||||
struct rmnet_real_dev_info*
|
struct rmnet_port *rmnet_get_port(struct net_device *real_dev);
|
||||||
rmnet_get_real_dev_info(struct net_device *real_dev);
|
|
||||||
|
|
||||||
#endif /* _RMNET_CONFIG_H_ */
|
#endif /* _RMNET_CONFIG_H_ */
|
||||||
|
@ -82,32 +82,32 @@ rmnet_deliver_skb(struct sk_buff *skb, struct rmnet_endpoint *ep)
|
|||||||
|
|
||||||
static rx_handler_result_t
|
static rx_handler_result_t
|
||||||
rmnet_ingress_deliver_packet(struct sk_buff *skb,
|
rmnet_ingress_deliver_packet(struct sk_buff *skb,
|
||||||
struct rmnet_real_dev_info *r)
|
struct rmnet_port *port)
|
||||||
{
|
{
|
||||||
if (!r) {
|
if (!port) {
|
||||||
kfree_skb(skb);
|
kfree_skb(skb);
|
||||||
return RX_HANDLER_CONSUMED;
|
return RX_HANDLER_CONSUMED;
|
||||||
}
|
}
|
||||||
|
|
||||||
skb->dev = r->local_ep.egress_dev;
|
skb->dev = port->local_ep.egress_dev;
|
||||||
|
|
||||||
return rmnet_deliver_skb(skb, &r->local_ep);
|
return rmnet_deliver_skb(skb, &port->local_ep);
|
||||||
}
|
}
|
||||||
|
|
||||||
/* MAP handler */
|
/* MAP handler */
|
||||||
|
|
||||||
static rx_handler_result_t
|
static rx_handler_result_t
|
||||||
__rmnet_map_ingress_handler(struct sk_buff *skb,
|
__rmnet_map_ingress_handler(struct sk_buff *skb,
|
||||||
struct rmnet_real_dev_info *r)
|
struct rmnet_port *port)
|
||||||
{
|
{
|
||||||
struct rmnet_endpoint *ep;
|
struct rmnet_endpoint *ep;
|
||||||
u8 mux_id;
|
u8 mux_id;
|
||||||
u16 len;
|
u16 len;
|
||||||
|
|
||||||
if (RMNET_MAP_GET_CD_BIT(skb)) {
|
if (RMNET_MAP_GET_CD_BIT(skb)) {
|
||||||
if (r->ingress_data_format
|
if (port->ingress_data_format
|
||||||
& RMNET_INGRESS_FORMAT_MAP_COMMANDS)
|
& RMNET_INGRESS_FORMAT_MAP_COMMANDS)
|
||||||
return rmnet_map_command(skb, r);
|
return rmnet_map_command(skb, port);
|
||||||
|
|
||||||
kfree_skb(skb);
|
kfree_skb(skb);
|
||||||
return RX_HANDLER_CONSUMED;
|
return RX_HANDLER_CONSUMED;
|
||||||
@ -121,9 +121,9 @@ __rmnet_map_ingress_handler(struct sk_buff *skb,
|
|||||||
return RX_HANDLER_CONSUMED;
|
return RX_HANDLER_CONSUMED;
|
||||||
}
|
}
|
||||||
|
|
||||||
ep = &r->muxed_ep[mux_id];
|
ep = &port->muxed_ep[mux_id];
|
||||||
|
|
||||||
if (r->ingress_data_format & RMNET_INGRESS_FORMAT_DEMUXING)
|
if (port->ingress_data_format & RMNET_INGRESS_FORMAT_DEMUXING)
|
||||||
skb->dev = ep->egress_dev;
|
skb->dev = ep->egress_dev;
|
||||||
|
|
||||||
/* Subtract MAP header */
|
/* Subtract MAP header */
|
||||||
@ -135,26 +135,26 @@ __rmnet_map_ingress_handler(struct sk_buff *skb,
|
|||||||
|
|
||||||
static rx_handler_result_t
|
static rx_handler_result_t
|
||||||
rmnet_map_ingress_handler(struct sk_buff *skb,
|
rmnet_map_ingress_handler(struct sk_buff *skb,
|
||||||
struct rmnet_real_dev_info *r)
|
struct rmnet_port *port)
|
||||||
{
|
{
|
||||||
struct sk_buff *skbn;
|
struct sk_buff *skbn;
|
||||||
int rc;
|
int rc;
|
||||||
|
|
||||||
if (r->ingress_data_format & RMNET_INGRESS_FORMAT_DEAGGREGATION) {
|
if (port->ingress_data_format & RMNET_INGRESS_FORMAT_DEAGGREGATION) {
|
||||||
while ((skbn = rmnet_map_deaggregate(skb, r)) != NULL)
|
while ((skbn = rmnet_map_deaggregate(skb)) != NULL)
|
||||||
__rmnet_map_ingress_handler(skbn, r);
|
__rmnet_map_ingress_handler(skbn, port);
|
||||||
|
|
||||||
consume_skb(skb);
|
consume_skb(skb);
|
||||||
rc = RX_HANDLER_CONSUMED;
|
rc = RX_HANDLER_CONSUMED;
|
||||||
} else {
|
} else {
|
||||||
rc = __rmnet_map_ingress_handler(skb, r);
|
rc = __rmnet_map_ingress_handler(skb, port);
|
||||||
}
|
}
|
||||||
|
|
||||||
return rc;
|
return rc;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int rmnet_map_egress_handler(struct sk_buff *skb,
|
static int rmnet_map_egress_handler(struct sk_buff *skb,
|
||||||
struct rmnet_real_dev_info *r,
|
struct rmnet_port *port,
|
||||||
struct rmnet_endpoint *ep,
|
struct rmnet_endpoint *ep,
|
||||||
struct net_device *orig_dev)
|
struct net_device *orig_dev)
|
||||||
{
|
{
|
||||||
@ -173,7 +173,7 @@ static int rmnet_map_egress_handler(struct sk_buff *skb,
|
|||||||
if (!map_header)
|
if (!map_header)
|
||||||
return RMNET_MAP_CONSUMED;
|
return RMNET_MAP_CONSUMED;
|
||||||
|
|
||||||
if (r->egress_data_format & RMNET_EGRESS_FORMAT_MUXING) {
|
if (port->egress_data_format & RMNET_EGRESS_FORMAT_MUXING) {
|
||||||
if (ep->mux_id == 0xff)
|
if (ep->mux_id == 0xff)
|
||||||
map_header->mux_id = 0;
|
map_header->mux_id = 0;
|
||||||
else
|
else
|
||||||
@ -193,7 +193,7 @@ static int rmnet_map_egress_handler(struct sk_buff *skb,
|
|||||||
*/
|
*/
|
||||||
rx_handler_result_t rmnet_rx_handler(struct sk_buff **pskb)
|
rx_handler_result_t rmnet_rx_handler(struct sk_buff **pskb)
|
||||||
{
|
{
|
||||||
struct rmnet_real_dev_info *r;
|
struct rmnet_port *port;
|
||||||
struct sk_buff *skb = *pskb;
|
struct sk_buff *skb = *pskb;
|
||||||
struct net_device *dev;
|
struct net_device *dev;
|
||||||
int rc;
|
int rc;
|
||||||
@ -202,16 +202,16 @@ rx_handler_result_t rmnet_rx_handler(struct sk_buff **pskb)
|
|||||||
return RX_HANDLER_CONSUMED;
|
return RX_HANDLER_CONSUMED;
|
||||||
|
|
||||||
dev = skb->dev;
|
dev = skb->dev;
|
||||||
r = rmnet_get_real_dev_info(dev);
|
port = rmnet_get_port(dev);
|
||||||
|
|
||||||
if (r->ingress_data_format & RMNET_INGRESS_FORMAT_MAP) {
|
if (port->ingress_data_format & RMNET_INGRESS_FORMAT_MAP) {
|
||||||
rc = rmnet_map_ingress_handler(skb, r);
|
rc = rmnet_map_ingress_handler(skb, port);
|
||||||
} else {
|
} else {
|
||||||
switch (ntohs(skb->protocol)) {
|
switch (ntohs(skb->protocol)) {
|
||||||
case ETH_P_MAP:
|
case ETH_P_MAP:
|
||||||
if (r->local_ep.rmnet_mode ==
|
if (port->local_ep.rmnet_mode ==
|
||||||
RMNET_EPMODE_BRIDGE) {
|
RMNET_EPMODE_BRIDGE) {
|
||||||
rc = rmnet_ingress_deliver_packet(skb, r);
|
rc = rmnet_ingress_deliver_packet(skb, port);
|
||||||
} else {
|
} else {
|
||||||
kfree_skb(skb);
|
kfree_skb(skb);
|
||||||
rc = RX_HANDLER_CONSUMED;
|
rc = RX_HANDLER_CONSUMED;
|
||||||
@ -220,7 +220,7 @@ rx_handler_result_t rmnet_rx_handler(struct sk_buff **pskb)
|
|||||||
|
|
||||||
case ETH_P_IP:
|
case ETH_P_IP:
|
||||||
case ETH_P_IPV6:
|
case ETH_P_IPV6:
|
||||||
rc = rmnet_ingress_deliver_packet(skb, r);
|
rc = rmnet_ingress_deliver_packet(skb, port);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
default:
|
default:
|
||||||
@ -238,20 +238,20 @@ rx_handler_result_t rmnet_rx_handler(struct sk_buff **pskb)
|
|||||||
void rmnet_egress_handler(struct sk_buff *skb,
|
void rmnet_egress_handler(struct sk_buff *skb,
|
||||||
struct rmnet_endpoint *ep)
|
struct rmnet_endpoint *ep)
|
||||||
{
|
{
|
||||||
struct rmnet_real_dev_info *r;
|
|
||||||
struct net_device *orig_dev;
|
struct net_device *orig_dev;
|
||||||
|
struct rmnet_port *port;
|
||||||
|
|
||||||
orig_dev = skb->dev;
|
orig_dev = skb->dev;
|
||||||
skb->dev = ep->egress_dev;
|
skb->dev = ep->egress_dev;
|
||||||
|
|
||||||
r = rmnet_get_real_dev_info(skb->dev);
|
port = rmnet_get_port(skb->dev);
|
||||||
if (!r) {
|
if (!port) {
|
||||||
kfree_skb(skb);
|
kfree_skb(skb);
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (r->egress_data_format & RMNET_EGRESS_FORMAT_MAP) {
|
if (port->egress_data_format & RMNET_EGRESS_FORMAT_MAP) {
|
||||||
switch (rmnet_map_egress_handler(skb, r, ep, orig_dev)) {
|
switch (rmnet_map_egress_handler(skb, port, ep, orig_dev)) {
|
||||||
case RMNET_MAP_CONSUMED:
|
case RMNET_MAP_CONSUMED:
|
||||||
return;
|
return;
|
||||||
|
|
||||||
|
@ -77,12 +77,10 @@ struct rmnet_map_header {
|
|||||||
#define RMNET_MAP_ADD_PAD_BYTES 1
|
#define RMNET_MAP_ADD_PAD_BYTES 1
|
||||||
|
|
||||||
u8 rmnet_map_demultiplex(struct sk_buff *skb);
|
u8 rmnet_map_demultiplex(struct sk_buff *skb);
|
||||||
struct sk_buff *rmnet_map_deaggregate(struct sk_buff *skb,
|
struct sk_buff *rmnet_map_deaggregate(struct sk_buff *skb);
|
||||||
struct rmnet_real_dev_info *rdinfo);
|
|
||||||
|
|
||||||
struct rmnet_map_header *rmnet_map_add_map_header(struct sk_buff *skb,
|
struct rmnet_map_header *rmnet_map_add_map_header(struct sk_buff *skb,
|
||||||
int hdrlen, int pad);
|
int hdrlen, int pad);
|
||||||
rx_handler_result_t rmnet_map_command(struct sk_buff *skb,
|
rx_handler_result_t rmnet_map_command(struct sk_buff *skb,
|
||||||
struct rmnet_real_dev_info *rdinfo);
|
struct rmnet_port *port);
|
||||||
|
|
||||||
#endif /* _RMNET_MAP_H_ */
|
#endif /* _RMNET_MAP_H_ */
|
||||||
|
@ -17,7 +17,7 @@
|
|||||||
#include "rmnet_vnd.h"
|
#include "rmnet_vnd.h"
|
||||||
|
|
||||||
static u8 rmnet_map_do_flow_control(struct sk_buff *skb,
|
static u8 rmnet_map_do_flow_control(struct sk_buff *skb,
|
||||||
struct rmnet_real_dev_info *rdinfo,
|
struct rmnet_port *rdinfo,
|
||||||
int enable)
|
int enable)
|
||||||
{
|
{
|
||||||
struct rmnet_map_control_command *cmd;
|
struct rmnet_map_control_command *cmd;
|
||||||
@ -58,8 +58,7 @@ static u8 rmnet_map_do_flow_control(struct sk_buff *skb,
|
|||||||
}
|
}
|
||||||
|
|
||||||
static void rmnet_map_send_ack(struct sk_buff *skb,
|
static void rmnet_map_send_ack(struct sk_buff *skb,
|
||||||
unsigned char type,
|
unsigned char type)
|
||||||
struct rmnet_real_dev_info *rdinfo)
|
|
||||||
{
|
{
|
||||||
struct rmnet_map_control_command *cmd;
|
struct rmnet_map_control_command *cmd;
|
||||||
int xmit_status;
|
int xmit_status;
|
||||||
@ -78,7 +77,7 @@ static void rmnet_map_send_ack(struct sk_buff *skb,
|
|||||||
* name is decoded here and appropriate handler is called.
|
* name is decoded here and appropriate handler is called.
|
||||||
*/
|
*/
|
||||||
rx_handler_result_t rmnet_map_command(struct sk_buff *skb,
|
rx_handler_result_t rmnet_map_command(struct sk_buff *skb,
|
||||||
struct rmnet_real_dev_info *rdinfo)
|
struct rmnet_port *port)
|
||||||
{
|
{
|
||||||
struct rmnet_map_control_command *cmd;
|
struct rmnet_map_control_command *cmd;
|
||||||
unsigned char command_name;
|
unsigned char command_name;
|
||||||
@ -89,11 +88,11 @@ rx_handler_result_t rmnet_map_command(struct sk_buff *skb,
|
|||||||
|
|
||||||
switch (command_name) {
|
switch (command_name) {
|
||||||
case RMNET_MAP_COMMAND_FLOW_ENABLE:
|
case RMNET_MAP_COMMAND_FLOW_ENABLE:
|
||||||
rc = rmnet_map_do_flow_control(skb, rdinfo, 1);
|
rc = rmnet_map_do_flow_control(skb, port, 1);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
case RMNET_MAP_COMMAND_FLOW_DISABLE:
|
case RMNET_MAP_COMMAND_FLOW_DISABLE:
|
||||||
rc = rmnet_map_do_flow_control(skb, rdinfo, 0);
|
rc = rmnet_map_do_flow_control(skb, port, 0);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
default:
|
default:
|
||||||
@ -102,6 +101,6 @@ rx_handler_result_t rmnet_map_command(struct sk_buff *skb,
|
|||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
if (rc == RMNET_MAP_COMMAND_ACK)
|
if (rc == RMNET_MAP_COMMAND_ACK)
|
||||||
rmnet_map_send_ack(skb, rc, rdinfo);
|
rmnet_map_send_ack(skb, rc);
|
||||||
return RX_HANDLER_CONSUMED;
|
return RX_HANDLER_CONSUMED;
|
||||||
}
|
}
|
||||||
|
@ -69,8 +69,7 @@ struct rmnet_map_header *rmnet_map_add_map_header(struct sk_buff *skb,
|
|||||||
* returned, indicating that there are no more packets to deaggregate. Caller
|
* returned, indicating that there are no more packets to deaggregate. Caller
|
||||||
* is responsible for freeing the original skb.
|
* is responsible for freeing the original skb.
|
||||||
*/
|
*/
|
||||||
struct sk_buff *rmnet_map_deaggregate(struct sk_buff *skb,
|
struct sk_buff *rmnet_map_deaggregate(struct sk_buff *skb)
|
||||||
struct rmnet_real_dev_info *rdinfo)
|
|
||||||
{
|
{
|
||||||
struct rmnet_map_header *maph;
|
struct rmnet_map_header *maph;
|
||||||
struct sk_buff *skbn;
|
struct sk_buff *skbn;
|
||||||
|
@ -13,7 +13,6 @@
|
|||||||
#ifndef _RMNET_PRIVATE_H_
|
#ifndef _RMNET_PRIVATE_H_
|
||||||
#define _RMNET_PRIVATE_H_
|
#define _RMNET_PRIVATE_H_
|
||||||
|
|
||||||
#define RMNET_MAX_VND 32
|
|
||||||
#define RMNET_MAX_PACKET_SIZE 16384
|
#define RMNET_MAX_PACKET_SIZE 16384
|
||||||
#define RMNET_DFLT_PACKET_SIZE 1500
|
#define RMNET_DFLT_PACKET_SIZE 1500
|
||||||
#define RMNET_NEEDED_HEADROOM 16
|
#define RMNET_NEEDED_HEADROOM 16
|
||||||
|
@ -63,9 +63,17 @@ static int rmnet_vnd_change_mtu(struct net_device *rmnet_dev, int new_mtu)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int rmnet_vnd_get_iflink(const struct net_device *dev)
|
||||||
|
{
|
||||||
|
struct rmnet_priv *priv = netdev_priv(dev);
|
||||||
|
|
||||||
|
return priv->real_dev->ifindex;
|
||||||
|
}
|
||||||
|
|
||||||
static const struct net_device_ops rmnet_vnd_ops = {
|
static const struct net_device_ops rmnet_vnd_ops = {
|
||||||
.ndo_start_xmit = rmnet_vnd_start_xmit,
|
.ndo_start_xmit = rmnet_vnd_start_xmit,
|
||||||
.ndo_change_mtu = rmnet_vnd_change_mtu,
|
.ndo_change_mtu = rmnet_vnd_change_mtu,
|
||||||
|
.ndo_get_iflink = rmnet_vnd_get_iflink,
|
||||||
};
|
};
|
||||||
|
|
||||||
/* Called by kernel whenever a new rmnet<n> device is created. Sets MTU,
|
/* Called by kernel whenever a new rmnet<n> device is created. Sets MTU,
|
||||||
@ -73,8 +81,6 @@ static const struct net_device_ops rmnet_vnd_ops = {
|
|||||||
*/
|
*/
|
||||||
void rmnet_vnd_setup(struct net_device *rmnet_dev)
|
void rmnet_vnd_setup(struct net_device *rmnet_dev)
|
||||||
{
|
{
|
||||||
netdev_dbg(rmnet_dev, "Setting up device %s\n", rmnet_dev->name);
|
|
||||||
|
|
||||||
rmnet_dev->netdev_ops = &rmnet_vnd_ops;
|
rmnet_dev->netdev_ops = &rmnet_vnd_ops;
|
||||||
rmnet_dev->mtu = RMNET_DFLT_PACKET_SIZE;
|
rmnet_dev->mtu = RMNET_DFLT_PACKET_SIZE;
|
||||||
rmnet_dev->needed_headroom = RMNET_NEEDED_HEADROOM;
|
rmnet_dev->needed_headroom = RMNET_NEEDED_HEADROOM;
|
||||||
@ -93,30 +99,39 @@ void rmnet_vnd_setup(struct net_device *rmnet_dev)
|
|||||||
/* Exposed API */
|
/* Exposed API */
|
||||||
|
|
||||||
int rmnet_vnd_newlink(u8 id, struct net_device *rmnet_dev,
|
int rmnet_vnd_newlink(u8 id, struct net_device *rmnet_dev,
|
||||||
struct rmnet_real_dev_info *r)
|
struct rmnet_port *port,
|
||||||
|
struct net_device *real_dev)
|
||||||
{
|
{
|
||||||
|
struct rmnet_priv *priv;
|
||||||
int rc;
|
int rc;
|
||||||
|
|
||||||
if (r->rmnet_devices[id])
|
if (port->rmnet_devices[id])
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
rc = register_netdevice(rmnet_dev);
|
rc = register_netdevice(rmnet_dev);
|
||||||
if (!rc) {
|
if (!rc) {
|
||||||
r->rmnet_devices[id] = rmnet_dev;
|
port->rmnet_devices[id] = rmnet_dev;
|
||||||
r->nr_rmnet_devs++;
|
port->nr_rmnet_devs++;
|
||||||
|
|
||||||
rmnet_dev->rtnl_link_ops = &rmnet_link_ops;
|
rmnet_dev->rtnl_link_ops = &rmnet_link_ops;
|
||||||
|
|
||||||
|
priv = netdev_priv(rmnet_dev);
|
||||||
|
priv->mux_id = id;
|
||||||
|
priv->real_dev = real_dev;
|
||||||
|
|
||||||
|
netdev_dbg(rmnet_dev, "rmnet dev created\n");
|
||||||
}
|
}
|
||||||
|
|
||||||
return rc;
|
return rc;
|
||||||
}
|
}
|
||||||
|
|
||||||
int rmnet_vnd_dellink(u8 id, struct rmnet_real_dev_info *r)
|
int rmnet_vnd_dellink(u8 id, struct rmnet_port *port)
|
||||||
{
|
{
|
||||||
if (id >= RMNET_MAX_VND || !r->rmnet_devices[id])
|
if (id >= RMNET_MAX_LOGICAL_EP || !port->rmnet_devices[id])
|
||||||
return -EINVAL;
|
return -EINVAL;
|
||||||
|
|
||||||
r->rmnet_devices[id] = NULL;
|
port->rmnet_devices[id] = NULL;
|
||||||
r->nr_rmnet_devs--;
|
port->nr_rmnet_devs--;
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -128,14 +143,6 @@ u8 rmnet_vnd_get_mux(struct net_device *rmnet_dev)
|
|||||||
return priv->mux_id;
|
return priv->mux_id;
|
||||||
}
|
}
|
||||||
|
|
||||||
void rmnet_vnd_set_mux(struct net_device *rmnet_dev, u8 mux_id)
|
|
||||||
{
|
|
||||||
struct rmnet_priv *priv;
|
|
||||||
|
|
||||||
priv = netdev_priv(rmnet_dev);
|
|
||||||
priv->mux_id = mux_id;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Gets the logical endpoint configuration for a RmNet virtual network device
|
/* Gets the logical endpoint configuration for a RmNet virtual network device
|
||||||
* node. Caller should confirm that devices is a RmNet VND before calling.
|
* node. Caller should confirm that devices is a RmNet VND before calling.
|
||||||
*/
|
*/
|
||||||
|
@ -19,11 +19,11 @@
|
|||||||
int rmnet_vnd_do_flow_control(struct net_device *dev, int enable);
|
int rmnet_vnd_do_flow_control(struct net_device *dev, int enable);
|
||||||
struct rmnet_endpoint *rmnet_vnd_get_endpoint(struct net_device *dev);
|
struct rmnet_endpoint *rmnet_vnd_get_endpoint(struct net_device *dev);
|
||||||
int rmnet_vnd_newlink(u8 id, struct net_device *rmnet_dev,
|
int rmnet_vnd_newlink(u8 id, struct net_device *rmnet_dev,
|
||||||
struct rmnet_real_dev_info *r);
|
struct rmnet_port *port,
|
||||||
int rmnet_vnd_dellink(u8 id, struct rmnet_real_dev_info *r);
|
struct net_device *real_dev);
|
||||||
|
int rmnet_vnd_dellink(u8 id, struct rmnet_port *port);
|
||||||
void rmnet_vnd_rx_fixup(struct sk_buff *skb, struct net_device *dev);
|
void rmnet_vnd_rx_fixup(struct sk_buff *skb, struct net_device *dev);
|
||||||
void rmnet_vnd_tx_fixup(struct sk_buff *skb, struct net_device *dev);
|
void rmnet_vnd_tx_fixup(struct sk_buff *skb, struct net_device *dev);
|
||||||
u8 rmnet_vnd_get_mux(struct net_device *rmnet_dev);
|
u8 rmnet_vnd_get_mux(struct net_device *rmnet_dev);
|
||||||
void rmnet_vnd_set_mux(struct net_device *rmnet_dev, u8 mux_id);
|
|
||||||
void rmnet_vnd_setup(struct net_device *dev);
|
void rmnet_vnd_setup(struct net_device *dev);
|
||||||
#endif /* _RMNET_VND_H_ */
|
#endif /* _RMNET_VND_H_ */
|
||||||
|
Loading…
Reference in New Issue
Block a user