static int sipc4_check_data(struct sipc4_rx_data *data, char *buf, int rest) { struct net_device *dev = data->dev; struct sk_buff *skb = data->skb; struct sipc_rx_hdr *hdr = data->rx_hdr; int head_size = sipc4_get_header_size(data->format); int data_size = sipc4_get_hdlc_size(hdr->hdr, data->format) - head_size; int alloc_size = data_size; int len; struct sk_buff *skb_new; int err; if (!skb) { switch (data->format) { case SIPC4_RFS: /* Send the RFS header to RILD*/ alloc_size = sipc_min(data_size, rest) + head_size; skb = sipc4_alloc_skb(dev, alloc_size); if (unlikely(!skb)) return -ENOMEM; memcpy(skb_put(skb, head_size), hdr->hdr, head_size); break; default: skb = sipc4_alloc_skb(dev, alloc_size); if (unlikely(!skb)) return -ENOMEM; break; } data->skb = skb; } else { switch (data->format) { case SIPC4_RFS: alloc_size = sipc_min(data_size - hdr->flag_len, rest); skb_new = sipc4_alloc_skb(data->dev, alloc_size); if (unlikely(!skb_new)) return -ENOMEM; err = sipc4_hdlc_format_rx(data); if (err < 0) { dev_kfree_skb_any(skb_new); return err; } skb = data->skb = skb_new; break; default: /* do noting, IPC,RAW MTU is 1500byte */ break; } } /* handle data */ len = sipc_min(rest, alloc_size - skb->len); memcpy(skb_put(skb, len), buf, len); hdr->flag_len += len; return len; }
int sipc4_rx(struct sipc4_rx_data *data) { struct net_device *dev = data->dev; struct sk_buff *skb; /* non HDLC frame */ if (!(data->flags & SIPC4_RX_HDLC)) { int ch = SIPC4_NOT_HDLC_CH; /* get socket buffer */ if (!data->skb) { skb = sipc4_alloc_skb(dev, 0); if (!skb) return -ENOMEM; data->skb = skb; } else skb = data->skb; /* handle data */ skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, data->page, 0, data->size); /* rx data */ if (data->flags & SIPC4_RX_LAST) { data->skb = NULL; sipc4_netif_rx(dev, skb, SIPC4_RES(SIPC4_FMT, ch)); } return 0; } return sipc4_hdlc_rx(data); }
static int sipc4_check_header(struct sipc4_rx_data *data, char *buf, int rest) { struct sk_buff *skb = data->skb; int header_size = sipc4_get_header_size(data->format); int done_len = 0; int len = 0; if (!skb) { len = sipc4_check_hdlc_start(data, buf, rest); if (len < 0) return len; buf += len; rest -= len; done_len += len; skb = sipc4_alloc_skb(data, header_size); if (!skb) return -ENOMEM; data->skb = skb; } if (skb->len < header_size) { len = header_size - skb->len; len = rest < len ? rest : len; memcpy(skb_put(skb, len), buf, len); done_len += len; } return done_len; }
static int sipc4_check_data(struct sipc4_rx_data *data, char *buf, int rest, const __be16 protocol) { struct sk_buff *skb = data->skb; struct sipc4_rx_frag *frag = (struct sipc4_rx_frag *)skb->cb; struct page *page; int header_size = sipc4_get_header_size(data->format); int hdlc_size = sipc4_get_hdlc_size(skb->data, data->format); int data_size = hdlc_size - header_size; int skb_data_size = skb->data_len + frag->data_len; int rest_data_size = data_size - skb_data_size; int len; int skb_max_pages = MAX_SKB_FRAGS; len = rest < rest_data_size ? rest : rest_data_size; page = __netdev_alloc_page(data->dev, GFP_ATOMIC); if (!page) { pr_err("%s - failed to alloc netdev page\n", __func__); return -ENOMEM; } if (data->format == SIPC4_RFS) skb_max_pages = 1; /* check fragment number */ if (skb_shinfo(skb)->nr_frags >= skb_max_pages) { struct sk_buff *skb_new; int err; skb_new = sipc4_alloc_skb(data, header_size); if (!skb) { pr_err("%s - failed to alloc skb\n", __func__); return -ENOMEM; } memcpy(skb_put(skb_new, header_size), skb->data, header_size); memcpy(skb_new->cb, skb->cb, sizeof(struct sipc4_rx_frag)); frag = (struct sipc4_rx_frag *)skb_new->cb; frag->data_len += skb->data_len; err = sipc4_hdlc_format_rx(data, protocol); if (err < 0) { pr_err("%s - failed to rx data\n", __func__); dev_kfree_skb_any(skb_new); return err; } skb = data->skb = skb_new; } /* handle data */ memcpy(page_address(page), buf, len); skb_add_rx_frag(skb, skb_shinfo(skb)->nr_frags, page, 0, len); return len; }