1 /*-
2 * SPDX-License-Identifier: BSD-3-Clause
3 *
4 * Copyright (c) 2001-2008, by Cisco Systems, Inc. All rights reserved.
5 * Copyright (c) 2008-2012, by Randall Stewart. All rights reserved.
6 * Copyright (c) 2008-2012, by Michael Tuexen. All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions are met:
10 *
11 * a) Redistributions of source code must retain the above copyright notice,
12 * this list of conditions and the following disclaimer.
13 *
14 * b) Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in
16 * the documentation and/or other materials provided with the distribution.
17 *
18 * c) Neither the name of Cisco Systems, Inc. nor the names of its
19 * contributors may be used to endorse or promote products derived
20 * from this software without specific prior written permission.
21 *
22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
24 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
26 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
27 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
28 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
29 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
30 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
31 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF
32 * THE POSSIBILITY OF SUCH DAMAGE.
33 */
34
35 #include <sys/cdefs.h>
36 __FBSDID("$FreeBSD$");
37
38 #include <netinet/sctp_os.h>
39 #include <sys/proc.h>
40 #include <netinet/sctp_var.h>
41 #include <netinet/sctp_sysctl.h>
42 #include <netinet/sctp_header.h>
43 #include <netinet/sctp_pcb.h>
44 #include <netinet/sctputil.h>
45 #include <netinet/sctp_output.h>
46 #include <netinet/sctp_uio.h>
47 #include <netinet/sctputil.h>
48 #include <netinet/sctp_auth.h>
49 #include <netinet/sctp_timer.h>
50 #include <netinet/sctp_asconf.h>
51 #include <netinet/sctp_indata.h>
52 #include <netinet/sctp_bsd_addr.h>
53 #include <netinet/sctp_input.h>
54 #include <netinet/sctp_crc32.h>
55 #include <netinet/sctp_kdtrace.h>
56 #if defined(INET) || defined(INET6)
57 #include <netinet/udp.h>
58 #endif
59 #include <netinet/udp_var.h>
60 #include <machine/in_cksum.h>
61
62 #define SCTP_MAX_GAPS_INARRAY 4
63 struct sack_track {
64 uint8_t right_edge; /* mergable on the right edge */
65 uint8_t left_edge; /* mergable on the left edge */
66 uint8_t num_entries;
67 uint8_t spare;
68 struct sctp_gap_ack_block gaps[SCTP_MAX_GAPS_INARRAY];
69 };
70
71 const struct sack_track sack_array[256] = {
72 {0, 0, 0, 0, /* 0x00 */
73 {{0, 0},
74 {0, 0},
75 {0, 0},
76 {0, 0}
77 }
78 },
79 {1, 0, 1, 0, /* 0x01 */
80 {{0, 0},
81 {0, 0},
82 {0, 0},
83 {0, 0}
84 }
85 },
86 {0, 0, 1, 0, /* 0x02 */
87 {{1, 1},
88 {0, 0},
89 {0, 0},
90 {0, 0}
91 }
92 },
93 {1, 0, 1, 0, /* 0x03 */
94 {{0, 1},
95 {0, 0},
96 {0, 0},
97 {0, 0}
98 }
99 },
100 {0, 0, 1, 0, /* 0x04 */
101 {{2, 2},
102 {0, 0},
103 {0, 0},
104 {0, 0}
105 }
106 },
107 {1, 0, 2, 0, /* 0x05 */
108 {{0, 0},
109 {2, 2},
110 {0, 0},
111 {0, 0}
112 }
113 },
114 {0, 0, 1, 0, /* 0x06 */
115 {{1, 2},
116 {0, 0},
117 {0, 0},
118 {0, 0}
119 }
120 },
121 {1, 0, 1, 0, /* 0x07 */
122 {{0, 2},
123 {0, 0},
124 {0, 0},
125 {0, 0}
126 }
127 },
128 {0, 0, 1, 0, /* 0x08 */
129 {{3, 3},
130 {0, 0},
131 {0, 0},
132 {0, 0}
133 }
134 },
135 {1, 0, 2, 0, /* 0x09 */
136 {{0, 0},
137 {3, 3},
138 {0, 0},
139 {0, 0}
140 }
141 },
142 {0, 0, 2, 0, /* 0x0a */
143 {{1, 1},
144 {3, 3},
145 {0, 0},
146 {0, 0}
147 }
148 },
149 {1, 0, 2, 0, /* 0x0b */
150 {{0, 1},
151 {3, 3},
152 {0, 0},
153 {0, 0}
154 }
155 },
156 {0, 0, 1, 0, /* 0x0c */
157 {{2, 3},
158 {0, 0},
159 {0, 0},
160 {0, 0}
161 }
162 },
163 {1, 0, 2, 0, /* 0x0d */
164 {{0, 0},
165 {2, 3},
166 {0, 0},
167 {0, 0}
168 }
169 },
170 {0, 0, 1, 0, /* 0x0e */
171 {{1, 3},
172 {0, 0},
173 {0, 0},
174 {0, 0}
175 }
176 },
177 {1, 0, 1, 0, /* 0x0f */
178 {{0, 3},
179 {0, 0},
180 {0, 0},
181 {0, 0}
182 }
183 },
184 {0, 0, 1, 0, /* 0x10 */
185 {{4, 4},
186 {0, 0},
187 {0, 0},
188 {0, 0}
189 }
190 },
191 {1, 0, 2, 0, /* 0x11 */
192 {{0, 0},
193 {4, 4},
194 {0, 0},
195 {0, 0}
196 }
197 },
198 {0, 0, 2, 0, /* 0x12 */
199 {{1, 1},
200 {4, 4},
201 {0, 0},
202 {0, 0}
203 }
204 },
205 {1, 0, 2, 0, /* 0x13 */
206 {{0, 1},
207 {4, 4},
208 {0, 0},
209 {0, 0}
210 }
211 },
212 {0, 0, 2, 0, /* 0x14 */
213 {{2, 2},
214 {4, 4},
215 {0, 0},
216 {0, 0}
217 }
218 },
219 {1, 0, 3, 0, /* 0x15 */
220 {{0, 0},
221 {2, 2},
222 {4, 4},
223 {0, 0}
224 }
225 },
226 {0, 0, 2, 0, /* 0x16 */
227 {{1, 2},
228 {4, 4},
229 {0, 0},
230 {0, 0}
231 }
232 },
233 {1, 0, 2, 0, /* 0x17 */
234 {{0, 2},
235 {4, 4},
236 {0, 0},
237 {0, 0}
238 }
239 },
240 {0, 0, 1, 0, /* 0x18 */
241 {{3, 4},
242 {0, 0},
243 {0, 0},
244 {0, 0}
245 }
246 },
247 {1, 0, 2, 0, /* 0x19 */
248 {{0, 0},
249 {3, 4},
250 {0, 0},
251 {0, 0}
252 }
253 },
254 {0, 0, 2, 0, /* 0x1a */
255 {{1, 1},
256 {3, 4},
257 {0, 0},
258 {0, 0}
259 }
260 },
261 {1, 0, 2, 0, /* 0x1b */
262 {{0, 1},
263 {3, 4},
264 {0, 0},
265 {0, 0}
266 }
267 },
268 {0, 0, 1, 0, /* 0x1c */
269 {{2, 4},
270 {0, 0},
271 {0, 0},
272 {0, 0}
273 }
274 },
275 {1, 0, 2, 0, /* 0x1d */
276 {{0, 0},
277 {2, 4},
278 {0, 0},
279 {0, 0}
280 }
281 },
282 {0, 0, 1, 0, /* 0x1e */
283 {{1, 4},
284 {0, 0},
285 {0, 0},
286 {0, 0}
287 }
288 },
289 {1, 0, 1, 0, /* 0x1f */
290 {{0, 4},
291 {0, 0},
292 {0, 0},
293 {0, 0}
294 }
295 },
296 {0, 0, 1, 0, /* 0x20 */
297 {{5, 5},
298 {0, 0},
299 {0, 0},
300 {0, 0}
301 }
302 },
303 {1, 0, 2, 0, /* 0x21 */
304 {{0, 0},
305 {5, 5},
306 {0, 0},
307 {0, 0}
308 }
309 },
310 {0, 0, 2, 0, /* 0x22 */
311 {{1, 1},
312 {5, 5},
313 {0, 0},
314 {0, 0}
315 }
316 },
317 {1, 0, 2, 0, /* 0x23 */
318 {{0, 1},
319 {5, 5},
320 {0, 0},
321 {0, 0}
322 }
323 },
324 {0, 0, 2, 0, /* 0x24 */
325 {{2, 2},
326 {5, 5},
327 {0, 0},
328 {0, 0}
329 }
330 },
331 {1, 0, 3, 0, /* 0x25 */
332 {{0, 0},
333 {2, 2},
334 {5, 5},
335 {0, 0}
336 }
337 },
338 {0, 0, 2, 0, /* 0x26 */
339 {{1, 2},
340 {5, 5},
341 {0, 0},
342 {0, 0}
343 }
344 },
345 {1, 0, 2, 0, /* 0x27 */
346 {{0, 2},
347 {5, 5},
348 {0, 0},
349 {0, 0}
350 }
351 },
352 {0, 0, 2, 0, /* 0x28 */
353 {{3, 3},
354 {5, 5},
355 {0, 0},
356 {0, 0}
357 }
358 },
359 {1, 0, 3, 0, /* 0x29 */
360 {{0, 0},
361 {3, 3},
362 {5, 5},
363 {0, 0}
364 }
365 },
366 {0, 0, 3, 0, /* 0x2a */
367 {{1, 1},
368 {3, 3},
369 {5, 5},
370 {0, 0}
371 }
372 },
373 {1, 0, 3, 0, /* 0x2b */
374 {{0, 1},
375 {3, 3},
376 {5, 5},
377 {0, 0}
378 }
379 },
380 {0, 0, 2, 0, /* 0x2c */
381 {{2, 3},
382 {5, 5},
383 {0, 0},
384 {0, 0}
385 }
386 },
387 {1, 0, 3, 0, /* 0x2d */
388 {{0, 0},
389 {2, 3},
390 {5, 5},
391 {0, 0}
392 }
393 },
394 {0, 0, 2, 0, /* 0x2e */
395 {{1, 3},
396 {5, 5},
397 {0, 0},
398 {0, 0}
399 }
400 },
401 {1, 0, 2, 0, /* 0x2f */
402 {{0, 3},
403 {5, 5},
404 {0, 0},
405 {0, 0}
406 }
407 },
408 {0, 0, 1, 0, /* 0x30 */
409 {{4, 5},
410 {0, 0},
411 {0, 0},
412 {0, 0}
413 }
414 },
415 {1, 0, 2, 0, /* 0x31 */
416 {{0, 0},
417 {4, 5},
418 {0, 0},
419 {0, 0}
420 }
421 },
422 {0, 0, 2, 0, /* 0x32 */
423 {{1, 1},
424 {4, 5},
425 {0, 0},
426 {0, 0}
427 }
428 },
429 {1, 0, 2, 0, /* 0x33 */
430 {{0, 1},
431 {4, 5},
432 {0, 0},
433 {0, 0}
434 }
435 },
436 {0, 0, 2, 0, /* 0x34 */
437 {{2, 2},
438 {4, 5},
439 {0, 0},
440 {0, 0}
441 }
442 },
443 {1, 0, 3, 0, /* 0x35 */
444 {{0, 0},
445 {2, 2},
446 {4, 5},
447 {0, 0}
448 }
449 },
450 {0, 0, 2, 0, /* 0x36 */
451 {{1, 2},
452 {4, 5},
453 {0, 0},
454 {0, 0}
455 }
456 },
457 {1, 0, 2, 0, /* 0x37 */
458 {{0, 2},
459 {4, 5},
460 {0, 0},
461 {0, 0}
462 }
463 },
464 {0, 0, 1, 0, /* 0x38 */
465 {{3, 5},
466 {0, 0},
467 {0, 0},
468 {0, 0}
469 }
470 },
471 {1, 0, 2, 0, /* 0x39 */
472 {{0, 0},
473 {3, 5},
474 {0, 0},
475 {0, 0}
476 }
477 },
478 {0, 0, 2, 0, /* 0x3a */
479 {{1, 1},
480 {3, 5},
481 {0, 0},
482 {0, 0}
483 }
484 },
485 {1, 0, 2, 0, /* 0x3b */
486 {{0, 1},
487 {3, 5},
488 {0, 0},
489 {0, 0}
490 }
491 },
492 {0, 0, 1, 0, /* 0x3c */
493 {{2, 5},
494 {0, 0},
495 {0, 0},
496 {0, 0}
497 }
498 },
499 {1, 0, 2, 0, /* 0x3d */
500 {{0, 0},
501 {2, 5},
502 {0, 0},
503 {0, 0}
504 }
505 },
506 {0, 0, 1, 0, /* 0x3e */
507 {{1, 5},
508 {0, 0},
509 {0, 0},
510 {0, 0}
511 }
512 },
513 {1, 0, 1, 0, /* 0x3f */
514 {{0, 5},
515 {0, 0},
516 {0, 0},
517 {0, 0}
518 }
519 },
520 {0, 0, 1, 0, /* 0x40 */
521 {{6, 6},
522 {0, 0},
523 {0, 0},
524 {0, 0}
525 }
526 },
527 {1, 0, 2, 0, /* 0x41 */
528 {{0, 0},
529 {6, 6},
530 {0, 0},
531 {0, 0}
532 }
533 },
534 {0, 0, 2, 0, /* 0x42 */
535 {{1, 1},
536 {6, 6},
537 {0, 0},
538 {0, 0}
539 }
540 },
541 {1, 0, 2, 0, /* 0x43 */
542 {{0, 1},
543 {6, 6},
544 {0, 0},
545 {0, 0}
546 }
547 },
548 {0, 0, 2, 0, /* 0x44 */
549 {{2, 2},
550 {6, 6},
551 {0, 0},
552 {0, 0}
553 }
554 },
555 {1, 0, 3, 0, /* 0x45 */
556 {{0, 0},
557 {2, 2},
558 {6, 6},
559 {0, 0}
560 }
561 },
562 {0, 0, 2, 0, /* 0x46 */
563 {{1, 2},
564 {6, 6},
565 {0, 0},
566 {0, 0}
567 }
568 },
569 {1, 0, 2, 0, /* 0x47 */
570 {{0, 2},
571 {6, 6},
572 {0, 0},
573 {0, 0}
574 }
575 },
576 {0, 0, 2, 0, /* 0x48 */
577 {{3, 3},
578 {6, 6},
579 {0, 0},
580 {0, 0}
581 }
582 },
583 {1, 0, 3, 0, /* 0x49 */
584 {{0, 0},
585 {3, 3},
586 {6, 6},
587 {0, 0}
588 }
589 },
590 {0, 0, 3, 0, /* 0x4a */
591 {{1, 1},
592 {3, 3},
593 {6, 6},
594 {0, 0}
595 }
596 },
597 {1, 0, 3, 0, /* 0x4b */
598 {{0, 1},
599 {3, 3},
600 {6, 6},
601 {0, 0}
602 }
603 },
604 {0, 0, 2, 0, /* 0x4c */
605 {{2, 3},
606 {6, 6},
607 {0, 0},
608 {0, 0}
609 }
610 },
611 {1, 0, 3, 0, /* 0x4d */
612 {{0, 0},
613 {2, 3},
614 {6, 6},
615 {0, 0}
616 }
617 },
618 {0, 0, 2, 0, /* 0x4e */
619 {{1, 3},
620 {6, 6},
621 {0, 0},
622 {0, 0}
623 }
624 },
625 {1, 0, 2, 0, /* 0x4f */
626 {{0, 3},
627 {6, 6},
628 {0, 0},
629 {0, 0}
630 }
631 },
632 {0, 0, 2, 0, /* 0x50 */
633 {{4, 4},
634 {6, 6},
635 {0, 0},
636 {0, 0}
637 }
638 },
639 {1, 0, 3, 0, /* 0x51 */
640 {{0, 0},
641 {4, 4},
642 {6, 6},
643 {0, 0}
644 }
645 },
646 {0, 0, 3, 0, /* 0x52 */
647 {{1, 1},
648 {4, 4},
649 {6, 6},
650 {0, 0}
651 }
652 },
653 {1, 0, 3, 0, /* 0x53 */
654 {{0, 1},
655 {4, 4},
656 {6, 6},
657 {0, 0}
658 }
659 },
660 {0, 0, 3, 0, /* 0x54 */
661 {{2, 2},
662 {4, 4},
663 {6, 6},
664 {0, 0}
665 }
666 },
667 {1, 0, 4, 0, /* 0x55 */
668 {{0, 0},
669 {2, 2},
670 {4, 4},
671 {6, 6}
672 }
673 },
674 {0, 0, 3, 0, /* 0x56 */
675 {{1, 2},
676 {4, 4},
677 {6, 6},
678 {0, 0}
679 }
680 },
681 {1, 0, 3, 0, /* 0x57 */
682 {{0, 2},
683 {4, 4},
684 {6, 6},
685 {0, 0}
686 }
687 },
688 {0, 0, 2, 0, /* 0x58 */
689 {{3, 4},
690 {6, 6},
691 {0, 0},
692 {0, 0}
693 }
694 },
695 {1, 0, 3, 0, /* 0x59 */
696 {{0, 0},
697 {3, 4},
698 {6, 6},
699 {0, 0}
700 }
701 },
702 {0, 0, 3, 0, /* 0x5a */
703 {{1, 1},
704 {3, 4},
705 {6, 6},
706 {0, 0}
707 }
708 },
709 {1, 0, 3, 0, /* 0x5b */
710 {{0, 1},
711 {3, 4},
712 {6, 6},
713 {0, 0}
714 }
715 },
716 {0, 0, 2, 0, /* 0x5c */
717 {{2, 4},
718 {6, 6},
719 {0, 0},
720 {0, 0}
721 }
722 },
723 {1, 0, 3, 0, /* 0x5d */
724 {{0, 0},
725 {2, 4},
726 {6, 6},
727 {0, 0}
728 }
729 },
730 {0, 0, 2, 0, /* 0x5e */
731 {{1, 4},
732 {6, 6},
733 {0, 0},
734 {0, 0}
735 }
736 },
737 {1, 0, 2, 0, /* 0x5f */
738 {{0, 4},
739 {6, 6},
740 {0, 0},
741 {0, 0}
742 }
743 },
744 {0, 0, 1, 0, /* 0x60 */
745 {{5, 6},
746 {0, 0},
747 {0, 0},
748 {0, 0}
749 }
750 },
751 {1, 0, 2, 0, /* 0x61 */
752 {{0, 0},
753 {5, 6},
754 {0, 0},
755 {0, 0}
756 }
757 },
758 {0, 0, 2, 0, /* 0x62 */
759 {{1, 1},
760 {5, 6},
761 {0, 0},
762 {0, 0}
763 }
764 },
765 {1, 0, 2, 0, /* 0x63 */
766 {{0, 1},
767 {5, 6},
768 {0, 0},
769 {0, 0}
770 }
771 },
772 {0, 0, 2, 0, /* 0x64 */
773 {{2, 2},
774 {5, 6},
775 {0, 0},
776 {0, 0}
777 }
778 },
779 {1, 0, 3, 0, /* 0x65 */
780 {{0, 0},
781 {2, 2},
782 {5, 6},
783 {0, 0}
784 }
785 },
786 {0, 0, 2, 0, /* 0x66 */
787 {{1, 2},
788 {5, 6},
789 {0, 0},
790 {0, 0}
791 }
792 },
793 {1, 0, 2, 0, /* 0x67 */
794 {{0, 2},
795 {5, 6},
796 {0, 0},
797 {0, 0}
798 }
799 },
800 {0, 0, 2, 0, /* 0x68 */
801 {{3, 3},
802 {5, 6},
803 {0, 0},
804 {0, 0}
805 }
806 },
807 {1, 0, 3, 0, /* 0x69 */
808 {{0, 0},
809 {3, 3},
810 {5, 6},
811 {0, 0}
812 }
813 },
814 {0, 0, 3, 0, /* 0x6a */
815 {{1, 1},
816 {3, 3},
817 {5, 6},
818 {0, 0}
819 }
820 },
821 {1, 0, 3, 0, /* 0x6b */
822 {{0, 1},
823 {3, 3},
824 {5, 6},
825 {0, 0}
826 }
827 },
828 {0, 0, 2, 0, /* 0x6c */
829 {{2, 3},
830 {5, 6},
831 {0, 0},
832 {0, 0}
833 }
834 },
835 {1, 0, 3, 0, /* 0x6d */
836 {{0, 0},
837 {2, 3},
838 {5, 6},
839 {0, 0}
840 }
841 },
842 {0, 0, 2, 0, /* 0x6e */
843 {{1, 3},
844 {5, 6},
845 {0, 0},
846 {0, 0}
847 }
848 },
849 {1, 0, 2, 0, /* 0x6f */
850 {{0, 3},
851 {5, 6},
852 {0, 0},
853 {0, 0}
854 }
855 },
856 {0, 0, 1, 0, /* 0x70 */
857 {{4, 6},
858 {0, 0},
859 {0, 0},
860 {0, 0}
861 }
862 },
863 {1, 0, 2, 0, /* 0x71 */
864 {{0, 0},
865 {4, 6},
866 {0, 0},
867 {0, 0}
868 }
869 },
870 {0, 0, 2, 0, /* 0x72 */
871 {{1, 1},
872 {4, 6},
873 {0, 0},
874 {0, 0}
875 }
876 },
877 {1, 0, 2, 0, /* 0x73 */
878 {{0, 1},
879 {4, 6},
880 {0, 0},
881 {0, 0}
882 }
883 },
884 {0, 0, 2, 0, /* 0x74 */
885 {{2, 2},
886 {4, 6},
887 {0, 0},
888 {0, 0}
889 }
890 },
891 {1, 0, 3, 0, /* 0x75 */
892 {{0, 0},
893 {2, 2},
894 {4, 6},
895 {0, 0}
896 }
897 },
898 {0, 0, 2, 0, /* 0x76 */
899 {{1, 2},
900 {4, 6},
901 {0, 0},
902 {0, 0}
903 }
904 },
905 {1, 0, 2, 0, /* 0x77 */
906 {{0, 2},
907 {4, 6},
908 {0, 0},
909 {0, 0}
910 }
911 },
912 {0, 0, 1, 0, /* 0x78 */
913 {{3, 6},
914 {0, 0},
915 {0, 0},
916 {0, 0}
917 }
918 },
919 {1, 0, 2, 0, /* 0x79 */
920 {{0, 0},
921 {3, 6},
922 {0, 0},
923 {0, 0}
924 }
925 },
926 {0, 0, 2, 0, /* 0x7a */
927 {{1, 1},
928 {3, 6},
929 {0, 0},
930 {0, 0}
931 }
932 },
933 {1, 0, 2, 0, /* 0x7b */
934 {{0, 1},
935 {3, 6},
936 {0, 0},
937 {0, 0}
938 }
939 },
940 {0, 0, 1, 0, /* 0x7c */
941 {{2, 6},
942 {0, 0},
943 {0, 0},
944 {0, 0}
945 }
946 },
947 {1, 0, 2, 0, /* 0x7d */
948 {{0, 0},
949 {2, 6},
950 {0, 0},
951 {0, 0}
952 }
953 },
954 {0, 0, 1, 0, /* 0x7e */
955 {{1, 6},
956 {0, 0},
957 {0, 0},
958 {0, 0}
959 }
960 },
961 {1, 0, 1, 0, /* 0x7f */
962 {{0, 6},
963 {0, 0},
964 {0, 0},
965 {0, 0}
966 }
967 },
968 {0, 1, 1, 0, /* 0x80 */
969 {{7, 7},
970 {0, 0},
971 {0, 0},
972 {0, 0}
973 }
974 },
975 {1, 1, 2, 0, /* 0x81 */
976 {{0, 0},
977 {7, 7},
978 {0, 0},
979 {0, 0}
980 }
981 },
982 {0, 1, 2, 0, /* 0x82 */
983 {{1, 1},
984 {7, 7},
985 {0, 0},
986 {0, 0}
987 }
988 },
989 {1, 1, 2, 0, /* 0x83 */
990 {{0, 1},
991 {7, 7},
992 {0, 0},
993 {0, 0}
994 }
995 },
996 {0, 1, 2, 0, /* 0x84 */
997 {{2, 2},
998 {7, 7},
999 {0, 0},
1000 {0, 0}
1001 }
1002 },
1003 {1, 1, 3, 0, /* 0x85 */
1004 {{0, 0},
1005 {2, 2},
1006 {7, 7},
1007 {0, 0}
1008 }
1009 },
1010 {0, 1, 2, 0, /* 0x86 */
1011 {{1, 2},
1012 {7, 7},
1013 {0, 0},
1014 {0, 0}
1015 }
1016 },
1017 {1, 1, 2, 0, /* 0x87 */
1018 {{0, 2},
1019 {7, 7},
1020 {0, 0},
1021 {0, 0}
1022 }
1023 },
1024 {0, 1, 2, 0, /* 0x88 */
1025 {{3, 3},
1026 {7, 7},
1027 {0, 0},
1028 {0, 0}
1029 }
1030 },
1031 {1, 1, 3, 0, /* 0x89 */
1032 {{0, 0},
1033 {3, 3},
1034 {7, 7},
1035 {0, 0}
1036 }
1037 },
1038 {0, 1, 3, 0, /* 0x8a */
1039 {{1, 1},
1040 {3, 3},
1041 {7, 7},
1042 {0, 0}
1043 }
1044 },
1045 {1, 1, 3, 0, /* 0x8b */
1046 {{0, 1},
1047 {3, 3},
1048 {7, 7},
1049 {0, 0}
1050 }
1051 },
1052 {0, 1, 2, 0, /* 0x8c */
1053 {{2, 3},
1054 {7, 7},
1055 {0, 0},
1056 {0, 0}
1057 }
1058 },
1059 {1, 1, 3, 0, /* 0x8d */
1060 {{0, 0},
1061 {2, 3},
1062 {7, 7},
1063 {0, 0}
1064 }
1065 },
1066 {0, 1, 2, 0, /* 0x8e */
1067 {{1, 3},
1068 {7, 7},
1069 {0, 0},
1070 {0, 0}
1071 }
1072 },
1073 {1, 1, 2, 0, /* 0x8f */
1074 {{0, 3},
1075 {7, 7},
1076 {0, 0},
1077 {0, 0}
1078 }
1079 },
1080 {0, 1, 2, 0, /* 0x90 */
1081 {{4, 4},
1082 {7, 7},
1083 {0, 0},
1084 {0, 0}
1085 }
1086 },
1087 {1, 1, 3, 0, /* 0x91 */
1088 {{0, 0},
1089 {4, 4},
1090 {7, 7},
1091 {0, 0}
1092 }
1093 },
1094 {0, 1, 3, 0, /* 0x92 */
1095 {{1, 1},
1096 {4, 4},
1097 {7, 7},
1098 {0, 0}
1099 }
1100 },
1101 {1, 1, 3, 0, /* 0x93 */
1102 {{0, 1},
1103 {4, 4},
1104 {7, 7},
1105 {0, 0}
1106 }
1107 },
1108 {0, 1, 3, 0, /* 0x94 */
1109 {{2, 2},
1110 {4, 4},
1111 {7, 7},
1112 {0, 0}
1113 }
1114 },
1115 {1, 1, 4, 0, /* 0x95 */
1116 {{0, 0},
1117 {2, 2},
1118 {4, 4},
1119 {7, 7}
1120 }
1121 },
1122 {0, 1, 3, 0, /* 0x96 */
1123 {{1, 2},
1124 {4, 4},
1125 {7, 7},
1126 {0, 0}
1127 }
1128 },
1129 {1, 1, 3, 0, /* 0x97 */
1130 {{0, 2},
1131 {4, 4},
1132 {7, 7},
1133 {0, 0}
1134 }
1135 },
1136 {0, 1, 2, 0, /* 0x98 */
1137 {{3, 4},
1138 {7, 7},
1139 {0, 0},
1140 {0, 0}
1141 }
1142 },
1143 {1, 1, 3, 0, /* 0x99 */
1144 {{0, 0},
1145 {3, 4},
1146 {7, 7},
1147 {0, 0}
1148 }
1149 },
1150 {0, 1, 3, 0, /* 0x9a */
1151 {{1, 1},
1152 {3, 4},
1153 {7, 7},
1154 {0, 0}
1155 }
1156 },
1157 {1, 1, 3, 0, /* 0x9b */
1158 {{0, 1},
1159 {3, 4},
1160 {7, 7},
1161 {0, 0}
1162 }
1163 },
1164 {0, 1, 2, 0, /* 0x9c */
1165 {{2, 4},
1166 {7, 7},
1167 {0, 0},
1168 {0, 0}
1169 }
1170 },
1171 {1, 1, 3, 0, /* 0x9d */
1172 {{0, 0},
1173 {2, 4},
1174 {7, 7},
1175 {0, 0}
1176 }
1177 },
1178 {0, 1, 2, 0, /* 0x9e */
1179 {{1, 4},
1180 {7, 7},
1181 {0, 0},
1182 {0, 0}
1183 }
1184 },
1185 {1, 1, 2, 0, /* 0x9f */
1186 {{0, 4},
1187 {7, 7},
1188 {0, 0},
1189 {0, 0}
1190 }
1191 },
1192 {0, 1, 2, 0, /* 0xa0 */
1193 {{5, 5},
1194 {7, 7},
1195 {0, 0},
1196 {0, 0}
1197 }
1198 },
1199 {1, 1, 3, 0, /* 0xa1 */
1200 {{0, 0},
1201 {5, 5},
1202 {7, 7},
1203 {0, 0}
1204 }
1205 },
1206 {0, 1, 3, 0, /* 0xa2 */
1207 {{1, 1},
1208 {5, 5},
1209 {7, 7},
1210 {0, 0}
1211 }
1212 },
1213 {1, 1, 3, 0, /* 0xa3 */
1214 {{0, 1},
1215 {5, 5},
1216 {7, 7},
1217 {0, 0}
1218 }
1219 },
1220 {0, 1, 3, 0, /* 0xa4 */
1221 {{2, 2},
1222 {5, 5},
1223 {7, 7},
1224 {0, 0}
1225 }
1226 },
1227 {1, 1, 4, 0, /* 0xa5 */
1228 {{0, 0},
1229 {2, 2},
1230 {5, 5},
1231 {7, 7}
1232 }
1233 },
1234 {0, 1, 3, 0, /* 0xa6 */
1235 {{1, 2},
1236 {5, 5},
1237 {7, 7},
1238 {0, 0}
1239 }
1240 },
1241 {1, 1, 3, 0, /* 0xa7 */
1242 {{0, 2},
1243 {5, 5},
1244 {7, 7},
1245 {0, 0}
1246 }
1247 },
1248 {0, 1, 3, 0, /* 0xa8 */
1249 {{3, 3},
1250 {5, 5},
1251 {7, 7},
1252 {0, 0}
1253 }
1254 },
1255 {1, 1, 4, 0, /* 0xa9 */
1256 {{0, 0},
1257 {3, 3},
1258 {5, 5},
1259 {7, 7}
1260 }
1261 },
1262 {0, 1, 4, 0, /* 0xaa */
1263 {{1, 1},
1264 {3, 3},
1265 {5, 5},
1266 {7, 7}
1267 }
1268 },
1269 {1, 1, 4, 0, /* 0xab */
1270 {{0, 1},
1271 {3, 3},
1272 {5, 5},
1273 {7, 7}
1274 }
1275 },
1276 {0, 1, 3, 0, /* 0xac */
1277 {{2, 3},
1278 {5, 5},
1279 {7, 7},
1280 {0, 0}
1281 }
1282 },
1283 {1, 1, 4, 0, /* 0xad */
1284 {{0, 0},
1285 {2, 3},
1286 {5, 5},
1287 {7, 7}
1288 }
1289 },
1290 {0, 1, 3, 0, /* 0xae */
1291 {{1, 3},
1292 {5, 5},
1293 {7, 7},
1294 {0, 0}
1295 }
1296 },
1297 {1, 1, 3, 0, /* 0xaf */
1298 {{0, 3},
1299 {5, 5},
1300 {7, 7},
1301 {0, 0}
1302 }
1303 },
1304 {0, 1, 2, 0, /* 0xb0 */
1305 {{4, 5},
1306 {7, 7},
1307 {0, 0},
1308 {0, 0}
1309 }
1310 },
1311 {1, 1, 3, 0, /* 0xb1 */
1312 {{0, 0},
1313 {4, 5},
1314 {7, 7},
1315 {0, 0}
1316 }
1317 },
1318 {0, 1, 3, 0, /* 0xb2 */
1319 {{1, 1},
1320 {4, 5},
1321 {7, 7},
1322 {0, 0}
1323 }
1324 },
1325 {1, 1, 3, 0, /* 0xb3 */
1326 {{0, 1},
1327 {4, 5},
1328 {7, 7},
1329 {0, 0}
1330 }
1331 },
1332 {0, 1, 3, 0, /* 0xb4 */
1333 {{2, 2},
1334 {4, 5},
1335 {7, 7},
1336 {0, 0}
1337 }
1338 },
1339 {1, 1, 4, 0, /* 0xb5 */
1340 {{0, 0},
1341 {2, 2},
1342 {4, 5},
1343 {7, 7}
1344 }
1345 },
1346 {0, 1, 3, 0, /* 0xb6 */
1347 {{1, 2},
1348 {4, 5},
1349 {7, 7},
1350 {0, 0}
1351 }
1352 },
1353 {1, 1, 3, 0, /* 0xb7 */
1354 {{0, 2},
1355 {4, 5},
1356 {7, 7},
1357 {0, 0}
1358 }
1359 },
1360 {0, 1, 2, 0, /* 0xb8 */
1361 {{3, 5},
1362 {7, 7},
1363 {0, 0},
1364 {0, 0}
1365 }
1366 },
1367 {1, 1, 3, 0, /* 0xb9 */
1368 {{0, 0},
1369 {3, 5},
1370 {7, 7},
1371 {0, 0}
1372 }
1373 },
1374 {0, 1, 3, 0, /* 0xba */
1375 {{1, 1},
1376 {3, 5},
1377 {7, 7},
1378 {0, 0}
1379 }
1380 },
1381 {1, 1, 3, 0, /* 0xbb */
1382 {{0, 1},
1383 {3, 5},
1384 {7, 7},
1385 {0, 0}
1386 }
1387 },
1388 {0, 1, 2, 0, /* 0xbc */
1389 {{2, 5},
1390 {7, 7},
1391 {0, 0},
1392 {0, 0}
1393 }
1394 },
1395 {1, 1, 3, 0, /* 0xbd */
1396 {{0, 0},
1397 {2, 5},
1398 {7, 7},
1399 {0, 0}
1400 }
1401 },
1402 {0, 1, 2, 0, /* 0xbe */
1403 {{1, 5},
1404 {7, 7},
1405 {0, 0},
1406 {0, 0}
1407 }
1408 },
1409 {1, 1, 2, 0, /* 0xbf */
1410 {{0, 5},
1411 {7, 7},
1412 {0, 0},
1413 {0, 0}
1414 }
1415 },
1416 {0, 1, 1, 0, /* 0xc0 */
1417 {{6, 7},
1418 {0, 0},
1419 {0, 0},
1420 {0, 0}
1421 }
1422 },
1423 {1, 1, 2, 0, /* 0xc1 */
1424 {{0, 0},
1425 {6, 7},
1426 {0, 0},
1427 {0, 0}
1428 }
1429 },
1430 {0, 1, 2, 0, /* 0xc2 */
1431 {{1, 1},
1432 {6, 7},
1433 {0, 0},
1434 {0, 0}
1435 }
1436 },
1437 {1, 1, 2, 0, /* 0xc3 */
1438 {{0, 1},
1439 {6, 7},
1440 {0, 0},
1441 {0, 0}
1442 }
1443 },
1444 {0, 1, 2, 0, /* 0xc4 */
1445 {{2, 2},
1446 {6, 7},
1447 {0, 0},
1448 {0, 0}
1449 }
1450 },
1451 {1, 1, 3, 0, /* 0xc5 */
1452 {{0, 0},
1453 {2, 2},
1454 {6, 7},
1455 {0, 0}
1456 }
1457 },
1458 {0, 1, 2, 0, /* 0xc6 */
1459 {{1, 2},
1460 {6, 7},
1461 {0, 0},
1462 {0, 0}
1463 }
1464 },
1465 {1, 1, 2, 0, /* 0xc7 */
1466 {{0, 2},
1467 {6, 7},
1468 {0, 0},
1469 {0, 0}
1470 }
1471 },
1472 {0, 1, 2, 0, /* 0xc8 */
1473 {{3, 3},
1474 {6, 7},
1475 {0, 0},
1476 {0, 0}
1477 }
1478 },
1479 {1, 1, 3, 0, /* 0xc9 */
1480 {{0, 0},
1481 {3, 3},
1482 {6, 7},
1483 {0, 0}
1484 }
1485 },
1486 {0, 1, 3, 0, /* 0xca */
1487 {{1, 1},
1488 {3, 3},
1489 {6, 7},
1490 {0, 0}
1491 }
1492 },
1493 {1, 1, 3, 0, /* 0xcb */
1494 {{0, 1},
1495 {3, 3},
1496 {6, 7},
1497 {0, 0}
1498 }
1499 },
1500 {0, 1, 2, 0, /* 0xcc */
1501 {{2, 3},
1502 {6, 7},
1503 {0, 0},
1504 {0, 0}
1505 }
1506 },
1507 {1, 1, 3, 0, /* 0xcd */
1508 {{0, 0},
1509 {2, 3},
1510 {6, 7},
1511 {0, 0}
1512 }
1513 },
1514 {0, 1, 2, 0, /* 0xce */
1515 {{1, 3},
1516 {6, 7},
1517 {0, 0},
1518 {0, 0}
1519 }
1520 },
1521 {1, 1, 2, 0, /* 0xcf */
1522 {{0, 3},
1523 {6, 7},
1524 {0, 0},
1525 {0, 0}
1526 }
1527 },
1528 {0, 1, 2, 0, /* 0xd0 */
1529 {{4, 4},
1530 {6, 7},
1531 {0, 0},
1532 {0, 0}
1533 }
1534 },
1535 {1, 1, 3, 0, /* 0xd1 */
1536 {{0, 0},
1537 {4, 4},
1538 {6, 7},
1539 {0, 0}
1540 }
1541 },
1542 {0, 1, 3, 0, /* 0xd2 */
1543 {{1, 1},
1544 {4, 4},
1545 {6, 7},
1546 {0, 0}
1547 }
1548 },
1549 {1, 1, 3, 0, /* 0xd3 */
1550 {{0, 1},
1551 {4, 4},
1552 {6, 7},
1553 {0, 0}
1554 }
1555 },
1556 {0, 1, 3, 0, /* 0xd4 */
1557 {{2, 2},
1558 {4, 4},
1559 {6, 7},
1560 {0, 0}
1561 }
1562 },
1563 {1, 1, 4, 0, /* 0xd5 */
1564 {{0, 0},
1565 {2, 2},
1566 {4, 4},
1567 {6, 7}
1568 }
1569 },
1570 {0, 1, 3, 0, /* 0xd6 */
1571 {{1, 2},
1572 {4, 4},
1573 {6, 7},
1574 {0, 0}
1575 }
1576 },
1577 {1, 1, 3, 0, /* 0xd7 */
1578 {{0, 2},
1579 {4, 4},
1580 {6, 7},
1581 {0, 0}
1582 }
1583 },
1584 {0, 1, 2, 0, /* 0xd8 */
1585 {{3, 4},
1586 {6, 7},
1587 {0, 0},
1588 {0, 0}
1589 }
1590 },
1591 {1, 1, 3, 0, /* 0xd9 */
1592 {{0, 0},
1593 {3, 4},
1594 {6, 7},
1595 {0, 0}
1596 }
1597 },
1598 {0, 1, 3, 0, /* 0xda */
1599 {{1, 1},
1600 {3, 4},
1601 {6, 7},
1602 {0, 0}
1603 }
1604 },
1605 {1, 1, 3, 0, /* 0xdb */
1606 {{0, 1},
1607 {3, 4},
1608 {6, 7},
1609 {0, 0}
1610 }
1611 },
1612 {0, 1, 2, 0, /* 0xdc */
1613 {{2, 4},
1614 {6, 7},
1615 {0, 0},
1616 {0, 0}
1617 }
1618 },
1619 {1, 1, 3, 0, /* 0xdd */
1620 {{0, 0},
1621 {2, 4},
1622 {6, 7},
1623 {0, 0}
1624 }
1625 },
1626 {0, 1, 2, 0, /* 0xde */
1627 {{1, 4},
1628 {6, 7},
1629 {0, 0},
1630 {0, 0}
1631 }
1632 },
1633 {1, 1, 2, 0, /* 0xdf */
1634 {{0, 4},
1635 {6, 7},
1636 {0, 0},
1637 {0, 0}
1638 }
1639 },
1640 {0, 1, 1, 0, /* 0xe0 */
1641 {{5, 7},
1642 {0, 0},
1643 {0, 0},
1644 {0, 0}
1645 }
1646 },
1647 {1, 1, 2, 0, /* 0xe1 */
1648 {{0, 0},
1649 {5, 7},
1650 {0, 0},
1651 {0, 0}
1652 }
1653 },
1654 {0, 1, 2, 0, /* 0xe2 */
1655 {{1, 1},
1656 {5, 7},
1657 {0, 0},
1658 {0, 0}
1659 }
1660 },
1661 {1, 1, 2, 0, /* 0xe3 */
1662 {{0, 1},
1663 {5, 7},
1664 {0, 0},
1665 {0, 0}
1666 }
1667 },
1668 {0, 1, 2, 0, /* 0xe4 */
1669 {{2, 2},
1670 {5, 7},
1671 {0, 0},
1672 {0, 0}
1673 }
1674 },
1675 {1, 1, 3, 0, /* 0xe5 */
1676 {{0, 0},
1677 {2, 2},
1678 {5, 7},
1679 {0, 0}
1680 }
1681 },
1682 {0, 1, 2, 0, /* 0xe6 */
1683 {{1, 2},
1684 {5, 7},
1685 {0, 0},
1686 {0, 0}
1687 }
1688 },
1689 {1, 1, 2, 0, /* 0xe7 */
1690 {{0, 2},
1691 {5, 7},
1692 {0, 0},
1693 {0, 0}
1694 }
1695 },
1696 {0, 1, 2, 0, /* 0xe8 */
1697 {{3, 3},
1698 {5, 7},
1699 {0, 0},
1700 {0, 0}
1701 }
1702 },
1703 {1, 1, 3, 0, /* 0xe9 */
1704 {{0, 0},
1705 {3, 3},
1706 {5, 7},
1707 {0, 0}
1708 }
1709 },
1710 {0, 1, 3, 0, /* 0xea */
1711 {{1, 1},
1712 {3, 3},
1713 {5, 7},
1714 {0, 0}
1715 }
1716 },
1717 {1, 1, 3, 0, /* 0xeb */
1718 {{0, 1},
1719 {3, 3},
1720 {5, 7},
1721 {0, 0}
1722 }
1723 },
1724 {0, 1, 2, 0, /* 0xec */
1725 {{2, 3},
1726 {5, 7},
1727 {0, 0},
1728 {0, 0}
1729 }
1730 },
1731 {1, 1, 3, 0, /* 0xed */
1732 {{0, 0},
1733 {2, 3},
1734 {5, 7},
1735 {0, 0}
1736 }
1737 },
1738 {0, 1, 2, 0, /* 0xee */
1739 {{1, 3},
1740 {5, 7},
1741 {0, 0},
1742 {0, 0}
1743 }
1744 },
1745 {1, 1, 2, 0, /* 0xef */
1746 {{0, 3},
1747 {5, 7},
1748 {0, 0},
1749 {0, 0}
1750 }
1751 },
1752 {0, 1, 1, 0, /* 0xf0 */
1753 {{4, 7},
1754 {0, 0},
1755 {0, 0},
1756 {0, 0}
1757 }
1758 },
1759 {1, 1, 2, 0, /* 0xf1 */
1760 {{0, 0},
1761 {4, 7},
1762 {0, 0},
1763 {0, 0}
1764 }
1765 },
1766 {0, 1, 2, 0, /* 0xf2 */
1767 {{1, 1},
1768 {4, 7},
1769 {0, 0},
1770 {0, 0}
1771 }
1772 },
1773 {1, 1, 2, 0, /* 0xf3 */
1774 {{0, 1},
1775 {4, 7},
1776 {0, 0},
1777 {0, 0}
1778 }
1779 },
1780 {0, 1, 2, 0, /* 0xf4 */
1781 {{2, 2},
1782 {4, 7},
1783 {0, 0},
1784 {0, 0}
1785 }
1786 },
1787 {1, 1, 3, 0, /* 0xf5 */
1788 {{0, 0},
1789 {2, 2},
1790 {4, 7},
1791 {0, 0}
1792 }
1793 },
1794 {0, 1, 2, 0, /* 0xf6 */
1795 {{1, 2},
1796 {4, 7},
1797 {0, 0},
1798 {0, 0}
1799 }
1800 },
1801 {1, 1, 2, 0, /* 0xf7 */
1802 {{0, 2},
1803 {4, 7},
1804 {0, 0},
1805 {0, 0}
1806 }
1807 },
1808 {0, 1, 1, 0, /* 0xf8 */
1809 {{3, 7},
1810 {0, 0},
1811 {0, 0},
1812 {0, 0}
1813 }
1814 },
1815 {1, 1, 2, 0, /* 0xf9 */
1816 {{0, 0},
1817 {3, 7},
1818 {0, 0},
1819 {0, 0}
1820 }
1821 },
1822 {0, 1, 2, 0, /* 0xfa */
1823 {{1, 1},
1824 {3, 7},
1825 {0, 0},
1826 {0, 0}
1827 }
1828 },
1829 {1, 1, 2, 0, /* 0xfb */
1830 {{0, 1},
1831 {3, 7},
1832 {0, 0},
1833 {0, 0}
1834 }
1835 },
1836 {0, 1, 1, 0, /* 0xfc */
1837 {{2, 7},
1838 {0, 0},
1839 {0, 0},
1840 {0, 0}
1841 }
1842 },
1843 {1, 1, 2, 0, /* 0xfd */
1844 {{0, 0},
1845 {2, 7},
1846 {0, 0},
1847 {0, 0}
1848 }
1849 },
1850 {0, 1, 1, 0, /* 0xfe */
1851 {{1, 7},
1852 {0, 0},
1853 {0, 0},
1854 {0, 0}
1855 }
1856 },
1857 {1, 1, 1, 0, /* 0xff */
1858 {{0, 7},
1859 {0, 0},
1860 {0, 0},
1861 {0, 0}
1862 }
1863 }
1864 };
1865
1866 int
1867 sctp_is_address_in_scope(struct sctp_ifa *ifa,
1868 struct sctp_scoping *scope,
1869 int do_update)
1870 {
1871 if ((scope->loopback_scope == 0) &&
1872 (ifa->ifn_p) && SCTP_IFN_IS_IFT_LOOP(ifa->ifn_p)) {
1873 /*
1874 * skip loopback if not in scope *
1875 */
1876 return (0);
1877 }
1878 switch (ifa->address.sa.sa_family) {
1879 #ifdef INET
1880 case AF_INET:
1881 if (scope->ipv4_addr_legal) {
1882 struct sockaddr_in *sin;
1883
1884 sin = &ifa->address.sin;
1885 if (sin->sin_addr.s_addr == 0) {
1886 /* not in scope , unspecified */
1887 return (0);
1888 }
1889 if ((scope->ipv4_local_scope == 0) &&
1890 (IN4_ISPRIVATE_ADDRESS(&sin->sin_addr))) {
1891 /* private address not in scope */
1892 return (0);
1893 }
1894 } else {
1895 return (0);
1896 }
1897 break;
1898 #endif
1899 #ifdef INET6
1900 case AF_INET6:
1901 if (scope->ipv6_addr_legal) {
1902 struct sockaddr_in6 *sin6;
1903
1904 /*
1905 * Must update the flags, bummer, which means any
1906 * IFA locks must now be applied HERE <->
1907 */
1908 if (do_update) {
1909 sctp_gather_internal_ifa_flags(ifa);
1910 }
1911 if (ifa->localifa_flags & SCTP_ADDR_IFA_UNUSEABLE) {
1912 return (0);
1913 }
1914 /* ok to use deprecated addresses? */
1915 sin6 = &ifa->address.sin6;
1916 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
1917 /* skip unspecified addresses */
1918 return (0);
1919 }
1920 if ( /* (local_scope == 0) && */
1921 (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr))) {
1922 return (0);
1923 }
1924 if ((scope->site_scope == 0) &&
1925 (IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr))) {
1926 return (0);
1927 }
1928 } else {
1929 return (0);
1930 }
1931 break;
1932 #endif
1933 default:
1934 return (0);
1935 }
1936 return (1);
1937 }
1938
1939 static struct mbuf *
1940 sctp_add_addr_to_mbuf(struct mbuf *m, struct sctp_ifa *ifa, uint16_t *len)
1941 {
1942 #if defined(INET) || defined(INET6)
1943 struct sctp_paramhdr *paramh;
1944 struct mbuf *mret;
1945 uint16_t plen;
1946 #endif
1947
1948 switch (ifa->address.sa.sa_family) {
1949 #ifdef INET
1950 case AF_INET:
1951 plen = (uint16_t)sizeof(struct sctp_ipv4addr_param);
1952 break;
1953 #endif
1954 #ifdef INET6
1955 case AF_INET6:
1956 plen = (uint16_t)sizeof(struct sctp_ipv6addr_param);
1957 break;
1958 #endif
1959 default:
1960 return (m);
1961 }
1962 #if defined(INET) || defined(INET6)
1963 if (M_TRAILINGSPACE(m) >= plen) {
1964 /* easy side we just drop it on the end */
1965 paramh = (struct sctp_paramhdr *)(SCTP_BUF_AT(m, SCTP_BUF_LEN(m)));
1966 mret = m;
1967 } else {
1968 /* Need more space */
1969 mret = m;
1970 while (SCTP_BUF_NEXT(mret) != NULL) {
1971 mret = SCTP_BUF_NEXT(mret);
1972 }
1973 SCTP_BUF_NEXT(mret) = sctp_get_mbuf_for_msg(plen, 0, M_NOWAIT, 1, MT_DATA);
1974 if (SCTP_BUF_NEXT(mret) == NULL) {
1975 /* We are hosed, can't add more addresses */
1976 return (m);
1977 }
1978 mret = SCTP_BUF_NEXT(mret);
1979 paramh = mtod(mret, struct sctp_paramhdr *);
1980 }
1981 /* now add the parameter */
1982 switch (ifa->address.sa.sa_family) {
1983 #ifdef INET
1984 case AF_INET:
1985 {
1986 struct sctp_ipv4addr_param *ipv4p;
1987 struct sockaddr_in *sin;
1988
1989 sin = &ifa->address.sin;
1990 ipv4p = (struct sctp_ipv4addr_param *)paramh;
1991 paramh->param_type = htons(SCTP_IPV4_ADDRESS);
1992 paramh->param_length = htons(plen);
1993 ipv4p->addr = sin->sin_addr.s_addr;
1994 SCTP_BUF_LEN(mret) += plen;
1995 break;
1996 }
1997 #endif
1998 #ifdef INET6
1999 case AF_INET6:
2000 {
2001 struct sctp_ipv6addr_param *ipv6p;
2002 struct sockaddr_in6 *sin6;
2003
2004 sin6 = &ifa->address.sin6;
2005 ipv6p = (struct sctp_ipv6addr_param *)paramh;
2006 paramh->param_type = htons(SCTP_IPV6_ADDRESS);
2007 paramh->param_length = htons(plen);
2008 memcpy(ipv6p->addr, &sin6->sin6_addr,
2009 sizeof(ipv6p->addr));
2010 /* clear embedded scope in the address */
2011 in6_clearscope((struct in6_addr *)ipv6p->addr);
2012 SCTP_BUF_LEN(mret) += plen;
2013 break;
2014 }
2015 #endif
2016 default:
2017 return (m);
2018 }
2019 if (len != NULL) {
2020 *len += plen;
2021 }
2022 return (mret);
2023 #endif
2024 }
2025
2026 struct mbuf *
2027 sctp_add_addresses_to_i_ia(struct sctp_inpcb *inp, struct sctp_tcb *stcb,
2028 struct sctp_scoping *scope,
2029 struct mbuf *m_at, int cnt_inits_to,
2030 uint16_t *padding_len, uint16_t *chunk_len)
2031 {
2032 struct sctp_vrf *vrf = NULL;
2033 int cnt, limit_out = 0, total_count;
2034 uint32_t vrf_id;
2035
2036 vrf_id = inp->def_vrf_id;
2037 SCTP_IPI_ADDR_RLOCK();
2038 vrf = sctp_find_vrf(vrf_id);
2039 if (vrf == NULL) {
2040 SCTP_IPI_ADDR_RUNLOCK();
2041 return (m_at);
2042 }
2043 if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) {
2044 struct sctp_ifa *sctp_ifap;
2045 struct sctp_ifn *sctp_ifnp;
2046
2047 cnt = cnt_inits_to;
2048 if (vrf->total_ifa_count > SCTP_COUNT_LIMIT) {
2049 limit_out = 1;
2050 cnt = SCTP_ADDRESS_LIMIT;
2051 goto skip_count;
2052 }
2053 LIST_FOREACH(sctp_ifnp, &vrf->ifnlist, next_ifn) {
2054 if ((scope->loopback_scope == 0) &&
2055 SCTP_IFN_IS_IFT_LOOP(sctp_ifnp)) {
2056 /*
2057 * Skip loopback devices if loopback_scope
2058 * not set
2059 */
2060 continue;
2061 }
2062 LIST_FOREACH(sctp_ifap, &sctp_ifnp->ifalist, next_ifa) {
2063 #ifdef INET
2064 if ((sctp_ifap->address.sa.sa_family == AF_INET) &&
2065 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2066 &sctp_ifap->address.sin.sin_addr) != 0)) {
2067 continue;
2068 }
2069 #endif
2070 #ifdef INET6
2071 if ((sctp_ifap->address.sa.sa_family == AF_INET6) &&
2072 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2073 &sctp_ifap->address.sin6.sin6_addr) != 0)) {
2074 continue;
2075 }
2076 #endif
2077 if (sctp_is_addr_restricted(stcb, sctp_ifap)) {
2078 continue;
2079 }
2080 if (sctp_is_address_in_scope(sctp_ifap, scope, 1) == 0) {
2081 continue;
2082 }
2083 cnt++;
2084 if (cnt > SCTP_ADDRESS_LIMIT) {
2085 break;
2086 }
2087 }
2088 if (cnt > SCTP_ADDRESS_LIMIT) {
2089 break;
2090 }
2091 }
2092 skip_count:
2093 if (cnt > 1) {
2094 total_count = 0;
2095 LIST_FOREACH(sctp_ifnp, &vrf->ifnlist, next_ifn) {
2096 cnt = 0;
2097 if ((scope->loopback_scope == 0) &&
2098 SCTP_IFN_IS_IFT_LOOP(sctp_ifnp)) {
2099 /*
2100 * Skip loopback devices if
2101 * loopback_scope not set
2102 */
2103 continue;
2104 }
2105 LIST_FOREACH(sctp_ifap, &sctp_ifnp->ifalist, next_ifa) {
2106 #ifdef INET
2107 if ((sctp_ifap->address.sa.sa_family == AF_INET) &&
2108 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2109 &sctp_ifap->address.sin.sin_addr) != 0)) {
2110 continue;
2111 }
2112 #endif
2113 #ifdef INET6
2114 if ((sctp_ifap->address.sa.sa_family == AF_INET6) &&
2115 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2116 &sctp_ifap->address.sin6.sin6_addr) != 0)) {
2117 continue;
2118 }
2119 #endif
2120 if (sctp_is_addr_restricted(stcb, sctp_ifap)) {
2121 continue;
2122 }
2123 if (sctp_is_address_in_scope(sctp_ifap,
2124 scope, 0) == 0) {
2125 continue;
2126 }
2127 if ((chunk_len != NULL) &&
2128 (padding_len != NULL) &&
2129 (*padding_len > 0)) {
2130 memset(mtod(m_at, caddr_t)+*chunk_len, 0, *padding_len);
2131 SCTP_BUF_LEN(m_at) += *padding_len;
2132 *chunk_len += *padding_len;
2133 *padding_len = 0;
2134 }
2135 m_at = sctp_add_addr_to_mbuf(m_at, sctp_ifap, chunk_len);
2136 if (limit_out) {
2137 cnt++;
2138 total_count++;
2139 if (cnt >= 2) {
2140 /*
2141 * two from each
2142 * address
2143 */
2144 break;
2145 }
2146 if (total_count > SCTP_ADDRESS_LIMIT) {
2147 /* No more addresses */
2148 break;
2149 }
2150 }
2151 }
2152 }
2153 }
2154 } else {
2155 struct sctp_laddr *laddr;
2156
2157 cnt = cnt_inits_to;
2158 /* First, how many ? */
2159 LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) {
2160 if (laddr->ifa == NULL) {
2161 continue;
2162 }
2163 if (laddr->ifa->localifa_flags & SCTP_BEING_DELETED)
2164 /*
2165 * Address being deleted by the system, dont
2166 * list.
2167 */
2168 continue;
2169 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2170 /*
2171 * Address being deleted on this ep don't
2172 * list.
2173 */
2174 continue;
2175 }
2176 if (sctp_is_address_in_scope(laddr->ifa,
2177 scope, 1) == 0) {
2178 continue;
2179 }
2180 cnt++;
2181 }
2182 /*
2183 * To get through a NAT we only list addresses if we have
2184 * more than one. That way if you just bind a single address
2185 * we let the source of the init dictate our address.
2186 */
2187 if (cnt > 1) {
2188 cnt = cnt_inits_to;
2189 LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) {
2190 if (laddr->ifa == NULL) {
2191 continue;
2192 }
2193 if (laddr->ifa->localifa_flags & SCTP_BEING_DELETED) {
2194 continue;
2195 }
2196 if (sctp_is_address_in_scope(laddr->ifa,
2197 scope, 0) == 0) {
2198 continue;
2199 }
2200 if ((chunk_len != NULL) &&
2201 (padding_len != NULL) &&
2202 (*padding_len > 0)) {
2203 memset(mtod(m_at, caddr_t)+*chunk_len, 0, *padding_len);
2204 SCTP_BUF_LEN(m_at) += *padding_len;
2205 *chunk_len += *padding_len;
2206 *padding_len = 0;
2207 }
2208 m_at = sctp_add_addr_to_mbuf(m_at, laddr->ifa, chunk_len);
2209 cnt++;
2210 if (cnt >= SCTP_ADDRESS_LIMIT) {
2211 break;
2212 }
2213 }
2214 }
2215 }
2216 SCTP_IPI_ADDR_RUNLOCK();
2217 return (m_at);
2218 }
2219
2220 static struct sctp_ifa *
2221 sctp_is_ifa_addr_preferred(struct sctp_ifa *ifa,
2222 uint8_t dest_is_loop,
2223 uint8_t dest_is_priv,
2224 sa_family_t fam)
2225 {
2226 uint8_t dest_is_global = 0;
2227
2228 /* dest_is_priv is true if destination is a private address */
2229 /* dest_is_loop is true if destination is a loopback addresses */
2230
2231 /**
2232 * Here we determine if its a preferred address. A preferred address
2233 * means it is the same scope or higher scope then the destination.
2234 * L = loopback, P = private, G = global
2235 * -----------------------------------------
2236 * src | dest | result
2237 * ----------------------------------------
2238 * L | L | yes
2239 * -----------------------------------------
2240 * P | L | yes-v4 no-v6
2241 * -----------------------------------------
2242 * G | L | yes-v4 no-v6
2243 * -----------------------------------------
2244 * L | P | no
2245 * -----------------------------------------
2246 * P | P | yes
2247 * -----------------------------------------
2248 * G | P | no
2249 * -----------------------------------------
2250 * L | G | no
2251 * -----------------------------------------
2252 * P | G | no
2253 * -----------------------------------------
2254 * G | G | yes
2255 * -----------------------------------------
2256 */
2257
2258 if (ifa->address.sa.sa_family != fam) {
2259 /* forget mis-matched family */
2260 return (NULL);
2261 }
2262 if ((dest_is_priv == 0) && (dest_is_loop == 0)) {
2263 dest_is_global = 1;
2264 }
2265 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Is destination preferred:");
2266 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &ifa->address.sa);
2267 /* Ok the address may be ok */
2268 #ifdef INET6
2269 if (fam == AF_INET6) {
2270 /* ok to use deprecated addresses? no lets not! */
2271 if (ifa->localifa_flags & SCTP_ADDR_IFA_UNUSEABLE) {
2272 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:1\n");
2273 return (NULL);
2274 }
2275 if (ifa->src_is_priv && !ifa->src_is_loop) {
2276 if (dest_is_loop) {
2277 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:2\n");
2278 return (NULL);
2279 }
2280 }
2281 if (ifa->src_is_glob) {
2282 if (dest_is_loop) {
2283 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:3\n");
2284 return (NULL);
2285 }
2286 }
2287 }
2288 #endif
2289 /*
2290 * Now that we know what is what, implement or table this could in
2291 * theory be done slicker (it used to be), but this is
2292 * straightforward and easier to validate :-)
2293 */
2294 SCTPDBG(SCTP_DEBUG_OUTPUT3, "src_loop:%d src_priv:%d src_glob:%d\n",
2295 ifa->src_is_loop, ifa->src_is_priv, ifa->src_is_glob);
2296 SCTPDBG(SCTP_DEBUG_OUTPUT3, "dest_loop:%d dest_priv:%d dest_glob:%d\n",
2297 dest_is_loop, dest_is_priv, dest_is_global);
2298
2299 if ((ifa->src_is_loop) && (dest_is_priv)) {
2300 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:4\n");
2301 return (NULL);
2302 }
2303 if ((ifa->src_is_glob) && (dest_is_priv)) {
2304 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:5\n");
2305 return (NULL);
2306 }
2307 if ((ifa->src_is_loop) && (dest_is_global)) {
2308 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:6\n");
2309 return (NULL);
2310 }
2311 if ((ifa->src_is_priv) && (dest_is_global)) {
2312 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:7\n");
2313 return (NULL);
2314 }
2315 SCTPDBG(SCTP_DEBUG_OUTPUT3, "YES\n");
2316 /* its a preferred address */
2317 return (ifa);
2318 }
2319
2320 static struct sctp_ifa *
2321 sctp_is_ifa_addr_acceptable(struct sctp_ifa *ifa,
2322 uint8_t dest_is_loop,
2323 uint8_t dest_is_priv,
2324 sa_family_t fam)
2325 {
2326 uint8_t dest_is_global = 0;
2327
2328 /**
2329 * Here we determine if its a acceptable address. A acceptable
2330 * address means it is the same scope or higher scope but we can
2331 * allow for NAT which means its ok to have a global dest and a
2332 * private src.
2333 *
2334 * L = loopback, P = private, G = global
2335 * -----------------------------------------
2336 * src | dest | result
2337 * -----------------------------------------
2338 * L | L | yes
2339 * -----------------------------------------
2340 * P | L | yes-v4 no-v6
2341 * -----------------------------------------
2342 * G | L | yes
2343 * -----------------------------------------
2344 * L | P | no
2345 * -----------------------------------------
2346 * P | P | yes
2347 * -----------------------------------------
2348 * G | P | yes - May not work
2349 * -----------------------------------------
2350 * L | G | no
2351 * -----------------------------------------
2352 * P | G | yes - May not work
2353 * -----------------------------------------
2354 * G | G | yes
2355 * -----------------------------------------
2356 */
2357
2358 if (ifa->address.sa.sa_family != fam) {
2359 /* forget non matching family */
2360 SCTPDBG(SCTP_DEBUG_OUTPUT3, "ifa_fam:%d fam:%d\n",
2361 ifa->address.sa.sa_family, fam);
2362 return (NULL);
2363 }
2364 /* Ok the address may be ok */
2365 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT3, &ifa->address.sa);
2366 SCTPDBG(SCTP_DEBUG_OUTPUT3, "dst_is_loop:%d dest_is_priv:%d\n",
2367 dest_is_loop, dest_is_priv);
2368 if ((dest_is_loop == 0) && (dest_is_priv == 0)) {
2369 dest_is_global = 1;
2370 }
2371 #ifdef INET6
2372 if (fam == AF_INET6) {
2373 /* ok to use deprecated addresses? */
2374 if (ifa->localifa_flags & SCTP_ADDR_IFA_UNUSEABLE) {
2375 return (NULL);
2376 }
2377 if (ifa->src_is_priv) {
2378 /* Special case, linklocal to loop */
2379 if (dest_is_loop)
2380 return (NULL);
2381 }
2382 }
2383 #endif
2384 /*
2385 * Now that we know what is what, implement our table. This could in
2386 * theory be done slicker (it used to be), but this is
2387 * straightforward and easier to validate :-)
2388 */
2389 SCTPDBG(SCTP_DEBUG_OUTPUT3, "ifa->src_is_loop:%d dest_is_priv:%d\n",
2390 ifa->src_is_loop,
2391 dest_is_priv);
2392 if ((ifa->src_is_loop == 1) && (dest_is_priv)) {
2393 return (NULL);
2394 }
2395 SCTPDBG(SCTP_DEBUG_OUTPUT3, "ifa->src_is_loop:%d dest_is_glob:%d\n",
2396 ifa->src_is_loop,
2397 dest_is_global);
2398 if ((ifa->src_is_loop == 1) && (dest_is_global)) {
2399 return (NULL);
2400 }
2401 SCTPDBG(SCTP_DEBUG_OUTPUT3, "address is acceptable\n");
2402 /* its an acceptable address */
2403 return (ifa);
2404 }
2405
2406 int
2407 sctp_is_addr_restricted(struct sctp_tcb *stcb, struct sctp_ifa *ifa)
2408 {
2409 struct sctp_laddr *laddr;
2410
2411 if (stcb == NULL) {
2412 /* There are no restrictions, no TCB :-) */
2413 return (0);
2414 }
2415 LIST_FOREACH(laddr, &stcb->asoc.sctp_restricted_addrs, sctp_nxt_addr) {
2416 if (laddr->ifa == NULL) {
2417 SCTPDBG(SCTP_DEBUG_OUTPUT1, "%s: NULL ifa\n",
2418 __func__);
2419 continue;
2420 }
2421 if (laddr->ifa == ifa) {
2422 /* Yes it is on the list */
2423 return (1);
2424 }
2425 }
2426 return (0);
2427 }
2428
2429 int
2430 sctp_is_addr_in_ep(struct sctp_inpcb *inp, struct sctp_ifa *ifa)
2431 {
2432 struct sctp_laddr *laddr;
2433
2434 if (ifa == NULL)
2435 return (0);
2436 LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) {
2437 if (laddr->ifa == NULL) {
2438 SCTPDBG(SCTP_DEBUG_OUTPUT1, "%s: NULL ifa\n",
2439 __func__);
2440 continue;
2441 }
2442 if ((laddr->ifa == ifa) && laddr->action == 0)
2443 /* same pointer */
2444 return (1);
2445 }
2446 return (0);
2447 }
2448
2449 static struct sctp_ifa *
2450 sctp_choose_boundspecific_inp(struct sctp_inpcb *inp,
2451 sctp_route_t *ro,
2452 uint32_t vrf_id,
2453 int non_asoc_addr_ok,
2454 uint8_t dest_is_priv,
2455 uint8_t dest_is_loop,
2456 sa_family_t fam)
2457 {
2458 struct sctp_laddr *laddr, *starting_point;
2459 void *ifn;
2460 int resettotop = 0;
2461 struct sctp_ifn *sctp_ifn;
2462 struct sctp_ifa *sctp_ifa, *sifa;
2463 struct sctp_vrf *vrf;
2464 uint32_t ifn_index;
2465
2466 vrf = sctp_find_vrf(vrf_id);
2467 if (vrf == NULL)
2468 return (NULL);
2469
2470 ifn = SCTP_GET_IFN_VOID_FROM_ROUTE(ro);
2471 ifn_index = SCTP_GET_IF_INDEX_FROM_ROUTE(ro);
2472 sctp_ifn = sctp_find_ifn(ifn, ifn_index);
2473 /*
2474 * first question, is the ifn we will emit on in our list, if so, we
2475 * want such an address. Note that we first looked for a preferred
2476 * address.
2477 */
2478 if (sctp_ifn) {
2479 /* is a preferred one on the interface we route out? */
2480 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
2481 #ifdef INET
2482 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
2483 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2484 &sctp_ifa->address.sin.sin_addr) != 0)) {
2485 continue;
2486 }
2487 #endif
2488 #ifdef INET6
2489 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
2490 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2491 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
2492 continue;
2493 }
2494 #endif
2495 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
2496 (non_asoc_addr_ok == 0))
2497 continue;
2498 sifa = sctp_is_ifa_addr_preferred(sctp_ifa,
2499 dest_is_loop,
2500 dest_is_priv, fam);
2501 if (sifa == NULL)
2502 continue;
2503 if (sctp_is_addr_in_ep(inp, sifa)) {
2504 atomic_add_int(&sifa->refcount, 1);
2505 return (sifa);
2506 }
2507 }
2508 }
2509 /*
2510 * ok, now we now need to find one on the list of the addresses. We
2511 * can't get one on the emitting interface so let's find first a
2512 * preferred one. If not that an acceptable one otherwise... we
2513 * return NULL.
2514 */
2515 starting_point = inp->next_addr_touse;
2516 once_again:
2517 if (inp->next_addr_touse == NULL) {
2518 inp->next_addr_touse = LIST_FIRST(&inp->sctp_addr_list);
2519 resettotop = 1;
2520 }
2521 for (laddr = inp->next_addr_touse; laddr;
2522 laddr = LIST_NEXT(laddr, sctp_nxt_addr)) {
2523 if (laddr->ifa == NULL) {
2524 /* address has been removed */
2525 continue;
2526 }
2527 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2528 /* address is being deleted */
2529 continue;
2530 }
2531 sifa = sctp_is_ifa_addr_preferred(laddr->ifa, dest_is_loop,
2532 dest_is_priv, fam);
2533 if (sifa == NULL)
2534 continue;
2535 atomic_add_int(&sifa->refcount, 1);
2536 return (sifa);
2537 }
2538 if (resettotop == 0) {
2539 inp->next_addr_touse = NULL;
2540 goto once_again;
2541 }
2542
2543 inp->next_addr_touse = starting_point;
2544 resettotop = 0;
2545 once_again_too:
2546 if (inp->next_addr_touse == NULL) {
2547 inp->next_addr_touse = LIST_FIRST(&inp->sctp_addr_list);
2548 resettotop = 1;
2549 }
2550
2551 /* ok, what about an acceptable address in the inp */
2552 for (laddr = inp->next_addr_touse; laddr;
2553 laddr = LIST_NEXT(laddr, sctp_nxt_addr)) {
2554 if (laddr->ifa == NULL) {
2555 /* address has been removed */
2556 continue;
2557 }
2558 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2559 /* address is being deleted */
2560 continue;
2561 }
2562 sifa = sctp_is_ifa_addr_acceptable(laddr->ifa, dest_is_loop,
2563 dest_is_priv, fam);
2564 if (sifa == NULL)
2565 continue;
2566 atomic_add_int(&sifa->refcount, 1);
2567 return (sifa);
2568 }
2569 if (resettotop == 0) {
2570 inp->next_addr_touse = NULL;
2571 goto once_again_too;
2572 }
2573
2574 /*
2575 * no address bound can be a source for the destination we are in
2576 * trouble
2577 */
2578 return (NULL);
2579 }
2580
2581 static struct sctp_ifa *
2582 sctp_choose_boundspecific_stcb(struct sctp_inpcb *inp,
2583 struct sctp_tcb *stcb,
2584 sctp_route_t *ro,
2585 uint32_t vrf_id,
2586 uint8_t dest_is_priv,
2587 uint8_t dest_is_loop,
2588 int non_asoc_addr_ok,
2589 sa_family_t fam)
2590 {
2591 struct sctp_laddr *laddr, *starting_point;
2592 void *ifn;
2593 struct sctp_ifn *sctp_ifn;
2594 struct sctp_ifa *sctp_ifa, *sifa;
2595 uint8_t start_at_beginning = 0;
2596 struct sctp_vrf *vrf;
2597 uint32_t ifn_index;
2598
2599 /*
2600 * first question, is the ifn we will emit on in our list, if so, we
2601 * want that one.
2602 */
2603 vrf = sctp_find_vrf(vrf_id);
2604 if (vrf == NULL)
2605 return (NULL);
2606
2607 ifn = SCTP_GET_IFN_VOID_FROM_ROUTE(ro);
2608 ifn_index = SCTP_GET_IF_INDEX_FROM_ROUTE(ro);
2609 sctp_ifn = sctp_find_ifn(ifn, ifn_index);
2610
2611 /*
2612 * first question, is the ifn we will emit on in our list? If so,
2613 * we want that one. First we look for a preferred. Second, we go
2614 * for an acceptable.
2615 */
2616 if (sctp_ifn) {
2617 /* first try for a preferred address on the ep */
2618 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
2619 #ifdef INET
2620 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
2621 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2622 &sctp_ifa->address.sin.sin_addr) != 0)) {
2623 continue;
2624 }
2625 #endif
2626 #ifdef INET6
2627 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
2628 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2629 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
2630 continue;
2631 }
2632 #endif
2633 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) && (non_asoc_addr_ok == 0))
2634 continue;
2635 if (sctp_is_addr_in_ep(inp, sctp_ifa)) {
2636 sifa = sctp_is_ifa_addr_preferred(sctp_ifa, dest_is_loop, dest_is_priv, fam);
2637 if (sifa == NULL)
2638 continue;
2639 if (((non_asoc_addr_ok == 0) &&
2640 (sctp_is_addr_restricted(stcb, sifa))) ||
2641 (non_asoc_addr_ok &&
2642 (sctp_is_addr_restricted(stcb, sifa)) &&
2643 (!sctp_is_addr_pending(stcb, sifa)))) {
2644 /* on the no-no list */
2645 continue;
2646 }
2647 atomic_add_int(&sifa->refcount, 1);
2648 return (sifa);
2649 }
2650 }
2651 /* next try for an acceptable address on the ep */
2652 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
2653 #ifdef INET
2654 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
2655 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2656 &sctp_ifa->address.sin.sin_addr) != 0)) {
2657 continue;
2658 }
2659 #endif
2660 #ifdef INET6
2661 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
2662 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2663 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
2664 continue;
2665 }
2666 #endif
2667 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) && (non_asoc_addr_ok == 0))
2668 continue;
2669 if (sctp_is_addr_in_ep(inp, sctp_ifa)) {
2670 sifa = sctp_is_ifa_addr_acceptable(sctp_ifa, dest_is_loop, dest_is_priv, fam);
2671 if (sifa == NULL)
2672 continue;
2673 if (((non_asoc_addr_ok == 0) &&
2674 (sctp_is_addr_restricted(stcb, sifa))) ||
2675 (non_asoc_addr_ok &&
2676 (sctp_is_addr_restricted(stcb, sifa)) &&
2677 (!sctp_is_addr_pending(stcb, sifa)))) {
2678 /* on the no-no list */
2679 continue;
2680 }
2681 atomic_add_int(&sifa->refcount, 1);
2682 return (sifa);
2683 }
2684 }
2685 }
2686 /*
2687 * if we can't find one like that then we must look at all addresses
2688 * bound to pick one at first preferable then secondly acceptable.
2689 */
2690 starting_point = stcb->asoc.last_used_address;
2691 sctp_from_the_top:
2692 if (stcb->asoc.last_used_address == NULL) {
2693 start_at_beginning = 1;
2694 stcb->asoc.last_used_address = LIST_FIRST(&inp->sctp_addr_list);
2695 }
2696 /* search beginning with the last used address */
2697 for (laddr = stcb->asoc.last_used_address; laddr;
2698 laddr = LIST_NEXT(laddr, sctp_nxt_addr)) {
2699 if (laddr->ifa == NULL) {
2700 /* address has been removed */
2701 continue;
2702 }
2703 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2704 /* address is being deleted */
2705 continue;
2706 }
2707 sifa = sctp_is_ifa_addr_preferred(laddr->ifa, dest_is_loop, dest_is_priv, fam);
2708 if (sifa == NULL)
2709 continue;
2710 if (((non_asoc_addr_ok == 0) &&
2711 (sctp_is_addr_restricted(stcb, sifa))) ||
2712 (non_asoc_addr_ok &&
2713 (sctp_is_addr_restricted(stcb, sifa)) &&
2714 (!sctp_is_addr_pending(stcb, sifa)))) {
2715 /* on the no-no list */
2716 continue;
2717 }
2718 stcb->asoc.last_used_address = laddr;
2719 atomic_add_int(&sifa->refcount, 1);
2720 return (sifa);
2721 }
2722 if (start_at_beginning == 0) {
2723 stcb->asoc.last_used_address = NULL;
2724 goto sctp_from_the_top;
2725 }
2726 /* now try for any higher scope than the destination */
2727 stcb->asoc.last_used_address = starting_point;
2728 start_at_beginning = 0;
2729 sctp_from_the_top2:
2730 if (stcb->asoc.last_used_address == NULL) {
2731 start_at_beginning = 1;
2732 stcb->asoc.last_used_address = LIST_FIRST(&inp->sctp_addr_list);
2733 }
2734 /* search beginning with the last used address */
2735 for (laddr = stcb->asoc.last_used_address; laddr;
2736 laddr = LIST_NEXT(laddr, sctp_nxt_addr)) {
2737 if (laddr->ifa == NULL) {
2738 /* address has been removed */
2739 continue;
2740 }
2741 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2742 /* address is being deleted */
2743 continue;
2744 }
2745 sifa = sctp_is_ifa_addr_acceptable(laddr->ifa, dest_is_loop,
2746 dest_is_priv, fam);
2747 if (sifa == NULL)
2748 continue;
2749 if (((non_asoc_addr_ok == 0) &&
2750 (sctp_is_addr_restricted(stcb, sifa))) ||
2751 (non_asoc_addr_ok &&
2752 (sctp_is_addr_restricted(stcb, sifa)) &&
2753 (!sctp_is_addr_pending(stcb, sifa)))) {
2754 /* on the no-no list */
2755 continue;
2756 }
2757 stcb->asoc.last_used_address = laddr;
2758 atomic_add_int(&sifa->refcount, 1);
2759 return (sifa);
2760 }
2761 if (start_at_beginning == 0) {
2762 stcb->asoc.last_used_address = NULL;
2763 goto sctp_from_the_top2;
2764 }
2765 return (NULL);
2766 }
2767
2768 static struct sctp_ifa *
2769 sctp_select_nth_preferred_addr_from_ifn_boundall(struct sctp_ifn *ifn,
2770 struct sctp_inpcb *inp,
2771 struct sctp_tcb *stcb,
2772 int non_asoc_addr_ok,
2773 uint8_t dest_is_loop,
2774 uint8_t dest_is_priv,
2775 int addr_wanted,
2776 sa_family_t fam,
2777 sctp_route_t *ro)
2778 {
2779 struct sctp_ifa *ifa, *sifa;
2780 int num_eligible_addr = 0;
2781 #ifdef INET6
2782 struct sockaddr_in6 sin6, lsa6;
2783
2784 if (fam == AF_INET6) {
2785 memcpy(&sin6, &ro->ro_dst, sizeof(struct sockaddr_in6));
2786 (void)sa6_recoverscope(&sin6);
2787 }
2788 #endif /* INET6 */
2789 LIST_FOREACH(ifa, &ifn->ifalist, next_ifa) {
2790 #ifdef INET
2791 if ((ifa->address.sa.sa_family == AF_INET) &&
2792 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2793 &ifa->address.sin.sin_addr) != 0)) {
2794 continue;
2795 }
2796 #endif
2797 #ifdef INET6
2798 if ((ifa->address.sa.sa_family == AF_INET6) &&
2799 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2800 &ifa->address.sin6.sin6_addr) != 0)) {
2801 continue;
2802 }
2803 #endif
2804 if ((ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
2805 (non_asoc_addr_ok == 0))
2806 continue;
2807 sifa = sctp_is_ifa_addr_preferred(ifa, dest_is_loop,
2808 dest_is_priv, fam);
2809 if (sifa == NULL)
2810 continue;
2811 #ifdef INET6
2812 if (fam == AF_INET6 &&
2813 dest_is_loop &&
2814 sifa->src_is_loop && sifa->src_is_priv) {
2815 /*
2816 * don't allow fe80::1 to be a src on loop ::1, we
2817 * don't list it to the peer so we will get an
2818 * abort.
2819 */
2820 continue;
2821 }
2822 if (fam == AF_INET6 &&
2823 IN6_IS_ADDR_LINKLOCAL(&sifa->address.sin6.sin6_addr) &&
2824 IN6_IS_ADDR_LINKLOCAL(&sin6.sin6_addr)) {
2825 /*
2826 * link-local <-> link-local must belong to the same
2827 * scope.
2828 */
2829 memcpy(&lsa6, &sifa->address.sin6, sizeof(struct sockaddr_in6));
2830 (void)sa6_recoverscope(&lsa6);
2831 if (sin6.sin6_scope_id != lsa6.sin6_scope_id) {
2832 continue;
2833 }
2834 }
2835 #endif /* INET6 */
2836
2837 /*
2838 * Check if the IPv6 address matches to next-hop. In the
2839 * mobile case, old IPv6 address may be not deleted from the
2840 * interface. Then, the interface has previous and new
2841 * addresses. We should use one corresponding to the
2842 * next-hop. (by micchie)
2843 */
2844 #ifdef INET6
2845 if (stcb && fam == AF_INET6 &&
2846 sctp_is_mobility_feature_on(stcb->sctp_ep, SCTP_MOBILITY_BASE)) {
2847 if (sctp_v6src_match_nexthop(&sifa->address.sin6, ro) == 0) {
2848 continue;
2849 }
2850 }
2851 #endif
2852 #ifdef INET
2853 /* Avoid topologically incorrect IPv4 address */
2854 if (stcb && fam == AF_INET &&
2855 sctp_is_mobility_feature_on(stcb->sctp_ep, SCTP_MOBILITY_BASE)) {
2856 if (sctp_v4src_match_nexthop(sifa, ro) == 0) {
2857 continue;
2858 }
2859 }
2860 #endif
2861 if (stcb) {
2862 if (sctp_is_address_in_scope(ifa, &stcb->asoc.scope, 0) == 0) {
2863 continue;
2864 }
2865 if (((non_asoc_addr_ok == 0) &&
2866 (sctp_is_addr_restricted(stcb, sifa))) ||
2867 (non_asoc_addr_ok &&
2868 (sctp_is_addr_restricted(stcb, sifa)) &&
2869 (!sctp_is_addr_pending(stcb, sifa)))) {
2870 /*
2871 * It is restricted for some reason..
2872 * probably not yet added.
2873 */
2874 continue;
2875 }
2876 }
2877 if (num_eligible_addr >= addr_wanted) {
2878 return (sifa);
2879 }
2880 num_eligible_addr++;
2881 }
2882 return (NULL);
2883 }
2884
2885 static int
2886 sctp_count_num_preferred_boundall(struct sctp_ifn *ifn,
2887 struct sctp_inpcb *inp,
2888 struct sctp_tcb *stcb,
2889 int non_asoc_addr_ok,
2890 uint8_t dest_is_loop,
2891 uint8_t dest_is_priv,
2892 sa_family_t fam)
2893 {
2894 struct sctp_ifa *ifa, *sifa;
2895 int num_eligible_addr = 0;
2896
2897 LIST_FOREACH(ifa, &ifn->ifalist, next_ifa) {
2898 #ifdef INET
2899 if ((ifa->address.sa.sa_family == AF_INET) &&
2900 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2901 &ifa->address.sin.sin_addr) != 0)) {
2902 continue;
2903 }
2904 #endif
2905 #ifdef INET6
2906 if ((ifa->address.sa.sa_family == AF_INET6) &&
2907 (stcb != NULL) &&
2908 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2909 &ifa->address.sin6.sin6_addr) != 0)) {
2910 continue;
2911 }
2912 #endif
2913 if ((ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
2914 (non_asoc_addr_ok == 0)) {
2915 continue;
2916 }
2917 sifa = sctp_is_ifa_addr_preferred(ifa, dest_is_loop,
2918 dest_is_priv, fam);
2919 if (sifa == NULL) {
2920 continue;
2921 }
2922 if (stcb) {
2923 if (sctp_is_address_in_scope(ifa, &stcb->asoc.scope, 0) == 0) {
2924 continue;
2925 }
2926 if (((non_asoc_addr_ok == 0) &&
2927 (sctp_is_addr_restricted(stcb, sifa))) ||
2928 (non_asoc_addr_ok &&
2929 (sctp_is_addr_restricted(stcb, sifa)) &&
2930 (!sctp_is_addr_pending(stcb, sifa)))) {
2931 /*
2932 * It is restricted for some reason..
2933 * probably not yet added.
2934 */
2935 continue;
2936 }
2937 }
2938 num_eligible_addr++;
2939 }
2940 return (num_eligible_addr);
2941 }
2942
2943 static struct sctp_ifa *
2944 sctp_choose_boundall(struct sctp_inpcb *inp,
2945 struct sctp_tcb *stcb,
2946 struct sctp_nets *net,
2947 sctp_route_t *ro,
2948 uint32_t vrf_id,
2949 uint8_t dest_is_priv,
2950 uint8_t dest_is_loop,
2951 int non_asoc_addr_ok,
2952 sa_family_t fam)
2953 {
2954 int cur_addr_num = 0, num_preferred = 0;
2955 void *ifn;
2956 struct sctp_ifn *sctp_ifn, *looked_at = NULL, *emit_ifn;
2957 struct sctp_ifa *sctp_ifa, *sifa;
2958 uint32_t ifn_index;
2959 struct sctp_vrf *vrf;
2960 #ifdef INET
2961 int retried = 0;
2962 #endif
2963
2964 /*-
2965 * For boundall we can use any address in the association.
2966 * If non_asoc_addr_ok is set we can use any address (at least in
2967 * theory). So we look for preferred addresses first. If we find one,
2968 * we use it. Otherwise we next try to get an address on the
2969 * interface, which we should be able to do (unless non_asoc_addr_ok
2970 * is false and we are routed out that way). In these cases where we
2971 * can't use the address of the interface we go through all the
2972 * ifn's looking for an address we can use and fill that in. Punting
2973 * means we send back address 0, which will probably cause problems
2974 * actually since then IP will fill in the address of the route ifn,
2975 * which means we probably already rejected it.. i.e. here comes an
2976 * abort :-<.
2977 */
2978 vrf = sctp_find_vrf(vrf_id);
2979 if (vrf == NULL)
2980 return (NULL);
2981
2982 ifn = SCTP_GET_IFN_VOID_FROM_ROUTE(ro);
2983 ifn_index = SCTP_GET_IF_INDEX_FROM_ROUTE(ro);
2984 SCTPDBG(SCTP_DEBUG_OUTPUT2, "ifn from route:%p ifn_index:%d\n", ifn, ifn_index);
2985 emit_ifn = looked_at = sctp_ifn = sctp_find_ifn(ifn, ifn_index);
2986 if (sctp_ifn == NULL) {
2987 /* ?? We don't have this guy ?? */
2988 SCTPDBG(SCTP_DEBUG_OUTPUT2, "No ifn emit interface?\n");
2989 goto bound_all_plan_b;
2990 }
2991 SCTPDBG(SCTP_DEBUG_OUTPUT2, "ifn_index:%d name:%s is emit interface\n",
2992 ifn_index, sctp_ifn->ifn_name);
2993
2994 if (net) {
2995 cur_addr_num = net->indx_of_eligible_next_to_use;
2996 }
2997 num_preferred = sctp_count_num_preferred_boundall(sctp_ifn,
2998 inp, stcb,
2999 non_asoc_addr_ok,
3000 dest_is_loop,
3001 dest_is_priv, fam);
3002 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Found %d preferred source addresses for intf:%s\n",
3003 num_preferred, sctp_ifn->ifn_name);
3004 if (num_preferred == 0) {
3005 /*
3006 * no eligible addresses, we must use some other interface
3007 * address if we can find one.
3008 */
3009 goto bound_all_plan_b;
3010 }
3011 /*
3012 * Ok we have num_eligible_addr set with how many we can use, this
3013 * may vary from call to call due to addresses being deprecated
3014 * etc..
3015 */
3016 if (cur_addr_num >= num_preferred) {
3017 cur_addr_num = 0;
3018 }
3019 /*
3020 * select the nth address from the list (where cur_addr_num is the
3021 * nth) and 0 is the first one, 1 is the second one etc...
3022 */
3023 SCTPDBG(SCTP_DEBUG_OUTPUT2, "cur_addr_num:%d\n", cur_addr_num);
3024
3025 sctp_ifa = sctp_select_nth_preferred_addr_from_ifn_boundall(sctp_ifn, inp, stcb, non_asoc_addr_ok, dest_is_loop,
3026 dest_is_priv, cur_addr_num, fam, ro);
3027
3028 /* if sctp_ifa is NULL something changed??, fall to plan b. */
3029 if (sctp_ifa) {
3030 atomic_add_int(&sctp_ifa->refcount, 1);
3031 if (net) {
3032 /* save off where the next one we will want */
3033 net->indx_of_eligible_next_to_use = cur_addr_num + 1;
3034 }
3035 return (sctp_ifa);
3036 }
3037 /*
3038 * plan_b: Look at all interfaces and find a preferred address. If
3039 * no preferred fall through to plan_c.
3040 */
3041 bound_all_plan_b:
3042 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Trying Plan B\n");
3043 LIST_FOREACH(sctp_ifn, &vrf->ifnlist, next_ifn) {
3044 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Examine interface %s\n",
3045 sctp_ifn->ifn_name);
3046 if (dest_is_loop == 0 && SCTP_IFN_IS_IFT_LOOP(sctp_ifn)) {
3047 /* wrong base scope */
3048 SCTPDBG(SCTP_DEBUG_OUTPUT2, "skip\n");
3049 continue;
3050 }
3051 if ((sctp_ifn == looked_at) && looked_at) {
3052 /* already looked at this guy */
3053 SCTPDBG(SCTP_DEBUG_OUTPUT2, "already seen\n");
3054 continue;
3055 }
3056 num_preferred = sctp_count_num_preferred_boundall(sctp_ifn, inp, stcb, non_asoc_addr_ok,
3057 dest_is_loop, dest_is_priv, fam);
3058 SCTPDBG(SCTP_DEBUG_OUTPUT2,
3059 "Found ifn:%p %d preferred source addresses\n",
3060 ifn, num_preferred);
3061 if (num_preferred == 0) {
3062 /* None on this interface. */
3063 SCTPDBG(SCTP_DEBUG_OUTPUT2, "No preferred -- skipping to next\n");
3064 continue;
3065 }
3066 SCTPDBG(SCTP_DEBUG_OUTPUT2,
3067 "num preferred:%d on interface:%p cur_addr_num:%d\n",
3068 num_preferred, (void *)sctp_ifn, cur_addr_num);
3069
3070 /*
3071 * Ok we have num_eligible_addr set with how many we can
3072 * use, this may vary from call to call due to addresses
3073 * being deprecated etc..
3074 */
3075 if (cur_addr_num >= num_preferred) {
3076 cur_addr_num = 0;
3077 }
3078 sifa = sctp_select_nth_preferred_addr_from_ifn_boundall(sctp_ifn, inp, stcb, non_asoc_addr_ok, dest_is_loop,
3079 dest_is_priv, cur_addr_num, fam, ro);
3080 if (sifa == NULL)
3081 continue;
3082 if (net) {
3083 net->indx_of_eligible_next_to_use = cur_addr_num + 1;
3084 SCTPDBG(SCTP_DEBUG_OUTPUT2, "we selected %d\n",
3085 cur_addr_num);
3086 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Source:");
3087 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &sifa->address.sa);
3088 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Dest:");
3089 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &net->ro._l_addr.sa);
3090 }
3091 atomic_add_int(&sifa->refcount, 1);
3092 return (sifa);
3093 }
3094 #ifdef INET
3095 again_with_private_addresses_allowed:
3096 #endif
3097 /* plan_c: do we have an acceptable address on the emit interface */
3098 sifa = NULL;
3099 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Trying Plan C: find acceptable on interface\n");
3100 if (emit_ifn == NULL) {
3101 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Jump to Plan D - no emit_ifn\n");
3102 goto plan_d;
3103 }
3104 LIST_FOREACH(sctp_ifa, &emit_ifn->ifalist, next_ifa) {
3105 SCTPDBG(SCTP_DEBUG_OUTPUT2, "ifa:%p\n", (void *)sctp_ifa);
3106 #ifdef INET
3107 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
3108 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
3109 &sctp_ifa->address.sin.sin_addr) != 0)) {
3110 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Jailed\n");
3111 continue;
3112 }
3113 #endif
3114 #ifdef INET6
3115 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
3116 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
3117 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
3118 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Jailed\n");
3119 continue;
3120 }
3121 #endif
3122 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
3123 (non_asoc_addr_ok == 0)) {
3124 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Defer\n");
3125 continue;
3126 }
3127 sifa = sctp_is_ifa_addr_acceptable(sctp_ifa, dest_is_loop,
3128 dest_is_priv, fam);
3129 if (sifa == NULL) {
3130 SCTPDBG(SCTP_DEBUG_OUTPUT2, "IFA not acceptable\n");
3131 continue;
3132 }
3133 if (stcb) {
3134 if (sctp_is_address_in_scope(sifa, &stcb->asoc.scope, 0) == 0) {
3135 SCTPDBG(SCTP_DEBUG_OUTPUT2, "NOT in scope\n");
3136 sifa = NULL;
3137 continue;
3138 }
3139 if (((non_asoc_addr_ok == 0) &&
3140 (sctp_is_addr_restricted(stcb, sifa))) ||
3141 (non_asoc_addr_ok &&
3142 (sctp_is_addr_restricted(stcb, sifa)) &&
3143 (!sctp_is_addr_pending(stcb, sifa)))) {
3144 /*
3145 * It is restricted for some reason..
3146 * probably not yet added.
3147 */
3148 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Its restricted\n");
3149 sifa = NULL;
3150 continue;
3151 }
3152 }
3153 atomic_add_int(&sifa->refcount, 1);
3154 goto out;
3155 }
3156 plan_d:
3157 /*
3158 * plan_d: We are in trouble. No preferred address on the emit
3159 * interface. And not even a preferred address on all interfaces. Go
3160 * out and see if we can find an acceptable address somewhere
3161 * amongst all interfaces.
3162 */
3163 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Trying Plan D looked_at is %p\n", (void *)looked_at);
3164 LIST_FOREACH(sctp_ifn, &vrf->ifnlist, next_ifn) {
3165 if (dest_is_loop == 0 && SCTP_IFN_IS_IFT_LOOP(sctp_ifn)) {
3166 /* wrong base scope */
3167 continue;
3168 }
3169 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
3170 #ifdef INET
3171 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
3172 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
3173 &sctp_ifa->address.sin.sin_addr) != 0)) {
3174 continue;
3175 }
3176 #endif
3177 #ifdef INET6
3178 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
3179 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
3180 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
3181 continue;
3182 }
3183 #endif
3184 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
3185 (non_asoc_addr_ok == 0))
3186 continue;
3187 sifa = sctp_is_ifa_addr_acceptable(sctp_ifa,
3188 dest_is_loop,
3189 dest_is_priv, fam);
3190 if (sifa == NULL)
3191 continue;
3192 if (stcb) {
3193 if (sctp_is_address_in_scope(sifa, &stcb->asoc.scope, 0) == 0) {
3194 sifa = NULL;
3195 continue;
3196 }
3197 if (((non_asoc_addr_ok == 0) &&
3198 (sctp_is_addr_restricted(stcb, sifa))) ||
3199 (non_asoc_addr_ok &&
3200 (sctp_is_addr_restricted(stcb, sifa)) &&
3201 (!sctp_is_addr_pending(stcb, sifa)))) {
3202 /*
3203 * It is restricted for some
3204 * reason.. probably not yet added.
3205 */
3206 sifa = NULL;
3207 continue;
3208 }
3209 }
3210 goto out;
3211 }
3212 }
3213 #ifdef INET
3214 if (stcb) {
3215 if ((retried == 0) && (stcb->asoc.scope.ipv4_local_scope == 0)) {
3216 stcb->asoc.scope.ipv4_local_scope = 1;
3217 retried = 1;
3218 goto again_with_private_addresses_allowed;
3219 } else if (retried == 1) {
3220 stcb->asoc.scope.ipv4_local_scope = 0;
3221 }
3222 }
3223 #endif
3224 out:
3225 #ifdef INET
3226 if (sifa) {
3227 if (retried == 1) {
3228 LIST_FOREACH(sctp_ifn, &vrf->ifnlist, next_ifn) {
3229 if (dest_is_loop == 0 && SCTP_IFN_IS_IFT_LOOP(sctp_ifn)) {
3230 /* wrong base scope */
3231 continue;
3232 }
3233 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
3234 struct sctp_ifa *tmp_sifa;
3235
3236 #ifdef INET
3237 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
3238 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
3239 &sctp_ifa->address.sin.sin_addr) != 0)) {
3240 continue;
3241 }
3242 #endif
3243 #ifdef INET6
3244 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
3245 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
3246 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
3247 continue;
3248 }
3249 #endif
3250 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
3251 (non_asoc_addr_ok == 0))
3252 continue;
3253 tmp_sifa = sctp_is_ifa_addr_acceptable(sctp_ifa,
3254 dest_is_loop,
3255 dest_is_priv, fam);
3256 if (tmp_sifa == NULL) {
3257 continue;
3258 }
3259 if (tmp_sifa == sifa) {
3260 continue;
3261 }
3262 if (stcb) {
3263 if (sctp_is_address_in_scope(tmp_sifa,
3264 &stcb->asoc.scope, 0) == 0) {
3265 continue;
3266 }
3267 if (((non_asoc_addr_ok == 0) &&
3268 (sctp_is_addr_restricted(stcb, tmp_sifa))) ||
3269 (non_asoc_addr_ok &&
3270 (sctp_is_addr_restricted(stcb, tmp_sifa)) &&
3271 (!sctp_is_addr_pending(stcb, tmp_sifa)))) {
3272 /*
3273 * It is restricted
3274 * for some reason..
3275 * probably not yet
3276 * added.
3277 */
3278 continue;
3279 }
3280 }
3281 if ((tmp_sifa->address.sin.sin_family == AF_INET) &&
3282 (IN4_ISPRIVATE_ADDRESS(&(tmp_sifa->address.sin.sin_addr)))) {
3283 sctp_add_local_addr_restricted(stcb, tmp_sifa);
3284 }
3285 }
3286 }
3287 }
3288 atomic_add_int(&sifa->refcount, 1);
3289 }
3290 #endif
3291 return (sifa);
3292 }
3293
3294 /* tcb may be NULL */
3295 struct sctp_ifa *
3296 sctp_source_address_selection(struct sctp_inpcb *inp,
3297 struct sctp_tcb *stcb,
3298 sctp_route_t *ro,
3299 struct sctp_nets *net,
3300 int non_asoc_addr_ok, uint32_t vrf_id)
3301 {
3302 struct sctp_ifa *answer;
3303 uint8_t dest_is_priv, dest_is_loop;
3304 sa_family_t fam;
3305 #ifdef INET
3306 struct sockaddr_in *to = (struct sockaddr_in *)&ro->ro_dst;
3307 #endif
3308 #ifdef INET6
3309 struct sockaddr_in6 *to6 = (struct sockaddr_in6 *)&ro->ro_dst;
3310 #endif
3311
3312 /**
3313 * Rules:
3314 * - Find the route if needed, cache if I can.
3315 * - Look at interface address in route, Is it in the bound list. If so we
3316 * have the best source.
3317 * - If not we must rotate amongst the addresses.
3318 *
3319 * Caveats and issues
3320 *
3321 * Do we need to pay attention to scope. We can have a private address
3322 * or a global address we are sourcing or sending to. So if we draw
3323 * it out
3324 * zzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzz
3325 * For V4
3326 * ------------------------------------------
3327 * source * dest * result
3328 * -----------------------------------------
3329 * <a> Private * Global * NAT
3330 * -----------------------------------------
3331 * <b> Private * Private * No problem
3332 * -----------------------------------------
3333 * <c> Global * Private * Huh, How will this work?
3334 * -----------------------------------------
3335 * <d> Global * Global * No Problem
3336 *------------------------------------------
3337 * zzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzz
3338 * For V6
3339 *------------------------------------------
3340 * source * dest * result
3341 * -----------------------------------------
3342 * <a> Linklocal * Global *
3343 * -----------------------------------------
3344 * <b> Linklocal * Linklocal * No problem
3345 * -----------------------------------------
3346 * <c> Global * Linklocal * Huh, How will this work?
3347 * -----------------------------------------
3348 * <d> Global * Global * No Problem
3349 *------------------------------------------
3350 * zzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzz
3351 *
3352 * And then we add to that what happens if there are multiple addresses
3353 * assigned to an interface. Remember the ifa on a ifn is a linked
3354 * list of addresses. So one interface can have more than one IP
3355 * address. What happens if we have both a private and a global
3356 * address? Do we then use context of destination to sort out which
3357 * one is best? And what about NAT's sending P->G may get you a NAT
3358 * translation, or should you select the G thats on the interface in
3359 * preference.
3360 *
3361 * Decisions:
3362 *
3363 * - count the number of addresses on the interface.
3364 * - if it is one, no problem except case <c>.
3365 * For <a> we will assume a NAT out there.
3366 * - if there are more than one, then we need to worry about scope P
3367 * or G. We should prefer G -> G and P -> P if possible.
3368 * Then as a secondary fall back to mixed types G->P being a last
3369 * ditch one.
3370 * - The above all works for bound all, but bound specific we need to
3371 * use the same concept but instead only consider the bound
3372 * addresses. If the bound set is NOT assigned to the interface then
3373 * we must use rotation amongst the bound addresses..
3374 */
3375 if (ro->ro_nh == NULL) {
3376 /*
3377 * Need a route to cache.
3378 */
3379 SCTP_RTALLOC(ro, vrf_id, inp->fibnum);
3380 }
3381 if (ro->ro_nh == NULL) {
3382 return (NULL);
3383 }
3384 fam = ro->ro_dst.sa_family;
3385 dest_is_priv = dest_is_loop = 0;
3386 /* Setup our scopes for the destination */
3387 switch (fam) {
3388 #ifdef INET
3389 case AF_INET:
3390 /* Scope based on outbound address */
3391 if (IN4_ISLOOPBACK_ADDRESS(&to->sin_addr)) {
3392 dest_is_loop = 1;
3393 if (net != NULL) {
3394 /* mark it as local */
3395 net->addr_is_local = 1;
3396 }
3397 } else if ((IN4_ISPRIVATE_ADDRESS(&to->sin_addr))) {
3398 dest_is_priv = 1;
3399 }
3400 break;
3401 #endif
3402 #ifdef INET6
3403 case AF_INET6:
3404 /* Scope based on outbound address */
3405 if (IN6_IS_ADDR_LOOPBACK(&to6->sin6_addr) ||
3406 SCTP_ROUTE_IS_REAL_LOOP(ro)) {
3407 /*
3408 * If the address is a loopback address, which
3409 * consists of "::1" OR "fe80::1%lo0", we are
3410 * loopback scope. But we don't use dest_is_priv
3411 * (link local addresses).
3412 */
3413 dest_is_loop = 1;
3414 if (net != NULL) {
3415 /* mark it as local */
3416 net->addr_is_local = 1;
3417 }
3418 } else if (IN6_IS_ADDR_LINKLOCAL(&to6->sin6_addr)) {
3419 dest_is_priv = 1;
3420 }
3421 break;
3422 #endif
3423 }
3424 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Select source addr for:");
3425 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)&ro->ro_dst);
3426 SCTP_IPI_ADDR_RLOCK();
3427 if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) {
3428 /*
3429 * Bound all case
3430 */
3431 answer = sctp_choose_boundall(inp, stcb, net, ro, vrf_id,
3432 dest_is_priv, dest_is_loop,
3433 non_asoc_addr_ok, fam);
3434 SCTP_IPI_ADDR_RUNLOCK();
3435 return (answer);
3436 }
3437 /*
3438 * Subset bound case
3439 */
3440 if (stcb) {
3441 answer = sctp_choose_boundspecific_stcb(inp, stcb, ro,
3442 vrf_id, dest_is_priv,
3443 dest_is_loop,
3444 non_asoc_addr_ok, fam);
3445 } else {
3446 answer = sctp_choose_boundspecific_inp(inp, ro, vrf_id,
3447 non_asoc_addr_ok,
3448 dest_is_priv,
3449 dest_is_loop, fam);
3450 }
3451 SCTP_IPI_ADDR_RUNLOCK();
3452 return (answer);
3453 }
3454
3455 static bool
3456 sctp_find_cmsg(int c_type, void *data, struct mbuf *control, size_t cpsize)
3457 {
3458 struct cmsghdr cmh;
3459 struct sctp_sndinfo sndinfo;
3460 struct sctp_prinfo prinfo;
3461 struct sctp_authinfo authinfo;
3462 int tot_len, rem_len, cmsg_data_len, cmsg_data_off, off;
3463 bool found;
3464
3465 /*
3466 * Independent of how many mbufs, find the c_type inside the control
3467 * structure and copy out the data.
3468 */
3469 found = false;
3470 tot_len = SCTP_BUF_LEN(control);
3471 for (off = 0; off < tot_len; off += CMSG_ALIGN(cmh.cmsg_len)) {
3472 rem_len = tot_len - off;
3473 if (rem_len < (int)CMSG_ALIGN(sizeof(cmh))) {
3474 /* There is not enough room for one more. */
3475 return (found);
3476 }
3477 m_copydata(control, off, sizeof(cmh), (caddr_t)&cmh);
3478 if (cmh.cmsg_len < CMSG_ALIGN(sizeof(cmh))) {
3479 /* We dont't have a complete CMSG header. */
3480 return (found);
3481 }
3482 if ((cmh.cmsg_len > INT_MAX) || ((int)cmh.cmsg_len > rem_len)) {
3483 /* We don't have the complete CMSG. */
3484 return (found);
3485 }
3486 cmsg_data_len = (int)cmh.cmsg_len - CMSG_ALIGN(sizeof(cmh));
3487 cmsg_data_off = off + CMSG_ALIGN(sizeof(cmh));
3488 if ((cmh.cmsg_level == IPPROTO_SCTP) &&
3489 ((c_type == cmh.cmsg_type) ||
3490 ((c_type == SCTP_SNDRCV) &&
3491 ((cmh.cmsg_type == SCTP_SNDINFO) ||
3492 (cmh.cmsg_type == SCTP_PRINFO) ||
3493 (cmh.cmsg_type == SCTP_AUTHINFO))))) {
3494 if (c_type == cmh.cmsg_type) {
3495 if (cpsize > INT_MAX) {
3496 return (found);
3497 }
3498 if (cmsg_data_len < (int)cpsize) {
3499 return (found);
3500 }
3501 /* It is exactly what we want. Copy it out. */
3502 m_copydata(control, cmsg_data_off, (int)cpsize, (caddr_t)data);
3503 return (1);
3504 } else {
3505 struct sctp_sndrcvinfo *sndrcvinfo;
3506
3507 sndrcvinfo = (struct sctp_sndrcvinfo *)data;
3508 if (!found) {
3509 if (cpsize < sizeof(struct sctp_sndrcvinfo)) {
3510 return (found);
3511 }
3512 memset(sndrcvinfo, 0, sizeof(struct sctp_sndrcvinfo));
3513 }
3514 switch (cmh.cmsg_type) {
3515 case SCTP_SNDINFO:
3516 if (cmsg_data_len < (int)sizeof(struct sctp_sndinfo)) {
3517 return (found);
3518 }
3519 m_copydata(control, cmsg_data_off, sizeof(struct sctp_sndinfo), (caddr_t)&sndinfo);
3520 sndrcvinfo->sinfo_stream = sndinfo.snd_sid;
3521 sndrcvinfo->sinfo_flags = sndinfo.snd_flags;
3522 sndrcvinfo->sinfo_ppid = sndinfo.snd_ppid;
3523 sndrcvinfo->sinfo_context = sndinfo.snd_context;
3524 sndrcvinfo->sinfo_assoc_id = sndinfo.snd_assoc_id;
3525 break;
3526 case SCTP_PRINFO:
3527 if (cmsg_data_len < (int)sizeof(struct sctp_prinfo)) {
3528 return (found);
3529 }
3530 m_copydata(control, cmsg_data_off, sizeof(struct sctp_prinfo), (caddr_t)&prinfo);
3531 if (prinfo.pr_policy != SCTP_PR_SCTP_NONE) {
3532 sndrcvinfo->sinfo_timetolive = prinfo.pr_value;
3533 } else {
3534 sndrcvinfo->sinfo_timetolive = 0;
3535 }
3536 sndrcvinfo->sinfo_flags |= prinfo.pr_policy;
3537 break;
3538 case SCTP_AUTHINFO:
3539 if (cmsg_data_len < (int)sizeof(struct sctp_authinfo)) {
3540 return (found);
3541 }
3542 m_copydata(control, cmsg_data_off, sizeof(struct sctp_authinfo), (caddr_t)&authinfo);
3543 sndrcvinfo->sinfo_keynumber_valid = 1;
3544 sndrcvinfo->sinfo_keynumber = authinfo.auth_keynumber;
3545 break;
3546 default:
3547 return (found);
3548 }
3549 found = true;
3550 }
3551 }
3552 }
3553 return (found);
3554 }
3555
3556 static int
3557 sctp_process_cmsgs_for_init(struct sctp_tcb *stcb, struct mbuf *control, int *error)
3558 {
3559 struct cmsghdr cmh;
3560 struct sctp_initmsg initmsg;
3561 #ifdef INET
3562 struct sockaddr_in sin;
3563 #endif
3564 #ifdef INET6
3565 struct sockaddr_in6 sin6;
3566 #endif
3567 int tot_len, rem_len, cmsg_data_len, cmsg_data_off, off;
3568
3569 tot_len = SCTP_BUF_LEN(control);
3570 for (off = 0; off < tot_len; off += CMSG_ALIGN(cmh.cmsg_len)) {
3571 rem_len = tot_len - off;
3572 if (rem_len < (int)CMSG_ALIGN(sizeof(cmh))) {
3573 /* There is not enough room for one more. */
3574 *error = EINVAL;
3575 return (1);
3576 }
3577 m_copydata(control, off, sizeof(cmh), (caddr_t)&cmh);
3578 if (cmh.cmsg_len < CMSG_ALIGN(sizeof(cmh))) {
3579 /* We dont't have a complete CMSG header. */
3580 *error = EINVAL;
3581 return (1);
3582 }
3583 if ((cmh.cmsg_len > INT_MAX) || ((int)cmh.cmsg_len > rem_len)) {
3584 /* We don't have the complete CMSG. */
3585 *error = EINVAL;
3586 return (1);
3587 }
3588 cmsg_data_len = (int)cmh.cmsg_len - CMSG_ALIGN(sizeof(cmh));
3589 cmsg_data_off = off + CMSG_ALIGN(sizeof(cmh));
3590 if (cmh.cmsg_level == IPPROTO_SCTP) {
3591 switch (cmh.cmsg_type) {
3592 case SCTP_INIT:
3593 if (cmsg_data_len < (int)sizeof(struct sctp_initmsg)) {
3594 *error = EINVAL;
3595 return (1);
3596 }
3597 m_copydata(control, cmsg_data_off, sizeof(struct sctp_initmsg), (caddr_t)&initmsg);
3598 if (initmsg.sinit_max_attempts)
3599 stcb->asoc.max_init_times = initmsg.sinit_max_attempts;
3600 if (initmsg.sinit_num_ostreams)
3601 stcb->asoc.pre_open_streams = initmsg.sinit_num_ostreams;
3602 if (initmsg.sinit_max_instreams)
3603 stcb->asoc.max_inbound_streams = initmsg.sinit_max_instreams;
3604 if (initmsg.sinit_max_init_timeo)
3605 stcb->asoc.initial_init_rto_max = initmsg.sinit_max_init_timeo;
3606 if (stcb->asoc.streamoutcnt < stcb->asoc.pre_open_streams) {
3607 struct sctp_stream_out *tmp_str;
3608 unsigned int i;
3609 #if defined(SCTP_DETAILED_STR_STATS)
3610 int j;
3611 #endif
3612
3613 /* Default is NOT correct */
3614 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Ok, default:%d pre_open:%d\n",
3615 stcb->asoc.streamoutcnt, stcb->asoc.pre_open_streams);
3616 SCTP_TCB_UNLOCK(stcb);
3617 SCTP_MALLOC(tmp_str,
3618 struct sctp_stream_out *,
3619 (stcb->asoc.pre_open_streams * sizeof(struct sctp_stream_out)),
3620 SCTP_M_STRMO);
3621 SCTP_TCB_LOCK(stcb);
3622 if (tmp_str != NULL) {
3623 SCTP_FREE(stcb->asoc.strmout, SCTP_M_STRMO);
3624 stcb->asoc.strmout = tmp_str;
3625 stcb->asoc.strm_realoutsize = stcb->asoc.streamoutcnt = stcb->asoc.pre_open_streams;
3626 } else {
3627 stcb->asoc.pre_open_streams = stcb->asoc.streamoutcnt;
3628 }
3629 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
3630 TAILQ_INIT(&stcb->asoc.strmout[i].outqueue);
3631 stcb->asoc.ss_functions.sctp_ss_init_stream(stcb, &stcb->asoc.strmout[i], NULL);
3632 stcb->asoc.strmout[i].chunks_on_queues = 0;
3633 #if defined(SCTP_DETAILED_STR_STATS)
3634 for (j = 0; j < SCTP_PR_SCTP_MAX + 1; j++) {
3635 stcb->asoc.strmout[i].abandoned_sent[j] = 0;
3636 stcb->asoc.strmout[i].abandoned_unsent[j] = 0;
3637 }
3638 #else
3639 stcb->asoc.strmout[i].abandoned_sent[0] = 0;
3640 stcb->asoc.strmout[i].abandoned_unsent[0] = 0;
3641 #endif
3642 stcb->asoc.strmout[i].next_mid_ordered = 0;
3643 stcb->asoc.strmout[i].next_mid_unordered = 0;
3644 stcb->asoc.strmout[i].sid = i;
3645 stcb->asoc.strmout[i].last_msg_incomplete = 0;
3646 stcb->asoc.strmout[i].state = SCTP_STREAM_OPENING;
3647 }
3648 }
3649 break;
3650 #ifdef INET
3651 case SCTP_DSTADDRV4:
3652 if (cmsg_data_len < (int)sizeof(struct in_addr)) {
3653 *error = EINVAL;
3654 return (1);
3655 }
3656 memset(&sin, 0, sizeof(struct sockaddr_in));
3657 sin.sin_family = AF_INET;
3658 sin.sin_len = sizeof(struct sockaddr_in);
3659 sin.sin_port = stcb->rport;
3660 m_copydata(control, cmsg_data_off, sizeof(struct in_addr), (caddr_t)&sin.sin_addr);
3661 if ((sin.sin_addr.s_addr == INADDR_ANY) ||
3662 (sin.sin_addr.s_addr == INADDR_BROADCAST) ||
3663 IN_MULTICAST(ntohl(sin.sin_addr.s_addr))) {
3664 *error = EINVAL;
3665 return (1);
3666 }
3667 if (sctp_add_remote_addr(stcb, (struct sockaddr *)&sin, NULL, stcb->asoc.port,
3668 SCTP_DONOT_SETSCOPE, SCTP_ADDR_IS_CONFIRMED)) {
3669 *error = ENOBUFS;
3670 return (1);
3671 }
3672 break;
3673 #endif
3674 #ifdef INET6
3675 case SCTP_DSTADDRV6:
3676 if (cmsg_data_len < (int)sizeof(struct in6_addr)) {
3677 *error = EINVAL;
3678 return (1);
3679 }
3680 memset(&sin6, 0, sizeof(struct sockaddr_in6));
3681 sin6.sin6_family = AF_INET6;
3682 sin6.sin6_len = sizeof(struct sockaddr_in6);
3683 sin6.sin6_port = stcb->rport;
3684 m_copydata(control, cmsg_data_off, sizeof(struct in6_addr), (caddr_t)&sin6.sin6_addr);
3685 if (IN6_IS_ADDR_UNSPECIFIED(&sin6.sin6_addr) ||
3686 IN6_IS_ADDR_MULTICAST(&sin6.sin6_addr)) {
3687 *error = EINVAL;
3688 return (1);
3689 }
3690 #ifdef INET
3691 if (IN6_IS_ADDR_V4MAPPED(&sin6.sin6_addr)) {
3692 in6_sin6_2_sin(&sin, &sin6);
3693 if ((sin.sin_addr.s_addr == INADDR_ANY) ||
3694 (sin.sin_addr.s_addr == INADDR_BROADCAST) ||
3695 IN_MULTICAST(ntohl(sin.sin_addr.s_addr))) {
3696 *error = EINVAL;
3697 return (1);
3698 }
3699 if (sctp_add_remote_addr(stcb, (struct sockaddr *)&sin, NULL, stcb->asoc.port,
3700 SCTP_DONOT_SETSCOPE, SCTP_ADDR_IS_CONFIRMED)) {
3701 *error = ENOBUFS;
3702 return (1);
3703 }
3704 } else
3705 #endif
3706 if (sctp_add_remote_addr(stcb, (struct sockaddr *)&sin6, NULL, stcb->asoc.port,
3707 SCTP_DONOT_SETSCOPE, SCTP_ADDR_IS_CONFIRMED)) {
3708 *error = ENOBUFS;
3709 return (1);
3710 }
3711 break;
3712 #endif
3713 default:
3714 break;
3715 }
3716 }
3717 }
3718 return (0);
3719 }
3720
3721 #if defined(INET) || defined(INET6)
3722 static struct sctp_tcb *
3723 sctp_findassociation_cmsgs(struct sctp_inpcb **inp_p,
3724 uint16_t port,
3725 struct mbuf *control,
3726 struct sctp_nets **net_p,
3727 int *error)
3728 {
3729 struct cmsghdr cmh;
3730 struct sctp_tcb *stcb;
3731 struct sockaddr *addr;
3732 #ifdef INET
3733 struct sockaddr_in sin;
3734 #endif
3735 #ifdef INET6
3736 struct sockaddr_in6 sin6;
3737 #endif
3738 int tot_len, rem_len, cmsg_data_len, cmsg_data_off, off;
3739
3740 tot_len = SCTP_BUF_LEN(control);
3741 for (off = 0; off < tot_len; off += CMSG_ALIGN(cmh.cmsg_len)) {
3742 rem_len = tot_len - off;
3743 if (rem_len < (int)CMSG_ALIGN(sizeof(cmh))) {
3744 /* There is not enough room for one more. */
3745 *error = EINVAL;
3746 return (NULL);
3747 }
3748 m_copydata(control, off, sizeof(cmh), (caddr_t)&cmh);
3749 if (cmh.cmsg_len < CMSG_ALIGN(sizeof(cmh))) {
3750 /* We dont't have a complete CMSG header. */
3751 *error = EINVAL;
3752 return (NULL);
3753 }
3754 if ((cmh.cmsg_len > INT_MAX) || ((int)cmh.cmsg_len > rem_len)) {
3755 /* We don't have the complete CMSG. */
3756 *error = EINVAL;
3757 return (NULL);
3758 }
3759 cmsg_data_len = (int)cmh.cmsg_len - CMSG_ALIGN(sizeof(cmh));
3760 cmsg_data_off = off + CMSG_ALIGN(sizeof(cmh));
3761 if (cmh.cmsg_level == IPPROTO_SCTP) {
3762 switch (cmh.cmsg_type) {
3763 #ifdef INET
3764 case SCTP_DSTADDRV4:
3765 if (cmsg_data_len < (int)sizeof(struct in_addr)) {
3766 *error = EINVAL;
3767 return (NULL);
3768 }
3769 memset(&sin, 0, sizeof(struct sockaddr_in));
3770 sin.sin_family = AF_INET;
3771 sin.sin_len = sizeof(struct sockaddr_in);
3772 sin.sin_port = port;
3773 m_copydata(control, cmsg_data_off, sizeof(struct in_addr), (caddr_t)&sin.sin_addr);
3774 addr = (struct sockaddr *)&sin;
3775 break;
3776 #endif
3777 #ifdef INET6
3778 case SCTP_DSTADDRV6:
3779 if (cmsg_data_len < (int)sizeof(struct in6_addr)) {
3780 *error = EINVAL;
3781 return (NULL);
3782 }
3783 memset(&sin6, 0, sizeof(struct sockaddr_in6));
3784 sin6.sin6_family = AF_INET6;
3785 sin6.sin6_len = sizeof(struct sockaddr_in6);
3786 sin6.sin6_port = port;
3787 m_copydata(control, cmsg_data_off, sizeof(struct in6_addr), (caddr_t)&sin6.sin6_addr);
3788 #ifdef INET
3789 if (IN6_IS_ADDR_V4MAPPED(&sin6.sin6_addr)) {
3790 in6_sin6_2_sin(&sin, &sin6);
3791 addr = (struct sockaddr *)&sin;
3792 } else
3793 #endif
3794 addr = (struct sockaddr *)&sin6;
3795 break;
3796 #endif
3797 default:
3798 addr = NULL;
3799 break;
3800 }
3801 if (addr) {
3802 stcb = sctp_findassociation_ep_addr(inp_p, addr, net_p, NULL, NULL);
3803 if (stcb != NULL) {
3804 return (stcb);
3805 }
3806 }
3807 }
3808 }
3809 return (NULL);
3810 }
3811 #endif
3812
3813 static struct mbuf *
3814 sctp_add_cookie(struct mbuf *init, int init_offset,
3815 struct mbuf *initack, int initack_offset, struct sctp_state_cookie *stc_in, uint8_t **signature)
3816 {
3817 struct mbuf *copy_init, *copy_initack, *m_at, *sig, *mret;
3818 struct sctp_state_cookie *stc;
3819 struct sctp_paramhdr *ph;
3820 uint16_t cookie_sz;
3821
3822 mret = sctp_get_mbuf_for_msg((sizeof(struct sctp_state_cookie) +
3823 sizeof(struct sctp_paramhdr)), 0,
3824 M_NOWAIT, 1, MT_DATA);
3825 if (mret == NULL) {
3826 return (NULL);
3827 }
3828 copy_init = SCTP_M_COPYM(init, init_offset, M_COPYALL, M_NOWAIT);
3829 if (copy_init == NULL) {
3830 sctp_m_freem(mret);
3831 return (NULL);
3832 }
3833 #ifdef SCTP_MBUF_LOGGING
3834 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
3835 sctp_log_mbc(copy_init, SCTP_MBUF_ICOPY);
3836 }
3837 #endif
3838 copy_initack = SCTP_M_COPYM(initack, initack_offset, M_COPYALL,
3839 M_NOWAIT);
3840 if (copy_initack == NULL) {
3841 sctp_m_freem(mret);
3842 sctp_m_freem(copy_init);
3843 return (NULL);
3844 }
3845 #ifdef SCTP_MBUF_LOGGING
3846 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
3847 sctp_log_mbc(copy_initack, SCTP_MBUF_ICOPY);
3848 }
3849 #endif
3850 /* easy side we just drop it on the end */
3851 ph = mtod(mret, struct sctp_paramhdr *);
3852 SCTP_BUF_LEN(mret) = sizeof(struct sctp_state_cookie) +
3853 sizeof(struct sctp_paramhdr);
3854 stc = (struct sctp_state_cookie *)((caddr_t)ph +
3855 sizeof(struct sctp_paramhdr));
3856 ph->param_type = htons(SCTP_STATE_COOKIE);
3857 ph->param_length = 0; /* fill in at the end */
3858 /* Fill in the stc cookie data */
3859 memcpy(stc, stc_in, sizeof(struct sctp_state_cookie));
3860
3861 /* tack the INIT and then the INIT-ACK onto the chain */
3862 cookie_sz = 0;
3863 for (m_at = mret; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
3864 cookie_sz += SCTP_BUF_LEN(m_at);
3865 if (SCTP_BUF_NEXT(m_at) == NULL) {
3866 SCTP_BUF_NEXT(m_at) = copy_init;
3867 break;
3868 }
3869 }
3870 for (m_at = copy_init; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
3871 cookie_sz += SCTP_BUF_LEN(m_at);
3872 if (SCTP_BUF_NEXT(m_at) == NULL) {
3873 SCTP_BUF_NEXT(m_at) = copy_initack;
3874 break;
3875 }
3876 }
3877 for (m_at = copy_initack; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
3878 cookie_sz += SCTP_BUF_LEN(m_at);
3879 if (SCTP_BUF_NEXT(m_at) == NULL) {
3880 break;
3881 }
3882 }
3883 sig = sctp_get_mbuf_for_msg(SCTP_SIGNATURE_SIZE, 0, M_NOWAIT, 1, MT_DATA);
3884 if (sig == NULL) {
3885 /* no space, so free the entire chain */
3886 sctp_m_freem(mret);
3887 return (NULL);
3888 }
3889 SCTP_BUF_NEXT(m_at) = sig;
3890 SCTP_BUF_LEN(sig) = SCTP_SIGNATURE_SIZE;
3891 cookie_sz += SCTP_SIGNATURE_SIZE;
3892 ph->param_length = htons(cookie_sz);
3893 *signature = (uint8_t *)mtod(sig, caddr_t);
3894 memset(*signature, 0, SCTP_SIGNATURE_SIZE);
3895 return (mret);
3896 }
3897
3898 static uint8_t
3899 sctp_get_ect(struct sctp_tcb *stcb)
3900 {
3901 if ((stcb != NULL) && (stcb->asoc.ecn_supported == 1)) {
3902 return (SCTP_ECT0_BIT);
3903 } else {
3904 return (0);
3905 }
3906 }
3907
3908 #if defined(INET) || defined(INET6)
3909 static void
3910 sctp_handle_no_route(struct sctp_tcb *stcb,
3911 struct sctp_nets *net,
3912 int so_locked)
3913 {
3914 SCTPDBG(SCTP_DEBUG_OUTPUT1, "dropped packet - no valid source addr\n");
3915
3916 if (net) {
3917 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Destination was ");
3918 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT1, &net->ro._l_addr.sa);
3919 if (net->dest_state & SCTP_ADDR_CONFIRMED) {
3920 if ((net->dest_state & SCTP_ADDR_REACHABLE) && stcb) {
3921 SCTPDBG(SCTP_DEBUG_OUTPUT1, "no route takes interface %p down\n", (void *)net);
3922 sctp_ulp_notify(SCTP_NOTIFY_INTERFACE_DOWN,
3923 stcb, 0,
3924 (void *)net,
3925 so_locked);
3926 net->dest_state &= ~SCTP_ADDR_REACHABLE;
3927 net->dest_state &= ~SCTP_ADDR_PF;
3928 }
3929 }
3930 if (stcb) {
3931 if (net == stcb->asoc.primary_destination) {
3932 /* need a new primary */
3933 struct sctp_nets *alt;
3934
3935 alt = sctp_find_alternate_net(stcb, net, 0);
3936 if (alt != net) {
3937 if (stcb->asoc.alternate) {
3938 sctp_free_remote_addr(stcb->asoc.alternate);
3939 }
3940 stcb->asoc.alternate = alt;
3941 atomic_add_int(&stcb->asoc.alternate->ref_count, 1);
3942 if (net->ro._s_addr) {
3943 sctp_free_ifa(net->ro._s_addr);
3944 net->ro._s_addr = NULL;
3945 }
3946 net->src_addr_selected = 0;
3947 }
3948 }
3949 }
3950 }
3951 }
3952 #endif
3953
3954 static int
3955 sctp_lowlevel_chunk_output(struct sctp_inpcb *inp,
3956 struct sctp_tcb *stcb, /* may be NULL */
3957 struct sctp_nets *net,
3958 struct sockaddr *to,
3959 struct mbuf *m,
3960 uint32_t auth_offset,
3961 struct sctp_auth_chunk *auth,
3962 uint16_t auth_keyid,
3963 int nofragment_flag,
3964 int ecn_ok,
3965 int out_of_asoc_ok,
3966 uint16_t src_port,
3967 uint16_t dest_port,
3968 uint32_t v_tag,
3969 uint16_t port,
3970 union sctp_sockstore *over_addr,
3971 uint8_t mflowtype, uint32_t mflowid,
3972 int so_locked)
3973 {
3974 /* nofragment_flag to tell if IP_DF should be set (IPv4 only) */
3975 /**
3976 * Given a mbuf chain (via SCTP_BUF_NEXT()) that holds a packet header
3977 * WITH an SCTPHDR but no IP header, endpoint inp and sa structure:
3978 * - fill in the HMAC digest of any AUTH chunk in the packet.
3979 * - calculate and fill in the SCTP checksum.
3980 * - prepend an IP address header.
3981 * - if boundall use INADDR_ANY.
3982 * - if boundspecific do source address selection.
3983 * - set fragmentation option for ipV4.
3984 * - On return from IP output, check/adjust mtu size of output
3985 * interface and smallest_mtu size as well.
3986 */
3987 /* Will need ifdefs around this */
3988 struct mbuf *newm;
3989 struct sctphdr *sctphdr;
3990 int packet_length;
3991 int ret;
3992 #if defined(INET) || defined(INET6)
3993 uint32_t vrf_id;
3994 #endif
3995 #if defined(INET) || defined(INET6)
3996 struct mbuf *o_pak;
3997 sctp_route_t *ro = NULL;
3998 struct udphdr *udp = NULL;
3999 #endif
4000 uint8_t tos_value;
4001
4002 if ((net) && (net->dest_state & SCTP_ADDR_OUT_OF_SCOPE)) {
4003 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EFAULT);
4004 sctp_m_freem(m);
4005 return (EFAULT);
4006 }
4007 #if defined(INET) || defined(INET6)
4008 if (stcb) {
4009 vrf_id = stcb->asoc.vrf_id;
4010 } else {
4011 vrf_id = inp->def_vrf_id;
4012 }
4013 #endif
4014 /* fill in the HMAC digest for any AUTH chunk in the packet */
4015 if ((auth != NULL) && (stcb != NULL)) {
4016 sctp_fill_hmac_digest_m(m, auth_offset, auth, stcb, auth_keyid);
4017 }
4018
4019 if (net) {
4020 tos_value = net->dscp;
4021 } else if (stcb) {
4022 tos_value = stcb->asoc.default_dscp;
4023 } else {
4024 tos_value = inp->sctp_ep.default_dscp;
4025 }
4026
4027 switch (to->sa_family) {
4028 #ifdef INET
4029 case AF_INET:
4030 {
4031 struct ip *ip = NULL;
4032 sctp_route_t iproute;
4033 int len;
4034
4035 len = SCTP_MIN_V4_OVERHEAD;
4036 if (port) {
4037 len += sizeof(struct udphdr);
4038 }
4039 newm = sctp_get_mbuf_for_msg(len, 1, M_NOWAIT, 1, MT_DATA);
4040 if (newm == NULL) {
4041 sctp_m_freem(m);
4042 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4043 return (ENOMEM);
4044 }
4045 SCTP_ALIGN_TO_END(newm, len);
4046 SCTP_BUF_LEN(newm) = len;
4047 SCTP_BUF_NEXT(newm) = m;
4048 m = newm;
4049 if (net != NULL) {
4050 m->m_pkthdr.flowid = net->flowid;
4051 M_HASHTYPE_SET(m, net->flowtype);
4052 } else {
4053 m->m_pkthdr.flowid = mflowid;
4054 M_HASHTYPE_SET(m, mflowtype);
4055 }
4056 packet_length = sctp_calculate_len(m);
4057 ip = mtod(m, struct ip *);
4058 ip->ip_v = IPVERSION;
4059 ip->ip_hl = (sizeof(struct ip) >> 2);
4060 if (tos_value == 0) {
4061 /*
4062 * This means especially, that it is not set
4063 * at the SCTP layer. So use the value from
4064 * the IP layer.
4065 */
4066 tos_value = inp->ip_inp.inp.inp_ip_tos;
4067 }
4068 tos_value &= 0xfc;
4069 if (ecn_ok) {
4070 tos_value |= sctp_get_ect(stcb);
4071 }
4072 if ((nofragment_flag) && (port == 0)) {
4073 ip->ip_off = htons(IP_DF);
4074 } else {
4075 ip->ip_off = htons(0);
4076 }
4077 /* FreeBSD has a function for ip_id's */
4078 ip_fillid(ip);
4079
4080 ip->ip_ttl = inp->ip_inp.inp.inp_ip_ttl;
4081 ip->ip_len = htons(packet_length);
4082 ip->ip_tos = tos_value;
4083 if (port) {
4084 ip->ip_p = IPPROTO_UDP;
4085 } else {
4086 ip->ip_p = IPPROTO_SCTP;
4087 }
4088 ip->ip_sum = 0;
4089 if (net == NULL) {
4090 ro = &iproute;
4091 memset(&iproute, 0, sizeof(iproute));
4092 memcpy(&ro->ro_dst, to, to->sa_len);
4093 } else {
4094 ro = (sctp_route_t *)&net->ro;
4095 }
4096 /* Now the address selection part */
4097 ip->ip_dst.s_addr = ((struct sockaddr_in *)to)->sin_addr.s_addr;
4098
4099 /* call the routine to select the src address */
4100 if (net && out_of_asoc_ok == 0) {
4101 if (net->ro._s_addr && (net->ro._s_addr->localifa_flags & (SCTP_BEING_DELETED | SCTP_ADDR_IFA_UNUSEABLE))) {
4102 sctp_free_ifa(net->ro._s_addr);
4103 net->ro._s_addr = NULL;
4104 net->src_addr_selected = 0;
4105 RO_NHFREE(ro);
4106 }
4107 if (net->src_addr_selected == 0) {
4108 /* Cache the source address */
4109 net->ro._s_addr = sctp_source_address_selection(inp, stcb,
4110 ro, net, 0,
4111 vrf_id);
4112 net->src_addr_selected = 1;
4113 }
4114 if (net->ro._s_addr == NULL) {
4115 /* No route to host */
4116 net->src_addr_selected = 0;
4117 sctp_handle_no_route(stcb, net, so_locked);
4118 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4119 sctp_m_freem(m);
4120 return (EHOSTUNREACH);
4121 }
4122 ip->ip_src = net->ro._s_addr->address.sin.sin_addr;
4123 } else {
4124 if (over_addr == NULL) {
4125 struct sctp_ifa *_lsrc;
4126
4127 _lsrc = sctp_source_address_selection(inp, stcb, ro,
4128 net,
4129 out_of_asoc_ok,
4130 vrf_id);
4131 if (_lsrc == NULL) {
4132 sctp_handle_no_route(stcb, net, so_locked);
4133 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4134 sctp_m_freem(m);
4135 return (EHOSTUNREACH);
4136 }
4137 ip->ip_src = _lsrc->address.sin.sin_addr;
4138 sctp_free_ifa(_lsrc);
4139 } else {
4140 ip->ip_src = over_addr->sin.sin_addr;
4141 SCTP_RTALLOC(ro, vrf_id, inp->fibnum);
4142 }
4143 }
4144 if (port) {
4145 if (htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port)) == 0) {
4146 sctp_handle_no_route(stcb, net, so_locked);
4147 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4148 sctp_m_freem(m);
4149 return (EHOSTUNREACH);
4150 }
4151 udp = (struct udphdr *)((caddr_t)ip + sizeof(struct ip));
4152 udp->uh_sport = htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port));
4153 udp->uh_dport = port;
4154 udp->uh_ulen = htons((uint16_t)(packet_length - sizeof(struct ip)));
4155 if (V_udp_cksum) {
4156 udp->uh_sum = in_pseudo(ip->ip_src.s_addr, ip->ip_dst.s_addr, udp->uh_ulen + htons(IPPROTO_UDP));
4157 } else {
4158 udp->uh_sum = 0;
4159 }
4160 sctphdr = (struct sctphdr *)((caddr_t)udp + sizeof(struct udphdr));
4161 } else {
4162 sctphdr = (struct sctphdr *)((caddr_t)ip + sizeof(struct ip));
4163 }
4164
4165 sctphdr->src_port = src_port;
4166 sctphdr->dest_port = dest_port;
4167 sctphdr->v_tag = v_tag;
4168 sctphdr->checksum = 0;
4169
4170 /*
4171 * If source address selection fails and we find no
4172 * route then the ip_output should fail as well with
4173 * a NO_ROUTE_TO_HOST type error. We probably should
4174 * catch that somewhere and abort the association
4175 * right away (assuming this is an INIT being sent).
4176 */
4177 if (ro->ro_nh == NULL) {
4178 /*
4179 * src addr selection failed to find a route
4180 * (or valid source addr), so we can't get
4181 * there from here (yet)!
4182 */
4183 sctp_handle_no_route(stcb, net, so_locked);
4184 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4185 sctp_m_freem(m);
4186 return (EHOSTUNREACH);
4187 }
4188 if (ro != &iproute) {
4189 memcpy(&iproute, ro, sizeof(*ro));
4190 }
4191 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Calling ipv4 output routine from low level src addr:%x\n",
4192 (uint32_t)(ntohl(ip->ip_src.s_addr)));
4193 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Destination is %x\n",
4194 (uint32_t)(ntohl(ip->ip_dst.s_addr)));
4195 SCTPDBG(SCTP_DEBUG_OUTPUT3, "RTP route is %p through\n",
4196 (void *)ro->ro_nh);
4197
4198 if (SCTP_GET_HEADER_FOR_OUTPUT(o_pak)) {
4199 /* failed to prepend data, give up */
4200 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4201 sctp_m_freem(m);
4202 return (ENOMEM);
4203 }
4204 SCTP_ATTACH_CHAIN(o_pak, m, packet_length);
4205 if (port) {
4206 sctphdr->checksum = sctp_calculate_cksum(m, sizeof(struct ip) + sizeof(struct udphdr));
4207 SCTP_STAT_INCR(sctps_sendswcrc);
4208 if (V_udp_cksum) {
4209 SCTP_ENABLE_UDP_CSUM(o_pak);
4210 }
4211 } else {
4212 m->m_pkthdr.csum_flags = CSUM_SCTP;
4213 m->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
4214 SCTP_STAT_INCR(sctps_sendhwcrc);
4215 }
4216 #ifdef SCTP_PACKET_LOGGING
4217 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING)
4218 sctp_packet_log(o_pak);
4219 #endif
4220 /* send it out. table id is taken from stcb */
4221 SCTP_PROBE5(send, NULL, stcb, ip, stcb, sctphdr);
4222 SCTP_IP_OUTPUT(ret, o_pak, ro, inp, vrf_id);
4223 if (port) {
4224 UDPSTAT_INC(udps_opackets);
4225 }
4226 SCTP_STAT_INCR(sctps_sendpackets);
4227 SCTP_STAT_INCR_COUNTER64(sctps_outpackets);
4228 if (ret)
4229 SCTP_STAT_INCR(sctps_senderrors);
4230
4231 SCTPDBG(SCTP_DEBUG_OUTPUT3, "IP output returns %d\n", ret);
4232 if (net == NULL) {
4233 /* free tempy routes */
4234 RO_NHFREE(ro);
4235 } else {
4236 if ((ro->ro_nh != NULL) && (net->ro._s_addr) &&
4237 ((net->dest_state & SCTP_ADDR_NO_PMTUD) == 0)) {
4238 uint32_t mtu;
4239
4240 mtu = SCTP_GATHER_MTU_FROM_ROUTE(net->ro._s_addr, &net->ro._l_addr.sa, ro->ro_nh);
4241 if (mtu > 0) {
4242 if (net->port) {
4243 mtu -= sizeof(struct udphdr);
4244 }
4245 if (mtu < net->mtu) {
4246 net->mtu = mtu;
4247 if ((stcb != NULL) && (stcb->asoc.smallest_mtu > mtu)) {
4248 sctp_pathmtu_adjustment(stcb, mtu, true);
4249 }
4250 }
4251 }
4252 } else if (ro->ro_nh == NULL) {
4253 /* route was freed */
4254 if (net->ro._s_addr &&
4255 net->src_addr_selected) {
4256 sctp_free_ifa(net->ro._s_addr);
4257 net->ro._s_addr = NULL;
4258 }
4259 net->src_addr_selected = 0;
4260 }
4261 }
4262 return (ret);
4263 }
4264 #endif
4265 #ifdef INET6
4266 case AF_INET6:
4267 {
4268 uint32_t flowlabel, flowinfo;
4269 struct ip6_hdr *ip6h;
4270 struct route_in6 ip6route;
4271 struct ifnet *ifp;
4272 struct sockaddr_in6 *sin6, tmp, *lsa6, lsa6_tmp;
4273 int prev_scope = 0;
4274 struct sockaddr_in6 lsa6_storage;
4275 int error;
4276 u_short prev_port = 0;
4277 int len;
4278
4279 if (net) {
4280 flowlabel = net->flowlabel;
4281 } else if (stcb) {
4282 flowlabel = stcb->asoc.default_flowlabel;
4283 } else {
4284 flowlabel = inp->sctp_ep.default_flowlabel;
4285 }
4286 if (flowlabel == 0) {
4287 /*
4288 * This means especially, that it is not set
4289 * at the SCTP layer. So use the value from
4290 * the IP layer.
4291 */
4292 flowlabel = ntohl(((struct inpcb *)inp)->inp_flow);
4293 }
4294 flowlabel &= 0x000fffff;
4295 len = SCTP_MIN_OVERHEAD;
4296 if (port) {
4297 len += sizeof(struct udphdr);
4298 }
4299 newm = sctp_get_mbuf_for_msg(len, 1, M_NOWAIT, 1, MT_DATA);
4300 if (newm == NULL) {
4301 sctp_m_freem(m);
4302 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4303 return (ENOMEM);
4304 }
4305 SCTP_ALIGN_TO_END(newm, len);
4306 SCTP_BUF_LEN(newm) = len;
4307 SCTP_BUF_NEXT(newm) = m;
4308 m = newm;
4309 if (net != NULL) {
4310 m->m_pkthdr.flowid = net->flowid;
4311 M_HASHTYPE_SET(m, net->flowtype);
4312 } else {
4313 m->m_pkthdr.flowid = mflowid;
4314 M_HASHTYPE_SET(m, mflowtype);
4315 }
4316 packet_length = sctp_calculate_len(m);
4317
4318 ip6h = mtod(m, struct ip6_hdr *);
4319 /* protect *sin6 from overwrite */
4320 sin6 = (struct sockaddr_in6 *)to;
4321 tmp = *sin6;
4322 sin6 = &tmp;
4323
4324 /* KAME hack: embed scopeid */
4325 if (sa6_embedscope(sin6, MODULE_GLOBAL(ip6_use_defzone)) != 0) {
4326 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
4327 sctp_m_freem(m);
4328 return (EINVAL);
4329 }
4330 if (net == NULL) {
4331 memset(&ip6route, 0, sizeof(ip6route));
4332 ro = (sctp_route_t *)&ip6route;
4333 memcpy(&ro->ro_dst, sin6, sin6->sin6_len);
4334 } else {
4335 ro = (sctp_route_t *)&net->ro;
4336 }
4337 /*
4338 * We assume here that inp_flow is in host byte
4339 * order within the TCB!
4340 */
4341 if (tos_value == 0) {
4342 /*
4343 * This means especially, that it is not set
4344 * at the SCTP layer. So use the value from
4345 * the IP layer.
4346 */
4347 tos_value = (ntohl(((struct inpcb *)inp)->inp_flow) >> 20) & 0xff;
4348 }
4349 tos_value &= 0xfc;
4350 if (ecn_ok) {
4351 tos_value |= sctp_get_ect(stcb);
4352 }
4353 flowinfo = 0x06;
4354 flowinfo <<= 8;
4355 flowinfo |= tos_value;
4356 flowinfo <<= 20;
4357 flowinfo |= flowlabel;
4358 ip6h->ip6_flow = htonl(flowinfo);
4359 if (port) {
4360 ip6h->ip6_nxt = IPPROTO_UDP;
4361 } else {
4362 ip6h->ip6_nxt = IPPROTO_SCTP;
4363 }
4364 ip6h->ip6_plen = htons((uint16_t)(packet_length - sizeof(struct ip6_hdr)));
4365 ip6h->ip6_dst = sin6->sin6_addr;
4366
4367 /*
4368 * Add SRC address selection here: we can only reuse
4369 * to a limited degree the kame src-addr-sel, since
4370 * we can try their selection but it may not be
4371 * bound.
4372 */
4373 memset(&lsa6_tmp, 0, sizeof(lsa6_tmp));
4374 lsa6_tmp.sin6_family = AF_INET6;
4375 lsa6_tmp.sin6_len = sizeof(lsa6_tmp);
4376 lsa6 = &lsa6_tmp;
4377 if (net && out_of_asoc_ok == 0) {
4378 if (net->ro._s_addr && (net->ro._s_addr->localifa_flags & (SCTP_BEING_DELETED | SCTP_ADDR_IFA_UNUSEABLE))) {
4379 sctp_free_ifa(net->ro._s_addr);
4380 net->ro._s_addr = NULL;
4381 net->src_addr_selected = 0;
4382 RO_NHFREE(ro);
4383 }
4384 if (net->src_addr_selected == 0) {
4385 sin6 = (struct sockaddr_in6 *)&net->ro._l_addr;
4386 /* KAME hack: embed scopeid */
4387 if (sa6_embedscope(sin6, MODULE_GLOBAL(ip6_use_defzone)) != 0) {
4388 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
4389 sctp_m_freem(m);
4390 return (EINVAL);
4391 }
4392 /* Cache the source address */
4393 net->ro._s_addr = sctp_source_address_selection(inp,
4394 stcb,
4395 ro,
4396 net,
4397 0,
4398 vrf_id);
4399 (void)sa6_recoverscope(sin6);
4400 net->src_addr_selected = 1;
4401 }
4402 if (net->ro._s_addr == NULL) {
4403 SCTPDBG(SCTP_DEBUG_OUTPUT3, "V6:No route to host\n");
4404 net->src_addr_selected = 0;
4405 sctp_handle_no_route(stcb, net, so_locked);
4406 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4407 sctp_m_freem(m);
4408 return (EHOSTUNREACH);
4409 }
4410 lsa6->sin6_addr = net->ro._s_addr->address.sin6.sin6_addr;
4411 } else {
4412 sin6 = (struct sockaddr_in6 *)&ro->ro_dst;
4413 /* KAME hack: embed scopeid */
4414 if (sa6_embedscope(sin6, MODULE_GLOBAL(ip6_use_defzone)) != 0) {
4415 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
4416 sctp_m_freem(m);
4417 return (EINVAL);
4418 }
4419 if (over_addr == NULL) {
4420 struct sctp_ifa *_lsrc;
4421
4422 _lsrc = sctp_source_address_selection(inp, stcb, ro,
4423 net,
4424 out_of_asoc_ok,
4425 vrf_id);
4426 if (_lsrc == NULL) {
4427 sctp_handle_no_route(stcb, net, so_locked);
4428 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4429 sctp_m_freem(m);
4430 return (EHOSTUNREACH);
4431 }
4432 lsa6->sin6_addr = _lsrc->address.sin6.sin6_addr;
4433 sctp_free_ifa(_lsrc);
4434 } else {
4435 lsa6->sin6_addr = over_addr->sin6.sin6_addr;
4436 SCTP_RTALLOC(ro, vrf_id, inp->fibnum);
4437 }
4438 (void)sa6_recoverscope(sin6);
4439 }
4440 lsa6->sin6_port = inp->sctp_lport;
4441
4442 if (ro->ro_nh == NULL) {
4443 /*
4444 * src addr selection failed to find a route
4445 * (or valid source addr), so we can't get
4446 * there from here!
4447 */
4448 sctp_handle_no_route(stcb, net, so_locked);
4449 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4450 sctp_m_freem(m);
4451 return (EHOSTUNREACH);
4452 }
4453 /*
4454 * XXX: sa6 may not have a valid sin6_scope_id in
4455 * the non-SCOPEDROUTING case.
4456 */
4457 memset(&lsa6_storage, 0, sizeof(lsa6_storage));
4458 lsa6_storage.sin6_family = AF_INET6;
4459 lsa6_storage.sin6_len = sizeof(lsa6_storage);
4460 lsa6_storage.sin6_addr = lsa6->sin6_addr;
4461 if ((error = sa6_recoverscope(&lsa6_storage)) != 0) {
4462 SCTPDBG(SCTP_DEBUG_OUTPUT3, "recover scope fails error %d\n", error);
4463 sctp_m_freem(m);
4464 return (error);
4465 }
4466 /* XXX */
4467 lsa6_storage.sin6_addr = lsa6->sin6_addr;
4468 lsa6_storage.sin6_port = inp->sctp_lport;
4469 lsa6 = &lsa6_storage;
4470 ip6h->ip6_src = lsa6->sin6_addr;
4471
4472 if (port) {
4473 if (htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port)) == 0) {
4474 sctp_handle_no_route(stcb, net, so_locked);
4475 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4476 sctp_m_freem(m);
4477 return (EHOSTUNREACH);
4478 }
4479 udp = (struct udphdr *)((caddr_t)ip6h + sizeof(struct ip6_hdr));
4480 udp->uh_sport = htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port));
4481 udp->uh_dport = port;
4482 udp->uh_ulen = htons((uint16_t)(packet_length - sizeof(struct ip6_hdr)));
4483 udp->uh_sum = 0;
4484 sctphdr = (struct sctphdr *)((caddr_t)udp + sizeof(struct udphdr));
4485 } else {
4486 sctphdr = (struct sctphdr *)((caddr_t)ip6h + sizeof(struct ip6_hdr));
4487 }
4488
4489 sctphdr->src_port = src_port;
4490 sctphdr->dest_port = dest_port;
4491 sctphdr->v_tag = v_tag;
4492 sctphdr->checksum = 0;
4493
4494 /*
4495 * We set the hop limit now since there is a good
4496 * chance that our ro pointer is now filled
4497 */
4498 ip6h->ip6_hlim = SCTP_GET_HLIM(inp, ro);
4499 ifp = SCTP_GET_IFN_VOID_FROM_ROUTE(ro);
4500
4501 #ifdef SCTP_DEBUG
4502 /* Copy to be sure something bad is not happening */
4503 sin6->sin6_addr = ip6h->ip6_dst;
4504 lsa6->sin6_addr = ip6h->ip6_src;
4505 #endif
4506
4507 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Calling ipv6 output routine from low level\n");
4508 SCTPDBG(SCTP_DEBUG_OUTPUT3, "src: ");
4509 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT3, (struct sockaddr *)lsa6);
4510 SCTPDBG(SCTP_DEBUG_OUTPUT3, "dst: ");
4511 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT3, (struct sockaddr *)sin6);
4512 if (net) {
4513 sin6 = (struct sockaddr_in6 *)&net->ro._l_addr;
4514 /*
4515 * preserve the port and scope for link
4516 * local send
4517 */
4518 prev_scope = sin6->sin6_scope_id;
4519 prev_port = sin6->sin6_port;
4520 }
4521
4522 if (SCTP_GET_HEADER_FOR_OUTPUT(o_pak)) {
4523 /* failed to prepend data, give up */
4524 sctp_m_freem(m);
4525 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4526 return (ENOMEM);
4527 }
4528 SCTP_ATTACH_CHAIN(o_pak, m, packet_length);
4529 if (port) {
4530 sctphdr->checksum = sctp_calculate_cksum(m, sizeof(struct ip6_hdr) + sizeof(struct udphdr));
4531 SCTP_STAT_INCR(sctps_sendswcrc);
4532 if ((udp->uh_sum = in6_cksum(o_pak, IPPROTO_UDP, sizeof(struct ip6_hdr), packet_length - sizeof(struct ip6_hdr))) == 0) {
4533 udp->uh_sum = 0xffff;
4534 }
4535 } else {
4536 m->m_pkthdr.csum_flags = CSUM_SCTP_IPV6;
4537 m->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
4538 SCTP_STAT_INCR(sctps_sendhwcrc);
4539 }
4540 /* send it out. table id is taken from stcb */
4541 #ifdef SCTP_PACKET_LOGGING
4542 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING)
4543 sctp_packet_log(o_pak);
4544 #endif
4545 SCTP_PROBE5(send, NULL, stcb, ip6h, stcb, sctphdr);
4546 SCTP_IP6_OUTPUT(ret, o_pak, (struct route_in6 *)ro, &ifp, inp, vrf_id);
4547 if (net) {
4548 /* for link local this must be done */
4549 sin6->sin6_scope_id = prev_scope;
4550 sin6->sin6_port = prev_port;
4551 }
4552 SCTPDBG(SCTP_DEBUG_OUTPUT3, "return from send is %d\n", ret);
4553 if (port) {
4554 UDPSTAT_INC(udps_opackets);
4555 }
4556 SCTP_STAT_INCR(sctps_sendpackets);
4557 SCTP_STAT_INCR_COUNTER64(sctps_outpackets);
4558 if (ret) {
4559 SCTP_STAT_INCR(sctps_senderrors);
4560 }
4561 if (net == NULL) {
4562 /* Now if we had a temp route free it */
4563 RO_NHFREE(ro);
4564 } else {
4565 /*
4566 * PMTU check versus smallest asoc MTU goes
4567 * here
4568 */
4569 if (ro->ro_nh == NULL) {
4570 /* Route was freed */
4571 if (net->ro._s_addr &&
4572 net->src_addr_selected) {
4573 sctp_free_ifa(net->ro._s_addr);
4574 net->ro._s_addr = NULL;
4575 }
4576 net->src_addr_selected = 0;
4577 }
4578 if ((ro->ro_nh != NULL) && (net->ro._s_addr) &&
4579 ((net->dest_state & SCTP_ADDR_NO_PMTUD) == 0)) {
4580 uint32_t mtu;
4581
4582 mtu = SCTP_GATHER_MTU_FROM_ROUTE(net->ro._s_addr, &net->ro._l_addr.sa, ro->ro_nh);
4583 if (mtu > 0) {
4584 if (net->port) {
4585 mtu -= sizeof(struct udphdr);
4586 }
4587 if (mtu < net->mtu) {
4588 net->mtu = mtu;
4589 if ((stcb != NULL) && (stcb->asoc.smallest_mtu > mtu)) {
4590 sctp_pathmtu_adjustment(stcb, mtu, false);
4591 }
4592 }
4593 }
4594 } else if (ifp != NULL) {
4595 if ((ND_IFINFO(ifp)->linkmtu > 0) &&
4596 (stcb->asoc.smallest_mtu > ND_IFINFO(ifp)->linkmtu)) {
4597 sctp_pathmtu_adjustment(stcb, ND_IFINFO(ifp)->linkmtu, false);
4598 }
4599 }
4600 }
4601 return (ret);
4602 }
4603 #endif
4604 default:
4605 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Unknown protocol (TSNH) type %d\n",
4606 ((struct sockaddr *)to)->sa_family);
4607 sctp_m_freem(m);
4608 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EFAULT);
4609 return (EFAULT);
4610 }
4611 }
4612
4613 void
4614 sctp_send_initiate(struct sctp_inpcb *inp, struct sctp_tcb *stcb, int so_locked)
4615 {
4616 struct mbuf *m, *m_last;
4617 struct sctp_nets *net;
4618 struct sctp_init_chunk *init;
4619 struct sctp_supported_addr_param *sup_addr;
4620 struct sctp_adaptation_layer_indication *ali;
4621 struct sctp_supported_chunk_types_param *pr_supported;
4622 struct sctp_paramhdr *ph;
4623 int cnt_inits_to = 0;
4624 int error;
4625 uint16_t num_ext, chunk_len, padding_len, parameter_len;
4626
4627 /* INIT's always go to the primary (and usually ONLY address) */
4628 net = stcb->asoc.primary_destination;
4629 if (net == NULL) {
4630 net = TAILQ_FIRST(&stcb->asoc.nets);
4631 if (net == NULL) {
4632 /* TSNH */
4633 return;
4634 }
4635 /* we confirm any address we send an INIT to */
4636 net->dest_state &= ~SCTP_ADDR_UNCONFIRMED;
4637 (void)sctp_set_primary_addr(stcb, NULL, net);
4638 } else {
4639 /* we confirm any address we send an INIT to */
4640 net->dest_state &= ~SCTP_ADDR_UNCONFIRMED;
4641 }
4642 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT\n");
4643 #ifdef INET6
4644 if (net->ro._l_addr.sa.sa_family == AF_INET6) {
4645 /*
4646 * special hook, if we are sending to link local it will not
4647 * show up in our private address count.
4648 */
4649 if (IN6_IS_ADDR_LINKLOCAL(&net->ro._l_addr.sin6.sin6_addr))
4650 cnt_inits_to = 1;
4651 }
4652 #endif
4653 if (SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
4654 /* This case should not happen */
4655 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT - failed timer?\n");
4656 return;
4657 }
4658 /* start the INIT timer */
4659 sctp_timer_start(SCTP_TIMER_TYPE_INIT, inp, stcb, net);
4660
4661 m = sctp_get_mbuf_for_msg(MCLBYTES, 1, M_NOWAIT, 1, MT_DATA);
4662 if (m == NULL) {
4663 /* No memory, INIT timer will re-attempt. */
4664 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT - mbuf?\n");
4665 return;
4666 }
4667 chunk_len = (uint16_t)sizeof(struct sctp_init_chunk);
4668 padding_len = 0;
4669 /* Now lets put the chunk header in place */
4670 init = mtod(m, struct sctp_init_chunk *);
4671 /* now the chunk header */
4672 init->ch.chunk_type = SCTP_INITIATION;
4673 init->ch.chunk_flags = 0;
4674 /* fill in later from mbuf we build */
4675 init->ch.chunk_length = 0;
4676 /* place in my tag */
4677 init->init.initiate_tag = htonl(stcb->asoc.my_vtag);
4678 /* set up some of the credits. */
4679 init->init.a_rwnd = htonl(max(inp->sctp_socket ? SCTP_SB_LIMIT_RCV(inp->sctp_socket) : 0,
4680 SCTP_MINIMAL_RWND));
4681 init->init.num_outbound_streams = htons(stcb->asoc.pre_open_streams);
4682 init->init.num_inbound_streams = htons(stcb->asoc.max_inbound_streams);
4683 init->init.initial_tsn = htonl(stcb->asoc.init_seq_number);
4684
4685 /* Adaptation layer indication parameter */
4686 if (inp->sctp_ep.adaptation_layer_indicator_provided) {
4687 parameter_len = (uint16_t)sizeof(struct sctp_adaptation_layer_indication);
4688 ali = (struct sctp_adaptation_layer_indication *)(mtod(m, caddr_t)+chunk_len);
4689 ali->ph.param_type = htons(SCTP_ULP_ADAPTATION);
4690 ali->ph.param_length = htons(parameter_len);
4691 ali->indication = htonl(inp->sctp_ep.adaptation_layer_indicator);
4692 chunk_len += parameter_len;
4693 }
4694
4695 /* ECN parameter */
4696 if (stcb->asoc.ecn_supported == 1) {
4697 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4698 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
4699 ph->param_type = htons(SCTP_ECN_CAPABLE);
4700 ph->param_length = htons(parameter_len);
4701 chunk_len += parameter_len;
4702 }
4703
4704 /* PR-SCTP supported parameter */
4705 if (stcb->asoc.prsctp_supported == 1) {
4706 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4707 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
4708 ph->param_type = htons(SCTP_PRSCTP_SUPPORTED);
4709 ph->param_length = htons(parameter_len);
4710 chunk_len += parameter_len;
4711 }
4712
4713 /* Add NAT friendly parameter. */
4714 if (SCTP_BASE_SYSCTL(sctp_inits_include_nat_friendly)) {
4715 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4716 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
4717 ph->param_type = htons(SCTP_HAS_NAT_SUPPORT);
4718 ph->param_length = htons(parameter_len);
4719 chunk_len += parameter_len;
4720 }
4721
4722 /* And now tell the peer which extensions we support */
4723 num_ext = 0;
4724 pr_supported = (struct sctp_supported_chunk_types_param *)(mtod(m, caddr_t)+chunk_len);
4725 if (stcb->asoc.prsctp_supported == 1) {
4726 pr_supported->chunk_types[num_ext++] = SCTP_FORWARD_CUM_TSN;
4727 if (stcb->asoc.idata_supported) {
4728 pr_supported->chunk_types[num_ext++] = SCTP_IFORWARD_CUM_TSN;
4729 }
4730 }
4731 if (stcb->asoc.auth_supported == 1) {
4732 pr_supported->chunk_types[num_ext++] = SCTP_AUTHENTICATION;
4733 }
4734 if (stcb->asoc.asconf_supported == 1) {
4735 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF;
4736 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF_ACK;
4737 }
4738 if (stcb->asoc.reconfig_supported == 1) {
4739 pr_supported->chunk_types[num_ext++] = SCTP_STREAM_RESET;
4740 }
4741 if (stcb->asoc.idata_supported) {
4742 pr_supported->chunk_types[num_ext++] = SCTP_IDATA;
4743 }
4744 if (stcb->asoc.nrsack_supported == 1) {
4745 pr_supported->chunk_types[num_ext++] = SCTP_NR_SELECTIVE_ACK;
4746 }
4747 if (stcb->asoc.pktdrop_supported == 1) {
4748 pr_supported->chunk_types[num_ext++] = SCTP_PACKET_DROPPED;
4749 }
4750 if (num_ext > 0) {
4751 parameter_len = (uint16_t)sizeof(struct sctp_supported_chunk_types_param) + num_ext;
4752 pr_supported->ph.param_type = htons(SCTP_SUPPORTED_CHUNK_EXT);
4753 pr_supported->ph.param_length = htons(parameter_len);
4754 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4755 chunk_len += parameter_len;
4756 }
4757 /* add authentication parameters */
4758 if (stcb->asoc.auth_supported) {
4759 /* attach RANDOM parameter, if available */
4760 if (stcb->asoc.authinfo.random != NULL) {
4761 struct sctp_auth_random *randp;
4762
4763 if (padding_len > 0) {
4764 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4765 chunk_len += padding_len;
4766 padding_len = 0;
4767 }
4768 randp = (struct sctp_auth_random *)(mtod(m, caddr_t)+chunk_len);
4769 parameter_len = (uint16_t)sizeof(struct sctp_auth_random) + stcb->asoc.authinfo.random_len;
4770 /* random key already contains the header */
4771 memcpy(randp, stcb->asoc.authinfo.random->key, parameter_len);
4772 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4773 chunk_len += parameter_len;
4774 }
4775 /* add HMAC_ALGO parameter */
4776 if (stcb->asoc.local_hmacs != NULL) {
4777 struct sctp_auth_hmac_algo *hmacs;
4778
4779 if (padding_len > 0) {
4780 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4781 chunk_len += padding_len;
4782 padding_len = 0;
4783 }
4784 hmacs = (struct sctp_auth_hmac_algo *)(mtod(m, caddr_t)+chunk_len);
4785 parameter_len = (uint16_t)(sizeof(struct sctp_auth_hmac_algo) +
4786 stcb->asoc.local_hmacs->num_algo * sizeof(uint16_t));
4787 hmacs->ph.param_type = htons(SCTP_HMAC_LIST);
4788 hmacs->ph.param_length = htons(parameter_len);
4789 sctp_serialize_hmaclist(stcb->asoc.local_hmacs, (uint8_t *)hmacs->hmac_ids);
4790 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4791 chunk_len += parameter_len;
4792 }
4793 /* add CHUNKS parameter */
4794 if (stcb->asoc.local_auth_chunks != NULL) {
4795 struct sctp_auth_chunk_list *chunks;
4796
4797 if (padding_len > 0) {
4798 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4799 chunk_len += padding_len;
4800 padding_len = 0;
4801 }
4802 chunks = (struct sctp_auth_chunk_list *)(mtod(m, caddr_t)+chunk_len);
4803 parameter_len = (uint16_t)(sizeof(struct sctp_auth_chunk_list) +
4804 sctp_auth_get_chklist_size(stcb->asoc.local_auth_chunks));
4805 chunks->ph.param_type = htons(SCTP_CHUNK_LIST);
4806 chunks->ph.param_length = htons(parameter_len);
4807 sctp_serialize_auth_chunks(stcb->asoc.local_auth_chunks, chunks->chunk_types);
4808 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4809 chunk_len += parameter_len;
4810 }
4811 }
4812
4813 /* now any cookie time extensions */
4814 if (stcb->asoc.cookie_preserve_req > 0) {
4815 struct sctp_cookie_perserve_param *cookie_preserve;
4816
4817 if (padding_len > 0) {
4818 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4819 chunk_len += padding_len;
4820 padding_len = 0;
4821 }
4822 parameter_len = (uint16_t)sizeof(struct sctp_cookie_perserve_param);
4823 cookie_preserve = (struct sctp_cookie_perserve_param *)(mtod(m, caddr_t)+chunk_len);
4824 cookie_preserve->ph.param_type = htons(SCTP_COOKIE_PRESERVE);
4825 cookie_preserve->ph.param_length = htons(parameter_len);
4826 cookie_preserve->time = htonl(stcb->asoc.cookie_preserve_req);
4827 stcb->asoc.cookie_preserve_req = 0;
4828 chunk_len += parameter_len;
4829 }
4830
4831 if (stcb->asoc.scope.ipv4_addr_legal || stcb->asoc.scope.ipv6_addr_legal) {
4832 uint8_t i;
4833
4834 if (padding_len > 0) {
4835 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4836 chunk_len += padding_len;
4837 padding_len = 0;
4838 }
4839 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4840 if (stcb->asoc.scope.ipv4_addr_legal) {
4841 parameter_len += (uint16_t)sizeof(uint16_t);
4842 }
4843 if (stcb->asoc.scope.ipv6_addr_legal) {
4844 parameter_len += (uint16_t)sizeof(uint16_t);
4845 }
4846 sup_addr = (struct sctp_supported_addr_param *)(mtod(m, caddr_t)+chunk_len);
4847 sup_addr->ph.param_type = htons(SCTP_SUPPORTED_ADDRTYPE);
4848 sup_addr->ph.param_length = htons(parameter_len);
4849 i = 0;
4850 if (stcb->asoc.scope.ipv4_addr_legal) {
4851 sup_addr->addr_type[i++] = htons(SCTP_IPV4_ADDRESS);
4852 }
4853 if (stcb->asoc.scope.ipv6_addr_legal) {
4854 sup_addr->addr_type[i++] = htons(SCTP_IPV6_ADDRESS);
4855 }
4856 padding_len = 4 - 2 * i;
4857 chunk_len += parameter_len;
4858 }
4859
4860 SCTP_BUF_LEN(m) = chunk_len;
4861 /* now the addresses */
4862 /*
4863 * To optimize this we could put the scoping stuff into a structure
4864 * and remove the individual uint8's from the assoc structure. Then
4865 * we could just sifa in the address within the stcb. But for now
4866 * this is a quick hack to get the address stuff teased apart.
4867 */
4868 m_last = sctp_add_addresses_to_i_ia(inp, stcb, &stcb->asoc.scope,
4869 m, cnt_inits_to,
4870 &padding_len, &chunk_len);
4871
4872 init->ch.chunk_length = htons(chunk_len);
4873 if (padding_len > 0) {
4874 if (sctp_add_pad_tombuf(m_last, padding_len) == NULL) {
4875 sctp_m_freem(m);
4876 return;
4877 }
4878 }
4879 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT - calls lowlevel_output\n");
4880 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
4881 (struct sockaddr *)&net->ro._l_addr,
4882 m, 0, NULL, 0, 0, 0, 0,
4883 inp->sctp_lport, stcb->rport, htonl(0),
4884 net->port, NULL,
4885 0, 0,
4886 so_locked))) {
4887 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Gak send error %d\n", error);
4888 if (error == ENOBUFS) {
4889 stcb->asoc.ifp_had_enobuf = 1;
4890 SCTP_STAT_INCR(sctps_lowlevelerr);
4891 }
4892 } else {
4893 stcb->asoc.ifp_had_enobuf = 0;
4894 }
4895 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
4896 (void)SCTP_GETTIME_TIMEVAL(&net->last_sent_time);
4897 }
4898
4899 struct mbuf *
4900 sctp_arethere_unrecognized_parameters(struct mbuf *in_initpkt,
4901 int param_offset, int *abort_processing,
4902 struct sctp_chunkhdr *cp,
4903 int *nat_friendly,
4904 int *cookie_found)
4905 {
4906 /*
4907 * Given a mbuf containing an INIT or INIT-ACK with the param_offset
4908 * being equal to the beginning of the params i.e. (iphlen +
4909 * sizeof(struct sctp_init_msg) parse through the parameters to the
4910 * end of the mbuf verifying that all parameters are known.
4911 *
4912 * For unknown parameters build and return a mbuf with
4913 * UNRECOGNIZED_PARAMETER errors. If the flags indicate to stop
4914 * processing this chunk stop, and set *abort_processing to 1.
4915 *
4916 * By having param_offset be pre-set to where parameters begin it is
4917 * hoped that this routine may be reused in the future by new
4918 * features.
4919 */
4920 struct sctp_paramhdr *phdr, params;
4921
4922 struct mbuf *mat, *m_tmp, *op_err, *op_err_last;
4923 int at, limit, pad_needed;
4924 uint16_t ptype, plen, padded_size;
4925
4926 *abort_processing = 0;
4927 if (cookie_found != NULL) {
4928 *cookie_found = 0;
4929 }
4930 mat = in_initpkt;
4931 limit = ntohs(cp->chunk_length) - sizeof(struct sctp_init_chunk);
4932 at = param_offset;
4933 op_err = NULL;
4934 op_err_last = NULL;
4935 pad_needed = 0;
4936 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Check for unrecognized param's\n");
4937 phdr = sctp_get_next_param(mat, at, ¶ms, sizeof(params));
4938 while ((phdr != NULL) && ((size_t)limit >= sizeof(struct sctp_paramhdr))) {
4939 ptype = ntohs(phdr->param_type);
4940 plen = ntohs(phdr->param_length);
4941 if ((plen > limit) || (plen < sizeof(struct sctp_paramhdr))) {
4942 /* wacked parameter */
4943 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error %d\n", plen);
4944 goto invalid_size;
4945 }
4946 limit -= SCTP_SIZE32(plen);
4947 /*-
4948 * All parameters for all chunks that we know/understand are
4949 * listed here. We process them other places and make
4950 * appropriate stop actions per the upper bits. However this
4951 * is the generic routine processor's can call to get back
4952 * an operr.. to either incorporate (init-ack) or send.
4953 */
4954 padded_size = SCTP_SIZE32(plen);
4955 switch (ptype) {
4956 /* Param's with variable size */
4957 case SCTP_HEARTBEAT_INFO:
4958 case SCTP_UNRECOG_PARAM:
4959 case SCTP_ERROR_CAUSE_IND:
4960 /* ok skip fwd */
4961 at += padded_size;
4962 break;
4963 case SCTP_STATE_COOKIE:
4964 if (cookie_found != NULL) {
4965 *cookie_found = 1;
4966 }
4967 at += padded_size;
4968 break;
4969 /* Param's with variable size within a range */
4970 case SCTP_CHUNK_LIST:
4971 case SCTP_SUPPORTED_CHUNK_EXT:
4972 if (padded_size > (sizeof(struct sctp_supported_chunk_types_param) + (sizeof(uint8_t) * SCTP_MAX_SUPPORTED_EXT))) {
4973 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error chklist %d\n", plen);
4974 goto invalid_size;
4975 }
4976 at += padded_size;
4977 break;
4978 case SCTP_SUPPORTED_ADDRTYPE:
4979 if (padded_size > SCTP_MAX_ADDR_PARAMS_SIZE) {
4980 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error supaddrtype %d\n", plen);
4981 goto invalid_size;
4982 }
4983 at += padded_size;
4984 break;
4985 case SCTP_RANDOM:
4986 if (padded_size > (sizeof(struct sctp_auth_random) + SCTP_RANDOM_MAX_SIZE)) {
4987 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error random %d\n", plen);
4988 goto invalid_size;
4989 }
4990 at += padded_size;
4991 break;
4992 case SCTP_SET_PRIM_ADDR:
4993 case SCTP_DEL_IP_ADDRESS:
4994 case SCTP_ADD_IP_ADDRESS:
4995 if ((padded_size != sizeof(struct sctp_asconf_addrv4_param)) &&
4996 (padded_size != sizeof(struct sctp_asconf_addr_param))) {
4997 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error setprim %d\n", plen);
4998 goto invalid_size;
4999 }
5000 at += padded_size;
5001 break;
5002 /* Param's with a fixed size */
5003 case SCTP_IPV4_ADDRESS:
5004 if (padded_size != sizeof(struct sctp_ipv4addr_param)) {
5005 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error ipv4 addr %d\n", plen);
5006 goto invalid_size;
5007 }
5008 at += padded_size;
5009 break;
5010 case SCTP_IPV6_ADDRESS:
5011 if (padded_size != sizeof(struct sctp_ipv6addr_param)) {
5012 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error ipv6 addr %d\n", plen);
5013 goto invalid_size;
5014 }
5015 at += padded_size;
5016 break;
5017 case SCTP_COOKIE_PRESERVE:
5018 if (padded_size != sizeof(struct sctp_cookie_perserve_param)) {
5019 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error cookie-preserve %d\n", plen);
5020 goto invalid_size;
5021 }
5022 at += padded_size;
5023 break;
5024 case SCTP_HAS_NAT_SUPPORT:
5025 *nat_friendly = 1;
5026 /* fall through */
5027 case SCTP_PRSCTP_SUPPORTED:
5028 if (padded_size != sizeof(struct sctp_paramhdr)) {
5029 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error prsctp/nat support %d\n", plen);
5030 goto invalid_size;
5031 }
5032 at += padded_size;
5033 break;
5034 case SCTP_ECN_CAPABLE:
5035 if (padded_size != sizeof(struct sctp_paramhdr)) {
5036 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error ecn %d\n", plen);
5037 goto invalid_size;
5038 }
5039 at += padded_size;
5040 break;
5041 case SCTP_ULP_ADAPTATION:
5042 if (padded_size != sizeof(struct sctp_adaptation_layer_indication)) {
5043 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error adapatation %d\n", plen);
5044 goto invalid_size;
5045 }
5046 at += padded_size;
5047 break;
5048 case SCTP_SUCCESS_REPORT:
5049 if (padded_size != sizeof(struct sctp_asconf_paramhdr)) {
5050 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error success %d\n", plen);
5051 goto invalid_size;
5052 }
5053 at += padded_size;
5054 break;
5055 case SCTP_HOSTNAME_ADDRESS:
5056 {
5057 /* Hostname parameters are deprecated. */
5058 struct sctp_gen_error_cause *cause;
5059 int l_len;
5060
5061 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Can't handle hostname addresses.. abort processing\n");
5062 *abort_processing = 1;
5063 sctp_m_freem(op_err);
5064 op_err = NULL;
5065 op_err_last = NULL;
5066 #ifdef INET6
5067 l_len = SCTP_MIN_OVERHEAD;
5068 #else
5069 l_len = SCTP_MIN_V4_OVERHEAD;
5070 #endif
5071 l_len += sizeof(struct sctp_chunkhdr);
5072 l_len += sizeof(struct sctp_gen_error_cause);
5073 op_err = sctp_get_mbuf_for_msg(l_len, 0, M_NOWAIT, 1, MT_DATA);
5074 if (op_err != NULL) {
5075 /*
5076 * Pre-reserve space for IP, SCTP,
5077 * and chunk header.
5078 */
5079 #ifdef INET6
5080 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip6_hdr));
5081 #else
5082 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip));
5083 #endif
5084 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctphdr));
5085 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctp_chunkhdr));
5086 SCTP_BUF_LEN(op_err) = sizeof(struct sctp_gen_error_cause);
5087 cause = mtod(op_err, struct sctp_gen_error_cause *);
5088 cause->code = htons(SCTP_CAUSE_UNRESOLVABLE_ADDR);
5089 cause->length = htons((uint16_t)(sizeof(struct sctp_gen_error_cause) + plen));
5090 SCTP_BUF_NEXT(op_err) = SCTP_M_COPYM(mat, at, plen, M_NOWAIT);
5091 if (SCTP_BUF_NEXT(op_err) == NULL) {
5092 sctp_m_freem(op_err);
5093 op_err = NULL;
5094 op_err_last = NULL;
5095 }
5096 }
5097 return (op_err);
5098 }
5099 default:
5100 /*
5101 * we do not recognize the parameter figure out what
5102 * we do.
5103 */
5104 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Hit default param %x\n", ptype);
5105 if ((ptype & 0x4000) == 0x4000) {
5106 /* Report bit is set?? */
5107 SCTPDBG(SCTP_DEBUG_OUTPUT1, "report op err\n");
5108 if (op_err == NULL) {
5109 int l_len;
5110
5111 /* Ok need to try to get an mbuf */
5112 #ifdef INET6
5113 l_len = SCTP_MIN_OVERHEAD;
5114 #else
5115 l_len = SCTP_MIN_V4_OVERHEAD;
5116 #endif
5117 l_len += sizeof(struct sctp_chunkhdr);
5118 l_len += sizeof(struct sctp_paramhdr);
5119 op_err = sctp_get_mbuf_for_msg(l_len, 0, M_NOWAIT, 1, MT_DATA);
5120 if (op_err) {
5121 SCTP_BUF_LEN(op_err) = 0;
5122 #ifdef INET6
5123 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip6_hdr));
5124 #else
5125 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip));
5126 #endif
5127 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctphdr));
5128 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctp_chunkhdr));
5129 op_err_last = op_err;
5130 }
5131 }
5132 if (op_err != NULL) {
5133 /* If we have space */
5134 struct sctp_paramhdr *param;
5135
5136 if (pad_needed > 0) {
5137 op_err_last = sctp_add_pad_tombuf(op_err_last, pad_needed);
5138 }
5139 if (op_err_last == NULL) {
5140 sctp_m_freem(op_err);
5141 op_err = NULL;
5142 op_err_last = NULL;
5143 goto more_processing;
5144 }
5145 if (M_TRAILINGSPACE(op_err_last) < (int)sizeof(struct sctp_paramhdr)) {
5146 m_tmp = sctp_get_mbuf_for_msg(sizeof(struct sctp_paramhdr), 0, M_NOWAIT, 1, MT_DATA);
5147 if (m_tmp == NULL) {
5148 sctp_m_freem(op_err);
5149 op_err = NULL;
5150 op_err_last = NULL;
5151 goto more_processing;
5152 }
5153 SCTP_BUF_LEN(m_tmp) = 0;
5154 SCTP_BUF_NEXT(m_tmp) = NULL;
5155 SCTP_BUF_NEXT(op_err_last) = m_tmp;
5156 op_err_last = m_tmp;
5157 }
5158 param = (struct sctp_paramhdr *)(mtod(op_err_last, caddr_t)+SCTP_BUF_LEN(op_err_last));
5159 param->param_type = htons(SCTP_UNRECOG_PARAM);
5160 param->param_length = htons((uint16_t)sizeof(struct sctp_paramhdr) + plen);
5161 SCTP_BUF_LEN(op_err_last) += sizeof(struct sctp_paramhdr);
5162 SCTP_BUF_NEXT(op_err_last) = SCTP_M_COPYM(mat, at, plen, M_NOWAIT);
5163 if (SCTP_BUF_NEXT(op_err_last) == NULL) {
5164 sctp_m_freem(op_err);
5165 op_err = NULL;
5166 op_err_last = NULL;
5167 goto more_processing;
5168 } else {
5169 while (SCTP_BUF_NEXT(op_err_last) != NULL) {
5170 op_err_last = SCTP_BUF_NEXT(op_err_last);
5171 }
5172 }
5173 if (plen % 4 != 0) {
5174 pad_needed = 4 - (plen % 4);
5175 } else {
5176 pad_needed = 0;
5177 }
5178 }
5179 }
5180 more_processing:
5181 if ((ptype & 0x8000) == 0x0000) {
5182 SCTPDBG(SCTP_DEBUG_OUTPUT1, "stop proc\n");
5183 return (op_err);
5184 } else {
5185 /* skip this chunk and continue processing */
5186 SCTPDBG(SCTP_DEBUG_OUTPUT1, "move on\n");
5187 at += SCTP_SIZE32(plen);
5188 }
5189 break;
5190 }
5191 phdr = sctp_get_next_param(mat, at, ¶ms, sizeof(params));
5192 }
5193 return (op_err);
5194 invalid_size:
5195 SCTPDBG(SCTP_DEBUG_OUTPUT1, "abort flag set\n");
5196 *abort_processing = 1;
5197 sctp_m_freem(op_err);
5198 op_err = NULL;
5199 op_err_last = NULL;
5200 if (phdr != NULL) {
5201 struct sctp_paramhdr *param;
5202 int l_len;
5203 #ifdef INET6
5204 l_len = SCTP_MIN_OVERHEAD;
5205 #else
5206 l_len = SCTP_MIN_V4_OVERHEAD;
5207 #endif
5208 l_len += sizeof(struct sctp_chunkhdr);
5209 l_len += (2 * sizeof(struct sctp_paramhdr));
5210 op_err = sctp_get_mbuf_for_msg(l_len, 0, M_NOWAIT, 1, MT_DATA);
5211 if (op_err) {
5212 SCTP_BUF_LEN(op_err) = 0;
5213 #ifdef INET6
5214 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip6_hdr));
5215 #else
5216 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip));
5217 #endif
5218 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctphdr));
5219 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctp_chunkhdr));
5220 SCTP_BUF_LEN(op_err) = 2 * sizeof(struct sctp_paramhdr);
5221 param = mtod(op_err, struct sctp_paramhdr *);
5222 param->param_type = htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
5223 param->param_length = htons(2 * sizeof(struct sctp_paramhdr));
5224 param++;
5225 param->param_type = htons(ptype);
5226 param->param_length = htons(plen);
5227 }
5228 }
5229 return (op_err);
5230 }
5231
5232 /*
5233 * Given a INIT chunk, look through the parameters to verify that there
5234 * are no new addresses.
5235 * Return true, if there is a new address or there is a problem parsing
5236 the parameters. Provide an optional error cause used when sending an ABORT.
5237 * Return false, if there are no new addresses and there is no problem in
5238 parameter processing.
5239 */
5240 static bool
5241 sctp_are_there_new_addresses(struct sctp_association *asoc,
5242 struct mbuf *in_initpkt, int offset, int limit, struct sockaddr *src,
5243 struct mbuf **op_err)
5244 {
5245 struct sockaddr *sa_touse;
5246 struct sockaddr *sa;
5247 struct sctp_paramhdr *phdr, params;
5248 struct sctp_nets *net;
5249 #ifdef INET
5250 struct sockaddr_in sin4, *sa4;
5251 #endif
5252 #ifdef INET6
5253 struct sockaddr_in6 sin6, *sa6;
5254 #endif
5255 uint16_t ptype, plen;
5256 bool fnd, check_src;
5257
5258 *op_err = NULL;
5259 #ifdef INET
5260 memset(&sin4, 0, sizeof(sin4));
5261 sin4.sin_family = AF_INET;
5262 sin4.sin_len = sizeof(sin4);
5263 #endif
5264 #ifdef INET6
5265 memset(&sin6, 0, sizeof(sin6));
5266 sin6.sin6_family = AF_INET6;
5267 sin6.sin6_len = sizeof(sin6);
5268 #endif
5269 /* First what about the src address of the pkt ? */
5270 check_src = false;
5271 switch (src->sa_family) {
5272 #ifdef INET
5273 case AF_INET:
5274 if (asoc->scope.ipv4_addr_legal) {
5275 check_src = true;
5276 }
5277 break;
5278 #endif
5279 #ifdef INET6
5280 case AF_INET6:
5281 if (asoc->scope.ipv6_addr_legal) {
5282 check_src = true;
5283 }
5284 break;
5285 #endif
5286 default:
5287 /* TSNH */
5288 break;
5289 }
5290 if (check_src) {
5291 fnd = false;
5292 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5293 sa = (struct sockaddr *)&net->ro._l_addr;
5294 if (sa->sa_family == src->sa_family) {
5295 #ifdef INET
5296 if (sa->sa_family == AF_INET) {
5297 struct sockaddr_in *src4;
5298
5299 sa4 = (struct sockaddr_in *)sa;
5300 src4 = (struct sockaddr_in *)src;
5301 if (sa4->sin_addr.s_addr == src4->sin_addr.s_addr) {
5302 fnd = true;
5303 break;
5304 }
5305 }
5306 #endif
5307 #ifdef INET6
5308 if (sa->sa_family == AF_INET6) {
5309 struct sockaddr_in6 *src6;
5310
5311 sa6 = (struct sockaddr_in6 *)sa;
5312 src6 = (struct sockaddr_in6 *)src;
5313 if (SCTP6_ARE_ADDR_EQUAL(sa6, src6)) {
5314 fnd = true;
5315 break;
5316 }
5317 }
5318 #endif
5319 }
5320 }
5321 if (!fnd) {
5322 /*
5323 * If sending an ABORT in case of an additional
5324 * address, don't use the new address error cause.
5325 * This looks no different than if no listener was
5326 * present.
5327 */
5328 *op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code), "Address added");
5329 return (true);
5330 }
5331 }
5332 /* Ok so far lets munge through the rest of the packet */
5333 offset += sizeof(struct sctp_init_chunk);
5334 phdr = sctp_get_next_param(in_initpkt, offset, ¶ms, sizeof(params));
5335 while (phdr) {
5336 sa_touse = NULL;
5337 ptype = ntohs(phdr->param_type);
5338 plen = ntohs(phdr->param_length);
5339 if (offset + plen > limit) {
5340 *op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, "Partial parameter");
5341 return (true);
5342 }
5343 if (plen < sizeof(struct sctp_paramhdr)) {
5344 *op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, "Parameter length too small");
5345 return (true);
5346 }
5347 switch (ptype) {
5348 #ifdef INET
5349 case SCTP_IPV4_ADDRESS:
5350 {
5351 struct sctp_ipv4addr_param *p4, p4_buf;
5352
5353 if (plen != sizeof(struct sctp_ipv4addr_param)) {
5354 *op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, "Parameter length illegal");
5355 return (true);
5356 }
5357 phdr = sctp_get_next_param(in_initpkt, offset,
5358 (struct sctp_paramhdr *)&p4_buf, sizeof(p4_buf));
5359 if (phdr == NULL) {
5360 *op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, "");
5361 return (true);
5362 }
5363 if (asoc->scope.ipv4_addr_legal) {
5364 p4 = (struct sctp_ipv4addr_param *)phdr;
5365 sin4.sin_addr.s_addr = p4->addr;
5366 sa_touse = (struct sockaddr *)&sin4;
5367 }
5368 break;
5369 }
5370 #endif
5371 #ifdef INET6
5372 case SCTP_IPV6_ADDRESS:
5373 {
5374 struct sctp_ipv6addr_param *p6, p6_buf;
5375
5376 if (plen != sizeof(struct sctp_ipv6addr_param)) {
5377 *op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, "Parameter length illegal");
5378 return (true);
5379 }
5380 phdr = sctp_get_next_param(in_initpkt, offset,
5381 (struct sctp_paramhdr *)&p6_buf, sizeof(p6_buf));
5382 if (phdr == NULL) {
5383 *op_err = sctp_generate_cause(SCTP_CAUSE_PROTOCOL_VIOLATION, "");
5384 return (true);
5385 }
5386 if (asoc->scope.ipv6_addr_legal) {
5387 p6 = (struct sctp_ipv6addr_param *)phdr;
5388 memcpy((caddr_t)&sin6.sin6_addr, p6->addr,
5389 sizeof(p6->addr));
5390 sa_touse = (struct sockaddr *)&sin6;
5391 }
5392 break;
5393 }
5394 #endif
5395 default:
5396 sa_touse = NULL;
5397 break;
5398 }
5399 if (sa_touse) {
5400 /* ok, sa_touse points to one to check */
5401 fnd = false;
5402 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5403 sa = (struct sockaddr *)&net->ro._l_addr;
5404 if (sa->sa_family != sa_touse->sa_family) {
5405 continue;
5406 }
5407 #ifdef INET
5408 if (sa->sa_family == AF_INET) {
5409 sa4 = (struct sockaddr_in *)sa;
5410 if (sa4->sin_addr.s_addr ==
5411 sin4.sin_addr.s_addr) {
5412 fnd = true;
5413 break;
5414 }
5415 }
5416 #endif
5417 #ifdef INET6
5418 if (sa->sa_family == AF_INET6) {
5419 sa6 = (struct sockaddr_in6 *)sa;
5420 if (SCTP6_ARE_ADDR_EQUAL(
5421 sa6, &sin6)) {
5422 fnd = true;
5423 break;
5424 }
5425 }
5426 #endif
5427 }
5428 if (!fnd) {
5429 /*
5430 * If sending an ABORT in case of an
5431 * additional address, don't use the new
5432 * address error cause. This looks no
5433 * different than if no listener was
5434 * present.
5435 */
5436 *op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code), "Address added");
5437 return (true);
5438 }
5439 }
5440 offset += SCTP_SIZE32(plen);
5441 if (offset >= limit) {
5442 break;
5443 }
5444 phdr = sctp_get_next_param(in_initpkt, offset, ¶ms, sizeof(params));
5445 }
5446 return (false);
5447 }
5448
5449 /*
5450 * Given a MBUF chain that was sent into us containing an INIT. Build a
5451 * INIT-ACK with COOKIE and send back. We assume that the in_initpkt has done
5452 * a pullup to include IPv6/4header, SCTP header and initial part of INIT
5453 * message (i.e. the struct sctp_init_msg).
5454 */
5455 void
5456 sctp_send_initiate_ack(struct sctp_inpcb *inp, struct sctp_tcb *stcb,
5457 struct sctp_nets *src_net, struct mbuf *init_pkt,
5458 int iphlen, int offset,
5459 struct sockaddr *src, struct sockaddr *dst,
5460 struct sctphdr *sh, struct sctp_init_chunk *init_chk,
5461 uint8_t mflowtype, uint32_t mflowid,
5462 uint32_t vrf_id, uint16_t port)
5463 {
5464 struct sctp_association *asoc;
5465 struct mbuf *m, *m_tmp, *m_last, *m_cookie, *op_err;
5466 struct sctp_init_ack_chunk *initack;
5467 struct sctp_adaptation_layer_indication *ali;
5468 struct sctp_supported_chunk_types_param *pr_supported;
5469 struct sctp_paramhdr *ph;
5470 union sctp_sockstore *over_addr;
5471 struct sctp_scoping scp;
5472 struct timeval now;
5473 #ifdef INET
5474 struct sockaddr_in *dst4 = (struct sockaddr_in *)dst;
5475 struct sockaddr_in *src4 = (struct sockaddr_in *)src;
5476 struct sockaddr_in *sin;
5477 #endif
5478 #ifdef INET6
5479 struct sockaddr_in6 *dst6 = (struct sockaddr_in6 *)dst;
5480 struct sockaddr_in6 *src6 = (struct sockaddr_in6 *)src;
5481 struct sockaddr_in6 *sin6;
5482 #endif
5483 struct sockaddr *to;
5484 struct sctp_state_cookie stc;
5485 struct sctp_nets *net = NULL;
5486 uint8_t *signature = NULL;
5487 int cnt_inits_to = 0;
5488 uint16_t his_limit, i_want;
5489 int abort_flag;
5490 int nat_friendly = 0;
5491 int error;
5492 struct socket *so;
5493 uint16_t num_ext, chunk_len, padding_len, parameter_len;
5494
5495 if (stcb) {
5496 asoc = &stcb->asoc;
5497 } else {
5498 asoc = NULL;
5499 }
5500 if ((asoc != NULL) &&
5501 (SCTP_GET_STATE(stcb) != SCTP_STATE_COOKIE_WAIT)) {
5502 if (sctp_are_there_new_addresses(asoc, init_pkt, offset, offset + ntohs(init_chk->ch.chunk_length), src, &op_err)) {
5503 /*
5504 * new addresses, out of here in non-cookie-wait
5505 * states
5506 */
5507 sctp_send_abort(init_pkt, iphlen, src, dst, sh, 0, op_err,
5508 mflowtype, mflowid, inp->fibnum,
5509 vrf_id, port);
5510 return;
5511 }
5512 if (src_net != NULL && (src_net->port != port)) {
5513 /*
5514 * change of remote encapsulation port, out of here
5515 * in non-cookie-wait states
5516 *
5517 * Send an ABORT, without an specific error cause.
5518 * This looks no different than if no listener was
5519 * present.
5520 */
5521 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
5522 "Remote encapsulation port changed");
5523 sctp_send_abort(init_pkt, iphlen, src, dst, sh, 0, op_err,
5524 mflowtype, mflowid, inp->fibnum,
5525 vrf_id, port);
5526 return;
5527 }
5528 }
5529 abort_flag = 0;
5530 op_err = sctp_arethere_unrecognized_parameters(init_pkt,
5531 (offset + sizeof(struct sctp_init_chunk)),
5532 &abort_flag,
5533 (struct sctp_chunkhdr *)init_chk,
5534 &nat_friendly, NULL);
5535 if (abort_flag) {
5536 do_a_abort:
5537 if (op_err == NULL) {
5538 char msg[SCTP_DIAG_INFO_LEN];
5539
5540 SCTP_SNPRINTF(msg, sizeof(msg), "%s:%d at %s", __FILE__, __LINE__, __func__);
5541 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
5542 msg);
5543 }
5544 sctp_send_abort(init_pkt, iphlen, src, dst, sh,
5545 init_chk->init.initiate_tag, op_err,
5546 mflowtype, mflowid, inp->fibnum,
5547 vrf_id, port);
5548 return;
5549 }
5550 m = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
5551 if (m == NULL) {
5552 /* No memory, INIT timer will re-attempt. */
5553 sctp_m_freem(op_err);
5554 return;
5555 }
5556 chunk_len = (uint16_t)sizeof(struct sctp_init_ack_chunk);
5557 padding_len = 0;
5558
5559 /*
5560 * We might not overwrite the identification[] completely and on
5561 * some platforms time_entered will contain some padding. Therefore
5562 * zero out the cookie to avoid putting uninitialized memory on the
5563 * wire.
5564 */
5565 memset(&stc, 0, sizeof(struct sctp_state_cookie));
5566
5567 /* the time I built cookie */
5568 (void)SCTP_GETTIME_TIMEVAL(&now);
5569 stc.time_entered.tv_sec = now.tv_sec;
5570 stc.time_entered.tv_usec = now.tv_usec;
5571
5572 /* populate any tie tags */
5573 if (asoc != NULL) {
5574 /* unlock before tag selections */
5575 stc.tie_tag_my_vtag = asoc->my_vtag_nonce;
5576 stc.tie_tag_peer_vtag = asoc->peer_vtag_nonce;
5577 stc.cookie_life = asoc->cookie_life;
5578 net = asoc->primary_destination;
5579 } else {
5580 stc.tie_tag_my_vtag = 0;
5581 stc.tie_tag_peer_vtag = 0;
5582 /* life I will award this cookie */
5583 stc.cookie_life = inp->sctp_ep.def_cookie_life;
5584 }
5585
5586 /* copy in the ports for later check */
5587 stc.myport = sh->dest_port;
5588 stc.peerport = sh->src_port;
5589
5590 /*
5591 * If we wanted to honor cookie life extensions, we would add to
5592 * stc.cookie_life. For now we should NOT honor any extension
5593 */
5594 stc.site_scope = stc.local_scope = stc.loopback_scope = 0;
5595 if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
5596 stc.ipv6_addr_legal = 1;
5597 if (SCTP_IPV6_V6ONLY(inp)) {
5598 stc.ipv4_addr_legal = 0;
5599 } else {
5600 stc.ipv4_addr_legal = 1;
5601 }
5602 } else {
5603 stc.ipv6_addr_legal = 0;
5604 stc.ipv4_addr_legal = 1;
5605 }
5606 stc.ipv4_scope = 0;
5607 if (net == NULL) {
5608 to = src;
5609 switch (dst->sa_family) {
5610 #ifdef INET
5611 case AF_INET:
5612 {
5613 /* lookup address */
5614 stc.address[0] = src4->sin_addr.s_addr;
5615 stc.address[1] = 0;
5616 stc.address[2] = 0;
5617 stc.address[3] = 0;
5618 stc.addr_type = SCTP_IPV4_ADDRESS;
5619 /* local from address */
5620 stc.laddress[0] = dst4->sin_addr.s_addr;
5621 stc.laddress[1] = 0;
5622 stc.laddress[2] = 0;
5623 stc.laddress[3] = 0;
5624 stc.laddr_type = SCTP_IPV4_ADDRESS;
5625 /* scope_id is only for v6 */
5626 stc.scope_id = 0;
5627 if ((IN4_ISPRIVATE_ADDRESS(&src4->sin_addr)) ||
5628 (IN4_ISPRIVATE_ADDRESS(&dst4->sin_addr))) {
5629 stc.ipv4_scope = 1;
5630 }
5631 /* Must use the address in this case */
5632 if (sctp_is_address_on_local_host(src, vrf_id)) {
5633 stc.loopback_scope = 1;
5634 stc.ipv4_scope = 1;
5635 stc.site_scope = 1;
5636 stc.local_scope = 0;
5637 }
5638 break;
5639 }
5640 #endif
5641 #ifdef INET6
5642 case AF_INET6:
5643 {
5644 stc.addr_type = SCTP_IPV6_ADDRESS;
5645 memcpy(&stc.address, &src6->sin6_addr, sizeof(struct in6_addr));
5646 stc.scope_id = ntohs(in6_getscope(&src6->sin6_addr));
5647 if (sctp_is_address_on_local_host(src, vrf_id)) {
5648 stc.loopback_scope = 1;
5649 stc.local_scope = 0;
5650 stc.site_scope = 1;
5651 stc.ipv4_scope = 1;
5652 } else if (IN6_IS_ADDR_LINKLOCAL(&src6->sin6_addr) ||
5653 IN6_IS_ADDR_LINKLOCAL(&dst6->sin6_addr)) {
5654 /*
5655 * If the new destination or source
5656 * is a LINK_LOCAL we must have
5657 * common both site and local scope.
5658 * Don't set local scope though
5659 * since we must depend on the
5660 * source to be added implicitly. We
5661 * cannot assure just because we
5662 * share one link that all links are
5663 * common.
5664 */
5665 stc.local_scope = 0;
5666 stc.site_scope = 1;
5667 stc.ipv4_scope = 1;
5668 /*
5669 * we start counting for the private
5670 * address stuff at 1. since the
5671 * link local we source from won't
5672 * show up in our scoped count.
5673 */
5674 cnt_inits_to = 1;
5675 /*
5676 * pull out the scope_id from
5677 * incoming pkt
5678 */
5679 } else if (IN6_IS_ADDR_SITELOCAL(&src6->sin6_addr) ||
5680 IN6_IS_ADDR_SITELOCAL(&dst6->sin6_addr)) {
5681 /*
5682 * If the new destination or source
5683 * is SITE_LOCAL then we must have
5684 * site scope in common.
5685 */
5686 stc.site_scope = 1;
5687 }
5688 memcpy(&stc.laddress, &dst6->sin6_addr, sizeof(struct in6_addr));
5689 stc.laddr_type = SCTP_IPV6_ADDRESS;
5690 break;
5691 }
5692 #endif
5693 default:
5694 /* TSNH */
5695 goto do_a_abort;
5696 break;
5697 }
5698 } else {
5699 /* set the scope per the existing tcb */
5700
5701 #ifdef INET6
5702 struct sctp_nets *lnet;
5703 #endif
5704
5705 stc.loopback_scope = asoc->scope.loopback_scope;
5706 stc.ipv4_scope = asoc->scope.ipv4_local_scope;
5707 stc.site_scope = asoc->scope.site_scope;
5708 stc.local_scope = asoc->scope.local_scope;
5709 #ifdef INET6
5710 /* Why do we not consider IPv4 LL addresses? */
5711 TAILQ_FOREACH(lnet, &asoc->nets, sctp_next) {
5712 if (lnet->ro._l_addr.sin6.sin6_family == AF_INET6) {
5713 if (IN6_IS_ADDR_LINKLOCAL(&lnet->ro._l_addr.sin6.sin6_addr)) {
5714 /*
5715 * if we have a LL address, start
5716 * counting at 1.
5717 */
5718 cnt_inits_to = 1;
5719 }
5720 }
5721 }
5722 #endif
5723 /* use the net pointer */
5724 to = (struct sockaddr *)&net->ro._l_addr;
5725 switch (to->sa_family) {
5726 #ifdef INET
5727 case AF_INET:
5728 sin = (struct sockaddr_in *)to;
5729 stc.address[0] = sin->sin_addr.s_addr;
5730 stc.address[1] = 0;
5731 stc.address[2] = 0;
5732 stc.address[3] = 0;
5733 stc.addr_type = SCTP_IPV4_ADDRESS;
5734 if (net->src_addr_selected == 0) {
5735 /*
5736 * strange case here, the INIT should have
5737 * did the selection.
5738 */
5739 net->ro._s_addr = sctp_source_address_selection(inp,
5740 stcb, (sctp_route_t *)&net->ro,
5741 net, 0, vrf_id);
5742 if (net->ro._s_addr == NULL) {
5743 sctp_m_freem(op_err);
5744 sctp_m_freem(m);
5745 return;
5746 }
5747
5748 net->src_addr_selected = 1;
5749 }
5750 stc.laddress[0] = net->ro._s_addr->address.sin.sin_addr.s_addr;
5751 stc.laddress[1] = 0;
5752 stc.laddress[2] = 0;
5753 stc.laddress[3] = 0;
5754 stc.laddr_type = SCTP_IPV4_ADDRESS;
5755 /* scope_id is only for v6 */
5756 stc.scope_id = 0;
5757 break;
5758 #endif
5759 #ifdef INET6
5760 case AF_INET6:
5761 sin6 = (struct sockaddr_in6 *)to;
5762 memcpy(&stc.address, &sin6->sin6_addr,
5763 sizeof(struct in6_addr));
5764 stc.addr_type = SCTP_IPV6_ADDRESS;
5765 stc.scope_id = sin6->sin6_scope_id;
5766 if (net->src_addr_selected == 0) {
5767 /*
5768 * strange case here, the INIT should have
5769 * done the selection.
5770 */
5771 net->ro._s_addr = sctp_source_address_selection(inp,
5772 stcb, (sctp_route_t *)&net->ro,
5773 net, 0, vrf_id);
5774 if (net->ro._s_addr == NULL) {
5775 sctp_m_freem(op_err);
5776 sctp_m_freem(m);
5777 return;
5778 }
5779
5780 net->src_addr_selected = 1;
5781 }
5782 memcpy(&stc.laddress, &net->ro._s_addr->address.sin6.sin6_addr,
5783 sizeof(struct in6_addr));
5784 stc.laddr_type = SCTP_IPV6_ADDRESS;
5785 break;
5786 #endif
5787 }
5788 }
5789 /* Now lets put the SCTP header in place */
5790 initack = mtod(m, struct sctp_init_ack_chunk *);
5791 /* Save it off for quick ref */
5792 stc.peers_vtag = ntohl(init_chk->init.initiate_tag);
5793 /* who are we */
5794 memcpy(stc.identification, SCTP_VERSION_STRING,
5795 min(strlen(SCTP_VERSION_STRING), sizeof(stc.identification)));
5796 memset(stc.reserved, 0, SCTP_RESERVE_SPACE);
5797 /* now the chunk header */
5798 initack->ch.chunk_type = SCTP_INITIATION_ACK;
5799 initack->ch.chunk_flags = 0;
5800 /* fill in later from mbuf we build */
5801 initack->ch.chunk_length = 0;
5802 /* place in my tag */
5803 if ((asoc != NULL) &&
5804 ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT) ||
5805 (SCTP_GET_STATE(stcb) == SCTP_STATE_INUSE) ||
5806 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED))) {
5807 /* re-use the v-tags and init-seq here */
5808 initack->init.initiate_tag = htonl(asoc->my_vtag);
5809 initack->init.initial_tsn = htonl(asoc->init_seq_number);
5810 } else {
5811 uint32_t vtag, itsn;
5812
5813 if (asoc) {
5814 atomic_add_int(&asoc->refcnt, 1);
5815 SCTP_TCB_UNLOCK(stcb);
5816 new_tag:
5817 SCTP_INP_INFO_RLOCK();
5818 vtag = sctp_select_a_tag(inp, inp->sctp_lport, sh->src_port, 1);
5819 SCTP_INP_INFO_RUNLOCK();
5820 if ((asoc->peer_supports_nat) && (vtag == asoc->my_vtag)) {
5821 /*
5822 * Got a duplicate vtag on some guy behind a
5823 * nat make sure we don't use it.
5824 */
5825 goto new_tag;
5826 }
5827 initack->init.initiate_tag = htonl(vtag);
5828 /* get a TSN to use too */
5829 itsn = sctp_select_initial_TSN(&inp->sctp_ep);
5830 initack->init.initial_tsn = htonl(itsn);
5831 SCTP_TCB_LOCK(stcb);
5832 atomic_subtract_int(&asoc->refcnt, 1);
5833 } else {
5834 SCTP_INP_INCR_REF(inp);
5835 SCTP_INP_RUNLOCK(inp);
5836 SCTP_INP_INFO_RLOCK();
5837 vtag = sctp_select_a_tag(inp, inp->sctp_lport, sh->src_port, 1);
5838 SCTP_INP_INFO_RUNLOCK();
5839 initack->init.initiate_tag = htonl(vtag);
5840 /* get a TSN to use too */
5841 initack->init.initial_tsn = htonl(sctp_select_initial_TSN(&inp->sctp_ep));
5842 SCTP_INP_RLOCK(inp);
5843 SCTP_INP_DECR_REF(inp);
5844 }
5845 }
5846 /* save away my tag to */
5847 stc.my_vtag = initack->init.initiate_tag;
5848
5849 /* set up some of the credits. */
5850 so = inp->sctp_socket;
5851 if (so == NULL) {
5852 /* memory problem */
5853 sctp_m_freem(op_err);
5854 sctp_m_freem(m);
5855 return;
5856 } else {
5857 initack->init.a_rwnd = htonl(max(SCTP_SB_LIMIT_RCV(so), SCTP_MINIMAL_RWND));
5858 }
5859 /* set what I want */
5860 his_limit = ntohs(init_chk->init.num_inbound_streams);
5861 /* choose what I want */
5862 if (asoc != NULL) {
5863 if (asoc->streamoutcnt > asoc->pre_open_streams) {
5864 i_want = asoc->streamoutcnt;
5865 } else {
5866 i_want = asoc->pre_open_streams;
5867 }
5868 } else {
5869 i_want = inp->sctp_ep.pre_open_stream_count;
5870 }
5871 if (his_limit < i_want) {
5872 /* I Want more :< */
5873 initack->init.num_outbound_streams = init_chk->init.num_inbound_streams;
5874 } else {
5875 /* I can have what I want :> */
5876 initack->init.num_outbound_streams = htons(i_want);
5877 }
5878 /* tell him his limit. */
5879 initack->init.num_inbound_streams =
5880 htons(inp->sctp_ep.max_open_streams_intome);
5881
5882 /* adaptation layer indication parameter */
5883 if (inp->sctp_ep.adaptation_layer_indicator_provided) {
5884 parameter_len = (uint16_t)sizeof(struct sctp_adaptation_layer_indication);
5885 ali = (struct sctp_adaptation_layer_indication *)(mtod(m, caddr_t)+chunk_len);
5886 ali->ph.param_type = htons(SCTP_ULP_ADAPTATION);
5887 ali->ph.param_length = htons(parameter_len);
5888 ali->indication = htonl(inp->sctp_ep.adaptation_layer_indicator);
5889 chunk_len += parameter_len;
5890 }
5891
5892 /* ECN parameter */
5893 if (((asoc != NULL) && (asoc->ecn_supported == 1)) ||
5894 ((asoc == NULL) && (inp->ecn_supported == 1))) {
5895 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
5896 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
5897 ph->param_type = htons(SCTP_ECN_CAPABLE);
5898 ph->param_length = htons(parameter_len);
5899 chunk_len += parameter_len;
5900 }
5901
5902 /* PR-SCTP supported parameter */
5903 if (((asoc != NULL) && (asoc->prsctp_supported == 1)) ||
5904 ((asoc == NULL) && (inp->prsctp_supported == 1))) {
5905 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
5906 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
5907 ph->param_type = htons(SCTP_PRSCTP_SUPPORTED);
5908 ph->param_length = htons(parameter_len);
5909 chunk_len += parameter_len;
5910 }
5911
5912 /* Add NAT friendly parameter */
5913 if (nat_friendly) {
5914 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
5915 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
5916 ph->param_type = htons(SCTP_HAS_NAT_SUPPORT);
5917 ph->param_length = htons(parameter_len);
5918 chunk_len += parameter_len;
5919 }
5920
5921 /* And now tell the peer which extensions we support */
5922 num_ext = 0;
5923 pr_supported = (struct sctp_supported_chunk_types_param *)(mtod(m, caddr_t)+chunk_len);
5924 if (((asoc != NULL) && (asoc->prsctp_supported == 1)) ||
5925 ((asoc == NULL) && (inp->prsctp_supported == 1))) {
5926 pr_supported->chunk_types[num_ext++] = SCTP_FORWARD_CUM_TSN;
5927 if (((asoc != NULL) && (asoc->idata_supported == 1)) ||
5928 ((asoc == NULL) && (inp->idata_supported == 1))) {
5929 pr_supported->chunk_types[num_ext++] = SCTP_IFORWARD_CUM_TSN;
5930 }
5931 }
5932 if (((asoc != NULL) && (asoc->auth_supported == 1)) ||
5933 ((asoc == NULL) && (inp->auth_supported == 1))) {
5934 pr_supported->chunk_types[num_ext++] = SCTP_AUTHENTICATION;
5935 }
5936 if (((asoc != NULL) && (asoc->asconf_supported == 1)) ||
5937 ((asoc == NULL) && (inp->asconf_supported == 1))) {
5938 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF;
5939 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF_ACK;
5940 }
5941 if (((asoc != NULL) && (asoc->reconfig_supported == 1)) ||
5942 ((asoc == NULL) && (inp->reconfig_supported == 1))) {
5943 pr_supported->chunk_types[num_ext++] = SCTP_STREAM_RESET;
5944 }
5945 if (((asoc != NULL) && (asoc->idata_supported == 1)) ||
5946 ((asoc == NULL) && (inp->idata_supported == 1))) {
5947 pr_supported->chunk_types[num_ext++] = SCTP_IDATA;
5948 }
5949 if (((asoc != NULL) && (asoc->nrsack_supported == 1)) ||
5950 ((asoc == NULL) && (inp->nrsack_supported == 1))) {
5951 pr_supported->chunk_types[num_ext++] = SCTP_NR_SELECTIVE_ACK;
5952 }
5953 if (((asoc != NULL) && (asoc->pktdrop_supported == 1)) ||
5954 ((asoc == NULL) && (inp->pktdrop_supported == 1))) {
5955 pr_supported->chunk_types[num_ext++] = SCTP_PACKET_DROPPED;
5956 }
5957 if (num_ext > 0) {
5958 parameter_len = (uint16_t)sizeof(struct sctp_supported_chunk_types_param) + num_ext;
5959 pr_supported->ph.param_type = htons(SCTP_SUPPORTED_CHUNK_EXT);
5960 pr_supported->ph.param_length = htons(parameter_len);
5961 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
5962 chunk_len += parameter_len;
5963 }
5964
5965 /* add authentication parameters */
5966 if (((asoc != NULL) && (asoc->auth_supported == 1)) ||
5967 ((asoc == NULL) && (inp->auth_supported == 1))) {
5968 struct sctp_auth_random *randp;
5969 struct sctp_auth_hmac_algo *hmacs;
5970 struct sctp_auth_chunk_list *chunks;
5971
5972 if (padding_len > 0) {
5973 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
5974 chunk_len += padding_len;
5975 padding_len = 0;
5976 }
5977 /* generate and add RANDOM parameter */
5978 randp = (struct sctp_auth_random *)(mtod(m, caddr_t)+chunk_len);
5979 parameter_len = (uint16_t)sizeof(struct sctp_auth_random) +
5980 SCTP_AUTH_RANDOM_SIZE_DEFAULT;
5981 randp->ph.param_type = htons(SCTP_RANDOM);
5982 randp->ph.param_length = htons(parameter_len);
5983 SCTP_READ_RANDOM(randp->random_data, SCTP_AUTH_RANDOM_SIZE_DEFAULT);
5984 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
5985 chunk_len += parameter_len;
5986
5987 if (padding_len > 0) {
5988 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
5989 chunk_len += padding_len;
5990 padding_len = 0;
5991 }
5992 /* add HMAC_ALGO parameter */
5993 hmacs = (struct sctp_auth_hmac_algo *)(mtod(m, caddr_t)+chunk_len);
5994 parameter_len = (uint16_t)sizeof(struct sctp_auth_hmac_algo) +
5995 sctp_serialize_hmaclist(inp->sctp_ep.local_hmacs,
5996 (uint8_t *)hmacs->hmac_ids);
5997 hmacs->ph.param_type = htons(SCTP_HMAC_LIST);
5998 hmacs->ph.param_length = htons(parameter_len);
5999 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6000 chunk_len += parameter_len;
6001
6002 if (padding_len > 0) {
6003 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
6004 chunk_len += padding_len;
6005 padding_len = 0;
6006 }
6007 /* add CHUNKS parameter */
6008 chunks = (struct sctp_auth_chunk_list *)(mtod(m, caddr_t)+chunk_len);
6009 parameter_len = (uint16_t)sizeof(struct sctp_auth_chunk_list) +
6010 sctp_serialize_auth_chunks(inp->sctp_ep.local_auth_chunks,
6011 chunks->chunk_types);
6012 chunks->ph.param_type = htons(SCTP_CHUNK_LIST);
6013 chunks->ph.param_length = htons(parameter_len);
6014 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6015 chunk_len += parameter_len;
6016 }
6017 SCTP_BUF_LEN(m) = chunk_len;
6018 m_last = m;
6019 /* now the addresses */
6020 /*
6021 * To optimize this we could put the scoping stuff into a structure
6022 * and remove the individual uint8's from the stc structure. Then we
6023 * could just sifa in the address within the stc.. but for now this
6024 * is a quick hack to get the address stuff teased apart.
6025 */
6026 scp.ipv4_addr_legal = stc.ipv4_addr_legal;
6027 scp.ipv6_addr_legal = stc.ipv6_addr_legal;
6028 scp.loopback_scope = stc.loopback_scope;
6029 scp.ipv4_local_scope = stc.ipv4_scope;
6030 scp.local_scope = stc.local_scope;
6031 scp.site_scope = stc.site_scope;
6032 m_last = sctp_add_addresses_to_i_ia(inp, stcb, &scp, m_last,
6033 cnt_inits_to,
6034 &padding_len, &chunk_len);
6035 /* padding_len can only be positive, if no addresses have been added */
6036 if (padding_len > 0) {
6037 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
6038 chunk_len += padding_len;
6039 SCTP_BUF_LEN(m) += padding_len;
6040 padding_len = 0;
6041 }
6042
6043 /* tack on the operational error if present */
6044 if (op_err) {
6045 parameter_len = 0;
6046 for (m_tmp = op_err; m_tmp != NULL; m_tmp = SCTP_BUF_NEXT(m_tmp)) {
6047 parameter_len += SCTP_BUF_LEN(m_tmp);
6048 }
6049 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6050 SCTP_BUF_NEXT(m_last) = op_err;
6051 while (SCTP_BUF_NEXT(m_last) != NULL) {
6052 m_last = SCTP_BUF_NEXT(m_last);
6053 }
6054 chunk_len += parameter_len;
6055 }
6056 if (padding_len > 0) {
6057 m_last = sctp_add_pad_tombuf(m_last, padding_len);
6058 if (m_last == NULL) {
6059 /* Houston we have a problem, no space */
6060 sctp_m_freem(m);
6061 return;
6062 }
6063 chunk_len += padding_len;
6064 padding_len = 0;
6065 }
6066 /* Now we must build a cookie */
6067 m_cookie = sctp_add_cookie(init_pkt, offset, m, 0, &stc, &signature);
6068 if (m_cookie == NULL) {
6069 /* memory problem */
6070 sctp_m_freem(m);
6071 return;
6072 }
6073 /* Now append the cookie to the end and update the space/size */
6074 SCTP_BUF_NEXT(m_last) = m_cookie;
6075 parameter_len = 0;
6076 for (m_tmp = m_cookie; m_tmp != NULL; m_tmp = SCTP_BUF_NEXT(m_tmp)) {
6077 parameter_len += SCTP_BUF_LEN(m_tmp);
6078 if (SCTP_BUF_NEXT(m_tmp) == NULL) {
6079 m_last = m_tmp;
6080 }
6081 }
6082 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6083 chunk_len += parameter_len;
6084
6085 /*
6086 * Place in the size, but we don't include the last pad (if any) in
6087 * the INIT-ACK.
6088 */
6089 initack->ch.chunk_length = htons(chunk_len);
6090
6091 /*
6092 * Time to sign the cookie, we don't sign over the cookie signature
6093 * though thus we set trailer.
6094 */
6095 (void)sctp_hmac_m(SCTP_HMAC,
6096 (uint8_t *)inp->sctp_ep.secret_key[(int)(inp->sctp_ep.current_secret_number)],
6097 SCTP_SECRET_SIZE, m_cookie, sizeof(struct sctp_paramhdr),
6098 (uint8_t *)signature, SCTP_SIGNATURE_SIZE);
6099 /*
6100 * We sifa 0 here to NOT set IP_DF if its IPv4, we ignore the return
6101 * here since the timer will drive a retranmission.
6102 */
6103 if (padding_len > 0) {
6104 if (sctp_add_pad_tombuf(m_last, padding_len) == NULL) {
6105 sctp_m_freem(m);
6106 return;
6107 }
6108 }
6109 if (stc.loopback_scope) {
6110 over_addr = (union sctp_sockstore *)dst;
6111 } else {
6112 over_addr = NULL;
6113 }
6114
6115 if ((error = sctp_lowlevel_chunk_output(inp, NULL, NULL, to, m, 0, NULL, 0, 0,
6116 0, 0,
6117 inp->sctp_lport, sh->src_port, init_chk->init.initiate_tag,
6118 port, over_addr,
6119 mflowtype, mflowid,
6120 SCTP_SO_NOT_LOCKED))) {
6121 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Gak send error %d\n", error);
6122 if (error == ENOBUFS) {
6123 if (asoc != NULL) {
6124 asoc->ifp_had_enobuf = 1;
6125 }
6126 SCTP_STAT_INCR(sctps_lowlevelerr);
6127 }
6128 } else {
6129 if (asoc != NULL) {
6130 asoc->ifp_had_enobuf = 0;
6131 }
6132 }
6133 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
6134 }
6135
6136 static void
6137 sctp_prune_prsctp(struct sctp_tcb *stcb,
6138 struct sctp_association *asoc,
6139 struct sctp_nonpad_sndrcvinfo *srcv,
6140 int dataout)
6141 {
6142 int freed_spc = 0;
6143 struct sctp_tmit_chunk *chk, *nchk;
6144
6145 SCTP_TCB_LOCK_ASSERT(stcb);
6146 if ((asoc->prsctp_supported) &&
6147 (asoc->sent_queue_cnt_removeable > 0)) {
6148 TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) {
6149 /*
6150 * Look for chunks marked with the PR_SCTP flag AND
6151 * the buffer space flag. If the one being sent is
6152 * equal or greater priority then purge the old one
6153 * and free some space.
6154 */
6155 if (PR_SCTP_BUF_ENABLED(chk->flags)) {
6156 /*
6157 * This one is PR-SCTP AND buffer space
6158 * limited type
6159 */
6160 if (chk->rec.data.timetodrop.tv_sec > (long)srcv->sinfo_timetolive) {
6161 /*
6162 * Lower numbers equates to higher
6163 * priority. So if the one we are
6164 * looking at has a larger priority,
6165 * we want to drop the data and NOT
6166 * retransmit it.
6167 */
6168 if (chk->data) {
6169 /*
6170 * We release the book_size
6171 * if the mbuf is here
6172 */
6173 int ret_spc;
6174 uint8_t sent;
6175
6176 if (chk->sent > SCTP_DATAGRAM_UNSENT)
6177 sent = 1;
6178 else
6179 sent = 0;
6180 ret_spc = sctp_release_pr_sctp_chunk(stcb, chk,
6181 sent,
6182 SCTP_SO_LOCKED);
6183 freed_spc += ret_spc;
6184 if (freed_spc >= dataout) {
6185 return;
6186 }
6187 } /* if chunk was present */
6188 } /* if of sufficient priority */
6189 } /* if chunk has enabled */
6190 } /* tailqforeach */
6191
6192 TAILQ_FOREACH_SAFE(chk, &asoc->send_queue, sctp_next, nchk) {
6193 /* Here we must move to the sent queue and mark */
6194 if (PR_SCTP_BUF_ENABLED(chk->flags)) {
6195 if (chk->rec.data.timetodrop.tv_sec > (long)srcv->sinfo_timetolive) {
6196 if (chk->data) {
6197 /*
6198 * We release the book_size
6199 * if the mbuf is here
6200 */
6201 int ret_spc;
6202
6203 ret_spc = sctp_release_pr_sctp_chunk(stcb, chk,
6204 0, SCTP_SO_LOCKED);
6205
6206 freed_spc += ret_spc;
6207 if (freed_spc >= dataout) {
6208 return;
6209 }
6210 } /* end if chk->data */
6211 } /* end if right class */
6212 } /* end if chk pr-sctp */
6213 } /* tailqforeachsafe (chk) */
6214 } /* if enabled in asoc */
6215 }
6216
6217 uint32_t
6218 sctp_get_frag_point(struct sctp_tcb *stcb)
6219 {
6220 struct sctp_association *asoc;
6221 uint32_t frag_point, overhead;
6222
6223 asoc = &stcb->asoc;
6224 /* Consider IP header and SCTP common header. */
6225 if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
6226 overhead = SCTP_MIN_OVERHEAD;
6227 } else {
6228 overhead = SCTP_MIN_V4_OVERHEAD;
6229 }
6230 /* Consider DATA/IDATA chunk header and AUTH header, if needed. */
6231 if (asoc->idata_supported) {
6232 overhead += sizeof(struct sctp_idata_chunk);
6233 if (sctp_auth_is_required_chunk(SCTP_IDATA, asoc->peer_auth_chunks)) {
6234 overhead += sctp_get_auth_chunk_len(asoc->peer_hmac_id);
6235 }
6236 } else {
6237 overhead += sizeof(struct sctp_data_chunk);
6238 if (sctp_auth_is_required_chunk(SCTP_DATA, asoc->peer_auth_chunks)) {
6239 overhead += sctp_get_auth_chunk_len(asoc->peer_hmac_id);
6240 }
6241 }
6242 KASSERT(overhead % 4 == 0,
6243 ("overhead (%u) not a multiple of 4", overhead));
6244 /* Consider padding. */
6245 if (asoc->smallest_mtu % 4 > 0) {
6246 overhead += (asoc->smallest_mtu % 4);
6247 }
6248 KASSERT(asoc->smallest_mtu > overhead,
6249 ("Association MTU (%u) too small for overhead (%u)",
6250 asoc->smallest_mtu, overhead));
6251 frag_point = asoc->smallest_mtu - overhead;
6252 KASSERT(frag_point % 4 == 0,
6253 ("frag_point (%u) not a multiple of 4", frag_point));
6254 /* Honor MAXSEG socket option. */
6255 if ((asoc->sctp_frag_point > 0) &&
6256 (asoc->sctp_frag_point < frag_point)) {
6257 frag_point = asoc->sctp_frag_point;
6258 }
6259 return (frag_point);
6260 }
6261
6262 static void
6263 sctp_set_prsctp_policy(struct sctp_stream_queue_pending *sp)
6264 {
6265 /*
6266 * We assume that the user wants PR_SCTP_TTL if the user provides a
6267 * positive lifetime but does not specify any PR_SCTP policy.
6268 */
6269 if (PR_SCTP_ENABLED(sp->sinfo_flags)) {
6270 sp->act_flags |= PR_SCTP_POLICY(sp->sinfo_flags);
6271 } else if (sp->timetolive > 0) {
6272 sp->sinfo_flags |= SCTP_PR_SCTP_TTL;
6273 sp->act_flags |= PR_SCTP_POLICY(sp->sinfo_flags);
6274 } else {
6275 return;
6276 }
6277 switch (PR_SCTP_POLICY(sp->sinfo_flags)) {
6278 case CHUNK_FLAGS_PR_SCTP_BUF:
6279 /*
6280 * Time to live is a priority stored in tv_sec when doing
6281 * the buffer drop thing.
6282 */
6283 sp->ts.tv_sec = sp->timetolive;
6284 sp->ts.tv_usec = 0;
6285 break;
6286 case CHUNK_FLAGS_PR_SCTP_TTL:
6287 {
6288 struct timeval tv;
6289
6290 (void)SCTP_GETTIME_TIMEVAL(&sp->ts);
6291 tv.tv_sec = sp->timetolive / 1000;
6292 tv.tv_usec = (sp->timetolive * 1000) % 1000000;
6293 /*
6294 * TODO sctp_constants.h needs alternative time
6295 * macros when _KERNEL is undefined.
6296 */
6297 timevaladd(&sp->ts, &tv);
6298 }
6299 break;
6300 case CHUNK_FLAGS_PR_SCTP_RTX:
6301 /*
6302 * Time to live is a the number or retransmissions stored in
6303 * tv_sec.
6304 */
6305 sp->ts.tv_sec = sp->timetolive;
6306 sp->ts.tv_usec = 0;
6307 break;
6308 default:
6309 SCTPDBG(SCTP_DEBUG_USRREQ1,
6310 "Unknown PR_SCTP policy %u.\n",
6311 PR_SCTP_POLICY(sp->sinfo_flags));
6312 break;
6313 }
6314 }
6315
6316 static int
6317 sctp_msg_append(struct sctp_tcb *stcb,
6318 struct sctp_nets *net,
6319 struct mbuf *m,
6320 struct sctp_nonpad_sndrcvinfo *srcv)
6321 {
6322 int error = 0;
6323 struct mbuf *at;
6324 struct sctp_stream_queue_pending *sp = NULL;
6325 struct sctp_stream_out *strm;
6326
6327 SCTP_TCB_LOCK_ASSERT(stcb);
6328
6329 /*
6330 * Given an mbuf chain, put it into the association send queue and
6331 * place it on the wheel
6332 */
6333 if (srcv->sinfo_stream >= stcb->asoc.streamoutcnt) {
6334 /* Invalid stream number */
6335 SCTP_LTRACE_ERR_RET_PKT(m, NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
6336 error = EINVAL;
6337 goto out_now;
6338 }
6339 if ((stcb->asoc.stream_locked) &&
6340 (stcb->asoc.stream_locked_on != srcv->sinfo_stream)) {
6341 SCTP_LTRACE_ERR_RET_PKT(m, NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
6342 error = EINVAL;
6343 goto out_now;
6344 }
6345 if ((stcb->asoc.strmout[srcv->sinfo_stream].state != SCTP_STREAM_OPEN) &&
6346 (stcb->asoc.strmout[srcv->sinfo_stream].state != SCTP_STREAM_OPENING)) {
6347 /*
6348 * Can't queue any data while stream reset is underway.
6349 */
6350 if (stcb->asoc.strmout[srcv->sinfo_stream].state > SCTP_STREAM_OPEN) {
6351 error = EAGAIN;
6352 } else {
6353 error = EINVAL;
6354 }
6355 goto out_now;
6356 }
6357 /* Now can we send this? */
6358 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_SENT) ||
6359 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_ACK_SENT) ||
6360 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
6361 (stcb->asoc.state & SCTP_STATE_SHUTDOWN_PENDING)) {
6362 /* got data while shutting down */
6363 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EPIPE);
6364 error = EPIPE;
6365 goto out_now;
6366 }
6367 sctp_alloc_a_strmoq(stcb, sp);
6368 if (sp == NULL) {
6369 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
6370 error = ENOMEM;
6371 goto out_now;
6372 }
6373 sp->sinfo_flags = srcv->sinfo_flags;
6374 sp->timetolive = srcv->sinfo_timetolive;
6375 sp->ppid = srcv->sinfo_ppid;
6376 sp->context = srcv->sinfo_context;
6377 sp->fsn = 0;
6378 if (sp->sinfo_flags & SCTP_ADDR_OVER) {
6379 sp->net = net;
6380 atomic_add_int(&sp->net->ref_count, 1);
6381 } else {
6382 sp->net = NULL;
6383 }
6384 (void)SCTP_GETTIME_TIMEVAL(&sp->ts);
6385 sp->sid = srcv->sinfo_stream;
6386 sp->msg_is_complete = 1;
6387 sp->sender_all_done = 1;
6388 sp->some_taken = 0;
6389 sp->data = m;
6390 sp->tail_mbuf = NULL;
6391 sctp_set_prsctp_policy(sp);
6392 /*
6393 * We could in theory (for sendall) sifa the length in, but we would
6394 * still have to hunt through the chain since we need to setup the
6395 * tail_mbuf
6396 */
6397 sp->length = 0;
6398 for (at = m; at; at = SCTP_BUF_NEXT(at)) {
6399 if (SCTP_BUF_NEXT(at) == NULL)
6400 sp->tail_mbuf = at;
6401 sp->length += SCTP_BUF_LEN(at);
6402 }
6403 if (srcv->sinfo_keynumber_valid) {
6404 sp->auth_keyid = srcv->sinfo_keynumber;
6405 } else {
6406 sp->auth_keyid = stcb->asoc.authinfo.active_keyid;
6407 }
6408 if (sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks)) {
6409 sctp_auth_key_acquire(stcb, sp->auth_keyid);
6410 sp->holds_key_ref = 1;
6411 }
6412 strm = &stcb->asoc.strmout[srcv->sinfo_stream];
6413 sctp_snd_sb_alloc(stcb, sp->length);
6414 atomic_add_int(&stcb->asoc.stream_queue_cnt, 1);
6415 TAILQ_INSERT_TAIL(&strm->outqueue, sp, next);
6416 stcb->asoc.ss_functions.sctp_ss_add_to_stream(stcb, &stcb->asoc, strm, sp);
6417 m = NULL;
6418 out_now:
6419 if (m) {
6420 sctp_m_freem(m);
6421 }
6422 return (error);
6423 }
6424
6425 static struct mbuf *
6426 sctp_copy_mbufchain(struct mbuf *clonechain,
6427 struct mbuf *outchain,
6428 struct mbuf **endofchain,
6429 int can_take_mbuf,
6430 int sizeofcpy,
6431 uint8_t copy_by_ref)
6432 {
6433 struct mbuf *m;
6434 struct mbuf *appendchain;
6435 caddr_t cp;
6436 int len;
6437
6438 if (endofchain == NULL) {
6439 /* error */
6440 error_out:
6441 if (outchain)
6442 sctp_m_freem(outchain);
6443 return (NULL);
6444 }
6445 if (can_take_mbuf) {
6446 appendchain = clonechain;
6447 } else {
6448 if (!copy_by_ref &&
6449 (sizeofcpy <= (int)((((SCTP_BASE_SYSCTL(sctp_mbuf_threshold_count) - 1) * MLEN) + MHLEN)))) {
6450 /* Its not in a cluster */
6451 if (*endofchain == NULL) {
6452 /* lets get a mbuf cluster */
6453 if (outchain == NULL) {
6454 /* This is the general case */
6455 new_mbuf:
6456 outchain = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_HEADER);
6457 if (outchain == NULL) {
6458 goto error_out;
6459 }
6460 SCTP_BUF_LEN(outchain) = 0;
6461 *endofchain = outchain;
6462 /* get the prepend space */
6463 SCTP_BUF_RESV_UF(outchain, (SCTP_FIRST_MBUF_RESV + 4));
6464 } else {
6465 /*
6466 * We really should not get a NULL
6467 * in endofchain
6468 */
6469 /* find end */
6470 m = outchain;
6471 while (m) {
6472 if (SCTP_BUF_NEXT(m) == NULL) {
6473 *endofchain = m;
6474 break;
6475 }
6476 m = SCTP_BUF_NEXT(m);
6477 }
6478 /* sanity */
6479 if (*endofchain == NULL) {
6480 /*
6481 * huh, TSNH XXX maybe we
6482 * should panic
6483 */
6484 sctp_m_freem(outchain);
6485 goto new_mbuf;
6486 }
6487 }
6488 /* get the new end of length */
6489 len = (int)M_TRAILINGSPACE(*endofchain);
6490 } else {
6491 /* how much is left at the end? */
6492 len = (int)M_TRAILINGSPACE(*endofchain);
6493 }
6494 /* Find the end of the data, for appending */
6495 cp = (mtod((*endofchain), caddr_t)+SCTP_BUF_LEN((*endofchain)));
6496
6497 /* Now lets copy it out */
6498 if (len >= sizeofcpy) {
6499 /* It all fits, copy it in */
6500 m_copydata(clonechain, 0, sizeofcpy, cp);
6501 SCTP_BUF_LEN((*endofchain)) += sizeofcpy;
6502 } else {
6503 /* fill up the end of the chain */
6504 if (len > 0) {
6505 m_copydata(clonechain, 0, len, cp);
6506 SCTP_BUF_LEN((*endofchain)) += len;
6507 /* now we need another one */
6508 sizeofcpy -= len;
6509 }
6510 m = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_HEADER);
6511 if (m == NULL) {
6512 /* We failed */
6513 goto error_out;
6514 }
6515 SCTP_BUF_NEXT((*endofchain)) = m;
6516 *endofchain = m;
6517 cp = mtod((*endofchain), caddr_t);
6518 m_copydata(clonechain, len, sizeofcpy, cp);
6519 SCTP_BUF_LEN((*endofchain)) += sizeofcpy;
6520 }
6521 return (outchain);
6522 } else {
6523 /* copy the old fashion way */
6524 appendchain = SCTP_M_COPYM(clonechain, 0, M_COPYALL, M_NOWAIT);
6525 #ifdef SCTP_MBUF_LOGGING
6526 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
6527 sctp_log_mbc(appendchain, SCTP_MBUF_ICOPY);
6528 }
6529 #endif
6530 }
6531 }
6532 if (appendchain == NULL) {
6533 /* error */
6534 if (outchain)
6535 sctp_m_freem(outchain);
6536 return (NULL);
6537 }
6538 if (outchain) {
6539 /* tack on to the end */
6540 if (*endofchain != NULL) {
6541 SCTP_BUF_NEXT(((*endofchain))) = appendchain;
6542 } else {
6543 m = outchain;
6544 while (m) {
6545 if (SCTP_BUF_NEXT(m) == NULL) {
6546 SCTP_BUF_NEXT(m) = appendchain;
6547 break;
6548 }
6549 m = SCTP_BUF_NEXT(m);
6550 }
6551 }
6552 /*
6553 * save off the end and update the end-chain position
6554 */
6555 m = appendchain;
6556 while (m) {
6557 if (SCTP_BUF_NEXT(m) == NULL) {
6558 *endofchain = m;
6559 break;
6560 }
6561 m = SCTP_BUF_NEXT(m);
6562 }
6563 return (outchain);
6564 } else {
6565 /* save off the end and update the end-chain position */
6566 m = appendchain;
6567 while (m) {
6568 if (SCTP_BUF_NEXT(m) == NULL) {
6569 *endofchain = m;
6570 break;
6571 }
6572 m = SCTP_BUF_NEXT(m);
6573 }
6574 return (appendchain);
6575 }
6576 }
6577
6578 static int
6579 sctp_med_chunk_output(struct sctp_inpcb *inp,
6580 struct sctp_tcb *stcb,
6581 struct sctp_association *asoc,
6582 int *num_out,
6583 int *reason_code,
6584 int control_only, int from_where,
6585 struct timeval *now, int *now_filled,
6586 uint32_t frag_point, int so_locked);
6587
6588 static void
6589 sctp_sendall_iterator(struct sctp_inpcb *inp, struct sctp_tcb *stcb, void *ptr,
6590 uint32_t val SCTP_UNUSED)
6591 {
6592 struct sctp_copy_all *ca;
6593 struct mbuf *m;
6594 int ret = 0;
6595 int added_control = 0;
6596 int un_sent, do_chunk_output = 1;
6597 struct sctp_association *asoc;
6598 struct sctp_nets *net;
6599
6600 ca = (struct sctp_copy_all *)ptr;
6601 if (ca->m == NULL) {
6602 return;
6603 }
6604 if (ca->inp != inp) {
6605 /* TSNH */
6606 return;
6607 }
6608 if (ca->sndlen > 0) {
6609 m = SCTP_M_COPYM(ca->m, 0, M_COPYALL, M_NOWAIT);
6610 if (m == NULL) {
6611 /* can't copy so we are done */
6612 ca->cnt_failed++;
6613 return;
6614 }
6615 #ifdef SCTP_MBUF_LOGGING
6616 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
6617 sctp_log_mbc(m, SCTP_MBUF_ICOPY);
6618 }
6619 #endif
6620 } else {
6621 m = NULL;
6622 }
6623 SCTP_TCB_LOCK_ASSERT(stcb);
6624 if (stcb->asoc.alternate) {
6625 net = stcb->asoc.alternate;
6626 } else {
6627 net = stcb->asoc.primary_destination;
6628 }
6629 if (ca->sndrcv.sinfo_flags & SCTP_ABORT) {
6630 /* Abort this assoc with m as the user defined reason */
6631 if (m != NULL) {
6632 SCTP_BUF_PREPEND(m, sizeof(struct sctp_paramhdr), M_NOWAIT);
6633 } else {
6634 m = sctp_get_mbuf_for_msg(sizeof(struct sctp_paramhdr),
6635 0, M_NOWAIT, 1, MT_DATA);
6636 SCTP_BUF_LEN(m) = sizeof(struct sctp_paramhdr);
6637 }
6638 if (m != NULL) {
6639 struct sctp_paramhdr *ph;
6640
6641 ph = mtod(m, struct sctp_paramhdr *);
6642 ph->param_type = htons(SCTP_CAUSE_USER_INITIATED_ABT);
6643 ph->param_length = htons((uint16_t)(sizeof(struct sctp_paramhdr) + ca->sndlen));
6644 }
6645 /*
6646 * We add one here to keep the assoc from dis-appearing on
6647 * us.
6648 */
6649 atomic_add_int(&stcb->asoc.refcnt, 1);
6650 sctp_abort_an_association(inp, stcb, m, false, SCTP_SO_NOT_LOCKED);
6651 /*
6652 * sctp_abort_an_association calls sctp_free_asoc() free
6653 * association will NOT free it since we incremented the
6654 * refcnt .. we do this to prevent it being freed and things
6655 * getting tricky since we could end up (from free_asoc)
6656 * calling inpcb_free which would get a recursive lock call
6657 * to the iterator lock.. But as a consequence of that the
6658 * stcb will return to us un-locked.. since free_asoc
6659 * returns with either no TCB or the TCB unlocked, we must
6660 * relock.. to unlock in the iterator timer :-0
6661 */
6662 SCTP_TCB_LOCK(stcb);
6663 atomic_subtract_int(&stcb->asoc.refcnt, 1);
6664 goto no_chunk_output;
6665 } else {
6666 if (m != NULL) {
6667 ret = sctp_msg_append(stcb, net, m, &ca->sndrcv);
6668 }
6669 asoc = &stcb->asoc;
6670 if (ca->sndrcv.sinfo_flags & SCTP_EOF) {
6671 /* shutdown this assoc */
6672 if (TAILQ_EMPTY(&asoc->send_queue) &&
6673 TAILQ_EMPTY(&asoc->sent_queue) &&
6674 sctp_is_there_unsent_data(stcb, SCTP_SO_NOT_LOCKED) == 0) {
6675 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
6676 goto abort_anyway;
6677 }
6678 /*
6679 * there is nothing queued to send, so I'm
6680 * done...
6681 */
6682 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
6683 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
6684 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
6685 /*
6686 * only send SHUTDOWN the first time
6687 * through
6688 */
6689 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
6690 SCTP_STAT_DECR_GAUGE32(sctps_currestab);
6691 }
6692 SCTP_SET_STATE(stcb, SCTP_STATE_SHUTDOWN_SENT);
6693 sctp_stop_timers_for_shutdown(stcb);
6694 sctp_send_shutdown(stcb, net);
6695 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN, stcb->sctp_ep, stcb,
6696 net);
6697 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
6698 NULL);
6699 added_control = 1;
6700 do_chunk_output = 0;
6701 }
6702 } else {
6703 /*
6704 * we still got (or just got) data to send,
6705 * so set SHUTDOWN_PENDING
6706 */
6707 /*
6708 * XXX sockets draft says that SCTP_EOF
6709 * should be sent with no data. currently,
6710 * we will allow user data to be sent first
6711 * and move to SHUTDOWN-PENDING
6712 */
6713 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
6714 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
6715 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
6716 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
6717 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_PARTIAL_MSG_LEFT);
6718 }
6719 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_SHUTDOWN_PENDING);
6720 if (TAILQ_EMPTY(&asoc->send_queue) &&
6721 TAILQ_EMPTY(&asoc->sent_queue) &&
6722 (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT)) {
6723 struct mbuf *op_err;
6724 char msg[SCTP_DIAG_INFO_LEN];
6725
6726 abort_anyway:
6727 SCTP_SNPRINTF(msg, sizeof(msg),
6728 "%s:%d at %s", __FILE__, __LINE__, __func__);
6729 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
6730 msg);
6731 atomic_add_int(&stcb->asoc.refcnt, 1);
6732 sctp_abort_an_association(stcb->sctp_ep, stcb,
6733 op_err, false, SCTP_SO_NOT_LOCKED);
6734 atomic_subtract_int(&stcb->asoc.refcnt, 1);
6735 goto no_chunk_output;
6736 }
6737 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
6738 NULL);
6739 }
6740 }
6741 }
6742 }
6743 un_sent = ((stcb->asoc.total_output_queue_size - stcb->asoc.total_flight) +
6744 (stcb->asoc.stream_queue_cnt * SCTP_DATA_CHUNK_OVERHEAD(stcb)));
6745
6746 if ((sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY)) &&
6747 (stcb->asoc.total_flight > 0) &&
6748 (un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD))) {
6749 do_chunk_output = 0;
6750 }
6751 if (do_chunk_output)
6752 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_NOT_LOCKED);
6753 else if (added_control) {
6754 struct timeval now;
6755 int num_out, reason, now_filled = 0;
6756
6757 (void)sctp_med_chunk_output(inp, stcb, &stcb->asoc, &num_out,
6758 &reason, 1, 1, &now, &now_filled,
6759 sctp_get_frag_point(stcb),
6760 SCTP_SO_NOT_LOCKED);
6761 }
6762 no_chunk_output:
6763 if (ret) {
6764 ca->cnt_failed++;
6765 } else {
6766 ca->cnt_sent++;
6767 }
6768 }
6769
6770 static void
6771 sctp_sendall_completes(void *ptr, uint32_t val SCTP_UNUSED)
6772 {
6773 struct sctp_copy_all *ca;
6774
6775 ca = (struct sctp_copy_all *)ptr;
6776 /*
6777 * Do a notify here? Kacheong suggests that the notify be done at
6778 * the send time.. so you would push up a notification if any send
6779 * failed. Don't know if this is feasible since the only failures we
6780 * have is "memory" related and if you cannot get an mbuf to send
6781 * the data you surely can't get an mbuf to send up to notify the
6782 * user you can't send the data :->
6783 */
6784
6785 /* now free everything */
6786 if (ca->inp) {
6787 /* Lets clear the flag to allow others to run. */
6788 SCTP_INP_WLOCK(ca->inp);
6789 ca->inp->sctp_flags &= ~SCTP_PCB_FLAGS_SND_ITERATOR_UP;
6790 SCTP_INP_WUNLOCK(ca->inp);
6791 }
6792 sctp_m_freem(ca->m);
6793 SCTP_FREE(ca, SCTP_M_COPYAL);
6794 }
6795
6796 static struct mbuf *
6797 sctp_copy_out_all(struct uio *uio, ssize_t len)
6798 {
6799 struct mbuf *ret, *at;
6800 ssize_t left, willcpy, cancpy, error;
6801
6802 ret = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_WAITOK, 1, MT_DATA);
6803 if (ret == NULL) {
6804 /* TSNH */
6805 return (NULL);
6806 }
6807 left = len;
6808 SCTP_BUF_LEN(ret) = 0;
6809 /* save space for the data chunk header */
6810 cancpy = (int)M_TRAILINGSPACE(ret);
6811 willcpy = min(cancpy, left);
6812 at = ret;
6813 while (left > 0) {
6814 /* Align data to the end */
6815 error = uiomove(mtod(at, caddr_t), (int)willcpy, uio);
6816 if (error) {
6817 err_out_now:
6818 sctp_m_freem(at);
6819 return (NULL);
6820 }
6821 SCTP_BUF_LEN(at) = (int)willcpy;
6822 SCTP_BUF_NEXT_PKT(at) = SCTP_BUF_NEXT(at) = 0;
6823 left -= willcpy;
6824 if (left > 0) {
6825 SCTP_BUF_NEXT(at) = sctp_get_mbuf_for_msg((unsigned int)left, 0, M_WAITOK, 1, MT_DATA);
6826 if (SCTP_BUF_NEXT(at) == NULL) {
6827 goto err_out_now;
6828 }
6829 at = SCTP_BUF_NEXT(at);
6830 SCTP_BUF_LEN(at) = 0;
6831 cancpy = (int)M_TRAILINGSPACE(at);
6832 willcpy = min(cancpy, left);
6833 }
6834 }
6835 return (ret);
6836 }
6837
6838 static int
6839 sctp_sendall(struct sctp_inpcb *inp, struct uio *uio, struct mbuf *m,
6840 struct sctp_nonpad_sndrcvinfo *srcv)
6841 {
6842 int ret;
6843 struct sctp_copy_all *ca;
6844
6845 if (uio->uio_resid > (ssize_t)SCTP_BASE_SYSCTL(sctp_sendall_limit)) {
6846 /* You must not be larger than the limit! */
6847 return (EMSGSIZE);
6848 }
6849 SCTP_MALLOC(ca, struct sctp_copy_all *, sizeof(struct sctp_copy_all),
6850 SCTP_M_COPYAL);
6851 if (ca == NULL) {
6852 sctp_m_freem(m);
6853 SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
6854 return (ENOMEM);
6855 }
6856 memset(ca, 0, sizeof(struct sctp_copy_all));
6857
6858 ca->inp = inp;
6859 if (srcv != NULL) {
6860 memcpy(&ca->sndrcv, srcv, sizeof(struct sctp_nonpad_sndrcvinfo));
6861 }
6862
6863 /* Serialize. */
6864 SCTP_INP_WLOCK(inp);
6865 if ((inp->sctp_flags & SCTP_PCB_FLAGS_SND_ITERATOR_UP) != 0) {
6866 SCTP_INP_WUNLOCK(inp);
6867 sctp_m_freem(m);
6868 SCTP_FREE(ca, SCTP_M_COPYAL);
6869 return (EBUSY);
6870 }
6871 inp->sctp_flags |= SCTP_PCB_FLAGS_SND_ITERATOR_UP;
6872 SCTP_INP_WUNLOCK(inp);
6873
6874 /*
6875 * take off the sendall flag, it would be bad if we failed to do
6876 * this :-0
6877 */
6878 ca->sndrcv.sinfo_flags &= ~SCTP_SENDALL;
6879 /* get length and mbuf chain */
6880 if (uio) {
6881 ca->sndlen = uio->uio_resid;
6882 ca->m = sctp_copy_out_all(uio, ca->sndlen);
6883 if (ca->m == NULL) {
6884 SCTP_FREE(ca, SCTP_M_COPYAL);
6885 sctp_m_freem(m);
6886 SCTP_INP_WLOCK(inp);
6887 inp->sctp_flags &= ~SCTP_PCB_FLAGS_SND_ITERATOR_UP;
6888 SCTP_INP_WUNLOCK(inp);
6889 SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
6890 return (ENOMEM);
6891 }
6892 } else {
6893 /* Gather the length of the send */
6894 struct mbuf *mat;
6895
6896 ca->sndlen = 0;
6897 for (mat = m; mat; mat = SCTP_BUF_NEXT(mat)) {
6898 ca->sndlen += SCTP_BUF_LEN(mat);
6899 }
6900 }
6901 ret = sctp_initiate_iterator(NULL, sctp_sendall_iterator, NULL,
6902 SCTP_PCB_ANY_FLAGS, SCTP_PCB_ANY_FEATURES,
6903 SCTP_ASOC_ANY_STATE,
6904 (void *)ca, 0,
6905 sctp_sendall_completes, inp, 1);
6906 if (ret) {
6907 SCTP_INP_WLOCK(inp);
6908 inp->sctp_flags &= ~SCTP_PCB_FLAGS_SND_ITERATOR_UP;
6909 SCTP_INP_WUNLOCK(inp);
6910 SCTP_FREE(ca, SCTP_M_COPYAL);
6911 SCTP_LTRACE_ERR_RET_PKT(m, inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EFAULT);
6912 return (EFAULT);
6913 }
6914 return (0);
6915 }
6916
6917 void
6918 sctp_toss_old_cookies(struct sctp_tcb *stcb, struct sctp_association *asoc)
6919 {
6920 struct sctp_tmit_chunk *chk, *nchk;
6921
6922 TAILQ_FOREACH_SAFE(chk, &asoc->control_send_queue, sctp_next, nchk) {
6923 if (chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) {
6924 TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next);
6925 asoc->ctrl_queue_cnt--;
6926 if (chk->data) {
6927 sctp_m_freem(chk->data);
6928 chk->data = NULL;
6929 }
6930 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
6931 }
6932 }
6933 }
6934
6935 void
6936 sctp_toss_old_asconf(struct sctp_tcb *stcb)
6937 {
6938 struct sctp_association *asoc;
6939 struct sctp_tmit_chunk *chk, *nchk;
6940 struct sctp_asconf_chunk *acp;
6941
6942 asoc = &stcb->asoc;
6943 TAILQ_FOREACH_SAFE(chk, &asoc->asconf_send_queue, sctp_next, nchk) {
6944 /* find SCTP_ASCONF chunk in queue */
6945 if (chk->rec.chunk_id.id == SCTP_ASCONF) {
6946 if (chk->data) {
6947 acp = mtod(chk->data, struct sctp_asconf_chunk *);
6948 if (SCTP_TSN_GT(ntohl(acp->serial_number), asoc->asconf_seq_out_acked)) {
6949 /* Not Acked yet */
6950 break;
6951 }
6952 }
6953 TAILQ_REMOVE(&asoc->asconf_send_queue, chk, sctp_next);
6954 asoc->ctrl_queue_cnt--;
6955 if (chk->data) {
6956 sctp_m_freem(chk->data);
6957 chk->data = NULL;
6958 }
6959 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
6960 }
6961 }
6962 }
6963
6964 static void
6965 sctp_clean_up_datalist(struct sctp_tcb *stcb,
6966 struct sctp_association *asoc,
6967 struct sctp_tmit_chunk **data_list,
6968 int bundle_at,
6969 struct sctp_nets *net)
6970 {
6971 int i;
6972 struct sctp_tmit_chunk *tp1;
6973
6974 for (i = 0; i < bundle_at; i++) {
6975 /* off of the send queue */
6976 TAILQ_REMOVE(&asoc->send_queue, data_list[i], sctp_next);
6977 asoc->send_queue_cnt--;
6978 if (i > 0) {
6979 /*
6980 * Any chunk NOT 0 you zap the time chunk 0 gets
6981 * zapped or set based on if a RTO measurement is
6982 * needed.
6983 */
6984 data_list[i]->do_rtt = 0;
6985 }
6986 /* record time */
6987 data_list[i]->sent_rcv_time = net->last_sent_time;
6988 data_list[i]->rec.data.cwnd_at_send = net->cwnd;
6989 data_list[i]->rec.data.fast_retran_tsn = data_list[i]->rec.data.tsn;
6990 if (data_list[i]->whoTo == NULL) {
6991 data_list[i]->whoTo = net;
6992 atomic_add_int(&net->ref_count, 1);
6993 }
6994 /* on to the sent queue */
6995 tp1 = TAILQ_LAST(&asoc->sent_queue, sctpchunk_listhead);
6996 if ((tp1) && SCTP_TSN_GT(tp1->rec.data.tsn, data_list[i]->rec.data.tsn)) {
6997 struct sctp_tmit_chunk *tpp;
6998
6999 /* need to move back */
7000 back_up_more:
7001 tpp = TAILQ_PREV(tp1, sctpchunk_listhead, sctp_next);
7002 if (tpp == NULL) {
7003 TAILQ_INSERT_BEFORE(tp1, data_list[i], sctp_next);
7004 goto all_done;
7005 }
7006 tp1 = tpp;
7007 if (SCTP_TSN_GT(tp1->rec.data.tsn, data_list[i]->rec.data.tsn)) {
7008 goto back_up_more;
7009 }
7010 TAILQ_INSERT_AFTER(&asoc->sent_queue, tp1, data_list[i], sctp_next);
7011 } else {
7012 TAILQ_INSERT_TAIL(&asoc->sent_queue,
7013 data_list[i],
7014 sctp_next);
7015 }
7016 all_done:
7017 /* This does not lower until the cum-ack passes it */
7018 asoc->sent_queue_cnt++;
7019 if ((asoc->peers_rwnd <= 0) &&
7020 (asoc->total_flight == 0) &&
7021 (bundle_at == 1)) {
7022 /* Mark the chunk as being a window probe */
7023 SCTP_STAT_INCR(sctps_windowprobed);
7024 }
7025 #ifdef SCTP_AUDITING_ENABLED
7026 sctp_audit_log(0xC2, 3);
7027 #endif
7028 data_list[i]->sent = SCTP_DATAGRAM_SENT;
7029 data_list[i]->snd_count = 1;
7030 data_list[i]->rec.data.chunk_was_revoked = 0;
7031 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
7032 sctp_misc_ints(SCTP_FLIGHT_LOG_UP,
7033 data_list[i]->whoTo->flight_size,
7034 data_list[i]->book_size,
7035 (uint32_t)(uintptr_t)data_list[i]->whoTo,
7036 data_list[i]->rec.data.tsn);
7037 }
7038 sctp_flight_size_increase(data_list[i]);
7039 sctp_total_flight_increase(stcb, data_list[i]);
7040 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_RWND_ENABLE) {
7041 sctp_log_rwnd(SCTP_DECREASE_PEER_RWND,
7042 asoc->peers_rwnd, data_list[i]->send_size, SCTP_BASE_SYSCTL(sctp_peer_chunk_oh));
7043 }
7044 asoc->peers_rwnd = sctp_sbspace_sub(asoc->peers_rwnd,
7045 (uint32_t)(data_list[i]->send_size + SCTP_BASE_SYSCTL(sctp_peer_chunk_oh)));
7046 if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
7047 /* SWS sender side engages */
7048 asoc->peers_rwnd = 0;
7049 }
7050 }
7051 if (asoc->cc_functions.sctp_cwnd_update_packet_transmitted) {
7052 (*asoc->cc_functions.sctp_cwnd_update_packet_transmitted) (stcb, net);
7053 }
7054 }
7055
7056 static void
7057 sctp_clean_up_ctl(struct sctp_tcb *stcb, struct sctp_association *asoc, int so_locked)
7058 {
7059 struct sctp_tmit_chunk *chk, *nchk;
7060
7061 TAILQ_FOREACH_SAFE(chk, &asoc->control_send_queue, sctp_next, nchk) {
7062 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
7063 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK) || /* EY */
7064 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_REQUEST) ||
7065 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_ACK) ||
7066 (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) ||
7067 (chk->rec.chunk_id.id == SCTP_SHUTDOWN) ||
7068 (chk->rec.chunk_id.id == SCTP_SHUTDOWN_ACK) ||
7069 (chk->rec.chunk_id.id == SCTP_OPERATION_ERROR) ||
7070 (chk->rec.chunk_id.id == SCTP_PACKET_DROPPED) ||
7071 (chk->rec.chunk_id.id == SCTP_COOKIE_ACK) ||
7072 (chk->rec.chunk_id.id == SCTP_ECN_CWR) ||
7073 (chk->rec.chunk_id.id == SCTP_ASCONF_ACK)) {
7074 /* Stray chunks must be cleaned up */
7075 clean_up_anyway:
7076 TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next);
7077 asoc->ctrl_queue_cnt--;
7078 if (chk->data) {
7079 sctp_m_freem(chk->data);
7080 chk->data = NULL;
7081 }
7082 if (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) {
7083 asoc->fwd_tsn_cnt--;
7084 }
7085 sctp_free_a_chunk(stcb, chk, so_locked);
7086 } else if (chk->rec.chunk_id.id == SCTP_STREAM_RESET) {
7087 /* special handling, we must look into the param */
7088 if (chk != asoc->str_reset) {
7089 goto clean_up_anyway;
7090 }
7091 }
7092 }
7093 }
7094
7095 static uint32_t
7096 sctp_can_we_split_this(struct sctp_tcb *stcb, uint32_t length,
7097 uint32_t space_left, uint32_t frag_point, int eeor_on)
7098 {
7099 /*
7100 * Make a decision on if I should split a msg into multiple parts.
7101 * This is only asked of incomplete messages.
7102 */
7103 if (eeor_on) {
7104 /*
7105 * If we are doing EEOR we need to always send it if its the
7106 * entire thing, since it might be all the guy is putting in
7107 * the hopper.
7108 */
7109 if (space_left >= length) {
7110 /*-
7111 * If we have data outstanding,
7112 * we get another chance when the sack
7113 * arrives to transmit - wait for more data
7114 */
7115 if (stcb->asoc.total_flight == 0) {
7116 /*
7117 * If nothing is in flight, we zero the
7118 * packet counter.
7119 */
7120 return (length);
7121 }
7122 return (0);
7123
7124 } else {
7125 /* You can fill the rest */
7126 return (space_left);
7127 }
7128 }
7129 /*-
7130 * For those strange folk that make the send buffer
7131 * smaller than our fragmentation point, we can't
7132 * get a full msg in so we have to allow splitting.
7133 */
7134 if (SCTP_SB_LIMIT_SND(stcb->sctp_socket) < frag_point) {
7135 return (length);
7136 }
7137 if ((length <= space_left) ||
7138 ((length - space_left) < SCTP_BASE_SYSCTL(sctp_min_residual))) {
7139 /* Sub-optimal residual don't split in non-eeor mode. */
7140 return (0);
7141 }
7142 /*
7143 * If we reach here length is larger than the space_left. Do we wish
7144 * to split it for the sake of packet putting together?
7145 */
7146 if (space_left >= min(SCTP_BASE_SYSCTL(sctp_min_split_point), frag_point)) {
7147 /* Its ok to split it */
7148 return (min(space_left, frag_point));
7149 }
7150 /* Nope, can't split */
7151 return (0);
7152 }
7153
7154 static uint32_t
7155 sctp_move_to_outqueue(struct sctp_tcb *stcb,
7156 struct sctp_nets *net,
7157 struct sctp_stream_out *strq,
7158 uint32_t space_left,
7159 uint32_t frag_point,
7160 int *giveup,
7161 int eeor_mode,
7162 int *bail,
7163 int so_locked)
7164 {
7165 /* Move from the stream to the send_queue keeping track of the total */
7166 struct sctp_association *asoc;
7167 struct sctp_stream_queue_pending *sp;
7168 struct sctp_tmit_chunk *chk;
7169 struct sctp_data_chunk *dchkh = NULL;
7170 struct sctp_idata_chunk *ndchkh = NULL;
7171 uint32_t to_move, length;
7172 int leading;
7173 uint8_t rcv_flags = 0;
7174 uint8_t some_taken;
7175
7176 SCTP_TCB_LOCK_ASSERT(stcb);
7177 asoc = &stcb->asoc;
7178 one_more_time:
7179 /* sa_ignore FREED_MEMORY */
7180 sp = TAILQ_FIRST(&strq->outqueue);
7181 if (sp == NULL) {
7182 sp = TAILQ_FIRST(&strq->outqueue);
7183 if (sp) {
7184 goto one_more_time;
7185 }
7186 if ((sctp_is_feature_on(stcb->sctp_ep, SCTP_PCB_FLAGS_EXPLICIT_EOR) == 0) &&
7187 (stcb->asoc.idata_supported == 0) &&
7188 (strq->last_msg_incomplete)) {
7189 SCTP_PRINTF("Huh? Stream:%d lm_in_c=%d but queue is NULL\n",
7190 strq->sid,
7191 strq->last_msg_incomplete);
7192 strq->last_msg_incomplete = 0;
7193 }
7194 to_move = 0;
7195 goto out_of;
7196 }
7197 if ((sp->msg_is_complete) && (sp->length == 0)) {
7198 if (sp->sender_all_done) {
7199 /*
7200 * We are doing deferred cleanup. Last time through
7201 * when we took all the data the sender_all_done was
7202 * not set.
7203 */
7204 if ((sp->put_last_out == 0) && (sp->discard_rest == 0)) {
7205 SCTP_PRINTF("Gak, put out entire msg with NO end!-1\n");
7206 SCTP_PRINTF("sender_done:%d len:%d msg_comp:%d put_last_out:%d\n",
7207 sp->sender_all_done,
7208 sp->length,
7209 sp->msg_is_complete,
7210 sp->put_last_out);
7211 }
7212 atomic_subtract_int(&asoc->stream_queue_cnt, 1);
7213 TAILQ_REMOVE(&strq->outqueue, sp, next);
7214 stcb->asoc.ss_functions.sctp_ss_remove_from_stream(stcb, asoc, strq, sp);
7215 if ((strq->state == SCTP_STREAM_RESET_PENDING) &&
7216 (strq->chunks_on_queues == 0) &&
7217 TAILQ_EMPTY(&strq->outqueue)) {
7218 stcb->asoc.trigger_reset = 1;
7219 }
7220 if (sp->net) {
7221 sctp_free_remote_addr(sp->net);
7222 sp->net = NULL;
7223 }
7224 if (sp->data) {
7225 sctp_m_freem(sp->data);
7226 sp->data = NULL;
7227 }
7228 sctp_free_a_strmoq(stcb, sp, so_locked);
7229 /* back to get the next msg */
7230 goto one_more_time;
7231 } else {
7232 /*
7233 * sender just finished this but still holds a
7234 * reference
7235 */
7236 *giveup = 1;
7237 to_move = 0;
7238 goto out_of;
7239 }
7240 } else {
7241 /* is there some to get */
7242 if (sp->length == 0) {
7243 /* no */
7244 *giveup = 1;
7245 to_move = 0;
7246 goto out_of;
7247 } else if (sp->discard_rest) {
7248 /* Whack down the size */
7249 atomic_subtract_int(&stcb->asoc.total_output_queue_size, sp->length);
7250 if ((stcb->sctp_socket != NULL) &&
7251 ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) ||
7252 (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL))) {
7253 atomic_subtract_int(&stcb->sctp_socket->so_snd.sb_cc, sp->length);
7254 }
7255 if (sp->data) {
7256 sctp_m_freem(sp->data);
7257 sp->data = NULL;
7258 sp->tail_mbuf = NULL;
7259 }
7260 sp->length = 0;
7261 sp->some_taken = 1;
7262 *giveup = 1;
7263 to_move = 0;
7264 goto out_of;
7265 }
7266 }
7267 some_taken = sp->some_taken;
7268 length = sp->length;
7269 if (sp->msg_is_complete) {
7270 /* The message is complete */
7271 to_move = min(length, frag_point);
7272 if (to_move == length) {
7273 /* All of it fits in the MTU */
7274 if (sp->some_taken) {
7275 rcv_flags |= SCTP_DATA_LAST_FRAG;
7276 } else {
7277 rcv_flags |= SCTP_DATA_NOT_FRAG;
7278 }
7279 sp->put_last_out = 1;
7280 if (sp->sinfo_flags & SCTP_SACK_IMMEDIATELY) {
7281 rcv_flags |= SCTP_DATA_SACK_IMMEDIATELY;
7282 }
7283 } else {
7284 /* Not all of it fits, we fragment */
7285 if (sp->some_taken == 0) {
7286 rcv_flags |= SCTP_DATA_FIRST_FRAG;
7287 }
7288 sp->some_taken = 1;
7289 }
7290 } else {
7291 to_move = sctp_can_we_split_this(stcb, length, space_left, frag_point, eeor_mode);
7292 if (to_move > 0) {
7293 if (to_move >= length) {
7294 to_move = length;
7295 }
7296 if (sp->some_taken == 0) {
7297 rcv_flags |= SCTP_DATA_FIRST_FRAG;
7298 sp->some_taken = 1;
7299 }
7300 } else {
7301 /* Nothing to take. */
7302 *giveup = 1;
7303 to_move = 0;
7304 goto out_of;
7305 }
7306 }
7307
7308 /* If we reach here, we can copy out a chunk */
7309 sctp_alloc_a_chunk(stcb, chk);
7310 if (chk == NULL) {
7311 /* No chunk memory */
7312 *giveup = 1;
7313 to_move = 0;
7314 goto out_of;
7315 }
7316 /*
7317 * Setup for unordered if needed by looking at the user sent info
7318 * flags.
7319 */
7320 if (sp->sinfo_flags & SCTP_UNORDERED) {
7321 rcv_flags |= SCTP_DATA_UNORDERED;
7322 }
7323 if (SCTP_BASE_SYSCTL(sctp_enable_sack_immediately) &&
7324 (sp->sinfo_flags & SCTP_EOF) == SCTP_EOF) {
7325 rcv_flags |= SCTP_DATA_SACK_IMMEDIATELY;
7326 }
7327 /* clear out the chunk before setting up */
7328 memset(chk, 0, sizeof(*chk));
7329 chk->rec.data.rcv_flags = rcv_flags;
7330
7331 if (to_move >= length) {
7332 /* we think we can steal the whole thing */
7333 if (to_move < sp->length) {
7334 /* bail, it changed */
7335 goto dont_do_it;
7336 }
7337 chk->data = sp->data;
7338 chk->last_mbuf = sp->tail_mbuf;
7339 /* register the stealing */
7340 sp->data = sp->tail_mbuf = NULL;
7341 } else {
7342 struct mbuf *m;
7343
7344 dont_do_it:
7345 chk->data = SCTP_M_COPYM(sp->data, 0, to_move, M_NOWAIT);
7346 chk->last_mbuf = NULL;
7347 if (chk->data == NULL) {
7348 sp->some_taken = some_taken;
7349 sctp_free_a_chunk(stcb, chk, so_locked);
7350 *bail = 1;
7351 to_move = 0;
7352 goto out_of;
7353 }
7354 #ifdef SCTP_MBUF_LOGGING
7355 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
7356 sctp_log_mbc(chk->data, SCTP_MBUF_ICOPY);
7357 }
7358 #endif
7359 /* Pull off the data */
7360 m_adj(sp->data, to_move);
7361 /* Now lets work our way down and compact it */
7362 m = sp->data;
7363 while (m && (SCTP_BUF_LEN(m) == 0)) {
7364 sp->data = SCTP_BUF_NEXT(m);
7365 SCTP_BUF_NEXT(m) = NULL;
7366 if (sp->tail_mbuf == m) {
7367 /*-
7368 * Freeing tail? TSNH since
7369 * we supposedly were taking less
7370 * than the sp->length.
7371 */
7372 #ifdef INVARIANTS
7373 panic("Huh, freeing tail? - TSNH");
7374 #else
7375 SCTP_PRINTF("Huh, freeing tail? - TSNH\n");
7376 sp->tail_mbuf = sp->data = NULL;
7377 sp->length = 0;
7378 #endif
7379 }
7380 sctp_m_free(m);
7381 m = sp->data;
7382 }
7383 }
7384 if (SCTP_BUF_IS_EXTENDED(chk->data)) {
7385 chk->copy_by_ref = 1;
7386 } else {
7387 chk->copy_by_ref = 0;
7388 }
7389 /*
7390 * get last_mbuf and counts of mb usage This is ugly but hopefully
7391 * its only one mbuf.
7392 */
7393 if (chk->last_mbuf == NULL) {
7394 chk->last_mbuf = chk->data;
7395 while (SCTP_BUF_NEXT(chk->last_mbuf) != NULL) {
7396 chk->last_mbuf = SCTP_BUF_NEXT(chk->last_mbuf);
7397 }
7398 }
7399
7400 if (to_move > length) {
7401 /*- This should not happen either
7402 * since we always lower to_move to the size
7403 * of sp->length if its larger.
7404 */
7405 #ifdef INVARIANTS
7406 panic("Huh, how can to_move be larger?");
7407 #else
7408 SCTP_PRINTF("Huh, how can to_move be larger?\n");
7409 sp->length = 0;
7410 #endif
7411 } else {
7412 atomic_subtract_int(&sp->length, to_move);
7413 }
7414 leading = SCTP_DATA_CHUNK_OVERHEAD(stcb);
7415 if (M_LEADINGSPACE(chk->data) < leading) {
7416 /* Not enough room for a chunk header, get some */
7417 struct mbuf *m;
7418
7419 m = sctp_get_mbuf_for_msg(1, 0, M_NOWAIT, 1, MT_DATA);
7420 if (m == NULL) {
7421 /*
7422 * we're in trouble here. _PREPEND below will free
7423 * all the data if there is no leading space, so we
7424 * must put the data back and restore.
7425 */
7426 if (sp->data == NULL) {
7427 /* unsteal the data */
7428 sp->data = chk->data;
7429 sp->tail_mbuf = chk->last_mbuf;
7430 } else {
7431 struct mbuf *m_tmp;
7432
7433 /* reassemble the data */
7434 m_tmp = sp->data;
7435 sp->data = chk->data;
7436 SCTP_BUF_NEXT(chk->last_mbuf) = m_tmp;
7437 }
7438 sp->some_taken = some_taken;
7439 atomic_add_int(&sp->length, to_move);
7440 chk->data = NULL;
7441 *bail = 1;
7442 sctp_free_a_chunk(stcb, chk, so_locked);
7443 to_move = 0;
7444 goto out_of;
7445 } else {
7446 SCTP_BUF_LEN(m) = 0;
7447 SCTP_BUF_NEXT(m) = chk->data;
7448 chk->data = m;
7449 M_ALIGN(chk->data, 4);
7450 }
7451 }
7452 SCTP_BUF_PREPEND(chk->data, SCTP_DATA_CHUNK_OVERHEAD(stcb), M_NOWAIT);
7453 if (chk->data == NULL) {
7454 /* HELP, TSNH since we assured it would not above? */
7455 #ifdef INVARIANTS
7456 panic("prepend fails HELP?");
7457 #else
7458 SCTP_PRINTF("prepend fails HELP?\n");
7459 sctp_free_a_chunk(stcb, chk, so_locked);
7460 #endif
7461 *bail = 1;
7462 to_move = 0;
7463 goto out_of;
7464 }
7465 sctp_snd_sb_alloc(stcb, SCTP_DATA_CHUNK_OVERHEAD(stcb));
7466 chk->book_size = chk->send_size = (uint16_t)(to_move + SCTP_DATA_CHUNK_OVERHEAD(stcb));
7467 chk->book_size_scale = 0;
7468 chk->sent = SCTP_DATAGRAM_UNSENT;
7469
7470 chk->flags = 0;
7471 chk->asoc = &stcb->asoc;
7472 chk->pad_inplace = 0;
7473 chk->no_fr_allowed = 0;
7474 if (stcb->asoc.idata_supported == 0) {
7475 if (rcv_flags & SCTP_DATA_UNORDERED) {
7476 /* Just use 0. The receiver ignores the values. */
7477 chk->rec.data.mid = 0;
7478 } else {
7479 chk->rec.data.mid = strq->next_mid_ordered;
7480 if (rcv_flags & SCTP_DATA_LAST_FRAG) {
7481 strq->next_mid_ordered++;
7482 }
7483 }
7484 } else {
7485 if (rcv_flags & SCTP_DATA_UNORDERED) {
7486 chk->rec.data.mid = strq->next_mid_unordered;
7487 if (rcv_flags & SCTP_DATA_LAST_FRAG) {
7488 strq->next_mid_unordered++;
7489 }
7490 } else {
7491 chk->rec.data.mid = strq->next_mid_ordered;
7492 if (rcv_flags & SCTP_DATA_LAST_FRAG) {
7493 strq->next_mid_ordered++;
7494 }
7495 }
7496 }
7497 chk->rec.data.sid = sp->sid;
7498 chk->rec.data.ppid = sp->ppid;
7499 chk->rec.data.context = sp->context;
7500 chk->rec.data.doing_fast_retransmit = 0;
7501
7502 chk->rec.data.timetodrop = sp->ts;
7503 chk->flags = sp->act_flags;
7504
7505 if (sp->net) {
7506 chk->whoTo = sp->net;
7507 atomic_add_int(&chk->whoTo->ref_count, 1);
7508 } else
7509 chk->whoTo = NULL;
7510
7511 if (sp->holds_key_ref) {
7512 chk->auth_keyid = sp->auth_keyid;
7513 sctp_auth_key_acquire(stcb, chk->auth_keyid);
7514 chk->holds_key_ref = 1;
7515 }
7516 stcb->asoc.ss_functions.sctp_ss_scheduled(stcb, net, asoc, strq, to_move);
7517 chk->rec.data.tsn = atomic_fetchadd_int(&asoc->sending_seq, 1);
7518 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_AT_SEND_2_OUTQ) {
7519 sctp_misc_ints(SCTP_STRMOUT_LOG_SEND,
7520 (uint32_t)(uintptr_t)stcb, sp->length,
7521 (uint32_t)((chk->rec.data.sid << 16) | (0x0000ffff & chk->rec.data.mid)),
7522 chk->rec.data.tsn);
7523 }
7524 if (stcb->asoc.idata_supported == 0) {
7525 dchkh = mtod(chk->data, struct sctp_data_chunk *);
7526 } else {
7527 ndchkh = mtod(chk->data, struct sctp_idata_chunk *);
7528 }
7529 /*
7530 * Put the rest of the things in place now. Size was done earlier in
7531 * previous loop prior to padding.
7532 */
7533
7534 SCTP_TCB_LOCK_ASSERT(stcb);
7535 #ifdef SCTP_ASOCLOG_OF_TSNS
7536 if (asoc->tsn_out_at >= SCTP_TSN_LOG_SIZE) {
7537 asoc->tsn_out_at = 0;
7538 asoc->tsn_out_wrapped = 1;
7539 }
7540 asoc->out_tsnlog[asoc->tsn_out_at].tsn = chk->rec.data.tsn;
7541 asoc->out_tsnlog[asoc->tsn_out_at].strm = chk->rec.data.sid;
7542 asoc->out_tsnlog[asoc->tsn_out_at].seq = chk->rec.data.mid;
7543 asoc->out_tsnlog[asoc->tsn_out_at].sz = chk->send_size;
7544 asoc->out_tsnlog[asoc->tsn_out_at].flgs = chk->rec.data.rcv_flags;
7545 asoc->out_tsnlog[asoc->tsn_out_at].stcb = (void *)stcb;
7546 asoc->out_tsnlog[asoc->tsn_out_at].in_pos = asoc->tsn_out_at;
7547 asoc->out_tsnlog[asoc->tsn_out_at].in_out = 2;
7548 asoc->tsn_out_at++;
7549 #endif
7550 if (stcb->asoc.idata_supported == 0) {
7551 dchkh->ch.chunk_type = SCTP_DATA;
7552 dchkh->ch.chunk_flags = chk->rec.data.rcv_flags;
7553 dchkh->dp.tsn = htonl(chk->rec.data.tsn);
7554 dchkh->dp.sid = htons(strq->sid);
7555 dchkh->dp.ssn = htons((uint16_t)chk->rec.data.mid);
7556 dchkh->dp.ppid = chk->rec.data.ppid;
7557 dchkh->ch.chunk_length = htons(chk->send_size);
7558 } else {
7559 ndchkh->ch.chunk_type = SCTP_IDATA;
7560 ndchkh->ch.chunk_flags = chk->rec.data.rcv_flags;
7561 ndchkh->dp.tsn = htonl(chk->rec.data.tsn);
7562 ndchkh->dp.sid = htons(strq->sid);
7563 ndchkh->dp.reserved = htons(0);
7564 ndchkh->dp.mid = htonl(chk->rec.data.mid);
7565 if (sp->fsn == 0)
7566 ndchkh->dp.ppid_fsn.ppid = chk->rec.data.ppid;
7567 else
7568 ndchkh->dp.ppid_fsn.fsn = htonl(sp->fsn);
7569 sp->fsn++;
7570 ndchkh->ch.chunk_length = htons(chk->send_size);
7571 }
7572 /* Now advance the chk->send_size by the actual pad needed. */
7573 if (chk->send_size < SCTP_SIZE32(chk->book_size)) {
7574 /* need a pad */
7575 struct mbuf *lm;
7576 int pads;
7577
7578 pads = SCTP_SIZE32(chk->book_size) - chk->send_size;
7579 lm = sctp_pad_lastmbuf(chk->data, pads, chk->last_mbuf);
7580 if (lm != NULL) {
7581 chk->last_mbuf = lm;
7582 chk->pad_inplace = 1;
7583 }
7584 chk->send_size += pads;
7585 }
7586 if (PR_SCTP_ENABLED(chk->flags)) {
7587 asoc->pr_sctp_cnt++;
7588 }
7589 if (sp->msg_is_complete && (sp->length == 0) && (sp->sender_all_done)) {
7590 /* All done pull and kill the message */
7591 if (sp->put_last_out == 0) {
7592 SCTP_PRINTF("Gak, put out entire msg with NO end!-2\n");
7593 SCTP_PRINTF("sender_done:%d len:%d msg_comp:%d put_last_out:%d\n",
7594 sp->sender_all_done,
7595 sp->length,
7596 sp->msg_is_complete,
7597 sp->put_last_out);
7598 }
7599 atomic_subtract_int(&asoc->stream_queue_cnt, 1);
7600 TAILQ_REMOVE(&strq->outqueue, sp, next);
7601 stcb->asoc.ss_functions.sctp_ss_remove_from_stream(stcb, asoc, strq, sp);
7602 if ((strq->state == SCTP_STREAM_RESET_PENDING) &&
7603 (strq->chunks_on_queues == 0) &&
7604 TAILQ_EMPTY(&strq->outqueue)) {
7605 stcb->asoc.trigger_reset = 1;
7606 }
7607 if (sp->net) {
7608 sctp_free_remote_addr(sp->net);
7609 sp->net = NULL;
7610 }
7611 if (sp->data) {
7612 sctp_m_freem(sp->data);
7613 sp->data = NULL;
7614 }
7615 sctp_free_a_strmoq(stcb, sp, so_locked);
7616 }
7617 asoc->chunks_on_out_queue++;
7618 strq->chunks_on_queues++;
7619 TAILQ_INSERT_TAIL(&asoc->send_queue, chk, sctp_next);
7620 asoc->send_queue_cnt++;
7621 out_of:
7622 return (to_move);
7623 }
7624
7625 static void
7626 sctp_fill_outqueue(struct sctp_tcb *stcb, struct sctp_nets *net,
7627 uint32_t frag_point, int eeor_mode, int *quit_now,
7628 int so_locked)
7629 {
7630 struct sctp_association *asoc;
7631 struct sctp_stream_out *strq;
7632 uint32_t space_left, moved, total_moved;
7633 int bail, giveup;
7634
7635 SCTP_TCB_LOCK_ASSERT(stcb);
7636 asoc = &stcb->asoc;
7637 total_moved = 0;
7638 switch (net->ro._l_addr.sa.sa_family) {
7639 #ifdef INET
7640 case AF_INET:
7641 space_left = net->mtu - SCTP_MIN_V4_OVERHEAD;
7642 break;
7643 #endif
7644 #ifdef INET6
7645 case AF_INET6:
7646 space_left = net->mtu - SCTP_MIN_OVERHEAD;
7647 break;
7648 #endif
7649 default:
7650 /* TSNH */
7651 space_left = net->mtu;
7652 break;
7653 }
7654 /* Need an allowance for the data chunk header too */
7655 space_left -= SCTP_DATA_CHUNK_OVERHEAD(stcb);
7656
7657 /* must make even word boundary */
7658 space_left &= 0xfffffffc;
7659 strq = stcb->asoc.ss_functions.sctp_ss_select_stream(stcb, net, asoc);
7660 giveup = 0;
7661 bail = 0;
7662 while ((space_left > 0) && (strq != NULL)) {
7663 moved = sctp_move_to_outqueue(stcb, net, strq, space_left,
7664 frag_point, &giveup, eeor_mode,
7665 &bail, so_locked);
7666 if ((giveup != 0) || (bail != 0)) {
7667 break;
7668 }
7669 strq = stcb->asoc.ss_functions.sctp_ss_select_stream(stcb, net, asoc);
7670 total_moved += moved;
7671 if (space_left >= moved) {
7672 space_left -= moved;
7673 } else {
7674 space_left = 0;
7675 }
7676 if (space_left >= SCTP_DATA_CHUNK_OVERHEAD(stcb)) {
7677 space_left -= SCTP_DATA_CHUNK_OVERHEAD(stcb);
7678 } else {
7679 space_left = 0;
7680 }
7681 space_left &= 0xfffffffc;
7682 }
7683 if (bail != 0)
7684 *quit_now = 1;
7685
7686 stcb->asoc.ss_functions.sctp_ss_packet_done(stcb, net, asoc);
7687
7688 if (total_moved == 0) {
7689 if ((stcb->asoc.sctp_cmt_on_off == 0) &&
7690 (net == stcb->asoc.primary_destination)) {
7691 /* ran dry for primary network net */
7692 SCTP_STAT_INCR(sctps_primary_randry);
7693 } else if (stcb->asoc.sctp_cmt_on_off > 0) {
7694 /* ran dry with CMT on */
7695 SCTP_STAT_INCR(sctps_cmt_randry);
7696 }
7697 }
7698 }
7699
7700 void
7701 sctp_fix_ecn_echo(struct sctp_association *asoc)
7702 {
7703 struct sctp_tmit_chunk *chk;
7704
7705 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
7706 if (chk->rec.chunk_id.id == SCTP_ECN_ECHO) {
7707 chk->sent = SCTP_DATAGRAM_UNSENT;
7708 }
7709 }
7710 }
7711
7712 void
7713 sctp_move_chunks_from_net(struct sctp_tcb *stcb, struct sctp_nets *net)
7714 {
7715 struct sctp_association *asoc;
7716 struct sctp_tmit_chunk *chk;
7717 struct sctp_stream_queue_pending *sp;
7718 unsigned int i;
7719
7720 if (net == NULL) {
7721 return;
7722 }
7723 asoc = &stcb->asoc;
7724 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
7725 TAILQ_FOREACH(sp, &stcb->asoc.strmout[i].outqueue, next) {
7726 if (sp->net == net) {
7727 sctp_free_remote_addr(sp->net);
7728 sp->net = NULL;
7729 }
7730 }
7731 }
7732 TAILQ_FOREACH(chk, &asoc->send_queue, sctp_next) {
7733 if (chk->whoTo == net) {
7734 sctp_free_remote_addr(chk->whoTo);
7735 chk->whoTo = NULL;
7736 }
7737 }
7738 }
7739
7740 int
7741 sctp_med_chunk_output(struct sctp_inpcb *inp,
7742 struct sctp_tcb *stcb,
7743 struct sctp_association *asoc,
7744 int *num_out,
7745 int *reason_code,
7746 int control_only, int from_where,
7747 struct timeval *now, int *now_filled,
7748 uint32_t frag_point, int so_locked)
7749 {
7750 /**
7751 * Ok this is the generic chunk service queue. we must do the
7752 * following:
7753 * - Service the stream queue that is next, moving any
7754 * message (note I must get a complete message i.e. FIRST/MIDDLE and
7755 * LAST to the out queue in one pass) and assigning TSN's. This
7756 * only applies though if the peer does not support NDATA. For NDATA
7757 * chunks its ok to not send the entire message ;-)
7758 * - Check to see if the cwnd/rwnd allows any output, if so we go ahead and
7759 * formulate and send the low level chunks. Making sure to combine
7760 * any control in the control chunk queue also.
7761 */
7762 struct sctp_nets *net, *start_at, *sack_goes_to = NULL, *old_start_at = NULL;
7763 struct mbuf *outchain, *endoutchain;
7764 struct sctp_tmit_chunk *chk, *nchk;
7765
7766 /* temp arrays for unlinking */
7767 struct sctp_tmit_chunk *data_list[SCTP_MAX_DATA_BUNDLING];
7768 int no_fragmentflg, error;
7769 unsigned int max_rwnd_per_dest, max_send_per_dest;
7770 int one_chunk, hbflag, skip_data_for_this_net;
7771 int asconf, cookie, no_out_cnt;
7772 int bundle_at, ctl_cnt, no_data_chunks, eeor_mode;
7773 unsigned int mtu, r_mtu, omtu, mx_mtu, to_out;
7774 int tsns_sent = 0;
7775 uint32_t auth_offset;
7776 struct sctp_auth_chunk *auth;
7777 uint16_t auth_keyid;
7778 int override_ok = 1;
7779 int skip_fill_up = 0;
7780 int data_auth_reqd = 0;
7781
7782 /*
7783 * JRS 5/14/07 - Add flag for whether a heartbeat is sent to the
7784 * destination.
7785 */
7786 int quit_now = 0;
7787
7788 *num_out = 0;
7789 *reason_code = 0;
7790 auth_keyid = stcb->asoc.authinfo.active_keyid;
7791 if ((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) ||
7792 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
7793 (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXPLICIT_EOR))) {
7794 eeor_mode = 1;
7795 } else {
7796 eeor_mode = 0;
7797 }
7798 ctl_cnt = no_out_cnt = asconf = cookie = 0;
7799 /*
7800 * First lets prime the pump. For each destination, if there is room
7801 * in the flight size, attempt to pull an MTU's worth out of the
7802 * stream queues into the general send_queue
7803 */
7804 #ifdef SCTP_AUDITING_ENABLED
7805 sctp_audit_log(0xC2, 2);
7806 #endif
7807 SCTP_TCB_LOCK_ASSERT(stcb);
7808 hbflag = 0;
7809 if (control_only)
7810 no_data_chunks = 1;
7811 else
7812 no_data_chunks = 0;
7813
7814 /* Nothing to possible to send? */
7815 if ((TAILQ_EMPTY(&asoc->control_send_queue) ||
7816 (asoc->ctrl_queue_cnt == stcb->asoc.ecn_echo_cnt_onq)) &&
7817 TAILQ_EMPTY(&asoc->asconf_send_queue) &&
7818 TAILQ_EMPTY(&asoc->send_queue) &&
7819 sctp_is_there_unsent_data(stcb, so_locked) == 0) {
7820 nothing_to_send:
7821 *reason_code = 9;
7822 return (0);
7823 }
7824 if (asoc->peers_rwnd == 0) {
7825 /* No room in peers rwnd */
7826 *reason_code = 1;
7827 if (asoc->total_flight > 0) {
7828 /* we are allowed one chunk in flight */
7829 no_data_chunks = 1;
7830 }
7831 }
7832 if (stcb->asoc.ecn_echo_cnt_onq) {
7833 /* Record where a sack goes, if any */
7834 if (no_data_chunks &&
7835 (asoc->ctrl_queue_cnt == stcb->asoc.ecn_echo_cnt_onq)) {
7836 /* Nothing but ECNe to send - we don't do that */
7837 goto nothing_to_send;
7838 }
7839 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
7840 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
7841 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK)) {
7842 sack_goes_to = chk->whoTo;
7843 break;
7844 }
7845 }
7846 }
7847 max_rwnd_per_dest = ((asoc->peers_rwnd + asoc->total_flight) / asoc->numnets);
7848 if (stcb->sctp_socket)
7849 max_send_per_dest = SCTP_SB_LIMIT_SND(stcb->sctp_socket) / asoc->numnets;
7850 else
7851 max_send_per_dest = 0;
7852 if (no_data_chunks == 0) {
7853 /* How many non-directed chunks are there? */
7854 TAILQ_FOREACH(chk, &asoc->send_queue, sctp_next) {
7855 if (chk->whoTo == NULL) {
7856 /*
7857 * We already have non-directed chunks on
7858 * the queue, no need to do a fill-up.
7859 */
7860 skip_fill_up = 1;
7861 break;
7862 }
7863 }
7864 }
7865 if ((no_data_chunks == 0) &&
7866 (skip_fill_up == 0) &&
7867 (!stcb->asoc.ss_functions.sctp_ss_is_empty(stcb, asoc))) {
7868 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
7869 /*
7870 * This for loop we are in takes in each net, if
7871 * its's got space in cwnd and has data sent to it
7872 * (when CMT is off) then it calls
7873 * sctp_fill_outqueue for the net. This gets data on
7874 * the send queue for that network.
7875 *
7876 * In sctp_fill_outqueue TSN's are assigned and data
7877 * is copied out of the stream buffers. Note mostly
7878 * copy by reference (we hope).
7879 */
7880 net->window_probe = 0;
7881 if ((net != stcb->asoc.alternate) &&
7882 ((net->dest_state & SCTP_ADDR_PF) ||
7883 ((net->dest_state & SCTP_ADDR_REACHABLE) == 0) ||
7884 (net->dest_state & SCTP_ADDR_UNCONFIRMED))) {
7885 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
7886 sctp_log_cwnd(stcb, net, 1,
7887 SCTP_CWND_LOG_FILL_OUTQ_CALLED);
7888 }
7889 continue;
7890 }
7891 if ((stcb->asoc.cc_functions.sctp_cwnd_new_transmission_begins) &&
7892 (net->flight_size == 0)) {
7893 (*stcb->asoc.cc_functions.sctp_cwnd_new_transmission_begins) (stcb, net);
7894 }
7895 if (net->flight_size >= net->cwnd) {
7896 /* skip this network, no room - can't fill */
7897 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
7898 sctp_log_cwnd(stcb, net, 3,
7899 SCTP_CWND_LOG_FILL_OUTQ_CALLED);
7900 }
7901 continue;
7902 }
7903 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
7904 sctp_log_cwnd(stcb, net, 4, SCTP_CWND_LOG_FILL_OUTQ_CALLED);
7905 }
7906 sctp_fill_outqueue(stcb, net, frag_point, eeor_mode, &quit_now, so_locked);
7907 if (quit_now) {
7908 /* memory alloc failure */
7909 no_data_chunks = 1;
7910 break;
7911 }
7912 }
7913 }
7914 /* now service each destination and send out what we can for it */
7915 /* Nothing to send? */
7916 if (TAILQ_EMPTY(&asoc->control_send_queue) &&
7917 TAILQ_EMPTY(&asoc->asconf_send_queue) &&
7918 TAILQ_EMPTY(&asoc->send_queue)) {
7919 *reason_code = 8;
7920 return (0);
7921 }
7922
7923 if (asoc->sctp_cmt_on_off > 0) {
7924 /* get the last start point */
7925 start_at = asoc->last_net_cmt_send_started;
7926 if (start_at == NULL) {
7927 /* null so to beginning */
7928 start_at = TAILQ_FIRST(&asoc->nets);
7929 } else {
7930 start_at = TAILQ_NEXT(asoc->last_net_cmt_send_started, sctp_next);
7931 if (start_at == NULL) {
7932 start_at = TAILQ_FIRST(&asoc->nets);
7933 }
7934 }
7935 asoc->last_net_cmt_send_started = start_at;
7936 } else {
7937 start_at = TAILQ_FIRST(&asoc->nets);
7938 }
7939 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
7940 if (chk->whoTo == NULL) {
7941 if (asoc->alternate) {
7942 chk->whoTo = asoc->alternate;
7943 } else {
7944 chk->whoTo = asoc->primary_destination;
7945 }
7946 atomic_add_int(&chk->whoTo->ref_count, 1);
7947 }
7948 }
7949 old_start_at = NULL;
7950 again_one_more_time:
7951 for (net = start_at; net != NULL; net = TAILQ_NEXT(net, sctp_next)) {
7952 /* how much can we send? */
7953 /* SCTPDBG("Examine for sending net:%x\n", (uint32_t)net); */
7954 if (old_start_at && (old_start_at == net)) {
7955 /* through list completely. */
7956 break;
7957 }
7958 tsns_sent = 0xa;
7959 if (TAILQ_EMPTY(&asoc->control_send_queue) &&
7960 TAILQ_EMPTY(&asoc->asconf_send_queue) &&
7961 (net->flight_size >= net->cwnd)) {
7962 /*
7963 * Nothing on control or asconf and flight is full,
7964 * we can skip even in the CMT case.
7965 */
7966 continue;
7967 }
7968 bundle_at = 0;
7969 endoutchain = outchain = NULL;
7970 auth = NULL;
7971 auth_offset = 0;
7972 no_fragmentflg = 1;
7973 one_chunk = 0;
7974 if (net->dest_state & SCTP_ADDR_UNCONFIRMED) {
7975 skip_data_for_this_net = 1;
7976 } else {
7977 skip_data_for_this_net = 0;
7978 }
7979 switch (((struct sockaddr *)&net->ro._l_addr)->sa_family) {
7980 #ifdef INET
7981 case AF_INET:
7982 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
7983 break;
7984 #endif
7985 #ifdef INET6
7986 case AF_INET6:
7987 mtu = net->mtu - SCTP_MIN_OVERHEAD;
7988 break;
7989 #endif
7990 default:
7991 /* TSNH */
7992 mtu = net->mtu;
7993 break;
7994 }
7995 mx_mtu = mtu;
7996 to_out = 0;
7997 if (mtu > asoc->peers_rwnd) {
7998 if (asoc->total_flight > 0) {
7999 /* We have a packet in flight somewhere */
8000 r_mtu = asoc->peers_rwnd;
8001 } else {
8002 /* We are always allowed to send one MTU out */
8003 one_chunk = 1;
8004 r_mtu = mtu;
8005 }
8006 } else {
8007 r_mtu = mtu;
8008 }
8009 error = 0;
8010 /************************/
8011 /* ASCONF transmission */
8012 /************************/
8013 /* Now first lets go through the asconf queue */
8014 TAILQ_FOREACH_SAFE(chk, &asoc->asconf_send_queue, sctp_next, nchk) {
8015 if (chk->rec.chunk_id.id != SCTP_ASCONF) {
8016 continue;
8017 }
8018 if (chk->whoTo == NULL) {
8019 if (asoc->alternate == NULL) {
8020 if (asoc->primary_destination != net) {
8021 break;
8022 }
8023 } else {
8024 if (asoc->alternate != net) {
8025 break;
8026 }
8027 }
8028 } else {
8029 if (chk->whoTo != net) {
8030 break;
8031 }
8032 }
8033 if (chk->data == NULL) {
8034 break;
8035 }
8036 if (chk->sent != SCTP_DATAGRAM_UNSENT &&
8037 chk->sent != SCTP_DATAGRAM_RESEND) {
8038 break;
8039 }
8040 /*
8041 * if no AUTH is yet included and this chunk
8042 * requires it, make sure to account for it. We
8043 * don't apply the size until the AUTH chunk is
8044 * actually added below in case there is no room for
8045 * this chunk. NOTE: we overload the use of "omtu"
8046 * here
8047 */
8048 if ((auth == NULL) &&
8049 sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8050 stcb->asoc.peer_auth_chunks)) {
8051 omtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
8052 } else
8053 omtu = 0;
8054 /* Here we do NOT factor the r_mtu */
8055 if ((chk->send_size < (int)(mtu - omtu)) ||
8056 (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) {
8057 /*
8058 * We probably should glom the mbuf chain
8059 * from the chk->data for control but the
8060 * problem is it becomes yet one more level
8061 * of tracking to do if for some reason
8062 * output fails. Then I have got to
8063 * reconstruct the merged control chain.. el
8064 * yucko.. for now we take the easy way and
8065 * do the copy
8066 */
8067 /*
8068 * Add an AUTH chunk, if chunk requires it
8069 * save the offset into the chain for AUTH
8070 */
8071 if ((auth == NULL) &&
8072 (sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8073 stcb->asoc.peer_auth_chunks))) {
8074 outchain = sctp_add_auth_chunk(outchain,
8075 &endoutchain,
8076 &auth,
8077 &auth_offset,
8078 stcb,
8079 chk->rec.chunk_id.id);
8080 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8081 }
8082 outchain = sctp_copy_mbufchain(chk->data, outchain, &endoutchain,
8083 (int)chk->rec.chunk_id.can_take_data,
8084 chk->send_size, chk->copy_by_ref);
8085 if (outchain == NULL) {
8086 *reason_code = 8;
8087 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
8088 return (ENOMEM);
8089 }
8090 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8091 /* update our MTU size */
8092 if (mtu > (chk->send_size + omtu))
8093 mtu -= (chk->send_size + omtu);
8094 else
8095 mtu = 0;
8096 to_out += (chk->send_size + omtu);
8097 /* Do clear IP_DF ? */
8098 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
8099 no_fragmentflg = 0;
8100 }
8101 if (chk->rec.chunk_id.can_take_data)
8102 chk->data = NULL;
8103 /*
8104 * set hb flag since we can use these for
8105 * RTO
8106 */
8107 hbflag = 1;
8108 asconf = 1;
8109 /*
8110 * should sysctl this: don't bundle data
8111 * with ASCONF since it requires AUTH
8112 */
8113 no_data_chunks = 1;
8114 chk->sent = SCTP_DATAGRAM_SENT;
8115 if (chk->whoTo == NULL) {
8116 chk->whoTo = net;
8117 atomic_add_int(&net->ref_count, 1);
8118 }
8119 chk->snd_count++;
8120 if (mtu == 0) {
8121 /*
8122 * Ok we are out of room but we can
8123 * output without effecting the
8124 * flight size since this little guy
8125 * is a control only packet.
8126 */
8127 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, net);
8128 /*
8129 * do NOT clear the asconf flag as
8130 * it is used to do appropriate
8131 * source address selection.
8132 */
8133 if (*now_filled == 0) {
8134 (void)SCTP_GETTIME_TIMEVAL(now);
8135 *now_filled = 1;
8136 }
8137 net->last_sent_time = *now;
8138 hbflag = 0;
8139 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
8140 (struct sockaddr *)&net->ro._l_addr,
8141 outchain, auth_offset, auth,
8142 stcb->asoc.authinfo.active_keyid,
8143 no_fragmentflg, 0, asconf,
8144 inp->sctp_lport, stcb->rport,
8145 htonl(stcb->asoc.peer_vtag),
8146 net->port, NULL,
8147 0, 0,
8148 so_locked))) {
8149 /*
8150 * error, we could not
8151 * output
8152 */
8153 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
8154 if (from_where == 0) {
8155 SCTP_STAT_INCR(sctps_lowlevelerrusr);
8156 }
8157 if (error == ENOBUFS) {
8158 asoc->ifp_had_enobuf = 1;
8159 SCTP_STAT_INCR(sctps_lowlevelerr);
8160 }
8161 /* error, could not output */
8162 if (error == EHOSTUNREACH) {
8163 /*
8164 * Destination went
8165 * unreachable
8166 * during this send
8167 */
8168 sctp_move_chunks_from_net(stcb, net);
8169 }
8170 *reason_code = 7;
8171 break;
8172 } else {
8173 asoc->ifp_had_enobuf = 0;
8174 }
8175 /*
8176 * increase the number we sent, if a
8177 * cookie is sent we don't tell them
8178 * any was sent out.
8179 */
8180 outchain = endoutchain = NULL;
8181 auth = NULL;
8182 auth_offset = 0;
8183 if (!no_out_cnt)
8184 *num_out += ctl_cnt;
8185 /* recalc a clean slate and setup */
8186 switch (net->ro._l_addr.sa.sa_family) {
8187 #ifdef INET
8188 case AF_INET:
8189 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8190 break;
8191 #endif
8192 #ifdef INET6
8193 case AF_INET6:
8194 mtu = net->mtu - SCTP_MIN_OVERHEAD;
8195 break;
8196 #endif
8197 default:
8198 /* TSNH */
8199 mtu = net->mtu;
8200 break;
8201 }
8202 to_out = 0;
8203 no_fragmentflg = 1;
8204 }
8205 }
8206 }
8207 if (error != 0) {
8208 /* try next net */
8209 continue;
8210 }
8211 /************************/
8212 /* Control transmission */
8213 /************************/
8214 /* Now first lets go through the control queue */
8215 TAILQ_FOREACH_SAFE(chk, &asoc->control_send_queue, sctp_next, nchk) {
8216 if ((sack_goes_to) &&
8217 (chk->rec.chunk_id.id == SCTP_ECN_ECHO) &&
8218 (chk->whoTo != sack_goes_to)) {
8219 /*
8220 * if we have a sack in queue, and we are
8221 * looking at an ecn echo that is NOT queued
8222 * to where the sack is going..
8223 */
8224 if (chk->whoTo == net) {
8225 /*
8226 * Don't transmit it to where its
8227 * going (current net)
8228 */
8229 continue;
8230 } else if (sack_goes_to == net) {
8231 /*
8232 * But do transmit it to this
8233 * address
8234 */
8235 goto skip_net_check;
8236 }
8237 }
8238 if (chk->whoTo == NULL) {
8239 if (asoc->alternate == NULL) {
8240 if (asoc->primary_destination != net) {
8241 continue;
8242 }
8243 } else {
8244 if (asoc->alternate != net) {
8245 continue;
8246 }
8247 }
8248 } else {
8249 if (chk->whoTo != net) {
8250 continue;
8251 }
8252 }
8253 skip_net_check:
8254 if (chk->data == NULL) {
8255 continue;
8256 }
8257 if (chk->sent != SCTP_DATAGRAM_UNSENT) {
8258 /*
8259 * It must be unsent. Cookies and ASCONF's
8260 * hang around but there timers will force
8261 * when marked for resend.
8262 */
8263 continue;
8264 }
8265 /*
8266 * if no AUTH is yet included and this chunk
8267 * requires it, make sure to account for it. We
8268 * don't apply the size until the AUTH chunk is
8269 * actually added below in case there is no room for
8270 * this chunk. NOTE: we overload the use of "omtu"
8271 * here
8272 */
8273 if ((auth == NULL) &&
8274 sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8275 stcb->asoc.peer_auth_chunks)) {
8276 omtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
8277 } else
8278 omtu = 0;
8279 /* Here we do NOT factor the r_mtu */
8280 if ((chk->send_size <= (int)(mtu - omtu)) ||
8281 (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) {
8282 /*
8283 * We probably should glom the mbuf chain
8284 * from the chk->data for control but the
8285 * problem is it becomes yet one more level
8286 * of tracking to do if for some reason
8287 * output fails. Then I have got to
8288 * reconstruct the merged control chain.. el
8289 * yucko.. for now we take the easy way and
8290 * do the copy
8291 */
8292 /*
8293 * Add an AUTH chunk, if chunk requires it
8294 * save the offset into the chain for AUTH
8295 */
8296 if ((auth == NULL) &&
8297 (sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8298 stcb->asoc.peer_auth_chunks))) {
8299 outchain = sctp_add_auth_chunk(outchain,
8300 &endoutchain,
8301 &auth,
8302 &auth_offset,
8303 stcb,
8304 chk->rec.chunk_id.id);
8305 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8306 }
8307 outchain = sctp_copy_mbufchain(chk->data, outchain, &endoutchain,
8308 (int)chk->rec.chunk_id.can_take_data,
8309 chk->send_size, chk->copy_by_ref);
8310 if (outchain == NULL) {
8311 *reason_code = 8;
8312 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
8313 return (ENOMEM);
8314 }
8315 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8316 /* update our MTU size */
8317 if (mtu > (chk->send_size + omtu))
8318 mtu -= (chk->send_size + omtu);
8319 else
8320 mtu = 0;
8321 to_out += (chk->send_size + omtu);
8322 /* Do clear IP_DF ? */
8323 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
8324 no_fragmentflg = 0;
8325 }
8326 if (chk->rec.chunk_id.can_take_data)
8327 chk->data = NULL;
8328 /* Mark things to be removed, if needed */
8329 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
8330 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK) || /* EY */
8331 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_REQUEST) ||
8332 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_ACK) ||
8333 (chk->rec.chunk_id.id == SCTP_SHUTDOWN) ||
8334 (chk->rec.chunk_id.id == SCTP_SHUTDOWN_ACK) ||
8335 (chk->rec.chunk_id.id == SCTP_OPERATION_ERROR) ||
8336 (chk->rec.chunk_id.id == SCTP_COOKIE_ACK) ||
8337 (chk->rec.chunk_id.id == SCTP_ECN_CWR) ||
8338 (chk->rec.chunk_id.id == SCTP_PACKET_DROPPED) ||
8339 (chk->rec.chunk_id.id == SCTP_ASCONF_ACK)) {
8340 if (chk->rec.chunk_id.id == SCTP_HEARTBEAT_REQUEST) {
8341 hbflag = 1;
8342 }
8343 /* remove these chunks at the end */
8344 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
8345 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK)) {
8346 /* turn off the timer */
8347 if (SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
8348 sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
8349 inp, stcb, NULL,
8350 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_1);
8351 }
8352 }
8353 ctl_cnt++;
8354 } else {
8355 /*
8356 * Other chunks, since they have
8357 * timers running (i.e. COOKIE) we
8358 * just "trust" that it gets sent or
8359 * retransmitted.
8360 */
8361 ctl_cnt++;
8362 if (chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) {
8363 cookie = 1;
8364 no_out_cnt = 1;
8365 } else if (chk->rec.chunk_id.id == SCTP_ECN_ECHO) {
8366 /*
8367 * Increment ecne send count
8368 * here this means we may be
8369 * over-zealous in our
8370 * counting if the send
8371 * fails, but its the best
8372 * place to do it (we used
8373 * to do it in the queue of
8374 * the chunk, but that did
8375 * not tell how many times
8376 * it was sent.
8377 */
8378 SCTP_STAT_INCR(sctps_sendecne);
8379 }
8380 chk->sent = SCTP_DATAGRAM_SENT;
8381 if (chk->whoTo == NULL) {
8382 chk->whoTo = net;
8383 atomic_add_int(&net->ref_count, 1);
8384 }
8385 chk->snd_count++;
8386 }
8387 if (mtu == 0) {
8388 /*
8389 * Ok we are out of room but we can
8390 * output without effecting the
8391 * flight size since this little guy
8392 * is a control only packet.
8393 */
8394 if (asconf) {
8395 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, net);
8396 /*
8397 * do NOT clear the asconf
8398 * flag as it is used to do
8399 * appropriate source
8400 * address selection.
8401 */
8402 }
8403 if (cookie) {
8404 sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, net);
8405 cookie = 0;
8406 }
8407 /* Only HB or ASCONF advances time */
8408 if (hbflag) {
8409 if (*now_filled == 0) {
8410 (void)SCTP_GETTIME_TIMEVAL(now);
8411 *now_filled = 1;
8412 }
8413 net->last_sent_time = *now;
8414 hbflag = 0;
8415 }
8416 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
8417 (struct sockaddr *)&net->ro._l_addr,
8418 outchain,
8419 auth_offset, auth,
8420 stcb->asoc.authinfo.active_keyid,
8421 no_fragmentflg, 0, asconf,
8422 inp->sctp_lport, stcb->rport,
8423 htonl(stcb->asoc.peer_vtag),
8424 net->port, NULL,
8425 0, 0,
8426 so_locked))) {
8427 /*
8428 * error, we could not
8429 * output
8430 */
8431 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
8432 if (from_where == 0) {
8433 SCTP_STAT_INCR(sctps_lowlevelerrusr);
8434 }
8435 if (error == ENOBUFS) {
8436 asoc->ifp_had_enobuf = 1;
8437 SCTP_STAT_INCR(sctps_lowlevelerr);
8438 }
8439 if (error == EHOSTUNREACH) {
8440 /*
8441 * Destination went
8442 * unreachable
8443 * during this send
8444 */
8445 sctp_move_chunks_from_net(stcb, net);
8446 }
8447 *reason_code = 7;
8448 break;
8449 } else {
8450 asoc->ifp_had_enobuf = 0;
8451 }
8452 /*
8453 * increase the number we sent, if a
8454 * cookie is sent we don't tell them
8455 * any was sent out.
8456 */
8457 outchain = endoutchain = NULL;
8458 auth = NULL;
8459 auth_offset = 0;
8460 if (!no_out_cnt)
8461 *num_out += ctl_cnt;
8462 /* recalc a clean slate and setup */
8463 switch (net->ro._l_addr.sa.sa_family) {
8464 #ifdef INET
8465 case AF_INET:
8466 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8467 break;
8468 #endif
8469 #ifdef INET6
8470 case AF_INET6:
8471 mtu = net->mtu - SCTP_MIN_OVERHEAD;
8472 break;
8473 #endif
8474 default:
8475 /* TSNH */
8476 mtu = net->mtu;
8477 break;
8478 }
8479 to_out = 0;
8480 no_fragmentflg = 1;
8481 }
8482 }
8483 }
8484 if (error != 0) {
8485 /* try next net */
8486 continue;
8487 }
8488 /* JRI: if dest is in PF state, do not send data to it */
8489 if ((asoc->sctp_cmt_on_off > 0) &&
8490 (net != stcb->asoc.alternate) &&
8491 (net->dest_state & SCTP_ADDR_PF)) {
8492 goto no_data_fill;
8493 }
8494 if (net->flight_size >= net->cwnd) {
8495 goto no_data_fill;
8496 }
8497 if ((asoc->sctp_cmt_on_off > 0) &&
8498 (SCTP_BASE_SYSCTL(sctp_buffer_splitting) & SCTP_RECV_BUFFER_SPLITTING) &&
8499 (net->flight_size > max_rwnd_per_dest)) {
8500 goto no_data_fill;
8501 }
8502 /*
8503 * We need a specific accounting for the usage of the send
8504 * buffer. We also need to check the number of messages per
8505 * net. For now, this is better than nothing and it disabled
8506 * by default...
8507 */
8508 if ((asoc->sctp_cmt_on_off > 0) &&
8509 (SCTP_BASE_SYSCTL(sctp_buffer_splitting) & SCTP_SEND_BUFFER_SPLITTING) &&
8510 (max_send_per_dest > 0) &&
8511 (net->flight_size > max_send_per_dest)) {
8512 goto no_data_fill;
8513 }
8514 /*********************/
8515 /* Data transmission */
8516 /*********************/
8517 /*
8518 * if AUTH for DATA is required and no AUTH has been added
8519 * yet, account for this in the mtu now... if no data can be
8520 * bundled, this adjustment won't matter anyways since the
8521 * packet will be going out...
8522 */
8523 data_auth_reqd = sctp_auth_is_required_chunk(SCTP_DATA,
8524 stcb->asoc.peer_auth_chunks);
8525 if (data_auth_reqd && (auth == NULL)) {
8526 mtu -= sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
8527 }
8528 /* now lets add any data within the MTU constraints */
8529 switch (((struct sockaddr *)&net->ro._l_addr)->sa_family) {
8530 #ifdef INET
8531 case AF_INET:
8532 if (net->mtu > SCTP_MIN_V4_OVERHEAD)
8533 omtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8534 else
8535 omtu = 0;
8536 break;
8537 #endif
8538 #ifdef INET6
8539 case AF_INET6:
8540 if (net->mtu > SCTP_MIN_OVERHEAD)
8541 omtu = net->mtu - SCTP_MIN_OVERHEAD;
8542 else
8543 omtu = 0;
8544 break;
8545 #endif
8546 default:
8547 /* TSNH */
8548 omtu = 0;
8549 break;
8550 }
8551 if ((((SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) ||
8552 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED)) &&
8553 (skip_data_for_this_net == 0)) ||
8554 (cookie)) {
8555 TAILQ_FOREACH_SAFE(chk, &asoc->send_queue, sctp_next, nchk) {
8556 if (no_data_chunks) {
8557 /* let only control go out */
8558 *reason_code = 1;
8559 break;
8560 }
8561 if (net->flight_size >= net->cwnd) {
8562 /* skip this net, no room for data */
8563 *reason_code = 2;
8564 break;
8565 }
8566 if ((chk->whoTo != NULL) &&
8567 (chk->whoTo != net)) {
8568 /* Don't send the chunk on this net */
8569 continue;
8570 }
8571
8572 if (asoc->sctp_cmt_on_off == 0) {
8573 if ((asoc->alternate) &&
8574 (asoc->alternate != net) &&
8575 (chk->whoTo == NULL)) {
8576 continue;
8577 } else if ((net != asoc->primary_destination) &&
8578 (asoc->alternate == NULL) &&
8579 (chk->whoTo == NULL)) {
8580 continue;
8581 }
8582 }
8583 if ((chk->send_size > omtu) && ((chk->flags & CHUNK_FLAGS_FRAGMENT_OK) == 0)) {
8584 /*-
8585 * strange, we have a chunk that is
8586 * to big for its destination and
8587 * yet no fragment ok flag.
8588 * Something went wrong when the
8589 * PMTU changed...we did not mark
8590 * this chunk for some reason?? I
8591 * will fix it here by letting IP
8592 * fragment it for now and printing
8593 * a warning. This really should not
8594 * happen ...
8595 */
8596 SCTP_PRINTF("Warning chunk of %d bytes > mtu:%d and yet PMTU disc missed\n",
8597 chk->send_size, mtu);
8598 chk->flags |= CHUNK_FLAGS_FRAGMENT_OK;
8599 }
8600 if (SCTP_BASE_SYSCTL(sctp_enable_sack_immediately) &&
8601 (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) {
8602 struct sctp_data_chunk *dchkh;
8603
8604 dchkh = mtod(chk->data, struct sctp_data_chunk *);
8605 dchkh->ch.chunk_flags |= SCTP_DATA_SACK_IMMEDIATELY;
8606 }
8607 if (((chk->send_size <= mtu) && (chk->send_size <= r_mtu)) ||
8608 ((chk->flags & CHUNK_FLAGS_FRAGMENT_OK) && (chk->send_size <= asoc->peers_rwnd))) {
8609 /* ok we will add this one */
8610
8611 /*
8612 * Add an AUTH chunk, if chunk
8613 * requires it, save the offset into
8614 * the chain for AUTH
8615 */
8616 if (data_auth_reqd) {
8617 if (auth == NULL) {
8618 outchain = sctp_add_auth_chunk(outchain,
8619 &endoutchain,
8620 &auth,
8621 &auth_offset,
8622 stcb,
8623 SCTP_DATA);
8624 auth_keyid = chk->auth_keyid;
8625 override_ok = 0;
8626 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8627 } else if (override_ok) {
8628 /*
8629 * use this data's
8630 * keyid
8631 */
8632 auth_keyid = chk->auth_keyid;
8633 override_ok = 0;
8634 } else if (auth_keyid != chk->auth_keyid) {
8635 /*
8636 * different keyid,
8637 * so done bundling
8638 */
8639 break;
8640 }
8641 }
8642 outchain = sctp_copy_mbufchain(chk->data, outchain, &endoutchain, 0,
8643 chk->send_size, chk->copy_by_ref);
8644 if (outchain == NULL) {
8645 SCTPDBG(SCTP_DEBUG_OUTPUT3, "No memory?\n");
8646 if (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
8647 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
8648 }
8649 *reason_code = 3;
8650 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
8651 return (ENOMEM);
8652 }
8653 /* update our MTU size */
8654 /* Do clear IP_DF ? */
8655 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
8656 no_fragmentflg = 0;
8657 }
8658 /* unsigned subtraction of mtu */
8659 if (mtu > chk->send_size)
8660 mtu -= chk->send_size;
8661 else
8662 mtu = 0;
8663 /* unsigned subtraction of r_mtu */
8664 if (r_mtu > chk->send_size)
8665 r_mtu -= chk->send_size;
8666 else
8667 r_mtu = 0;
8668
8669 to_out += chk->send_size;
8670 if ((to_out > mx_mtu) && no_fragmentflg) {
8671 #ifdef INVARIANTS
8672 panic("Exceeding mtu of %d out size is %d", mx_mtu, to_out);
8673 #else
8674 SCTP_PRINTF("Exceeding mtu of %d out size is %d\n",
8675 mx_mtu, to_out);
8676 #endif
8677 }
8678 chk->window_probe = 0;
8679 data_list[bundle_at++] = chk;
8680 if (bundle_at >= SCTP_MAX_DATA_BUNDLING) {
8681 break;
8682 }
8683 if (chk->sent == SCTP_DATAGRAM_UNSENT) {
8684 if ((chk->rec.data.rcv_flags & SCTP_DATA_UNORDERED) == 0) {
8685 SCTP_STAT_INCR_COUNTER64(sctps_outorderchunks);
8686 } else {
8687 SCTP_STAT_INCR_COUNTER64(sctps_outunorderchunks);
8688 }
8689 if (((chk->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG) == SCTP_DATA_LAST_FRAG) &&
8690 ((chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) == 0))
8691 /*
8692 * Count number of
8693 * user msg's that
8694 * were fragmented
8695 * we do this by
8696 * counting when we
8697 * see a LAST
8698 * fragment only.
8699 */
8700 SCTP_STAT_INCR_COUNTER64(sctps_fragusrmsgs);
8701 }
8702 if ((mtu == 0) || (r_mtu == 0) || (one_chunk)) {
8703 if ((one_chunk) && (stcb->asoc.total_flight == 0)) {
8704 data_list[0]->window_probe = 1;
8705 net->window_probe = 1;
8706 }
8707 break;
8708 }
8709 } else {
8710 /*
8711 * Must be sent in order of the
8712 * TSN's (on a network)
8713 */
8714 break;
8715 }
8716 } /* for (chunk gather loop for this net) */
8717 } /* if asoc.state OPEN */
8718 no_data_fill:
8719 /* Is there something to send for this destination? */
8720 if (outchain) {
8721 /* We may need to start a control timer or two */
8722 if (asconf) {
8723 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp,
8724 stcb, net);
8725 /*
8726 * do NOT clear the asconf flag as it is
8727 * used to do appropriate source address
8728 * selection.
8729 */
8730 }
8731 if (cookie) {
8732 sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, net);
8733 cookie = 0;
8734 }
8735 /* must start a send timer if data is being sent */
8736 if (bundle_at && (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer))) {
8737 /*
8738 * no timer running on this destination
8739 * restart it.
8740 */
8741 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
8742 }
8743 if (bundle_at || hbflag) {
8744 /* For data/asconf and hb set time */
8745 if (*now_filled == 0) {
8746 (void)SCTP_GETTIME_TIMEVAL(now);
8747 *now_filled = 1;
8748 }
8749 net->last_sent_time = *now;
8750 }
8751 /* Now send it, if there is anything to send :> */
8752 if ((error = sctp_lowlevel_chunk_output(inp,
8753 stcb,
8754 net,
8755 (struct sockaddr *)&net->ro._l_addr,
8756 outchain,
8757 auth_offset,
8758 auth,
8759 auth_keyid,
8760 no_fragmentflg,
8761 bundle_at,
8762 asconf,
8763 inp->sctp_lport, stcb->rport,
8764 htonl(stcb->asoc.peer_vtag),
8765 net->port, NULL,
8766 0, 0,
8767 so_locked))) {
8768 /* error, we could not output */
8769 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
8770 if (from_where == 0) {
8771 SCTP_STAT_INCR(sctps_lowlevelerrusr);
8772 }
8773 if (error == ENOBUFS) {
8774 asoc->ifp_had_enobuf = 1;
8775 SCTP_STAT_INCR(sctps_lowlevelerr);
8776 }
8777 if (error == EHOSTUNREACH) {
8778 /*
8779 * Destination went unreachable
8780 * during this send
8781 */
8782 sctp_move_chunks_from_net(stcb, net);
8783 }
8784 *reason_code = 6;
8785 /*-
8786 * I add this line to be paranoid. As far as
8787 * I can tell the continue, takes us back to
8788 * the top of the for, but just to make sure
8789 * I will reset these again here.
8790 */
8791 ctl_cnt = 0;
8792 continue; /* This takes us back to the
8793 * for() for the nets. */
8794 } else {
8795 asoc->ifp_had_enobuf = 0;
8796 }
8797 endoutchain = NULL;
8798 auth = NULL;
8799 auth_offset = 0;
8800 if (!no_out_cnt) {
8801 *num_out += (ctl_cnt + bundle_at);
8802 }
8803 if (bundle_at) {
8804 /* setup for a RTO measurement */
8805 tsns_sent = data_list[0]->rec.data.tsn;
8806 /* fill time if not already filled */
8807 if (*now_filled == 0) {
8808 (void)SCTP_GETTIME_TIMEVAL(&asoc->time_last_sent);
8809 *now_filled = 1;
8810 *now = asoc->time_last_sent;
8811 } else {
8812 asoc->time_last_sent = *now;
8813 }
8814 if (net->rto_needed) {
8815 data_list[0]->do_rtt = 1;
8816 net->rto_needed = 0;
8817 }
8818 SCTP_STAT_INCR_BY(sctps_senddata, bundle_at);
8819 sctp_clean_up_datalist(stcb, asoc, data_list, bundle_at, net);
8820 }
8821 if (one_chunk) {
8822 break;
8823 }
8824 }
8825 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
8826 sctp_log_cwnd(stcb, net, tsns_sent, SCTP_CWND_LOG_FROM_SEND);
8827 }
8828 }
8829 if (old_start_at == NULL) {
8830 old_start_at = start_at;
8831 start_at = TAILQ_FIRST(&asoc->nets);
8832 if (old_start_at)
8833 goto again_one_more_time;
8834 }
8835
8836 /*
8837 * At the end there should be no NON timed chunks hanging on this
8838 * queue.
8839 */
8840 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
8841 sctp_log_cwnd(stcb, net, *num_out, SCTP_CWND_LOG_FROM_SEND);
8842 }
8843 if ((*num_out == 0) && (*reason_code == 0)) {
8844 *reason_code = 4;
8845 } else {
8846 *reason_code = 5;
8847 }
8848 sctp_clean_up_ctl(stcb, asoc, so_locked);
8849 return (0);
8850 }
8851
8852 void
8853 sctp_queue_op_err(struct sctp_tcb *stcb, struct mbuf *op_err)
8854 {
8855 /*-
8856 * Prepend a OPERATIONAL_ERROR chunk header and put on the end of
8857 * the control chunk queue.
8858 */
8859 struct sctp_chunkhdr *hdr;
8860 struct sctp_tmit_chunk *chk;
8861 struct mbuf *mat, *last_mbuf;
8862 uint32_t chunk_length;
8863 uint16_t padding_length;
8864
8865 SCTP_TCB_LOCK_ASSERT(stcb);
8866 SCTP_BUF_PREPEND(op_err, sizeof(struct sctp_chunkhdr), M_NOWAIT);
8867 if (op_err == NULL) {
8868 return;
8869 }
8870 last_mbuf = NULL;
8871 chunk_length = 0;
8872 for (mat = op_err; mat != NULL; mat = SCTP_BUF_NEXT(mat)) {
8873 chunk_length += SCTP_BUF_LEN(mat);
8874 if (SCTP_BUF_NEXT(mat) == NULL) {
8875 last_mbuf = mat;
8876 }
8877 }
8878 if (chunk_length > SCTP_MAX_CHUNK_LENGTH) {
8879 sctp_m_freem(op_err);
8880 return;
8881 }
8882 padding_length = chunk_length % 4;
8883 if (padding_length != 0) {
8884 padding_length = 4 - padding_length;
8885 }
8886 if (padding_length != 0) {
8887 if (sctp_add_pad_tombuf(last_mbuf, padding_length) == NULL) {
8888 sctp_m_freem(op_err);
8889 return;
8890 }
8891 }
8892 sctp_alloc_a_chunk(stcb, chk);
8893 if (chk == NULL) {
8894 /* no memory */
8895 sctp_m_freem(op_err);
8896 return;
8897 }
8898 chk->copy_by_ref = 0;
8899 chk->rec.chunk_id.id = SCTP_OPERATION_ERROR;
8900 chk->rec.chunk_id.can_take_data = 0;
8901 chk->flags = 0;
8902 chk->send_size = (uint16_t)chunk_length;
8903 chk->sent = SCTP_DATAGRAM_UNSENT;
8904 chk->snd_count = 0;
8905 chk->asoc = &stcb->asoc;
8906 chk->data = op_err;
8907 chk->whoTo = NULL;
8908 hdr = mtod(op_err, struct sctp_chunkhdr *);
8909 hdr->chunk_type = SCTP_OPERATION_ERROR;
8910 hdr->chunk_flags = 0;
8911 hdr->chunk_length = htons(chk->send_size);
8912 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
8913 chk->asoc->ctrl_queue_cnt++;
8914 }
8915
8916 int
8917 sctp_send_cookie_echo(struct mbuf *m,
8918 int offset, int limit,
8919 struct sctp_tcb *stcb,
8920 struct sctp_nets *net)
8921 {
8922 /*-
8923 * pull out the cookie and put it at the front of the control chunk
8924 * queue.
8925 */
8926 int at;
8927 struct mbuf *cookie;
8928 struct sctp_paramhdr param, *phdr;
8929 struct sctp_chunkhdr *hdr;
8930 struct sctp_tmit_chunk *chk;
8931 uint16_t ptype, plen;
8932
8933 SCTP_TCB_LOCK_ASSERT(stcb);
8934 /* First find the cookie in the param area */
8935 cookie = NULL;
8936 at = offset + sizeof(struct sctp_init_chunk);
8937 for (;;) {
8938 phdr = sctp_get_next_param(m, at, ¶m, sizeof(param));
8939 if (phdr == NULL) {
8940 return (-3);
8941 }
8942 ptype = ntohs(phdr->param_type);
8943 plen = ntohs(phdr->param_length);
8944 if (plen < sizeof(struct sctp_paramhdr)) {
8945 return (-6);
8946 }
8947 if (ptype == SCTP_STATE_COOKIE) {
8948 int pad;
8949
8950 /* found the cookie */
8951 if (at + plen > limit) {
8952 return (-7);
8953 }
8954 cookie = SCTP_M_COPYM(m, at, plen, M_NOWAIT);
8955 if (cookie == NULL) {
8956 /* No memory */
8957 return (-2);
8958 }
8959 if ((pad = (plen % 4)) > 0) {
8960 pad = 4 - pad;
8961 }
8962 if (pad > 0) {
8963 if (sctp_pad_lastmbuf(cookie, pad, NULL) == NULL) {
8964 return (-8);
8965 }
8966 }
8967 #ifdef SCTP_MBUF_LOGGING
8968 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
8969 sctp_log_mbc(cookie, SCTP_MBUF_ICOPY);
8970 }
8971 #endif
8972 break;
8973 }
8974 at += SCTP_SIZE32(plen);
8975 }
8976 /* ok, we got the cookie lets change it into a cookie echo chunk */
8977 /* first the change from param to cookie */
8978 hdr = mtod(cookie, struct sctp_chunkhdr *);
8979 hdr->chunk_type = SCTP_COOKIE_ECHO;
8980 hdr->chunk_flags = 0;
8981 /* get the chunk stuff now and place it in the FRONT of the queue */
8982 sctp_alloc_a_chunk(stcb, chk);
8983 if (chk == NULL) {
8984 /* no memory */
8985 sctp_m_freem(cookie);
8986 return (-5);
8987 }
8988 chk->copy_by_ref = 0;
8989 chk->rec.chunk_id.id = SCTP_COOKIE_ECHO;
8990 chk->rec.chunk_id.can_take_data = 0;
8991 chk->flags = CHUNK_FLAGS_FRAGMENT_OK;
8992 chk->send_size = SCTP_SIZE32(plen);
8993 chk->sent = SCTP_DATAGRAM_UNSENT;
8994 chk->snd_count = 0;
8995 chk->asoc = &stcb->asoc;
8996 chk->data = cookie;
8997 chk->whoTo = net;
8998 atomic_add_int(&chk->whoTo->ref_count, 1);
8999 TAILQ_INSERT_HEAD(&chk->asoc->control_send_queue, chk, sctp_next);
9000 chk->asoc->ctrl_queue_cnt++;
9001 return (0);
9002 }
9003
9004 void
9005 sctp_send_heartbeat_ack(struct sctp_tcb *stcb,
9006 struct mbuf *m,
9007 int offset,
9008 int chk_length,
9009 struct sctp_nets *net)
9010 {
9011 /*
9012 * take a HB request and make it into a HB ack and send it.
9013 */
9014 struct mbuf *outchain;
9015 struct sctp_chunkhdr *chdr;
9016 struct sctp_tmit_chunk *chk;
9017
9018 if (net == NULL)
9019 /* must have a net pointer */
9020 return;
9021
9022 outchain = SCTP_M_COPYM(m, offset, chk_length, M_NOWAIT);
9023 if (outchain == NULL) {
9024 /* gak out of memory */
9025 return;
9026 }
9027 #ifdef SCTP_MBUF_LOGGING
9028 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
9029 sctp_log_mbc(outchain, SCTP_MBUF_ICOPY);
9030 }
9031 #endif
9032 chdr = mtod(outchain, struct sctp_chunkhdr *);
9033 chdr->chunk_type = SCTP_HEARTBEAT_ACK;
9034 chdr->chunk_flags = 0;
9035 if (chk_length % 4 != 0) {
9036 sctp_pad_lastmbuf(outchain, 4 - (chk_length % 4), NULL);
9037 }
9038 sctp_alloc_a_chunk(stcb, chk);
9039 if (chk == NULL) {
9040 /* no memory */
9041 sctp_m_freem(outchain);
9042 return;
9043 }
9044 chk->copy_by_ref = 0;
9045 chk->rec.chunk_id.id = SCTP_HEARTBEAT_ACK;
9046 chk->rec.chunk_id.can_take_data = 1;
9047 chk->flags = 0;
9048 chk->send_size = chk_length;
9049 chk->sent = SCTP_DATAGRAM_UNSENT;
9050 chk->snd_count = 0;
9051 chk->asoc = &stcb->asoc;
9052 chk->data = outchain;
9053 chk->whoTo = net;
9054 atomic_add_int(&chk->whoTo->ref_count, 1);
9055 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9056 chk->asoc->ctrl_queue_cnt++;
9057 }
9058
9059 void
9060 sctp_send_cookie_ack(struct sctp_tcb *stcb)
9061 {
9062 /* formulate and queue a cookie-ack back to sender */
9063 struct mbuf *cookie_ack;
9064 struct sctp_chunkhdr *hdr;
9065 struct sctp_tmit_chunk *chk;
9066
9067 SCTP_TCB_LOCK_ASSERT(stcb);
9068
9069 cookie_ack = sctp_get_mbuf_for_msg(sizeof(struct sctp_chunkhdr), 0, M_NOWAIT, 1, MT_HEADER);
9070 if (cookie_ack == NULL) {
9071 /* no mbuf's */
9072 return;
9073 }
9074 SCTP_BUF_RESV_UF(cookie_ack, SCTP_MIN_OVERHEAD);
9075 sctp_alloc_a_chunk(stcb, chk);
9076 if (chk == NULL) {
9077 /* no memory */
9078 sctp_m_freem(cookie_ack);
9079 return;
9080 }
9081 chk->copy_by_ref = 0;
9082 chk->rec.chunk_id.id = SCTP_COOKIE_ACK;
9083 chk->rec.chunk_id.can_take_data = 1;
9084 chk->flags = 0;
9085 chk->send_size = sizeof(struct sctp_chunkhdr);
9086 chk->sent = SCTP_DATAGRAM_UNSENT;
9087 chk->snd_count = 0;
9088 chk->asoc = &stcb->asoc;
9089 chk->data = cookie_ack;
9090 if (chk->asoc->last_control_chunk_from != NULL) {
9091 chk->whoTo = chk->asoc->last_control_chunk_from;
9092 atomic_add_int(&chk->whoTo->ref_count, 1);
9093 } else {
9094 chk->whoTo = NULL;
9095 }
9096 hdr = mtod(cookie_ack, struct sctp_chunkhdr *);
9097 hdr->chunk_type = SCTP_COOKIE_ACK;
9098 hdr->chunk_flags = 0;
9099 hdr->chunk_length = htons(chk->send_size);
9100 SCTP_BUF_LEN(cookie_ack) = chk->send_size;
9101 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9102 chk->asoc->ctrl_queue_cnt++;
9103 return;
9104 }
9105
9106 void
9107 sctp_send_shutdown_ack(struct sctp_tcb *stcb, struct sctp_nets *net)
9108 {
9109 /* formulate and queue a SHUTDOWN-ACK back to the sender */
9110 struct mbuf *m_shutdown_ack;
9111 struct sctp_shutdown_ack_chunk *ack_cp;
9112 struct sctp_tmit_chunk *chk;
9113
9114 m_shutdown_ack = sctp_get_mbuf_for_msg(sizeof(struct sctp_shutdown_ack_chunk), 0, M_NOWAIT, 1, MT_HEADER);
9115 if (m_shutdown_ack == NULL) {
9116 /* no mbuf's */
9117 return;
9118 }
9119 SCTP_BUF_RESV_UF(m_shutdown_ack, SCTP_MIN_OVERHEAD);
9120 sctp_alloc_a_chunk(stcb, chk);
9121 if (chk == NULL) {
9122 /* no memory */
9123 sctp_m_freem(m_shutdown_ack);
9124 return;
9125 }
9126 chk->copy_by_ref = 0;
9127 chk->rec.chunk_id.id = SCTP_SHUTDOWN_ACK;
9128 chk->rec.chunk_id.can_take_data = 1;
9129 chk->flags = 0;
9130 chk->send_size = sizeof(struct sctp_chunkhdr);
9131 chk->sent = SCTP_DATAGRAM_UNSENT;
9132 chk->snd_count = 0;
9133 chk->asoc = &stcb->asoc;
9134 chk->data = m_shutdown_ack;
9135 chk->whoTo = net;
9136 if (chk->whoTo) {
9137 atomic_add_int(&chk->whoTo->ref_count, 1);
9138 }
9139 ack_cp = mtod(m_shutdown_ack, struct sctp_shutdown_ack_chunk *);
9140 ack_cp->ch.chunk_type = SCTP_SHUTDOWN_ACK;
9141 ack_cp->ch.chunk_flags = 0;
9142 ack_cp->ch.chunk_length = htons(chk->send_size);
9143 SCTP_BUF_LEN(m_shutdown_ack) = chk->send_size;
9144 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9145 chk->asoc->ctrl_queue_cnt++;
9146 return;
9147 }
9148
9149 void
9150 sctp_send_shutdown(struct sctp_tcb *stcb, struct sctp_nets *net)
9151 {
9152 /* formulate and queue a SHUTDOWN to the sender */
9153 struct mbuf *m_shutdown;
9154 struct sctp_shutdown_chunk *shutdown_cp;
9155 struct sctp_tmit_chunk *chk;
9156
9157 TAILQ_FOREACH(chk, &stcb->asoc.control_send_queue, sctp_next) {
9158 if (chk->rec.chunk_id.id == SCTP_SHUTDOWN) {
9159 /* We already have a SHUTDOWN queued. Reuse it. */
9160 if (chk->whoTo) {
9161 sctp_free_remote_addr(chk->whoTo);
9162 chk->whoTo = NULL;
9163 }
9164 break;
9165 }
9166 }
9167 if (chk == NULL) {
9168 m_shutdown = sctp_get_mbuf_for_msg(sizeof(struct sctp_shutdown_chunk), 0, M_NOWAIT, 1, MT_HEADER);
9169 if (m_shutdown == NULL) {
9170 /* no mbuf's */
9171 return;
9172 }
9173 SCTP_BUF_RESV_UF(m_shutdown, SCTP_MIN_OVERHEAD);
9174 sctp_alloc_a_chunk(stcb, chk);
9175 if (chk == NULL) {
9176 /* no memory */
9177 sctp_m_freem(m_shutdown);
9178 return;
9179 }
9180 chk->copy_by_ref = 0;
9181 chk->rec.chunk_id.id = SCTP_SHUTDOWN;
9182 chk->rec.chunk_id.can_take_data = 1;
9183 chk->flags = 0;
9184 chk->send_size = sizeof(struct sctp_shutdown_chunk);
9185 chk->sent = SCTP_DATAGRAM_UNSENT;
9186 chk->snd_count = 0;
9187 chk->asoc = &stcb->asoc;
9188 chk->data = m_shutdown;
9189 chk->whoTo = net;
9190 if (chk->whoTo) {
9191 atomic_add_int(&chk->whoTo->ref_count, 1);
9192 }
9193 shutdown_cp = mtod(m_shutdown, struct sctp_shutdown_chunk *);
9194 shutdown_cp->ch.chunk_type = SCTP_SHUTDOWN;
9195 shutdown_cp->ch.chunk_flags = 0;
9196 shutdown_cp->ch.chunk_length = htons(chk->send_size);
9197 shutdown_cp->cumulative_tsn_ack = htonl(stcb->asoc.cumulative_tsn);
9198 SCTP_BUF_LEN(m_shutdown) = chk->send_size;
9199 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9200 chk->asoc->ctrl_queue_cnt++;
9201 } else {
9202 TAILQ_REMOVE(&stcb->asoc.control_send_queue, chk, sctp_next);
9203 chk->whoTo = net;
9204 if (chk->whoTo) {
9205 atomic_add_int(&chk->whoTo->ref_count, 1);
9206 }
9207 shutdown_cp = mtod(chk->data, struct sctp_shutdown_chunk *);
9208 shutdown_cp->cumulative_tsn_ack = htonl(stcb->asoc.cumulative_tsn);
9209 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
9210 }
9211 return;
9212 }
9213
9214 void
9215 sctp_send_asconf(struct sctp_tcb *stcb, struct sctp_nets *net, int addr_locked)
9216 {
9217 /*
9218 * formulate and queue an ASCONF to the peer. ASCONF parameters
9219 * should be queued on the assoc queue.
9220 */
9221 struct sctp_tmit_chunk *chk;
9222 struct mbuf *m_asconf;
9223 int len;
9224
9225 SCTP_TCB_LOCK_ASSERT(stcb);
9226
9227 if ((!TAILQ_EMPTY(&stcb->asoc.asconf_send_queue)) &&
9228 (!sctp_is_feature_on(stcb->sctp_ep, SCTP_PCB_FLAGS_MULTIPLE_ASCONFS))) {
9229 /* can't send a new one if there is one in flight already */
9230 return;
9231 }
9232
9233 /* compose an ASCONF chunk, maximum length is PMTU */
9234 m_asconf = sctp_compose_asconf(stcb, &len, addr_locked);
9235 if (m_asconf == NULL) {
9236 return;
9237 }
9238
9239 sctp_alloc_a_chunk(stcb, chk);
9240 if (chk == NULL) {
9241 /* no memory */
9242 sctp_m_freem(m_asconf);
9243 return;
9244 }
9245
9246 chk->copy_by_ref = 0;
9247 chk->rec.chunk_id.id = SCTP_ASCONF;
9248 chk->rec.chunk_id.can_take_data = 0;
9249 chk->flags = CHUNK_FLAGS_FRAGMENT_OK;
9250 chk->data = m_asconf;
9251 chk->send_size = len;
9252 chk->sent = SCTP_DATAGRAM_UNSENT;
9253 chk->snd_count = 0;
9254 chk->asoc = &stcb->asoc;
9255 chk->whoTo = net;
9256 if (chk->whoTo) {
9257 atomic_add_int(&chk->whoTo->ref_count, 1);
9258 }
9259 TAILQ_INSERT_TAIL(&chk->asoc->asconf_send_queue, chk, sctp_next);
9260 chk->asoc->ctrl_queue_cnt++;
9261 return;
9262 }
9263
9264 void
9265 sctp_send_asconf_ack(struct sctp_tcb *stcb)
9266 {
9267 /*
9268 * formulate and queue a asconf-ack back to sender. the asconf-ack
9269 * must be stored in the tcb.
9270 */
9271 struct sctp_tmit_chunk *chk;
9272 struct sctp_asconf_ack *ack, *latest_ack;
9273 struct mbuf *m_ack;
9274 struct sctp_nets *net = NULL;
9275
9276 SCTP_TCB_LOCK_ASSERT(stcb);
9277 /* Get the latest ASCONF-ACK */
9278 latest_ack = TAILQ_LAST(&stcb->asoc.asconf_ack_sent, sctp_asconf_ackhead);
9279 if (latest_ack == NULL) {
9280 return;
9281 }
9282 if (latest_ack->last_sent_to != NULL &&
9283 latest_ack->last_sent_to == stcb->asoc.last_control_chunk_from) {
9284 /* we're doing a retransmission */
9285 net = sctp_find_alternate_net(stcb, stcb->asoc.last_control_chunk_from, 0);
9286 if (net == NULL) {
9287 /* no alternate */
9288 if (stcb->asoc.last_control_chunk_from == NULL) {
9289 if (stcb->asoc.alternate) {
9290 net = stcb->asoc.alternate;
9291 } else {
9292 net = stcb->asoc.primary_destination;
9293 }
9294 } else {
9295 net = stcb->asoc.last_control_chunk_from;
9296 }
9297 }
9298 } else {
9299 /* normal case */
9300 if (stcb->asoc.last_control_chunk_from == NULL) {
9301 if (stcb->asoc.alternate) {
9302 net = stcb->asoc.alternate;
9303 } else {
9304 net = stcb->asoc.primary_destination;
9305 }
9306 } else {
9307 net = stcb->asoc.last_control_chunk_from;
9308 }
9309 }
9310 latest_ack->last_sent_to = net;
9311
9312 TAILQ_FOREACH(ack, &stcb->asoc.asconf_ack_sent, next) {
9313 if (ack->data == NULL) {
9314 continue;
9315 }
9316
9317 /* copy the asconf_ack */
9318 m_ack = SCTP_M_COPYM(ack->data, 0, M_COPYALL, M_NOWAIT);
9319 if (m_ack == NULL) {
9320 /* couldn't copy it */
9321 return;
9322 }
9323 #ifdef SCTP_MBUF_LOGGING
9324 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
9325 sctp_log_mbc(m_ack, SCTP_MBUF_ICOPY);
9326 }
9327 #endif
9328
9329 sctp_alloc_a_chunk(stcb, chk);
9330 if (chk == NULL) {
9331 /* no memory */
9332 if (m_ack)
9333 sctp_m_freem(m_ack);
9334 return;
9335 }
9336 chk->copy_by_ref = 0;
9337 chk->rec.chunk_id.id = SCTP_ASCONF_ACK;
9338 chk->rec.chunk_id.can_take_data = 1;
9339 chk->flags = CHUNK_FLAGS_FRAGMENT_OK;
9340 chk->whoTo = net;
9341 if (chk->whoTo) {
9342 atomic_add_int(&chk->whoTo->ref_count, 1);
9343 }
9344 chk->data = m_ack;
9345 chk->send_size = ack->len;
9346 chk->sent = SCTP_DATAGRAM_UNSENT;
9347 chk->snd_count = 0;
9348 chk->asoc = &stcb->asoc;
9349
9350 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9351 chk->asoc->ctrl_queue_cnt++;
9352 }
9353 return;
9354 }
9355
9356 static int
9357 sctp_chunk_retransmission(struct sctp_inpcb *inp,
9358 struct sctp_tcb *stcb,
9359 struct sctp_association *asoc,
9360 int *cnt_out, struct timeval *now, int *now_filled, int *fr_done, int so_locked)
9361 {
9362 /*-
9363 * send out one MTU of retransmission. If fast_retransmit is
9364 * happening we ignore the cwnd. Otherwise we obey the cwnd and
9365 * rwnd. For a Cookie or Asconf in the control chunk queue we
9366 * retransmit them by themselves.
9367 *
9368 * For data chunks we will pick out the lowest TSN's in the sent_queue
9369 * marked for resend and bundle them all together (up to a MTU of
9370 * destination). The address to send to should have been
9371 * selected/changed where the retransmission was marked (i.e. in FR
9372 * or t3-timeout routines).
9373 */
9374 struct sctp_tmit_chunk *data_list[SCTP_MAX_DATA_BUNDLING];
9375 struct sctp_tmit_chunk *chk, *fwd;
9376 struct mbuf *m, *endofchain;
9377 struct sctp_nets *net = NULL;
9378 uint32_t tsns_sent = 0;
9379 int no_fragmentflg, bundle_at;
9380 unsigned int mtu;
9381 int error, i, one_chunk, fwd_tsn, ctl_cnt, tmr_started;
9382 struct sctp_auth_chunk *auth = NULL;
9383 uint32_t auth_offset = 0;
9384 uint16_t auth_keyid;
9385 int override_ok = 1;
9386 int data_auth_reqd = 0;
9387 uint32_t dmtu = 0;
9388
9389 SCTP_TCB_LOCK_ASSERT(stcb);
9390 tmr_started = ctl_cnt = 0;
9391 no_fragmentflg = 1;
9392 fwd_tsn = 0;
9393 *cnt_out = 0;
9394 fwd = NULL;
9395 endofchain = m = NULL;
9396 auth_keyid = stcb->asoc.authinfo.active_keyid;
9397 #ifdef SCTP_AUDITING_ENABLED
9398 sctp_audit_log(0xC3, 1);
9399 #endif
9400 if ((TAILQ_EMPTY(&asoc->sent_queue)) &&
9401 (TAILQ_EMPTY(&asoc->control_send_queue))) {
9402 SCTPDBG(SCTP_DEBUG_OUTPUT1, "SCTP hits empty queue with cnt set to %d?\n",
9403 asoc->sent_queue_retran_cnt);
9404 asoc->sent_queue_cnt = 0;
9405 asoc->sent_queue_cnt_removeable = 0;
9406 /* send back 0/0 so we enter normal transmission */
9407 *cnt_out = 0;
9408 return (0);
9409 }
9410 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
9411 if ((chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) ||
9412 (chk->rec.chunk_id.id == SCTP_STREAM_RESET) ||
9413 (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN)) {
9414 if (chk->sent != SCTP_DATAGRAM_RESEND) {
9415 continue;
9416 }
9417 if (chk->rec.chunk_id.id == SCTP_STREAM_RESET) {
9418 if (chk != asoc->str_reset) {
9419 /*
9420 * not eligible for retran if its
9421 * not ours
9422 */
9423 continue;
9424 }
9425 }
9426 ctl_cnt++;
9427 if (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) {
9428 fwd_tsn = 1;
9429 }
9430 /*
9431 * Add an AUTH chunk, if chunk requires it save the
9432 * offset into the chain for AUTH
9433 */
9434 if ((auth == NULL) &&
9435 (sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
9436 stcb->asoc.peer_auth_chunks))) {
9437 m = sctp_add_auth_chunk(m, &endofchain,
9438 &auth, &auth_offset,
9439 stcb,
9440 chk->rec.chunk_id.id);
9441 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
9442 }
9443 m = sctp_copy_mbufchain(chk->data, m, &endofchain, 0, chk->send_size, chk->copy_by_ref);
9444 break;
9445 }
9446 }
9447 one_chunk = 0;
9448 /* do we have control chunks to retransmit? */
9449 if (m != NULL) {
9450 /* Start a timer no matter if we succeed or fail */
9451 if (chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) {
9452 sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, chk->whoTo);
9453 } else if (chk->rec.chunk_id.id == SCTP_ASCONF)
9454 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, chk->whoTo);
9455 chk->snd_count++; /* update our count */
9456 if ((error = sctp_lowlevel_chunk_output(inp, stcb, chk->whoTo,
9457 (struct sockaddr *)&chk->whoTo->ro._l_addr, m,
9458 auth_offset, auth, stcb->asoc.authinfo.active_keyid,
9459 no_fragmentflg, 0, 0,
9460 inp->sctp_lport, stcb->rport, htonl(stcb->asoc.peer_vtag),
9461 chk->whoTo->port, NULL,
9462 0, 0,
9463 so_locked))) {
9464 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
9465 if (error == ENOBUFS) {
9466 asoc->ifp_had_enobuf = 1;
9467 SCTP_STAT_INCR(sctps_lowlevelerr);
9468 }
9469 return (error);
9470 } else {
9471 asoc->ifp_had_enobuf = 0;
9472 }
9473 endofchain = NULL;
9474 auth = NULL;
9475 auth_offset = 0;
9476 /*
9477 * We don't want to mark the net->sent time here since this
9478 * we use this for HB and retrans cannot measure RTT
9479 */
9480 /* (void)SCTP_GETTIME_TIMEVAL(&chk->whoTo->last_sent_time); */
9481 *cnt_out += 1;
9482 chk->sent = SCTP_DATAGRAM_SENT;
9483 sctp_ucount_decr(stcb->asoc.sent_queue_retran_cnt);
9484 if (fwd_tsn == 0) {
9485 return (0);
9486 } else {
9487 /* Clean up the fwd-tsn list */
9488 sctp_clean_up_ctl(stcb, asoc, so_locked);
9489 return (0);
9490 }
9491 }
9492 /*
9493 * Ok, it is just data retransmission we need to do or that and a
9494 * fwd-tsn with it all.
9495 */
9496 if (TAILQ_EMPTY(&asoc->sent_queue)) {
9497 return (SCTP_RETRAN_DONE);
9498 }
9499 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED) ||
9500 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT)) {
9501 /* not yet open, resend the cookie and that is it */
9502 return (1);
9503 }
9504 #ifdef SCTP_AUDITING_ENABLED
9505 sctp_auditing(20, inp, stcb, NULL);
9506 #endif
9507 data_auth_reqd = sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks);
9508 TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) {
9509 if (chk->sent != SCTP_DATAGRAM_RESEND) {
9510 /* No, not sent to this net or not ready for rtx */
9511 continue;
9512 }
9513 if (chk->data == NULL) {
9514 SCTP_PRINTF("TSN:%x chk->snd_count:%d chk->sent:%d can't retran - no data\n",
9515 chk->rec.data.tsn, chk->snd_count, chk->sent);
9516 continue;
9517 }
9518 if ((SCTP_BASE_SYSCTL(sctp_max_retran_chunk)) &&
9519 (chk->snd_count >= SCTP_BASE_SYSCTL(sctp_max_retran_chunk))) {
9520 struct mbuf *op_err;
9521 char msg[SCTP_DIAG_INFO_LEN];
9522
9523 SCTP_SNPRINTF(msg, sizeof(msg), "TSN %8.8x retransmitted %d times, giving up",
9524 chk->rec.data.tsn, chk->snd_count);
9525 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
9526 msg);
9527 atomic_add_int(&stcb->asoc.refcnt, 1);
9528 sctp_abort_an_association(stcb->sctp_ep, stcb, op_err,
9529 false, so_locked);
9530 SCTP_TCB_LOCK(stcb);
9531 atomic_subtract_int(&stcb->asoc.refcnt, 1);
9532 return (SCTP_RETRAN_EXIT);
9533 }
9534 /* pick up the net */
9535 net = chk->whoTo;
9536 switch (net->ro._l_addr.sa.sa_family) {
9537 #ifdef INET
9538 case AF_INET:
9539 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
9540 break;
9541 #endif
9542 #ifdef INET6
9543 case AF_INET6:
9544 mtu = net->mtu - SCTP_MIN_OVERHEAD;
9545 break;
9546 #endif
9547 default:
9548 /* TSNH */
9549 mtu = net->mtu;
9550 break;
9551 }
9552
9553 if ((asoc->peers_rwnd < mtu) && (asoc->total_flight > 0)) {
9554 /* No room in peers rwnd */
9555 uint32_t tsn;
9556
9557 tsn = asoc->last_acked_seq + 1;
9558 if (tsn == chk->rec.data.tsn) {
9559 /*
9560 * we make a special exception for this
9561 * case. The peer has no rwnd but is missing
9562 * the lowest chunk.. which is probably what
9563 * is holding up the rwnd.
9564 */
9565 goto one_chunk_around;
9566 }
9567 return (1);
9568 }
9569 one_chunk_around:
9570 if (asoc->peers_rwnd < mtu) {
9571 one_chunk = 1;
9572 if ((asoc->peers_rwnd == 0) &&
9573 (asoc->total_flight == 0)) {
9574 chk->window_probe = 1;
9575 chk->whoTo->window_probe = 1;
9576 }
9577 }
9578 #ifdef SCTP_AUDITING_ENABLED
9579 sctp_audit_log(0xC3, 2);
9580 #endif
9581 bundle_at = 0;
9582 m = NULL;
9583 net->fast_retran_ip = 0;
9584 if (chk->rec.data.doing_fast_retransmit == 0) {
9585 /*
9586 * if no FR in progress skip destination that have
9587 * flight_size > cwnd.
9588 */
9589 if (net->flight_size >= net->cwnd) {
9590 continue;
9591 }
9592 } else {
9593 /*
9594 * Mark the destination net to have FR recovery
9595 * limits put on it.
9596 */
9597 *fr_done = 1;
9598 net->fast_retran_ip = 1;
9599 }
9600
9601 /*
9602 * if no AUTH is yet included and this chunk requires it,
9603 * make sure to account for it. We don't apply the size
9604 * until the AUTH chunk is actually added below in case
9605 * there is no room for this chunk.
9606 */
9607 if (data_auth_reqd && (auth == NULL)) {
9608 dmtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
9609 } else
9610 dmtu = 0;
9611
9612 if ((chk->send_size <= (mtu - dmtu)) ||
9613 (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) {
9614 /* ok we will add this one */
9615 if (data_auth_reqd) {
9616 if (auth == NULL) {
9617 m = sctp_add_auth_chunk(m,
9618 &endofchain,
9619 &auth,
9620 &auth_offset,
9621 stcb,
9622 SCTP_DATA);
9623 auth_keyid = chk->auth_keyid;
9624 override_ok = 0;
9625 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
9626 } else if (override_ok) {
9627 auth_keyid = chk->auth_keyid;
9628 override_ok = 0;
9629 } else if (chk->auth_keyid != auth_keyid) {
9630 /* different keyid, so done bundling */
9631 break;
9632 }
9633 }
9634 m = sctp_copy_mbufchain(chk->data, m, &endofchain, 0, chk->send_size, chk->copy_by_ref);
9635 if (m == NULL) {
9636 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
9637 return (ENOMEM);
9638 }
9639 /* Do clear IP_DF ? */
9640 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
9641 no_fragmentflg = 0;
9642 }
9643 /* update our MTU size */
9644 if (mtu > (chk->send_size + dmtu))
9645 mtu -= (chk->send_size + dmtu);
9646 else
9647 mtu = 0;
9648 data_list[bundle_at++] = chk;
9649 if (one_chunk && (asoc->total_flight <= 0)) {
9650 SCTP_STAT_INCR(sctps_windowprobed);
9651 }
9652 }
9653 if (one_chunk == 0) {
9654 /*
9655 * now are there anymore forward from chk to pick
9656 * up?
9657 */
9658 for (fwd = TAILQ_NEXT(chk, sctp_next); fwd != NULL; fwd = TAILQ_NEXT(fwd, sctp_next)) {
9659 if (fwd->sent != SCTP_DATAGRAM_RESEND) {
9660 /* Nope, not for retran */
9661 continue;
9662 }
9663 if (fwd->whoTo != net) {
9664 /* Nope, not the net in question */
9665 continue;
9666 }
9667 if (data_auth_reqd && (auth == NULL)) {
9668 dmtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
9669 } else
9670 dmtu = 0;
9671 if (fwd->send_size <= (mtu - dmtu)) {
9672 if (data_auth_reqd) {
9673 if (auth == NULL) {
9674 m = sctp_add_auth_chunk(m,
9675 &endofchain,
9676 &auth,
9677 &auth_offset,
9678 stcb,
9679 SCTP_DATA);
9680 auth_keyid = fwd->auth_keyid;
9681 override_ok = 0;
9682 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
9683 } else if (override_ok) {
9684 auth_keyid = fwd->auth_keyid;
9685 override_ok = 0;
9686 } else if (fwd->auth_keyid != auth_keyid) {
9687 /*
9688 * different keyid,
9689 * so done bundling
9690 */
9691 break;
9692 }
9693 }
9694 m = sctp_copy_mbufchain(fwd->data, m, &endofchain, 0, fwd->send_size, fwd->copy_by_ref);
9695 if (m == NULL) {
9696 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
9697 return (ENOMEM);
9698 }
9699 /* Do clear IP_DF ? */
9700 if (fwd->flags & CHUNK_FLAGS_FRAGMENT_OK) {
9701 no_fragmentflg = 0;
9702 }
9703 /* update our MTU size */
9704 if (mtu > (fwd->send_size + dmtu))
9705 mtu -= (fwd->send_size + dmtu);
9706 else
9707 mtu = 0;
9708 data_list[bundle_at++] = fwd;
9709 if (bundle_at >= SCTP_MAX_DATA_BUNDLING) {
9710 break;
9711 }
9712 } else {
9713 /* can't fit so we are done */
9714 break;
9715 }
9716 }
9717 }
9718 /* Is there something to send for this destination? */
9719 if (m) {
9720 /*
9721 * No matter if we fail/or succeed we should start a
9722 * timer. A failure is like a lost IP packet :-)
9723 */
9724 if (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
9725 /*
9726 * no timer running on this destination
9727 * restart it.
9728 */
9729 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
9730 tmr_started = 1;
9731 }
9732 /* Now lets send it, if there is anything to send :> */
9733 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
9734 (struct sockaddr *)&net->ro._l_addr, m,
9735 auth_offset, auth, auth_keyid,
9736 no_fragmentflg, 0, 0,
9737 inp->sctp_lport, stcb->rport, htonl(stcb->asoc.peer_vtag),
9738 net->port, NULL,
9739 0, 0,
9740 so_locked))) {
9741 /* error, we could not output */
9742 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
9743 if (error == ENOBUFS) {
9744 asoc->ifp_had_enobuf = 1;
9745 SCTP_STAT_INCR(sctps_lowlevelerr);
9746 }
9747 return (error);
9748 } else {
9749 asoc->ifp_had_enobuf = 0;
9750 }
9751 endofchain = NULL;
9752 auth = NULL;
9753 auth_offset = 0;
9754 /* For HB's */
9755 /*
9756 * We don't want to mark the net->sent time here
9757 * since this we use this for HB and retrans cannot
9758 * measure RTT
9759 */
9760 /* (void)SCTP_GETTIME_TIMEVAL(&net->last_sent_time); */
9761
9762 /* For auto-close */
9763 if (*now_filled == 0) {
9764 (void)SCTP_GETTIME_TIMEVAL(&asoc->time_last_sent);
9765 *now = asoc->time_last_sent;
9766 *now_filled = 1;
9767 } else {
9768 asoc->time_last_sent = *now;
9769 }
9770 *cnt_out += bundle_at;
9771 #ifdef SCTP_AUDITING_ENABLED
9772 sctp_audit_log(0xC4, bundle_at);
9773 #endif
9774 if (bundle_at) {
9775 tsns_sent = data_list[0]->rec.data.tsn;
9776 }
9777 for (i = 0; i < bundle_at; i++) {
9778 SCTP_STAT_INCR(sctps_sendretransdata);
9779 data_list[i]->sent = SCTP_DATAGRAM_SENT;
9780 /*
9781 * When we have a revoked data, and we
9782 * retransmit it, then we clear the revoked
9783 * flag since this flag dictates if we
9784 * subtracted from the fs
9785 */
9786 if (data_list[i]->rec.data.chunk_was_revoked) {
9787 /* Deflate the cwnd */
9788 data_list[i]->whoTo->cwnd -= data_list[i]->book_size;
9789 data_list[i]->rec.data.chunk_was_revoked = 0;
9790 }
9791 data_list[i]->snd_count++;
9792 sctp_ucount_decr(asoc->sent_queue_retran_cnt);
9793 /* record the time */
9794 data_list[i]->sent_rcv_time = asoc->time_last_sent;
9795 if (data_list[i]->book_size_scale) {
9796 /*
9797 * need to double the book size on
9798 * this one
9799 */
9800 data_list[i]->book_size_scale = 0;
9801 /*
9802 * Since we double the booksize, we
9803 * must also double the output queue
9804 * size, since this get shrunk when
9805 * we free by this amount.
9806 */
9807 atomic_add_int(&((asoc)->total_output_queue_size), data_list[i]->book_size);
9808 data_list[i]->book_size *= 2;
9809 } else {
9810 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_RWND_ENABLE) {
9811 sctp_log_rwnd(SCTP_DECREASE_PEER_RWND,
9812 asoc->peers_rwnd, data_list[i]->send_size, SCTP_BASE_SYSCTL(sctp_peer_chunk_oh));
9813 }
9814 asoc->peers_rwnd = sctp_sbspace_sub(asoc->peers_rwnd,
9815 (uint32_t)(data_list[i]->send_size +
9816 SCTP_BASE_SYSCTL(sctp_peer_chunk_oh)));
9817 }
9818 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
9819 sctp_misc_ints(SCTP_FLIGHT_LOG_UP_RSND,
9820 data_list[i]->whoTo->flight_size,
9821 data_list[i]->book_size,
9822 (uint32_t)(uintptr_t)data_list[i]->whoTo,
9823 data_list[i]->rec.data.tsn);
9824 }
9825 sctp_flight_size_increase(data_list[i]);
9826 sctp_total_flight_increase(stcb, data_list[i]);
9827 if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
9828 /* SWS sender side engages */
9829 asoc->peers_rwnd = 0;
9830 }
9831 if ((i == 0) &&
9832 (data_list[i]->rec.data.doing_fast_retransmit)) {
9833 SCTP_STAT_INCR(sctps_sendfastretrans);
9834 if ((data_list[i] == TAILQ_FIRST(&asoc->sent_queue)) &&
9835 (tmr_started == 0)) {
9836 /*-
9837 * ok we just fast-retrans'd
9838 * the lowest TSN, i.e the
9839 * first on the list. In
9840 * this case we want to give
9841 * some more time to get a
9842 * SACK back without a
9843 * t3-expiring.
9844 */
9845 sctp_timer_stop(SCTP_TIMER_TYPE_SEND, inp, stcb, net,
9846 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_2);
9847 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
9848 }
9849 }
9850 }
9851 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
9852 sctp_log_cwnd(stcb, net, tsns_sent, SCTP_CWND_LOG_FROM_RESEND);
9853 }
9854 #ifdef SCTP_AUDITING_ENABLED
9855 sctp_auditing(21, inp, stcb, NULL);
9856 #endif
9857 } else {
9858 /* None will fit */
9859 return (1);
9860 }
9861 if (asoc->sent_queue_retran_cnt <= 0) {
9862 /* all done we have no more to retran */
9863 asoc->sent_queue_retran_cnt = 0;
9864 break;
9865 }
9866 if (one_chunk) {
9867 /* No more room in rwnd */
9868 return (1);
9869 }
9870 /* stop the for loop here. we sent out a packet */
9871 break;
9872 }
9873 return (0);
9874 }
9875
9876 static void
9877 sctp_timer_validation(struct sctp_inpcb *inp,
9878 struct sctp_tcb *stcb,
9879 struct sctp_association *asoc)
9880 {
9881 struct sctp_nets *net;
9882
9883 /* Validate that a timer is running somewhere */
9884 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
9885 if (SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
9886 /* Here is a timer */
9887 return;
9888 }
9889 }
9890 SCTP_TCB_LOCK_ASSERT(stcb);
9891 /* Gak, we did not have a timer somewhere */
9892 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Deadlock avoided starting timer on a dest at retran\n");
9893 if (asoc->alternate) {
9894 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, asoc->alternate);
9895 } else {
9896 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, asoc->primary_destination);
9897 }
9898 return;
9899 }
9900
9901 void
9902 sctp_chunk_output(struct sctp_inpcb *inp,
9903 struct sctp_tcb *stcb,
9904 int from_where,
9905 int so_locked)
9906 {
9907 /*-
9908 * Ok this is the generic chunk service queue. we must do the
9909 * following:
9910 * - See if there are retransmits pending, if so we must
9911 * do these first.
9912 * - Service the stream queue that is next, moving any
9913 * message (note I must get a complete message i.e.
9914 * FIRST/MIDDLE and LAST to the out queue in one pass) and assigning
9915 * TSN's
9916 * - Check to see if the cwnd/rwnd allows any output, if so we
9917 * go ahead and formulate and send the low level chunks. Making sure
9918 * to combine any control in the control chunk queue also.
9919 */
9920 struct sctp_association *asoc;
9921 struct sctp_nets *net;
9922 int error = 0, num_out, tot_out = 0, ret = 0, reason_code;
9923 unsigned int burst_cnt = 0;
9924 struct timeval now;
9925 int now_filled = 0;
9926 int nagle_on;
9927 uint32_t frag_point = sctp_get_frag_point(stcb);
9928 int un_sent = 0;
9929 int fr_done;
9930 unsigned int tot_frs = 0;
9931
9932 asoc = &stcb->asoc;
9933 do_it_again:
9934 /* The Nagle algorithm is only applied when handling a send call. */
9935 if (from_where == SCTP_OUTPUT_FROM_USR_SEND) {
9936 if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_NODELAY)) {
9937 nagle_on = 0;
9938 } else {
9939 nagle_on = 1;
9940 }
9941 } else {
9942 nagle_on = 0;
9943 }
9944 SCTP_TCB_LOCK_ASSERT(stcb);
9945
9946 un_sent = (stcb->asoc.total_output_queue_size - stcb->asoc.total_flight);
9947
9948 if ((un_sent <= 0) &&
9949 (TAILQ_EMPTY(&asoc->control_send_queue)) &&
9950 (TAILQ_EMPTY(&asoc->asconf_send_queue)) &&
9951 (asoc->sent_queue_retran_cnt == 0) &&
9952 (asoc->trigger_reset == 0)) {
9953 /* Nothing to do unless there is something to be sent left */
9954 return;
9955 }
9956 /*
9957 * Do we have something to send, data or control AND a sack timer
9958 * running, if so piggy-back the sack.
9959 */
9960 if (SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
9961 sctp_send_sack(stcb, so_locked);
9962 sctp_timer_stop(SCTP_TIMER_TYPE_RECV, stcb->sctp_ep, stcb, NULL,
9963 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_3);
9964 }
9965 while (asoc->sent_queue_retran_cnt) {
9966 /*-
9967 * Ok, it is retransmission time only, we send out only ONE
9968 * packet with a single call off to the retran code.
9969 */
9970 if (from_where == SCTP_OUTPUT_FROM_COOKIE_ACK) {
9971 /*-
9972 * Special hook for handling cookies discarded
9973 * by peer that carried data. Send cookie-ack only
9974 * and then the next call with get the retran's.
9975 */
9976 (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1,
9977 from_where,
9978 &now, &now_filled, frag_point, so_locked);
9979 return;
9980 } else if (from_where != SCTP_OUTPUT_FROM_HB_TMR) {
9981 /* if its not from a HB then do it */
9982 fr_done = 0;
9983 ret = sctp_chunk_retransmission(inp, stcb, asoc, &num_out, &now, &now_filled, &fr_done, so_locked);
9984 if (fr_done) {
9985 tot_frs++;
9986 }
9987 } else {
9988 /*
9989 * its from any other place, we don't allow retran
9990 * output (only control)
9991 */
9992 ret = 1;
9993 }
9994 if (ret > 0) {
9995 /* Can't send anymore */
9996 /*-
9997 * now lets push out control by calling med-level
9998 * output once. this assures that we WILL send HB's
9999 * if queued too.
10000 */
10001 (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1,
10002 from_where,
10003 &now, &now_filled, frag_point, so_locked);
10004 #ifdef SCTP_AUDITING_ENABLED
10005 sctp_auditing(8, inp, stcb, NULL);
10006 #endif
10007 sctp_timer_validation(inp, stcb, asoc);
10008 return;
10009 }
10010 if (ret < 0) {
10011 /*-
10012 * The count was off.. retran is not happening so do
10013 * the normal retransmission.
10014 */
10015 #ifdef SCTP_AUDITING_ENABLED
10016 sctp_auditing(9, inp, stcb, NULL);
10017 #endif
10018 if (ret == SCTP_RETRAN_EXIT) {
10019 return;
10020 }
10021 break;
10022 }
10023 if (from_where == SCTP_OUTPUT_FROM_T3) {
10024 /* Only one transmission allowed out of a timeout */
10025 #ifdef SCTP_AUDITING_ENABLED
10026 sctp_auditing(10, inp, stcb, NULL);
10027 #endif
10028 /* Push out any control */
10029 (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1, from_where,
10030 &now, &now_filled, frag_point, so_locked);
10031 return;
10032 }
10033 if ((asoc->fr_max_burst > 0) && (tot_frs >= asoc->fr_max_burst)) {
10034 /* Hit FR burst limit */
10035 return;
10036 }
10037 if ((num_out == 0) && (ret == 0)) {
10038 /* No more retrans to send */
10039 break;
10040 }
10041 }
10042 #ifdef SCTP_AUDITING_ENABLED
10043 sctp_auditing(12, inp, stcb, NULL);
10044 #endif
10045 /* Check for bad destinations, if they exist move chunks around. */
10046 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
10047 if ((net->dest_state & SCTP_ADDR_REACHABLE) == 0) {
10048 /*-
10049 * if possible move things off of this address we
10050 * still may send below due to the dormant state but
10051 * we try to find an alternate address to send to
10052 * and if we have one we move all queued data on the
10053 * out wheel to this alternate address.
10054 */
10055 if (net->ref_count > 1)
10056 sctp_move_chunks_from_net(stcb, net);
10057 } else {
10058 /*-
10059 * if ((asoc->sat_network) || (net->addr_is_local))
10060 * { burst_limit = asoc->max_burst *
10061 * SCTP_SAT_NETWORK_BURST_INCR; }
10062 */
10063 if (asoc->max_burst > 0) {
10064 if (SCTP_BASE_SYSCTL(sctp_use_cwnd_based_maxburst)) {
10065 if ((net->flight_size + (asoc->max_burst * net->mtu)) < net->cwnd) {
10066 /*
10067 * JRS - Use the congestion
10068 * control given in the
10069 * congestion control module
10070 */
10071 asoc->cc_functions.sctp_cwnd_update_after_output(stcb, net, asoc->max_burst);
10072 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_MAXBURST_ENABLE) {
10073 sctp_log_maxburst(stcb, net, 0, asoc->max_burst, SCTP_MAX_BURST_APPLIED);
10074 }
10075 SCTP_STAT_INCR(sctps_maxburstqueued);
10076 }
10077 net->fast_retran_ip = 0;
10078 } else {
10079 if (net->flight_size == 0) {
10080 /*
10081 * Should be decaying the
10082 * cwnd here
10083 */
10084 ;
10085 }
10086 }
10087 }
10088 }
10089 }
10090 burst_cnt = 0;
10091 do {
10092 error = sctp_med_chunk_output(inp, stcb, asoc, &num_out,
10093 &reason_code, 0, from_where,
10094 &now, &now_filled, frag_point, so_locked);
10095 if (error) {
10096 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Error %d was returned from med-c-op\n", error);
10097 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_MAXBURST_ENABLE) {
10098 sctp_log_maxburst(stcb, asoc->primary_destination, error, burst_cnt, SCTP_MAX_BURST_ERROR_STOP);
10099 }
10100 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
10101 sctp_log_cwnd(stcb, NULL, error, SCTP_SEND_NOW_COMPLETES);
10102 sctp_log_cwnd(stcb, NULL, 0xdeadbeef, SCTP_SEND_NOW_COMPLETES);
10103 }
10104 break;
10105 }
10106 SCTPDBG(SCTP_DEBUG_OUTPUT3, "m-c-o put out %d\n", num_out);
10107
10108 tot_out += num_out;
10109 burst_cnt++;
10110 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
10111 sctp_log_cwnd(stcb, NULL, num_out, SCTP_SEND_NOW_COMPLETES);
10112 if (num_out == 0) {
10113 sctp_log_cwnd(stcb, NULL, reason_code, SCTP_SEND_NOW_COMPLETES);
10114 }
10115 }
10116 if (nagle_on) {
10117 /*
10118 * When the Nagle algorithm is used, look at how
10119 * much is unsent, then if its smaller than an MTU
10120 * and we have data in flight we stop, except if we
10121 * are handling a fragmented user message.
10122 */
10123 un_sent = stcb->asoc.total_output_queue_size - stcb->asoc.total_flight;
10124 if ((un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD)) &&
10125 (stcb->asoc.total_flight > 0)) {
10126 /* && sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXPLICIT_EOR))) {*/
10127 break;
10128 }
10129 }
10130 if (TAILQ_EMPTY(&asoc->control_send_queue) &&
10131 TAILQ_EMPTY(&asoc->send_queue) &&
10132 sctp_is_there_unsent_data(stcb, so_locked) == 0) {
10133 /* Nothing left to send */
10134 break;
10135 }
10136 if ((stcb->asoc.total_output_queue_size - stcb->asoc.total_flight) <= 0) {
10137 /* Nothing left to send */
10138 break;
10139 }
10140 } while (num_out &&
10141 ((asoc->max_burst == 0) ||
10142 SCTP_BASE_SYSCTL(sctp_use_cwnd_based_maxburst) ||
10143 (burst_cnt < asoc->max_burst)));
10144
10145 if (SCTP_BASE_SYSCTL(sctp_use_cwnd_based_maxburst) == 0) {
10146 if ((asoc->max_burst > 0) && (burst_cnt >= asoc->max_burst)) {
10147 SCTP_STAT_INCR(sctps_maxburstqueued);
10148 asoc->burst_limit_applied = 1;
10149 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_MAXBURST_ENABLE) {
10150 sctp_log_maxburst(stcb, asoc->primary_destination, 0, burst_cnt, SCTP_MAX_BURST_APPLIED);
10151 }
10152 } else {
10153 asoc->burst_limit_applied = 0;
10154 }
10155 }
10156 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
10157 sctp_log_cwnd(stcb, NULL, tot_out, SCTP_SEND_NOW_COMPLETES);
10158 }
10159 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Ok, we have put out %d chunks\n",
10160 tot_out);
10161
10162 /*-
10163 * Now we need to clean up the control chunk chain if a ECNE is on
10164 * it. It must be marked as UNSENT again so next call will continue
10165 * to send it until such time that we get a CWR, to remove it.
10166 */
10167 if (stcb->asoc.ecn_echo_cnt_onq)
10168 sctp_fix_ecn_echo(asoc);
10169
10170 if (stcb->asoc.trigger_reset) {
10171 if (sctp_send_stream_reset_out_if_possible(stcb, so_locked) == 0) {
10172 goto do_it_again;
10173 }
10174 }
10175 return;
10176 }
10177
10178 int
10179 sctp_output(
10180 struct sctp_inpcb *inp,
10181 struct mbuf *m,
10182 struct sockaddr *addr,
10183 struct mbuf *control,
10184 struct thread *p,
10185 int flags)
10186 {
10187 if (inp == NULL) {
10188 SCTP_LTRACE_ERR_RET_PKT(m, inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
10189 return (EINVAL);
10190 }
10191
10192 if (inp->sctp_socket == NULL) {
10193 SCTP_LTRACE_ERR_RET_PKT(m, inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
10194 return (EINVAL);
10195 }
10196 return (sctp_sosend(inp->sctp_socket,
10197 addr,
10198 (struct uio *)NULL,
10199 m,
10200 control,
10201 flags, p
10202 ));
10203 }
10204
10205 void
10206 send_forward_tsn(struct sctp_tcb *stcb,
10207 struct sctp_association *asoc)
10208 {
10209 struct sctp_tmit_chunk *chk, *at, *tp1, *last;
10210 struct sctp_forward_tsn_chunk *fwdtsn;
10211 struct sctp_strseq *strseq;
10212 struct sctp_strseq_mid *strseq_m;
10213 uint32_t advance_peer_ack_point;
10214 unsigned int cnt_of_space, i, ovh;
10215 unsigned int space_needed;
10216 unsigned int cnt_of_skipped = 0;
10217
10218 SCTP_TCB_LOCK_ASSERT(stcb);
10219 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
10220 if (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) {
10221 /* mark it to unsent */
10222 chk->sent = SCTP_DATAGRAM_UNSENT;
10223 chk->snd_count = 0;
10224 /* Do we correct its output location? */
10225 if (chk->whoTo) {
10226 sctp_free_remote_addr(chk->whoTo);
10227 chk->whoTo = NULL;
10228 }
10229 goto sctp_fill_in_rest;
10230 }
10231 }
10232 /* Ok if we reach here we must build one */
10233 sctp_alloc_a_chunk(stcb, chk);
10234 if (chk == NULL) {
10235 return;
10236 }
10237 asoc->fwd_tsn_cnt++;
10238 chk->copy_by_ref = 0;
10239 /*
10240 * We don't do the old thing here since this is used not for on-wire
10241 * but to tell if we are sending a fwd-tsn by the stack during
10242 * output. And if its a IFORWARD or a FORWARD it is a fwd-tsn.
10243 */
10244 chk->rec.chunk_id.id = SCTP_FORWARD_CUM_TSN;
10245 chk->rec.chunk_id.can_take_data = 0;
10246 chk->flags = 0;
10247 chk->asoc = asoc;
10248 chk->whoTo = NULL;
10249 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
10250 if (chk->data == NULL) {
10251 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
10252 return;
10253 }
10254 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
10255 chk->sent = SCTP_DATAGRAM_UNSENT;
10256 chk->snd_count = 0;
10257 TAILQ_INSERT_TAIL(&asoc->control_send_queue, chk, sctp_next);
10258 asoc->ctrl_queue_cnt++;
10259 sctp_fill_in_rest:
10260 /*-
10261 * Here we go through and fill out the part that deals with
10262 * stream/seq of the ones we skip.
10263 */
10264 SCTP_BUF_LEN(chk->data) = 0;
10265 TAILQ_FOREACH(at, &asoc->sent_queue, sctp_next) {
10266 if ((at->sent != SCTP_FORWARD_TSN_SKIP) &&
10267 (at->sent != SCTP_DATAGRAM_NR_ACKED)) {
10268 /* no more to look at */
10269 break;
10270 }
10271 if (!asoc->idata_supported && (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED)) {
10272 /* We don't report these */
10273 continue;
10274 }
10275 cnt_of_skipped++;
10276 }
10277 if (asoc->idata_supported) {
10278 space_needed = (sizeof(struct sctp_forward_tsn_chunk) +
10279 (cnt_of_skipped * sizeof(struct sctp_strseq_mid)));
10280 } else {
10281 space_needed = (sizeof(struct sctp_forward_tsn_chunk) +
10282 (cnt_of_skipped * sizeof(struct sctp_strseq)));
10283 }
10284 cnt_of_space = (unsigned int)M_TRAILINGSPACE(chk->data);
10285
10286 if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
10287 ovh = SCTP_MIN_OVERHEAD;
10288 } else {
10289 ovh = SCTP_MIN_V4_OVERHEAD;
10290 }
10291 if (cnt_of_space > (asoc->smallest_mtu - ovh)) {
10292 /* trim to a mtu size */
10293 cnt_of_space = asoc->smallest_mtu - ovh;
10294 }
10295 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
10296 sctp_misc_ints(SCTP_FWD_TSN_CHECK,
10297 0xff, 0, cnt_of_skipped,
10298 asoc->advanced_peer_ack_point);
10299 }
10300 advance_peer_ack_point = asoc->advanced_peer_ack_point;
10301 if (cnt_of_space < space_needed) {
10302 /*-
10303 * ok we must trim down the chunk by lowering the
10304 * advance peer ack point.
10305 */
10306 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
10307 sctp_misc_ints(SCTP_FWD_TSN_CHECK,
10308 0xff, 0xff, cnt_of_space,
10309 space_needed);
10310 }
10311 cnt_of_skipped = cnt_of_space - sizeof(struct sctp_forward_tsn_chunk);
10312 if (asoc->idata_supported) {
10313 cnt_of_skipped /= sizeof(struct sctp_strseq_mid);
10314 } else {
10315 cnt_of_skipped /= sizeof(struct sctp_strseq);
10316 }
10317 /*-
10318 * Go through and find the TSN that will be the one
10319 * we report.
10320 */
10321 at = TAILQ_FIRST(&asoc->sent_queue);
10322 if (at != NULL) {
10323 for (i = 0; i < cnt_of_skipped; i++) {
10324 tp1 = TAILQ_NEXT(at, sctp_next);
10325 if (tp1 == NULL) {
10326 break;
10327 }
10328 at = tp1;
10329 }
10330 }
10331 if (at && SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
10332 sctp_misc_ints(SCTP_FWD_TSN_CHECK,
10333 0xff, cnt_of_skipped, at->rec.data.tsn,
10334 asoc->advanced_peer_ack_point);
10335 }
10336 last = at;
10337 /*-
10338 * last now points to last one I can report, update
10339 * peer ack point
10340 */
10341 if (last) {
10342 advance_peer_ack_point = last->rec.data.tsn;
10343 }
10344 if (asoc->idata_supported) {
10345 space_needed = sizeof(struct sctp_forward_tsn_chunk) +
10346 cnt_of_skipped * sizeof(struct sctp_strseq_mid);
10347 } else {
10348 space_needed = sizeof(struct sctp_forward_tsn_chunk) +
10349 cnt_of_skipped * sizeof(struct sctp_strseq);
10350 }
10351 }
10352 chk->send_size = space_needed;
10353 /* Setup the chunk */
10354 fwdtsn = mtod(chk->data, struct sctp_forward_tsn_chunk *);
10355 fwdtsn->ch.chunk_length = htons(chk->send_size);
10356 fwdtsn->ch.chunk_flags = 0;
10357 if (asoc->idata_supported) {
10358 fwdtsn->ch.chunk_type = SCTP_IFORWARD_CUM_TSN;
10359 } else {
10360 fwdtsn->ch.chunk_type = SCTP_FORWARD_CUM_TSN;
10361 }
10362 fwdtsn->new_cumulative_tsn = htonl(advance_peer_ack_point);
10363 SCTP_BUF_LEN(chk->data) = chk->send_size;
10364 fwdtsn++;
10365 /*-
10366 * Move pointer to after the fwdtsn and transfer to the
10367 * strseq pointer.
10368 */
10369 if (asoc->idata_supported) {
10370 strseq_m = (struct sctp_strseq_mid *)fwdtsn;
10371 strseq = NULL;
10372 } else {
10373 strseq = (struct sctp_strseq *)fwdtsn;
10374 strseq_m = NULL;
10375 }
10376 /*-
10377 * Now populate the strseq list. This is done blindly
10378 * without pulling out duplicate stream info. This is
10379 * inefficient but won't harm the process since the peer will
10380 * look at these in sequence and will thus release anything.
10381 * It could mean we exceed the PMTU and chop off some that
10382 * we could have included.. but this is unlikely (aka 1432/4
10383 * would mean 300+ stream seq's would have to be reported in
10384 * one FWD-TSN. With a bit of work we can later FIX this to
10385 * optimize and pull out duplicates.. but it does add more
10386 * overhead. So for now... not!
10387 */
10388 i = 0;
10389 TAILQ_FOREACH(at, &asoc->sent_queue, sctp_next) {
10390 if (i >= cnt_of_skipped) {
10391 break;
10392 }
10393 if (!asoc->idata_supported && (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED)) {
10394 /* We don't report these */
10395 continue;
10396 }
10397 if (at->rec.data.tsn == advance_peer_ack_point) {
10398 at->rec.data.fwd_tsn_cnt = 0;
10399 }
10400 if (asoc->idata_supported) {
10401 strseq_m->sid = htons(at->rec.data.sid);
10402 if (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED) {
10403 strseq_m->flags = htons(PR_SCTP_UNORDERED_FLAG);
10404 } else {
10405 strseq_m->flags = 0;
10406 }
10407 strseq_m->mid = htonl(at->rec.data.mid);
10408 strseq_m++;
10409 } else {
10410 strseq->sid = htons(at->rec.data.sid);
10411 strseq->ssn = htons((uint16_t)at->rec.data.mid);
10412 strseq++;
10413 }
10414 i++;
10415 }
10416 return;
10417 }
10418
10419 void
10420 sctp_send_sack(struct sctp_tcb *stcb, int so_locked)
10421 {
10422 /*-
10423 * Queue up a SACK or NR-SACK in the control queue.
10424 * We must first check to see if a SACK or NR-SACK is
10425 * somehow on the control queue.
10426 * If so, we will take and and remove the old one.
10427 */
10428 struct sctp_association *asoc;
10429 struct sctp_tmit_chunk *chk, *a_chk;
10430 struct sctp_sack_chunk *sack;
10431 struct sctp_nr_sack_chunk *nr_sack;
10432 struct sctp_gap_ack_block *gap_descriptor;
10433 const struct sack_track *selector;
10434 int mergeable = 0;
10435 int offset;
10436 caddr_t limit;
10437 uint32_t *dup;
10438 int limit_reached = 0;
10439 unsigned int i, siz, j;
10440 unsigned int num_gap_blocks = 0, num_nr_gap_blocks = 0, space;
10441 int num_dups = 0;
10442 int space_req;
10443 uint32_t highest_tsn;
10444 uint8_t flags;
10445 uint8_t type;
10446 uint8_t tsn_map;
10447
10448 if (stcb->asoc.nrsack_supported == 1) {
10449 type = SCTP_NR_SELECTIVE_ACK;
10450 } else {
10451 type = SCTP_SELECTIVE_ACK;
10452 }
10453 a_chk = NULL;
10454 asoc = &stcb->asoc;
10455 SCTP_TCB_LOCK_ASSERT(stcb);
10456 if (asoc->last_data_chunk_from == NULL) {
10457 /* Hmm we never received anything */
10458 return;
10459 }
10460 sctp_slide_mapping_arrays(stcb);
10461 sctp_set_rwnd(stcb, asoc);
10462 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
10463 if (chk->rec.chunk_id.id == type) {
10464 /* Hmm, found a sack already on queue, remove it */
10465 TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next);
10466 asoc->ctrl_queue_cnt--;
10467 a_chk = chk;
10468 if (a_chk->data) {
10469 sctp_m_freem(a_chk->data);
10470 a_chk->data = NULL;
10471 }
10472 if (a_chk->whoTo) {
10473 sctp_free_remote_addr(a_chk->whoTo);
10474 a_chk->whoTo = NULL;
10475 }
10476 break;
10477 }
10478 }
10479 if (a_chk == NULL) {
10480 sctp_alloc_a_chunk(stcb, a_chk);
10481 if (a_chk == NULL) {
10482 /* No memory so we drop the idea, and set a timer */
10483 if (stcb->asoc.delayed_ack) {
10484 sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
10485 stcb->sctp_ep, stcb, NULL,
10486 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_4);
10487 sctp_timer_start(SCTP_TIMER_TYPE_RECV,
10488 stcb->sctp_ep, stcb, NULL);
10489 } else {
10490 stcb->asoc.send_sack = 1;
10491 }
10492 return;
10493 }
10494 a_chk->copy_by_ref = 0;
10495 a_chk->rec.chunk_id.id = type;
10496 a_chk->rec.chunk_id.can_take_data = 1;
10497 }
10498 /* Clear our pkt counts */
10499 asoc->data_pkts_seen = 0;
10500
10501 a_chk->flags = 0;
10502 a_chk->asoc = asoc;
10503 a_chk->snd_count = 0;
10504 a_chk->send_size = 0; /* fill in later */
10505 a_chk->sent = SCTP_DATAGRAM_UNSENT;
10506 a_chk->whoTo = NULL;
10507
10508 if ((asoc->last_data_chunk_from->dest_state & SCTP_ADDR_REACHABLE) == 0) {
10509 /*-
10510 * Ok, the destination for the SACK is unreachable, lets see if
10511 * we can select an alternate to asoc->last_data_chunk_from
10512 */
10513 a_chk->whoTo = sctp_find_alternate_net(stcb, asoc->last_data_chunk_from, 0);
10514 if (a_chk->whoTo == NULL) {
10515 /* Nope, no alternate */
10516 a_chk->whoTo = asoc->last_data_chunk_from;
10517 }
10518 } else {
10519 a_chk->whoTo = asoc->last_data_chunk_from;
10520 }
10521 if (a_chk->whoTo) {
10522 atomic_add_int(&a_chk->whoTo->ref_count, 1);
10523 }
10524 if (SCTP_TSN_GT(asoc->highest_tsn_inside_map, asoc->highest_tsn_inside_nr_map)) {
10525 highest_tsn = asoc->highest_tsn_inside_map;
10526 } else {
10527 highest_tsn = asoc->highest_tsn_inside_nr_map;
10528 }
10529 if (highest_tsn == asoc->cumulative_tsn) {
10530 /* no gaps */
10531 if (type == SCTP_SELECTIVE_ACK) {
10532 space_req = sizeof(struct sctp_sack_chunk);
10533 } else {
10534 space_req = sizeof(struct sctp_nr_sack_chunk);
10535 }
10536 } else {
10537 /* gaps get a cluster */
10538 space_req = MCLBYTES;
10539 }
10540 /* Ok now lets formulate a MBUF with our sack */
10541 a_chk->data = sctp_get_mbuf_for_msg(space_req, 0, M_NOWAIT, 1, MT_DATA);
10542 if ((a_chk->data == NULL) ||
10543 (a_chk->whoTo == NULL)) {
10544 /* rats, no mbuf memory */
10545 if (a_chk->data) {
10546 /* was a problem with the destination */
10547 sctp_m_freem(a_chk->data);
10548 a_chk->data = NULL;
10549 }
10550 sctp_free_a_chunk(stcb, a_chk, so_locked);
10551 /* sa_ignore NO_NULL_CHK */
10552 if (stcb->asoc.delayed_ack) {
10553 sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
10554 stcb->sctp_ep, stcb, NULL,
10555 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_5);
10556 sctp_timer_start(SCTP_TIMER_TYPE_RECV,
10557 stcb->sctp_ep, stcb, NULL);
10558 } else {
10559 stcb->asoc.send_sack = 1;
10560 }
10561 return;
10562 }
10563 /* ok, lets go through and fill it in */
10564 SCTP_BUF_RESV_UF(a_chk->data, SCTP_MIN_OVERHEAD);
10565 space = (unsigned int)M_TRAILINGSPACE(a_chk->data);
10566 if (space > (a_chk->whoTo->mtu - SCTP_MIN_OVERHEAD)) {
10567 space = (a_chk->whoTo->mtu - SCTP_MIN_OVERHEAD);
10568 }
10569 limit = mtod(a_chk->data, caddr_t);
10570 limit += space;
10571
10572 flags = 0;
10573
10574 if ((asoc->sctp_cmt_on_off > 0) &&
10575 SCTP_BASE_SYSCTL(sctp_cmt_use_dac)) {
10576 /*-
10577 * CMT DAC algorithm: If 2 (i.e., 0x10) packets have been
10578 * received, then set high bit to 1, else 0. Reset
10579 * pkts_rcvd.
10580 */
10581 flags |= (asoc->cmt_dac_pkts_rcvd << 6);
10582 asoc->cmt_dac_pkts_rcvd = 0;
10583 }
10584 #ifdef SCTP_ASOCLOG_OF_TSNS
10585 stcb->asoc.cumack_logsnt[stcb->asoc.cumack_log_atsnt] = asoc->cumulative_tsn;
10586 stcb->asoc.cumack_log_atsnt++;
10587 if (stcb->asoc.cumack_log_atsnt >= SCTP_TSN_LOG_SIZE) {
10588 stcb->asoc.cumack_log_atsnt = 0;
10589 }
10590 #endif
10591 /* reset the readers interpretation */
10592 stcb->freed_by_sorcv_sincelast = 0;
10593
10594 if (type == SCTP_SELECTIVE_ACK) {
10595 sack = mtod(a_chk->data, struct sctp_sack_chunk *);
10596 nr_sack = NULL;
10597 gap_descriptor = (struct sctp_gap_ack_block *)((caddr_t)sack + sizeof(struct sctp_sack_chunk));
10598 if (highest_tsn > asoc->mapping_array_base_tsn) {
10599 siz = (((highest_tsn - asoc->mapping_array_base_tsn) + 1) + 7) / 8;
10600 } else {
10601 siz = (((MAX_TSN - asoc->mapping_array_base_tsn) + 1) + highest_tsn + 7) / 8;
10602 }
10603 } else {
10604 sack = NULL;
10605 nr_sack = mtod(a_chk->data, struct sctp_nr_sack_chunk *);
10606 gap_descriptor = (struct sctp_gap_ack_block *)((caddr_t)nr_sack + sizeof(struct sctp_nr_sack_chunk));
10607 if (asoc->highest_tsn_inside_map > asoc->mapping_array_base_tsn) {
10608 siz = (((asoc->highest_tsn_inside_map - asoc->mapping_array_base_tsn) + 1) + 7) / 8;
10609 } else {
10610 siz = (((MAX_TSN - asoc->mapping_array_base_tsn) + 1) + asoc->highest_tsn_inside_map + 7) / 8;
10611 }
10612 }
10613
10614 if (SCTP_TSN_GT(asoc->mapping_array_base_tsn, asoc->cumulative_tsn)) {
10615 offset = 1;
10616 } else {
10617 offset = asoc->mapping_array_base_tsn - asoc->cumulative_tsn;
10618 }
10619 if (((type == SCTP_SELECTIVE_ACK) &&
10620 SCTP_TSN_GT(highest_tsn, asoc->cumulative_tsn)) ||
10621 ((type == SCTP_NR_SELECTIVE_ACK) &&
10622 SCTP_TSN_GT(asoc->highest_tsn_inside_map, asoc->cumulative_tsn))) {
10623 /* we have a gap .. maybe */
10624 for (i = 0; i < siz; i++) {
10625 tsn_map = asoc->mapping_array[i];
10626 if (type == SCTP_SELECTIVE_ACK) {
10627 tsn_map |= asoc->nr_mapping_array[i];
10628 }
10629 if (i == 0) {
10630 /*
10631 * Clear all bits corresponding to TSNs
10632 * smaller or equal to the cumulative TSN.
10633 */
10634 tsn_map &= (~0U << (1 - offset));
10635 }
10636 selector = &sack_array[tsn_map];
10637 if (mergeable && selector->right_edge) {
10638 /*
10639 * Backup, left and right edges were ok to
10640 * merge.
10641 */
10642 num_gap_blocks--;
10643 gap_descriptor--;
10644 }
10645 if (selector->num_entries == 0)
10646 mergeable = 0;
10647 else {
10648 for (j = 0; j < selector->num_entries; j++) {
10649 if (mergeable && selector->right_edge) {
10650 /*
10651 * do a merge by NOT setting
10652 * the left side
10653 */
10654 mergeable = 0;
10655 } else {
10656 /*
10657 * no merge, set the left
10658 * side
10659 */
10660 mergeable = 0;
10661 gap_descriptor->start = htons((selector->gaps[j].start + offset));
10662 }
10663 gap_descriptor->end = htons((selector->gaps[j].end + offset));
10664 num_gap_blocks++;
10665 gap_descriptor++;
10666 if (((caddr_t)gap_descriptor + sizeof(struct sctp_gap_ack_block)) > limit) {
10667 /* no more room */
10668 limit_reached = 1;
10669 break;
10670 }
10671 }
10672 if (selector->left_edge) {
10673 mergeable = 1;
10674 }
10675 }
10676 if (limit_reached) {
10677 /* Reached the limit stop */
10678 break;
10679 }
10680 offset += 8;
10681 }
10682 }
10683 if ((type == SCTP_NR_SELECTIVE_ACK) &&
10684 (limit_reached == 0)) {
10685 mergeable = 0;
10686
10687 if (asoc->highest_tsn_inside_nr_map > asoc->mapping_array_base_tsn) {
10688 siz = (((asoc->highest_tsn_inside_nr_map - asoc->mapping_array_base_tsn) + 1) + 7) / 8;
10689 } else {
10690 siz = (((MAX_TSN - asoc->mapping_array_base_tsn) + 1) + asoc->highest_tsn_inside_nr_map + 7) / 8;
10691 }
10692
10693 if (SCTP_TSN_GT(asoc->mapping_array_base_tsn, asoc->cumulative_tsn)) {
10694 offset = 1;
10695 } else {
10696 offset = asoc->mapping_array_base_tsn - asoc->cumulative_tsn;
10697 }
10698 if (SCTP_TSN_GT(asoc->highest_tsn_inside_nr_map, asoc->cumulative_tsn)) {
10699 /* we have a gap .. maybe */
10700 for (i = 0; i < siz; i++) {
10701 tsn_map = asoc->nr_mapping_array[i];
10702 if (i == 0) {
10703 /*
10704 * Clear all bits corresponding to
10705 * TSNs smaller or equal to the
10706 * cumulative TSN.
10707 */
10708 tsn_map &= (~0U << (1 - offset));
10709 }
10710 selector = &sack_array[tsn_map];
10711 if (mergeable && selector->right_edge) {
10712 /*
10713 * Backup, left and right edges were
10714 * ok to merge.
10715 */
10716 num_nr_gap_blocks--;
10717 gap_descriptor--;
10718 }
10719 if (selector->num_entries == 0)
10720 mergeable = 0;
10721 else {
10722 for (j = 0; j < selector->num_entries; j++) {
10723 if (mergeable && selector->right_edge) {
10724 /*
10725 * do a merge by NOT
10726 * setting the left
10727 * side
10728 */
10729 mergeable = 0;
10730 } else {
10731 /*
10732 * no merge, set the
10733 * left side
10734 */
10735 mergeable = 0;
10736 gap_descriptor->start = htons((selector->gaps[j].start + offset));
10737 }
10738 gap_descriptor->end = htons((selector->gaps[j].end + offset));
10739 num_nr_gap_blocks++;
10740 gap_descriptor++;
10741 if (((caddr_t)gap_descriptor + sizeof(struct sctp_gap_ack_block)) > limit) {
10742 /* no more room */
10743 limit_reached = 1;
10744 break;
10745 }
10746 }
10747 if (selector->left_edge) {
10748 mergeable = 1;
10749 }
10750 }
10751 if (limit_reached) {
10752 /* Reached the limit stop */
10753 break;
10754 }
10755 offset += 8;
10756 }
10757 }
10758 }
10759 /* now we must add any dups we are going to report. */
10760 if ((limit_reached == 0) && (asoc->numduptsns)) {
10761 dup = (uint32_t *)gap_descriptor;
10762 for (i = 0; i < asoc->numduptsns; i++) {
10763 *dup = htonl(asoc->dup_tsns[i]);
10764 dup++;
10765 num_dups++;
10766 if (((caddr_t)dup + sizeof(uint32_t)) > limit) {
10767 /* no more room */
10768 break;
10769 }
10770 }
10771 asoc->numduptsns = 0;
10772 }
10773 /*
10774 * now that the chunk is prepared queue it to the control chunk
10775 * queue.
10776 */
10777 if (type == SCTP_SELECTIVE_ACK) {
10778 a_chk->send_size = (uint16_t)(sizeof(struct sctp_sack_chunk) +
10779 (num_gap_blocks + num_nr_gap_blocks) * sizeof(struct sctp_gap_ack_block) +
10780 num_dups * sizeof(int32_t));
10781 SCTP_BUF_LEN(a_chk->data) = a_chk->send_size;
10782 sack->sack.cum_tsn_ack = htonl(asoc->cumulative_tsn);
10783 sack->sack.a_rwnd = htonl(asoc->my_rwnd);
10784 sack->sack.num_gap_ack_blks = htons(num_gap_blocks);
10785 sack->sack.num_dup_tsns = htons(num_dups);
10786 sack->ch.chunk_type = type;
10787 sack->ch.chunk_flags = flags;
10788 sack->ch.chunk_length = htons(a_chk->send_size);
10789 } else {
10790 a_chk->send_size = (uint16_t)(sizeof(struct sctp_nr_sack_chunk) +
10791 (num_gap_blocks + num_nr_gap_blocks) * sizeof(struct sctp_gap_ack_block) +
10792 num_dups * sizeof(int32_t));
10793 SCTP_BUF_LEN(a_chk->data) = a_chk->send_size;
10794 nr_sack->nr_sack.cum_tsn_ack = htonl(asoc->cumulative_tsn);
10795 nr_sack->nr_sack.a_rwnd = htonl(asoc->my_rwnd);
10796 nr_sack->nr_sack.num_gap_ack_blks = htons(num_gap_blocks);
10797 nr_sack->nr_sack.num_nr_gap_ack_blks = htons(num_nr_gap_blocks);
10798 nr_sack->nr_sack.num_dup_tsns = htons(num_dups);
10799 nr_sack->nr_sack.reserved = 0;
10800 nr_sack->ch.chunk_type = type;
10801 nr_sack->ch.chunk_flags = flags;
10802 nr_sack->ch.chunk_length = htons(a_chk->send_size);
10803 }
10804 TAILQ_INSERT_TAIL(&asoc->control_send_queue, a_chk, sctp_next);
10805 asoc->my_last_reported_rwnd = asoc->my_rwnd;
10806 asoc->ctrl_queue_cnt++;
10807 asoc->send_sack = 0;
10808 SCTP_STAT_INCR(sctps_sendsacks);
10809 return;
10810 }
10811
10812 void
10813 sctp_send_abort_tcb(struct sctp_tcb *stcb, struct mbuf *operr, int so_locked)
10814 {
10815 struct mbuf *m_abort, *m, *m_last;
10816 struct mbuf *m_out, *m_end = NULL;
10817 struct sctp_abort_chunk *abort;
10818 struct sctp_auth_chunk *auth = NULL;
10819 struct sctp_nets *net;
10820 uint32_t vtag;
10821 uint32_t auth_offset = 0;
10822 int error;
10823 uint16_t cause_len, chunk_len, padding_len;
10824
10825 SCTP_TCB_LOCK_ASSERT(stcb);
10826 /*-
10827 * Add an AUTH chunk, if chunk requires it and save the offset into
10828 * the chain for AUTH
10829 */
10830 if (sctp_auth_is_required_chunk(SCTP_ABORT_ASSOCIATION,
10831 stcb->asoc.peer_auth_chunks)) {
10832 m_out = sctp_add_auth_chunk(NULL, &m_end, &auth, &auth_offset,
10833 stcb, SCTP_ABORT_ASSOCIATION);
10834 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
10835 } else {
10836 m_out = NULL;
10837 }
10838 m_abort = sctp_get_mbuf_for_msg(sizeof(struct sctp_abort_chunk), 0, M_NOWAIT, 1, MT_HEADER);
10839 if (m_abort == NULL) {
10840 if (m_out) {
10841 sctp_m_freem(m_out);
10842 }
10843 if (operr) {
10844 sctp_m_freem(operr);
10845 }
10846 return;
10847 }
10848 /* link in any error */
10849 SCTP_BUF_NEXT(m_abort) = operr;
10850 cause_len = 0;
10851 m_last = NULL;
10852 for (m = operr; m; m = SCTP_BUF_NEXT(m)) {
10853 cause_len += (uint16_t)SCTP_BUF_LEN(m);
10854 if (SCTP_BUF_NEXT(m) == NULL) {
10855 m_last = m;
10856 }
10857 }
10858 SCTP_BUF_LEN(m_abort) = sizeof(struct sctp_abort_chunk);
10859 chunk_len = (uint16_t)sizeof(struct sctp_abort_chunk) + cause_len;
10860 padding_len = SCTP_SIZE32(chunk_len) - chunk_len;
10861 if (m_out == NULL) {
10862 /* NO Auth chunk prepended, so reserve space in front */
10863 SCTP_BUF_RESV_UF(m_abort, SCTP_MIN_OVERHEAD);
10864 m_out = m_abort;
10865 } else {
10866 /* Put AUTH chunk at the front of the chain */
10867 SCTP_BUF_NEXT(m_end) = m_abort;
10868 }
10869 if (stcb->asoc.alternate) {
10870 net = stcb->asoc.alternate;
10871 } else {
10872 net = stcb->asoc.primary_destination;
10873 }
10874 /* Fill in the ABORT chunk header. */
10875 abort = mtod(m_abort, struct sctp_abort_chunk *);
10876 abort->ch.chunk_type = SCTP_ABORT_ASSOCIATION;
10877 if (stcb->asoc.peer_vtag == 0) {
10878 /* This happens iff the assoc is in COOKIE-WAIT state. */
10879 vtag = stcb->asoc.my_vtag;
10880 abort->ch.chunk_flags = SCTP_HAD_NO_TCB;
10881 } else {
10882 vtag = stcb->asoc.peer_vtag;
10883 abort->ch.chunk_flags = 0;
10884 }
10885 abort->ch.chunk_length = htons(chunk_len);
10886 /* Add padding, if necessary. */
10887 if (padding_len > 0) {
10888 if ((m_last == NULL) ||
10889 (sctp_add_pad_tombuf(m_last, padding_len) == NULL)) {
10890 sctp_m_freem(m_out);
10891 return;
10892 }
10893 }
10894 if ((error = sctp_lowlevel_chunk_output(stcb->sctp_ep, stcb, net,
10895 (struct sockaddr *)&net->ro._l_addr,
10896 m_out, auth_offset, auth, stcb->asoc.authinfo.active_keyid, 1, 0, 0,
10897 stcb->sctp_ep->sctp_lport, stcb->rport, htonl(vtag),
10898 stcb->asoc.primary_destination->port, NULL,
10899 0, 0,
10900 so_locked))) {
10901 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
10902 if (error == ENOBUFS) {
10903 stcb->asoc.ifp_had_enobuf = 1;
10904 SCTP_STAT_INCR(sctps_lowlevelerr);
10905 }
10906 } else {
10907 stcb->asoc.ifp_had_enobuf = 0;
10908 }
10909 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
10910 }
10911
10912 void
10913 sctp_send_shutdown_complete(struct sctp_tcb *stcb,
10914 struct sctp_nets *net,
10915 int reflect_vtag)
10916 {
10917 /* formulate and SEND a SHUTDOWN-COMPLETE */
10918 struct mbuf *m_shutdown_comp;
10919 struct sctp_shutdown_complete_chunk *shutdown_complete;
10920 uint32_t vtag;
10921 int error;
10922 uint8_t flags;
10923
10924 m_shutdown_comp = sctp_get_mbuf_for_msg(sizeof(struct sctp_chunkhdr), 0, M_NOWAIT, 1, MT_HEADER);
10925 if (m_shutdown_comp == NULL) {
10926 /* no mbuf's */
10927 return;
10928 }
10929 if (reflect_vtag) {
10930 flags = SCTP_HAD_NO_TCB;
10931 vtag = stcb->asoc.my_vtag;
10932 } else {
10933 flags = 0;
10934 vtag = stcb->asoc.peer_vtag;
10935 }
10936 shutdown_complete = mtod(m_shutdown_comp, struct sctp_shutdown_complete_chunk *);
10937 shutdown_complete->ch.chunk_type = SCTP_SHUTDOWN_COMPLETE;
10938 shutdown_complete->ch.chunk_flags = flags;
10939 shutdown_complete->ch.chunk_length = htons(sizeof(struct sctp_shutdown_complete_chunk));
10940 SCTP_BUF_LEN(m_shutdown_comp) = sizeof(struct sctp_shutdown_complete_chunk);
10941 if ((error = sctp_lowlevel_chunk_output(stcb->sctp_ep, stcb, net,
10942 (struct sockaddr *)&net->ro._l_addr,
10943 m_shutdown_comp, 0, NULL, 0, 1, 0, 0,
10944 stcb->sctp_ep->sctp_lport, stcb->rport,
10945 htonl(vtag),
10946 net->port, NULL,
10947 0, 0,
10948 SCTP_SO_NOT_LOCKED))) {
10949 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
10950 if (error == ENOBUFS) {
10951 stcb->asoc.ifp_had_enobuf = 1;
10952 SCTP_STAT_INCR(sctps_lowlevelerr);
10953 }
10954 } else {
10955 stcb->asoc.ifp_had_enobuf = 0;
10956 }
10957 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
10958 return;
10959 }
10960
10961 static void
10962 sctp_send_resp_msg(struct sockaddr *src, struct sockaddr *dst,
10963 struct sctphdr *sh, uint32_t vtag,
10964 uint8_t type, struct mbuf *cause,
10965 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
10966 uint32_t vrf_id, uint16_t port)
10967 {
10968 struct mbuf *o_pak;
10969 struct mbuf *mout;
10970 struct sctphdr *shout;
10971 struct sctp_chunkhdr *ch;
10972 #if defined(INET) || defined(INET6)
10973 struct udphdr *udp;
10974 #endif
10975 int ret, len, cause_len, padding_len;
10976 #ifdef INET
10977 struct sockaddr_in *src_sin, *dst_sin;
10978 struct ip *ip;
10979 #endif
10980 #ifdef INET6
10981 struct sockaddr_in6 *src_sin6, *dst_sin6;
10982 struct ip6_hdr *ip6;
10983 #endif
10984
10985 /* Compute the length of the cause and add final padding. */
10986 cause_len = 0;
10987 if (cause != NULL) {
10988 struct mbuf *m_at, *m_last = NULL;
10989
10990 for (m_at = cause; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
10991 if (SCTP_BUF_NEXT(m_at) == NULL)
10992 m_last = m_at;
10993 cause_len += SCTP_BUF_LEN(m_at);
10994 }
10995 padding_len = cause_len % 4;
10996 if (padding_len != 0) {
10997 padding_len = 4 - padding_len;
10998 }
10999 if (padding_len != 0) {
11000 if (sctp_add_pad_tombuf(m_last, padding_len) == NULL) {
11001 sctp_m_freem(cause);
11002 return;
11003 }
11004 }
11005 } else {
11006 padding_len = 0;
11007 }
11008 /* Get an mbuf for the header. */
11009 len = sizeof(struct sctphdr) + sizeof(struct sctp_chunkhdr);
11010 switch (dst->sa_family) {
11011 #ifdef INET
11012 case AF_INET:
11013 len += sizeof(struct ip);
11014 break;
11015 #endif
11016 #ifdef INET6
11017 case AF_INET6:
11018 len += sizeof(struct ip6_hdr);
11019 break;
11020 #endif
11021 default:
11022 break;
11023 }
11024 #if defined(INET) || defined(INET6)
11025 if (port) {
11026 len += sizeof(struct udphdr);
11027 }
11028 #endif
11029 mout = sctp_get_mbuf_for_msg(len + max_linkhdr, 1, M_NOWAIT, 1, MT_DATA);
11030 if (mout == NULL) {
11031 if (cause) {
11032 sctp_m_freem(cause);
11033 }
11034 return;
11035 }
11036 SCTP_BUF_RESV_UF(mout, max_linkhdr);
11037 SCTP_BUF_LEN(mout) = len;
11038 SCTP_BUF_NEXT(mout) = cause;
11039 M_SETFIB(mout, fibnum);
11040 mout->m_pkthdr.flowid = mflowid;
11041 M_HASHTYPE_SET(mout, mflowtype);
11042 #ifdef INET
11043 ip = NULL;
11044 #endif
11045 #ifdef INET6
11046 ip6 = NULL;
11047 #endif
11048 switch (dst->sa_family) {
11049 #ifdef INET
11050 case AF_INET:
11051 src_sin = (struct sockaddr_in *)src;
11052 dst_sin = (struct sockaddr_in *)dst;
11053 ip = mtod(mout, struct ip *);
11054 ip->ip_v = IPVERSION;
11055 ip->ip_hl = (sizeof(struct ip) >> 2);
11056 ip->ip_tos = 0;
11057 ip->ip_off = htons(IP_DF);
11058 ip_fillid(ip);
11059 ip->ip_ttl = MODULE_GLOBAL(ip_defttl);
11060 if (port) {
11061 ip->ip_p = IPPROTO_UDP;
11062 } else {
11063 ip->ip_p = IPPROTO_SCTP;
11064 }
11065 ip->ip_src.s_addr = dst_sin->sin_addr.s_addr;
11066 ip->ip_dst.s_addr = src_sin->sin_addr.s_addr;
11067 ip->ip_sum = 0;
11068 len = sizeof(struct ip);
11069 shout = (struct sctphdr *)((caddr_t)ip + len);
11070 break;
11071 #endif
11072 #ifdef INET6
11073 case AF_INET6:
11074 src_sin6 = (struct sockaddr_in6 *)src;
11075 dst_sin6 = (struct sockaddr_in6 *)dst;
11076 ip6 = mtod(mout, struct ip6_hdr *);
11077 ip6->ip6_flow = htonl(0x60000000);
11078 if (V_ip6_auto_flowlabel) {
11079 ip6->ip6_flow |= (htonl(ip6_randomflowlabel()) & IPV6_FLOWLABEL_MASK);
11080 }
11081 ip6->ip6_hlim = MODULE_GLOBAL(ip6_defhlim);
11082 if (port) {
11083 ip6->ip6_nxt = IPPROTO_UDP;
11084 } else {
11085 ip6->ip6_nxt = IPPROTO_SCTP;
11086 }
11087 ip6->ip6_src = dst_sin6->sin6_addr;
11088 ip6->ip6_dst = src_sin6->sin6_addr;
11089 len = sizeof(struct ip6_hdr);
11090 shout = (struct sctphdr *)((caddr_t)ip6 + len);
11091 break;
11092 #endif
11093 default:
11094 len = 0;
11095 shout = mtod(mout, struct sctphdr *);
11096 break;
11097 }
11098 #if defined(INET) || defined(INET6)
11099 if (port) {
11100 if (htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port)) == 0) {
11101 sctp_m_freem(mout);
11102 return;
11103 }
11104 udp = (struct udphdr *)shout;
11105 udp->uh_sport = htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port));
11106 udp->uh_dport = port;
11107 udp->uh_sum = 0;
11108 udp->uh_ulen = htons((uint16_t)(sizeof(struct udphdr) +
11109 sizeof(struct sctphdr) +
11110 sizeof(struct sctp_chunkhdr) +
11111 cause_len + padding_len));
11112 len += sizeof(struct udphdr);
11113 shout = (struct sctphdr *)((caddr_t)shout + sizeof(struct udphdr));
11114 } else {
11115 udp = NULL;
11116 }
11117 #endif
11118 shout->src_port = sh->dest_port;
11119 shout->dest_port = sh->src_port;
11120 shout->checksum = 0;
11121 if (vtag) {
11122 shout->v_tag = htonl(vtag);
11123 } else {
11124 shout->v_tag = sh->v_tag;
11125 }
11126 len += sizeof(struct sctphdr);
11127 ch = (struct sctp_chunkhdr *)((caddr_t)shout + sizeof(struct sctphdr));
11128 ch->chunk_type = type;
11129 if (vtag) {
11130 ch->chunk_flags = 0;
11131 } else {
11132 ch->chunk_flags = SCTP_HAD_NO_TCB;
11133 }
11134 ch->chunk_length = htons((uint16_t)(sizeof(struct sctp_chunkhdr) + cause_len));
11135 len += sizeof(struct sctp_chunkhdr);
11136 len += cause_len + padding_len;
11137
11138 if (SCTP_GET_HEADER_FOR_OUTPUT(o_pak)) {
11139 sctp_m_freem(mout);
11140 return;
11141 }
11142 SCTP_ATTACH_CHAIN(o_pak, mout, len);
11143 switch (dst->sa_family) {
11144 #ifdef INET
11145 case AF_INET:
11146 if (port) {
11147 if (V_udp_cksum) {
11148 udp->uh_sum = in_pseudo(ip->ip_src.s_addr, ip->ip_dst.s_addr, udp->uh_ulen + htons(IPPROTO_UDP));
11149 } else {
11150 udp->uh_sum = 0;
11151 }
11152 }
11153 ip->ip_len = htons(len);
11154 if (port) {
11155 shout->checksum = sctp_calculate_cksum(mout, sizeof(struct ip) + sizeof(struct udphdr));
11156 SCTP_STAT_INCR(sctps_sendswcrc);
11157 if (V_udp_cksum) {
11158 SCTP_ENABLE_UDP_CSUM(o_pak);
11159 }
11160 } else {
11161 mout->m_pkthdr.csum_flags = CSUM_SCTP;
11162 mout->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
11163 SCTP_STAT_INCR(sctps_sendhwcrc);
11164 }
11165 #ifdef SCTP_PACKET_LOGGING
11166 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING) {
11167 sctp_packet_log(o_pak);
11168 }
11169 #endif
11170 SCTP_PROBE5(send, NULL, NULL, ip, NULL, shout);
11171 SCTP_IP_OUTPUT(ret, o_pak, NULL, NULL, vrf_id);
11172 break;
11173 #endif
11174 #ifdef INET6
11175 case AF_INET6:
11176 ip6->ip6_plen = htons((uint16_t)(len - sizeof(struct ip6_hdr)));
11177 if (port) {
11178 shout->checksum = sctp_calculate_cksum(mout, sizeof(struct ip6_hdr) + sizeof(struct udphdr));
11179 SCTP_STAT_INCR(sctps_sendswcrc);
11180 if ((udp->uh_sum = in6_cksum(o_pak, IPPROTO_UDP, sizeof(struct ip6_hdr), len - sizeof(struct ip6_hdr))) == 0) {
11181 udp->uh_sum = 0xffff;
11182 }
11183 } else {
11184 mout->m_pkthdr.csum_flags = CSUM_SCTP_IPV6;
11185 mout->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
11186 SCTP_STAT_INCR(sctps_sendhwcrc);
11187 }
11188 #ifdef SCTP_PACKET_LOGGING
11189 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING) {
11190 sctp_packet_log(o_pak);
11191 }
11192 #endif
11193 SCTP_PROBE5(send, NULL, NULL, ip6, NULL, shout);
11194 SCTP_IP6_OUTPUT(ret, o_pak, NULL, NULL, NULL, vrf_id);
11195 break;
11196 #endif
11197 default:
11198 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Unknown protocol (TSNH) type %d\n",
11199 dst->sa_family);
11200 sctp_m_freem(mout);
11201 SCTP_LTRACE_ERR_RET_PKT(mout, NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EFAULT);
11202 return;
11203 }
11204 SCTPDBG(SCTP_DEBUG_OUTPUT3, "return from send is %d\n", ret);
11205 if (port) {
11206 UDPSTAT_INC(udps_opackets);
11207 }
11208 SCTP_STAT_INCR(sctps_sendpackets);
11209 SCTP_STAT_INCR_COUNTER64(sctps_outpackets);
11210 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
11211 if (ret) {
11212 SCTP_STAT_INCR(sctps_senderrors);
11213 }
11214 return;
11215 }
11216
11217 void
11218 sctp_send_shutdown_complete2(struct sockaddr *src, struct sockaddr *dst,
11219 struct sctphdr *sh,
11220 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
11221 uint32_t vrf_id, uint16_t port)
11222 {
11223 sctp_send_resp_msg(src, dst, sh, 0, SCTP_SHUTDOWN_COMPLETE, NULL,
11224 mflowtype, mflowid, fibnum,
11225 vrf_id, port);
11226 }
11227
11228 void
11229 sctp_send_hb(struct sctp_tcb *stcb, struct sctp_nets *net, int so_locked)
11230 {
11231 struct sctp_tmit_chunk *chk;
11232 struct sctp_heartbeat_chunk *hb;
11233 struct timeval now;
11234
11235 SCTP_TCB_LOCK_ASSERT(stcb);
11236 if (net == NULL) {
11237 return;
11238 }
11239 (void)SCTP_GETTIME_TIMEVAL(&now);
11240 switch (net->ro._l_addr.sa.sa_family) {
11241 #ifdef INET
11242 case AF_INET:
11243 break;
11244 #endif
11245 #ifdef INET6
11246 case AF_INET6:
11247 break;
11248 #endif
11249 default:
11250 return;
11251 }
11252 sctp_alloc_a_chunk(stcb, chk);
11253 if (chk == NULL) {
11254 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Gak, can't get a chunk for hb\n");
11255 return;
11256 }
11257
11258 chk->copy_by_ref = 0;
11259 chk->rec.chunk_id.id = SCTP_HEARTBEAT_REQUEST;
11260 chk->rec.chunk_id.can_take_data = 1;
11261 chk->flags = 0;
11262 chk->asoc = &stcb->asoc;
11263 chk->send_size = sizeof(struct sctp_heartbeat_chunk);
11264
11265 chk->data = sctp_get_mbuf_for_msg(chk->send_size, 0, M_NOWAIT, 1, MT_HEADER);
11266 if (chk->data == NULL) {
11267 sctp_free_a_chunk(stcb, chk, so_locked);
11268 return;
11269 }
11270 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11271 SCTP_BUF_LEN(chk->data) = chk->send_size;
11272 chk->sent = SCTP_DATAGRAM_UNSENT;
11273 chk->snd_count = 0;
11274 chk->whoTo = net;
11275 atomic_add_int(&chk->whoTo->ref_count, 1);
11276 /* Now we have a mbuf that we can fill in with the details */
11277 hb = mtod(chk->data, struct sctp_heartbeat_chunk *);
11278 memset(hb, 0, sizeof(struct sctp_heartbeat_chunk));
11279 /* fill out chunk header */
11280 hb->ch.chunk_type = SCTP_HEARTBEAT_REQUEST;
11281 hb->ch.chunk_flags = 0;
11282 hb->ch.chunk_length = htons(chk->send_size);
11283 /* Fill out hb parameter */
11284 hb->heartbeat.hb_info.ph.param_type = htons(SCTP_HEARTBEAT_INFO);
11285 hb->heartbeat.hb_info.ph.param_length = htons(sizeof(struct sctp_heartbeat_info_param));
11286 hb->heartbeat.hb_info.time_value_1 = (uint32_t)now.tv_sec;
11287 hb->heartbeat.hb_info.time_value_2 = now.tv_usec;
11288 /* Did our user request this one, put it in */
11289 hb->heartbeat.hb_info.addr_family = (uint8_t)net->ro._l_addr.sa.sa_family;
11290 hb->heartbeat.hb_info.addr_len = net->ro._l_addr.sa.sa_len;
11291 if (net->dest_state & SCTP_ADDR_UNCONFIRMED) {
11292 /*
11293 * we only take from the entropy pool if the address is not
11294 * confirmed.
11295 */
11296 net->heartbeat_random1 = hb->heartbeat.hb_info.random_value1 = sctp_select_initial_TSN(&stcb->sctp_ep->sctp_ep);
11297 net->heartbeat_random2 = hb->heartbeat.hb_info.random_value2 = sctp_select_initial_TSN(&stcb->sctp_ep->sctp_ep);
11298 } else {
11299 net->heartbeat_random1 = hb->heartbeat.hb_info.random_value1 = 0;
11300 net->heartbeat_random2 = hb->heartbeat.hb_info.random_value2 = 0;
11301 }
11302 switch (net->ro._l_addr.sa.sa_family) {
11303 #ifdef INET
11304 case AF_INET:
11305 memcpy(hb->heartbeat.hb_info.address,
11306 &net->ro._l_addr.sin.sin_addr,
11307 sizeof(net->ro._l_addr.sin.sin_addr));
11308 break;
11309 #endif
11310 #ifdef INET6
11311 case AF_INET6:
11312 memcpy(hb->heartbeat.hb_info.address,
11313 &net->ro._l_addr.sin6.sin6_addr,
11314 sizeof(net->ro._l_addr.sin6.sin6_addr));
11315 break;
11316 #endif
11317 default:
11318 if (chk->data) {
11319 sctp_m_freem(chk->data);
11320 chk->data = NULL;
11321 }
11322 sctp_free_a_chunk(stcb, chk, so_locked);
11323 return;
11324 break;
11325 }
11326 net->hb_responded = 0;
11327 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
11328 stcb->asoc.ctrl_queue_cnt++;
11329 SCTP_STAT_INCR(sctps_sendheartbeat);
11330 return;
11331 }
11332
11333 void
11334 sctp_send_ecn_echo(struct sctp_tcb *stcb, struct sctp_nets *net,
11335 uint32_t high_tsn)
11336 {
11337 struct sctp_association *asoc;
11338 struct sctp_ecne_chunk *ecne;
11339 struct sctp_tmit_chunk *chk;
11340
11341 if (net == NULL) {
11342 return;
11343 }
11344 asoc = &stcb->asoc;
11345 SCTP_TCB_LOCK_ASSERT(stcb);
11346 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
11347 if ((chk->rec.chunk_id.id == SCTP_ECN_ECHO) && (net == chk->whoTo)) {
11348 /* found a previous ECN_ECHO update it if needed */
11349 uint32_t cnt, ctsn;
11350
11351 ecne = mtod(chk->data, struct sctp_ecne_chunk *);
11352 ctsn = ntohl(ecne->tsn);
11353 if (SCTP_TSN_GT(high_tsn, ctsn)) {
11354 ecne->tsn = htonl(high_tsn);
11355 SCTP_STAT_INCR(sctps_queue_upd_ecne);
11356 }
11357 cnt = ntohl(ecne->num_pkts_since_cwr);
11358 cnt++;
11359 ecne->num_pkts_since_cwr = htonl(cnt);
11360 return;
11361 }
11362 }
11363 /* nope could not find one to update so we must build one */
11364 sctp_alloc_a_chunk(stcb, chk);
11365 if (chk == NULL) {
11366 return;
11367 }
11368 SCTP_STAT_INCR(sctps_queue_upd_ecne);
11369 chk->copy_by_ref = 0;
11370 chk->rec.chunk_id.id = SCTP_ECN_ECHO;
11371 chk->rec.chunk_id.can_take_data = 0;
11372 chk->flags = 0;
11373 chk->asoc = &stcb->asoc;
11374 chk->send_size = sizeof(struct sctp_ecne_chunk);
11375 chk->data = sctp_get_mbuf_for_msg(chk->send_size, 0, M_NOWAIT, 1, MT_HEADER);
11376 if (chk->data == NULL) {
11377 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11378 return;
11379 }
11380 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11381 SCTP_BUF_LEN(chk->data) = chk->send_size;
11382 chk->sent = SCTP_DATAGRAM_UNSENT;
11383 chk->snd_count = 0;
11384 chk->whoTo = net;
11385 atomic_add_int(&chk->whoTo->ref_count, 1);
11386
11387 stcb->asoc.ecn_echo_cnt_onq++;
11388 ecne = mtod(chk->data, struct sctp_ecne_chunk *);
11389 ecne->ch.chunk_type = SCTP_ECN_ECHO;
11390 ecne->ch.chunk_flags = 0;
11391 ecne->ch.chunk_length = htons(sizeof(struct sctp_ecne_chunk));
11392 ecne->tsn = htonl(high_tsn);
11393 ecne->num_pkts_since_cwr = htonl(1);
11394 TAILQ_INSERT_HEAD(&stcb->asoc.control_send_queue, chk, sctp_next);
11395 asoc->ctrl_queue_cnt++;
11396 }
11397
11398 void
11399 sctp_send_packet_dropped(struct sctp_tcb *stcb, struct sctp_nets *net,
11400 struct mbuf *m, int len, int iphlen, int bad_crc)
11401 {
11402 struct sctp_association *asoc;
11403 struct sctp_pktdrop_chunk *drp;
11404 struct sctp_tmit_chunk *chk;
11405 uint8_t *datap;
11406 int was_trunc = 0;
11407 int fullsz = 0;
11408 long spc;
11409 int offset;
11410 struct sctp_chunkhdr *ch, chunk_buf;
11411 unsigned int chk_length;
11412
11413 if (!stcb) {
11414 return;
11415 }
11416 asoc = &stcb->asoc;
11417 SCTP_TCB_LOCK_ASSERT(stcb);
11418 if (asoc->pktdrop_supported == 0) {
11419 /*-
11420 * peer must declare support before I send one.
11421 */
11422 return;
11423 }
11424 if (stcb->sctp_socket == NULL) {
11425 return;
11426 }
11427 sctp_alloc_a_chunk(stcb, chk);
11428 if (chk == NULL) {
11429 return;
11430 }
11431 chk->copy_by_ref = 0;
11432 chk->rec.chunk_id.id = SCTP_PACKET_DROPPED;
11433 chk->rec.chunk_id.can_take_data = 1;
11434 chk->flags = 0;
11435 len -= iphlen;
11436 chk->send_size = len;
11437 /* Validate that we do not have an ABORT in here. */
11438 offset = iphlen + sizeof(struct sctphdr);
11439 ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, offset,
11440 sizeof(*ch), (uint8_t *)&chunk_buf);
11441 while (ch != NULL) {
11442 chk_length = ntohs(ch->chunk_length);
11443 if (chk_length < sizeof(*ch)) {
11444 /* break to abort land */
11445 break;
11446 }
11447 switch (ch->chunk_type) {
11448 case SCTP_PACKET_DROPPED:
11449 case SCTP_ABORT_ASSOCIATION:
11450 case SCTP_INITIATION_ACK:
11451 /**
11452 * We don't respond with an PKT-DROP to an ABORT
11453 * or PKT-DROP. We also do not respond to an
11454 * INIT-ACK, because we can't know if the initiation
11455 * tag is correct or not.
11456 */
11457 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11458 return;
11459 default:
11460 break;
11461 }
11462 offset += SCTP_SIZE32(chk_length);
11463 ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, offset,
11464 sizeof(*ch), (uint8_t *)&chunk_buf);
11465 }
11466
11467 if ((len + SCTP_MAX_OVERHEAD + sizeof(struct sctp_pktdrop_chunk)) >
11468 min(stcb->asoc.smallest_mtu, MCLBYTES)) {
11469 /*
11470 * only send 1 mtu worth, trim off the excess on the end.
11471 */
11472 fullsz = len;
11473 len = min(stcb->asoc.smallest_mtu, MCLBYTES) - SCTP_MAX_OVERHEAD;
11474 was_trunc = 1;
11475 }
11476 chk->asoc = &stcb->asoc;
11477 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
11478 if (chk->data == NULL) {
11479 jump_out:
11480 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11481 return;
11482 }
11483 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11484 drp = mtod(chk->data, struct sctp_pktdrop_chunk *);
11485 if (drp == NULL) {
11486 sctp_m_freem(chk->data);
11487 chk->data = NULL;
11488 goto jump_out;
11489 }
11490 chk->book_size = SCTP_SIZE32((chk->send_size + sizeof(struct sctp_pktdrop_chunk) +
11491 sizeof(struct sctphdr) + SCTP_MED_OVERHEAD));
11492 chk->book_size_scale = 0;
11493 if (was_trunc) {
11494 drp->ch.chunk_flags = SCTP_PACKET_TRUNCATED;
11495 drp->trunc_len = htons(fullsz);
11496 /*
11497 * Len is already adjusted to size minus overhead above take
11498 * out the pkt_drop chunk itself from it.
11499 */
11500 chk->send_size = (uint16_t)(len - sizeof(struct sctp_pktdrop_chunk));
11501 len = chk->send_size;
11502 } else {
11503 /* no truncation needed */
11504 drp->ch.chunk_flags = 0;
11505 drp->trunc_len = htons(0);
11506 }
11507 if (bad_crc) {
11508 drp->ch.chunk_flags |= SCTP_BADCRC;
11509 }
11510 chk->send_size += sizeof(struct sctp_pktdrop_chunk);
11511 SCTP_BUF_LEN(chk->data) = chk->send_size;
11512 chk->sent = SCTP_DATAGRAM_UNSENT;
11513 chk->snd_count = 0;
11514 if (net) {
11515 /* we should hit here */
11516 chk->whoTo = net;
11517 atomic_add_int(&chk->whoTo->ref_count, 1);
11518 } else {
11519 chk->whoTo = NULL;
11520 }
11521 drp->ch.chunk_type = SCTP_PACKET_DROPPED;
11522 drp->ch.chunk_length = htons(chk->send_size);
11523 spc = SCTP_SB_LIMIT_RCV(stcb->sctp_socket);
11524 if (spc < 0) {
11525 spc = 0;
11526 }
11527 drp->bottle_bw = htonl(spc);
11528 if (asoc->my_rwnd) {
11529 drp->current_onq = htonl(asoc->size_on_reasm_queue +
11530 asoc->size_on_all_streams +
11531 asoc->my_rwnd_control_len +
11532 SCTP_SBAVAIL(&stcb->sctp_socket->so_rcv));
11533 } else {
11534 /*-
11535 * If my rwnd is 0, possibly from mbuf depletion as well as
11536 * space used, tell the peer there is NO space aka onq == bw
11537 */
11538 drp->current_onq = htonl(spc);
11539 }
11540 drp->reserved = 0;
11541 datap = drp->data;
11542 m_copydata(m, iphlen, len, (caddr_t)datap);
11543 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
11544 asoc->ctrl_queue_cnt++;
11545 }
11546
11547 void
11548 sctp_send_cwr(struct sctp_tcb *stcb, struct sctp_nets *net, uint32_t high_tsn, uint8_t override)
11549 {
11550 struct sctp_association *asoc;
11551 struct sctp_cwr_chunk *cwr;
11552 struct sctp_tmit_chunk *chk;
11553
11554 SCTP_TCB_LOCK_ASSERT(stcb);
11555 if (net == NULL) {
11556 return;
11557 }
11558 asoc = &stcb->asoc;
11559 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
11560 if ((chk->rec.chunk_id.id == SCTP_ECN_CWR) && (net == chk->whoTo)) {
11561 /*
11562 * found a previous CWR queued to same destination
11563 * update it if needed
11564 */
11565 uint32_t ctsn;
11566
11567 cwr = mtod(chk->data, struct sctp_cwr_chunk *);
11568 ctsn = ntohl(cwr->tsn);
11569 if (SCTP_TSN_GT(high_tsn, ctsn)) {
11570 cwr->tsn = htonl(high_tsn);
11571 }
11572 if (override & SCTP_CWR_REDUCE_OVERRIDE) {
11573 /* Make sure override is carried */
11574 cwr->ch.chunk_flags |= SCTP_CWR_REDUCE_OVERRIDE;
11575 }
11576 return;
11577 }
11578 }
11579 sctp_alloc_a_chunk(stcb, chk);
11580 if (chk == NULL) {
11581 return;
11582 }
11583 chk->copy_by_ref = 0;
11584 chk->rec.chunk_id.id = SCTP_ECN_CWR;
11585 chk->rec.chunk_id.can_take_data = 1;
11586 chk->flags = 0;
11587 chk->asoc = asoc;
11588 chk->send_size = sizeof(struct sctp_cwr_chunk);
11589 chk->data = sctp_get_mbuf_for_msg(chk->send_size, 0, M_NOWAIT, 1, MT_HEADER);
11590 if (chk->data == NULL) {
11591 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11592 return;
11593 }
11594 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11595 SCTP_BUF_LEN(chk->data) = chk->send_size;
11596 chk->sent = SCTP_DATAGRAM_UNSENT;
11597 chk->snd_count = 0;
11598 chk->whoTo = net;
11599 atomic_add_int(&chk->whoTo->ref_count, 1);
11600 cwr = mtod(chk->data, struct sctp_cwr_chunk *);
11601 cwr->ch.chunk_type = SCTP_ECN_CWR;
11602 cwr->ch.chunk_flags = override;
11603 cwr->ch.chunk_length = htons(sizeof(struct sctp_cwr_chunk));
11604 cwr->tsn = htonl(high_tsn);
11605 TAILQ_INSERT_TAIL(&asoc->control_send_queue, chk, sctp_next);
11606 asoc->ctrl_queue_cnt++;
11607 }
11608
11609 static int
11610 sctp_add_stream_reset_out(struct sctp_tcb *stcb, struct sctp_tmit_chunk *chk,
11611 uint32_t seq, uint32_t resp_seq, uint32_t last_sent)
11612 {
11613 uint16_t len, old_len, i;
11614 struct sctp_stream_reset_out_request *req_out;
11615 struct sctp_chunkhdr *ch;
11616 int at;
11617 int number_entries = 0;
11618
11619 ch = mtod(chk->data, struct sctp_chunkhdr *);
11620 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11621 /* get to new offset for the param. */
11622 req_out = (struct sctp_stream_reset_out_request *)((caddr_t)ch + len);
11623 /* now how long will this param be? */
11624 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
11625 if ((stcb->asoc.strmout[i].state == SCTP_STREAM_RESET_PENDING) &&
11626 (stcb->asoc.strmout[i].chunks_on_queues == 0) &&
11627 TAILQ_EMPTY(&stcb->asoc.strmout[i].outqueue)) {
11628 number_entries++;
11629 }
11630 }
11631 if (number_entries == 0) {
11632 return (0);
11633 }
11634 if (number_entries == stcb->asoc.streamoutcnt) {
11635 number_entries = 0;
11636 }
11637 if (number_entries > SCTP_MAX_STREAMS_AT_ONCE_RESET) {
11638 number_entries = SCTP_MAX_STREAMS_AT_ONCE_RESET;
11639 }
11640 len = (uint16_t)(sizeof(struct sctp_stream_reset_out_request) + (sizeof(uint16_t) * number_entries));
11641 req_out->ph.param_type = htons(SCTP_STR_RESET_OUT_REQUEST);
11642 req_out->ph.param_length = htons(len);
11643 req_out->request_seq = htonl(seq);
11644 req_out->response_seq = htonl(resp_seq);
11645 req_out->send_reset_at_tsn = htonl(last_sent);
11646 at = 0;
11647 if (number_entries) {
11648 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
11649 if ((stcb->asoc.strmout[i].state == SCTP_STREAM_RESET_PENDING) &&
11650 (stcb->asoc.strmout[i].chunks_on_queues == 0) &&
11651 TAILQ_EMPTY(&stcb->asoc.strmout[i].outqueue)) {
11652 req_out->list_of_streams[at] = htons(i);
11653 at++;
11654 stcb->asoc.strmout[i].state = SCTP_STREAM_RESET_IN_FLIGHT;
11655 if (at >= number_entries) {
11656 break;
11657 }
11658 }
11659 }
11660 } else {
11661 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
11662 stcb->asoc.strmout[i].state = SCTP_STREAM_RESET_IN_FLIGHT;
11663 }
11664 }
11665 if (SCTP_SIZE32(len) > len) {
11666 /*-
11667 * Need to worry about the pad we may end up adding to the
11668 * end. This is easy since the struct is either aligned to 4
11669 * bytes or 2 bytes off.
11670 */
11671 req_out->list_of_streams[number_entries] = 0;
11672 }
11673 /* now fix the chunk length */
11674 ch->chunk_length = htons(len + old_len);
11675 chk->book_size = len + old_len;
11676 chk->book_size_scale = 0;
11677 chk->send_size = SCTP_SIZE32(chk->book_size);
11678 SCTP_BUF_LEN(chk->data) = chk->send_size;
11679 return (1);
11680 }
11681
11682 static void
11683 sctp_add_stream_reset_in(struct sctp_tmit_chunk *chk,
11684 int number_entries, uint16_t *list,
11685 uint32_t seq)
11686 {
11687 uint16_t len, old_len, i;
11688 struct sctp_stream_reset_in_request *req_in;
11689 struct sctp_chunkhdr *ch;
11690
11691 ch = mtod(chk->data, struct sctp_chunkhdr *);
11692 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11693
11694 /* get to new offset for the param. */
11695 req_in = (struct sctp_stream_reset_in_request *)((caddr_t)ch + len);
11696 /* now how long will this param be? */
11697 len = (uint16_t)(sizeof(struct sctp_stream_reset_in_request) + (sizeof(uint16_t) * number_entries));
11698 req_in->ph.param_type = htons(SCTP_STR_RESET_IN_REQUEST);
11699 req_in->ph.param_length = htons(len);
11700 req_in->request_seq = htonl(seq);
11701 if (number_entries) {
11702 for (i = 0; i < number_entries; i++) {
11703 req_in->list_of_streams[i] = htons(list[i]);
11704 }
11705 }
11706 if (SCTP_SIZE32(len) > len) {
11707 /*-
11708 * Need to worry about the pad we may end up adding to the
11709 * end. This is easy since the struct is either aligned to 4
11710 * bytes or 2 bytes off.
11711 */
11712 req_in->list_of_streams[number_entries] = 0;
11713 }
11714 /* now fix the chunk length */
11715 ch->chunk_length = htons(len + old_len);
11716 chk->book_size = len + old_len;
11717 chk->book_size_scale = 0;
11718 chk->send_size = SCTP_SIZE32(chk->book_size);
11719 SCTP_BUF_LEN(chk->data) = chk->send_size;
11720 return;
11721 }
11722
11723 static void
11724 sctp_add_stream_reset_tsn(struct sctp_tmit_chunk *chk,
11725 uint32_t seq)
11726 {
11727 uint16_t len, old_len;
11728 struct sctp_stream_reset_tsn_request *req_tsn;
11729 struct sctp_chunkhdr *ch;
11730
11731 ch = mtod(chk->data, struct sctp_chunkhdr *);
11732 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11733
11734 /* get to new offset for the param. */
11735 req_tsn = (struct sctp_stream_reset_tsn_request *)((caddr_t)ch + len);
11736 /* now how long will this param be? */
11737 len = sizeof(struct sctp_stream_reset_tsn_request);
11738 req_tsn->ph.param_type = htons(SCTP_STR_RESET_TSN_REQUEST);
11739 req_tsn->ph.param_length = htons(len);
11740 req_tsn->request_seq = htonl(seq);
11741
11742 /* now fix the chunk length */
11743 ch->chunk_length = htons(len + old_len);
11744 chk->send_size = len + old_len;
11745 chk->book_size = SCTP_SIZE32(chk->send_size);
11746 chk->book_size_scale = 0;
11747 SCTP_BUF_LEN(chk->data) = SCTP_SIZE32(chk->send_size);
11748 return;
11749 }
11750
11751 void
11752 sctp_add_stream_reset_result(struct sctp_tmit_chunk *chk,
11753 uint32_t resp_seq, uint32_t result)
11754 {
11755 uint16_t len, old_len;
11756 struct sctp_stream_reset_response *resp;
11757 struct sctp_chunkhdr *ch;
11758
11759 ch = mtod(chk->data, struct sctp_chunkhdr *);
11760 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11761
11762 /* get to new offset for the param. */
11763 resp = (struct sctp_stream_reset_response *)((caddr_t)ch + len);
11764 /* now how long will this param be? */
11765 len = sizeof(struct sctp_stream_reset_response);
11766 resp->ph.param_type = htons(SCTP_STR_RESET_RESPONSE);
11767 resp->ph.param_length = htons(len);
11768 resp->response_seq = htonl(resp_seq);
11769 resp->result = ntohl(result);
11770
11771 /* now fix the chunk length */
11772 ch->chunk_length = htons(len + old_len);
11773 chk->book_size = len + old_len;
11774 chk->book_size_scale = 0;
11775 chk->send_size = SCTP_SIZE32(chk->book_size);
11776 SCTP_BUF_LEN(chk->data) = chk->send_size;
11777 return;
11778 }
11779
11780 void
11781 sctp_send_deferred_reset_response(struct sctp_tcb *stcb,
11782 struct sctp_stream_reset_list *ent,
11783 int response)
11784 {
11785 struct sctp_association *asoc;
11786 struct sctp_tmit_chunk *chk;
11787 struct sctp_chunkhdr *ch;
11788
11789 asoc = &stcb->asoc;
11790
11791 /*
11792 * Reset our last reset action to the new one IP -> response
11793 * (PERFORMED probably). This assures that if we fail to send, a
11794 * retran from the peer will get the new response.
11795 */
11796 asoc->last_reset_action[0] = response;
11797 if (asoc->stream_reset_outstanding) {
11798 return;
11799 }
11800 sctp_alloc_a_chunk(stcb, chk);
11801 if (chk == NULL) {
11802 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
11803 return;
11804 }
11805 chk->copy_by_ref = 0;
11806 chk->rec.chunk_id.id = SCTP_STREAM_RESET;
11807 chk->rec.chunk_id.can_take_data = 0;
11808 chk->flags = 0;
11809 chk->asoc = &stcb->asoc;
11810 chk->book_size = sizeof(struct sctp_chunkhdr);
11811 chk->send_size = SCTP_SIZE32(chk->book_size);
11812 chk->book_size_scale = 0;
11813 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
11814 if (chk->data == NULL) {
11815 sctp_free_a_chunk(stcb, chk, SCTP_SO_LOCKED);
11816 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
11817 return;
11818 }
11819 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11820 /* setup chunk parameters */
11821 chk->sent = SCTP_DATAGRAM_UNSENT;
11822 chk->snd_count = 0;
11823 if (stcb->asoc.alternate) {
11824 chk->whoTo = stcb->asoc.alternate;
11825 } else {
11826 chk->whoTo = stcb->asoc.primary_destination;
11827 }
11828 ch = mtod(chk->data, struct sctp_chunkhdr *);
11829 ch->chunk_type = SCTP_STREAM_RESET;
11830 ch->chunk_flags = 0;
11831 ch->chunk_length = htons(chk->book_size);
11832 atomic_add_int(&chk->whoTo->ref_count, 1);
11833 SCTP_BUF_LEN(chk->data) = chk->send_size;
11834 sctp_add_stream_reset_result(chk, ent->seq, response);
11835 /* insert the chunk for sending */
11836 TAILQ_INSERT_TAIL(&asoc->control_send_queue,
11837 chk,
11838 sctp_next);
11839 asoc->ctrl_queue_cnt++;
11840 }
11841
11842 void
11843 sctp_add_stream_reset_result_tsn(struct sctp_tmit_chunk *chk,
11844 uint32_t resp_seq, uint32_t result,
11845 uint32_t send_una, uint32_t recv_next)
11846 {
11847 uint16_t len, old_len;
11848 struct sctp_stream_reset_response_tsn *resp;
11849 struct sctp_chunkhdr *ch;
11850
11851 ch = mtod(chk->data, struct sctp_chunkhdr *);
11852 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11853
11854 /* get to new offset for the param. */
11855 resp = (struct sctp_stream_reset_response_tsn *)((caddr_t)ch + len);
11856 /* now how long will this param be? */
11857 len = sizeof(struct sctp_stream_reset_response_tsn);
11858 resp->ph.param_type = htons(SCTP_STR_RESET_RESPONSE);
11859 resp->ph.param_length = htons(len);
11860 resp->response_seq = htonl(resp_seq);
11861 resp->result = htonl(result);
11862 resp->senders_next_tsn = htonl(send_una);
11863 resp->receivers_next_tsn = htonl(recv_next);
11864
11865 /* now fix the chunk length */
11866 ch->chunk_length = htons(len + old_len);
11867 chk->book_size = len + old_len;
11868 chk->send_size = SCTP_SIZE32(chk->book_size);
11869 chk->book_size_scale = 0;
11870 SCTP_BUF_LEN(chk->data) = chk->send_size;
11871 return;
11872 }
11873
11874 static void
11875 sctp_add_an_out_stream(struct sctp_tmit_chunk *chk,
11876 uint32_t seq,
11877 uint16_t adding)
11878 {
11879 uint16_t len, old_len;
11880 struct sctp_chunkhdr *ch;
11881 struct sctp_stream_reset_add_strm *addstr;
11882
11883 ch = mtod(chk->data, struct sctp_chunkhdr *);
11884 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11885
11886 /* get to new offset for the param. */
11887 addstr = (struct sctp_stream_reset_add_strm *)((caddr_t)ch + len);
11888 /* now how long will this param be? */
11889 len = sizeof(struct sctp_stream_reset_add_strm);
11890
11891 /* Fill it out. */
11892 addstr->ph.param_type = htons(SCTP_STR_RESET_ADD_OUT_STREAMS);
11893 addstr->ph.param_length = htons(len);
11894 addstr->request_seq = htonl(seq);
11895 addstr->number_of_streams = htons(adding);
11896 addstr->reserved = 0;
11897
11898 /* now fix the chunk length */
11899 ch->chunk_length = htons(len + old_len);
11900 chk->send_size = len + old_len;
11901 chk->book_size = SCTP_SIZE32(chk->send_size);
11902 chk->book_size_scale = 0;
11903 SCTP_BUF_LEN(chk->data) = SCTP_SIZE32(chk->send_size);
11904 return;
11905 }
11906
11907 static void
11908 sctp_add_an_in_stream(struct sctp_tmit_chunk *chk,
11909 uint32_t seq,
11910 uint16_t adding)
11911 {
11912 uint16_t len, old_len;
11913 struct sctp_chunkhdr *ch;
11914 struct sctp_stream_reset_add_strm *addstr;
11915
11916 ch = mtod(chk->data, struct sctp_chunkhdr *);
11917 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11918
11919 /* get to new offset for the param. */
11920 addstr = (struct sctp_stream_reset_add_strm *)((caddr_t)ch + len);
11921 /* now how long will this param be? */
11922 len = sizeof(struct sctp_stream_reset_add_strm);
11923 /* Fill it out. */
11924 addstr->ph.param_type = htons(SCTP_STR_RESET_ADD_IN_STREAMS);
11925 addstr->ph.param_length = htons(len);
11926 addstr->request_seq = htonl(seq);
11927 addstr->number_of_streams = htons(adding);
11928 addstr->reserved = 0;
11929
11930 /* now fix the chunk length */
11931 ch->chunk_length = htons(len + old_len);
11932 chk->send_size = len + old_len;
11933 chk->book_size = SCTP_SIZE32(chk->send_size);
11934 chk->book_size_scale = 0;
11935 SCTP_BUF_LEN(chk->data) = SCTP_SIZE32(chk->send_size);
11936 return;
11937 }
11938
11939 int
11940 sctp_send_stream_reset_out_if_possible(struct sctp_tcb *stcb, int so_locked)
11941 {
11942 struct sctp_association *asoc;
11943 struct sctp_tmit_chunk *chk;
11944 struct sctp_chunkhdr *ch;
11945 uint32_t seq;
11946
11947 asoc = &stcb->asoc;
11948 asoc->trigger_reset = 0;
11949 if (asoc->stream_reset_outstanding) {
11950 return (EALREADY);
11951 }
11952 sctp_alloc_a_chunk(stcb, chk);
11953 if (chk == NULL) {
11954 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
11955 return (ENOMEM);
11956 }
11957 chk->copy_by_ref = 0;
11958 chk->rec.chunk_id.id = SCTP_STREAM_RESET;
11959 chk->rec.chunk_id.can_take_data = 0;
11960 chk->flags = 0;
11961 chk->asoc = &stcb->asoc;
11962 chk->book_size = sizeof(struct sctp_chunkhdr);
11963 chk->send_size = SCTP_SIZE32(chk->book_size);
11964 chk->book_size_scale = 0;
11965 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
11966 if (chk->data == NULL) {
11967 sctp_free_a_chunk(stcb, chk, so_locked);
11968 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
11969 return (ENOMEM);
11970 }
11971 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11972
11973 /* setup chunk parameters */
11974 chk->sent = SCTP_DATAGRAM_UNSENT;
11975 chk->snd_count = 0;
11976 if (stcb->asoc.alternate) {
11977 chk->whoTo = stcb->asoc.alternate;
11978 } else {
11979 chk->whoTo = stcb->asoc.primary_destination;
11980 }
11981 ch = mtod(chk->data, struct sctp_chunkhdr *);
11982 ch->chunk_type = SCTP_STREAM_RESET;
11983 ch->chunk_flags = 0;
11984 ch->chunk_length = htons(chk->book_size);
11985 atomic_add_int(&chk->whoTo->ref_count, 1);
11986 SCTP_BUF_LEN(chk->data) = chk->send_size;
11987 seq = stcb->asoc.str_reset_seq_out;
11988 if (sctp_add_stream_reset_out(stcb, chk, seq, (stcb->asoc.str_reset_seq_in - 1), (stcb->asoc.sending_seq - 1))) {
11989 seq++;
11990 asoc->stream_reset_outstanding++;
11991 } else {
11992 m_freem(chk->data);
11993 chk->data = NULL;
11994 sctp_free_a_chunk(stcb, chk, so_locked);
11995 return (ENOENT);
11996 }
11997 asoc->str_reset = chk;
11998 /* insert the chunk for sending */
11999 TAILQ_INSERT_TAIL(&asoc->control_send_queue,
12000 chk,
12001 sctp_next);
12002 asoc->ctrl_queue_cnt++;
12003
12004 if (stcb->asoc.send_sack) {
12005 sctp_send_sack(stcb, so_locked);
12006 }
12007 sctp_timer_start(SCTP_TIMER_TYPE_STRRESET, stcb->sctp_ep, stcb, chk->whoTo);
12008 return (0);
12009 }
12010
12011 int
12012 sctp_send_str_reset_req(struct sctp_tcb *stcb,
12013 uint16_t number_entries, uint16_t *list,
12014 uint8_t send_in_req,
12015 uint8_t send_tsn_req,
12016 uint8_t add_stream,
12017 uint16_t adding_o,
12018 uint16_t adding_i, uint8_t peer_asked)
12019 {
12020 struct sctp_association *asoc;
12021 struct sctp_tmit_chunk *chk;
12022 struct sctp_chunkhdr *ch;
12023 int can_send_out_req = 0;
12024 uint32_t seq;
12025
12026 SCTP_TCB_LOCK_ASSERT(stcb);
12027
12028 asoc = &stcb->asoc;
12029 if (asoc->stream_reset_outstanding) {
12030 /*-
12031 * Already one pending, must get ACK back to clear the flag.
12032 */
12033 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EBUSY);
12034 return (EBUSY);
12035 }
12036 if ((send_in_req == 0) && (send_tsn_req == 0) &&
12037 (add_stream == 0)) {
12038 /* nothing to do */
12039 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12040 return (EINVAL);
12041 }
12042 if (send_tsn_req && send_in_req) {
12043 /* error, can't do that */
12044 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12045 return (EINVAL);
12046 } else if (send_in_req) {
12047 can_send_out_req = 1;
12048 }
12049 if (number_entries > (MCLBYTES -
12050 SCTP_MIN_OVERHEAD -
12051 sizeof(struct sctp_chunkhdr) -
12052 sizeof(struct sctp_stream_reset_out_request)) /
12053 sizeof(uint16_t)) {
12054 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12055 return (ENOMEM);
12056 }
12057 sctp_alloc_a_chunk(stcb, chk);
12058 if (chk == NULL) {
12059 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12060 return (ENOMEM);
12061 }
12062 chk->copy_by_ref = 0;
12063 chk->rec.chunk_id.id = SCTP_STREAM_RESET;
12064 chk->rec.chunk_id.can_take_data = 0;
12065 chk->flags = 0;
12066 chk->asoc = &stcb->asoc;
12067 chk->book_size = sizeof(struct sctp_chunkhdr);
12068 chk->send_size = SCTP_SIZE32(chk->book_size);
12069 chk->book_size_scale = 0;
12070 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
12071 if (chk->data == NULL) {
12072 sctp_free_a_chunk(stcb, chk, SCTP_SO_LOCKED);
12073 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12074 return (ENOMEM);
12075 }
12076 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
12077
12078 /* setup chunk parameters */
12079 chk->sent = SCTP_DATAGRAM_UNSENT;
12080 chk->snd_count = 0;
12081 if (stcb->asoc.alternate) {
12082 chk->whoTo = stcb->asoc.alternate;
12083 } else {
12084 chk->whoTo = stcb->asoc.primary_destination;
12085 }
12086 atomic_add_int(&chk->whoTo->ref_count, 1);
12087 ch = mtod(chk->data, struct sctp_chunkhdr *);
12088 ch->chunk_type = SCTP_STREAM_RESET;
12089 ch->chunk_flags = 0;
12090 ch->chunk_length = htons(chk->book_size);
12091 SCTP_BUF_LEN(chk->data) = chk->send_size;
12092
12093 seq = stcb->asoc.str_reset_seq_out;
12094 if (can_send_out_req) {
12095 int ret;
12096
12097 ret = sctp_add_stream_reset_out(stcb, chk, seq, (stcb->asoc.str_reset_seq_in - 1), (stcb->asoc.sending_seq - 1));
12098 if (ret) {
12099 seq++;
12100 asoc->stream_reset_outstanding++;
12101 }
12102 }
12103 if ((add_stream & 1) &&
12104 ((stcb->asoc.strm_realoutsize - stcb->asoc.streamoutcnt) < adding_o)) {
12105 /* Need to allocate more */
12106 struct sctp_stream_out *oldstream;
12107 struct sctp_stream_queue_pending *sp, *nsp;
12108 int i;
12109 #if defined(SCTP_DETAILED_STR_STATS)
12110 int j;
12111 #endif
12112
12113 oldstream = stcb->asoc.strmout;
12114 /* get some more */
12115 SCTP_MALLOC(stcb->asoc.strmout, struct sctp_stream_out *,
12116 (stcb->asoc.streamoutcnt + adding_o) * sizeof(struct sctp_stream_out),
12117 SCTP_M_STRMO);
12118 if (stcb->asoc.strmout == NULL) {
12119 uint8_t x;
12120
12121 stcb->asoc.strmout = oldstream;
12122 /* Turn off the bit */
12123 x = add_stream & 0xfe;
12124 add_stream = x;
12125 goto skip_stuff;
12126 }
12127 /*
12128 * Ok now we proceed with copying the old out stuff and
12129 * initializing the new stuff.
12130 */
12131 stcb->asoc.ss_functions.sctp_ss_clear(stcb, &stcb->asoc, false);
12132 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
12133 TAILQ_INIT(&stcb->asoc.strmout[i].outqueue);
12134 /* FIX ME FIX ME */
12135 /*
12136 * This should be a SS_COPY operation FIX ME STREAM
12137 * SCHEDULER EXPERT
12138 */
12139 stcb->asoc.ss_functions.sctp_ss_init_stream(stcb, &stcb->asoc.strmout[i], &oldstream[i]);
12140 stcb->asoc.strmout[i].chunks_on_queues = oldstream[i].chunks_on_queues;
12141 #if defined(SCTP_DETAILED_STR_STATS)
12142 for (j = 0; j < SCTP_PR_SCTP_MAX + 1; j++) {
12143 stcb->asoc.strmout[i].abandoned_sent[j] = oldstream[i].abandoned_sent[j];
12144 stcb->asoc.strmout[i].abandoned_unsent[j] = oldstream[i].abandoned_unsent[j];
12145 }
12146 #else
12147 stcb->asoc.strmout[i].abandoned_sent[0] = oldstream[i].abandoned_sent[0];
12148 stcb->asoc.strmout[i].abandoned_unsent[0] = oldstream[i].abandoned_unsent[0];
12149 #endif
12150 stcb->asoc.strmout[i].next_mid_ordered = oldstream[i].next_mid_ordered;
12151 stcb->asoc.strmout[i].next_mid_unordered = oldstream[i].next_mid_unordered;
12152 stcb->asoc.strmout[i].last_msg_incomplete = oldstream[i].last_msg_incomplete;
12153 stcb->asoc.strmout[i].sid = i;
12154 stcb->asoc.strmout[i].state = oldstream[i].state;
12155 /* now anything on those queues? */
12156 TAILQ_FOREACH_SAFE(sp, &oldstream[i].outqueue, next, nsp) {
12157 TAILQ_REMOVE(&oldstream[i].outqueue, sp, next);
12158 TAILQ_INSERT_TAIL(&stcb->asoc.strmout[i].outqueue, sp, next);
12159 }
12160 }
12161 /* now the new streams */
12162 stcb->asoc.ss_functions.sctp_ss_init(stcb, &stcb->asoc);
12163 for (i = stcb->asoc.streamoutcnt; i < (stcb->asoc.streamoutcnt + adding_o); i++) {
12164 TAILQ_INIT(&stcb->asoc.strmout[i].outqueue);
12165 stcb->asoc.strmout[i].chunks_on_queues = 0;
12166 #if defined(SCTP_DETAILED_STR_STATS)
12167 for (j = 0; j < SCTP_PR_SCTP_MAX + 1; j++) {
12168 stcb->asoc.strmout[i].abandoned_sent[j] = 0;
12169 stcb->asoc.strmout[i].abandoned_unsent[j] = 0;
12170 }
12171 #else
12172 stcb->asoc.strmout[i].abandoned_sent[0] = 0;
12173 stcb->asoc.strmout[i].abandoned_unsent[0] = 0;
12174 #endif
12175 stcb->asoc.strmout[i].next_mid_ordered = 0;
12176 stcb->asoc.strmout[i].next_mid_unordered = 0;
12177 stcb->asoc.strmout[i].sid = i;
12178 stcb->asoc.strmout[i].last_msg_incomplete = 0;
12179 stcb->asoc.ss_functions.sctp_ss_init_stream(stcb, &stcb->asoc.strmout[i], NULL);
12180 stcb->asoc.strmout[i].state = SCTP_STREAM_CLOSED;
12181 }
12182 stcb->asoc.strm_realoutsize = stcb->asoc.streamoutcnt + adding_o;
12183 SCTP_FREE(oldstream, SCTP_M_STRMO);
12184 }
12185 skip_stuff:
12186 if ((add_stream & 1) && (adding_o > 0)) {
12187 asoc->strm_pending_add_size = adding_o;
12188 asoc->peer_req_out = peer_asked;
12189 sctp_add_an_out_stream(chk, seq, adding_o);
12190 seq++;
12191 asoc->stream_reset_outstanding++;
12192 }
12193 if ((add_stream & 2) && (adding_i > 0)) {
12194 sctp_add_an_in_stream(chk, seq, adding_i);
12195 seq++;
12196 asoc->stream_reset_outstanding++;
12197 }
12198 if (send_in_req) {
12199 sctp_add_stream_reset_in(chk, number_entries, list, seq);
12200 seq++;
12201 asoc->stream_reset_outstanding++;
12202 }
12203 if (send_tsn_req) {
12204 sctp_add_stream_reset_tsn(chk, seq);
12205 asoc->stream_reset_outstanding++;
12206 }
12207 asoc->str_reset = chk;
12208 /* insert the chunk for sending */
12209 TAILQ_INSERT_TAIL(&asoc->control_send_queue,
12210 chk,
12211 sctp_next);
12212 asoc->ctrl_queue_cnt++;
12213 if (stcb->asoc.send_sack) {
12214 sctp_send_sack(stcb, SCTP_SO_LOCKED);
12215 }
12216 sctp_timer_start(SCTP_TIMER_TYPE_STRRESET, stcb->sctp_ep, stcb, chk->whoTo);
12217 return (0);
12218 }
12219
12220 void
12221 sctp_send_abort(struct mbuf *m, int iphlen, struct sockaddr *src, struct sockaddr *dst,
12222 struct sctphdr *sh, uint32_t vtag, struct mbuf *cause,
12223 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
12224 uint32_t vrf_id, uint16_t port)
12225 {
12226 /* Don't respond to an ABORT with an ABORT. */
12227 if (sctp_is_there_an_abort_here(m, iphlen, &vtag)) {
12228 if (cause)
12229 sctp_m_freem(cause);
12230 return;
12231 }
12232 sctp_send_resp_msg(src, dst, sh, vtag, SCTP_ABORT_ASSOCIATION, cause,
12233 mflowtype, mflowid, fibnum,
12234 vrf_id, port);
12235 return;
12236 }
12237
12238 void
12239 sctp_send_operr_to(struct sockaddr *src, struct sockaddr *dst,
12240 struct sctphdr *sh, uint32_t vtag, struct mbuf *cause,
12241 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
12242 uint32_t vrf_id, uint16_t port)
12243 {
12244 sctp_send_resp_msg(src, dst, sh, vtag, SCTP_OPERATION_ERROR, cause,
12245 mflowtype, mflowid, fibnum,
12246 vrf_id, port);
12247 return;
12248 }
12249
12250 static struct mbuf *
12251 sctp_copy_resume(struct uio *uio,
12252 int max_send_len,
12253 int user_marks_eor,
12254 int *error,
12255 uint32_t *sndout,
12256 struct mbuf **new_tail)
12257 {
12258 struct mbuf *m;
12259
12260 m = m_uiotombuf(uio, M_WAITOK, max_send_len, 0,
12261 (M_PKTHDR | (user_marks_eor ? M_EOR : 0)));
12262 if (m == NULL) {
12263 /* The only possible error is EFAULT. */
12264 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EFAULT);
12265 *error = EFAULT;
12266 } else {
12267 *sndout = m_length(m, NULL);
12268 *new_tail = m_last(m);
12269 }
12270 return (m);
12271 }
12272
12273 static int
12274 sctp_copy_one(struct sctp_stream_queue_pending *sp,
12275 struct uio *uio,
12276 int resv_upfront)
12277 {
12278 sp->data = m_uiotombuf(uio, M_WAITOK, sp->length, resv_upfront, 0);
12279 if (sp->data == NULL) {
12280 /* The only possible error is EFAULT. */
12281 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EFAULT);
12282 return (EFAULT);
12283 }
12284 sp->tail_mbuf = m_last(sp->data);
12285 return (0);
12286 }
12287
12288 static struct sctp_stream_queue_pending *
12289 sctp_copy_it_in(struct sctp_tcb *stcb,
12290 struct sctp_association *asoc,
12291 struct sctp_nonpad_sndrcvinfo *srcv,
12292 struct uio *uio,
12293 struct sctp_nets *net,
12294 ssize_t max_send_len,
12295 int user_marks_eor,
12296 int *error)
12297 {
12298
12299 /*-
12300 * This routine must be very careful in its work. Protocol
12301 * processing is up and running so care must be taken to spl...()
12302 * when you need to do something that may effect the stcb/asoc. The
12303 * sb is locked however. When data is copied the protocol processing
12304 * should be enabled since this is a slower operation...
12305 */
12306 struct sctp_stream_queue_pending *sp;
12307 int resv_in_first;
12308
12309 *error = 0;
12310 sctp_alloc_a_strmoq(stcb, sp);
12311 if (sp == NULL) {
12312 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12313 *error = ENOMEM;
12314 goto out_now;
12315 }
12316 sp->act_flags = 0;
12317 sp->sender_all_done = 0;
12318 sp->sinfo_flags = srcv->sinfo_flags;
12319 sp->timetolive = srcv->sinfo_timetolive;
12320 sp->ppid = srcv->sinfo_ppid;
12321 sp->context = srcv->sinfo_context;
12322 sp->fsn = 0;
12323 (void)SCTP_GETTIME_TIMEVAL(&sp->ts);
12324 sp->sid = srcv->sinfo_stream;
12325 sp->length = (uint32_t)min(uio->uio_resid, max_send_len);
12326 if ((sp->length == (uint32_t)uio->uio_resid) &&
12327 ((user_marks_eor == 0) ||
12328 (srcv->sinfo_flags & SCTP_EOF) ||
12329 (user_marks_eor && (srcv->sinfo_flags & SCTP_EOR)))) {
12330 sp->msg_is_complete = 1;
12331 } else {
12332 sp->msg_is_complete = 0;
12333 }
12334 sp->sender_all_done = 0;
12335 sp->some_taken = 0;
12336 sp->put_last_out = 0;
12337 resv_in_first = SCTP_DATA_CHUNK_OVERHEAD(stcb);
12338 sp->data = sp->tail_mbuf = NULL;
12339 if (sp->length == 0) {
12340 goto skip_copy;
12341 }
12342 if (srcv->sinfo_keynumber_valid) {
12343 sp->auth_keyid = srcv->sinfo_keynumber;
12344 } else {
12345 sp->auth_keyid = stcb->asoc.authinfo.active_keyid;
12346 }
12347 if (sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks)) {
12348 sctp_auth_key_acquire(stcb, sp->auth_keyid);
12349 sp->holds_key_ref = 1;
12350 }
12351 *error = sctp_copy_one(sp, uio, resv_in_first);
12352 skip_copy:
12353 if (*error) {
12354 sctp_free_a_strmoq(stcb, sp, SCTP_SO_LOCKED);
12355 sp = NULL;
12356 } else {
12357 if (sp->sinfo_flags & SCTP_ADDR_OVER) {
12358 sp->net = net;
12359 atomic_add_int(&sp->net->ref_count, 1);
12360 } else {
12361 sp->net = NULL;
12362 }
12363 sctp_set_prsctp_policy(sp);
12364 }
12365 out_now:
12366 return (sp);
12367 }
12368
12369 int
12370 sctp_sosend(struct socket *so,
12371 struct sockaddr *addr,
12372 struct uio *uio,
12373 struct mbuf *top,
12374 struct mbuf *control,
12375 int flags,
12376 struct thread *p)
12377 {
12378 struct sctp_sndrcvinfo sndrcvninfo;
12379 #if defined(INET) && defined(INET6)
12380 struct sockaddr_in sin;
12381 #endif
12382 struct sockaddr *addr_to_use;
12383 int error;
12384 bool use_sndinfo;
12385
12386 if (control != NULL) {
12387 /* process cmsg snd/rcv info (maybe a assoc-id) */
12388 use_sndinfo = sctp_find_cmsg(SCTP_SNDRCV, (void *)&sndrcvninfo, control, sizeof(sndrcvninfo));
12389 } else {
12390 use_sndinfo = false;
12391 }
12392 #if defined(INET) && defined(INET6)
12393 if ((addr != NULL) && (addr->sa_family == AF_INET6)) {
12394 struct sockaddr_in6 *sin6;
12395
12396 if (addr->sa_len != sizeof(struct sockaddr_in6)) {
12397 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12398 return (EINVAL);
12399 }
12400 sin6 = (struct sockaddr_in6 *)addr;
12401 if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
12402 in6_sin6_2_sin(&sin, sin6);
12403 addr_to_use = (struct sockaddr *)&sin;
12404 } else {
12405 addr_to_use = addr;
12406 }
12407 } else {
12408 addr_to_use = addr;
12409 }
12410 #else
12411 addr_to_use = addr;
12412 #endif
12413 error = sctp_lower_sosend(so, addr_to_use, uio, top, control, flags,
12414 use_sndinfo ? &sndrcvninfo : NULL, p);
12415 return (error);
12416 }
12417
12418 int
12419 sctp_lower_sosend(struct socket *so,
12420 struct sockaddr *addr,
12421 struct uio *uio,
12422 struct mbuf *top,
12423 struct mbuf *control,
12424 int flags,
12425 struct sctp_sndrcvinfo *srcv,
12426 struct thread *p)
12427 {
12428 struct sctp_nonpad_sndrcvinfo sndrcvninfo_buf;
12429 struct epoch_tracker et;
12430 struct timeval now;
12431 struct sctp_block_entry be;
12432 struct sctp_inpcb *inp;
12433 struct sctp_tcb *stcb = NULL;
12434 struct sctp_nets *net;
12435 struct sctp_association *asoc;
12436 struct sctp_inpcb *t_inp;
12437 struct sctp_nonpad_sndrcvinfo *sndrcvninfo;
12438 ssize_t sndlen = 0, max_len, local_add_more;
12439 ssize_t local_soresv = 0;
12440 sctp_assoc_t sinfo_assoc_id;
12441 int user_marks_eor;
12442 int nagle_applies = 0;
12443 int error;
12444 int queue_only = 0, queue_only_for_init = 0;
12445 int un_sent;
12446 int now_filled = 0;
12447 unsigned int inqueue_bytes = 0;
12448 uint16_t port;
12449 uint16_t sinfo_flags;
12450 uint16_t sinfo_stream;
12451 bool create_lock_applied = false;
12452 bool free_cnt_applied = false;
12453 bool some_on_control;
12454 bool got_all_of_the_send = false;
12455 bool non_blocking = false;
12456
12457 error = 0;
12458 net = NULL;
12459 stcb = NULL;
12460
12461 if ((uio == NULL) && (top == NULL)) {
12462 error = EINVAL;
12463 goto out_unlocked;
12464 }
12465 if (addr != NULL) {
12466 union sctp_sockstore *raddr = (union sctp_sockstore *)addr;
12467
12468 switch (raddr->sa.sa_family) {
12469 #ifdef INET
12470 case AF_INET:
12471 if (raddr->sin.sin_len != sizeof(struct sockaddr_in)) {
12472 error = EINVAL;
12473 goto out_unlocked;
12474 }
12475 port = raddr->sin.sin_port;
12476 break;
12477 #endif
12478 #ifdef INET6
12479 case AF_INET6:
12480 if (raddr->sin6.sin6_len != sizeof(struct sockaddr_in6)) {
12481 error = EINVAL;
12482 goto out_unlocked;
12483 }
12484 port = raddr->sin6.sin6_port;
12485 break;
12486 #endif
12487 default:
12488 error = EAFNOSUPPORT;
12489 goto out_unlocked;
12490 }
12491 } else {
12492 port = 0;
12493 }
12494 if (uio != NULL) {
12495 if (uio->uio_resid < 0) {
12496 error = EINVAL;
12497 goto out_unlocked;
12498 }
12499 sndlen = uio->uio_resid;
12500 } else {
12501 sndlen = SCTP_HEADER_LEN(top);
12502 }
12503 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Send called addr:%p send length %zd\n",
12504 (void *)addr, sndlen);
12505
12506 t_inp = inp = (struct sctp_inpcb *)so->so_pcb;
12507 if (inp == NULL) {
12508 error = EINVAL;
12509 goto out_unlocked;
12510 }
12511 user_marks_eor = sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXPLICIT_EOR);
12512 if ((uio == NULL) && (user_marks_eor != 0)) {
12513 /*-
12514 * We do not support eeor mode for
12515 * sending with mbuf chains (like sendfile).
12516 */
12517 error = EINVAL;
12518 goto out_unlocked;
12519 }
12520 if ((inp->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) &&
12521 SCTP_IS_LISTENING(inp)) {
12522 /* The listener can NOT send. */
12523 error = EINVAL;
12524 goto out_unlocked;
12525 }
12526 atomic_add_int(&inp->total_sends, 1);
12527
12528 if (srcv != NULL) {
12529 sndrcvninfo = (struct sctp_nonpad_sndrcvinfo *)srcv;
12530 sinfo_assoc_id = sndrcvninfo->sinfo_assoc_id;
12531 sinfo_flags = sndrcvninfo->sinfo_flags;
12532 if (INVALID_SINFO_FLAG(sinfo_flags) ||
12533 PR_SCTP_INVALID_POLICY(sinfo_flags)) {
12534 error = EINVAL;
12535 goto out_unlocked;
12536 }
12537 if (sinfo_flags != 0) {
12538 SCTP_STAT_INCR(sctps_sends_with_flags);
12539 }
12540 } else {
12541 sndrcvninfo = NULL;
12542 sinfo_flags = inp->def_send.sinfo_flags;
12543 sinfo_assoc_id = inp->def_send.sinfo_assoc_id;
12544 }
12545 if (flags & MSG_EOR) {
12546 sinfo_flags |= SCTP_EOR;
12547 }
12548 if (flags & MSG_EOF) {
12549 sinfo_flags |= SCTP_EOF;
12550 }
12551 if ((sinfo_flags & SCTP_ADDR_OVER) && (addr == NULL)) {
12552 error = EINVAL;
12553 goto out_unlocked;
12554 }
12555 SCTP_INP_RLOCK(inp);
12556 if ((sinfo_flags & SCTP_SENDALL) &&
12557 (inp->sctp_flags & SCTP_PCB_FLAGS_UDPTYPE)) {
12558 SCTP_INP_RUNLOCK(inp);
12559 error = sctp_sendall(inp, uio, top, sndrcvninfo);
12560 top = NULL;
12561 goto out_unlocked;
12562 }
12563 /* Now we must find the association. */
12564 if ((inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED) ||
12565 (inp->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) {
12566 stcb = LIST_FIRST(&inp->sctp_asoc_list);
12567 if (stcb != NULL) {
12568 SCTP_TCB_LOCK(stcb);
12569 }
12570 SCTP_INP_RUNLOCK(inp);
12571 } else if (sinfo_assoc_id > SCTP_ALL_ASSOC) {
12572 stcb = sctp_findasoc_ep_asocid_locked(inp, sinfo_assoc_id, 1);
12573 SCTP_INP_RUNLOCK(inp);
12574 if (stcb != NULL) {
12575 SCTP_TCB_LOCK_ASSERT(stcb);
12576 }
12577 } else if (addr != NULL) {
12578 /*-
12579 * Since we did not use findep we must
12580 * increment it, and if we don't find a tcb
12581 * decrement it.
12582 */
12583 SCTP_INP_INCR_REF(inp);
12584 SCTP_INP_RUNLOCK(inp);
12585 stcb = sctp_findassociation_ep_addr(&t_inp, addr, &net, NULL, NULL);
12586 if (stcb == NULL) {
12587 SCTP_INP_WLOCK(inp);
12588 SCTP_INP_DECR_REF(inp);
12589 SCTP_INP_WUNLOCK(inp);
12590 } else {
12591 SCTP_TCB_LOCK_ASSERT(stcb);
12592 }
12593 } else {
12594 SCTP_INP_RUNLOCK(inp);
12595 }
12596
12597 #ifdef INVARIANTS
12598 if (stcb != NULL) {
12599 SCTP_TCB_LOCK_ASSERT(stcb);
12600 }
12601 #endif
12602
12603 if ((stcb == NULL) && (addr != NULL)) {
12604 /* Possible implicit send? */
12605 SCTP_ASOC_CREATE_LOCK(inp);
12606 create_lock_applied = true;
12607 if ((inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
12608 (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_ALLGONE)) {
12609 error = EINVAL;
12610 goto out_unlocked;
12611 }
12612 if (((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) == 0) &&
12613 (addr->sa_family == AF_INET6)) {
12614 error = EINVAL;
12615 goto out_unlocked;
12616 }
12617 SCTP_INP_WLOCK(inp);
12618 SCTP_INP_INCR_REF(inp);
12619 SCTP_INP_WUNLOCK(inp);
12620 /* With the lock applied look again */
12621 stcb = sctp_findassociation_ep_addr(&t_inp, addr, &net, NULL, NULL);
12622 #if defined(INET) || defined(INET6)
12623 if ((stcb == NULL) && (control != NULL) && (port > 0)) {
12624 stcb = sctp_findassociation_cmsgs(&t_inp, port, control, &net, &error);
12625 }
12626 #endif
12627 if (stcb == NULL) {
12628 SCTP_INP_WLOCK(inp);
12629 SCTP_INP_DECR_REF(inp);
12630 SCTP_INP_WUNLOCK(inp);
12631 } else {
12632 SCTP_TCB_LOCK_ASSERT(stcb);
12633 SCTP_ASOC_CREATE_UNLOCK(inp);
12634 create_lock_applied = false;
12635 }
12636 if (error != 0) {
12637 goto out_unlocked;
12638 }
12639 if (t_inp != inp) {
12640 error = ENOTCONN;
12641 goto out_unlocked;
12642 }
12643 }
12644 if (stcb == NULL) {
12645 if (addr == NULL) {
12646 error = ENOENT;
12647 goto out_unlocked;
12648 } else {
12649 /* We must go ahead and start the INIT process */
12650 uint32_t vrf_id;
12651
12652 if ((sinfo_flags & SCTP_ABORT) ||
12653 ((sinfo_flags & SCTP_EOF) && (sndlen == 0))) {
12654 /*-
12655 * User asks to abort a non-existent assoc,
12656 * or EOF a non-existent assoc with no data
12657 */
12658 error = ENOENT;
12659 goto out_unlocked;
12660 }
12661 /* get an asoc/stcb struct */
12662 vrf_id = inp->def_vrf_id;
12663 KASSERT(create_lock_applied, ("create_lock_applied is false"));
12664 stcb = sctp_aloc_assoc_connected(inp, addr, &error, 0, 0, vrf_id,
12665 inp->sctp_ep.pre_open_stream_count,
12666 inp->sctp_ep.port,
12667 p,
12668 SCTP_INITIALIZE_AUTH_PARAMS);
12669 if (stcb == NULL) {
12670 /* error is setup for us in the call. */
12671 KASSERT(error != 0, ("error is 0 although stcb is NULL"));
12672 goto out_unlocked;
12673 }
12674 SCTP_TCB_LOCK_ASSERT(stcb);
12675 SCTP_ASOC_CREATE_UNLOCK(inp);
12676 create_lock_applied = false;
12677 /*
12678 * Turn on queue only flag to prevent data from
12679 * being sent
12680 */
12681 queue_only = 1;
12682 SCTP_SET_STATE(stcb, SCTP_STATE_COOKIE_WAIT);
12683 (void)SCTP_GETTIME_TIMEVAL(&stcb->asoc.time_entered);
12684 if (control != NULL) {
12685 if (sctp_process_cmsgs_for_init(stcb, control, &error)) {
12686 sctp_free_assoc(inp, stcb, SCTP_NORMAL_PROC,
12687 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_6);
12688 stcb = NULL;
12689 KASSERT(error != 0,
12690 ("error is 0 although sctp_process_cmsgs_for_init() indicated an error"));
12691 goto out_unlocked;
12692 }
12693 }
12694 /* out with the INIT */
12695 queue_only_for_init = 1;
12696 /*-
12697 * we may want to dig in after this call and adjust the MTU
12698 * value. It defaulted to 1500 (constant) but the ro
12699 * structure may now have an update and thus we may need to
12700 * change it BEFORE we append the message.
12701 */
12702 }
12703 }
12704
12705 KASSERT(!create_lock_applied, ("create_lock_applied is true"));
12706 KASSERT(stcb != NULL, ("stcb is NULL"));
12707 SCTP_TCB_LOCK_ASSERT(stcb);
12708
12709 asoc = &stcb->asoc;
12710 if ((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) ||
12711 (asoc->state & SCTP_STATE_WAS_ABORTED)) {
12712 if (asoc->state & SCTP_STATE_WAS_ABORTED) {
12713 /* XXX: Could also be ECONNABORTED, not enough info. */
12714 error = ECONNRESET;
12715 } else {
12716 error = ENOTCONN;
12717 }
12718 goto out_unlocked;
12719 }
12720 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT) ||
12721 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED)) {
12722 queue_only = 1;
12723 }
12724 /* Keep the stcb from being freed under our feet. */
12725 atomic_add_int(&asoc->refcnt, 1);
12726 free_cnt_applied = true;
12727 if (sndrcvninfo == NULL) {
12728 /* Use a local copy to have a consistent view. */
12729 sndrcvninfo_buf = asoc->def_send;
12730 sndrcvninfo = &sndrcvninfo_buf;
12731 sinfo_flags = sndrcvninfo->sinfo_flags;
12732 if (flags & MSG_EOR) {
12733 sinfo_flags |= SCTP_EOR;
12734 }
12735 if (flags & MSG_EOF) {
12736 sinfo_flags |= SCTP_EOF;
12737 }
12738 }
12739 /* Are we aborting? */
12740 if (sinfo_flags & SCTP_ABORT) {
12741 struct mbuf *mm;
12742 struct sctp_paramhdr *ph;
12743 ssize_t tot_demand, tot_out = 0, max_out;
12744
12745 SCTP_STAT_INCR(sctps_sends_with_abort);
12746 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT) ||
12747 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED)) {
12748 /* It has to be up before we abort. */
12749 error = EINVAL;
12750 goto out_unlocked;
12751 }
12752 /* How big is the user initiated abort? */
12753 if (top != NULL) {
12754 struct mbuf *cntm;
12755
12756 if (sndlen != 0) {
12757 for (cntm = top; cntm; cntm = SCTP_BUF_NEXT(cntm)) {
12758 tot_out += SCTP_BUF_LEN(cntm);
12759 }
12760 }
12761 mm = sctp_get_mbuf_for_msg(sizeof(struct sctp_paramhdr), 0, M_NOWAIT, 1, MT_DATA);
12762 } else {
12763 /* Must fit in a MTU */
12764 tot_out = sndlen;
12765 tot_demand = (tot_out + sizeof(struct sctp_paramhdr));
12766 if (tot_demand > SCTP_DEFAULT_ADD_MORE) {
12767 error = EMSGSIZE;
12768 goto out_unlocked;
12769 }
12770 mm = sctp_get_mbuf_for_msg((unsigned int)tot_demand, 0, M_NOWAIT, 1, MT_DATA);
12771 }
12772 if (mm == NULL) {
12773 error = ENOMEM;
12774 goto out_unlocked;
12775 }
12776 max_out = asoc->smallest_mtu - sizeof(struct sctp_paramhdr);
12777 max_out -= sizeof(struct sctp_abort_msg);
12778 if (tot_out > max_out) {
12779 tot_out = max_out;
12780 }
12781 ph = mtod(mm, struct sctp_paramhdr *);
12782 ph->param_type = htons(SCTP_CAUSE_USER_INITIATED_ABT);
12783 ph->param_length = htons((uint16_t)(sizeof(struct sctp_paramhdr) + tot_out));
12784 ph++;
12785 SCTP_BUF_LEN(mm) = (int)(tot_out + sizeof(struct sctp_paramhdr));
12786 if (top == NULL) {
12787 SCTP_TCB_UNLOCK(stcb);
12788 error = uiomove((caddr_t)ph, (int)tot_out, uio);
12789 SCTP_TCB_LOCK(stcb);
12790 if ((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) ||
12791 (asoc->state & SCTP_STATE_WAS_ABORTED)) {
12792 sctp_m_freem(mm);
12793 if (asoc->state & SCTP_STATE_WAS_ABORTED) {
12794 /*
12795 * XXX: Could also be ECONNABORTED,
12796 * not enough info.
12797 */
12798 error = ECONNRESET;
12799 } else {
12800 error = ENOTCONN;
12801 }
12802 goto out_unlocked;
12803 }
12804 if (error != 0) {
12805 /*-
12806 * Here if we can't get his data we
12807 * still abort we just don't get to
12808 * send the users note :-0
12809 */
12810 sctp_m_freem(mm);
12811 mm = NULL;
12812 error = 0;
12813 }
12814 } else {
12815 if (sndlen != 0) {
12816 SCTP_BUF_NEXT(mm) = top;
12817 }
12818 }
12819 atomic_subtract_int(&asoc->refcnt, 1);
12820 free_cnt_applied = false;
12821 /* release this lock, otherwise we hang on ourselves */
12822 NET_EPOCH_ENTER(et);
12823 sctp_abort_an_association(stcb->sctp_ep, stcb, mm, false, SCTP_SO_LOCKED);
12824 NET_EPOCH_EXIT(et);
12825 stcb = NULL;
12826 /*
12827 * In this case top is already chained to mm avoid double
12828 * free, since we free it below if top != NULL and driver
12829 * would free it after sending the packet out
12830 */
12831 if (sndlen != 0) {
12832 top = NULL;
12833 }
12834 goto out_unlocked;
12835 }
12836
12837 KASSERT(stcb != NULL, ("stcb is NULL"));
12838 SCTP_TCB_LOCK_ASSERT(stcb);
12839 KASSERT((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) == 0,
12840 ("Association about to be freed"));
12841 KASSERT((asoc->state & SCTP_STATE_WAS_ABORTED) == 0,
12842 ("Association was aborted"));
12843
12844 if (sinfo_flags & SCTP_ADDR_OVER) {
12845 if (addr != NULL) {
12846 net = sctp_findnet(stcb, addr);
12847 } else {
12848 net = NULL;
12849 }
12850 if ((net == NULL) ||
12851 ((port != 0) && (port != stcb->rport))) {
12852 error = EINVAL;
12853 goto out_unlocked;
12854 }
12855 } else {
12856 if (asoc->alternate != NULL) {
12857 net = asoc->alternate;
12858 } else {
12859 net = asoc->primary_destination;
12860 }
12861 }
12862 if (sndlen == 0) {
12863 if (sinfo_flags & SCTP_EOF) {
12864 got_all_of_the_send = true;
12865 goto dataless_eof;
12866 } else {
12867 error = EINVAL;
12868 goto out_unlocked;
12869 }
12870 }
12871 if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_NO_FRAGMENT)) {
12872 if (sndlen > (ssize_t)asoc->smallest_mtu) {
12873 error = EMSGSIZE;
12874 goto out_unlocked;
12875 }
12876 }
12877 sinfo_stream = sndrcvninfo->sinfo_stream;
12878 /* Is the stream no. valid? */
12879 if (sinfo_stream >= asoc->streamoutcnt) {
12880 /* Invalid stream number */
12881 error = EINVAL;
12882 goto out_unlocked;
12883 }
12884 if ((asoc->strmout[sinfo_stream].state != SCTP_STREAM_OPEN) &&
12885 (asoc->strmout[sinfo_stream].state != SCTP_STREAM_OPENING)) {
12886 /*
12887 * Can't queue any data while stream reset is underway.
12888 */
12889 if (asoc->strmout[sinfo_stream].state > SCTP_STREAM_OPEN) {
12890 error = EAGAIN;
12891 } else {
12892 error = EINVAL;
12893 }
12894 goto out_unlocked;
12895 }
12896 atomic_add_int(&stcb->total_sends, 1);
12897 if (SCTP_SO_IS_NBIO(so) || (flags & (MSG_NBIO | MSG_DONTWAIT)) != 0) {
12898 non_blocking = true;
12899 }
12900 if (non_blocking) {
12901 ssize_t amount;
12902
12903 inqueue_bytes = asoc->total_output_queue_size - (asoc->chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
12904 if (user_marks_eor == 0) {
12905 amount = sndlen;
12906 } else {
12907 amount = 1;
12908 }
12909 if ((SCTP_SB_LIMIT_SND(so) < (amount + inqueue_bytes + asoc->sb_send_resv)) ||
12910 (asoc->chunks_on_out_queue >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue))) {
12911 if ((sndlen > (ssize_t)SCTP_SB_LIMIT_SND(so)) &&
12912 (user_marks_eor == 0)) {
12913 error = EMSGSIZE;
12914 } else {
12915 error = EWOULDBLOCK;
12916 }
12917 goto out_unlocked;
12918 }
12919 }
12920 atomic_add_int(&asoc->sb_send_resv, (int)sndlen);
12921 local_soresv = sndlen;
12922
12923 KASSERT(stcb != NULL, ("stcb is NULL"));
12924 SCTP_TCB_LOCK_ASSERT(stcb);
12925 KASSERT((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) == 0,
12926 ("Association about to be freed"));
12927 KASSERT((asoc->state & SCTP_STATE_WAS_ABORTED) == 0,
12928 ("Association was aborted"));
12929
12930 /* Ok, we will attempt a msgsnd :> */
12931 if (p != NULL) {
12932 p->td_ru.ru_msgsnd++;
12933 }
12934 /* Calculate the maximum we can send */
12935 inqueue_bytes = asoc->total_output_queue_size - (asoc->chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
12936 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes) {
12937 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
12938 } else {
12939 max_len = 0;
12940 }
12941 /* Unless E_EOR mode is on, we must make a send FIT in one call. */
12942 if ((user_marks_eor == 0) &&
12943 (sndlen > (ssize_t)SCTP_SB_LIMIT_SND(stcb->sctp_socket))) {
12944 /* It will NEVER fit. */
12945 error = EMSGSIZE;
12946 goto out_unlocked;
12947 }
12948 if (user_marks_eor != 0) {
12949 local_add_more = (ssize_t)min(SCTP_SB_LIMIT_SND(so), SCTP_BASE_SYSCTL(sctp_add_more_threshold));
12950 } else {
12951 /*-
12952 * For non-eeor the whole message must fit in
12953 * the socket send buffer.
12954 */
12955 local_add_more = sndlen;
12956 }
12957 if (non_blocking) {
12958 goto skip_preblock;
12959 }
12960 if (((max_len <= local_add_more) && ((ssize_t)SCTP_SB_LIMIT_SND(so) >= local_add_more)) ||
12961 (max_len == 0) ||
12962 ((asoc->chunks_on_out_queue + asoc->stream_queue_cnt) >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue))) {
12963 /* No room right now! */
12964 inqueue_bytes = asoc->total_output_queue_size - (asoc->chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
12965 SOCKBUF_LOCK(&so->so_snd);
12966 while ((SCTP_SB_LIMIT_SND(so) < (inqueue_bytes + local_add_more)) ||
12967 ((asoc->stream_queue_cnt + asoc->chunks_on_out_queue) >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue))) {
12968 SCTPDBG(SCTP_DEBUG_OUTPUT1, "pre_block limit:%u <(inq:%d + %zd) || (%d+%d > %d)\n",
12969 (unsigned int)SCTP_SB_LIMIT_SND(so),
12970 inqueue_bytes,
12971 local_add_more,
12972 asoc->stream_queue_cnt,
12973 asoc->chunks_on_out_queue,
12974 SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue));
12975 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
12976 sctp_log_block(SCTP_BLOCK_LOG_INTO_BLKA, asoc, sndlen);
12977 }
12978 be.error = 0;
12979 stcb->block_entry = &be;
12980 SCTP_TCB_UNLOCK(stcb);
12981 error = sbwait(so, SO_SND);
12982 if (error == 0) {
12983 if (so->so_error != 0) {
12984 error = so->so_error;
12985 }
12986 if (be.error != 0) {
12987 error = be.error;
12988 }
12989 }
12990 SOCKBUF_UNLOCK(&so->so_snd);
12991 SCTP_TCB_LOCK(stcb);
12992 stcb->block_entry = NULL;
12993 if (error != 0) {
12994 goto out_unlocked;
12995 }
12996 if ((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) ||
12997 (asoc->state & SCTP_STATE_WAS_ABORTED)) {
12998 if (asoc->state & SCTP_STATE_WAS_ABORTED) {
12999 /*
13000 * XXX: Could also be ECONNABORTED,
13001 * not enough info.
13002 */
13003 error = ECONNRESET;
13004 } else {
13005 error = ENOTCONN;
13006 }
13007 goto out_unlocked;
13008 }
13009 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13010 sctp_log_block(SCTP_BLOCK_LOG_OUTOF_BLK,
13011 asoc, asoc->total_output_queue_size);
13012 }
13013 inqueue_bytes = asoc->total_output_queue_size - (asoc->chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13014 SOCKBUF_LOCK(&so->so_snd);
13015 }
13016 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes) {
13017 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13018 } else {
13019 max_len = 0;
13020 }
13021 SOCKBUF_UNLOCK(&so->so_snd);
13022 }
13023
13024 skip_preblock:
13025 KASSERT(stcb != NULL, ("stcb is NULL"));
13026 SCTP_TCB_LOCK_ASSERT(stcb);
13027 KASSERT((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) == 0,
13028 ("Association about to be freed"));
13029 KASSERT((asoc->state & SCTP_STATE_WAS_ABORTED) == 0,
13030 ("Association was aborted"));
13031
13032 /*
13033 * sndlen covers for mbuf case uio_resid covers for the non-mbuf
13034 * case NOTE: uio will be null when top/mbuf is passed
13035 */
13036 if (top == NULL) {
13037 struct sctp_stream_queue_pending *sp;
13038 struct sctp_stream_out *strm;
13039 uint32_t sndout;
13040
13041 if ((asoc->stream_locked) &&
13042 (asoc->stream_locked_on != sinfo_stream)) {
13043 error = EINVAL;
13044 goto out;
13045 }
13046 strm = &asoc->strmout[sinfo_stream];
13047 if (strm->last_msg_incomplete == 0) {
13048 do_a_copy_in:
13049 SCTP_TCB_UNLOCK(stcb);
13050 sp = sctp_copy_it_in(stcb, asoc, sndrcvninfo, uio, net, max_len, user_marks_eor, &error);
13051 SCTP_TCB_LOCK(stcb);
13052 if ((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) ||
13053 (asoc->state & SCTP_STATE_WAS_ABORTED)) {
13054 if (asoc->state & SCTP_STATE_WAS_ABORTED) {
13055 /*
13056 * XXX: Could also be ECONNABORTED,
13057 * not enough info.
13058 */
13059 error = ECONNRESET;
13060 } else {
13061 error = ENOTCONN;
13062 }
13063 goto out;
13064 }
13065 if (error != 0) {
13066 goto out;
13067 }
13068 /*
13069 * Reject the sending of a new user message, if the
13070 * association is about to be shut down.
13071 */
13072 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_SENT) ||
13073 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
13074 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_ACK_SENT) ||
13075 (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) {
13076 if (sp->data != 0) {
13077 sctp_m_freem(sp->data);
13078 sp->data = NULL;
13079 sp->tail_mbuf = NULL;
13080 sp->length = 0;
13081 }
13082 if (sp->net != NULL) {
13083 sctp_free_remote_addr(sp->net);
13084 sp->net = NULL;
13085 }
13086 sctp_free_a_strmoq(stcb, sp, SCTP_SO_LOCKED);
13087 error = EPIPE;
13088 goto out_unlocked;
13089 }
13090 /* The out streams might be reallocated. */
13091 strm = &asoc->strmout[sinfo_stream];
13092 if (sp->msg_is_complete) {
13093 strm->last_msg_incomplete = 0;
13094 asoc->stream_locked = 0;
13095 } else {
13096 /*
13097 * Just got locked to this guy in case of an
13098 * interrupt.
13099 */
13100 strm->last_msg_incomplete = 1;
13101 if (asoc->idata_supported == 0) {
13102 asoc->stream_locked = 1;
13103 asoc->stream_locked_on = sinfo_stream;
13104 }
13105 sp->sender_all_done = 0;
13106 }
13107 sctp_snd_sb_alloc(stcb, sp->length);
13108 atomic_add_int(&asoc->stream_queue_cnt, 1);
13109 if (sinfo_flags & SCTP_UNORDERED) {
13110 SCTP_STAT_INCR(sctps_sends_with_unord);
13111 }
13112 sp->processing = 1;
13113 TAILQ_INSERT_TAIL(&strm->outqueue, sp, next);
13114 asoc->ss_functions.sctp_ss_add_to_stream(stcb, asoc, strm, sp);
13115 } else {
13116 sp = TAILQ_LAST(&strm->outqueue, sctp_streamhead);
13117 if (sp == NULL) {
13118 /* ???? Huh ??? last msg is gone */
13119 #ifdef INVARIANTS
13120 panic("Warning: Last msg marked incomplete, yet nothing left?");
13121 #else
13122 SCTP_PRINTF("Warning: Last msg marked incomplete, yet nothing left?\n");
13123 strm->last_msg_incomplete = 0;
13124 #endif
13125 goto do_a_copy_in;
13126 }
13127 if (sp->processing != 0) {
13128 error = EINVAL;
13129 goto out;
13130 } else {
13131 sp->processing = 1;
13132 }
13133 }
13134
13135 KASSERT(stcb != NULL, ("stcb is NULL"));
13136 SCTP_TCB_LOCK_ASSERT(stcb);
13137 KASSERT((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) == 0,
13138 ("Association about to be freed"));
13139 KASSERT((asoc->state & SCTP_STATE_WAS_ABORTED) == 0,
13140 ("Association was aborted"));
13141
13142 while (uio->uio_resid > 0) {
13143 /* How much room do we have? */
13144 struct mbuf *new_tail, *mm;
13145
13146 inqueue_bytes = asoc->total_output_queue_size - (asoc->chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13147 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes) {
13148 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13149 } else {
13150 max_len = 0;
13151 }
13152 if ((max_len > (ssize_t)SCTP_BASE_SYSCTL(sctp_add_more_threshold)) ||
13153 ((max_len > 0) && (SCTP_SB_LIMIT_SND(so) < SCTP_BASE_SYSCTL(sctp_add_more_threshold))) ||
13154 (uio->uio_resid <= max_len)) {
13155 SCTP_TCB_UNLOCK(stcb);
13156 sndout = 0;
13157 new_tail = NULL;
13158 mm = sctp_copy_resume(uio, (int)max_len, user_marks_eor, &error, &sndout, &new_tail);
13159 SCTP_TCB_LOCK(stcb);
13160 if ((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) ||
13161 (asoc->state & SCTP_STATE_WAS_ABORTED)) {
13162 /*
13163 * We need to get out. Peer probably
13164 * aborted.
13165 */
13166 sctp_m_freem(mm);
13167 if (asoc->state & SCTP_STATE_WAS_ABORTED) {
13168 /*
13169 * XXX: Could also be
13170 * ECONNABORTED, not enough
13171 * info.
13172 */
13173 error = ECONNRESET;
13174 } else {
13175 error = ENOTCONN;
13176 }
13177 goto out;
13178 }
13179 if ((mm == NULL) || (error != 0)) {
13180 if (mm != NULL) {
13181 sctp_m_freem(mm);
13182 }
13183 if (sp != NULL) {
13184 sp->processing = 0;
13185 }
13186 goto out;
13187 }
13188 /* Update the mbuf and count */
13189 if (sp->tail_mbuf != NULL) {
13190 /* Tack it to the end. */
13191 SCTP_BUF_NEXT(sp->tail_mbuf) = mm;
13192 } else {
13193 /* A stolen mbuf. */
13194 sp->data = mm;
13195 }
13196 sp->tail_mbuf = new_tail;
13197 sctp_snd_sb_alloc(stcb, sndout);
13198 atomic_add_int(&sp->length, sndout);
13199 if (sinfo_flags & SCTP_SACK_IMMEDIATELY) {
13200 sp->sinfo_flags |= SCTP_SACK_IMMEDIATELY;
13201 }
13202
13203 /* Did we reach EOR? */
13204 if ((uio->uio_resid == 0) &&
13205 ((user_marks_eor == 0) ||
13206 (sinfo_flags & SCTP_EOF) ||
13207 (user_marks_eor && (sinfo_flags & SCTP_EOR)))) {
13208 sp->msg_is_complete = 1;
13209 } else {
13210 sp->msg_is_complete = 0;
13211 }
13212 }
13213
13214 KASSERT(stcb != NULL, ("stcb is NULL"));
13215 SCTP_TCB_LOCK_ASSERT(stcb);
13216 KASSERT((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) == 0,
13217 ("Association about to be freed"));
13218 KASSERT((asoc->state & SCTP_STATE_WAS_ABORTED) == 0,
13219 ("Association was aborted"));
13220
13221 if (uio->uio_resid == 0) {
13222 /* got it all? */
13223 continue;
13224 }
13225 /* PR-SCTP? */
13226 if ((asoc->prsctp_supported) && (asoc->sent_queue_cnt_removeable > 0)) {
13227 /*
13228 * This is ugly but we must assure locking
13229 * order
13230 */
13231 sctp_prune_prsctp(stcb, asoc, sndrcvninfo, (int)sndlen);
13232 inqueue_bytes = asoc->total_output_queue_size - (asoc->chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13233 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes)
13234 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13235 else
13236 max_len = 0;
13237 if (max_len > 0) {
13238 continue;
13239 }
13240 }
13241 /* wait for space now */
13242 if (non_blocking) {
13243 /* Non-blocking io in place out */
13244 if (sp != NULL) {
13245 sp->processing = 0;
13246 }
13247 goto skip_out_eof;
13248 }
13249 /* What about the INIT, send it maybe */
13250 if (queue_only_for_init) {
13251 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
13252 /* a collision took us forward? */
13253 queue_only = 0;
13254 } else {
13255 NET_EPOCH_ENTER(et);
13256 sctp_send_initiate(inp, stcb, SCTP_SO_LOCKED);
13257 NET_EPOCH_EXIT(et);
13258 SCTP_SET_STATE(stcb, SCTP_STATE_COOKIE_WAIT);
13259 queue_only = 1;
13260 }
13261 }
13262 if ((net->flight_size > net->cwnd) &&
13263 (asoc->sctp_cmt_on_off == 0)) {
13264 SCTP_STAT_INCR(sctps_send_cwnd_avoid);
13265 queue_only = 1;
13266 } else if (asoc->ifp_had_enobuf) {
13267 SCTP_STAT_INCR(sctps_ifnomemqueued);
13268 if (net->flight_size > (2 * net->mtu)) {
13269 queue_only = 1;
13270 }
13271 asoc->ifp_had_enobuf = 0;
13272 }
13273 un_sent = asoc->total_output_queue_size - asoc->total_flight;
13274 if ((sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY)) &&
13275 (asoc->total_flight > 0) &&
13276 (asoc->stream_queue_cnt < SCTP_MAX_DATA_BUNDLING) &&
13277 (un_sent < (int)(asoc->smallest_mtu - SCTP_MIN_OVERHEAD))) {
13278 /*-
13279 * Ok, Nagle is set on and we have data outstanding.
13280 * Don't send anything and let SACKs drive out the
13281 * data unless we have a "full" segment to send.
13282 */
13283 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13284 sctp_log_nagle_event(stcb, SCTP_NAGLE_APPLIED);
13285 }
13286 SCTP_STAT_INCR(sctps_naglequeued);
13287 nagle_applies = 1;
13288 } else {
13289 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13290 if (sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY))
13291 sctp_log_nagle_event(stcb, SCTP_NAGLE_SKIPPED);
13292 }
13293 SCTP_STAT_INCR(sctps_naglesent);
13294 nagle_applies = 0;
13295 }
13296 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13297 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, queue_only_for_init, queue_only,
13298 nagle_applies, un_sent);
13299 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, asoc->total_output_queue_size,
13300 asoc->total_flight,
13301 asoc->chunks_on_out_queue, asoc->total_flight_count);
13302 }
13303 if (queue_only_for_init) {
13304 queue_only_for_init = 0;
13305 }
13306 if ((queue_only == 0) && (nagle_applies == 0)) {
13307 /*-
13308 * need to start chunk output
13309 * before blocking.. note that if
13310 * a lock is already applied, then
13311 * the input via the net is happening
13312 * and I don't need to start output :-D
13313 */
13314 NET_EPOCH_ENTER(et);
13315 sctp_chunk_output(inp, stcb,
13316 SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13317 NET_EPOCH_EXIT(et);
13318 }
13319 /*-
13320 * This is a bit strange, but I think it will
13321 * work. The total_output_queue_size is locked and
13322 * protected by the TCB_LOCK, which we just released.
13323 * There is a race that can occur between releasing it
13324 * above, and me getting the socket lock, where sacks
13325 * come in but we have not put the SB_WAIT on the
13326 * so_snd buffer to get the wakeup. After the LOCK
13327 * is applied the sack_processing will also need to
13328 * LOCK the so->so_snd to do the actual sowwakeup(). So
13329 * once we have the socket buffer lock if we recheck the
13330 * size we KNOW we will get to sleep safely with the
13331 * wakeup flag in place.
13332 */
13333 inqueue_bytes = asoc->total_output_queue_size - (asoc->chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13334 SOCKBUF_LOCK(&so->so_snd);
13335 if (SCTP_SB_LIMIT_SND(so) <= (inqueue_bytes +
13336 min(SCTP_BASE_SYSCTL(sctp_add_more_threshold), SCTP_SB_LIMIT_SND(so)))) {
13337 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13338 sctp_log_block(SCTP_BLOCK_LOG_INTO_BLK,
13339 asoc, uio->uio_resid);
13340 }
13341 be.error = 0;
13342 stcb->block_entry = &be;
13343 SCTP_TCB_UNLOCK(stcb);
13344 error = sbwait(so, SO_SND);
13345 if (error == 0) {
13346 if (so->so_error != 0)
13347 error = so->so_error;
13348 if (be.error != 0) {
13349 error = be.error;
13350 }
13351 }
13352 SOCKBUF_UNLOCK(&so->so_snd);
13353 SCTP_TCB_LOCK(stcb);
13354 stcb->block_entry = NULL;
13355 if ((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) ||
13356 (asoc->state & SCTP_STATE_WAS_ABORTED)) {
13357 if (asoc->state & SCTP_STATE_WAS_ABORTED) {
13358 /*
13359 * XXX: Could also be
13360 * ECONNABORTED, not enough
13361 * info.
13362 */
13363 error = ECONNRESET;
13364 } else {
13365 error = ENOTCONN;
13366 }
13367 goto out_unlocked;
13368 }
13369 if (error != 0) {
13370 if (sp != NULL) {
13371 sp->processing = 0;
13372 }
13373 goto out_unlocked;
13374 }
13375 } else {
13376 SOCKBUF_UNLOCK(&so->so_snd);
13377 }
13378 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13379 sctp_log_block(SCTP_BLOCK_LOG_OUTOF_BLK,
13380 asoc, asoc->total_output_queue_size);
13381 }
13382 }
13383
13384 KASSERT(stcb != NULL, ("stcb is NULL"));
13385 SCTP_TCB_LOCK_ASSERT(stcb);
13386 KASSERT((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) == 0,
13387 ("Association about to be freed"));
13388 KASSERT((asoc->state & SCTP_STATE_WAS_ABORTED) == 0,
13389 ("Association was aborted"));
13390
13391 /* The out streams might be reallocated. */
13392 strm = &asoc->strmout[sinfo_stream];
13393 if (sp != NULL) {
13394 if (sp->msg_is_complete == 0) {
13395 strm->last_msg_incomplete = 1;
13396 if (asoc->idata_supported == 0) {
13397 asoc->stream_locked = 1;
13398 asoc->stream_locked_on = sinfo_stream;
13399 }
13400 } else {
13401 sp->sender_all_done = 1;
13402 strm->last_msg_incomplete = 0;
13403 asoc->stream_locked = 0;
13404 }
13405 sp->processing = 0;
13406 } else {
13407 SCTP_PRINTF("Huh no sp TSNH?\n");
13408 strm->last_msg_incomplete = 0;
13409 asoc->stream_locked = 0;
13410 }
13411 if (uio->uio_resid == 0) {
13412 got_all_of_the_send = true;
13413 }
13414 } else {
13415 error = sctp_msg_append(stcb, net, top, sndrcvninfo);
13416 top = NULL;
13417 if ((sinfo_flags & SCTP_EOF) != 0) {
13418 got_all_of_the_send = true;
13419 }
13420 }
13421 if (error != 0) {
13422 goto out;
13423 }
13424
13425 dataless_eof:
13426 KASSERT(stcb != NULL, ("stcb is NULL"));
13427 SCTP_TCB_LOCK_ASSERT(stcb);
13428 KASSERT((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) == 0,
13429 ("Association about to be freed"));
13430 KASSERT((asoc->state & SCTP_STATE_WAS_ABORTED) == 0,
13431 ("Association was aborted"));
13432
13433 /* EOF thing ? */
13434 if ((sinfo_flags & SCTP_EOF) && got_all_of_the_send) {
13435 SCTP_STAT_INCR(sctps_sends_with_eof);
13436 error = 0;
13437 if (TAILQ_EMPTY(&asoc->send_queue) &&
13438 TAILQ_EMPTY(&asoc->sent_queue) &&
13439 sctp_is_there_unsent_data(stcb, SCTP_SO_LOCKED) == 0) {
13440 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
13441 goto abort_anyway;
13442 }
13443 /* there is nothing queued to send, so I'm done... */
13444 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
13445 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
13446 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
13447 struct sctp_nets *netp;
13448
13449 /* only send SHUTDOWN the first time through */
13450 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
13451 SCTP_STAT_DECR_GAUGE32(sctps_currestab);
13452 }
13453 SCTP_SET_STATE(stcb, SCTP_STATE_SHUTDOWN_SENT);
13454 sctp_stop_timers_for_shutdown(stcb);
13455 if (asoc->alternate != NULL) {
13456 netp = asoc->alternate;
13457 } else {
13458 netp = asoc->primary_destination;
13459 }
13460 sctp_send_shutdown(stcb, netp);
13461 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN, stcb->sctp_ep, stcb,
13462 netp);
13463 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
13464 NULL);
13465 }
13466 } else {
13467 /*-
13468 * we still got (or just got) data to send, so set
13469 * SHUTDOWN_PENDING
13470 */
13471 /*-
13472 * XXX sockets draft says that SCTP_EOF should be
13473 * sent with no data. currently, we will allow user
13474 * data to be sent first and move to
13475 * SHUTDOWN-PENDING
13476 */
13477 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
13478 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
13479 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
13480 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
13481 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_PARTIAL_MSG_LEFT);
13482 }
13483 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_SHUTDOWN_PENDING);
13484 if (TAILQ_EMPTY(&asoc->send_queue) &&
13485 TAILQ_EMPTY(&asoc->sent_queue) &&
13486 (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT)) {
13487 struct mbuf *op_err;
13488 char msg[SCTP_DIAG_INFO_LEN];
13489
13490 abort_anyway:
13491 if (free_cnt_applied) {
13492 atomic_subtract_int(&asoc->refcnt, 1);
13493 free_cnt_applied = false;
13494 }
13495 SCTP_SNPRINTF(msg, sizeof(msg),
13496 "%s:%d at %s", __FILE__, __LINE__, __func__);
13497 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
13498 msg);
13499 NET_EPOCH_ENTER(et);
13500 sctp_abort_an_association(stcb->sctp_ep, stcb,
13501 op_err, false, SCTP_SO_LOCKED);
13502 NET_EPOCH_EXIT(et);
13503 stcb = NULL;
13504 error = ECONNABORTED;
13505 goto out;
13506 }
13507 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
13508 NULL);
13509 sctp_feature_off(inp, SCTP_PCB_FLAGS_NODELAY);
13510 }
13511 }
13512 }
13513
13514 skip_out_eof:
13515 KASSERT(stcb != NULL, ("stcb is NULL"));
13516 SCTP_TCB_LOCK_ASSERT(stcb);
13517 KASSERT((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) == 0,
13518 ("Association about to be freed"));
13519 KASSERT((asoc->state & SCTP_STATE_WAS_ABORTED) == 0,
13520 ("Association was aborted"));
13521
13522 some_on_control = !TAILQ_EMPTY(&asoc->control_send_queue);
13523 if (queue_only_for_init) {
13524 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
13525 /* a collision took us forward? */
13526 queue_only = 0;
13527 } else {
13528 NET_EPOCH_ENTER(et);
13529 sctp_send_initiate(inp, stcb, SCTP_SO_LOCKED);
13530 NET_EPOCH_EXIT(et);
13531 SCTP_SET_STATE(stcb, SCTP_STATE_COOKIE_WAIT);
13532 queue_only = 1;
13533 }
13534 }
13535
13536 KASSERT(stcb != NULL, ("stcb is NULL"));
13537 SCTP_TCB_LOCK_ASSERT(stcb);
13538 KASSERT((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) == 0,
13539 ("Association about to be freed"));
13540 KASSERT((asoc->state & SCTP_STATE_WAS_ABORTED) == 0,
13541 ("Association was aborted"));
13542
13543 if ((net->flight_size > net->cwnd) &&
13544 (asoc->sctp_cmt_on_off == 0)) {
13545 SCTP_STAT_INCR(sctps_send_cwnd_avoid);
13546 queue_only = 1;
13547 } else if (asoc->ifp_had_enobuf) {
13548 SCTP_STAT_INCR(sctps_ifnomemqueued);
13549 if (net->flight_size > (2 * net->mtu)) {
13550 queue_only = 1;
13551 }
13552 asoc->ifp_had_enobuf = 0;
13553 }
13554 un_sent = asoc->total_output_queue_size - asoc->total_flight;
13555 if ((sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY)) &&
13556 (asoc->total_flight > 0) &&
13557 (asoc->stream_queue_cnt < SCTP_MAX_DATA_BUNDLING) &&
13558 (un_sent < (int)(asoc->smallest_mtu - SCTP_MIN_OVERHEAD))) {
13559 /*-
13560 * Ok, Nagle is set on and we have data outstanding.
13561 * Don't send anything and let SACKs drive out the
13562 * data unless wen have a "full" segment to send.
13563 */
13564 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13565 sctp_log_nagle_event(stcb, SCTP_NAGLE_APPLIED);
13566 }
13567 SCTP_STAT_INCR(sctps_naglequeued);
13568 nagle_applies = 1;
13569 } else {
13570 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13571 if (sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY))
13572 sctp_log_nagle_event(stcb, SCTP_NAGLE_SKIPPED);
13573 }
13574 SCTP_STAT_INCR(sctps_naglesent);
13575 nagle_applies = 0;
13576 }
13577 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13578 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, queue_only_for_init, queue_only,
13579 nagle_applies, un_sent);
13580 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, asoc->total_output_queue_size,
13581 asoc->total_flight,
13582 asoc->chunks_on_out_queue, asoc->total_flight_count);
13583 }
13584
13585 KASSERT(stcb != NULL, ("stcb is NULL"));
13586 SCTP_TCB_LOCK_ASSERT(stcb);
13587 KASSERT((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) == 0,
13588 ("Association about to be freed"));
13589 KASSERT((asoc->state & SCTP_STATE_WAS_ABORTED) == 0,
13590 ("Association was aborted"));
13591
13592 NET_EPOCH_ENTER(et);
13593 if ((queue_only == 0) && (nagle_applies == 0) && (asoc->peers_rwnd && un_sent)) {
13594 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13595 } else if ((queue_only == 0) &&
13596 (asoc->peers_rwnd == 0) &&
13597 (asoc->total_flight == 0)) {
13598 /* We get to have a probe outstanding */
13599 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13600 } else if (some_on_control) {
13601 int num_out, reason;
13602
13603 /* Here we do control only */
13604 (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out,
13605 &reason, 1, 1, &now, &now_filled,
13606 sctp_get_frag_point(stcb),
13607 SCTP_SO_LOCKED);
13608 }
13609 NET_EPOCH_EXIT(et);
13610 SCTPDBG(SCTP_DEBUG_OUTPUT1, "USR Send complete qo:%d prw:%d unsent:%d tf:%d cooq:%d toqs:%d err:%d\n",
13611 queue_only, asoc->peers_rwnd, un_sent,
13612 asoc->total_flight, asoc->chunks_on_out_queue,
13613 asoc->total_output_queue_size, error);
13614
13615 KASSERT(stcb != NULL, ("stcb is NULL"));
13616 SCTP_TCB_LOCK_ASSERT(stcb);
13617 KASSERT((asoc->state & SCTP_STATE_ABOUT_TO_BE_FREED) == 0,
13618 ("Association about to be freed"));
13619 KASSERT((asoc->state & SCTP_STATE_WAS_ABORTED) == 0,
13620 ("Association was aborted"));
13621
13622 out:
13623 out_unlocked:
13624 if (create_lock_applied) {
13625 SCTP_ASOC_CREATE_UNLOCK(inp);
13626 }
13627 if (stcb != NULL) {
13628 if (local_soresv) {
13629 atomic_subtract_int(&asoc->sb_send_resv, (int)sndlen);
13630 }
13631 if (free_cnt_applied) {
13632 atomic_subtract_int(&asoc->refcnt, 1);
13633 }
13634 SCTP_TCB_UNLOCK(stcb);
13635 }
13636 if (top != NULL) {
13637 sctp_m_freem(top);
13638 }
13639 if (control != NULL) {
13640 sctp_m_freem(control);
13641 }
13642 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, error);
13643 return (error);
13644 }
13645
13646 /*
13647 * generate an AUTHentication chunk, if required
13648 */
13649 struct mbuf *
13650 sctp_add_auth_chunk(struct mbuf *m, struct mbuf **m_end,
13651 struct sctp_auth_chunk **auth_ret, uint32_t *offset,
13652 struct sctp_tcb *stcb, uint8_t chunk)
13653 {
13654 struct mbuf *m_auth;
13655 struct sctp_auth_chunk *auth;
13656 int chunk_len;
13657 struct mbuf *cn;
13658
13659 if ((m_end == NULL) || (auth_ret == NULL) || (offset == NULL) ||
13660 (stcb == NULL))
13661 return (m);
13662
13663 if (stcb->asoc.auth_supported == 0) {
13664 return (m);
13665 }
13666 /* does the requested chunk require auth? */
13667 if (!sctp_auth_is_required_chunk(chunk, stcb->asoc.peer_auth_chunks)) {
13668 return (m);
13669 }
13670 m_auth = sctp_get_mbuf_for_msg(sizeof(*auth), 0, M_NOWAIT, 1, MT_HEADER);
13671 if (m_auth == NULL) {
13672 /* no mbuf's */
13673 return (m);
13674 }
13675 /* reserve some space if this will be the first mbuf */
13676 if (m == NULL)
13677 SCTP_BUF_RESV_UF(m_auth, SCTP_MIN_OVERHEAD);
13678 /* fill in the AUTH chunk details */
13679 auth = mtod(m_auth, struct sctp_auth_chunk *);
13680 memset(auth, 0, sizeof(*auth));
13681 auth->ch.chunk_type = SCTP_AUTHENTICATION;
13682 auth->ch.chunk_flags = 0;
13683 chunk_len = sizeof(*auth) +
13684 sctp_get_hmac_digest_len(stcb->asoc.peer_hmac_id);
13685 auth->ch.chunk_length = htons(chunk_len);
13686 auth->hmac_id = htons(stcb->asoc.peer_hmac_id);
13687 /* key id and hmac digest will be computed and filled in upon send */
13688
13689 /* save the offset where the auth was inserted into the chain */
13690 *offset = 0;
13691 for (cn = m; cn; cn = SCTP_BUF_NEXT(cn)) {
13692 *offset += SCTP_BUF_LEN(cn);
13693 }
13694
13695 /* update length and return pointer to the auth chunk */
13696 SCTP_BUF_LEN(m_auth) = chunk_len;
13697 m = sctp_copy_mbufchain(m_auth, m, m_end, 1, chunk_len, 0);
13698 if (auth_ret != NULL)
13699 *auth_ret = auth;
13700
13701 return (m);
13702 }
13703
13704 #ifdef INET6
13705 int
13706 sctp_v6src_match_nexthop(struct sockaddr_in6 *src6, sctp_route_t *ro)
13707 {
13708 struct nd_prefix *pfx = NULL;
13709 struct nd_pfxrouter *pfxrtr = NULL;
13710 struct sockaddr_in6 gw6;
13711
13712 if (ro == NULL || ro->ro_nh == NULL || src6->sin6_family != AF_INET6)
13713 return (0);
13714
13715 /* get prefix entry of address */
13716 ND6_RLOCK();
13717 LIST_FOREACH(pfx, &MODULE_GLOBAL(nd_prefix), ndpr_entry) {
13718 if (pfx->ndpr_stateflags & NDPRF_DETACHED)
13719 continue;
13720 if (IN6_ARE_MASKED_ADDR_EQUAL(&pfx->ndpr_prefix.sin6_addr,
13721 &src6->sin6_addr, &pfx->ndpr_mask))
13722 break;
13723 }
13724 /* no prefix entry in the prefix list */
13725 if (pfx == NULL) {
13726 ND6_RUNLOCK();
13727 SCTPDBG(SCTP_DEBUG_OUTPUT2, "No prefix entry for ");
13728 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)src6);
13729 return (0);
13730 }
13731
13732 SCTPDBG(SCTP_DEBUG_OUTPUT2, "v6src_match_nexthop(), Prefix entry is ");
13733 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)src6);
13734
13735 /* search installed gateway from prefix entry */
13736 LIST_FOREACH(pfxrtr, &pfx->ndpr_advrtrs, pfr_entry) {
13737 memset(&gw6, 0, sizeof(struct sockaddr_in6));
13738 gw6.sin6_family = AF_INET6;
13739 gw6.sin6_len = sizeof(struct sockaddr_in6);
13740 memcpy(&gw6.sin6_addr, &pfxrtr->router->rtaddr,
13741 sizeof(struct in6_addr));
13742 SCTPDBG(SCTP_DEBUG_OUTPUT2, "prefix router is ");
13743 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)&gw6);
13744 SCTPDBG(SCTP_DEBUG_OUTPUT2, "installed router is ");
13745 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &ro->ro_nh->gw_sa);
13746 if (sctp_cmpaddr((struct sockaddr *)&gw6, &ro->ro_nh->gw_sa)) {
13747 ND6_RUNLOCK();
13748 SCTPDBG(SCTP_DEBUG_OUTPUT2, "pfxrouter is installed\n");
13749 return (1);
13750 }
13751 }
13752 ND6_RUNLOCK();
13753 SCTPDBG(SCTP_DEBUG_OUTPUT2, "pfxrouter is not installed\n");
13754 return (0);
13755 }
13756 #endif
13757
13758 int
13759 sctp_v4src_match_nexthop(struct sctp_ifa *sifa, sctp_route_t *ro)
13760 {
13761 #ifdef INET
13762 struct sockaddr_in *sin, *mask;
13763 struct ifaddr *ifa;
13764 struct in_addr srcnetaddr, gwnetaddr;
13765
13766 if (ro == NULL || ro->ro_nh == NULL ||
13767 sifa->address.sa.sa_family != AF_INET) {
13768 return (0);
13769 }
13770 ifa = (struct ifaddr *)sifa->ifa;
13771 mask = (struct sockaddr_in *)(ifa->ifa_netmask);
13772 sin = &sifa->address.sin;
13773 srcnetaddr.s_addr = (sin->sin_addr.s_addr & mask->sin_addr.s_addr);
13774 SCTPDBG(SCTP_DEBUG_OUTPUT1, "match_nexthop4: src address is ");
13775 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &sifa->address.sa);
13776 SCTPDBG(SCTP_DEBUG_OUTPUT1, "network address is %x\n", srcnetaddr.s_addr);
13777
13778 sin = &ro->ro_nh->gw4_sa;
13779 gwnetaddr.s_addr = (sin->sin_addr.s_addr & mask->sin_addr.s_addr);
13780 SCTPDBG(SCTP_DEBUG_OUTPUT1, "match_nexthop4: nexthop is ");
13781 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &ro->ro_nh->gw_sa);
13782 SCTPDBG(SCTP_DEBUG_OUTPUT1, "network address is %x\n", gwnetaddr.s_addr);
13783 if (srcnetaddr.s_addr == gwnetaddr.s_addr) {
13784 return (1);
13785 }
13786 #endif
13787 return (0);
13788 }
Cache object: 010105ee1a5c81a8b8e9f9cf1ef9f24a
|