115c9ac0cSSjur Braendeland /* 215c9ac0cSSjur Braendeland * Copyright (C) ST-Ericsson AB 2010 326ee65e6Ssjur.brandeland@stericsson.com * Author: Sjur Brendeland 415c9ac0cSSjur Braendeland * License terms: GNU General Public License (GPL) version 2 515c9ac0cSSjur Braendeland */ 615c9ac0cSSjur Braendeland 7b31fa5baSJoe Perches #define pr_fmt(fmt) KBUILD_MODNAME ":%s(): " fmt, __func__ 8b31fa5baSJoe Perches 915c9ac0cSSjur Braendeland #include <linux/string.h> 1015c9ac0cSSjur Braendeland #include <linux/skbuff.h> 1115c9ac0cSSjur Braendeland #include <linux/hardirq.h> 12bc3b2d7fSPaul Gortmaker #include <linux/export.h> 1315c9ac0cSSjur Braendeland #include <net/caif/cfpkt.h> 1415c9ac0cSSjur Braendeland 1524e263adSSjur Braendeland #define PKT_PREFIX 48 162aa40aefSSjur Braendeland #define PKT_POSTFIX 2 1715c9ac0cSSjur Braendeland #define PKT_LEN_WHEN_EXTENDING 128 18b31fa5baSJoe Perches #define PKT_ERROR(pkt, errmsg) \ 19b31fa5baSJoe Perches do { \ 2015c9ac0cSSjur Braendeland cfpkt_priv(pkt)->erronous = true; \ 2115c9ac0cSSjur Braendeland skb_reset_tail_pointer(&pkt->skb); \ 22b31fa5baSJoe Perches pr_warn(errmsg); \ 2315c9ac0cSSjur Braendeland } while (0) 2415c9ac0cSSjur Braendeland 2515c9ac0cSSjur Braendeland struct cfpktq { 2615c9ac0cSSjur Braendeland struct sk_buff_head head; 2715c9ac0cSSjur Braendeland atomic_t count; 2815c9ac0cSSjur Braendeland /* Lock protects count updates */ 2915c9ac0cSSjur Braendeland spinlock_t lock; 3015c9ac0cSSjur Braendeland }; 3115c9ac0cSSjur Braendeland 3215c9ac0cSSjur Braendeland /* 3315c9ac0cSSjur Braendeland * net/caif/ is generic and does not 3415c9ac0cSSjur Braendeland * understand SKB, so we do this typecast 3515c9ac0cSSjur Braendeland */ 3615c9ac0cSSjur Braendeland struct cfpkt { 3715c9ac0cSSjur Braendeland struct sk_buff skb; 3815c9ac0cSSjur Braendeland }; 3915c9ac0cSSjur Braendeland 4015c9ac0cSSjur Braendeland /* Private data inside SKB */ 4115c9ac0cSSjur Braendeland struct cfpkt_priv_data { 4215c9ac0cSSjur Braendeland struct dev_info dev_info; 4315c9ac0cSSjur Braendeland bool erronous; 4415c9ac0cSSjur Braendeland }; 4515c9ac0cSSjur Braendeland 4673d6ac63SStephen Hemminger static inline struct cfpkt_priv_data *cfpkt_priv(struct cfpkt *pkt) 4715c9ac0cSSjur Braendeland { 4815c9ac0cSSjur Braendeland return (struct cfpkt_priv_data *) pkt->skb.cb; 4915c9ac0cSSjur Braendeland } 5015c9ac0cSSjur Braendeland 5173d6ac63SStephen Hemminger static inline bool is_erronous(struct cfpkt *pkt) 5215c9ac0cSSjur Braendeland { 5315c9ac0cSSjur Braendeland return cfpkt_priv(pkt)->erronous; 5415c9ac0cSSjur Braendeland } 5515c9ac0cSSjur Braendeland 5673d6ac63SStephen Hemminger static inline struct sk_buff *pkt_to_skb(struct cfpkt *pkt) 5715c9ac0cSSjur Braendeland { 5815c9ac0cSSjur Braendeland return &pkt->skb; 5915c9ac0cSSjur Braendeland } 6015c9ac0cSSjur Braendeland 6173d6ac63SStephen Hemminger static inline struct cfpkt *skb_to_pkt(struct sk_buff *skb) 6215c9ac0cSSjur Braendeland { 6315c9ac0cSSjur Braendeland return (struct cfpkt *) skb; 6415c9ac0cSSjur Braendeland } 6515c9ac0cSSjur Braendeland 6615c9ac0cSSjur Braendeland struct cfpkt *cfpkt_fromnative(enum caif_direction dir, void *nativepkt) 6715c9ac0cSSjur Braendeland { 6815c9ac0cSSjur Braendeland struct cfpkt *pkt = skb_to_pkt(nativepkt); 6915c9ac0cSSjur Braendeland cfpkt_priv(pkt)->erronous = false; 7015c9ac0cSSjur Braendeland return pkt; 7115c9ac0cSSjur Braendeland } 7215c9ac0cSSjur Braendeland EXPORT_SYMBOL(cfpkt_fromnative); 7315c9ac0cSSjur Braendeland 7415c9ac0cSSjur Braendeland void *cfpkt_tonative(struct cfpkt *pkt) 7515c9ac0cSSjur Braendeland { 7615c9ac0cSSjur Braendeland return (void *) pkt; 7715c9ac0cSSjur Braendeland } 7815c9ac0cSSjur Braendeland EXPORT_SYMBOL(cfpkt_tonative); 7915c9ac0cSSjur Braendeland 8015c9ac0cSSjur Braendeland static struct cfpkt *cfpkt_create_pfx(u16 len, u16 pfx) 8115c9ac0cSSjur Braendeland { 8215c9ac0cSSjur Braendeland struct sk_buff *skb; 8315c9ac0cSSjur Braendeland 8415c9ac0cSSjur Braendeland if (likely(in_interrupt())) 8515c9ac0cSSjur Braendeland skb = alloc_skb(len + pfx, GFP_ATOMIC); 8615c9ac0cSSjur Braendeland else 8715c9ac0cSSjur Braendeland skb = alloc_skb(len + pfx, GFP_KERNEL); 8815c9ac0cSSjur Braendeland 8915c9ac0cSSjur Braendeland if (unlikely(skb == NULL)) 9015c9ac0cSSjur Braendeland return NULL; 9115c9ac0cSSjur Braendeland 9215c9ac0cSSjur Braendeland skb_reserve(skb, pfx); 9315c9ac0cSSjur Braendeland return skb_to_pkt(skb); 9415c9ac0cSSjur Braendeland } 9515c9ac0cSSjur Braendeland 9615c9ac0cSSjur Braendeland inline struct cfpkt *cfpkt_create(u16 len) 9715c9ac0cSSjur Braendeland { 9815c9ac0cSSjur Braendeland return cfpkt_create_pfx(len + PKT_POSTFIX, PKT_PREFIX); 9915c9ac0cSSjur Braendeland } 10015c9ac0cSSjur Braendeland 10115c9ac0cSSjur Braendeland void cfpkt_destroy(struct cfpkt *pkt) 10215c9ac0cSSjur Braendeland { 10315c9ac0cSSjur Braendeland struct sk_buff *skb = pkt_to_skb(pkt); 10415c9ac0cSSjur Braendeland kfree_skb(skb); 10515c9ac0cSSjur Braendeland } 1063f874adcSsjur.brandeland@stericsson.com 10715c9ac0cSSjur Braendeland inline bool cfpkt_more(struct cfpkt *pkt) 10815c9ac0cSSjur Braendeland { 10915c9ac0cSSjur Braendeland struct sk_buff *skb = pkt_to_skb(pkt); 11015c9ac0cSSjur Braendeland return skb->len > 0; 11115c9ac0cSSjur Braendeland } 1123f874adcSsjur.brandeland@stericsson.com 11315c9ac0cSSjur Braendeland int cfpkt_peek_head(struct cfpkt *pkt, void *data, u16 len) 11415c9ac0cSSjur Braendeland { 11515c9ac0cSSjur Braendeland struct sk_buff *skb = pkt_to_skb(pkt); 11615c9ac0cSSjur Braendeland if (skb_headlen(skb) >= len) { 11715c9ac0cSSjur Braendeland memcpy(data, skb->data, len); 11815c9ac0cSSjur Braendeland return 0; 11915c9ac0cSSjur Braendeland } 12015c9ac0cSSjur Braendeland return !cfpkt_extr_head(pkt, data, len) && 12115c9ac0cSSjur Braendeland !cfpkt_add_head(pkt, data, len); 12215c9ac0cSSjur Braendeland } 12315c9ac0cSSjur Braendeland 12415c9ac0cSSjur Braendeland int cfpkt_extr_head(struct cfpkt *pkt, void *data, u16 len) 12515c9ac0cSSjur Braendeland { 12615c9ac0cSSjur Braendeland struct sk_buff *skb = pkt_to_skb(pkt); 12715c9ac0cSSjur Braendeland u8 *from; 12815c9ac0cSSjur Braendeland if (unlikely(is_erronous(pkt))) 12915c9ac0cSSjur Braendeland return -EPROTO; 13015c9ac0cSSjur Braendeland 13115c9ac0cSSjur Braendeland if (unlikely(len > skb->len)) { 132b31fa5baSJoe Perches PKT_ERROR(pkt, "read beyond end of packet\n"); 13315c9ac0cSSjur Braendeland return -EPROTO; 13415c9ac0cSSjur Braendeland } 13515c9ac0cSSjur Braendeland 13615c9ac0cSSjur Braendeland if (unlikely(len > skb_headlen(skb))) { 13715c9ac0cSSjur Braendeland if (unlikely(skb_linearize(skb) != 0)) { 138b31fa5baSJoe Perches PKT_ERROR(pkt, "linearize failed\n"); 13915c9ac0cSSjur Braendeland return -EPROTO; 14015c9ac0cSSjur Braendeland } 14115c9ac0cSSjur Braendeland } 14215c9ac0cSSjur Braendeland from = skb_pull(skb, len); 14315c9ac0cSSjur Braendeland from -= len; 144200c5a3bSsjur.brandeland@stericsson.com if (data) 14515c9ac0cSSjur Braendeland memcpy(data, from, len); 14615c9ac0cSSjur Braendeland return 0; 14715c9ac0cSSjur Braendeland } 1487ad65bf6Ssjur.brandeland@stericsson.com EXPORT_SYMBOL(cfpkt_extr_head); 14915c9ac0cSSjur Braendeland 15015c9ac0cSSjur Braendeland int cfpkt_extr_trail(struct cfpkt *pkt, void *dta, u16 len) 15115c9ac0cSSjur Braendeland { 15215c9ac0cSSjur Braendeland struct sk_buff *skb = pkt_to_skb(pkt); 15315c9ac0cSSjur Braendeland u8 *data = dta; 15415c9ac0cSSjur Braendeland u8 *from; 15515c9ac0cSSjur Braendeland if (unlikely(is_erronous(pkt))) 15615c9ac0cSSjur Braendeland return -EPROTO; 15715c9ac0cSSjur Braendeland 15815c9ac0cSSjur Braendeland if (unlikely(skb_linearize(skb) != 0)) { 159b31fa5baSJoe Perches PKT_ERROR(pkt, "linearize failed\n"); 16015c9ac0cSSjur Braendeland return -EPROTO; 16115c9ac0cSSjur Braendeland } 16215c9ac0cSSjur Braendeland if (unlikely(skb->data + len > skb_tail_pointer(skb))) { 163b31fa5baSJoe Perches PKT_ERROR(pkt, "read beyond end of packet\n"); 16415c9ac0cSSjur Braendeland return -EPROTO; 16515c9ac0cSSjur Braendeland } 16615c9ac0cSSjur Braendeland from = skb_tail_pointer(skb) - len; 16715c9ac0cSSjur Braendeland skb_trim(skb, skb->len - len); 16815c9ac0cSSjur Braendeland memcpy(data, from, len); 16915c9ac0cSSjur Braendeland return 0; 17015c9ac0cSSjur Braendeland } 1713f874adcSsjur.brandeland@stericsson.com 17215c9ac0cSSjur Braendeland int cfpkt_pad_trail(struct cfpkt *pkt, u16 len) 17315c9ac0cSSjur Braendeland { 17415c9ac0cSSjur Braendeland return cfpkt_add_body(pkt, NULL, len); 17515c9ac0cSSjur Braendeland } 1763f874adcSsjur.brandeland@stericsson.com 17715c9ac0cSSjur Braendeland int cfpkt_add_body(struct cfpkt *pkt, const void *data, u16 len) 17815c9ac0cSSjur Braendeland { 17915c9ac0cSSjur Braendeland struct sk_buff *skb = pkt_to_skb(pkt); 18015c9ac0cSSjur Braendeland struct sk_buff *lastskb; 18115c9ac0cSSjur Braendeland u8 *to; 18215c9ac0cSSjur Braendeland u16 addlen = 0; 18315c9ac0cSSjur Braendeland 18415c9ac0cSSjur Braendeland 18515c9ac0cSSjur Braendeland if (unlikely(is_erronous(pkt))) 18615c9ac0cSSjur Braendeland return -EPROTO; 18715c9ac0cSSjur Braendeland 18815c9ac0cSSjur Braendeland lastskb = skb; 18915c9ac0cSSjur Braendeland 19015c9ac0cSSjur Braendeland /* Check whether we need to add space at the tail */ 19115c9ac0cSSjur Braendeland if (unlikely(skb_tailroom(skb) < len)) { 19215c9ac0cSSjur Braendeland if (likely(len < PKT_LEN_WHEN_EXTENDING)) 19315c9ac0cSSjur Braendeland addlen = PKT_LEN_WHEN_EXTENDING; 19415c9ac0cSSjur Braendeland else 19515c9ac0cSSjur Braendeland addlen = len; 19615c9ac0cSSjur Braendeland } 19715c9ac0cSSjur Braendeland 19815c9ac0cSSjur Braendeland /* Check whether we need to change the SKB before writing to the tail */ 19915c9ac0cSSjur Braendeland if (unlikely((addlen > 0) || skb_cloned(skb) || skb_shared(skb))) { 20015c9ac0cSSjur Braendeland 20115c9ac0cSSjur Braendeland /* Make sure data is writable */ 20215c9ac0cSSjur Braendeland if (unlikely(skb_cow_data(skb, addlen, &lastskb) < 0)) { 203b31fa5baSJoe Perches PKT_ERROR(pkt, "cow failed\n"); 20415c9ac0cSSjur Braendeland return -EPROTO; 20515c9ac0cSSjur Braendeland } 20615c9ac0cSSjur Braendeland } 20715c9ac0cSSjur Braendeland 20815c9ac0cSSjur Braendeland /* All set to put the last SKB and optionally write data there. */ 209253c6daaSMathias Krause to = pskb_put(skb, lastskb, len); 21015c9ac0cSSjur Braendeland if (likely(data)) 21115c9ac0cSSjur Braendeland memcpy(to, data, len); 21215c9ac0cSSjur Braendeland return 0; 21315c9ac0cSSjur Braendeland } 21415c9ac0cSSjur Braendeland 21515c9ac0cSSjur Braendeland inline int cfpkt_addbdy(struct cfpkt *pkt, u8 data) 21615c9ac0cSSjur Braendeland { 21715c9ac0cSSjur Braendeland return cfpkt_add_body(pkt, &data, 1); 21815c9ac0cSSjur Braendeland } 21915c9ac0cSSjur Braendeland 22015c9ac0cSSjur Braendeland int cfpkt_add_head(struct cfpkt *pkt, const void *data2, u16 len) 22115c9ac0cSSjur Braendeland { 22215c9ac0cSSjur Braendeland struct sk_buff *skb = pkt_to_skb(pkt); 22315c9ac0cSSjur Braendeland struct sk_buff *lastskb; 22415c9ac0cSSjur Braendeland u8 *to; 22515c9ac0cSSjur Braendeland const u8 *data = data2; 226638e628aSSjur Braendeland int ret; 22715c9ac0cSSjur Braendeland if (unlikely(is_erronous(pkt))) 22815c9ac0cSSjur Braendeland return -EPROTO; 22915c9ac0cSSjur Braendeland if (unlikely(skb_headroom(skb) < len)) { 230b31fa5baSJoe Perches PKT_ERROR(pkt, "no headroom\n"); 23115c9ac0cSSjur Braendeland return -EPROTO; 23215c9ac0cSSjur Braendeland } 23315c9ac0cSSjur Braendeland 23415c9ac0cSSjur Braendeland /* Make sure data is writable */ 235638e628aSSjur Braendeland ret = skb_cow_data(skb, 0, &lastskb); 236638e628aSSjur Braendeland if (unlikely(ret < 0)) { 237b31fa5baSJoe Perches PKT_ERROR(pkt, "cow failed\n"); 238638e628aSSjur Braendeland return ret; 23915c9ac0cSSjur Braendeland } 24015c9ac0cSSjur Braendeland 24115c9ac0cSSjur Braendeland to = skb_push(skb, len); 24215c9ac0cSSjur Braendeland memcpy(to, data, len); 24315c9ac0cSSjur Braendeland return 0; 24415c9ac0cSSjur Braendeland } 2457ad65bf6Ssjur.brandeland@stericsson.com EXPORT_SYMBOL(cfpkt_add_head); 24615c9ac0cSSjur Braendeland 24715c9ac0cSSjur Braendeland inline int cfpkt_add_trail(struct cfpkt *pkt, const void *data, u16 len) 24815c9ac0cSSjur Braendeland { 24915c9ac0cSSjur Braendeland return cfpkt_add_body(pkt, data, len); 25015c9ac0cSSjur Braendeland } 2513f874adcSsjur.brandeland@stericsson.com 25215c9ac0cSSjur Braendeland inline u16 cfpkt_getlen(struct cfpkt *pkt) 25315c9ac0cSSjur Braendeland { 25415c9ac0cSSjur Braendeland struct sk_buff *skb = pkt_to_skb(pkt); 25515c9ac0cSSjur Braendeland return skb->len; 25615c9ac0cSSjur Braendeland } 2573f874adcSsjur.brandeland@stericsson.com 25815c9ac0cSSjur Braendeland inline u16 cfpkt_iterate(struct cfpkt *pkt, 25915c9ac0cSSjur Braendeland u16 (*iter_func)(u16, void *, u16), 26015c9ac0cSSjur Braendeland u16 data) 26115c9ac0cSSjur Braendeland { 26215c9ac0cSSjur Braendeland /* 26315c9ac0cSSjur Braendeland * Don't care about the performance hit of linearizing, 26415c9ac0cSSjur Braendeland * Checksum should not be used on high-speed interfaces anyway. 26515c9ac0cSSjur Braendeland */ 26615c9ac0cSSjur Braendeland if (unlikely(is_erronous(pkt))) 26715c9ac0cSSjur Braendeland return -EPROTO; 26815c9ac0cSSjur Braendeland if (unlikely(skb_linearize(&pkt->skb) != 0)) { 269b31fa5baSJoe Perches PKT_ERROR(pkt, "linearize failed\n"); 27015c9ac0cSSjur Braendeland return -EPROTO; 27115c9ac0cSSjur Braendeland } 27215c9ac0cSSjur Braendeland return iter_func(data, pkt->skb.data, cfpkt_getlen(pkt)); 27315c9ac0cSSjur Braendeland } 2743f874adcSsjur.brandeland@stericsson.com 27515c9ac0cSSjur Braendeland int cfpkt_setlen(struct cfpkt *pkt, u16 len) 27615c9ac0cSSjur Braendeland { 27715c9ac0cSSjur Braendeland struct sk_buff *skb = pkt_to_skb(pkt); 27815c9ac0cSSjur Braendeland 27915c9ac0cSSjur Braendeland 28015c9ac0cSSjur Braendeland if (unlikely(is_erronous(pkt))) 28115c9ac0cSSjur Braendeland return -EPROTO; 28215c9ac0cSSjur Braendeland 28315c9ac0cSSjur Braendeland if (likely(len <= skb->len)) { 28415c9ac0cSSjur Braendeland if (unlikely(skb->data_len)) 28515c9ac0cSSjur Braendeland ___pskb_trim(skb, len); 28615c9ac0cSSjur Braendeland else 28715c9ac0cSSjur Braendeland skb_trim(skb, len); 28815c9ac0cSSjur Braendeland 28915c9ac0cSSjur Braendeland return cfpkt_getlen(pkt); 29015c9ac0cSSjur Braendeland } 29115c9ac0cSSjur Braendeland 29215c9ac0cSSjur Braendeland /* Need to expand SKB */ 29315c9ac0cSSjur Braendeland if (unlikely(!cfpkt_pad_trail(pkt, len - skb->len))) 294b31fa5baSJoe Perches PKT_ERROR(pkt, "skb_pad_trail failed\n"); 29515c9ac0cSSjur Braendeland 29615c9ac0cSSjur Braendeland return cfpkt_getlen(pkt); 29715c9ac0cSSjur Braendeland } 29815c9ac0cSSjur Braendeland 29915c9ac0cSSjur Braendeland struct cfpkt *cfpkt_append(struct cfpkt *dstpkt, 30015c9ac0cSSjur Braendeland struct cfpkt *addpkt, 30115c9ac0cSSjur Braendeland u16 expectlen) 30215c9ac0cSSjur Braendeland { 30315c9ac0cSSjur Braendeland struct sk_buff *dst = pkt_to_skb(dstpkt); 30415c9ac0cSSjur Braendeland struct sk_buff *add = pkt_to_skb(addpkt); 30515c9ac0cSSjur Braendeland u16 addlen = skb_headlen(add); 30615c9ac0cSSjur Braendeland u16 neededtailspace; 30715c9ac0cSSjur Braendeland struct sk_buff *tmp; 30815c9ac0cSSjur Braendeland u16 dstlen; 30915c9ac0cSSjur Braendeland u16 createlen; 31015c9ac0cSSjur Braendeland if (unlikely(is_erronous(dstpkt) || is_erronous(addpkt))) { 31115c9ac0cSSjur Braendeland return dstpkt; 31215c9ac0cSSjur Braendeland } 31315c9ac0cSSjur Braendeland if (expectlen > addlen) 31415c9ac0cSSjur Braendeland neededtailspace = expectlen; 31515c9ac0cSSjur Braendeland else 31615c9ac0cSSjur Braendeland neededtailspace = addlen; 31715c9ac0cSSjur Braendeland 31815c9ac0cSSjur Braendeland if (dst->tail + neededtailspace > dst->end) { 31915c9ac0cSSjur Braendeland /* Create a dumplicate of 'dst' with more tail space */ 320638e628aSSjur Braendeland struct cfpkt *tmppkt; 32115c9ac0cSSjur Braendeland dstlen = skb_headlen(dst); 32215c9ac0cSSjur Braendeland createlen = dstlen + neededtailspace; 323638e628aSSjur Braendeland tmppkt = cfpkt_create(createlen + PKT_PREFIX + PKT_POSTFIX); 324638e628aSSjur Braendeland if (tmppkt == NULL) 32515c9ac0cSSjur Braendeland return NULL; 326638e628aSSjur Braendeland tmp = pkt_to_skb(tmppkt); 32715c9ac0cSSjur Braendeland skb_set_tail_pointer(tmp, dstlen); 32815c9ac0cSSjur Braendeland tmp->len = dstlen; 32915c9ac0cSSjur Braendeland memcpy(tmp->data, dst->data, dstlen); 33015c9ac0cSSjur Braendeland cfpkt_destroy(dstpkt); 33115c9ac0cSSjur Braendeland dst = tmp; 33215c9ac0cSSjur Braendeland } 33315c9ac0cSSjur Braendeland memcpy(skb_tail_pointer(dst), add->data, skb_headlen(add)); 33415c9ac0cSSjur Braendeland cfpkt_destroy(addpkt); 33515c9ac0cSSjur Braendeland dst->tail += addlen; 33615c9ac0cSSjur Braendeland dst->len += addlen; 33715c9ac0cSSjur Braendeland return skb_to_pkt(dst); 33815c9ac0cSSjur Braendeland } 33915c9ac0cSSjur Braendeland 34015c9ac0cSSjur Braendeland struct cfpkt *cfpkt_split(struct cfpkt *pkt, u16 pos) 34115c9ac0cSSjur Braendeland { 34215c9ac0cSSjur Braendeland struct sk_buff *skb2; 34315c9ac0cSSjur Braendeland struct sk_buff *skb = pkt_to_skb(pkt); 344638e628aSSjur Braendeland struct cfpkt *tmppkt; 34515c9ac0cSSjur Braendeland u8 *split = skb->data + pos; 34615c9ac0cSSjur Braendeland u16 len2nd = skb_tail_pointer(skb) - split; 34715c9ac0cSSjur Braendeland 34815c9ac0cSSjur Braendeland if (unlikely(is_erronous(pkt))) 34915c9ac0cSSjur Braendeland return NULL; 35015c9ac0cSSjur Braendeland 35115c9ac0cSSjur Braendeland if (skb->data + pos > skb_tail_pointer(skb)) { 352b31fa5baSJoe Perches PKT_ERROR(pkt, "trying to split beyond end of packet\n"); 35315c9ac0cSSjur Braendeland return NULL; 35415c9ac0cSSjur Braendeland } 35515c9ac0cSSjur Braendeland 35615c9ac0cSSjur Braendeland /* Create a new packet for the second part of the data */ 357638e628aSSjur Braendeland tmppkt = cfpkt_create_pfx(len2nd + PKT_PREFIX + PKT_POSTFIX, 358638e628aSSjur Braendeland PKT_PREFIX); 359638e628aSSjur Braendeland if (tmppkt == NULL) 360638e628aSSjur Braendeland return NULL; 361638e628aSSjur Braendeland skb2 = pkt_to_skb(tmppkt); 362638e628aSSjur Braendeland 36315c9ac0cSSjur Braendeland 36415c9ac0cSSjur Braendeland if (skb2 == NULL) 36515c9ac0cSSjur Braendeland return NULL; 36615c9ac0cSSjur Braendeland 36715c9ac0cSSjur Braendeland /* Reduce the length of the original packet */ 36815c9ac0cSSjur Braendeland skb_set_tail_pointer(skb, pos); 36915c9ac0cSSjur Braendeland skb->len = pos; 37015c9ac0cSSjur Braendeland 37115c9ac0cSSjur Braendeland memcpy(skb2->data, split, len2nd); 37215c9ac0cSSjur Braendeland skb2->tail += len2nd; 37315c9ac0cSSjur Braendeland skb2->len += len2nd; 37444764812SDmitry Tarnyagin skb2->priority = skb->priority; 37515c9ac0cSSjur Braendeland return skb_to_pkt(skb2); 37615c9ac0cSSjur Braendeland } 37715c9ac0cSSjur Braendeland 37873d6ac63SStephen Hemminger bool cfpkt_erroneous(struct cfpkt *pkt) 37915c9ac0cSSjur Braendeland { 38015c9ac0cSSjur Braendeland return cfpkt_priv(pkt)->erronous; 38115c9ac0cSSjur Braendeland } 38215c9ac0cSSjur Braendeland 38315c9ac0cSSjur Braendeland struct caif_payload_info *cfpkt_info(struct cfpkt *pkt) 38415c9ac0cSSjur Braendeland { 38515c9ac0cSSjur Braendeland return (struct caif_payload_info *)&pkt_to_skb(pkt)->cb; 38615c9ac0cSSjur Braendeland } 3877ad65bf6Ssjur.brandeland@stericsson.com EXPORT_SYMBOL(cfpkt_info); 38844764812SDmitry Tarnyagin 38944764812SDmitry Tarnyagin void cfpkt_set_prio(struct cfpkt *pkt, int prio) 39044764812SDmitry Tarnyagin { 39144764812SDmitry Tarnyagin pkt_to_skb(pkt)->priority = prio; 39244764812SDmitry Tarnyagin } 39344764812SDmitry Tarnyagin EXPORT_SYMBOL(cfpkt_set_prio); 394