1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44#include <linux/types.h>
45#include <linux/skbuff.h>
46#include <net/sock.h>
47#include <net/sctp/structs.h>
48#include <net/sctp/sctp.h>
49#include <net/sctp/sm.h>
50
51
52static struct sctp_ulpevent * sctp_ulpq_reasm(struct sctp_ulpq *ulpq,
53 struct sctp_ulpevent *);
54static struct sctp_ulpevent * sctp_ulpq_order(struct sctp_ulpq *,
55 struct sctp_ulpevent *);
56static void sctp_ulpq_reasm_drain(struct sctp_ulpq *ulpq);
57
58
59
60
61struct sctp_ulpq *sctp_ulpq_init(struct sctp_ulpq *ulpq,
62 struct sctp_association *asoc)
63{
64 memset(ulpq, 0, sizeof(struct sctp_ulpq));
65
66 ulpq->asoc = asoc;
67 skb_queue_head_init(&ulpq->reasm);
68 skb_queue_head_init(&ulpq->lobby);
69 ulpq->pd_mode = 0;
70 ulpq->malloced = 0;
71
72 return ulpq;
73}
74
75
76
77void sctp_ulpq_flush(struct sctp_ulpq *ulpq)
78{
79 struct sk_buff *skb;
80 struct sctp_ulpevent *event;
81
82 while ((skb = __skb_dequeue(&ulpq->lobby)) != NULL) {
83 event = sctp_skb2event(skb);
84 sctp_ulpevent_free(event);
85 }
86
87 while ((skb = __skb_dequeue(&ulpq->reasm)) != NULL) {
88 event = sctp_skb2event(skb);
89 sctp_ulpevent_free(event);
90 }
91
92}
93
94
95void sctp_ulpq_free(struct sctp_ulpq *ulpq)
96{
97 sctp_ulpq_flush(ulpq);
98 if (ulpq->malloced)
99 kfree(ulpq);
100}
101
102
103int sctp_ulpq_tail_data(struct sctp_ulpq *ulpq, struct sctp_chunk *chunk,
104 gfp_t gfp)
105{
106 struct sk_buff_head temp;
107 sctp_data_chunk_t *hdr;
108 struct sctp_ulpevent *event;
109
110 hdr = (sctp_data_chunk_t *) chunk->chunk_hdr;
111
112
113 event = sctp_ulpevent_make_rcvmsg(chunk->asoc, chunk, gfp);
114 if (!event)
115 return -ENOMEM;
116
117
118 event = sctp_ulpq_reasm(ulpq, event);
119
120
121 if ((event) && (event->msg_flags & MSG_EOR)){
122
123 skb_queue_head_init(&temp);
124 __skb_queue_tail(&temp, sctp_event2skb(event));
125
126 event = sctp_ulpq_order(ulpq, event);
127 }
128
129
130
131
132 if (event)
133 sctp_ulpq_tail_event(ulpq, event);
134
135 return 0;
136}
137
138
139
140
141
142int sctp_clear_pd(struct sock *sk, struct sctp_association *asoc)
143{
144 struct sctp_sock *sp = sctp_sk(sk);
145
146 if (atomic_dec_and_test(&sp->pd_mode)) {
147
148
149
150 if (!skb_queue_empty(&sp->pd_lobby)) {
151 struct list_head *list;
152 sctp_skb_list_tail(&sp->pd_lobby, &sk->sk_receive_queue);
153 list = (struct list_head *)&sctp_sk(sk)->pd_lobby;
154 INIT_LIST_HEAD(list);
155 return 1;
156 }
157 } else {
158
159
160
161
162
163 if (!skb_queue_empty(&sp->pd_lobby) && asoc) {
164 struct sk_buff *skb, *tmp;
165 struct sctp_ulpevent *event;
166
167 sctp_skb_for_each(skb, &sp->pd_lobby, tmp) {
168 event = sctp_skb2event(skb);
169 if (event->asoc == asoc) {
170 __skb_unlink(skb, &sp->pd_lobby);
171 __skb_queue_tail(&sk->sk_receive_queue,
172 skb);
173 }
174 }
175 }
176 }
177
178 return 0;
179}
180
181
182static void sctp_ulpq_set_pd(struct sctp_ulpq *ulpq)
183{
184 struct sctp_sock *sp = sctp_sk(ulpq->asoc->base.sk);
185
186 atomic_inc(&sp->pd_mode);
187 ulpq->pd_mode = 1;
188}
189
190
191static int sctp_ulpq_clear_pd(struct sctp_ulpq *ulpq)
192{
193 ulpq->pd_mode = 0;
194 sctp_ulpq_reasm_drain(ulpq);
195 return sctp_clear_pd(ulpq->asoc->base.sk, ulpq->asoc);
196}
197
198
199
200
201int sctp_ulpq_tail_event(struct sctp_ulpq *ulpq, struct sctp_ulpevent *event)
202{
203 struct sock *sk = ulpq->asoc->base.sk;
204 struct sk_buff_head *queue, *skb_list;
205 struct sk_buff *skb = sctp_event2skb(event);
206 int clear_pd = 0;
207
208 skb_list = (struct sk_buff_head *) skb->prev;
209
210
211
212
213 if (sock_flag(sk, SOCK_DEAD) || (sk->sk_shutdown & RCV_SHUTDOWN))
214 goto out_free;
215
216
217 if (!sctp_ulpevent_is_enabled(event, &sctp_sk(sk)->subscribe))
218 goto out_free;
219
220
221
222
223
224
225 if (atomic_read(&sctp_sk(sk)->pd_mode) == 0) {
226 queue = &sk->sk_receive_queue;
227 } else {
228 if (ulpq->pd_mode) {
229
230
231
232
233
234 if ((event->msg_flags & MSG_NOTIFICATION) ||
235 (SCTP_DATA_NOT_FRAG ==
236 (event->msg_flags & SCTP_DATA_FRAG_MASK)))
237 queue = &sctp_sk(sk)->pd_lobby;
238 else {
239 clear_pd = event->msg_flags & MSG_EOR;
240 queue = &sk->sk_receive_queue;
241 }
242 } else {
243
244
245
246
247
248 if (sctp_sk(sk)->frag_interleave)
249 queue = &sk->sk_receive_queue;
250 else
251 queue = &sctp_sk(sk)->pd_lobby;
252 }
253 }
254
255
256
257
258 if (skb_list)
259 sctp_skb_list_tail(skb_list, queue);
260 else
261 __skb_queue_tail(queue, skb);
262
263
264
265
266
267 if (clear_pd)
268 sctp_ulpq_clear_pd(ulpq);
269
270 if (queue == &sk->sk_receive_queue)
271 sk->sk_data_ready(sk, 0);
272 return 1;
273
274out_free:
275 if (skb_list)
276 sctp_queue_purge_ulpevents(skb_list);
277 else
278 sctp_ulpevent_free(event);
279
280 return 0;
281}
282
283
284
285
286static void sctp_ulpq_store_reasm(struct sctp_ulpq *ulpq,
287 struct sctp_ulpevent *event)
288{
289 struct sk_buff *pos;
290 struct sctp_ulpevent *cevent;
291 __u32 tsn, ctsn;
292
293 tsn = event->tsn;
294
295
296 pos = skb_peek_tail(&ulpq->reasm);
297 if (!pos) {
298 __skb_queue_tail(&ulpq->reasm, sctp_event2skb(event));
299 return;
300 }
301
302
303 cevent = sctp_skb2event(pos);
304 ctsn = cevent->tsn;
305 if (TSN_lt(ctsn, tsn)) {
306 __skb_queue_tail(&ulpq->reasm, sctp_event2skb(event));
307 return;
308 }
309
310
311 skb_queue_walk(&ulpq->reasm, pos) {
312 cevent = sctp_skb2event(pos);
313 ctsn = cevent->tsn;
314
315 if (TSN_lt(tsn, ctsn))
316 break;
317 }
318
319
320 __skb_queue_before(&ulpq->reasm, pos, sctp_event2skb(event));
321
322}
323
324
325
326
327
328
329
330
331static struct sctp_ulpevent *sctp_make_reassembled_event(struct sk_buff_head *queue, struct sk_buff *f_frag, struct sk_buff *l_frag)
332{
333 struct sk_buff *pos;
334 struct sk_buff *new = NULL;
335 struct sctp_ulpevent *event;
336 struct sk_buff *pnext, *last;
337 struct sk_buff *list = skb_shinfo(f_frag)->frag_list;
338
339
340 if (f_frag == l_frag)
341 pos = NULL;
342 else
343 pos = f_frag->next;
344
345
346 for (last = list; list; last = list, list = list->next);
347
348
349
350
351 if (last)
352 last->next = pos;
353 else {
354 if (skb_cloned(f_frag)) {
355
356
357
358
359
360 new = skb_copy(f_frag, GFP_ATOMIC);
361 if (!new)
362 return NULL;
363
364 sctp_skb_set_owner_r(new, f_frag->sk);
365
366 skb_shinfo(new)->frag_list = pos;
367 } else
368 skb_shinfo(f_frag)->frag_list = pos;
369 }
370
371
372 __skb_unlink(f_frag, queue);
373
374
375 if (new) {
376 kfree_skb(f_frag);
377 f_frag = new;
378 }
379
380 while (pos) {
381
382 pnext = pos->next;
383
384
385 f_frag->len += pos->len;
386 f_frag->data_len += pos->len;
387
388
389 __skb_unlink(pos, queue);
390
391
392 if (pos == l_frag)
393 break;
394 pos->next = pnext;
395 pos = pnext;
396 }
397
398 event = sctp_skb2event(f_frag);
399 SCTP_INC_STATS(SCTP_MIB_REASMUSRMSGS);
400
401 return event;
402}
403
404
405
406
407
408static struct sctp_ulpevent *sctp_ulpq_retrieve_reassembled(struct sctp_ulpq *ulpq)
409{
410 struct sk_buff *pos;
411 struct sctp_ulpevent *cevent;
412 struct sk_buff *first_frag = NULL;
413 __u32 ctsn, next_tsn;
414 struct sctp_ulpevent *retval = NULL;
415 struct sk_buff *pd_first = NULL;
416 struct sk_buff *pd_last = NULL;
417 size_t pd_len = 0;
418 struct sctp_association *asoc;
419 u32 pd_point;
420
421
422
423
424
425 next_tsn = 0;
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440 skb_queue_walk(&ulpq->reasm, pos) {
441 cevent = sctp_skb2event(pos);
442 ctsn = cevent->tsn;
443
444 switch (cevent->msg_flags & SCTP_DATA_FRAG_MASK) {
445 case SCTP_DATA_FIRST_FRAG:
446
447
448
449
450 if (pos == ulpq->reasm.next) {
451 pd_first = pos;
452 pd_last = pos;
453 pd_len = pos->len;
454 } else {
455 pd_first = NULL;
456 pd_last = NULL;
457 pd_len = 0;
458 }
459
460 first_frag = pos;
461 next_tsn = ctsn + 1;
462 break;
463
464 case SCTP_DATA_MIDDLE_FRAG:
465 if ((first_frag) && (ctsn == next_tsn)) {
466 next_tsn++;
467 if (pd_first) {
468 pd_last = pos;
469 pd_len += pos->len;
470 }
471 } else
472 first_frag = NULL;
473 break;
474
475 case SCTP_DATA_LAST_FRAG:
476 if (first_frag && (ctsn == next_tsn))
477 goto found;
478 else
479 first_frag = NULL;
480 break;
481 }
482 }
483
484 asoc = ulpq->asoc;
485 if (pd_first) {
486
487
488
489
490
491 if (!sctp_sk(asoc->base.sk)->frag_interleave &&
492 atomic_read(&sctp_sk(asoc->base.sk)->pd_mode))
493 goto done;
494
495 cevent = sctp_skb2event(pd_first);
496 pd_point = sctp_sk(asoc->base.sk)->pd_point;
497 if (pd_point && pd_point <= pd_len) {
498 retval = sctp_make_reassembled_event(&ulpq->reasm,
499 pd_first,
500 pd_last);
501 if (retval)
502 sctp_ulpq_set_pd(ulpq);
503 }
504 }
505done:
506 return retval;
507found:
508 retval = sctp_make_reassembled_event(&ulpq->reasm, first_frag, pos);
509 if (retval)
510 retval->msg_flags |= MSG_EOR;
511 goto done;
512}
513
514
515static struct sctp_ulpevent *sctp_ulpq_retrieve_partial(struct sctp_ulpq *ulpq)
516{
517 struct sk_buff *pos, *last_frag, *first_frag;
518 struct sctp_ulpevent *cevent;
519 __u32 ctsn, next_tsn;
520 int is_last;
521 struct sctp_ulpevent *retval;
522
523
524
525
526
527
528 if (skb_queue_empty(&ulpq->reasm))
529 return NULL;
530
531 last_frag = first_frag = NULL;
532 retval = NULL;
533 next_tsn = 0;
534 is_last = 0;
535
536 skb_queue_walk(&ulpq->reasm, pos) {
537 cevent = sctp_skb2event(pos);
538 ctsn = cevent->tsn;
539
540 switch (cevent->msg_flags & SCTP_DATA_FRAG_MASK) {
541 case SCTP_DATA_MIDDLE_FRAG:
542 if (!first_frag) {
543 first_frag = pos;
544 next_tsn = ctsn + 1;
545 last_frag = pos;
546 } else if (next_tsn == ctsn)
547 next_tsn++;
548 else
549 goto done;
550 break;
551 case SCTP_DATA_LAST_FRAG:
552 if (!first_frag)
553 first_frag = pos;
554 else if (ctsn != next_tsn)
555 goto done;
556 last_frag = pos;
557 is_last = 1;
558 goto done;
559 default:
560 return NULL;
561 }
562 }
563
564
565
566
567done:
568 retval = sctp_make_reassembled_event(&ulpq->reasm, first_frag, last_frag);
569 if (retval && is_last)
570 retval->msg_flags |= MSG_EOR;
571
572 return retval;
573}
574
575
576
577
578
579static struct sctp_ulpevent *sctp_ulpq_reasm(struct sctp_ulpq *ulpq,
580 struct sctp_ulpevent *event)
581{
582 struct sctp_ulpevent *retval = NULL;
583
584
585 if (SCTP_DATA_NOT_FRAG == (event->msg_flags & SCTP_DATA_FRAG_MASK)) {
586 event->msg_flags |= MSG_EOR;
587 return event;
588 }
589
590 sctp_ulpq_store_reasm(ulpq, event);
591 if (!ulpq->pd_mode)
592 retval = sctp_ulpq_retrieve_reassembled(ulpq);
593 else {
594 __u32 ctsn, ctsnap;
595
596
597
598
599 ctsn = event->tsn;
600 ctsnap = sctp_tsnmap_get_ctsn(&ulpq->asoc->peer.tsn_map);
601 if (TSN_lte(ctsn, ctsnap))
602 retval = sctp_ulpq_retrieve_partial(ulpq);
603 }
604
605 return retval;
606}
607
608
609static struct sctp_ulpevent *sctp_ulpq_retrieve_first(struct sctp_ulpq *ulpq)
610{
611 struct sk_buff *pos, *last_frag, *first_frag;
612 struct sctp_ulpevent *cevent;
613 __u32 ctsn, next_tsn;
614 struct sctp_ulpevent *retval;
615
616
617
618
619
620
621 if (skb_queue_empty(&ulpq->reasm))
622 return NULL;
623
624 last_frag = first_frag = NULL;
625 retval = NULL;
626 next_tsn = 0;
627
628 skb_queue_walk(&ulpq->reasm, pos) {
629 cevent = sctp_skb2event(pos);
630 ctsn = cevent->tsn;
631
632 switch (cevent->msg_flags & SCTP_DATA_FRAG_MASK) {
633 case SCTP_DATA_FIRST_FRAG:
634 if (!first_frag) {
635 first_frag = pos;
636 next_tsn = ctsn + 1;
637 last_frag = pos;
638 } else
639 goto done;
640 break;
641
642 case SCTP_DATA_MIDDLE_FRAG:
643 if (!first_frag)
644 return NULL;
645 if (ctsn == next_tsn) {
646 next_tsn++;
647 last_frag = pos;
648 } else
649 goto done;
650 break;
651 default:
652 return NULL;
653 }
654 }
655
656
657
658
659done:
660 retval = sctp_make_reassembled_event(&ulpq->reasm, first_frag, last_frag);
661 return retval;
662}
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678void sctp_ulpq_reasm_flushtsn(struct sctp_ulpq *ulpq, __u32 fwd_tsn)
679{
680 struct sk_buff *pos, *tmp;
681 struct sctp_ulpevent *event;
682 __u32 tsn;
683
684 if (skb_queue_empty(&ulpq->reasm))
685 return;
686
687 skb_queue_walk_safe(&ulpq->reasm, pos, tmp) {
688 event = sctp_skb2event(pos);
689 tsn = event->tsn;
690
691
692
693
694
695
696 if (TSN_lte(tsn, fwd_tsn)) {
697 __skb_unlink(pos, &ulpq->reasm);
698 sctp_ulpevent_free(event);
699 } else
700 break;
701 }
702}
703
704
705
706
707
708
709static void sctp_ulpq_reasm_drain(struct sctp_ulpq *ulpq)
710{
711 struct sctp_ulpevent *event = NULL;
712 struct sk_buff_head temp;
713
714 if (skb_queue_empty(&ulpq->reasm))
715 return;
716
717 while ((event = sctp_ulpq_retrieve_reassembled(ulpq)) != NULL) {
718
719 if ((event) && (event->msg_flags & MSG_EOR)){
720 skb_queue_head_init(&temp);
721 __skb_queue_tail(&temp, sctp_event2skb(event));
722
723 event = sctp_ulpq_order(ulpq, event);
724 }
725
726
727
728
729 if (event)
730 sctp_ulpq_tail_event(ulpq, event);
731 }
732}
733
734
735
736
737
738static void sctp_ulpq_retrieve_ordered(struct sctp_ulpq *ulpq,
739 struct sctp_ulpevent *event)
740{
741 struct sk_buff_head *event_list;
742 struct sk_buff *pos, *tmp;
743 struct sctp_ulpevent *cevent;
744 struct sctp_stream *in;
745 __u16 sid, csid;
746 __u16 ssn, cssn;
747
748 sid = event->stream;
749 ssn = event->ssn;
750 in = &ulpq->asoc->ssnmap->in;
751
752 event_list = (struct sk_buff_head *) sctp_event2skb(event)->prev;
753
754
755 sctp_skb_for_each(pos, &ulpq->lobby, tmp) {
756 cevent = (struct sctp_ulpevent *) pos->cb;
757 csid = cevent->stream;
758 cssn = cevent->ssn;
759
760
761 if (csid > sid)
762 break;
763
764
765 if (csid < sid)
766 continue;
767
768 if (cssn != sctp_ssn_peek(in, sid))
769 break;
770
771
772 sctp_ssn_next(in, sid);
773
774 __skb_unlink(pos, &ulpq->lobby);
775
776
777 __skb_queue_tail(event_list, pos);
778 }
779}
780
781
782static void sctp_ulpq_store_ordered(struct sctp_ulpq *ulpq,
783 struct sctp_ulpevent *event)
784{
785 struct sk_buff *pos;
786 struct sctp_ulpevent *cevent;
787 __u16 sid, csid;
788 __u16 ssn, cssn;
789
790 pos = skb_peek_tail(&ulpq->lobby);
791 if (!pos) {
792 __skb_queue_tail(&ulpq->lobby, sctp_event2skb(event));
793 return;
794 }
795
796 sid = event->stream;
797 ssn = event->ssn;
798
799 cevent = (struct sctp_ulpevent *) pos->cb;
800 csid = cevent->stream;
801 cssn = cevent->ssn;
802 if (sid > csid) {
803 __skb_queue_tail(&ulpq->lobby, sctp_event2skb(event));
804 return;
805 }
806
807 if ((sid == csid) && SSN_lt(cssn, ssn)) {
808 __skb_queue_tail(&ulpq->lobby, sctp_event2skb(event));
809 return;
810 }
811
812
813
814
815 skb_queue_walk(&ulpq->lobby, pos) {
816 cevent = (struct sctp_ulpevent *) pos->cb;
817 csid = cevent->stream;
818 cssn = cevent->ssn;
819
820 if (csid > sid)
821 break;
822 if (csid == sid && SSN_lt(ssn, cssn))
823 break;
824 }
825
826
827
828 __skb_queue_before(&ulpq->lobby, pos, sctp_event2skb(event));
829}
830
831static struct sctp_ulpevent *sctp_ulpq_order(struct sctp_ulpq *ulpq,
832 struct sctp_ulpevent *event)
833{
834 __u16 sid, ssn;
835 struct sctp_stream *in;
836
837
838 if (SCTP_DATA_UNORDERED & event->msg_flags)
839 return event;
840
841
842 sid = event->stream;
843 ssn = event->ssn;
844 in = &ulpq->asoc->ssnmap->in;
845
846
847 if (ssn != sctp_ssn_peek(in, sid)) {
848
849
850
851 sctp_ulpq_store_ordered(ulpq, event);
852 return NULL;
853 }
854
855
856 sctp_ssn_next(in, sid);
857
858
859
860
861 sctp_ulpq_retrieve_ordered(ulpq, event);
862
863 return event;
864}
865
866
867
868
869static void sctp_ulpq_reap_ordered(struct sctp_ulpq *ulpq, __u16 sid)
870{
871 struct sk_buff *pos, *tmp;
872 struct sctp_ulpevent *cevent;
873 struct sctp_ulpevent *event;
874 struct sctp_stream *in;
875 struct sk_buff_head temp;
876 struct sk_buff_head *lobby = &ulpq->lobby;
877 __u16 csid, cssn;
878
879 in = &ulpq->asoc->ssnmap->in;
880
881
882 skb_queue_head_init(&temp);
883 event = NULL;
884 sctp_skb_for_each(pos, lobby, tmp) {
885 cevent = (struct sctp_ulpevent *) pos->cb;
886 csid = cevent->stream;
887 cssn = cevent->ssn;
888
889
890 if (csid > sid)
891 break;
892
893
894 if (csid < sid)
895 continue;
896
897
898 if (!SSN_lt(cssn, sctp_ssn_peek(in, csid)))
899 break;
900
901 __skb_unlink(pos, lobby);
902 if (!event)
903
904 event = sctp_skb2event(pos);
905
906
907 __skb_queue_tail(&temp, pos);
908 }
909
910
911
912
913 if (event == NULL && pos != (struct sk_buff *)lobby) {
914 cevent = (struct sctp_ulpevent *) pos->cb;
915 csid = cevent->stream;
916 cssn = cevent->ssn;
917
918 if (csid == sid && cssn == sctp_ssn_peek(in, csid)) {
919 sctp_ssn_next(in, csid);
920 __skb_unlink(pos, lobby);
921 __skb_queue_tail(&temp, pos);
922 event = sctp_skb2event(pos);
923 }
924 }
925
926
927
928
929 if (event) {
930
931 sctp_ulpq_retrieve_ordered(ulpq, event);
932 sctp_ulpq_tail_event(ulpq, event);
933 }
934}
935
936
937
938
939void sctp_ulpq_skip(struct sctp_ulpq *ulpq, __u16 sid, __u16 ssn)
940{
941 struct sctp_stream *in;
942
943
944 in = &ulpq->asoc->ssnmap->in;
945
946
947 if (SSN_lt(ssn, sctp_ssn_peek(in, sid)))
948 return;
949
950
951 sctp_ssn_skip(in, sid, ssn);
952
953
954
955
956 sctp_ulpq_reap_ordered(ulpq, sid);
957 return;
958}
959
960static __u16 sctp_ulpq_renege_list(struct sctp_ulpq *ulpq,
961 struct sk_buff_head *list, __u16 needed)
962{
963 __u16 freed = 0;
964 __u32 tsn;
965 struct sk_buff *skb;
966 struct sctp_ulpevent *event;
967 struct sctp_tsnmap *tsnmap;
968
969 tsnmap = &ulpq->asoc->peer.tsn_map;
970
971 while ((skb = __skb_dequeue_tail(list)) != NULL) {
972 freed += skb_headlen(skb);
973 event = sctp_skb2event(skb);
974 tsn = event->tsn;
975
976 sctp_ulpevent_free(event);
977 sctp_tsnmap_renege(tsnmap, tsn);
978 if (freed >= needed)
979 return freed;
980 }
981
982 return freed;
983}
984
985
986static __u16 sctp_ulpq_renege_order(struct sctp_ulpq *ulpq, __u16 needed)
987{
988 return sctp_ulpq_renege_list(ulpq, &ulpq->lobby, needed);
989}
990
991
992static __u16 sctp_ulpq_renege_frags(struct sctp_ulpq *ulpq, __u16 needed)
993{
994 return sctp_ulpq_renege_list(ulpq, &ulpq->reasm, needed);
995}
996
997
998void sctp_ulpq_partial_delivery(struct sctp_ulpq *ulpq,
999 struct sctp_chunk *chunk,
1000 gfp_t gfp)
1001{
1002 struct sctp_ulpevent *event;
1003 struct sctp_association *asoc;
1004 struct sctp_sock *sp;
1005
1006 asoc = ulpq->asoc;
1007 sp = sctp_sk(asoc->base.sk);
1008
1009
1010
1011
1012 if (ulpq->pd_mode)
1013 return;
1014
1015
1016
1017
1018
1019
1020 if (sp->frag_interleave || atomic_read(&sp->pd_mode) == 0) {
1021
1022 event = sctp_ulpq_retrieve_first(ulpq);
1023
1024 if (event) {
1025 sctp_ulpq_tail_event(ulpq, event);
1026 sctp_ulpq_set_pd(ulpq);
1027 return;
1028 }
1029 }
1030}
1031
1032
1033void sctp_ulpq_renege(struct sctp_ulpq *ulpq, struct sctp_chunk *chunk,
1034 gfp_t gfp)
1035{
1036 struct sctp_association *asoc;
1037 __u16 needed, freed;
1038
1039 asoc = ulpq->asoc;
1040
1041 if (chunk) {
1042 needed = ntohs(chunk->chunk_hdr->length);
1043 needed -= sizeof(sctp_data_chunk_t);
1044 } else
1045 needed = SCTP_DEFAULT_MAXWINDOW;
1046
1047 freed = 0;
1048
1049 if (skb_queue_empty(&asoc->base.sk->sk_receive_queue)) {
1050 freed = sctp_ulpq_renege_order(ulpq, needed);
1051 if (freed < needed) {
1052 freed += sctp_ulpq_renege_frags(ulpq, needed - freed);
1053 }
1054 }
1055
1056 if (chunk && (freed >= needed)) {
1057 __u32 tsn;
1058 tsn = ntohl(chunk->subh.data_hdr->tsn);
1059 sctp_tsnmap_mark(&asoc->peer.tsn_map, tsn);
1060 sctp_ulpq_tail_data(ulpq, chunk, gfp);
1061
1062 sctp_ulpq_partial_delivery(ulpq, chunk, gfp);
1063 }
1064
1065 sk_mem_reclaim(asoc->base.sk);
1066 return;
1067}
1068
1069
1070
1071
1072
1073
1074void sctp_ulpq_abort_pd(struct sctp_ulpq *ulpq, gfp_t gfp)
1075{
1076 struct sctp_ulpevent *ev = NULL;
1077 struct sock *sk;
1078
1079 if (!ulpq->pd_mode)
1080 return;
1081
1082 sk = ulpq->asoc->base.sk;
1083 if (sctp_ulpevent_type_enabled(SCTP_PARTIAL_DELIVERY_EVENT,
1084 &sctp_sk(sk)->subscribe))
1085 ev = sctp_ulpevent_make_pdapi(ulpq->asoc,
1086 SCTP_PARTIAL_DELIVERY_ABORTED,
1087 gfp);
1088 if (ev)
1089 __skb_queue_tail(&sk->sk_receive_queue, sctp_event2skb(ev));
1090
1091
1092 if (sctp_ulpq_clear_pd(ulpq) || ev)
1093 sk->sk_data_ready(sk, 0);
1094}
1095