Commit f98ce389 authored by David S. Miller's avatar David S. Miller

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: default avatarDavid S. Miller <davem@davemloft.net>
parents 3cf2e08f b665f4f8
...@@ -42,12 +42,11 @@ ...@@ -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) ...@@ -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) ...@@ -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)
return NULL;
if (config_id == RMNET_LOCAL_LOGICAL_ENDPOINT) ep = &port->muxed_ep[config_id];
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, ...@@ -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) ...@@ -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) ...@@ -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 rmnet_real_dev_info *r;
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 net_device *egress_dev)
{ {
struct rmnet_endpoint ep; 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, ...@@ -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, ...@@ -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, ...@@ -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) ...@@ -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) ...@@ -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) ...@@ -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) ...@@ -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 = { ...@@ -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 @@ ...@@ -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 { ...@@ -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; ...@@ -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) ...@@ -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, ...@@ -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, ...@@ -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, ...@@ -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, ...@@ -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) ...@@ -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) ...@@ -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) ...@@ -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 { ...@@ -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 @@ ...@@ -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, ...@@ -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, ...@@ -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, ...@@ -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, ...@@ -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, ...@@ -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 @@ ...@@ -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) ...@@ -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 = { ...@@ -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) ...@@ -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) ...@@ -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 @@ ...@@ -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_ */
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment