|
|
@@ -480,8 +480,6 @@ EXPORT_SYMBOL_GPL(can_put_echo_skb);
|
|
|
struct sk_buff *__can_get_echo_skb(struct net_device *dev, unsigned int idx, u8 *len_ptr)
|
|
|
{
|
|
|
struct can_priv *priv = netdev_priv(dev);
|
|
|
- struct sk_buff *skb = priv->echo_skb[idx];
|
|
|
- struct canfd_frame *cf;
|
|
|
|
|
|
if (idx >= priv->echo_skb_max) {
|
|
|
netdev_err(dev, "%s: BUG! Trying to access can_priv::echo_skb out of bounds (%u/max %u)\n",
|
|
|
@@ -489,20 +487,21 @@ struct sk_buff *__can_get_echo_skb(struct net_device *dev, unsigned int idx, u8
|
|
|
return NULL;
|
|
|
}
|
|
|
|
|
|
- if (!skb) {
|
|
|
- netdev_err(dev, "%s: BUG! Trying to echo non existing skb: can_priv::echo_skb[%u]\n",
|
|
|
- __func__, idx);
|
|
|
- return NULL;
|
|
|
- }
|
|
|
+ if (priv->echo_skb[idx]) {
|
|
|
+ /* Using "struct canfd_frame::len" for the frame
|
|
|
+ * length is supported on both CAN and CANFD frames.
|
|
|
+ */
|
|
|
+ struct sk_buff *skb = priv->echo_skb[idx];
|
|
|
+ struct canfd_frame *cf = (struct canfd_frame *)skb->data;
|
|
|
+ u8 len = cf->len;
|
|
|
|
|
|
- /* Using "struct canfd_frame::len" for the frame
|
|
|
- * length is supported on both CAN and CANFD frames.
|
|
|
- */
|
|
|
- cf = (struct canfd_frame *)skb->data;
|
|
|
- *len_ptr = cf->len;
|
|
|
- priv->echo_skb[idx] = NULL;
|
|
|
+ *len_ptr = len;
|
|
|
+ priv->echo_skb[idx] = NULL;
|
|
|
|
|
|
- return skb;
|
|
|
+ return skb;
|
|
|
+ }
|
|
|
+
|
|
|
+ return NULL;
|
|
|
}
|
|
|
|
|
|
/*
|