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 #if defined(INET) || defined(INET6)
56 #include <netinet/udp.h>
57 #endif
58 #include <netinet/udp_var.h>
59 #include <machine/in_cksum.h>
60 #include <netinet/in_kdtrace.h>
61
62
63
64 #define SCTP_MAX_GAPS_INARRAY 4
65 struct sack_track {
66 uint8_t right_edge; /* mergable on the right edge */
67 uint8_t left_edge; /* mergable on the left edge */
68 uint8_t num_entries;
69 uint8_t spare;
70 struct sctp_gap_ack_block gaps[SCTP_MAX_GAPS_INARRAY];
71 };
72
73 const struct sack_track sack_array[256] = {
74 {0, 0, 0, 0, /* 0x00 */
75 {{0, 0},
76 {0, 0},
77 {0, 0},
78 {0, 0}
79 }
80 },
81 {1, 0, 1, 0, /* 0x01 */
82 {{0, 0},
83 {0, 0},
84 {0, 0},
85 {0, 0}
86 }
87 },
88 {0, 0, 1, 0, /* 0x02 */
89 {{1, 1},
90 {0, 0},
91 {0, 0},
92 {0, 0}
93 }
94 },
95 {1, 0, 1, 0, /* 0x03 */
96 {{0, 1},
97 {0, 0},
98 {0, 0},
99 {0, 0}
100 }
101 },
102 {0, 0, 1, 0, /* 0x04 */
103 {{2, 2},
104 {0, 0},
105 {0, 0},
106 {0, 0}
107 }
108 },
109 {1, 0, 2, 0, /* 0x05 */
110 {{0, 0},
111 {2, 2},
112 {0, 0},
113 {0, 0}
114 }
115 },
116 {0, 0, 1, 0, /* 0x06 */
117 {{1, 2},
118 {0, 0},
119 {0, 0},
120 {0, 0}
121 }
122 },
123 {1, 0, 1, 0, /* 0x07 */
124 {{0, 2},
125 {0, 0},
126 {0, 0},
127 {0, 0}
128 }
129 },
130 {0, 0, 1, 0, /* 0x08 */
131 {{3, 3},
132 {0, 0},
133 {0, 0},
134 {0, 0}
135 }
136 },
137 {1, 0, 2, 0, /* 0x09 */
138 {{0, 0},
139 {3, 3},
140 {0, 0},
141 {0, 0}
142 }
143 },
144 {0, 0, 2, 0, /* 0x0a */
145 {{1, 1},
146 {3, 3},
147 {0, 0},
148 {0, 0}
149 }
150 },
151 {1, 0, 2, 0, /* 0x0b */
152 {{0, 1},
153 {3, 3},
154 {0, 0},
155 {0, 0}
156 }
157 },
158 {0, 0, 1, 0, /* 0x0c */
159 {{2, 3},
160 {0, 0},
161 {0, 0},
162 {0, 0}
163 }
164 },
165 {1, 0, 2, 0, /* 0x0d */
166 {{0, 0},
167 {2, 3},
168 {0, 0},
169 {0, 0}
170 }
171 },
172 {0, 0, 1, 0, /* 0x0e */
173 {{1, 3},
174 {0, 0},
175 {0, 0},
176 {0, 0}
177 }
178 },
179 {1, 0, 1, 0, /* 0x0f */
180 {{0, 3},
181 {0, 0},
182 {0, 0},
183 {0, 0}
184 }
185 },
186 {0, 0, 1, 0, /* 0x10 */
187 {{4, 4},
188 {0, 0},
189 {0, 0},
190 {0, 0}
191 }
192 },
193 {1, 0, 2, 0, /* 0x11 */
194 {{0, 0},
195 {4, 4},
196 {0, 0},
197 {0, 0}
198 }
199 },
200 {0, 0, 2, 0, /* 0x12 */
201 {{1, 1},
202 {4, 4},
203 {0, 0},
204 {0, 0}
205 }
206 },
207 {1, 0, 2, 0, /* 0x13 */
208 {{0, 1},
209 {4, 4},
210 {0, 0},
211 {0, 0}
212 }
213 },
214 {0, 0, 2, 0, /* 0x14 */
215 {{2, 2},
216 {4, 4},
217 {0, 0},
218 {0, 0}
219 }
220 },
221 {1, 0, 3, 0, /* 0x15 */
222 {{0, 0},
223 {2, 2},
224 {4, 4},
225 {0, 0}
226 }
227 },
228 {0, 0, 2, 0, /* 0x16 */
229 {{1, 2},
230 {4, 4},
231 {0, 0},
232 {0, 0}
233 }
234 },
235 {1, 0, 2, 0, /* 0x17 */
236 {{0, 2},
237 {4, 4},
238 {0, 0},
239 {0, 0}
240 }
241 },
242 {0, 0, 1, 0, /* 0x18 */
243 {{3, 4},
244 {0, 0},
245 {0, 0},
246 {0, 0}
247 }
248 },
249 {1, 0, 2, 0, /* 0x19 */
250 {{0, 0},
251 {3, 4},
252 {0, 0},
253 {0, 0}
254 }
255 },
256 {0, 0, 2, 0, /* 0x1a */
257 {{1, 1},
258 {3, 4},
259 {0, 0},
260 {0, 0}
261 }
262 },
263 {1, 0, 2, 0, /* 0x1b */
264 {{0, 1},
265 {3, 4},
266 {0, 0},
267 {0, 0}
268 }
269 },
270 {0, 0, 1, 0, /* 0x1c */
271 {{2, 4},
272 {0, 0},
273 {0, 0},
274 {0, 0}
275 }
276 },
277 {1, 0, 2, 0, /* 0x1d */
278 {{0, 0},
279 {2, 4},
280 {0, 0},
281 {0, 0}
282 }
283 },
284 {0, 0, 1, 0, /* 0x1e */
285 {{1, 4},
286 {0, 0},
287 {0, 0},
288 {0, 0}
289 }
290 },
291 {1, 0, 1, 0, /* 0x1f */
292 {{0, 4},
293 {0, 0},
294 {0, 0},
295 {0, 0}
296 }
297 },
298 {0, 0, 1, 0, /* 0x20 */
299 {{5, 5},
300 {0, 0},
301 {0, 0},
302 {0, 0}
303 }
304 },
305 {1, 0, 2, 0, /* 0x21 */
306 {{0, 0},
307 {5, 5},
308 {0, 0},
309 {0, 0}
310 }
311 },
312 {0, 0, 2, 0, /* 0x22 */
313 {{1, 1},
314 {5, 5},
315 {0, 0},
316 {0, 0}
317 }
318 },
319 {1, 0, 2, 0, /* 0x23 */
320 {{0, 1},
321 {5, 5},
322 {0, 0},
323 {0, 0}
324 }
325 },
326 {0, 0, 2, 0, /* 0x24 */
327 {{2, 2},
328 {5, 5},
329 {0, 0},
330 {0, 0}
331 }
332 },
333 {1, 0, 3, 0, /* 0x25 */
334 {{0, 0},
335 {2, 2},
336 {5, 5},
337 {0, 0}
338 }
339 },
340 {0, 0, 2, 0, /* 0x26 */
341 {{1, 2},
342 {5, 5},
343 {0, 0},
344 {0, 0}
345 }
346 },
347 {1, 0, 2, 0, /* 0x27 */
348 {{0, 2},
349 {5, 5},
350 {0, 0},
351 {0, 0}
352 }
353 },
354 {0, 0, 2, 0, /* 0x28 */
355 {{3, 3},
356 {5, 5},
357 {0, 0},
358 {0, 0}
359 }
360 },
361 {1, 0, 3, 0, /* 0x29 */
362 {{0, 0},
363 {3, 3},
364 {5, 5},
365 {0, 0}
366 }
367 },
368 {0, 0, 3, 0, /* 0x2a */
369 {{1, 1},
370 {3, 3},
371 {5, 5},
372 {0, 0}
373 }
374 },
375 {1, 0, 3, 0, /* 0x2b */
376 {{0, 1},
377 {3, 3},
378 {5, 5},
379 {0, 0}
380 }
381 },
382 {0, 0, 2, 0, /* 0x2c */
383 {{2, 3},
384 {5, 5},
385 {0, 0},
386 {0, 0}
387 }
388 },
389 {1, 0, 3, 0, /* 0x2d */
390 {{0, 0},
391 {2, 3},
392 {5, 5},
393 {0, 0}
394 }
395 },
396 {0, 0, 2, 0, /* 0x2e */
397 {{1, 3},
398 {5, 5},
399 {0, 0},
400 {0, 0}
401 }
402 },
403 {1, 0, 2, 0, /* 0x2f */
404 {{0, 3},
405 {5, 5},
406 {0, 0},
407 {0, 0}
408 }
409 },
410 {0, 0, 1, 0, /* 0x30 */
411 {{4, 5},
412 {0, 0},
413 {0, 0},
414 {0, 0}
415 }
416 },
417 {1, 0, 2, 0, /* 0x31 */
418 {{0, 0},
419 {4, 5},
420 {0, 0},
421 {0, 0}
422 }
423 },
424 {0, 0, 2, 0, /* 0x32 */
425 {{1, 1},
426 {4, 5},
427 {0, 0},
428 {0, 0}
429 }
430 },
431 {1, 0, 2, 0, /* 0x33 */
432 {{0, 1},
433 {4, 5},
434 {0, 0},
435 {0, 0}
436 }
437 },
438 {0, 0, 2, 0, /* 0x34 */
439 {{2, 2},
440 {4, 5},
441 {0, 0},
442 {0, 0}
443 }
444 },
445 {1, 0, 3, 0, /* 0x35 */
446 {{0, 0},
447 {2, 2},
448 {4, 5},
449 {0, 0}
450 }
451 },
452 {0, 0, 2, 0, /* 0x36 */
453 {{1, 2},
454 {4, 5},
455 {0, 0},
456 {0, 0}
457 }
458 },
459 {1, 0, 2, 0, /* 0x37 */
460 {{0, 2},
461 {4, 5},
462 {0, 0},
463 {0, 0}
464 }
465 },
466 {0, 0, 1, 0, /* 0x38 */
467 {{3, 5},
468 {0, 0},
469 {0, 0},
470 {0, 0}
471 }
472 },
473 {1, 0, 2, 0, /* 0x39 */
474 {{0, 0},
475 {3, 5},
476 {0, 0},
477 {0, 0}
478 }
479 },
480 {0, 0, 2, 0, /* 0x3a */
481 {{1, 1},
482 {3, 5},
483 {0, 0},
484 {0, 0}
485 }
486 },
487 {1, 0, 2, 0, /* 0x3b */
488 {{0, 1},
489 {3, 5},
490 {0, 0},
491 {0, 0}
492 }
493 },
494 {0, 0, 1, 0, /* 0x3c */
495 {{2, 5},
496 {0, 0},
497 {0, 0},
498 {0, 0}
499 }
500 },
501 {1, 0, 2, 0, /* 0x3d */
502 {{0, 0},
503 {2, 5},
504 {0, 0},
505 {0, 0}
506 }
507 },
508 {0, 0, 1, 0, /* 0x3e */
509 {{1, 5},
510 {0, 0},
511 {0, 0},
512 {0, 0}
513 }
514 },
515 {1, 0, 1, 0, /* 0x3f */
516 {{0, 5},
517 {0, 0},
518 {0, 0},
519 {0, 0}
520 }
521 },
522 {0, 0, 1, 0, /* 0x40 */
523 {{6, 6},
524 {0, 0},
525 {0, 0},
526 {0, 0}
527 }
528 },
529 {1, 0, 2, 0, /* 0x41 */
530 {{0, 0},
531 {6, 6},
532 {0, 0},
533 {0, 0}
534 }
535 },
536 {0, 0, 2, 0, /* 0x42 */
537 {{1, 1},
538 {6, 6},
539 {0, 0},
540 {0, 0}
541 }
542 },
543 {1, 0, 2, 0, /* 0x43 */
544 {{0, 1},
545 {6, 6},
546 {0, 0},
547 {0, 0}
548 }
549 },
550 {0, 0, 2, 0, /* 0x44 */
551 {{2, 2},
552 {6, 6},
553 {0, 0},
554 {0, 0}
555 }
556 },
557 {1, 0, 3, 0, /* 0x45 */
558 {{0, 0},
559 {2, 2},
560 {6, 6},
561 {0, 0}
562 }
563 },
564 {0, 0, 2, 0, /* 0x46 */
565 {{1, 2},
566 {6, 6},
567 {0, 0},
568 {0, 0}
569 }
570 },
571 {1, 0, 2, 0, /* 0x47 */
572 {{0, 2},
573 {6, 6},
574 {0, 0},
575 {0, 0}
576 }
577 },
578 {0, 0, 2, 0, /* 0x48 */
579 {{3, 3},
580 {6, 6},
581 {0, 0},
582 {0, 0}
583 }
584 },
585 {1, 0, 3, 0, /* 0x49 */
586 {{0, 0},
587 {3, 3},
588 {6, 6},
589 {0, 0}
590 }
591 },
592 {0, 0, 3, 0, /* 0x4a */
593 {{1, 1},
594 {3, 3},
595 {6, 6},
596 {0, 0}
597 }
598 },
599 {1, 0, 3, 0, /* 0x4b */
600 {{0, 1},
601 {3, 3},
602 {6, 6},
603 {0, 0}
604 }
605 },
606 {0, 0, 2, 0, /* 0x4c */
607 {{2, 3},
608 {6, 6},
609 {0, 0},
610 {0, 0}
611 }
612 },
613 {1, 0, 3, 0, /* 0x4d */
614 {{0, 0},
615 {2, 3},
616 {6, 6},
617 {0, 0}
618 }
619 },
620 {0, 0, 2, 0, /* 0x4e */
621 {{1, 3},
622 {6, 6},
623 {0, 0},
624 {0, 0}
625 }
626 },
627 {1, 0, 2, 0, /* 0x4f */
628 {{0, 3},
629 {6, 6},
630 {0, 0},
631 {0, 0}
632 }
633 },
634 {0, 0, 2, 0, /* 0x50 */
635 {{4, 4},
636 {6, 6},
637 {0, 0},
638 {0, 0}
639 }
640 },
641 {1, 0, 3, 0, /* 0x51 */
642 {{0, 0},
643 {4, 4},
644 {6, 6},
645 {0, 0}
646 }
647 },
648 {0, 0, 3, 0, /* 0x52 */
649 {{1, 1},
650 {4, 4},
651 {6, 6},
652 {0, 0}
653 }
654 },
655 {1, 0, 3, 0, /* 0x53 */
656 {{0, 1},
657 {4, 4},
658 {6, 6},
659 {0, 0}
660 }
661 },
662 {0, 0, 3, 0, /* 0x54 */
663 {{2, 2},
664 {4, 4},
665 {6, 6},
666 {0, 0}
667 }
668 },
669 {1, 0, 4, 0, /* 0x55 */
670 {{0, 0},
671 {2, 2},
672 {4, 4},
673 {6, 6}
674 }
675 },
676 {0, 0, 3, 0, /* 0x56 */
677 {{1, 2},
678 {4, 4},
679 {6, 6},
680 {0, 0}
681 }
682 },
683 {1, 0, 3, 0, /* 0x57 */
684 {{0, 2},
685 {4, 4},
686 {6, 6},
687 {0, 0}
688 }
689 },
690 {0, 0, 2, 0, /* 0x58 */
691 {{3, 4},
692 {6, 6},
693 {0, 0},
694 {0, 0}
695 }
696 },
697 {1, 0, 3, 0, /* 0x59 */
698 {{0, 0},
699 {3, 4},
700 {6, 6},
701 {0, 0}
702 }
703 },
704 {0, 0, 3, 0, /* 0x5a */
705 {{1, 1},
706 {3, 4},
707 {6, 6},
708 {0, 0}
709 }
710 },
711 {1, 0, 3, 0, /* 0x5b */
712 {{0, 1},
713 {3, 4},
714 {6, 6},
715 {0, 0}
716 }
717 },
718 {0, 0, 2, 0, /* 0x5c */
719 {{2, 4},
720 {6, 6},
721 {0, 0},
722 {0, 0}
723 }
724 },
725 {1, 0, 3, 0, /* 0x5d */
726 {{0, 0},
727 {2, 4},
728 {6, 6},
729 {0, 0}
730 }
731 },
732 {0, 0, 2, 0, /* 0x5e */
733 {{1, 4},
734 {6, 6},
735 {0, 0},
736 {0, 0}
737 }
738 },
739 {1, 0, 2, 0, /* 0x5f */
740 {{0, 4},
741 {6, 6},
742 {0, 0},
743 {0, 0}
744 }
745 },
746 {0, 0, 1, 0, /* 0x60 */
747 {{5, 6},
748 {0, 0},
749 {0, 0},
750 {0, 0}
751 }
752 },
753 {1, 0, 2, 0, /* 0x61 */
754 {{0, 0},
755 {5, 6},
756 {0, 0},
757 {0, 0}
758 }
759 },
760 {0, 0, 2, 0, /* 0x62 */
761 {{1, 1},
762 {5, 6},
763 {0, 0},
764 {0, 0}
765 }
766 },
767 {1, 0, 2, 0, /* 0x63 */
768 {{0, 1},
769 {5, 6},
770 {0, 0},
771 {0, 0}
772 }
773 },
774 {0, 0, 2, 0, /* 0x64 */
775 {{2, 2},
776 {5, 6},
777 {0, 0},
778 {0, 0}
779 }
780 },
781 {1, 0, 3, 0, /* 0x65 */
782 {{0, 0},
783 {2, 2},
784 {5, 6},
785 {0, 0}
786 }
787 },
788 {0, 0, 2, 0, /* 0x66 */
789 {{1, 2},
790 {5, 6},
791 {0, 0},
792 {0, 0}
793 }
794 },
795 {1, 0, 2, 0, /* 0x67 */
796 {{0, 2},
797 {5, 6},
798 {0, 0},
799 {0, 0}
800 }
801 },
802 {0, 0, 2, 0, /* 0x68 */
803 {{3, 3},
804 {5, 6},
805 {0, 0},
806 {0, 0}
807 }
808 },
809 {1, 0, 3, 0, /* 0x69 */
810 {{0, 0},
811 {3, 3},
812 {5, 6},
813 {0, 0}
814 }
815 },
816 {0, 0, 3, 0, /* 0x6a */
817 {{1, 1},
818 {3, 3},
819 {5, 6},
820 {0, 0}
821 }
822 },
823 {1, 0, 3, 0, /* 0x6b */
824 {{0, 1},
825 {3, 3},
826 {5, 6},
827 {0, 0}
828 }
829 },
830 {0, 0, 2, 0, /* 0x6c */
831 {{2, 3},
832 {5, 6},
833 {0, 0},
834 {0, 0}
835 }
836 },
837 {1, 0, 3, 0, /* 0x6d */
838 {{0, 0},
839 {2, 3},
840 {5, 6},
841 {0, 0}
842 }
843 },
844 {0, 0, 2, 0, /* 0x6e */
845 {{1, 3},
846 {5, 6},
847 {0, 0},
848 {0, 0}
849 }
850 },
851 {1, 0, 2, 0, /* 0x6f */
852 {{0, 3},
853 {5, 6},
854 {0, 0},
855 {0, 0}
856 }
857 },
858 {0, 0, 1, 0, /* 0x70 */
859 {{4, 6},
860 {0, 0},
861 {0, 0},
862 {0, 0}
863 }
864 },
865 {1, 0, 2, 0, /* 0x71 */
866 {{0, 0},
867 {4, 6},
868 {0, 0},
869 {0, 0}
870 }
871 },
872 {0, 0, 2, 0, /* 0x72 */
873 {{1, 1},
874 {4, 6},
875 {0, 0},
876 {0, 0}
877 }
878 },
879 {1, 0, 2, 0, /* 0x73 */
880 {{0, 1},
881 {4, 6},
882 {0, 0},
883 {0, 0}
884 }
885 },
886 {0, 0, 2, 0, /* 0x74 */
887 {{2, 2},
888 {4, 6},
889 {0, 0},
890 {0, 0}
891 }
892 },
893 {1, 0, 3, 0, /* 0x75 */
894 {{0, 0},
895 {2, 2},
896 {4, 6},
897 {0, 0}
898 }
899 },
900 {0, 0, 2, 0, /* 0x76 */
901 {{1, 2},
902 {4, 6},
903 {0, 0},
904 {0, 0}
905 }
906 },
907 {1, 0, 2, 0, /* 0x77 */
908 {{0, 2},
909 {4, 6},
910 {0, 0},
911 {0, 0}
912 }
913 },
914 {0, 0, 1, 0, /* 0x78 */
915 {{3, 6},
916 {0, 0},
917 {0, 0},
918 {0, 0}
919 }
920 },
921 {1, 0, 2, 0, /* 0x79 */
922 {{0, 0},
923 {3, 6},
924 {0, 0},
925 {0, 0}
926 }
927 },
928 {0, 0, 2, 0, /* 0x7a */
929 {{1, 1},
930 {3, 6},
931 {0, 0},
932 {0, 0}
933 }
934 },
935 {1, 0, 2, 0, /* 0x7b */
936 {{0, 1},
937 {3, 6},
938 {0, 0},
939 {0, 0}
940 }
941 },
942 {0, 0, 1, 0, /* 0x7c */
943 {{2, 6},
944 {0, 0},
945 {0, 0},
946 {0, 0}
947 }
948 },
949 {1, 0, 2, 0, /* 0x7d */
950 {{0, 0},
951 {2, 6},
952 {0, 0},
953 {0, 0}
954 }
955 },
956 {0, 0, 1, 0, /* 0x7e */
957 {{1, 6},
958 {0, 0},
959 {0, 0},
960 {0, 0}
961 }
962 },
963 {1, 0, 1, 0, /* 0x7f */
964 {{0, 6},
965 {0, 0},
966 {0, 0},
967 {0, 0}
968 }
969 },
970 {0, 1, 1, 0, /* 0x80 */
971 {{7, 7},
972 {0, 0},
973 {0, 0},
974 {0, 0}
975 }
976 },
977 {1, 1, 2, 0, /* 0x81 */
978 {{0, 0},
979 {7, 7},
980 {0, 0},
981 {0, 0}
982 }
983 },
984 {0, 1, 2, 0, /* 0x82 */
985 {{1, 1},
986 {7, 7},
987 {0, 0},
988 {0, 0}
989 }
990 },
991 {1, 1, 2, 0, /* 0x83 */
992 {{0, 1},
993 {7, 7},
994 {0, 0},
995 {0, 0}
996 }
997 },
998 {0, 1, 2, 0, /* 0x84 */
999 {{2, 2},
1000 {7, 7},
1001 {0, 0},
1002 {0, 0}
1003 }
1004 },
1005 {1, 1, 3, 0, /* 0x85 */
1006 {{0, 0},
1007 {2, 2},
1008 {7, 7},
1009 {0, 0}
1010 }
1011 },
1012 {0, 1, 2, 0, /* 0x86 */
1013 {{1, 2},
1014 {7, 7},
1015 {0, 0},
1016 {0, 0}
1017 }
1018 },
1019 {1, 1, 2, 0, /* 0x87 */
1020 {{0, 2},
1021 {7, 7},
1022 {0, 0},
1023 {0, 0}
1024 }
1025 },
1026 {0, 1, 2, 0, /* 0x88 */
1027 {{3, 3},
1028 {7, 7},
1029 {0, 0},
1030 {0, 0}
1031 }
1032 },
1033 {1, 1, 3, 0, /* 0x89 */
1034 {{0, 0},
1035 {3, 3},
1036 {7, 7},
1037 {0, 0}
1038 }
1039 },
1040 {0, 1, 3, 0, /* 0x8a */
1041 {{1, 1},
1042 {3, 3},
1043 {7, 7},
1044 {0, 0}
1045 }
1046 },
1047 {1, 1, 3, 0, /* 0x8b */
1048 {{0, 1},
1049 {3, 3},
1050 {7, 7},
1051 {0, 0}
1052 }
1053 },
1054 {0, 1, 2, 0, /* 0x8c */
1055 {{2, 3},
1056 {7, 7},
1057 {0, 0},
1058 {0, 0}
1059 }
1060 },
1061 {1, 1, 3, 0, /* 0x8d */
1062 {{0, 0},
1063 {2, 3},
1064 {7, 7},
1065 {0, 0}
1066 }
1067 },
1068 {0, 1, 2, 0, /* 0x8e */
1069 {{1, 3},
1070 {7, 7},
1071 {0, 0},
1072 {0, 0}
1073 }
1074 },
1075 {1, 1, 2, 0, /* 0x8f */
1076 {{0, 3},
1077 {7, 7},
1078 {0, 0},
1079 {0, 0}
1080 }
1081 },
1082 {0, 1, 2, 0, /* 0x90 */
1083 {{4, 4},
1084 {7, 7},
1085 {0, 0},
1086 {0, 0}
1087 }
1088 },
1089 {1, 1, 3, 0, /* 0x91 */
1090 {{0, 0},
1091 {4, 4},
1092 {7, 7},
1093 {0, 0}
1094 }
1095 },
1096 {0, 1, 3, 0, /* 0x92 */
1097 {{1, 1},
1098 {4, 4},
1099 {7, 7},
1100 {0, 0}
1101 }
1102 },
1103 {1, 1, 3, 0, /* 0x93 */
1104 {{0, 1},
1105 {4, 4},
1106 {7, 7},
1107 {0, 0}
1108 }
1109 },
1110 {0, 1, 3, 0, /* 0x94 */
1111 {{2, 2},
1112 {4, 4},
1113 {7, 7},
1114 {0, 0}
1115 }
1116 },
1117 {1, 1, 4, 0, /* 0x95 */
1118 {{0, 0},
1119 {2, 2},
1120 {4, 4},
1121 {7, 7}
1122 }
1123 },
1124 {0, 1, 3, 0, /* 0x96 */
1125 {{1, 2},
1126 {4, 4},
1127 {7, 7},
1128 {0, 0}
1129 }
1130 },
1131 {1, 1, 3, 0, /* 0x97 */
1132 {{0, 2},
1133 {4, 4},
1134 {7, 7},
1135 {0, 0}
1136 }
1137 },
1138 {0, 1, 2, 0, /* 0x98 */
1139 {{3, 4},
1140 {7, 7},
1141 {0, 0},
1142 {0, 0}
1143 }
1144 },
1145 {1, 1, 3, 0, /* 0x99 */
1146 {{0, 0},
1147 {3, 4},
1148 {7, 7},
1149 {0, 0}
1150 }
1151 },
1152 {0, 1, 3, 0, /* 0x9a */
1153 {{1, 1},
1154 {3, 4},
1155 {7, 7},
1156 {0, 0}
1157 }
1158 },
1159 {1, 1, 3, 0, /* 0x9b */
1160 {{0, 1},
1161 {3, 4},
1162 {7, 7},
1163 {0, 0}
1164 }
1165 },
1166 {0, 1, 2, 0, /* 0x9c */
1167 {{2, 4},
1168 {7, 7},
1169 {0, 0},
1170 {0, 0}
1171 }
1172 },
1173 {1, 1, 3, 0, /* 0x9d */
1174 {{0, 0},
1175 {2, 4},
1176 {7, 7},
1177 {0, 0}
1178 }
1179 },
1180 {0, 1, 2, 0, /* 0x9e */
1181 {{1, 4},
1182 {7, 7},
1183 {0, 0},
1184 {0, 0}
1185 }
1186 },
1187 {1, 1, 2, 0, /* 0x9f */
1188 {{0, 4},
1189 {7, 7},
1190 {0, 0},
1191 {0, 0}
1192 }
1193 },
1194 {0, 1, 2, 0, /* 0xa0 */
1195 {{5, 5},
1196 {7, 7},
1197 {0, 0},
1198 {0, 0}
1199 }
1200 },
1201 {1, 1, 3, 0, /* 0xa1 */
1202 {{0, 0},
1203 {5, 5},
1204 {7, 7},
1205 {0, 0}
1206 }
1207 },
1208 {0, 1, 3, 0, /* 0xa2 */
1209 {{1, 1},
1210 {5, 5},
1211 {7, 7},
1212 {0, 0}
1213 }
1214 },
1215 {1, 1, 3, 0, /* 0xa3 */
1216 {{0, 1},
1217 {5, 5},
1218 {7, 7},
1219 {0, 0}
1220 }
1221 },
1222 {0, 1, 3, 0, /* 0xa4 */
1223 {{2, 2},
1224 {5, 5},
1225 {7, 7},
1226 {0, 0}
1227 }
1228 },
1229 {1, 1, 4, 0, /* 0xa5 */
1230 {{0, 0},
1231 {2, 2},
1232 {5, 5},
1233 {7, 7}
1234 }
1235 },
1236 {0, 1, 3, 0, /* 0xa6 */
1237 {{1, 2},
1238 {5, 5},
1239 {7, 7},
1240 {0, 0}
1241 }
1242 },
1243 {1, 1, 3, 0, /* 0xa7 */
1244 {{0, 2},
1245 {5, 5},
1246 {7, 7},
1247 {0, 0}
1248 }
1249 },
1250 {0, 1, 3, 0, /* 0xa8 */
1251 {{3, 3},
1252 {5, 5},
1253 {7, 7},
1254 {0, 0}
1255 }
1256 },
1257 {1, 1, 4, 0, /* 0xa9 */
1258 {{0, 0},
1259 {3, 3},
1260 {5, 5},
1261 {7, 7}
1262 }
1263 },
1264 {0, 1, 4, 0, /* 0xaa */
1265 {{1, 1},
1266 {3, 3},
1267 {5, 5},
1268 {7, 7}
1269 }
1270 },
1271 {1, 1, 4, 0, /* 0xab */
1272 {{0, 1},
1273 {3, 3},
1274 {5, 5},
1275 {7, 7}
1276 }
1277 },
1278 {0, 1, 3, 0, /* 0xac */
1279 {{2, 3},
1280 {5, 5},
1281 {7, 7},
1282 {0, 0}
1283 }
1284 },
1285 {1, 1, 4, 0, /* 0xad */
1286 {{0, 0},
1287 {2, 3},
1288 {5, 5},
1289 {7, 7}
1290 }
1291 },
1292 {0, 1, 3, 0, /* 0xae */
1293 {{1, 3},
1294 {5, 5},
1295 {7, 7},
1296 {0, 0}
1297 }
1298 },
1299 {1, 1, 3, 0, /* 0xaf */
1300 {{0, 3},
1301 {5, 5},
1302 {7, 7},
1303 {0, 0}
1304 }
1305 },
1306 {0, 1, 2, 0, /* 0xb0 */
1307 {{4, 5},
1308 {7, 7},
1309 {0, 0},
1310 {0, 0}
1311 }
1312 },
1313 {1, 1, 3, 0, /* 0xb1 */
1314 {{0, 0},
1315 {4, 5},
1316 {7, 7},
1317 {0, 0}
1318 }
1319 },
1320 {0, 1, 3, 0, /* 0xb2 */
1321 {{1, 1},
1322 {4, 5},
1323 {7, 7},
1324 {0, 0}
1325 }
1326 },
1327 {1, 1, 3, 0, /* 0xb3 */
1328 {{0, 1},
1329 {4, 5},
1330 {7, 7},
1331 {0, 0}
1332 }
1333 },
1334 {0, 1, 3, 0, /* 0xb4 */
1335 {{2, 2},
1336 {4, 5},
1337 {7, 7},
1338 {0, 0}
1339 }
1340 },
1341 {1, 1, 4, 0, /* 0xb5 */
1342 {{0, 0},
1343 {2, 2},
1344 {4, 5},
1345 {7, 7}
1346 }
1347 },
1348 {0, 1, 3, 0, /* 0xb6 */
1349 {{1, 2},
1350 {4, 5},
1351 {7, 7},
1352 {0, 0}
1353 }
1354 },
1355 {1, 1, 3, 0, /* 0xb7 */
1356 {{0, 2},
1357 {4, 5},
1358 {7, 7},
1359 {0, 0}
1360 }
1361 },
1362 {0, 1, 2, 0, /* 0xb8 */
1363 {{3, 5},
1364 {7, 7},
1365 {0, 0},
1366 {0, 0}
1367 }
1368 },
1369 {1, 1, 3, 0, /* 0xb9 */
1370 {{0, 0},
1371 {3, 5},
1372 {7, 7},
1373 {0, 0}
1374 }
1375 },
1376 {0, 1, 3, 0, /* 0xba */
1377 {{1, 1},
1378 {3, 5},
1379 {7, 7},
1380 {0, 0}
1381 }
1382 },
1383 {1, 1, 3, 0, /* 0xbb */
1384 {{0, 1},
1385 {3, 5},
1386 {7, 7},
1387 {0, 0}
1388 }
1389 },
1390 {0, 1, 2, 0, /* 0xbc */
1391 {{2, 5},
1392 {7, 7},
1393 {0, 0},
1394 {0, 0}
1395 }
1396 },
1397 {1, 1, 3, 0, /* 0xbd */
1398 {{0, 0},
1399 {2, 5},
1400 {7, 7},
1401 {0, 0}
1402 }
1403 },
1404 {0, 1, 2, 0, /* 0xbe */
1405 {{1, 5},
1406 {7, 7},
1407 {0, 0},
1408 {0, 0}
1409 }
1410 },
1411 {1, 1, 2, 0, /* 0xbf */
1412 {{0, 5},
1413 {7, 7},
1414 {0, 0},
1415 {0, 0}
1416 }
1417 },
1418 {0, 1, 1, 0, /* 0xc0 */
1419 {{6, 7},
1420 {0, 0},
1421 {0, 0},
1422 {0, 0}
1423 }
1424 },
1425 {1, 1, 2, 0, /* 0xc1 */
1426 {{0, 0},
1427 {6, 7},
1428 {0, 0},
1429 {0, 0}
1430 }
1431 },
1432 {0, 1, 2, 0, /* 0xc2 */
1433 {{1, 1},
1434 {6, 7},
1435 {0, 0},
1436 {0, 0}
1437 }
1438 },
1439 {1, 1, 2, 0, /* 0xc3 */
1440 {{0, 1},
1441 {6, 7},
1442 {0, 0},
1443 {0, 0}
1444 }
1445 },
1446 {0, 1, 2, 0, /* 0xc4 */
1447 {{2, 2},
1448 {6, 7},
1449 {0, 0},
1450 {0, 0}
1451 }
1452 },
1453 {1, 1, 3, 0, /* 0xc5 */
1454 {{0, 0},
1455 {2, 2},
1456 {6, 7},
1457 {0, 0}
1458 }
1459 },
1460 {0, 1, 2, 0, /* 0xc6 */
1461 {{1, 2},
1462 {6, 7},
1463 {0, 0},
1464 {0, 0}
1465 }
1466 },
1467 {1, 1, 2, 0, /* 0xc7 */
1468 {{0, 2},
1469 {6, 7},
1470 {0, 0},
1471 {0, 0}
1472 }
1473 },
1474 {0, 1, 2, 0, /* 0xc8 */
1475 {{3, 3},
1476 {6, 7},
1477 {0, 0},
1478 {0, 0}
1479 }
1480 },
1481 {1, 1, 3, 0, /* 0xc9 */
1482 {{0, 0},
1483 {3, 3},
1484 {6, 7},
1485 {0, 0}
1486 }
1487 },
1488 {0, 1, 3, 0, /* 0xca */
1489 {{1, 1},
1490 {3, 3},
1491 {6, 7},
1492 {0, 0}
1493 }
1494 },
1495 {1, 1, 3, 0, /* 0xcb */
1496 {{0, 1},
1497 {3, 3},
1498 {6, 7},
1499 {0, 0}
1500 }
1501 },
1502 {0, 1, 2, 0, /* 0xcc */
1503 {{2, 3},
1504 {6, 7},
1505 {0, 0},
1506 {0, 0}
1507 }
1508 },
1509 {1, 1, 3, 0, /* 0xcd */
1510 {{0, 0},
1511 {2, 3},
1512 {6, 7},
1513 {0, 0}
1514 }
1515 },
1516 {0, 1, 2, 0, /* 0xce */
1517 {{1, 3},
1518 {6, 7},
1519 {0, 0},
1520 {0, 0}
1521 }
1522 },
1523 {1, 1, 2, 0, /* 0xcf */
1524 {{0, 3},
1525 {6, 7},
1526 {0, 0},
1527 {0, 0}
1528 }
1529 },
1530 {0, 1, 2, 0, /* 0xd0 */
1531 {{4, 4},
1532 {6, 7},
1533 {0, 0},
1534 {0, 0}
1535 }
1536 },
1537 {1, 1, 3, 0, /* 0xd1 */
1538 {{0, 0},
1539 {4, 4},
1540 {6, 7},
1541 {0, 0}
1542 }
1543 },
1544 {0, 1, 3, 0, /* 0xd2 */
1545 {{1, 1},
1546 {4, 4},
1547 {6, 7},
1548 {0, 0}
1549 }
1550 },
1551 {1, 1, 3, 0, /* 0xd3 */
1552 {{0, 1},
1553 {4, 4},
1554 {6, 7},
1555 {0, 0}
1556 }
1557 },
1558 {0, 1, 3, 0, /* 0xd4 */
1559 {{2, 2},
1560 {4, 4},
1561 {6, 7},
1562 {0, 0}
1563 }
1564 },
1565 {1, 1, 4, 0, /* 0xd5 */
1566 {{0, 0},
1567 {2, 2},
1568 {4, 4},
1569 {6, 7}
1570 }
1571 },
1572 {0, 1, 3, 0, /* 0xd6 */
1573 {{1, 2},
1574 {4, 4},
1575 {6, 7},
1576 {0, 0}
1577 }
1578 },
1579 {1, 1, 3, 0, /* 0xd7 */
1580 {{0, 2},
1581 {4, 4},
1582 {6, 7},
1583 {0, 0}
1584 }
1585 },
1586 {0, 1, 2, 0, /* 0xd8 */
1587 {{3, 4},
1588 {6, 7},
1589 {0, 0},
1590 {0, 0}
1591 }
1592 },
1593 {1, 1, 3, 0, /* 0xd9 */
1594 {{0, 0},
1595 {3, 4},
1596 {6, 7},
1597 {0, 0}
1598 }
1599 },
1600 {0, 1, 3, 0, /* 0xda */
1601 {{1, 1},
1602 {3, 4},
1603 {6, 7},
1604 {0, 0}
1605 }
1606 },
1607 {1, 1, 3, 0, /* 0xdb */
1608 {{0, 1},
1609 {3, 4},
1610 {6, 7},
1611 {0, 0}
1612 }
1613 },
1614 {0, 1, 2, 0, /* 0xdc */
1615 {{2, 4},
1616 {6, 7},
1617 {0, 0},
1618 {0, 0}
1619 }
1620 },
1621 {1, 1, 3, 0, /* 0xdd */
1622 {{0, 0},
1623 {2, 4},
1624 {6, 7},
1625 {0, 0}
1626 }
1627 },
1628 {0, 1, 2, 0, /* 0xde */
1629 {{1, 4},
1630 {6, 7},
1631 {0, 0},
1632 {0, 0}
1633 }
1634 },
1635 {1, 1, 2, 0, /* 0xdf */
1636 {{0, 4},
1637 {6, 7},
1638 {0, 0},
1639 {0, 0}
1640 }
1641 },
1642 {0, 1, 1, 0, /* 0xe0 */
1643 {{5, 7},
1644 {0, 0},
1645 {0, 0},
1646 {0, 0}
1647 }
1648 },
1649 {1, 1, 2, 0, /* 0xe1 */
1650 {{0, 0},
1651 {5, 7},
1652 {0, 0},
1653 {0, 0}
1654 }
1655 },
1656 {0, 1, 2, 0, /* 0xe2 */
1657 {{1, 1},
1658 {5, 7},
1659 {0, 0},
1660 {0, 0}
1661 }
1662 },
1663 {1, 1, 2, 0, /* 0xe3 */
1664 {{0, 1},
1665 {5, 7},
1666 {0, 0},
1667 {0, 0}
1668 }
1669 },
1670 {0, 1, 2, 0, /* 0xe4 */
1671 {{2, 2},
1672 {5, 7},
1673 {0, 0},
1674 {0, 0}
1675 }
1676 },
1677 {1, 1, 3, 0, /* 0xe5 */
1678 {{0, 0},
1679 {2, 2},
1680 {5, 7},
1681 {0, 0}
1682 }
1683 },
1684 {0, 1, 2, 0, /* 0xe6 */
1685 {{1, 2},
1686 {5, 7},
1687 {0, 0},
1688 {0, 0}
1689 }
1690 },
1691 {1, 1, 2, 0, /* 0xe7 */
1692 {{0, 2},
1693 {5, 7},
1694 {0, 0},
1695 {0, 0}
1696 }
1697 },
1698 {0, 1, 2, 0, /* 0xe8 */
1699 {{3, 3},
1700 {5, 7},
1701 {0, 0},
1702 {0, 0}
1703 }
1704 },
1705 {1, 1, 3, 0, /* 0xe9 */
1706 {{0, 0},
1707 {3, 3},
1708 {5, 7},
1709 {0, 0}
1710 }
1711 },
1712 {0, 1, 3, 0, /* 0xea */
1713 {{1, 1},
1714 {3, 3},
1715 {5, 7},
1716 {0, 0}
1717 }
1718 },
1719 {1, 1, 3, 0, /* 0xeb */
1720 {{0, 1},
1721 {3, 3},
1722 {5, 7},
1723 {0, 0}
1724 }
1725 },
1726 {0, 1, 2, 0, /* 0xec */
1727 {{2, 3},
1728 {5, 7},
1729 {0, 0},
1730 {0, 0}
1731 }
1732 },
1733 {1, 1, 3, 0, /* 0xed */
1734 {{0, 0},
1735 {2, 3},
1736 {5, 7},
1737 {0, 0}
1738 }
1739 },
1740 {0, 1, 2, 0, /* 0xee */
1741 {{1, 3},
1742 {5, 7},
1743 {0, 0},
1744 {0, 0}
1745 }
1746 },
1747 {1, 1, 2, 0, /* 0xef */
1748 {{0, 3},
1749 {5, 7},
1750 {0, 0},
1751 {0, 0}
1752 }
1753 },
1754 {0, 1, 1, 0, /* 0xf0 */
1755 {{4, 7},
1756 {0, 0},
1757 {0, 0},
1758 {0, 0}
1759 }
1760 },
1761 {1, 1, 2, 0, /* 0xf1 */
1762 {{0, 0},
1763 {4, 7},
1764 {0, 0},
1765 {0, 0}
1766 }
1767 },
1768 {0, 1, 2, 0, /* 0xf2 */
1769 {{1, 1},
1770 {4, 7},
1771 {0, 0},
1772 {0, 0}
1773 }
1774 },
1775 {1, 1, 2, 0, /* 0xf3 */
1776 {{0, 1},
1777 {4, 7},
1778 {0, 0},
1779 {0, 0}
1780 }
1781 },
1782 {0, 1, 2, 0, /* 0xf4 */
1783 {{2, 2},
1784 {4, 7},
1785 {0, 0},
1786 {0, 0}
1787 }
1788 },
1789 {1, 1, 3, 0, /* 0xf5 */
1790 {{0, 0},
1791 {2, 2},
1792 {4, 7},
1793 {0, 0}
1794 }
1795 },
1796 {0, 1, 2, 0, /* 0xf6 */
1797 {{1, 2},
1798 {4, 7},
1799 {0, 0},
1800 {0, 0}
1801 }
1802 },
1803 {1, 1, 2, 0, /* 0xf7 */
1804 {{0, 2},
1805 {4, 7},
1806 {0, 0},
1807 {0, 0}
1808 }
1809 },
1810 {0, 1, 1, 0, /* 0xf8 */
1811 {{3, 7},
1812 {0, 0},
1813 {0, 0},
1814 {0, 0}
1815 }
1816 },
1817 {1, 1, 2, 0, /* 0xf9 */
1818 {{0, 0},
1819 {3, 7},
1820 {0, 0},
1821 {0, 0}
1822 }
1823 },
1824 {0, 1, 2, 0, /* 0xfa */
1825 {{1, 1},
1826 {3, 7},
1827 {0, 0},
1828 {0, 0}
1829 }
1830 },
1831 {1, 1, 2, 0, /* 0xfb */
1832 {{0, 1},
1833 {3, 7},
1834 {0, 0},
1835 {0, 0}
1836 }
1837 },
1838 {0, 1, 1, 0, /* 0xfc */
1839 {{2, 7},
1840 {0, 0},
1841 {0, 0},
1842 {0, 0}
1843 }
1844 },
1845 {1, 1, 2, 0, /* 0xfd */
1846 {{0, 0},
1847 {2, 7},
1848 {0, 0},
1849 {0, 0}
1850 }
1851 },
1852 {0, 1, 1, 0, /* 0xfe */
1853 {{1, 7},
1854 {0, 0},
1855 {0, 0},
1856 {0, 0}
1857 }
1858 },
1859 {1, 1, 1, 0, /* 0xff */
1860 {{0, 7},
1861 {0, 0},
1862 {0, 0},
1863 {0, 0}
1864 }
1865 }
1866 };
1867
1868
1869 int
sctp_is_address_in_scope(struct sctp_ifa * ifa,struct sctp_scoping * scope,int do_update)1870 sctp_is_address_in_scope(struct sctp_ifa *ifa,
1871 struct sctp_scoping *scope,
1872 int do_update)
1873 {
1874 if ((scope->loopback_scope == 0) &&
1875 (ifa->ifn_p) && SCTP_IFN_IS_IFT_LOOP(ifa->ifn_p)) {
1876 /*
1877 * skip loopback if not in scope *
1878 */
1879 return (0);
1880 }
1881 switch (ifa->address.sa.sa_family) {
1882 #ifdef INET
1883 case AF_INET:
1884 if (scope->ipv4_addr_legal) {
1885 struct sockaddr_in *sin;
1886
1887 sin = &ifa->address.sin;
1888 if (sin->sin_addr.s_addr == 0) {
1889 /* not in scope , unspecified */
1890 return (0);
1891 }
1892 if ((scope->ipv4_local_scope == 0) &&
1893 (IN4_ISPRIVATE_ADDRESS(&sin->sin_addr))) {
1894 /* private address not in scope */
1895 return (0);
1896 }
1897 } else {
1898 return (0);
1899 }
1900 break;
1901 #endif
1902 #ifdef INET6
1903 case AF_INET6:
1904 if (scope->ipv6_addr_legal) {
1905 struct sockaddr_in6 *sin6;
1906
1907 /*
1908 * Must update the flags, bummer, which means any
1909 * IFA locks must now be applied HERE <->
1910 */
1911 if (do_update) {
1912 sctp_gather_internal_ifa_flags(ifa);
1913 }
1914 if (ifa->localifa_flags & SCTP_ADDR_IFA_UNUSEABLE) {
1915 return (0);
1916 }
1917 /* ok to use deprecated addresses? */
1918 sin6 = &ifa->address.sin6;
1919 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
1920 /* skip unspecifed addresses */
1921 return (0);
1922 }
1923 if ( /* (local_scope == 0) && */
1924 (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr))) {
1925 return (0);
1926 }
1927 if ((scope->site_scope == 0) &&
1928 (IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr))) {
1929 return (0);
1930 }
1931 } else {
1932 return (0);
1933 }
1934 break;
1935 #endif
1936 default:
1937 return (0);
1938 }
1939 return (1);
1940 }
1941
1942 static struct mbuf *
sctp_add_addr_to_mbuf(struct mbuf * m,struct sctp_ifa * ifa,uint16_t * len)1943 sctp_add_addr_to_mbuf(struct mbuf *m, struct sctp_ifa *ifa, uint16_t *len)
1944 {
1945 #if defined(INET) || defined(INET6)
1946 struct sctp_paramhdr *paramh;
1947 struct mbuf *mret;
1948 uint16_t plen;
1949 #endif
1950
1951 switch (ifa->address.sa.sa_family) {
1952 #ifdef INET
1953 case AF_INET:
1954 plen = (uint16_t)sizeof(struct sctp_ipv4addr_param);
1955 break;
1956 #endif
1957 #ifdef INET6
1958 case AF_INET6:
1959 plen = (uint16_t)sizeof(struct sctp_ipv6addr_param);
1960 break;
1961 #endif
1962 default:
1963 return (m);
1964 }
1965 #if defined(INET) || defined(INET6)
1966 if (M_TRAILINGSPACE(m) >= plen) {
1967 /* easy side we just drop it on the end */
1968 paramh = (struct sctp_paramhdr *)(SCTP_BUF_AT(m, SCTP_BUF_LEN(m)));
1969 mret = m;
1970 } else {
1971 /* Need more space */
1972 mret = m;
1973 while (SCTP_BUF_NEXT(mret) != NULL) {
1974 mret = SCTP_BUF_NEXT(mret);
1975 }
1976 SCTP_BUF_NEXT(mret) = sctp_get_mbuf_for_msg(plen, 0, M_NOWAIT, 1, MT_DATA);
1977 if (SCTP_BUF_NEXT(mret) == NULL) {
1978 /* We are hosed, can't add more addresses */
1979 return (m);
1980 }
1981 mret = SCTP_BUF_NEXT(mret);
1982 paramh = mtod(mret, struct sctp_paramhdr *);
1983 }
1984 /* now add the parameter */
1985 switch (ifa->address.sa.sa_family) {
1986 #ifdef INET
1987 case AF_INET:
1988 {
1989 struct sctp_ipv4addr_param *ipv4p;
1990 struct sockaddr_in *sin;
1991
1992 sin = &ifa->address.sin;
1993 ipv4p = (struct sctp_ipv4addr_param *)paramh;
1994 paramh->param_type = htons(SCTP_IPV4_ADDRESS);
1995 paramh->param_length = htons(plen);
1996 ipv4p->addr = sin->sin_addr.s_addr;
1997 SCTP_BUF_LEN(mret) += plen;
1998 break;
1999 }
2000 #endif
2001 #ifdef INET6
2002 case AF_INET6:
2003 {
2004 struct sctp_ipv6addr_param *ipv6p;
2005 struct sockaddr_in6 *sin6;
2006
2007 sin6 = &ifa->address.sin6;
2008 ipv6p = (struct sctp_ipv6addr_param *)paramh;
2009 paramh->param_type = htons(SCTP_IPV6_ADDRESS);
2010 paramh->param_length = htons(plen);
2011 memcpy(ipv6p->addr, &sin6->sin6_addr,
2012 sizeof(ipv6p->addr));
2013 /* clear embedded scope in the address */
2014 in6_clearscope((struct in6_addr *)ipv6p->addr);
2015 SCTP_BUF_LEN(mret) += plen;
2016 break;
2017 }
2018 #endif
2019 default:
2020 return (m);
2021 }
2022 if (len != NULL) {
2023 *len += plen;
2024 }
2025 return (mret);
2026 #endif
2027 }
2028
2029
2030 struct mbuf *
sctp_add_addresses_to_i_ia(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_scoping * scope,struct mbuf * m_at,int cnt_inits_to,uint16_t * padding_len,uint16_t * chunk_len)2031 sctp_add_addresses_to_i_ia(struct sctp_inpcb *inp, struct sctp_tcb *stcb,
2032 struct sctp_scoping *scope,
2033 struct mbuf *m_at, int cnt_inits_to,
2034 uint16_t *padding_len, uint16_t *chunk_len)
2035 {
2036 struct sctp_vrf *vrf = NULL;
2037 int cnt, limit_out = 0, total_count;
2038 uint32_t vrf_id;
2039
2040 vrf_id = inp->def_vrf_id;
2041 SCTP_IPI_ADDR_RLOCK();
2042 vrf = sctp_find_vrf(vrf_id);
2043 if (vrf == NULL) {
2044 SCTP_IPI_ADDR_RUNLOCK();
2045 return (m_at);
2046 }
2047 if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) {
2048 struct sctp_ifa *sctp_ifap;
2049 struct sctp_ifn *sctp_ifnp;
2050
2051 cnt = cnt_inits_to;
2052 if (vrf->total_ifa_count > SCTP_COUNT_LIMIT) {
2053 limit_out = 1;
2054 cnt = SCTP_ADDRESS_LIMIT;
2055 goto skip_count;
2056 }
2057 LIST_FOREACH(sctp_ifnp, &vrf->ifnlist, next_ifn) {
2058 if ((scope->loopback_scope == 0) &&
2059 SCTP_IFN_IS_IFT_LOOP(sctp_ifnp)) {
2060 /*
2061 * Skip loopback devices if loopback_scope
2062 * not set
2063 */
2064 continue;
2065 }
2066 LIST_FOREACH(sctp_ifap, &sctp_ifnp->ifalist, next_ifa) {
2067 #ifdef INET
2068 if ((sctp_ifap->address.sa.sa_family == AF_INET) &&
2069 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2070 &sctp_ifap->address.sin.sin_addr) != 0)) {
2071 continue;
2072 }
2073 #endif
2074 #ifdef INET6
2075 if ((sctp_ifap->address.sa.sa_family == AF_INET6) &&
2076 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2077 &sctp_ifap->address.sin6.sin6_addr) != 0)) {
2078 continue;
2079 }
2080 #endif
2081 if (sctp_is_addr_restricted(stcb, sctp_ifap)) {
2082 continue;
2083 }
2084 if (sctp_is_address_in_scope(sctp_ifap, scope, 1) == 0) {
2085 continue;
2086 }
2087 cnt++;
2088 if (cnt > SCTP_ADDRESS_LIMIT) {
2089 break;
2090 }
2091 }
2092 if (cnt > SCTP_ADDRESS_LIMIT) {
2093 break;
2094 }
2095 }
2096 skip_count:
2097 if (cnt > 1) {
2098 total_count = 0;
2099 LIST_FOREACH(sctp_ifnp, &vrf->ifnlist, next_ifn) {
2100 cnt = 0;
2101 if ((scope->loopback_scope == 0) &&
2102 SCTP_IFN_IS_IFT_LOOP(sctp_ifnp)) {
2103 /*
2104 * Skip loopback devices if
2105 * loopback_scope not set
2106 */
2107 continue;
2108 }
2109 LIST_FOREACH(sctp_ifap, &sctp_ifnp->ifalist, next_ifa) {
2110 #ifdef INET
2111 if ((sctp_ifap->address.sa.sa_family == AF_INET) &&
2112 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2113 &sctp_ifap->address.sin.sin_addr) != 0)) {
2114 continue;
2115 }
2116 #endif
2117 #ifdef INET6
2118 if ((sctp_ifap->address.sa.sa_family == AF_INET6) &&
2119 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2120 &sctp_ifap->address.sin6.sin6_addr) != 0)) {
2121 continue;
2122 }
2123 #endif
2124 if (sctp_is_addr_restricted(stcb, sctp_ifap)) {
2125 continue;
2126 }
2127 if (sctp_is_address_in_scope(sctp_ifap,
2128 scope, 0) == 0) {
2129 continue;
2130 }
2131 if ((chunk_len != NULL) &&
2132 (padding_len != NULL) &&
2133 (*padding_len > 0)) {
2134 memset(mtod(m_at, caddr_t)+*chunk_len, 0, *padding_len);
2135 SCTP_BUF_LEN(m_at) += *padding_len;
2136 *chunk_len += *padding_len;
2137 *padding_len = 0;
2138 }
2139 m_at = sctp_add_addr_to_mbuf(m_at, sctp_ifap, chunk_len);
2140 if (limit_out) {
2141 cnt++;
2142 total_count++;
2143 if (cnt >= 2) {
2144 /*
2145 * two from each
2146 * address
2147 */
2148 break;
2149 }
2150 if (total_count > SCTP_ADDRESS_LIMIT) {
2151 /* No more addresses */
2152 break;
2153 }
2154 }
2155 }
2156 }
2157 }
2158 } else {
2159 struct sctp_laddr *laddr;
2160
2161 cnt = cnt_inits_to;
2162 /* First, how many ? */
2163 LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) {
2164 if (laddr->ifa == NULL) {
2165 continue;
2166 }
2167 if (laddr->ifa->localifa_flags & SCTP_BEING_DELETED)
2168 /*
2169 * Address being deleted by the system, dont
2170 * list.
2171 */
2172 continue;
2173 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2174 /*
2175 * Address being deleted on this ep don't
2176 * list.
2177 */
2178 continue;
2179 }
2180 if (sctp_is_address_in_scope(laddr->ifa,
2181 scope, 1) == 0) {
2182 continue;
2183 }
2184 cnt++;
2185 }
2186 /*
2187 * To get through a NAT we only list addresses if we have
2188 * more than one. That way if you just bind a single address
2189 * we let the source of the init dictate our address.
2190 */
2191 if (cnt > 1) {
2192 cnt = cnt_inits_to;
2193 LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) {
2194 if (laddr->ifa == NULL) {
2195 continue;
2196 }
2197 if (laddr->ifa->localifa_flags & SCTP_BEING_DELETED) {
2198 continue;
2199 }
2200 if (sctp_is_address_in_scope(laddr->ifa,
2201 scope, 0) == 0) {
2202 continue;
2203 }
2204 if ((chunk_len != NULL) &&
2205 (padding_len != NULL) &&
2206 (*padding_len > 0)) {
2207 memset(mtod(m_at, caddr_t)+*chunk_len, 0, *padding_len);
2208 SCTP_BUF_LEN(m_at) += *padding_len;
2209 *chunk_len += *padding_len;
2210 *padding_len = 0;
2211 }
2212 m_at = sctp_add_addr_to_mbuf(m_at, laddr->ifa, chunk_len);
2213 cnt++;
2214 if (cnt >= SCTP_ADDRESS_LIMIT) {
2215 break;
2216 }
2217 }
2218 }
2219 }
2220 SCTP_IPI_ADDR_RUNLOCK();
2221 return (m_at);
2222 }
2223
2224 static struct sctp_ifa *
sctp_is_ifa_addr_preferred(struct sctp_ifa * ifa,uint8_t dest_is_loop,uint8_t dest_is_priv,sa_family_t fam)2225 sctp_is_ifa_addr_preferred(struct sctp_ifa *ifa,
2226 uint8_t dest_is_loop,
2227 uint8_t dest_is_priv,
2228 sa_family_t fam)
2229 {
2230 uint8_t dest_is_global = 0;
2231
2232 /* dest_is_priv is true if destination is a private address */
2233 /* dest_is_loop is true if destination is a loopback addresses */
2234
2235 /**
2236 * Here we determine if its a preferred address. A preferred address
2237 * means it is the same scope or higher scope then the destination.
2238 * L = loopback, P = private, G = global
2239 * -----------------------------------------
2240 * src | dest | result
2241 * ----------------------------------------
2242 * L | L | yes
2243 * -----------------------------------------
2244 * P | L | yes-v4 no-v6
2245 * -----------------------------------------
2246 * G | L | yes-v4 no-v6
2247 * -----------------------------------------
2248 * L | P | no
2249 * -----------------------------------------
2250 * P | P | yes
2251 * -----------------------------------------
2252 * G | P | no
2253 * -----------------------------------------
2254 * L | G | no
2255 * -----------------------------------------
2256 * P | G | no
2257 * -----------------------------------------
2258 * G | G | yes
2259 * -----------------------------------------
2260 */
2261
2262 if (ifa->address.sa.sa_family != fam) {
2263 /* forget mis-matched family */
2264 return (NULL);
2265 }
2266 if ((dest_is_priv == 0) && (dest_is_loop == 0)) {
2267 dest_is_global = 1;
2268 }
2269 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Is destination preferred:");
2270 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &ifa->address.sa);
2271 /* Ok the address may be ok */
2272 #ifdef INET6
2273 if (fam == AF_INET6) {
2274 /* ok to use deprecated addresses? no lets not! */
2275 if (ifa->localifa_flags & SCTP_ADDR_IFA_UNUSEABLE) {
2276 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:1\n");
2277 return (NULL);
2278 }
2279 if (ifa->src_is_priv && !ifa->src_is_loop) {
2280 if (dest_is_loop) {
2281 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:2\n");
2282 return (NULL);
2283 }
2284 }
2285 if (ifa->src_is_glob) {
2286 if (dest_is_loop) {
2287 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:3\n");
2288 return (NULL);
2289 }
2290 }
2291 }
2292 #endif
2293 /*
2294 * Now that we know what is what, implement or table this could in
2295 * theory be done slicker (it used to be), but this is
2296 * straightforward and easier to validate :-)
2297 */
2298 SCTPDBG(SCTP_DEBUG_OUTPUT3, "src_loop:%d src_priv:%d src_glob:%d\n",
2299 ifa->src_is_loop, ifa->src_is_priv, ifa->src_is_glob);
2300 SCTPDBG(SCTP_DEBUG_OUTPUT3, "dest_loop:%d dest_priv:%d dest_glob:%d\n",
2301 dest_is_loop, dest_is_priv, dest_is_global);
2302
2303 if ((ifa->src_is_loop) && (dest_is_priv)) {
2304 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:4\n");
2305 return (NULL);
2306 }
2307 if ((ifa->src_is_glob) && (dest_is_priv)) {
2308 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:5\n");
2309 return (NULL);
2310 }
2311 if ((ifa->src_is_loop) && (dest_is_global)) {
2312 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:6\n");
2313 return (NULL);
2314 }
2315 if ((ifa->src_is_priv) && (dest_is_global)) {
2316 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:7\n");
2317 return (NULL);
2318 }
2319 SCTPDBG(SCTP_DEBUG_OUTPUT3, "YES\n");
2320 /* its a preferred address */
2321 return (ifa);
2322 }
2323
2324 static struct sctp_ifa *
sctp_is_ifa_addr_acceptable(struct sctp_ifa * ifa,uint8_t dest_is_loop,uint8_t dest_is_priv,sa_family_t fam)2325 sctp_is_ifa_addr_acceptable(struct sctp_ifa *ifa,
2326 uint8_t dest_is_loop,
2327 uint8_t dest_is_priv,
2328 sa_family_t fam)
2329 {
2330 uint8_t dest_is_global = 0;
2331
2332 /**
2333 * Here we determine if its a acceptable address. A acceptable
2334 * address means it is the same scope or higher scope but we can
2335 * allow for NAT which means its ok to have a global dest and a
2336 * private src.
2337 *
2338 * L = loopback, P = private, G = global
2339 * -----------------------------------------
2340 * src | dest | result
2341 * -----------------------------------------
2342 * L | L | yes
2343 * -----------------------------------------
2344 * P | L | yes-v4 no-v6
2345 * -----------------------------------------
2346 * G | L | yes
2347 * -----------------------------------------
2348 * L | P | no
2349 * -----------------------------------------
2350 * P | P | yes
2351 * -----------------------------------------
2352 * G | P | yes - May not work
2353 * -----------------------------------------
2354 * L | G | no
2355 * -----------------------------------------
2356 * P | G | yes - May not work
2357 * -----------------------------------------
2358 * G | G | yes
2359 * -----------------------------------------
2360 */
2361
2362 if (ifa->address.sa.sa_family != fam) {
2363 /* forget non matching family */
2364 SCTPDBG(SCTP_DEBUG_OUTPUT3, "ifa_fam:%d fam:%d\n",
2365 ifa->address.sa.sa_family, fam);
2366 return (NULL);
2367 }
2368 /* Ok the address may be ok */
2369 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT3, &ifa->address.sa);
2370 SCTPDBG(SCTP_DEBUG_OUTPUT3, "dst_is_loop:%d dest_is_priv:%d\n",
2371 dest_is_loop, dest_is_priv);
2372 if ((dest_is_loop == 0) && (dest_is_priv == 0)) {
2373 dest_is_global = 1;
2374 }
2375 #ifdef INET6
2376 if (fam == AF_INET6) {
2377 /* ok to use deprecated addresses? */
2378 if (ifa->localifa_flags & SCTP_ADDR_IFA_UNUSEABLE) {
2379 return (NULL);
2380 }
2381 if (ifa->src_is_priv) {
2382 /* Special case, linklocal to loop */
2383 if (dest_is_loop)
2384 return (NULL);
2385 }
2386 }
2387 #endif
2388 /*
2389 * Now that we know what is what, implement our table. This could in
2390 * theory be done slicker (it used to be), but this is
2391 * straightforward and easier to validate :-)
2392 */
2393 SCTPDBG(SCTP_DEBUG_OUTPUT3, "ifa->src_is_loop:%d dest_is_priv:%d\n",
2394 ifa->src_is_loop,
2395 dest_is_priv);
2396 if ((ifa->src_is_loop == 1) && (dest_is_priv)) {
2397 return (NULL);
2398 }
2399 SCTPDBG(SCTP_DEBUG_OUTPUT3, "ifa->src_is_loop:%d dest_is_glob:%d\n",
2400 ifa->src_is_loop,
2401 dest_is_global);
2402 if ((ifa->src_is_loop == 1) && (dest_is_global)) {
2403 return (NULL);
2404 }
2405 SCTPDBG(SCTP_DEBUG_OUTPUT3, "address is acceptable\n");
2406 /* its an acceptable address */
2407 return (ifa);
2408 }
2409
2410 int
sctp_is_addr_restricted(struct sctp_tcb * stcb,struct sctp_ifa * ifa)2411 sctp_is_addr_restricted(struct sctp_tcb *stcb, struct sctp_ifa *ifa)
2412 {
2413 struct sctp_laddr *laddr;
2414
2415 if (stcb == NULL) {
2416 /* There are no restrictions, no TCB :-) */
2417 return (0);
2418 }
2419 LIST_FOREACH(laddr, &stcb->asoc.sctp_restricted_addrs, sctp_nxt_addr) {
2420 if (laddr->ifa == NULL) {
2421 SCTPDBG(SCTP_DEBUG_OUTPUT1, "%s: NULL ifa\n",
2422 __func__);
2423 continue;
2424 }
2425 if (laddr->ifa == ifa) {
2426 /* Yes it is on the list */
2427 return (1);
2428 }
2429 }
2430 return (0);
2431 }
2432
2433
2434 int
sctp_is_addr_in_ep(struct sctp_inpcb * inp,struct sctp_ifa * ifa)2435 sctp_is_addr_in_ep(struct sctp_inpcb *inp, struct sctp_ifa *ifa)
2436 {
2437 struct sctp_laddr *laddr;
2438
2439 if (ifa == NULL)
2440 return (0);
2441 LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) {
2442 if (laddr->ifa == NULL) {
2443 SCTPDBG(SCTP_DEBUG_OUTPUT1, "%s: NULL ifa\n",
2444 __func__);
2445 continue;
2446 }
2447 if ((laddr->ifa == ifa) && laddr->action == 0)
2448 /* same pointer */
2449 return (1);
2450 }
2451 return (0);
2452 }
2453
2454
2455
2456 static struct sctp_ifa *
sctp_choose_boundspecific_inp(struct sctp_inpcb * inp,sctp_route_t * ro,uint32_t vrf_id,int non_asoc_addr_ok,uint8_t dest_is_priv,uint8_t dest_is_loop,sa_family_t fam)2457 sctp_choose_boundspecific_inp(struct sctp_inpcb *inp,
2458 sctp_route_t *ro,
2459 uint32_t vrf_id,
2460 int non_asoc_addr_ok,
2461 uint8_t dest_is_priv,
2462 uint8_t dest_is_loop,
2463 sa_family_t fam)
2464 {
2465 struct sctp_laddr *laddr, *starting_point;
2466 void *ifn;
2467 int resettotop = 0;
2468 struct sctp_ifn *sctp_ifn;
2469 struct sctp_ifa *sctp_ifa, *sifa;
2470 struct sctp_vrf *vrf;
2471 uint32_t ifn_index;
2472
2473 vrf = sctp_find_vrf(vrf_id);
2474 if (vrf == NULL)
2475 return (NULL);
2476
2477 ifn = SCTP_GET_IFN_VOID_FROM_ROUTE(ro);
2478 ifn_index = SCTP_GET_IF_INDEX_FROM_ROUTE(ro);
2479 sctp_ifn = sctp_find_ifn(ifn, ifn_index);
2480 /*
2481 * first question, is the ifn we will emit on in our list, if so, we
2482 * want such an address. Note that we first looked for a preferred
2483 * address.
2484 */
2485 if (sctp_ifn) {
2486 /* is a preferred one on the interface we route out? */
2487 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
2488 #ifdef INET
2489 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
2490 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2491 &sctp_ifa->address.sin.sin_addr) != 0)) {
2492 continue;
2493 }
2494 #endif
2495 #ifdef INET6
2496 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
2497 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2498 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
2499 continue;
2500 }
2501 #endif
2502 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
2503 (non_asoc_addr_ok == 0))
2504 continue;
2505 sifa = sctp_is_ifa_addr_preferred(sctp_ifa,
2506 dest_is_loop,
2507 dest_is_priv, fam);
2508 if (sifa == NULL)
2509 continue;
2510 if (sctp_is_addr_in_ep(inp, sifa)) {
2511 atomic_add_int(&sifa->refcount, 1);
2512 return (sifa);
2513 }
2514 }
2515 }
2516 /*
2517 * ok, now we now need to find one on the list of the addresses. We
2518 * can't get one on the emitting interface so let's find first a
2519 * preferred one. If not that an acceptable one otherwise... we
2520 * return NULL.
2521 */
2522 starting_point = inp->next_addr_touse;
2523 once_again:
2524 if (inp->next_addr_touse == NULL) {
2525 inp->next_addr_touse = LIST_FIRST(&inp->sctp_addr_list);
2526 resettotop = 1;
2527 }
2528 for (laddr = inp->next_addr_touse; laddr;
2529 laddr = LIST_NEXT(laddr, sctp_nxt_addr)) {
2530 if (laddr->ifa == NULL) {
2531 /* address has been removed */
2532 continue;
2533 }
2534 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2535 /* address is being deleted */
2536 continue;
2537 }
2538 sifa = sctp_is_ifa_addr_preferred(laddr->ifa, dest_is_loop,
2539 dest_is_priv, fam);
2540 if (sifa == NULL)
2541 continue;
2542 atomic_add_int(&sifa->refcount, 1);
2543 return (sifa);
2544 }
2545 if (resettotop == 0) {
2546 inp->next_addr_touse = NULL;
2547 goto once_again;
2548 }
2549
2550 inp->next_addr_touse = starting_point;
2551 resettotop = 0;
2552 once_again_too:
2553 if (inp->next_addr_touse == NULL) {
2554 inp->next_addr_touse = LIST_FIRST(&inp->sctp_addr_list);
2555 resettotop = 1;
2556 }
2557
2558 /* ok, what about an acceptable address in the inp */
2559 for (laddr = inp->next_addr_touse; laddr;
2560 laddr = LIST_NEXT(laddr, sctp_nxt_addr)) {
2561 if (laddr->ifa == NULL) {
2562 /* address has been removed */
2563 continue;
2564 }
2565 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2566 /* address is being deleted */
2567 continue;
2568 }
2569 sifa = sctp_is_ifa_addr_acceptable(laddr->ifa, dest_is_loop,
2570 dest_is_priv, fam);
2571 if (sifa == NULL)
2572 continue;
2573 atomic_add_int(&sifa->refcount, 1);
2574 return (sifa);
2575 }
2576 if (resettotop == 0) {
2577 inp->next_addr_touse = NULL;
2578 goto once_again_too;
2579 }
2580
2581 /*
2582 * no address bound can be a source for the destination we are in
2583 * trouble
2584 */
2585 return (NULL);
2586 }
2587
2588
2589
2590 static struct sctp_ifa *
sctp_choose_boundspecific_stcb(struct sctp_inpcb * inp,struct sctp_tcb * stcb,sctp_route_t * ro,uint32_t vrf_id,uint8_t dest_is_priv,uint8_t dest_is_loop,int non_asoc_addr_ok,sa_family_t fam)2591 sctp_choose_boundspecific_stcb(struct sctp_inpcb *inp,
2592 struct sctp_tcb *stcb,
2593 sctp_route_t *ro,
2594 uint32_t vrf_id,
2595 uint8_t dest_is_priv,
2596 uint8_t dest_is_loop,
2597 int non_asoc_addr_ok,
2598 sa_family_t fam)
2599 {
2600 struct sctp_laddr *laddr, *starting_point;
2601 void *ifn;
2602 struct sctp_ifn *sctp_ifn;
2603 struct sctp_ifa *sctp_ifa, *sifa;
2604 uint8_t start_at_beginning = 0;
2605 struct sctp_vrf *vrf;
2606 uint32_t ifn_index;
2607
2608 /*
2609 * first question, is the ifn we will emit on in our list, if so, we
2610 * want that one.
2611 */
2612 vrf = sctp_find_vrf(vrf_id);
2613 if (vrf == NULL)
2614 return (NULL);
2615
2616 ifn = SCTP_GET_IFN_VOID_FROM_ROUTE(ro);
2617 ifn_index = SCTP_GET_IF_INDEX_FROM_ROUTE(ro);
2618 sctp_ifn = sctp_find_ifn(ifn, ifn_index);
2619
2620 /*
2621 * first question, is the ifn we will emit on in our list? If so,
2622 * we want that one. First we look for a preferred. Second, we go
2623 * for an acceptable.
2624 */
2625 if (sctp_ifn) {
2626 /* first try for a preferred address on the ep */
2627 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
2628 #ifdef INET
2629 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
2630 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2631 &sctp_ifa->address.sin.sin_addr) != 0)) {
2632 continue;
2633 }
2634 #endif
2635 #ifdef INET6
2636 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
2637 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2638 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
2639 continue;
2640 }
2641 #endif
2642 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) && (non_asoc_addr_ok == 0))
2643 continue;
2644 if (sctp_is_addr_in_ep(inp, sctp_ifa)) {
2645 sifa = sctp_is_ifa_addr_preferred(sctp_ifa, dest_is_loop, dest_is_priv, fam);
2646 if (sifa == NULL)
2647 continue;
2648 if (((non_asoc_addr_ok == 0) &&
2649 (sctp_is_addr_restricted(stcb, sifa))) ||
2650 (non_asoc_addr_ok &&
2651 (sctp_is_addr_restricted(stcb, sifa)) &&
2652 (!sctp_is_addr_pending(stcb, sifa)))) {
2653 /* on the no-no list */
2654 continue;
2655 }
2656 atomic_add_int(&sifa->refcount, 1);
2657 return (sifa);
2658 }
2659 }
2660 /* next try for an acceptable address on the ep */
2661 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
2662 #ifdef INET
2663 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
2664 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2665 &sctp_ifa->address.sin.sin_addr) != 0)) {
2666 continue;
2667 }
2668 #endif
2669 #ifdef INET6
2670 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
2671 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2672 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
2673 continue;
2674 }
2675 #endif
2676 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) && (non_asoc_addr_ok == 0))
2677 continue;
2678 if (sctp_is_addr_in_ep(inp, sctp_ifa)) {
2679 sifa = sctp_is_ifa_addr_acceptable(sctp_ifa, dest_is_loop, dest_is_priv, fam);
2680 if (sifa == NULL)
2681 continue;
2682 if (((non_asoc_addr_ok == 0) &&
2683 (sctp_is_addr_restricted(stcb, sifa))) ||
2684 (non_asoc_addr_ok &&
2685 (sctp_is_addr_restricted(stcb, sifa)) &&
2686 (!sctp_is_addr_pending(stcb, sifa)))) {
2687 /* on the no-no list */
2688 continue;
2689 }
2690 atomic_add_int(&sifa->refcount, 1);
2691 return (sifa);
2692 }
2693 }
2694
2695 }
2696 /*
2697 * if we can't find one like that then we must look at all addresses
2698 * bound to pick one at first preferable then secondly acceptable.
2699 */
2700 starting_point = stcb->asoc.last_used_address;
2701 sctp_from_the_top:
2702 if (stcb->asoc.last_used_address == NULL) {
2703 start_at_beginning = 1;
2704 stcb->asoc.last_used_address = LIST_FIRST(&inp->sctp_addr_list);
2705 }
2706 /* search beginning with the last used address */
2707 for (laddr = stcb->asoc.last_used_address; laddr;
2708 laddr = LIST_NEXT(laddr, sctp_nxt_addr)) {
2709 if (laddr->ifa == NULL) {
2710 /* address has been removed */
2711 continue;
2712 }
2713 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2714 /* address is being deleted */
2715 continue;
2716 }
2717 sifa = sctp_is_ifa_addr_preferred(laddr->ifa, dest_is_loop, dest_is_priv, fam);
2718 if (sifa == NULL)
2719 continue;
2720 if (((non_asoc_addr_ok == 0) &&
2721 (sctp_is_addr_restricted(stcb, sifa))) ||
2722 (non_asoc_addr_ok &&
2723 (sctp_is_addr_restricted(stcb, sifa)) &&
2724 (!sctp_is_addr_pending(stcb, sifa)))) {
2725 /* on the no-no list */
2726 continue;
2727 }
2728 stcb->asoc.last_used_address = laddr;
2729 atomic_add_int(&sifa->refcount, 1);
2730 return (sifa);
2731 }
2732 if (start_at_beginning == 0) {
2733 stcb->asoc.last_used_address = NULL;
2734 goto sctp_from_the_top;
2735 }
2736 /* now try for any higher scope than the destination */
2737 stcb->asoc.last_used_address = starting_point;
2738 start_at_beginning = 0;
2739 sctp_from_the_top2:
2740 if (stcb->asoc.last_used_address == NULL) {
2741 start_at_beginning = 1;
2742 stcb->asoc.last_used_address = LIST_FIRST(&inp->sctp_addr_list);
2743 }
2744 /* search beginning with the last used address */
2745 for (laddr = stcb->asoc.last_used_address; laddr;
2746 laddr = LIST_NEXT(laddr, sctp_nxt_addr)) {
2747 if (laddr->ifa == NULL) {
2748 /* address has been removed */
2749 continue;
2750 }
2751 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2752 /* address is being deleted */
2753 continue;
2754 }
2755 sifa = sctp_is_ifa_addr_acceptable(laddr->ifa, dest_is_loop,
2756 dest_is_priv, fam);
2757 if (sifa == NULL)
2758 continue;
2759 if (((non_asoc_addr_ok == 0) &&
2760 (sctp_is_addr_restricted(stcb, sifa))) ||
2761 (non_asoc_addr_ok &&
2762 (sctp_is_addr_restricted(stcb, sifa)) &&
2763 (!sctp_is_addr_pending(stcb, sifa)))) {
2764 /* on the no-no list */
2765 continue;
2766 }
2767 stcb->asoc.last_used_address = laddr;
2768 atomic_add_int(&sifa->refcount, 1);
2769 return (sifa);
2770 }
2771 if (start_at_beginning == 0) {
2772 stcb->asoc.last_used_address = NULL;
2773 goto sctp_from_the_top2;
2774 }
2775 return (NULL);
2776 }
2777
2778 static struct sctp_ifa *
sctp_select_nth_preferred_addr_from_ifn_boundall(struct sctp_ifn * ifn,struct sctp_inpcb * inp,struct sctp_tcb * stcb,int non_asoc_addr_ok,uint8_t dest_is_loop,uint8_t dest_is_priv,int addr_wanted,sa_family_t fam,sctp_route_t * ro)2779 sctp_select_nth_preferred_addr_from_ifn_boundall(struct sctp_ifn *ifn,
2780 struct sctp_inpcb *inp,
2781 struct sctp_tcb *stcb,
2782 int non_asoc_addr_ok,
2783 uint8_t dest_is_loop,
2784 uint8_t dest_is_priv,
2785 int addr_wanted,
2786 sa_family_t fam,
2787 sctp_route_t *ro
2788 )
2789 {
2790 struct sctp_ifa *ifa, *sifa;
2791 int num_eligible_addr = 0;
2792 #ifdef INET6
2793 struct sockaddr_in6 sin6, lsa6;
2794
2795 if (fam == AF_INET6) {
2796 memcpy(&sin6, &ro->ro_dst, sizeof(struct sockaddr_in6));
2797 (void)sa6_recoverscope(&sin6);
2798 }
2799 #endif /* INET6 */
2800 LIST_FOREACH(ifa, &ifn->ifalist, next_ifa) {
2801 #ifdef INET
2802 if ((ifa->address.sa.sa_family == AF_INET) &&
2803 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2804 &ifa->address.sin.sin_addr) != 0)) {
2805 continue;
2806 }
2807 #endif
2808 #ifdef INET6
2809 if ((ifa->address.sa.sa_family == AF_INET6) &&
2810 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2811 &ifa->address.sin6.sin6_addr) != 0)) {
2812 continue;
2813 }
2814 #endif
2815 if ((ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
2816 (non_asoc_addr_ok == 0))
2817 continue;
2818 sifa = sctp_is_ifa_addr_preferred(ifa, dest_is_loop,
2819 dest_is_priv, fam);
2820 if (sifa == NULL)
2821 continue;
2822 #ifdef INET6
2823 if (fam == AF_INET6 &&
2824 dest_is_loop &&
2825 sifa->src_is_loop && sifa->src_is_priv) {
2826 /*
2827 * don't allow fe80::1 to be a src on loop ::1, we
2828 * don't list it to the peer so we will get an
2829 * abort.
2830 */
2831 continue;
2832 }
2833 if (fam == AF_INET6 &&
2834 IN6_IS_ADDR_LINKLOCAL(&sifa->address.sin6.sin6_addr) &&
2835 IN6_IS_ADDR_LINKLOCAL(&sin6.sin6_addr)) {
2836 /*
2837 * link-local <-> link-local must belong to the same
2838 * scope.
2839 */
2840 memcpy(&lsa6, &sifa->address.sin6, sizeof(struct sockaddr_in6));
2841 (void)sa6_recoverscope(&lsa6);
2842 if (sin6.sin6_scope_id != lsa6.sin6_scope_id) {
2843 continue;
2844 }
2845 }
2846 #endif /* INET6 */
2847
2848 /*
2849 * Check if the IPv6 address matches to next-hop. In the
2850 * mobile case, old IPv6 address may be not deleted from the
2851 * interface. Then, the interface has previous and new
2852 * addresses. We should use one corresponding to the
2853 * next-hop. (by micchie)
2854 */
2855 #ifdef INET6
2856 if (stcb && fam == AF_INET6 &&
2857 sctp_is_mobility_feature_on(stcb->sctp_ep, SCTP_MOBILITY_BASE)) {
2858 if (sctp_v6src_match_nexthop(&sifa->address.sin6, ro)
2859 == 0) {
2860 continue;
2861 }
2862 }
2863 #endif
2864 #ifdef INET
2865 /* Avoid topologically incorrect IPv4 address */
2866 if (stcb && fam == AF_INET &&
2867 sctp_is_mobility_feature_on(stcb->sctp_ep, SCTP_MOBILITY_BASE)) {
2868 if (sctp_v4src_match_nexthop(sifa, ro) == 0) {
2869 continue;
2870 }
2871 }
2872 #endif
2873 if (stcb) {
2874 if (sctp_is_address_in_scope(ifa, &stcb->asoc.scope, 0) == 0) {
2875 continue;
2876 }
2877 if (((non_asoc_addr_ok == 0) &&
2878 (sctp_is_addr_restricted(stcb, sifa))) ||
2879 (non_asoc_addr_ok &&
2880 (sctp_is_addr_restricted(stcb, sifa)) &&
2881 (!sctp_is_addr_pending(stcb, sifa)))) {
2882 /*
2883 * It is restricted for some reason..
2884 * probably not yet added.
2885 */
2886 continue;
2887 }
2888 }
2889 if (num_eligible_addr >= addr_wanted) {
2890 return (sifa);
2891 }
2892 num_eligible_addr++;
2893 }
2894 return (NULL);
2895 }
2896
2897
2898 static int
sctp_count_num_preferred_boundall(struct sctp_ifn * ifn,struct sctp_inpcb * inp,struct sctp_tcb * stcb,int non_asoc_addr_ok,uint8_t dest_is_loop,uint8_t dest_is_priv,sa_family_t fam)2899 sctp_count_num_preferred_boundall(struct sctp_ifn *ifn,
2900 struct sctp_inpcb *inp,
2901 struct sctp_tcb *stcb,
2902 int non_asoc_addr_ok,
2903 uint8_t dest_is_loop,
2904 uint8_t dest_is_priv,
2905 sa_family_t fam)
2906 {
2907 struct sctp_ifa *ifa, *sifa;
2908 int num_eligible_addr = 0;
2909
2910 LIST_FOREACH(ifa, &ifn->ifalist, next_ifa) {
2911 #ifdef INET
2912 if ((ifa->address.sa.sa_family == AF_INET) &&
2913 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2914 &ifa->address.sin.sin_addr) != 0)) {
2915 continue;
2916 }
2917 #endif
2918 #ifdef INET6
2919 if ((ifa->address.sa.sa_family == AF_INET6) &&
2920 (stcb != NULL) &&
2921 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2922 &ifa->address.sin6.sin6_addr) != 0)) {
2923 continue;
2924 }
2925 #endif
2926 if ((ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
2927 (non_asoc_addr_ok == 0)) {
2928 continue;
2929 }
2930 sifa = sctp_is_ifa_addr_preferred(ifa, dest_is_loop,
2931 dest_is_priv, fam);
2932 if (sifa == NULL) {
2933 continue;
2934 }
2935 if (stcb) {
2936 if (sctp_is_address_in_scope(ifa, &stcb->asoc.scope, 0) == 0) {
2937 continue;
2938 }
2939 if (((non_asoc_addr_ok == 0) &&
2940 (sctp_is_addr_restricted(stcb, sifa))) ||
2941 (non_asoc_addr_ok &&
2942 (sctp_is_addr_restricted(stcb, sifa)) &&
2943 (!sctp_is_addr_pending(stcb, sifa)))) {
2944 /*
2945 * It is restricted for some reason..
2946 * probably not yet added.
2947 */
2948 continue;
2949 }
2950 }
2951 num_eligible_addr++;
2952 }
2953 return (num_eligible_addr);
2954 }
2955
2956 static struct sctp_ifa *
sctp_choose_boundall(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_nets * net,sctp_route_t * ro,uint32_t vrf_id,uint8_t dest_is_priv,uint8_t dest_is_loop,int non_asoc_addr_ok,sa_family_t fam)2957 sctp_choose_boundall(struct sctp_inpcb *inp,
2958 struct sctp_tcb *stcb,
2959 struct sctp_nets *net,
2960 sctp_route_t *ro,
2961 uint32_t vrf_id,
2962 uint8_t dest_is_priv,
2963 uint8_t dest_is_loop,
2964 int non_asoc_addr_ok,
2965 sa_family_t fam)
2966 {
2967 int cur_addr_num = 0, num_preferred = 0;
2968 void *ifn;
2969 struct sctp_ifn *sctp_ifn, *looked_at = NULL, *emit_ifn;
2970 struct sctp_ifa *sctp_ifa, *sifa;
2971 uint32_t ifn_index;
2972 struct sctp_vrf *vrf;
2973 #ifdef INET
2974 int retried = 0;
2975 #endif
2976
2977 /*-
2978 * For boundall we can use any address in the association.
2979 * If non_asoc_addr_ok is set we can use any address (at least in
2980 * theory). So we look for preferred addresses first. If we find one,
2981 * we use it. Otherwise we next try to get an address on the
2982 * interface, which we should be able to do (unless non_asoc_addr_ok
2983 * is false and we are routed out that way). In these cases where we
2984 * can't use the address of the interface we go through all the
2985 * ifn's looking for an address we can use and fill that in. Punting
2986 * means we send back address 0, which will probably cause problems
2987 * actually since then IP will fill in the address of the route ifn,
2988 * which means we probably already rejected it.. i.e. here comes an
2989 * abort :-<.
2990 */
2991 vrf = sctp_find_vrf(vrf_id);
2992 if (vrf == NULL)
2993 return (NULL);
2994
2995 ifn = SCTP_GET_IFN_VOID_FROM_ROUTE(ro);
2996 ifn_index = SCTP_GET_IF_INDEX_FROM_ROUTE(ro);
2997 SCTPDBG(SCTP_DEBUG_OUTPUT2, "ifn from route:%p ifn_index:%d\n", ifn, ifn_index);
2998 emit_ifn = looked_at = sctp_ifn = sctp_find_ifn(ifn, ifn_index);
2999 if (sctp_ifn == NULL) {
3000 /* ?? We don't have this guy ?? */
3001 SCTPDBG(SCTP_DEBUG_OUTPUT2, "No ifn emit interface?\n");
3002 goto bound_all_plan_b;
3003 }
3004 SCTPDBG(SCTP_DEBUG_OUTPUT2, "ifn_index:%d name:%s is emit interface\n",
3005 ifn_index, sctp_ifn->ifn_name);
3006
3007 if (net) {
3008 cur_addr_num = net->indx_of_eligible_next_to_use;
3009 }
3010 num_preferred = sctp_count_num_preferred_boundall(sctp_ifn,
3011 inp, stcb,
3012 non_asoc_addr_ok,
3013 dest_is_loop,
3014 dest_is_priv, fam);
3015 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Found %d preferred source addresses for intf:%s\n",
3016 num_preferred, sctp_ifn->ifn_name);
3017 if (num_preferred == 0) {
3018 /*
3019 * no eligible addresses, we must use some other interface
3020 * address if we can find one.
3021 */
3022 goto bound_all_plan_b;
3023 }
3024 /*
3025 * Ok we have num_eligible_addr set with how many we can use, this
3026 * may vary from call to call due to addresses being deprecated
3027 * etc..
3028 */
3029 if (cur_addr_num >= num_preferred) {
3030 cur_addr_num = 0;
3031 }
3032 /*
3033 * select the nth address from the list (where cur_addr_num is the
3034 * nth) and 0 is the first one, 1 is the second one etc...
3035 */
3036 SCTPDBG(SCTP_DEBUG_OUTPUT2, "cur_addr_num:%d\n", cur_addr_num);
3037
3038 sctp_ifa = sctp_select_nth_preferred_addr_from_ifn_boundall(sctp_ifn, inp, stcb, non_asoc_addr_ok, dest_is_loop,
3039 dest_is_priv, cur_addr_num, fam, ro);
3040
3041 /* if sctp_ifa is NULL something changed??, fall to plan b. */
3042 if (sctp_ifa) {
3043 atomic_add_int(&sctp_ifa->refcount, 1);
3044 if (net) {
3045 /* save off where the next one we will want */
3046 net->indx_of_eligible_next_to_use = cur_addr_num + 1;
3047 }
3048 return (sctp_ifa);
3049 }
3050 /*
3051 * plan_b: Look at all interfaces and find a preferred address. If
3052 * no preferred fall through to plan_c.
3053 */
3054 bound_all_plan_b:
3055 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Trying Plan B\n");
3056 LIST_FOREACH(sctp_ifn, &vrf->ifnlist, next_ifn) {
3057 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Examine interface %s\n",
3058 sctp_ifn->ifn_name);
3059 if (dest_is_loop == 0 && SCTP_IFN_IS_IFT_LOOP(sctp_ifn)) {
3060 /* wrong base scope */
3061 SCTPDBG(SCTP_DEBUG_OUTPUT2, "skip\n");
3062 continue;
3063 }
3064 if ((sctp_ifn == looked_at) && looked_at) {
3065 /* already looked at this guy */
3066 SCTPDBG(SCTP_DEBUG_OUTPUT2, "already seen\n");
3067 continue;
3068 }
3069 num_preferred = sctp_count_num_preferred_boundall(sctp_ifn, inp, stcb, non_asoc_addr_ok,
3070 dest_is_loop, dest_is_priv, fam);
3071 SCTPDBG(SCTP_DEBUG_OUTPUT2,
3072 "Found ifn:%p %d preferred source addresses\n",
3073 ifn, num_preferred);
3074 if (num_preferred == 0) {
3075 /* None on this interface. */
3076 SCTPDBG(SCTP_DEBUG_OUTPUT2, "No preferred -- skipping to next\n");
3077 continue;
3078 }
3079 SCTPDBG(SCTP_DEBUG_OUTPUT2,
3080 "num preferred:%d on interface:%p cur_addr_num:%d\n",
3081 num_preferred, (void *)sctp_ifn, cur_addr_num);
3082
3083 /*
3084 * Ok we have num_eligible_addr set with how many we can
3085 * use, this may vary from call to call due to addresses
3086 * being deprecated etc..
3087 */
3088 if (cur_addr_num >= num_preferred) {
3089 cur_addr_num = 0;
3090 }
3091 sifa = sctp_select_nth_preferred_addr_from_ifn_boundall(sctp_ifn, inp, stcb, non_asoc_addr_ok, dest_is_loop,
3092 dest_is_priv, cur_addr_num, fam, ro);
3093 if (sifa == NULL)
3094 continue;
3095 if (net) {
3096 net->indx_of_eligible_next_to_use = cur_addr_num + 1;
3097 SCTPDBG(SCTP_DEBUG_OUTPUT2, "we selected %d\n",
3098 cur_addr_num);
3099 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Source:");
3100 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &sifa->address.sa);
3101 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Dest:");
3102 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &net->ro._l_addr.sa);
3103 }
3104 atomic_add_int(&sifa->refcount, 1);
3105 return (sifa);
3106 }
3107 #ifdef INET
3108 again_with_private_addresses_allowed:
3109 #endif
3110 /* plan_c: do we have an acceptable address on the emit interface */
3111 sifa = NULL;
3112 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Trying Plan C: find acceptable on interface\n");
3113 if (emit_ifn == NULL) {
3114 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Jump to Plan D - no emit_ifn\n");
3115 goto plan_d;
3116 }
3117 LIST_FOREACH(sctp_ifa, &emit_ifn->ifalist, next_ifa) {
3118 SCTPDBG(SCTP_DEBUG_OUTPUT2, "ifa:%p\n", (void *)sctp_ifa);
3119 #ifdef INET
3120 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
3121 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
3122 &sctp_ifa->address.sin.sin_addr) != 0)) {
3123 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Jailed\n");
3124 continue;
3125 }
3126 #endif
3127 #ifdef INET6
3128 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
3129 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
3130 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
3131 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Jailed\n");
3132 continue;
3133 }
3134 #endif
3135 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
3136 (non_asoc_addr_ok == 0)) {
3137 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Defer\n");
3138 continue;
3139 }
3140 sifa = sctp_is_ifa_addr_acceptable(sctp_ifa, dest_is_loop,
3141 dest_is_priv, fam);
3142 if (sifa == NULL) {
3143 SCTPDBG(SCTP_DEBUG_OUTPUT2, "IFA not acceptable\n");
3144 continue;
3145 }
3146 if (stcb) {
3147 if (sctp_is_address_in_scope(sifa, &stcb->asoc.scope, 0) == 0) {
3148 SCTPDBG(SCTP_DEBUG_OUTPUT2, "NOT in scope\n");
3149 sifa = NULL;
3150 continue;
3151 }
3152 if (((non_asoc_addr_ok == 0) &&
3153 (sctp_is_addr_restricted(stcb, sifa))) ||
3154 (non_asoc_addr_ok &&
3155 (sctp_is_addr_restricted(stcb, sifa)) &&
3156 (!sctp_is_addr_pending(stcb, sifa)))) {
3157 /*
3158 * It is restricted for some reason..
3159 * probably not yet added.
3160 */
3161 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Its restricted\n");
3162 sifa = NULL;
3163 continue;
3164 }
3165 }
3166 atomic_add_int(&sifa->refcount, 1);
3167 goto out;
3168 }
3169 plan_d:
3170 /*
3171 * plan_d: We are in trouble. No preferred address on the emit
3172 * interface. And not even a preferred address on all interfaces. Go
3173 * out and see if we can find an acceptable address somewhere
3174 * amongst all interfaces.
3175 */
3176 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Trying Plan D looked_at is %p\n", (void *)looked_at);
3177 LIST_FOREACH(sctp_ifn, &vrf->ifnlist, next_ifn) {
3178 if (dest_is_loop == 0 && SCTP_IFN_IS_IFT_LOOP(sctp_ifn)) {
3179 /* wrong base scope */
3180 continue;
3181 }
3182 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
3183 #ifdef INET
3184 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
3185 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
3186 &sctp_ifa->address.sin.sin_addr) != 0)) {
3187 continue;
3188 }
3189 #endif
3190 #ifdef INET6
3191 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
3192 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
3193 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
3194 continue;
3195 }
3196 #endif
3197 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
3198 (non_asoc_addr_ok == 0))
3199 continue;
3200 sifa = sctp_is_ifa_addr_acceptable(sctp_ifa,
3201 dest_is_loop,
3202 dest_is_priv, fam);
3203 if (sifa == NULL)
3204 continue;
3205 if (stcb) {
3206 if (sctp_is_address_in_scope(sifa, &stcb->asoc.scope, 0) == 0) {
3207 sifa = NULL;
3208 continue;
3209 }
3210 if (((non_asoc_addr_ok == 0) &&
3211 (sctp_is_addr_restricted(stcb, sifa))) ||
3212 (non_asoc_addr_ok &&
3213 (sctp_is_addr_restricted(stcb, sifa)) &&
3214 (!sctp_is_addr_pending(stcb, sifa)))) {
3215 /*
3216 * It is restricted for some
3217 * reason.. probably not yet added.
3218 */
3219 sifa = NULL;
3220 continue;
3221 }
3222 }
3223 goto out;
3224 }
3225 }
3226 #ifdef INET
3227 if (stcb) {
3228 if ((retried == 0) && (stcb->asoc.scope.ipv4_local_scope == 0)) {
3229 stcb->asoc.scope.ipv4_local_scope = 1;
3230 retried = 1;
3231 goto again_with_private_addresses_allowed;
3232 } else if (retried == 1) {
3233 stcb->asoc.scope.ipv4_local_scope = 0;
3234 }
3235 }
3236 #endif
3237 out:
3238 #ifdef INET
3239 if (sifa) {
3240 if (retried == 1) {
3241 LIST_FOREACH(sctp_ifn, &vrf->ifnlist, next_ifn) {
3242 if (dest_is_loop == 0 && SCTP_IFN_IS_IFT_LOOP(sctp_ifn)) {
3243 /* wrong base scope */
3244 continue;
3245 }
3246 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
3247 struct sctp_ifa *tmp_sifa;
3248
3249 #ifdef INET
3250 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
3251 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
3252 &sctp_ifa->address.sin.sin_addr) != 0)) {
3253 continue;
3254 }
3255 #endif
3256 #ifdef INET6
3257 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
3258 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
3259 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
3260 continue;
3261 }
3262 #endif
3263 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
3264 (non_asoc_addr_ok == 0))
3265 continue;
3266 tmp_sifa = sctp_is_ifa_addr_acceptable(sctp_ifa,
3267 dest_is_loop,
3268 dest_is_priv, fam);
3269 if (tmp_sifa == NULL) {
3270 continue;
3271 }
3272 if (tmp_sifa == sifa) {
3273 continue;
3274 }
3275 if (stcb) {
3276 if (sctp_is_address_in_scope(tmp_sifa,
3277 &stcb->asoc.scope, 0) == 0) {
3278 continue;
3279 }
3280 if (((non_asoc_addr_ok == 0) &&
3281 (sctp_is_addr_restricted(stcb, tmp_sifa))) ||
3282 (non_asoc_addr_ok &&
3283 (sctp_is_addr_restricted(stcb, tmp_sifa)) &&
3284 (!sctp_is_addr_pending(stcb, tmp_sifa)))) {
3285 /*
3286 * It is restricted
3287 * for some reason..
3288 * probably not yet
3289 * added.
3290 */
3291 continue;
3292 }
3293 }
3294 if ((tmp_sifa->address.sin.sin_family == AF_INET) &&
3295 (IN4_ISPRIVATE_ADDRESS(&(tmp_sifa->address.sin.sin_addr)))) {
3296 sctp_add_local_addr_restricted(stcb, tmp_sifa);
3297 }
3298 }
3299 }
3300 }
3301 atomic_add_int(&sifa->refcount, 1);
3302 }
3303 #endif
3304 return (sifa);
3305 }
3306
3307
3308
3309 /* tcb may be NULL */
3310 struct sctp_ifa *
sctp_source_address_selection(struct sctp_inpcb * inp,struct sctp_tcb * stcb,sctp_route_t * ro,struct sctp_nets * net,int non_asoc_addr_ok,uint32_t vrf_id)3311 sctp_source_address_selection(struct sctp_inpcb *inp,
3312 struct sctp_tcb *stcb,
3313 sctp_route_t *ro,
3314 struct sctp_nets *net,
3315 int non_asoc_addr_ok, uint32_t vrf_id)
3316 {
3317 struct sctp_ifa *answer;
3318 uint8_t dest_is_priv, dest_is_loop;
3319 sa_family_t fam;
3320 #ifdef INET
3321 struct sockaddr_in *to = (struct sockaddr_in *)&ro->ro_dst;
3322 #endif
3323 #ifdef INET6
3324 struct sockaddr_in6 *to6 = (struct sockaddr_in6 *)&ro->ro_dst;
3325 #endif
3326
3327 /**
3328 * Rules:
3329 * - Find the route if needed, cache if I can.
3330 * - Look at interface address in route, Is it in the bound list. If so we
3331 * have the best source.
3332 * - If not we must rotate amongst the addresses.
3333 *
3334 * Cavets and issues
3335 *
3336 * Do we need to pay attention to scope. We can have a private address
3337 * or a global address we are sourcing or sending to. So if we draw
3338 * it out
3339 * zzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzz
3340 * For V4
3341 * ------------------------------------------
3342 * source * dest * result
3343 * -----------------------------------------
3344 * <a> Private * Global * NAT
3345 * -----------------------------------------
3346 * <b> Private * Private * No problem
3347 * -----------------------------------------
3348 * <c> Global * Private * Huh, How will this work?
3349 * -----------------------------------------
3350 * <d> Global * Global * No Problem
3351 *------------------------------------------
3352 * zzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzz
3353 * For V6
3354 *------------------------------------------
3355 * source * dest * result
3356 * -----------------------------------------
3357 * <a> Linklocal * Global *
3358 * -----------------------------------------
3359 * <b> Linklocal * Linklocal * No problem
3360 * -----------------------------------------
3361 * <c> Global * Linklocal * Huh, How will this work?
3362 * -----------------------------------------
3363 * <d> Global * Global * No Problem
3364 *------------------------------------------
3365 * zzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzz
3366 *
3367 * And then we add to that what happens if there are multiple addresses
3368 * assigned to an interface. Remember the ifa on a ifn is a linked
3369 * list of addresses. So one interface can have more than one IP
3370 * address. What happens if we have both a private and a global
3371 * address? Do we then use context of destination to sort out which
3372 * one is best? And what about NAT's sending P->G may get you a NAT
3373 * translation, or should you select the G thats on the interface in
3374 * preference.
3375 *
3376 * Decisions:
3377 *
3378 * - count the number of addresses on the interface.
3379 * - if it is one, no problem except case <c>.
3380 * For <a> we will assume a NAT out there.
3381 * - if there are more than one, then we need to worry about scope P
3382 * or G. We should prefer G -> G and P -> P if possible.
3383 * Then as a secondary fall back to mixed types G->P being a last
3384 * ditch one.
3385 * - The above all works for bound all, but bound specific we need to
3386 * use the same concept but instead only consider the bound
3387 * addresses. If the bound set is NOT assigned to the interface then
3388 * we must use rotation amongst the bound addresses..
3389 */
3390 if (ro->ro_rt == NULL) {
3391 /*
3392 * Need a route to cache.
3393 */
3394 SCTP_RTALLOC(ro, vrf_id, inp->fibnum);
3395 }
3396 if (ro->ro_rt == NULL) {
3397 return (NULL);
3398 }
3399 fam = ro->ro_dst.sa_family;
3400 dest_is_priv = dest_is_loop = 0;
3401 /* Setup our scopes for the destination */
3402 switch (fam) {
3403 #ifdef INET
3404 case AF_INET:
3405 /* Scope based on outbound address */
3406 if (IN4_ISLOOPBACK_ADDRESS(&to->sin_addr)) {
3407 dest_is_loop = 1;
3408 if (net != NULL) {
3409 /* mark it as local */
3410 net->addr_is_local = 1;
3411 }
3412 } else if ((IN4_ISPRIVATE_ADDRESS(&to->sin_addr))) {
3413 dest_is_priv = 1;
3414 }
3415 break;
3416 #endif
3417 #ifdef INET6
3418 case AF_INET6:
3419 /* Scope based on outbound address */
3420 if (IN6_IS_ADDR_LOOPBACK(&to6->sin6_addr) ||
3421 SCTP_ROUTE_IS_REAL_LOOP(ro)) {
3422 /*
3423 * If the address is a loopback address, which
3424 * consists of "::1" OR "fe80::1%lo0", we are
3425 * loopback scope. But we don't use dest_is_priv
3426 * (link local addresses).
3427 */
3428 dest_is_loop = 1;
3429 if (net != NULL) {
3430 /* mark it as local */
3431 net->addr_is_local = 1;
3432 }
3433 } else if (IN6_IS_ADDR_LINKLOCAL(&to6->sin6_addr)) {
3434 dest_is_priv = 1;
3435 }
3436 break;
3437 #endif
3438 }
3439 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Select source addr for:");
3440 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)&ro->ro_dst);
3441 SCTP_IPI_ADDR_RLOCK();
3442 if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) {
3443 /*
3444 * Bound all case
3445 */
3446 answer = sctp_choose_boundall(inp, stcb, net, ro, vrf_id,
3447 dest_is_priv, dest_is_loop,
3448 non_asoc_addr_ok, fam);
3449 SCTP_IPI_ADDR_RUNLOCK();
3450 return (answer);
3451 }
3452 /*
3453 * Subset bound case
3454 */
3455 if (stcb) {
3456 answer = sctp_choose_boundspecific_stcb(inp, stcb, ro,
3457 vrf_id, dest_is_priv,
3458 dest_is_loop,
3459 non_asoc_addr_ok, fam);
3460 } else {
3461 answer = sctp_choose_boundspecific_inp(inp, ro, vrf_id,
3462 non_asoc_addr_ok,
3463 dest_is_priv,
3464 dest_is_loop, fam);
3465 }
3466 SCTP_IPI_ADDR_RUNLOCK();
3467 return (answer);
3468 }
3469
3470 static int
sctp_find_cmsg(int c_type,void * data,struct mbuf * control,size_t cpsize)3471 sctp_find_cmsg(int c_type, void *data, struct mbuf *control, size_t cpsize)
3472 {
3473 struct cmsghdr cmh;
3474 struct sctp_sndinfo sndinfo;
3475 struct sctp_prinfo prinfo;
3476 struct sctp_authinfo authinfo;
3477 int tot_len, rem_len, cmsg_data_len, cmsg_data_off, off;
3478 int found;
3479
3480 /*
3481 * Independent of how many mbufs, find the c_type inside the control
3482 * structure and copy out the data.
3483 */
3484 found = 0;
3485 tot_len = SCTP_BUF_LEN(control);
3486 for (off = 0; off < tot_len; off += CMSG_ALIGN(cmh.cmsg_len)) {
3487 rem_len = tot_len - off;
3488 if (rem_len < (int)CMSG_ALIGN(sizeof(cmh))) {
3489 /* There is not enough room for one more. */
3490 return (found);
3491 }
3492 m_copydata(control, off, sizeof(cmh), (caddr_t)&cmh);
3493 if (cmh.cmsg_len < CMSG_ALIGN(sizeof(cmh))) {
3494 /* We dont't have a complete CMSG header. */
3495 return (found);
3496 }
3497 if ((cmh.cmsg_len > INT_MAX) || ((int)cmh.cmsg_len > rem_len)) {
3498 /* We don't have the complete CMSG. */
3499 return (found);
3500 }
3501 cmsg_data_len = (int)cmh.cmsg_len - CMSG_ALIGN(sizeof(cmh));
3502 cmsg_data_off = off + CMSG_ALIGN(sizeof(cmh));
3503 if ((cmh.cmsg_level == IPPROTO_SCTP) &&
3504 ((c_type == cmh.cmsg_type) ||
3505 ((c_type == SCTP_SNDRCV) &&
3506 ((cmh.cmsg_type == SCTP_SNDINFO) ||
3507 (cmh.cmsg_type == SCTP_PRINFO) ||
3508 (cmh.cmsg_type == SCTP_AUTHINFO))))) {
3509 if (c_type == cmh.cmsg_type) {
3510 if (cpsize > INT_MAX) {
3511 return (found);
3512 }
3513 if (cmsg_data_len < (int)cpsize) {
3514 return (found);
3515 }
3516 /* It is exactly what we want. Copy it out. */
3517 m_copydata(control, cmsg_data_off, (int)cpsize, (caddr_t)data);
3518 return (1);
3519 } else {
3520 struct sctp_sndrcvinfo *sndrcvinfo;
3521
3522 sndrcvinfo = (struct sctp_sndrcvinfo *)data;
3523 if (found == 0) {
3524 if (cpsize < sizeof(struct sctp_sndrcvinfo)) {
3525 return (found);
3526 }
3527 memset(sndrcvinfo, 0, sizeof(struct sctp_sndrcvinfo));
3528 }
3529 switch (cmh.cmsg_type) {
3530 case SCTP_SNDINFO:
3531 if (cmsg_data_len < (int)sizeof(struct sctp_sndinfo)) {
3532 return (found);
3533 }
3534 m_copydata(control, cmsg_data_off, sizeof(struct sctp_sndinfo), (caddr_t)&sndinfo);
3535 sndrcvinfo->sinfo_stream = sndinfo.snd_sid;
3536 sndrcvinfo->sinfo_flags = sndinfo.snd_flags;
3537 sndrcvinfo->sinfo_ppid = sndinfo.snd_ppid;
3538 sndrcvinfo->sinfo_context = sndinfo.snd_context;
3539 sndrcvinfo->sinfo_assoc_id = sndinfo.snd_assoc_id;
3540 break;
3541 case SCTP_PRINFO:
3542 if (cmsg_data_len < (int)sizeof(struct sctp_prinfo)) {
3543 return (found);
3544 }
3545 m_copydata(control, cmsg_data_off, sizeof(struct sctp_prinfo), (caddr_t)&prinfo);
3546 if (prinfo.pr_policy != SCTP_PR_SCTP_NONE) {
3547 sndrcvinfo->sinfo_timetolive = prinfo.pr_value;
3548 } else {
3549 sndrcvinfo->sinfo_timetolive = 0;
3550 }
3551 sndrcvinfo->sinfo_flags |= prinfo.pr_policy;
3552 break;
3553 case SCTP_AUTHINFO:
3554 if (cmsg_data_len < (int)sizeof(struct sctp_authinfo)) {
3555 return (found);
3556 }
3557 m_copydata(control, cmsg_data_off, sizeof(struct sctp_authinfo), (caddr_t)&authinfo);
3558 sndrcvinfo->sinfo_keynumber_valid = 1;
3559 sndrcvinfo->sinfo_keynumber = authinfo.auth_keynumber;
3560 break;
3561 default:
3562 return (found);
3563 }
3564 found = 1;
3565 }
3566 }
3567 }
3568 return (found);
3569 }
3570
3571 static int
sctp_process_cmsgs_for_init(struct sctp_tcb * stcb,struct mbuf * control,int * error)3572 sctp_process_cmsgs_for_init(struct sctp_tcb *stcb, struct mbuf *control, int *error)
3573 {
3574 struct cmsghdr cmh;
3575 struct sctp_initmsg initmsg;
3576 #ifdef INET
3577 struct sockaddr_in sin;
3578 #endif
3579 #ifdef INET6
3580 struct sockaddr_in6 sin6;
3581 #endif
3582 int tot_len, rem_len, cmsg_data_len, cmsg_data_off, off;
3583
3584 tot_len = SCTP_BUF_LEN(control);
3585 for (off = 0; off < tot_len; off += CMSG_ALIGN(cmh.cmsg_len)) {
3586 rem_len = tot_len - off;
3587 if (rem_len < (int)CMSG_ALIGN(sizeof(cmh))) {
3588 /* There is not enough room for one more. */
3589 *error = EINVAL;
3590 return (1);
3591 }
3592 m_copydata(control, off, sizeof(cmh), (caddr_t)&cmh);
3593 if (cmh.cmsg_len < CMSG_ALIGN(sizeof(cmh))) {
3594 /* We dont't have a complete CMSG header. */
3595 *error = EINVAL;
3596 return (1);
3597 }
3598 if ((cmh.cmsg_len > INT_MAX) || ((int)cmh.cmsg_len > rem_len)) {
3599 /* We don't have the complete CMSG. */
3600 *error = EINVAL;
3601 return (1);
3602 }
3603 cmsg_data_len = (int)cmh.cmsg_len - CMSG_ALIGN(sizeof(cmh));
3604 cmsg_data_off = off + CMSG_ALIGN(sizeof(cmh));
3605 if (cmh.cmsg_level == IPPROTO_SCTP) {
3606 switch (cmh.cmsg_type) {
3607 case SCTP_INIT:
3608 if (cmsg_data_len < (int)sizeof(struct sctp_initmsg)) {
3609 *error = EINVAL;
3610 return (1);
3611 }
3612 m_copydata(control, cmsg_data_off, sizeof(struct sctp_initmsg), (caddr_t)&initmsg);
3613 if (initmsg.sinit_max_attempts)
3614 stcb->asoc.max_init_times = initmsg.sinit_max_attempts;
3615 if (initmsg.sinit_num_ostreams)
3616 stcb->asoc.pre_open_streams = initmsg.sinit_num_ostreams;
3617 if (initmsg.sinit_max_instreams)
3618 stcb->asoc.max_inbound_streams = initmsg.sinit_max_instreams;
3619 if (initmsg.sinit_max_init_timeo)
3620 stcb->asoc.initial_init_rto_max = initmsg.sinit_max_init_timeo;
3621 if (stcb->asoc.streamoutcnt < stcb->asoc.pre_open_streams) {
3622 struct sctp_stream_out *tmp_str;
3623 unsigned int i;
3624 #if defined(SCTP_DETAILED_STR_STATS)
3625 int j;
3626 #endif
3627
3628 /* Default is NOT correct */
3629 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Ok, default:%d pre_open:%d\n",
3630 stcb->asoc.streamoutcnt, stcb->asoc.pre_open_streams);
3631 SCTP_TCB_UNLOCK(stcb);
3632 SCTP_MALLOC(tmp_str,
3633 struct sctp_stream_out *,
3634 (stcb->asoc.pre_open_streams * sizeof(struct sctp_stream_out)),
3635 SCTP_M_STRMO);
3636 SCTP_TCB_LOCK(stcb);
3637 if (tmp_str != NULL) {
3638 SCTP_FREE(stcb->asoc.strmout, SCTP_M_STRMO);
3639 stcb->asoc.strmout = tmp_str;
3640 stcb->asoc.strm_realoutsize = stcb->asoc.streamoutcnt = stcb->asoc.pre_open_streams;
3641 } else {
3642 stcb->asoc.pre_open_streams = stcb->asoc.streamoutcnt;
3643 }
3644 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
3645 TAILQ_INIT(&stcb->asoc.strmout[i].outqueue);
3646 stcb->asoc.strmout[i].chunks_on_queues = 0;
3647 stcb->asoc.strmout[i].next_mid_ordered = 0;
3648 stcb->asoc.strmout[i].next_mid_unordered = 0;
3649 #if defined(SCTP_DETAILED_STR_STATS)
3650 for (j = 0; j < SCTP_PR_SCTP_MAX + 1; j++) {
3651 stcb->asoc.strmout[i].abandoned_sent[j] = 0;
3652 stcb->asoc.strmout[i].abandoned_unsent[j] = 0;
3653 }
3654 #else
3655 stcb->asoc.strmout[i].abandoned_sent[0] = 0;
3656 stcb->asoc.strmout[i].abandoned_unsent[0] = 0;
3657 #endif
3658 stcb->asoc.strmout[i].sid = i;
3659 stcb->asoc.strmout[i].last_msg_incomplete = 0;
3660 stcb->asoc.strmout[i].state = SCTP_STREAM_OPENING;
3661 stcb->asoc.ss_functions.sctp_ss_init_stream(stcb, &stcb->asoc.strmout[i], NULL);
3662 }
3663 }
3664 break;
3665 #ifdef INET
3666 case SCTP_DSTADDRV4:
3667 if (cmsg_data_len < (int)sizeof(struct in_addr)) {
3668 *error = EINVAL;
3669 return (1);
3670 }
3671 memset(&sin, 0, sizeof(struct sockaddr_in));
3672 sin.sin_family = AF_INET;
3673 sin.sin_len = sizeof(struct sockaddr_in);
3674 sin.sin_port = stcb->rport;
3675 m_copydata(control, cmsg_data_off, sizeof(struct in_addr), (caddr_t)&sin.sin_addr);
3676 if ((sin.sin_addr.s_addr == INADDR_ANY) ||
3677 (sin.sin_addr.s_addr == INADDR_BROADCAST) ||
3678 IN_MULTICAST(ntohl(sin.sin_addr.s_addr))) {
3679 *error = EINVAL;
3680 return (1);
3681 }
3682 if (sctp_add_remote_addr(stcb, (struct sockaddr *)&sin, NULL, stcb->asoc.port,
3683 SCTP_DONOT_SETSCOPE, SCTP_ADDR_IS_CONFIRMED)) {
3684 *error = ENOBUFS;
3685 return (1);
3686 }
3687 break;
3688 #endif
3689 #ifdef INET6
3690 case SCTP_DSTADDRV6:
3691 if (cmsg_data_len < (int)sizeof(struct in6_addr)) {
3692 *error = EINVAL;
3693 return (1);
3694 }
3695 memset(&sin6, 0, sizeof(struct sockaddr_in6));
3696 sin6.sin6_family = AF_INET6;
3697 sin6.sin6_len = sizeof(struct sockaddr_in6);
3698 sin6.sin6_port = stcb->rport;
3699 m_copydata(control, cmsg_data_off, sizeof(struct in6_addr), (caddr_t)&sin6.sin6_addr);
3700 if (IN6_IS_ADDR_UNSPECIFIED(&sin6.sin6_addr) ||
3701 IN6_IS_ADDR_MULTICAST(&sin6.sin6_addr)) {
3702 *error = EINVAL;
3703 return (1);
3704 }
3705 #ifdef INET
3706 if (IN6_IS_ADDR_V4MAPPED(&sin6.sin6_addr)) {
3707 in6_sin6_2_sin(&sin, &sin6);
3708 if ((sin.sin_addr.s_addr == INADDR_ANY) ||
3709 (sin.sin_addr.s_addr == INADDR_BROADCAST) ||
3710 IN_MULTICAST(ntohl(sin.sin_addr.s_addr))) {
3711 *error = EINVAL;
3712 return (1);
3713 }
3714 if (sctp_add_remote_addr(stcb, (struct sockaddr *)&sin, NULL, stcb->asoc.port,
3715 SCTP_DONOT_SETSCOPE, SCTP_ADDR_IS_CONFIRMED)) {
3716 *error = ENOBUFS;
3717 return (1);
3718 }
3719 } else
3720 #endif
3721 if (sctp_add_remote_addr(stcb, (struct sockaddr *)&sin6, NULL, stcb->asoc.port,
3722 SCTP_DONOT_SETSCOPE, SCTP_ADDR_IS_CONFIRMED)) {
3723 *error = ENOBUFS;
3724 return (1);
3725 }
3726 break;
3727 #endif
3728 default:
3729 break;
3730 }
3731 }
3732 }
3733 return (0);
3734 }
3735
3736 #if defined(INET) || defined(INET6)
3737 static struct sctp_tcb *
sctp_findassociation_cmsgs(struct sctp_inpcb ** inp_p,uint16_t port,struct mbuf * control,struct sctp_nets ** net_p,int * error)3738 sctp_findassociation_cmsgs(struct sctp_inpcb **inp_p,
3739 uint16_t port,
3740 struct mbuf *control,
3741 struct sctp_nets **net_p,
3742 int *error)
3743 {
3744 struct cmsghdr cmh;
3745 struct sctp_tcb *stcb;
3746 struct sockaddr *addr;
3747 #ifdef INET
3748 struct sockaddr_in sin;
3749 #endif
3750 #ifdef INET6
3751 struct sockaddr_in6 sin6;
3752 #endif
3753 int tot_len, rem_len, cmsg_data_len, cmsg_data_off, off;
3754
3755 tot_len = SCTP_BUF_LEN(control);
3756 for (off = 0; off < tot_len; off += CMSG_ALIGN(cmh.cmsg_len)) {
3757 rem_len = tot_len - off;
3758 if (rem_len < (int)CMSG_ALIGN(sizeof(cmh))) {
3759 /* There is not enough room for one more. */
3760 *error = EINVAL;
3761 return (NULL);
3762 }
3763 m_copydata(control, off, sizeof(cmh), (caddr_t)&cmh);
3764 if (cmh.cmsg_len < CMSG_ALIGN(sizeof(cmh))) {
3765 /* We dont't have a complete CMSG header. */
3766 *error = EINVAL;
3767 return (NULL);
3768 }
3769 if ((cmh.cmsg_len > INT_MAX) || ((int)cmh.cmsg_len > rem_len)) {
3770 /* We don't have the complete CMSG. */
3771 *error = EINVAL;
3772 return (NULL);
3773 }
3774 cmsg_data_len = (int)cmh.cmsg_len - CMSG_ALIGN(sizeof(cmh));
3775 cmsg_data_off = off + CMSG_ALIGN(sizeof(cmh));
3776 if (cmh.cmsg_level == IPPROTO_SCTP) {
3777 switch (cmh.cmsg_type) {
3778 #ifdef INET
3779 case SCTP_DSTADDRV4:
3780 if (cmsg_data_len < (int)sizeof(struct in_addr)) {
3781 *error = EINVAL;
3782 return (NULL);
3783 }
3784 memset(&sin, 0, sizeof(struct sockaddr_in));
3785 sin.sin_family = AF_INET;
3786 sin.sin_len = sizeof(struct sockaddr_in);
3787 sin.sin_port = port;
3788 m_copydata(control, cmsg_data_off, sizeof(struct in_addr), (caddr_t)&sin.sin_addr);
3789 addr = (struct sockaddr *)&sin;
3790 break;
3791 #endif
3792 #ifdef INET6
3793 case SCTP_DSTADDRV6:
3794 if (cmsg_data_len < (int)sizeof(struct in6_addr)) {
3795 *error = EINVAL;
3796 return (NULL);
3797 }
3798 memset(&sin6, 0, sizeof(struct sockaddr_in6));
3799 sin6.sin6_family = AF_INET6;
3800 sin6.sin6_len = sizeof(struct sockaddr_in6);
3801 sin6.sin6_port = port;
3802 m_copydata(control, cmsg_data_off, sizeof(struct in6_addr), (caddr_t)&sin6.sin6_addr);
3803 #ifdef INET
3804 if (IN6_IS_ADDR_V4MAPPED(&sin6.sin6_addr)) {
3805 in6_sin6_2_sin(&sin, &sin6);
3806 addr = (struct sockaddr *)&sin;
3807 } else
3808 #endif
3809 addr = (struct sockaddr *)&sin6;
3810 break;
3811 #endif
3812 default:
3813 addr = NULL;
3814 break;
3815 }
3816 if (addr) {
3817 stcb = sctp_findassociation_ep_addr(inp_p, addr, net_p, NULL, NULL);
3818 if (stcb != NULL) {
3819 return (stcb);
3820 }
3821 }
3822 }
3823 }
3824 return (NULL);
3825 }
3826 #endif
3827
3828 static struct mbuf *
sctp_add_cookie(struct mbuf * init,int init_offset,struct mbuf * initack,int initack_offset,struct sctp_state_cookie * stc_in,uint8_t ** signature)3829 sctp_add_cookie(struct mbuf *init, int init_offset,
3830 struct mbuf *initack, int initack_offset, struct sctp_state_cookie *stc_in, uint8_t **signature)
3831 {
3832 struct mbuf *copy_init, *copy_initack, *m_at, *sig, *mret;
3833 struct sctp_state_cookie *stc;
3834 struct sctp_paramhdr *ph;
3835 uint8_t *foo;
3836 int sig_offset;
3837 uint16_t cookie_sz;
3838
3839 mret = sctp_get_mbuf_for_msg((sizeof(struct sctp_state_cookie) +
3840 sizeof(struct sctp_paramhdr)), 0,
3841 M_NOWAIT, 1, MT_DATA);
3842 if (mret == NULL) {
3843 return (NULL);
3844 }
3845 copy_init = SCTP_M_COPYM(init, init_offset, M_COPYALL, M_NOWAIT);
3846 if (copy_init == NULL) {
3847 sctp_m_freem(mret);
3848 return (NULL);
3849 }
3850 #ifdef SCTP_MBUF_LOGGING
3851 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
3852 sctp_log_mbc(copy_init, SCTP_MBUF_ICOPY);
3853 }
3854 #endif
3855 copy_initack = SCTP_M_COPYM(initack, initack_offset, M_COPYALL,
3856 M_NOWAIT);
3857 if (copy_initack == NULL) {
3858 sctp_m_freem(mret);
3859 sctp_m_freem(copy_init);
3860 return (NULL);
3861 }
3862 #ifdef SCTP_MBUF_LOGGING
3863 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
3864 sctp_log_mbc(copy_initack, SCTP_MBUF_ICOPY);
3865 }
3866 #endif
3867 /* easy side we just drop it on the end */
3868 ph = mtod(mret, struct sctp_paramhdr *);
3869 SCTP_BUF_LEN(mret) = sizeof(struct sctp_state_cookie) +
3870 sizeof(struct sctp_paramhdr);
3871 stc = (struct sctp_state_cookie *)((caddr_t)ph +
3872 sizeof(struct sctp_paramhdr));
3873 ph->param_type = htons(SCTP_STATE_COOKIE);
3874 ph->param_length = 0; /* fill in at the end */
3875 /* Fill in the stc cookie data */
3876 memcpy(stc, stc_in, sizeof(struct sctp_state_cookie));
3877
3878 /* tack the INIT and then the INIT-ACK onto the chain */
3879 cookie_sz = 0;
3880 for (m_at = mret; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
3881 cookie_sz += SCTP_BUF_LEN(m_at);
3882 if (SCTP_BUF_NEXT(m_at) == NULL) {
3883 SCTP_BUF_NEXT(m_at) = copy_init;
3884 break;
3885 }
3886 }
3887 for (m_at = copy_init; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
3888 cookie_sz += SCTP_BUF_LEN(m_at);
3889 if (SCTP_BUF_NEXT(m_at) == NULL) {
3890 SCTP_BUF_NEXT(m_at) = copy_initack;
3891 break;
3892 }
3893 }
3894 for (m_at = copy_initack; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
3895 cookie_sz += SCTP_BUF_LEN(m_at);
3896 if (SCTP_BUF_NEXT(m_at) == NULL) {
3897 break;
3898 }
3899 }
3900 sig = sctp_get_mbuf_for_msg(SCTP_SECRET_SIZE, 0, M_NOWAIT, 1, MT_DATA);
3901 if (sig == NULL) {
3902 /* no space, so free the entire chain */
3903 sctp_m_freem(mret);
3904 return (NULL);
3905 }
3906 SCTP_BUF_LEN(sig) = 0;
3907 SCTP_BUF_NEXT(m_at) = sig;
3908 sig_offset = 0;
3909 foo = (uint8_t *)(mtod(sig, caddr_t)+sig_offset);
3910 memset(foo, 0, SCTP_SIGNATURE_SIZE);
3911 *signature = foo;
3912 SCTP_BUF_LEN(sig) += SCTP_SIGNATURE_SIZE;
3913 cookie_sz += SCTP_SIGNATURE_SIZE;
3914 ph->param_length = htons(cookie_sz);
3915 return (mret);
3916 }
3917
3918
3919 static uint8_t
sctp_get_ect(struct sctp_tcb * stcb)3920 sctp_get_ect(struct sctp_tcb *stcb)
3921 {
3922 if ((stcb != NULL) && (stcb->asoc.ecn_supported == 1)) {
3923 return (SCTP_ECT0_BIT);
3924 } else {
3925 return (0);
3926 }
3927 }
3928
3929 #if defined(INET) || defined(INET6)
3930 static void
sctp_handle_no_route(struct sctp_tcb * stcb,struct sctp_nets * net,int so_locked)3931 sctp_handle_no_route(struct sctp_tcb *stcb,
3932 struct sctp_nets *net,
3933 int so_locked)
3934 {
3935 SCTPDBG(SCTP_DEBUG_OUTPUT1, "dropped packet - no valid source addr\n");
3936
3937 if (net) {
3938 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Destination was ");
3939 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT1, &net->ro._l_addr.sa);
3940 if (net->dest_state & SCTP_ADDR_CONFIRMED) {
3941 if ((net->dest_state & SCTP_ADDR_REACHABLE) && stcb) {
3942 SCTPDBG(SCTP_DEBUG_OUTPUT1, "no route takes interface %p down\n", (void *)net);
3943 sctp_ulp_notify(SCTP_NOTIFY_INTERFACE_DOWN,
3944 stcb, 0,
3945 (void *)net,
3946 so_locked);
3947 net->dest_state &= ~SCTP_ADDR_REACHABLE;
3948 net->dest_state &= ~SCTP_ADDR_PF;
3949 }
3950 }
3951 if (stcb) {
3952 if (net == stcb->asoc.primary_destination) {
3953 /* need a new primary */
3954 struct sctp_nets *alt;
3955
3956 alt = sctp_find_alternate_net(stcb, net, 0);
3957 if (alt != net) {
3958 if (stcb->asoc.alternate) {
3959 sctp_free_remote_addr(stcb->asoc.alternate);
3960 }
3961 stcb->asoc.alternate = alt;
3962 atomic_add_int(&stcb->asoc.alternate->ref_count, 1);
3963 if (net->ro._s_addr) {
3964 sctp_free_ifa(net->ro._s_addr);
3965 net->ro._s_addr = NULL;
3966 }
3967 net->src_addr_selected = 0;
3968 }
3969 }
3970 }
3971 }
3972 }
3973 #endif
3974
3975 static int
sctp_lowlevel_chunk_output(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_nets * net,struct sockaddr * to,struct mbuf * m,uint32_t auth_offset,struct sctp_auth_chunk * auth,uint16_t auth_keyid,int nofragment_flag,int ecn_ok,int out_of_asoc_ok,uint16_t src_port,uint16_t dest_port,uint32_t v_tag,uint16_t port,union sctp_sockstore * over_addr,uint8_t mflowtype,uint32_t mflowid,int so_locked SCTP_UNUSED)3976 sctp_lowlevel_chunk_output(struct sctp_inpcb *inp,
3977 struct sctp_tcb *stcb, /* may be NULL */
3978 struct sctp_nets *net,
3979 struct sockaddr *to,
3980 struct mbuf *m,
3981 uint32_t auth_offset,
3982 struct sctp_auth_chunk *auth,
3983 uint16_t auth_keyid,
3984 int nofragment_flag,
3985 int ecn_ok,
3986 int out_of_asoc_ok,
3987 uint16_t src_port,
3988 uint16_t dest_port,
3989 uint32_t v_tag,
3990 uint16_t port,
3991 union sctp_sockstore *over_addr,
3992 uint8_t mflowtype, uint32_t mflowid,
3993 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
3994 int so_locked SCTP_UNUSED
3995 #else
3996 int so_locked
3997 #endif
3998 )
3999 {
4000 /* nofragment_flag to tell if IP_DF should be set (IPv4 only) */
4001 /**
4002 * Given a mbuf chain (via SCTP_BUF_NEXT()) that holds a packet header
4003 * WITH an SCTPHDR but no IP header, endpoint inp and sa structure:
4004 * - fill in the HMAC digest of any AUTH chunk in the packet.
4005 * - calculate and fill in the SCTP checksum.
4006 * - prepend an IP address header.
4007 * - if boundall use INADDR_ANY.
4008 * - if boundspecific do source address selection.
4009 * - set fragmentation option for ipV4.
4010 * - On return from IP output, check/adjust mtu size of output
4011 * interface and smallest_mtu size as well.
4012 */
4013 /* Will need ifdefs around this */
4014 struct mbuf *newm;
4015 struct sctphdr *sctphdr;
4016 int packet_length;
4017 int ret;
4018 #if defined(INET) || defined(INET6)
4019 uint32_t vrf_id;
4020 #endif
4021 #if defined(INET) || defined(INET6)
4022 struct mbuf *o_pak;
4023 sctp_route_t *ro = NULL;
4024 struct udphdr *udp = NULL;
4025 #endif
4026 uint8_t tos_value;
4027 #if defined(__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
4028 struct socket *so = NULL;
4029 #endif
4030
4031 if ((net) && (net->dest_state & SCTP_ADDR_OUT_OF_SCOPE)) {
4032 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EFAULT);
4033 sctp_m_freem(m);
4034 return (EFAULT);
4035 }
4036 #if defined(INET) || defined(INET6)
4037 if (stcb) {
4038 vrf_id = stcb->asoc.vrf_id;
4039 } else {
4040 vrf_id = inp->def_vrf_id;
4041 }
4042 #endif
4043 /* fill in the HMAC digest for any AUTH chunk in the packet */
4044 if ((auth != NULL) && (stcb != NULL)) {
4045 sctp_fill_hmac_digest_m(m, auth_offset, auth, stcb, auth_keyid);
4046 }
4047
4048 if (net) {
4049 tos_value = net->dscp;
4050 } else if (stcb) {
4051 tos_value = stcb->asoc.default_dscp;
4052 } else {
4053 tos_value = inp->sctp_ep.default_dscp;
4054 }
4055
4056 switch (to->sa_family) {
4057 #ifdef INET
4058 case AF_INET:
4059 {
4060 struct ip *ip = NULL;
4061 sctp_route_t iproute;
4062 int len;
4063
4064 len = SCTP_MIN_V4_OVERHEAD;
4065 if (port) {
4066 len += sizeof(struct udphdr);
4067 }
4068 newm = sctp_get_mbuf_for_msg(len, 1, M_NOWAIT, 1, MT_DATA);
4069 if (newm == NULL) {
4070 sctp_m_freem(m);
4071 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4072 return (ENOMEM);
4073 }
4074 SCTP_ALIGN_TO_END(newm, len);
4075 SCTP_BUF_LEN(newm) = len;
4076 SCTP_BUF_NEXT(newm) = m;
4077 m = newm;
4078 if (net != NULL) {
4079 m->m_pkthdr.flowid = net->flowid;
4080 M_HASHTYPE_SET(m, net->flowtype);
4081 } else {
4082 m->m_pkthdr.flowid = mflowid;
4083 M_HASHTYPE_SET(m, mflowtype);
4084 }
4085 packet_length = sctp_calculate_len(m);
4086 ip = mtod(m, struct ip *);
4087 ip->ip_v = IPVERSION;
4088 ip->ip_hl = (sizeof(struct ip) >> 2);
4089 if (tos_value == 0) {
4090 /*
4091 * This means especially, that it is not set
4092 * at the SCTP layer. So use the value from
4093 * the IP layer.
4094 */
4095 tos_value = inp->ip_inp.inp.inp_ip_tos;
4096 }
4097 tos_value &= 0xfc;
4098 if (ecn_ok) {
4099 tos_value |= sctp_get_ect(stcb);
4100 }
4101 if ((nofragment_flag) && (port == 0)) {
4102 ip->ip_off = htons(IP_DF);
4103 } else {
4104 ip->ip_off = htons(0);
4105 }
4106 /* FreeBSD has a function for ip_id's */
4107 ip_fillid(ip);
4108
4109 ip->ip_ttl = inp->ip_inp.inp.inp_ip_ttl;
4110 ip->ip_len = htons(packet_length);
4111 ip->ip_tos = tos_value;
4112 if (port) {
4113 ip->ip_p = IPPROTO_UDP;
4114 } else {
4115 ip->ip_p = IPPROTO_SCTP;
4116 }
4117 ip->ip_sum = 0;
4118 if (net == NULL) {
4119 ro = &iproute;
4120 memset(&iproute, 0, sizeof(iproute));
4121 memcpy(&ro->ro_dst, to, to->sa_len);
4122 } else {
4123 ro = (sctp_route_t *)&net->ro;
4124 }
4125 /* Now the address selection part */
4126 ip->ip_dst.s_addr = ((struct sockaddr_in *)to)->sin_addr.s_addr;
4127
4128 /* call the routine to select the src address */
4129 if (net && out_of_asoc_ok == 0) {
4130 if (net->ro._s_addr && (net->ro._s_addr->localifa_flags & (SCTP_BEING_DELETED | SCTP_ADDR_IFA_UNUSEABLE))) {
4131 sctp_free_ifa(net->ro._s_addr);
4132 net->ro._s_addr = NULL;
4133 net->src_addr_selected = 0;
4134 if (ro->ro_rt) {
4135 RTFREE(ro->ro_rt);
4136 ro->ro_rt = NULL;
4137 }
4138 }
4139 if (net->src_addr_selected == 0) {
4140 /* Cache the source address */
4141 net->ro._s_addr = sctp_source_address_selection(inp, stcb,
4142 ro, net, 0,
4143 vrf_id);
4144 net->src_addr_selected = 1;
4145 }
4146 if (net->ro._s_addr == NULL) {
4147 /* No route to host */
4148 net->src_addr_selected = 0;
4149 sctp_handle_no_route(stcb, net, so_locked);
4150 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4151 sctp_m_freem(m);
4152 return (EHOSTUNREACH);
4153 }
4154 ip->ip_src = net->ro._s_addr->address.sin.sin_addr;
4155 } else {
4156 if (over_addr == NULL) {
4157 struct sctp_ifa *_lsrc;
4158
4159 _lsrc = sctp_source_address_selection(inp, stcb, ro,
4160 net,
4161 out_of_asoc_ok,
4162 vrf_id);
4163 if (_lsrc == NULL) {
4164 sctp_handle_no_route(stcb, net, so_locked);
4165 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4166 sctp_m_freem(m);
4167 return (EHOSTUNREACH);
4168 }
4169 ip->ip_src = _lsrc->address.sin.sin_addr;
4170 sctp_free_ifa(_lsrc);
4171 } else {
4172 ip->ip_src = over_addr->sin.sin_addr;
4173 SCTP_RTALLOC(ro, vrf_id, inp->fibnum);
4174 }
4175 }
4176 if (port) {
4177 if (htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port)) == 0) {
4178 sctp_handle_no_route(stcb, net, so_locked);
4179 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4180 sctp_m_freem(m);
4181 return (EHOSTUNREACH);
4182 }
4183 udp = (struct udphdr *)((caddr_t)ip + sizeof(struct ip));
4184 udp->uh_sport = htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port));
4185 udp->uh_dport = port;
4186 udp->uh_ulen = htons((uint16_t)(packet_length - sizeof(struct ip)));
4187 if (V_udp_cksum) {
4188 udp->uh_sum = in_pseudo(ip->ip_src.s_addr, ip->ip_dst.s_addr, udp->uh_ulen + htons(IPPROTO_UDP));
4189 } else {
4190 udp->uh_sum = 0;
4191 }
4192 sctphdr = (struct sctphdr *)((caddr_t)udp + sizeof(struct udphdr));
4193 } else {
4194 sctphdr = (struct sctphdr *)((caddr_t)ip + sizeof(struct ip));
4195 }
4196
4197 sctphdr->src_port = src_port;
4198 sctphdr->dest_port = dest_port;
4199 sctphdr->v_tag = v_tag;
4200 sctphdr->checksum = 0;
4201
4202 /*
4203 * If source address selection fails and we find no
4204 * route then the ip_output should fail as well with
4205 * a NO_ROUTE_TO_HOST type error. We probably should
4206 * catch that somewhere and abort the association
4207 * right away (assuming this is an INIT being sent).
4208 */
4209 if (ro->ro_rt == NULL) {
4210 /*
4211 * src addr selection failed to find a route
4212 * (or valid source addr), so we can't get
4213 * there from here (yet)!
4214 */
4215 sctp_handle_no_route(stcb, net, so_locked);
4216 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4217 sctp_m_freem(m);
4218 return (EHOSTUNREACH);
4219 }
4220 if (ro != &iproute) {
4221 memcpy(&iproute, ro, sizeof(*ro));
4222 }
4223 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Calling ipv4 output routine from low level src addr:%x\n",
4224 (uint32_t)(ntohl(ip->ip_src.s_addr)));
4225 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Destination is %x\n",
4226 (uint32_t)(ntohl(ip->ip_dst.s_addr)));
4227 SCTPDBG(SCTP_DEBUG_OUTPUT3, "RTP route is %p through\n",
4228 (void *)ro->ro_rt);
4229
4230 if (SCTP_GET_HEADER_FOR_OUTPUT(o_pak)) {
4231 /* failed to prepend data, give up */
4232 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4233 sctp_m_freem(m);
4234 return (ENOMEM);
4235 }
4236 SCTP_ATTACH_CHAIN(o_pak, m, packet_length);
4237 if (port) {
4238 sctphdr->checksum = sctp_calculate_cksum(m, sizeof(struct ip) + sizeof(struct udphdr));
4239 SCTP_STAT_INCR(sctps_sendswcrc);
4240 if (V_udp_cksum) {
4241 SCTP_ENABLE_UDP_CSUM(o_pak);
4242 }
4243 } else {
4244 m->m_pkthdr.csum_flags = CSUM_SCTP;
4245 m->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
4246 SCTP_STAT_INCR(sctps_sendhwcrc);
4247 }
4248 #ifdef SCTP_PACKET_LOGGING
4249 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING)
4250 sctp_packet_log(o_pak);
4251 #endif
4252 /* send it out. table id is taken from stcb */
4253 #if defined(__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
4254 if ((SCTP_BASE_SYSCTL(sctp_output_unlocked)) && (so_locked)) {
4255 so = SCTP_INP_SO(inp);
4256 SCTP_SOCKET_UNLOCK(so, 0);
4257 }
4258 #endif
4259 SCTP_PROBE5(send, NULL, stcb, ip, stcb, sctphdr);
4260 SCTP_IP_OUTPUT(ret, o_pak, ro, stcb, vrf_id);
4261 #if defined(__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
4262 if ((SCTP_BASE_SYSCTL(sctp_output_unlocked)) && (so_locked)) {
4263 atomic_add_int(&stcb->asoc.refcnt, 1);
4264 SCTP_TCB_UNLOCK(stcb);
4265 SCTP_SOCKET_LOCK(so, 0);
4266 SCTP_TCB_LOCK(stcb);
4267 atomic_subtract_int(&stcb->asoc.refcnt, 1);
4268 }
4269 #endif
4270 if (port) {
4271 UDPSTAT_INC(udps_opackets);
4272 }
4273 SCTP_STAT_INCR(sctps_sendpackets);
4274 SCTP_STAT_INCR_COUNTER64(sctps_outpackets);
4275 if (ret)
4276 SCTP_STAT_INCR(sctps_senderrors);
4277
4278 SCTPDBG(SCTP_DEBUG_OUTPUT3, "IP output returns %d\n", ret);
4279 if (net == NULL) {
4280 /* free tempy routes */
4281 RO_RTFREE(ro);
4282 } else {
4283 if ((ro->ro_rt != NULL) && (net->ro._s_addr) &&
4284 ((net->dest_state & SCTP_ADDR_NO_PMTUD) == 0)) {
4285 uint32_t mtu;
4286
4287 mtu = SCTP_GATHER_MTU_FROM_ROUTE(net->ro._s_addr, &net->ro._l_addr.sa, ro->ro_rt);
4288 if (mtu > 0) {
4289 if (net->port) {
4290 mtu -= sizeof(struct udphdr);
4291 }
4292 if (mtu < net->mtu) {
4293 if ((stcb != NULL) && (stcb->asoc.smallest_mtu > mtu)) {
4294 sctp_mtu_size_reset(inp, &stcb->asoc, mtu);
4295 }
4296 net->mtu = mtu;
4297 }
4298 }
4299 } else if (ro->ro_rt == NULL) {
4300 /* route was freed */
4301 if (net->ro._s_addr &&
4302 net->src_addr_selected) {
4303 sctp_free_ifa(net->ro._s_addr);
4304 net->ro._s_addr = NULL;
4305 }
4306 net->src_addr_selected = 0;
4307 }
4308 }
4309 return (ret);
4310 }
4311 #endif
4312 #ifdef INET6
4313 case AF_INET6:
4314 {
4315 uint32_t flowlabel, flowinfo;
4316 struct ip6_hdr *ip6h;
4317 struct route_in6 ip6route;
4318 struct ifnet *ifp;
4319 struct sockaddr_in6 *sin6, tmp, *lsa6, lsa6_tmp;
4320 int prev_scope = 0;
4321 struct sockaddr_in6 lsa6_storage;
4322 int error;
4323 u_short prev_port = 0;
4324 int len;
4325
4326 if (net) {
4327 flowlabel = net->flowlabel;
4328 } else if (stcb) {
4329 flowlabel = stcb->asoc.default_flowlabel;
4330 } else {
4331 flowlabel = inp->sctp_ep.default_flowlabel;
4332 }
4333 if (flowlabel == 0) {
4334 /*
4335 * This means especially, that it is not set
4336 * at the SCTP layer. So use the value from
4337 * the IP layer.
4338 */
4339 flowlabel = ntohl(((struct in6pcb *)inp)->in6p_flowinfo);
4340 }
4341 flowlabel &= 0x000fffff;
4342 len = SCTP_MIN_OVERHEAD;
4343 if (port) {
4344 len += sizeof(struct udphdr);
4345 }
4346 newm = sctp_get_mbuf_for_msg(len, 1, M_NOWAIT, 1, MT_DATA);
4347 if (newm == NULL) {
4348 sctp_m_freem(m);
4349 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4350 return (ENOMEM);
4351 }
4352 SCTP_ALIGN_TO_END(newm, len);
4353 SCTP_BUF_LEN(newm) = len;
4354 SCTP_BUF_NEXT(newm) = m;
4355 m = newm;
4356 if (net != NULL) {
4357 m->m_pkthdr.flowid = net->flowid;
4358 M_HASHTYPE_SET(m, net->flowtype);
4359 } else {
4360 m->m_pkthdr.flowid = mflowid;
4361 M_HASHTYPE_SET(m, mflowtype);
4362 }
4363 packet_length = sctp_calculate_len(m);
4364
4365 ip6h = mtod(m, struct ip6_hdr *);
4366 /* protect *sin6 from overwrite */
4367 sin6 = (struct sockaddr_in6 *)to;
4368 tmp = *sin6;
4369 sin6 = &tmp;
4370
4371 /* KAME hack: embed scopeid */
4372 if (sa6_embedscope(sin6, MODULE_GLOBAL(ip6_use_defzone)) != 0) {
4373 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
4374 sctp_m_freem(m);
4375 return (EINVAL);
4376 }
4377 if (net == NULL) {
4378 memset(&ip6route, 0, sizeof(ip6route));
4379 ro = (sctp_route_t *)&ip6route;
4380 memcpy(&ro->ro_dst, sin6, sin6->sin6_len);
4381 } else {
4382 ro = (sctp_route_t *)&net->ro;
4383 }
4384 /*
4385 * We assume here that inp_flow is in host byte
4386 * order within the TCB!
4387 */
4388 if (tos_value == 0) {
4389 /*
4390 * This means especially, that it is not set
4391 * at the SCTP layer. So use the value from
4392 * the IP layer.
4393 */
4394 tos_value = (ntohl(((struct in6pcb *)inp)->in6p_flowinfo) >> 20) & 0xff;
4395 }
4396 tos_value &= 0xfc;
4397 if (ecn_ok) {
4398 tos_value |= sctp_get_ect(stcb);
4399 }
4400 flowinfo = 0x06;
4401 flowinfo <<= 8;
4402 flowinfo |= tos_value;
4403 flowinfo <<= 20;
4404 flowinfo |= flowlabel;
4405 ip6h->ip6_flow = htonl(flowinfo);
4406 if (port) {
4407 ip6h->ip6_nxt = IPPROTO_UDP;
4408 } else {
4409 ip6h->ip6_nxt = IPPROTO_SCTP;
4410 }
4411 ip6h->ip6_plen = htons((uint16_t)(packet_length - sizeof(struct ip6_hdr)));
4412 ip6h->ip6_dst = sin6->sin6_addr;
4413
4414 /*
4415 * Add SRC address selection here: we can only reuse
4416 * to a limited degree the kame src-addr-sel, since
4417 * we can try their selection but it may not be
4418 * bound.
4419 */
4420 memset(&lsa6_tmp, 0, sizeof(lsa6_tmp));
4421 lsa6_tmp.sin6_family = AF_INET6;
4422 lsa6_tmp.sin6_len = sizeof(lsa6_tmp);
4423 lsa6 = &lsa6_tmp;
4424 if (net && out_of_asoc_ok == 0) {
4425 if (net->ro._s_addr && (net->ro._s_addr->localifa_flags & (SCTP_BEING_DELETED | SCTP_ADDR_IFA_UNUSEABLE))) {
4426 sctp_free_ifa(net->ro._s_addr);
4427 net->ro._s_addr = NULL;
4428 net->src_addr_selected = 0;
4429 if (ro->ro_rt) {
4430 RTFREE(ro->ro_rt);
4431 ro->ro_rt = NULL;
4432 }
4433 }
4434 if (net->src_addr_selected == 0) {
4435 sin6 = (struct sockaddr_in6 *)&net->ro._l_addr;
4436 /* KAME hack: embed scopeid */
4437 if (sa6_embedscope(sin6, MODULE_GLOBAL(ip6_use_defzone)) != 0) {
4438 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
4439 sctp_m_freem(m);
4440 return (EINVAL);
4441 }
4442 /* Cache the source address */
4443 net->ro._s_addr = sctp_source_address_selection(inp,
4444 stcb,
4445 ro,
4446 net,
4447 0,
4448 vrf_id);
4449 (void)sa6_recoverscope(sin6);
4450 net->src_addr_selected = 1;
4451 }
4452 if (net->ro._s_addr == NULL) {
4453 SCTPDBG(SCTP_DEBUG_OUTPUT3, "V6:No route to host\n");
4454 net->src_addr_selected = 0;
4455 sctp_handle_no_route(stcb, net, so_locked);
4456 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4457 sctp_m_freem(m);
4458 return (EHOSTUNREACH);
4459 }
4460 lsa6->sin6_addr = net->ro._s_addr->address.sin6.sin6_addr;
4461 } else {
4462 sin6 = (struct sockaddr_in6 *)&ro->ro_dst;
4463 /* KAME hack: embed scopeid */
4464 if (sa6_embedscope(sin6, MODULE_GLOBAL(ip6_use_defzone)) != 0) {
4465 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
4466 sctp_m_freem(m);
4467 return (EINVAL);
4468 }
4469 if (over_addr == NULL) {
4470 struct sctp_ifa *_lsrc;
4471
4472 _lsrc = sctp_source_address_selection(inp, stcb, ro,
4473 net,
4474 out_of_asoc_ok,
4475 vrf_id);
4476 if (_lsrc == NULL) {
4477 sctp_handle_no_route(stcb, net, so_locked);
4478 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4479 sctp_m_freem(m);
4480 return (EHOSTUNREACH);
4481 }
4482 lsa6->sin6_addr = _lsrc->address.sin6.sin6_addr;
4483 sctp_free_ifa(_lsrc);
4484 } else {
4485 lsa6->sin6_addr = over_addr->sin6.sin6_addr;
4486 SCTP_RTALLOC(ro, vrf_id, inp->fibnum);
4487 }
4488 (void)sa6_recoverscope(sin6);
4489 }
4490 lsa6->sin6_port = inp->sctp_lport;
4491
4492 if (ro->ro_rt == NULL) {
4493 /*
4494 * src addr selection failed to find a route
4495 * (or valid source addr), so we can't get
4496 * there from here!
4497 */
4498 sctp_handle_no_route(stcb, net, so_locked);
4499 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4500 sctp_m_freem(m);
4501 return (EHOSTUNREACH);
4502 }
4503 /*
4504 * XXX: sa6 may not have a valid sin6_scope_id in
4505 * the non-SCOPEDROUTING case.
4506 */
4507 memset(&lsa6_storage, 0, sizeof(lsa6_storage));
4508 lsa6_storage.sin6_family = AF_INET6;
4509 lsa6_storage.sin6_len = sizeof(lsa6_storage);
4510 lsa6_storage.sin6_addr = lsa6->sin6_addr;
4511 if ((error = sa6_recoverscope(&lsa6_storage)) != 0) {
4512 SCTPDBG(SCTP_DEBUG_OUTPUT3, "recover scope fails error %d\n", error);
4513 sctp_m_freem(m);
4514 return (error);
4515 }
4516 /* XXX */
4517 lsa6_storage.sin6_addr = lsa6->sin6_addr;
4518 lsa6_storage.sin6_port = inp->sctp_lport;
4519 lsa6 = &lsa6_storage;
4520 ip6h->ip6_src = lsa6->sin6_addr;
4521
4522 if (port) {
4523 if (htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port)) == 0) {
4524 sctp_handle_no_route(stcb, net, so_locked);
4525 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4526 sctp_m_freem(m);
4527 return (EHOSTUNREACH);
4528 }
4529 udp = (struct udphdr *)((caddr_t)ip6h + sizeof(struct ip6_hdr));
4530 udp->uh_sport = htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port));
4531 udp->uh_dport = port;
4532 udp->uh_ulen = htons((uint16_t)(packet_length - sizeof(struct ip6_hdr)));
4533 udp->uh_sum = 0;
4534 sctphdr = (struct sctphdr *)((caddr_t)udp + sizeof(struct udphdr));
4535 } else {
4536 sctphdr = (struct sctphdr *)((caddr_t)ip6h + sizeof(struct ip6_hdr));
4537 }
4538
4539 sctphdr->src_port = src_port;
4540 sctphdr->dest_port = dest_port;
4541 sctphdr->v_tag = v_tag;
4542 sctphdr->checksum = 0;
4543
4544 /*
4545 * We set the hop limit now since there is a good
4546 * chance that our ro pointer is now filled
4547 */
4548 ip6h->ip6_hlim = SCTP_GET_HLIM(inp, ro);
4549 ifp = SCTP_GET_IFN_VOID_FROM_ROUTE(ro);
4550
4551 #ifdef SCTP_DEBUG
4552 /* Copy to be sure something bad is not happening */
4553 sin6->sin6_addr = ip6h->ip6_dst;
4554 lsa6->sin6_addr = ip6h->ip6_src;
4555 #endif
4556
4557 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Calling ipv6 output routine from low level\n");
4558 SCTPDBG(SCTP_DEBUG_OUTPUT3, "src: ");
4559 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT3, (struct sockaddr *)lsa6);
4560 SCTPDBG(SCTP_DEBUG_OUTPUT3, "dst: ");
4561 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT3, (struct sockaddr *)sin6);
4562 if (net) {
4563 sin6 = (struct sockaddr_in6 *)&net->ro._l_addr;
4564 /*
4565 * preserve the port and scope for link
4566 * local send
4567 */
4568 prev_scope = sin6->sin6_scope_id;
4569 prev_port = sin6->sin6_port;
4570 }
4571
4572 if (SCTP_GET_HEADER_FOR_OUTPUT(o_pak)) {
4573 /* failed to prepend data, give up */
4574 sctp_m_freem(m);
4575 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4576 return (ENOMEM);
4577 }
4578 SCTP_ATTACH_CHAIN(o_pak, m, packet_length);
4579 if (port) {
4580 sctphdr->checksum = sctp_calculate_cksum(m, sizeof(struct ip6_hdr) + sizeof(struct udphdr));
4581 SCTP_STAT_INCR(sctps_sendswcrc);
4582 if ((udp->uh_sum = in6_cksum(o_pak, IPPROTO_UDP, sizeof(struct ip6_hdr), packet_length - sizeof(struct ip6_hdr))) == 0) {
4583 udp->uh_sum = 0xffff;
4584 }
4585 } else {
4586 m->m_pkthdr.csum_flags = CSUM_SCTP_IPV6;
4587 m->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
4588 SCTP_STAT_INCR(sctps_sendhwcrc);
4589 }
4590 /* send it out. table id is taken from stcb */
4591 #if defined(__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
4592 if ((SCTP_BASE_SYSCTL(sctp_output_unlocked)) && (so_locked)) {
4593 so = SCTP_INP_SO(inp);
4594 SCTP_SOCKET_UNLOCK(so, 0);
4595 }
4596 #endif
4597 #ifdef SCTP_PACKET_LOGGING
4598 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING)
4599 sctp_packet_log(o_pak);
4600 #endif
4601 SCTP_PROBE5(send, NULL, stcb, ip6h, stcb, sctphdr);
4602 SCTP_IP6_OUTPUT(ret, o_pak, (struct route_in6 *)ro, &ifp, stcb, vrf_id);
4603 #if defined(__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
4604 if ((SCTP_BASE_SYSCTL(sctp_output_unlocked)) && (so_locked)) {
4605 atomic_add_int(&stcb->asoc.refcnt, 1);
4606 SCTP_TCB_UNLOCK(stcb);
4607 SCTP_SOCKET_LOCK(so, 0);
4608 SCTP_TCB_LOCK(stcb);
4609 atomic_subtract_int(&stcb->asoc.refcnt, 1);
4610 }
4611 #endif
4612 if (net) {
4613 /* for link local this must be done */
4614 sin6->sin6_scope_id = prev_scope;
4615 sin6->sin6_port = prev_port;
4616 }
4617 SCTPDBG(SCTP_DEBUG_OUTPUT3, "return from send is %d\n", ret);
4618 if (port) {
4619 UDPSTAT_INC(udps_opackets);
4620 }
4621 SCTP_STAT_INCR(sctps_sendpackets);
4622 SCTP_STAT_INCR_COUNTER64(sctps_outpackets);
4623 if (ret) {
4624 SCTP_STAT_INCR(sctps_senderrors);
4625 }
4626 if (net == NULL) {
4627 /* Now if we had a temp route free it */
4628 RO_RTFREE(ro);
4629 } else {
4630 /*
4631 * PMTU check versus smallest asoc MTU goes
4632 * here
4633 */
4634 if (ro->ro_rt == NULL) {
4635 /* Route was freed */
4636 if (net->ro._s_addr &&
4637 net->src_addr_selected) {
4638 sctp_free_ifa(net->ro._s_addr);
4639 net->ro._s_addr = NULL;
4640 }
4641 net->src_addr_selected = 0;
4642 }
4643 if ((ro->ro_rt != NULL) && (net->ro._s_addr) &&
4644 ((net->dest_state & SCTP_ADDR_NO_PMTUD) == 0)) {
4645 uint32_t mtu;
4646
4647 mtu = SCTP_GATHER_MTU_FROM_ROUTE(net->ro._s_addr, &net->ro._l_addr.sa, ro->ro_rt);
4648 if (mtu > 0) {
4649 if (net->port) {
4650 mtu -= sizeof(struct udphdr);
4651 }
4652 if (mtu < net->mtu) {
4653 if ((stcb != NULL) && (stcb->asoc.smallest_mtu > mtu)) {
4654 sctp_mtu_size_reset(inp, &stcb->asoc, mtu);
4655 }
4656 net->mtu = mtu;
4657 }
4658 }
4659 } else if (ifp) {
4660 if (ND_IFINFO(ifp)->linkmtu &&
4661 (stcb->asoc.smallest_mtu > ND_IFINFO(ifp)->linkmtu)) {
4662 sctp_mtu_size_reset(inp,
4663 &stcb->asoc,
4664 ND_IFINFO(ifp)->linkmtu);
4665 }
4666 }
4667 }
4668 return (ret);
4669 }
4670 #endif
4671 default:
4672 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Unknown protocol (TSNH) type %d\n",
4673 ((struct sockaddr *)to)->sa_family);
4674 sctp_m_freem(m);
4675 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EFAULT);
4676 return (EFAULT);
4677 }
4678 }
4679
4680
4681 void
sctp_send_initiate(struct sctp_inpcb * inp,struct sctp_tcb * stcb,int so_locked SCTP_UNUSED)4682 sctp_send_initiate(struct sctp_inpcb *inp, struct sctp_tcb *stcb, int so_locked
4683 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
4684 SCTP_UNUSED
4685 #endif
4686 )
4687 {
4688 struct mbuf *m, *m_last;
4689 struct sctp_nets *net;
4690 struct sctp_init_chunk *init;
4691 struct sctp_supported_addr_param *sup_addr;
4692 struct sctp_adaptation_layer_indication *ali;
4693 struct sctp_supported_chunk_types_param *pr_supported;
4694 struct sctp_paramhdr *ph;
4695 int cnt_inits_to = 0;
4696 int error;
4697 uint16_t num_ext, chunk_len, padding_len, parameter_len;
4698
4699 /* INIT's always go to the primary (and usually ONLY address) */
4700 net = stcb->asoc.primary_destination;
4701 if (net == NULL) {
4702 net = TAILQ_FIRST(&stcb->asoc.nets);
4703 if (net == NULL) {
4704 /* TSNH */
4705 return;
4706 }
4707 /* we confirm any address we send an INIT to */
4708 net->dest_state &= ~SCTP_ADDR_UNCONFIRMED;
4709 (void)sctp_set_primary_addr(stcb, NULL, net);
4710 } else {
4711 /* we confirm any address we send an INIT to */
4712 net->dest_state &= ~SCTP_ADDR_UNCONFIRMED;
4713 }
4714 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT\n");
4715 #ifdef INET6
4716 if (net->ro._l_addr.sa.sa_family == AF_INET6) {
4717 /*
4718 * special hook, if we are sending to link local it will not
4719 * show up in our private address count.
4720 */
4721 if (IN6_IS_ADDR_LINKLOCAL(&net->ro._l_addr.sin6.sin6_addr))
4722 cnt_inits_to = 1;
4723 }
4724 #endif
4725 if (SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
4726 /* This case should not happen */
4727 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT - failed timer?\n");
4728 return;
4729 }
4730 /* start the INIT timer */
4731 sctp_timer_start(SCTP_TIMER_TYPE_INIT, inp, stcb, net);
4732
4733 m = sctp_get_mbuf_for_msg(MCLBYTES, 1, M_NOWAIT, 1, MT_DATA);
4734 if (m == NULL) {
4735 /* No memory, INIT timer will re-attempt. */
4736 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT - mbuf?\n");
4737 return;
4738 }
4739 chunk_len = (uint16_t)sizeof(struct sctp_init_chunk);
4740 padding_len = 0;
4741 /* Now lets put the chunk header in place */
4742 init = mtod(m, struct sctp_init_chunk *);
4743 /* now the chunk header */
4744 init->ch.chunk_type = SCTP_INITIATION;
4745 init->ch.chunk_flags = 0;
4746 /* fill in later from mbuf we build */
4747 init->ch.chunk_length = 0;
4748 /* place in my tag */
4749 init->init.initiate_tag = htonl(stcb->asoc.my_vtag);
4750 /* set up some of the credits. */
4751 init->init.a_rwnd = htonl(max(inp->sctp_socket ? SCTP_SB_LIMIT_RCV(inp->sctp_socket) : 0,
4752 SCTP_MINIMAL_RWND));
4753 init->init.num_outbound_streams = htons(stcb->asoc.pre_open_streams);
4754 init->init.num_inbound_streams = htons(stcb->asoc.max_inbound_streams);
4755 init->init.initial_tsn = htonl(stcb->asoc.init_seq_number);
4756
4757 /* Adaptation layer indication parameter */
4758 if (inp->sctp_ep.adaptation_layer_indicator_provided) {
4759 parameter_len = (uint16_t)sizeof(struct sctp_adaptation_layer_indication);
4760 ali = (struct sctp_adaptation_layer_indication *)(mtod(m, caddr_t)+chunk_len);
4761 ali->ph.param_type = htons(SCTP_ULP_ADAPTATION);
4762 ali->ph.param_length = htons(parameter_len);
4763 ali->indication = htonl(inp->sctp_ep.adaptation_layer_indicator);
4764 chunk_len += parameter_len;
4765 }
4766
4767 /* ECN parameter */
4768 if (stcb->asoc.ecn_supported == 1) {
4769 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4770 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
4771 ph->param_type = htons(SCTP_ECN_CAPABLE);
4772 ph->param_length = htons(parameter_len);
4773 chunk_len += parameter_len;
4774 }
4775
4776 /* PR-SCTP supported parameter */
4777 if (stcb->asoc.prsctp_supported == 1) {
4778 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4779 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
4780 ph->param_type = htons(SCTP_PRSCTP_SUPPORTED);
4781 ph->param_length = htons(parameter_len);
4782 chunk_len += parameter_len;
4783 }
4784
4785 /* Add NAT friendly parameter. */
4786 if (SCTP_BASE_SYSCTL(sctp_inits_include_nat_friendly)) {
4787 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4788 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
4789 ph->param_type = htons(SCTP_HAS_NAT_SUPPORT);
4790 ph->param_length = htons(parameter_len);
4791 chunk_len += parameter_len;
4792 }
4793
4794 /* And now tell the peer which extensions we support */
4795 num_ext = 0;
4796 pr_supported = (struct sctp_supported_chunk_types_param *)(mtod(m, caddr_t)+chunk_len);
4797 if (stcb->asoc.prsctp_supported == 1) {
4798 pr_supported->chunk_types[num_ext++] = SCTP_FORWARD_CUM_TSN;
4799 if (stcb->asoc.idata_supported) {
4800 pr_supported->chunk_types[num_ext++] = SCTP_IFORWARD_CUM_TSN;
4801 }
4802 }
4803 if (stcb->asoc.auth_supported == 1) {
4804 pr_supported->chunk_types[num_ext++] = SCTP_AUTHENTICATION;
4805 }
4806 if (stcb->asoc.asconf_supported == 1) {
4807 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF;
4808 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF_ACK;
4809 }
4810 if (stcb->asoc.reconfig_supported == 1) {
4811 pr_supported->chunk_types[num_ext++] = SCTP_STREAM_RESET;
4812 }
4813 if (stcb->asoc.idata_supported) {
4814 pr_supported->chunk_types[num_ext++] = SCTP_IDATA;
4815 }
4816 if (stcb->asoc.nrsack_supported == 1) {
4817 pr_supported->chunk_types[num_ext++] = SCTP_NR_SELECTIVE_ACK;
4818 }
4819 if (stcb->asoc.pktdrop_supported == 1) {
4820 pr_supported->chunk_types[num_ext++] = SCTP_PACKET_DROPPED;
4821 }
4822 if (num_ext > 0) {
4823 parameter_len = (uint16_t)sizeof(struct sctp_supported_chunk_types_param) + num_ext;
4824 pr_supported->ph.param_type = htons(SCTP_SUPPORTED_CHUNK_EXT);
4825 pr_supported->ph.param_length = htons(parameter_len);
4826 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4827 chunk_len += parameter_len;
4828 }
4829 /* add authentication parameters */
4830 if (stcb->asoc.auth_supported) {
4831 /* attach RANDOM parameter, if available */
4832 if (stcb->asoc.authinfo.random != NULL) {
4833 struct sctp_auth_random *randp;
4834
4835 if (padding_len > 0) {
4836 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4837 chunk_len += padding_len;
4838 padding_len = 0;
4839 }
4840 randp = (struct sctp_auth_random *)(mtod(m, caddr_t)+chunk_len);
4841 parameter_len = (uint16_t)sizeof(struct sctp_auth_random) + stcb->asoc.authinfo.random_len;
4842 /* random key already contains the header */
4843 memcpy(randp, stcb->asoc.authinfo.random->key, parameter_len);
4844 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4845 chunk_len += parameter_len;
4846 }
4847 /* add HMAC_ALGO parameter */
4848 if (stcb->asoc.local_hmacs != NULL) {
4849 struct sctp_auth_hmac_algo *hmacs;
4850
4851 if (padding_len > 0) {
4852 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4853 chunk_len += padding_len;
4854 padding_len = 0;
4855 }
4856 hmacs = (struct sctp_auth_hmac_algo *)(mtod(m, caddr_t)+chunk_len);
4857 parameter_len = (uint16_t)(sizeof(struct sctp_auth_hmac_algo) +
4858 stcb->asoc.local_hmacs->num_algo * sizeof(uint16_t));
4859 hmacs->ph.param_type = htons(SCTP_HMAC_LIST);
4860 hmacs->ph.param_length = htons(parameter_len);
4861 sctp_serialize_hmaclist(stcb->asoc.local_hmacs, (uint8_t *)hmacs->hmac_ids);
4862 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4863 chunk_len += parameter_len;
4864 }
4865 /* add CHUNKS parameter */
4866 if (stcb->asoc.local_auth_chunks != NULL) {
4867 struct sctp_auth_chunk_list *chunks;
4868
4869 if (padding_len > 0) {
4870 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4871 chunk_len += padding_len;
4872 padding_len = 0;
4873 }
4874 chunks = (struct sctp_auth_chunk_list *)(mtod(m, caddr_t)+chunk_len);
4875 parameter_len = (uint16_t)(sizeof(struct sctp_auth_chunk_list) +
4876 sctp_auth_get_chklist_size(stcb->asoc.local_auth_chunks));
4877 chunks->ph.param_type = htons(SCTP_CHUNK_LIST);
4878 chunks->ph.param_length = htons(parameter_len);
4879 sctp_serialize_auth_chunks(stcb->asoc.local_auth_chunks, chunks->chunk_types);
4880 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4881 chunk_len += parameter_len;
4882 }
4883 }
4884
4885 /* now any cookie time extensions */
4886 if (stcb->asoc.cookie_preserve_req) {
4887 struct sctp_cookie_perserve_param *cookie_preserve;
4888
4889 if (padding_len > 0) {
4890 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4891 chunk_len += padding_len;
4892 padding_len = 0;
4893 }
4894 parameter_len = (uint16_t)sizeof(struct sctp_cookie_perserve_param);
4895 cookie_preserve = (struct sctp_cookie_perserve_param *)(mtod(m, caddr_t)+chunk_len);
4896 cookie_preserve->ph.param_type = htons(SCTP_COOKIE_PRESERVE);
4897 cookie_preserve->ph.param_length = htons(parameter_len);
4898 cookie_preserve->time = htonl(stcb->asoc.cookie_preserve_req);
4899 stcb->asoc.cookie_preserve_req = 0;
4900 chunk_len += parameter_len;
4901 }
4902
4903 if (stcb->asoc.scope.ipv4_addr_legal || stcb->asoc.scope.ipv6_addr_legal) {
4904 uint8_t i;
4905
4906 if (padding_len > 0) {
4907 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4908 chunk_len += padding_len;
4909 padding_len = 0;
4910 }
4911 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4912 if (stcb->asoc.scope.ipv4_addr_legal) {
4913 parameter_len += (uint16_t)sizeof(uint16_t);
4914 }
4915 if (stcb->asoc.scope.ipv6_addr_legal) {
4916 parameter_len += (uint16_t)sizeof(uint16_t);
4917 }
4918 sup_addr = (struct sctp_supported_addr_param *)(mtod(m, caddr_t)+chunk_len);
4919 sup_addr->ph.param_type = htons(SCTP_SUPPORTED_ADDRTYPE);
4920 sup_addr->ph.param_length = htons(parameter_len);
4921 i = 0;
4922 if (stcb->asoc.scope.ipv4_addr_legal) {
4923 sup_addr->addr_type[i++] = htons(SCTP_IPV4_ADDRESS);
4924 }
4925 if (stcb->asoc.scope.ipv6_addr_legal) {
4926 sup_addr->addr_type[i++] = htons(SCTP_IPV6_ADDRESS);
4927 }
4928 padding_len = 4 - 2 * i;
4929 chunk_len += parameter_len;
4930 }
4931
4932 SCTP_BUF_LEN(m) = chunk_len;
4933 /* now the addresses */
4934 /*
4935 * To optimize this we could put the scoping stuff into a structure
4936 * and remove the individual uint8's from the assoc structure. Then
4937 * we could just sifa in the address within the stcb. But for now
4938 * this is a quick hack to get the address stuff teased apart.
4939 */
4940 m_last = sctp_add_addresses_to_i_ia(inp, stcb, &stcb->asoc.scope,
4941 m, cnt_inits_to,
4942 &padding_len, &chunk_len);
4943
4944 init->ch.chunk_length = htons(chunk_len);
4945 if (padding_len > 0) {
4946 if (sctp_add_pad_tombuf(m_last, padding_len) == NULL) {
4947 sctp_m_freem(m);
4948 return;
4949 }
4950 }
4951 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT - calls lowlevel_output\n");
4952 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
4953 (struct sockaddr *)&net->ro._l_addr,
4954 m, 0, NULL, 0, 0, 0, 0,
4955 inp->sctp_lport, stcb->rport, htonl(0),
4956 net->port, NULL,
4957 0, 0,
4958 so_locked))) {
4959 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Gak send error %d\n", error);
4960 if (error == ENOBUFS) {
4961 stcb->asoc.ifp_had_enobuf = 1;
4962 SCTP_STAT_INCR(sctps_lowlevelerr);
4963 }
4964 } else {
4965 stcb->asoc.ifp_had_enobuf = 0;
4966 }
4967 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
4968 (void)SCTP_GETTIME_TIMEVAL(&net->last_sent_time);
4969 }
4970
4971 struct mbuf *
sctp_arethere_unrecognized_parameters(struct mbuf * in_initpkt,int param_offset,int * abort_processing,struct sctp_chunkhdr * cp,int * nat_friendly,int * cookie_found)4972 sctp_arethere_unrecognized_parameters(struct mbuf *in_initpkt,
4973 int param_offset, int *abort_processing,
4974 struct sctp_chunkhdr *cp,
4975 int *nat_friendly,
4976 int *cookie_found)
4977 {
4978 /*
4979 * Given a mbuf containing an INIT or INIT-ACK with the param_offset
4980 * being equal to the beginning of the params i.e. (iphlen +
4981 * sizeof(struct sctp_init_msg) parse through the parameters to the
4982 * end of the mbuf verifying that all parameters are known.
4983 *
4984 * For unknown parameters build and return a mbuf with
4985 * UNRECOGNIZED_PARAMETER errors. If the flags indicate to stop
4986 * processing this chunk stop, and set *abort_processing to 1.
4987 *
4988 * By having param_offset be pre-set to where parameters begin it is
4989 * hoped that this routine may be reused in the future by new
4990 * features.
4991 */
4992 struct sctp_paramhdr *phdr, params;
4993
4994 struct mbuf *mat, *m_tmp, *op_err, *op_err_last;
4995 int at, limit, pad_needed;
4996 uint16_t ptype, plen, padded_size;
4997
4998 *abort_processing = 0;
4999 if (cookie_found != NULL) {
5000 *cookie_found = 0;
5001 }
5002 mat = in_initpkt;
5003 limit = ntohs(cp->chunk_length) - sizeof(struct sctp_init_chunk);
5004 at = param_offset;
5005 op_err = NULL;
5006 op_err_last = NULL;
5007 pad_needed = 0;
5008 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Check for unrecognized param's\n");
5009 phdr = sctp_get_next_param(mat, at, ¶ms, sizeof(params));
5010 while ((phdr != NULL) && ((size_t)limit >= sizeof(struct sctp_paramhdr))) {
5011 ptype = ntohs(phdr->param_type);
5012 plen = ntohs(phdr->param_length);
5013 if ((plen > limit) || (plen < sizeof(struct sctp_paramhdr))) {
5014 /* wacked parameter */
5015 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error %d\n", plen);
5016 goto invalid_size;
5017 }
5018 limit -= SCTP_SIZE32(plen);
5019 /*-
5020 * All parameters for all chunks that we know/understand are
5021 * listed here. We process them other places and make
5022 * appropriate stop actions per the upper bits. However this
5023 * is the generic routine processor's can call to get back
5024 * an operr.. to either incorporate (init-ack) or send.
5025 */
5026 padded_size = SCTP_SIZE32(plen);
5027 switch (ptype) {
5028 /* Param's with variable size */
5029 case SCTP_HEARTBEAT_INFO:
5030 case SCTP_UNRECOG_PARAM:
5031 case SCTP_ERROR_CAUSE_IND:
5032 /* ok skip fwd */
5033 at += padded_size;
5034 break;
5035 case SCTP_STATE_COOKIE:
5036 if (cookie_found != NULL) {
5037 *cookie_found = 1;
5038 }
5039 at += padded_size;
5040 break;
5041 /* Param's with variable size within a range */
5042 case SCTP_CHUNK_LIST:
5043 case SCTP_SUPPORTED_CHUNK_EXT:
5044 if (padded_size > (sizeof(struct sctp_supported_chunk_types_param) + (sizeof(uint8_t) * SCTP_MAX_SUPPORTED_EXT))) {
5045 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error chklist %d\n", plen);
5046 goto invalid_size;
5047 }
5048 at += padded_size;
5049 break;
5050 case SCTP_SUPPORTED_ADDRTYPE:
5051 if (padded_size > SCTP_MAX_ADDR_PARAMS_SIZE) {
5052 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error supaddrtype %d\n", plen);
5053 goto invalid_size;
5054 }
5055 at += padded_size;
5056 break;
5057 case SCTP_RANDOM:
5058 if (padded_size > (sizeof(struct sctp_auth_random) + SCTP_RANDOM_MAX_SIZE)) {
5059 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error random %d\n", plen);
5060 goto invalid_size;
5061 }
5062 at += padded_size;
5063 break;
5064 case SCTP_SET_PRIM_ADDR:
5065 case SCTP_DEL_IP_ADDRESS:
5066 case SCTP_ADD_IP_ADDRESS:
5067 if ((padded_size != sizeof(struct sctp_asconf_addrv4_param)) &&
5068 (padded_size != sizeof(struct sctp_asconf_addr_param))) {
5069 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error setprim %d\n", plen);
5070 goto invalid_size;
5071 }
5072 at += padded_size;
5073 break;
5074 /* Param's with a fixed size */
5075 case SCTP_IPV4_ADDRESS:
5076 if (padded_size != sizeof(struct sctp_ipv4addr_param)) {
5077 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error ipv4 addr %d\n", plen);
5078 goto invalid_size;
5079 }
5080 at += padded_size;
5081 break;
5082 case SCTP_IPV6_ADDRESS:
5083 if (padded_size != sizeof(struct sctp_ipv6addr_param)) {
5084 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error ipv6 addr %d\n", plen);
5085 goto invalid_size;
5086 }
5087 at += padded_size;
5088 break;
5089 case SCTP_COOKIE_PRESERVE:
5090 if (padded_size != sizeof(struct sctp_cookie_perserve_param)) {
5091 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error cookie-preserve %d\n", plen);
5092 goto invalid_size;
5093 }
5094 at += padded_size;
5095 break;
5096 case SCTP_HAS_NAT_SUPPORT:
5097 *nat_friendly = 1;
5098 /* fall through */
5099 case SCTP_PRSCTP_SUPPORTED:
5100 if (padded_size != sizeof(struct sctp_paramhdr)) {
5101 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error prsctp/nat support %d\n", plen);
5102 goto invalid_size;
5103 }
5104 at += padded_size;
5105 break;
5106 case SCTP_ECN_CAPABLE:
5107 if (padded_size != sizeof(struct sctp_paramhdr)) {
5108 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error ecn %d\n", plen);
5109 goto invalid_size;
5110 }
5111 at += padded_size;
5112 break;
5113 case SCTP_ULP_ADAPTATION:
5114 if (padded_size != sizeof(struct sctp_adaptation_layer_indication)) {
5115 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error adapatation %d\n", plen);
5116 goto invalid_size;
5117 }
5118 at += padded_size;
5119 break;
5120 case SCTP_SUCCESS_REPORT:
5121 if (padded_size != sizeof(struct sctp_asconf_paramhdr)) {
5122 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error success %d\n", plen);
5123 goto invalid_size;
5124 }
5125 at += padded_size;
5126 break;
5127 case SCTP_HOSTNAME_ADDRESS:
5128 {
5129 /* Hostname parameters are deprecated. */
5130 struct sctp_gen_error_cause *cause;
5131 int l_len;
5132
5133 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Can't handle hostname addresses.. abort processing\n");
5134 *abort_processing = 1;
5135 sctp_m_freem(op_err);
5136 op_err = NULL;
5137 op_err_last = NULL;
5138 #ifdef INET6
5139 l_len = SCTP_MIN_OVERHEAD;
5140 #else
5141 l_len = SCTP_MIN_V4_OVERHEAD;
5142 #endif
5143 l_len += sizeof(struct sctp_chunkhdr);
5144 l_len += sizeof(struct sctp_gen_error_cause);
5145 op_err = sctp_get_mbuf_for_msg(l_len, 0, M_NOWAIT, 1, MT_DATA);
5146 if (op_err != NULL) {
5147 /*
5148 * Pre-reserve space for IP, SCTP,
5149 * and chunk header.
5150 */
5151 #ifdef INET6
5152 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip6_hdr));
5153 #else
5154 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip));
5155 #endif
5156 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctphdr));
5157 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctp_chunkhdr));
5158 SCTP_BUF_LEN(op_err) = sizeof(struct sctp_gen_error_cause);
5159 cause = mtod(op_err, struct sctp_gen_error_cause *);
5160 cause->code = htons(SCTP_CAUSE_UNRESOLVABLE_ADDR);
5161 cause->length = htons((uint16_t)(sizeof(struct sctp_gen_error_cause) + plen));
5162 SCTP_BUF_NEXT(op_err) = SCTP_M_COPYM(mat, at, plen, M_NOWAIT);
5163 if (SCTP_BUF_NEXT(op_err) == NULL) {
5164 sctp_m_freem(op_err);
5165 op_err = NULL;
5166 op_err_last = NULL;
5167 }
5168 }
5169 return (op_err);
5170 break;
5171 }
5172 default:
5173 /*
5174 * we do not recognize the parameter figure out what
5175 * we do.
5176 */
5177 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Hit default param %x\n", ptype);
5178 if ((ptype & 0x4000) == 0x4000) {
5179 /* Report bit is set?? */
5180 SCTPDBG(SCTP_DEBUG_OUTPUT1, "report op err\n");
5181 if (op_err == NULL) {
5182 int l_len;
5183
5184 /* Ok need to try to get an mbuf */
5185 #ifdef INET6
5186 l_len = SCTP_MIN_OVERHEAD;
5187 #else
5188 l_len = SCTP_MIN_V4_OVERHEAD;
5189 #endif
5190 l_len += sizeof(struct sctp_chunkhdr);
5191 l_len += sizeof(struct sctp_paramhdr);
5192 op_err = sctp_get_mbuf_for_msg(l_len, 0, M_NOWAIT, 1, MT_DATA);
5193 if (op_err) {
5194 SCTP_BUF_LEN(op_err) = 0;
5195 #ifdef INET6
5196 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip6_hdr));
5197 #else
5198 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip));
5199 #endif
5200 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctphdr));
5201 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctp_chunkhdr));
5202 op_err_last = op_err;
5203 }
5204 }
5205 if (op_err != NULL) {
5206 /* If we have space */
5207 struct sctp_paramhdr *param;
5208
5209 if (pad_needed > 0) {
5210 op_err_last = sctp_add_pad_tombuf(op_err_last, pad_needed);
5211 }
5212 if (op_err_last == NULL) {
5213 sctp_m_freem(op_err);
5214 op_err = NULL;
5215 op_err_last = NULL;
5216 goto more_processing;
5217 }
5218 if (M_TRAILINGSPACE(op_err_last) < (int)sizeof(struct sctp_paramhdr)) {
5219 m_tmp = sctp_get_mbuf_for_msg(sizeof(struct sctp_paramhdr), 0, M_NOWAIT, 1, MT_DATA);
5220 if (m_tmp == NULL) {
5221 sctp_m_freem(op_err);
5222 op_err = NULL;
5223 op_err_last = NULL;
5224 goto more_processing;
5225 }
5226 SCTP_BUF_LEN(m_tmp) = 0;
5227 SCTP_BUF_NEXT(m_tmp) = NULL;
5228 SCTP_BUF_NEXT(op_err_last) = m_tmp;
5229 op_err_last = m_tmp;
5230 }
5231 param = (struct sctp_paramhdr *)(mtod(op_err_last, caddr_t)+SCTP_BUF_LEN(op_err_last));
5232 param->param_type = htons(SCTP_UNRECOG_PARAM);
5233 param->param_length = htons((uint16_t)sizeof(struct sctp_paramhdr) + plen);
5234 SCTP_BUF_LEN(op_err_last) += sizeof(struct sctp_paramhdr);
5235 SCTP_BUF_NEXT(op_err_last) = SCTP_M_COPYM(mat, at, plen, M_NOWAIT);
5236 if (SCTP_BUF_NEXT(op_err_last) == NULL) {
5237 sctp_m_freem(op_err);
5238 op_err = NULL;
5239 op_err_last = NULL;
5240 goto more_processing;
5241 } else {
5242 while (SCTP_BUF_NEXT(op_err_last) != NULL) {
5243 op_err_last = SCTP_BUF_NEXT(op_err_last);
5244 }
5245 }
5246 if (plen % 4 != 0) {
5247 pad_needed = 4 - (plen % 4);
5248 } else {
5249 pad_needed = 0;
5250 }
5251 }
5252 }
5253 more_processing:
5254 if ((ptype & 0x8000) == 0x0000) {
5255 SCTPDBG(SCTP_DEBUG_OUTPUT1, "stop proc\n");
5256 return (op_err);
5257 } else {
5258 /* skip this chunk and continue processing */
5259 SCTPDBG(SCTP_DEBUG_OUTPUT1, "move on\n");
5260 at += SCTP_SIZE32(plen);
5261 }
5262 break;
5263
5264 }
5265 phdr = sctp_get_next_param(mat, at, ¶ms, sizeof(params));
5266 }
5267 return (op_err);
5268 invalid_size:
5269 SCTPDBG(SCTP_DEBUG_OUTPUT1, "abort flag set\n");
5270 *abort_processing = 1;
5271 sctp_m_freem(op_err);
5272 op_err = NULL;
5273 op_err_last = NULL;
5274 if (phdr != NULL) {
5275 struct sctp_paramhdr *param;
5276 int l_len;
5277 #ifdef INET6
5278 l_len = SCTP_MIN_OVERHEAD;
5279 #else
5280 l_len = SCTP_MIN_V4_OVERHEAD;
5281 #endif
5282 l_len += sizeof(struct sctp_chunkhdr);
5283 l_len += (2 * sizeof(struct sctp_paramhdr));
5284 op_err = sctp_get_mbuf_for_msg(l_len, 0, M_NOWAIT, 1, MT_DATA);
5285 if (op_err) {
5286 SCTP_BUF_LEN(op_err) = 0;
5287 #ifdef INET6
5288 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip6_hdr));
5289 #else
5290 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip));
5291 #endif
5292 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctphdr));
5293 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctp_chunkhdr));
5294 SCTP_BUF_LEN(op_err) = 2 * sizeof(struct sctp_paramhdr);
5295 param = mtod(op_err, struct sctp_paramhdr *);
5296 param->param_type = htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
5297 param->param_length = htons(2 * sizeof(struct sctp_paramhdr));
5298 param++;
5299 param->param_type = htons(ptype);
5300 param->param_length = htons(plen);
5301 }
5302 }
5303 return (op_err);
5304 }
5305
5306 static int
sctp_are_there_new_addresses(struct sctp_association * asoc,struct mbuf * in_initpkt,int offset,struct sockaddr * src)5307 sctp_are_there_new_addresses(struct sctp_association *asoc,
5308 struct mbuf *in_initpkt, int offset, struct sockaddr *src)
5309 {
5310 /*
5311 * Given a INIT packet, look through the packet to verify that there
5312 * are NO new addresses. As we go through the parameters add reports
5313 * of any un-understood parameters that require an error. Also we
5314 * must return (1) to drop the packet if we see a un-understood
5315 * parameter that tells us to drop the chunk.
5316 */
5317 struct sockaddr *sa_touse;
5318 struct sockaddr *sa;
5319 struct sctp_paramhdr *phdr, params;
5320 uint16_t ptype, plen;
5321 uint8_t fnd;
5322 struct sctp_nets *net;
5323 int check_src;
5324 #ifdef INET
5325 struct sockaddr_in sin4, *sa4;
5326 #endif
5327 #ifdef INET6
5328 struct sockaddr_in6 sin6, *sa6;
5329 #endif
5330
5331 #ifdef INET
5332 memset(&sin4, 0, sizeof(sin4));
5333 sin4.sin_family = AF_INET;
5334 sin4.sin_len = sizeof(sin4);
5335 #endif
5336 #ifdef INET6
5337 memset(&sin6, 0, sizeof(sin6));
5338 sin6.sin6_family = AF_INET6;
5339 sin6.sin6_len = sizeof(sin6);
5340 #endif
5341 /* First what about the src address of the pkt ? */
5342 check_src = 0;
5343 switch (src->sa_family) {
5344 #ifdef INET
5345 case AF_INET:
5346 if (asoc->scope.ipv4_addr_legal) {
5347 check_src = 1;
5348 }
5349 break;
5350 #endif
5351 #ifdef INET6
5352 case AF_INET6:
5353 if (asoc->scope.ipv6_addr_legal) {
5354 check_src = 1;
5355 }
5356 break;
5357 #endif
5358 default:
5359 /* TSNH */
5360 break;
5361 }
5362 if (check_src) {
5363 fnd = 0;
5364 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5365 sa = (struct sockaddr *)&net->ro._l_addr;
5366 if (sa->sa_family == src->sa_family) {
5367 #ifdef INET
5368 if (sa->sa_family == AF_INET) {
5369 struct sockaddr_in *src4;
5370
5371 sa4 = (struct sockaddr_in *)sa;
5372 src4 = (struct sockaddr_in *)src;
5373 if (sa4->sin_addr.s_addr == src4->sin_addr.s_addr) {
5374 fnd = 1;
5375 break;
5376 }
5377 }
5378 #endif
5379 #ifdef INET6
5380 if (sa->sa_family == AF_INET6) {
5381 struct sockaddr_in6 *src6;
5382
5383 sa6 = (struct sockaddr_in6 *)sa;
5384 src6 = (struct sockaddr_in6 *)src;
5385 if (SCTP6_ARE_ADDR_EQUAL(sa6, src6)) {
5386 fnd = 1;
5387 break;
5388 }
5389 }
5390 #endif
5391 }
5392 }
5393 if (fnd == 0) {
5394 /* New address added! no need to look further. */
5395 return (1);
5396 }
5397 }
5398 /* Ok so far lets munge through the rest of the packet */
5399 offset += sizeof(struct sctp_init_chunk);
5400 phdr = sctp_get_next_param(in_initpkt, offset, ¶ms, sizeof(params));
5401 while (phdr) {
5402 sa_touse = NULL;
5403 ptype = ntohs(phdr->param_type);
5404 plen = ntohs(phdr->param_length);
5405 switch (ptype) {
5406 #ifdef INET
5407 case SCTP_IPV4_ADDRESS:
5408 {
5409 struct sctp_ipv4addr_param *p4, p4_buf;
5410
5411 if (plen != sizeof(struct sctp_ipv4addr_param)) {
5412 return (1);
5413 }
5414 phdr = sctp_get_next_param(in_initpkt, offset,
5415 (struct sctp_paramhdr *)&p4_buf, sizeof(p4_buf));
5416 if (phdr == NULL) {
5417 return (1);
5418 }
5419 if (asoc->scope.ipv4_addr_legal) {
5420 p4 = (struct sctp_ipv4addr_param *)phdr;
5421 sin4.sin_addr.s_addr = p4->addr;
5422 sa_touse = (struct sockaddr *)&sin4;
5423 }
5424 break;
5425 }
5426 #endif
5427 #ifdef INET6
5428 case SCTP_IPV6_ADDRESS:
5429 {
5430 struct sctp_ipv6addr_param *p6, p6_buf;
5431
5432 if (plen != sizeof(struct sctp_ipv6addr_param)) {
5433 return (1);
5434 }
5435 phdr = sctp_get_next_param(in_initpkt, offset,
5436 (struct sctp_paramhdr *)&p6_buf, sizeof(p6_buf));
5437 if (phdr == NULL) {
5438 return (1);
5439 }
5440 if (asoc->scope.ipv6_addr_legal) {
5441 p6 = (struct sctp_ipv6addr_param *)phdr;
5442 memcpy((caddr_t)&sin6.sin6_addr, p6->addr,
5443 sizeof(p6->addr));
5444 sa_touse = (struct sockaddr *)&sin6;
5445 }
5446 break;
5447 }
5448 #endif
5449 default:
5450 sa_touse = NULL;
5451 break;
5452 }
5453 if (sa_touse) {
5454 /* ok, sa_touse points to one to check */
5455 fnd = 0;
5456 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5457 sa = (struct sockaddr *)&net->ro._l_addr;
5458 if (sa->sa_family != sa_touse->sa_family) {
5459 continue;
5460 }
5461 #ifdef INET
5462 if (sa->sa_family == AF_INET) {
5463 sa4 = (struct sockaddr_in *)sa;
5464 if (sa4->sin_addr.s_addr ==
5465 sin4.sin_addr.s_addr) {
5466 fnd = 1;
5467 break;
5468 }
5469 }
5470 #endif
5471 #ifdef INET6
5472 if (sa->sa_family == AF_INET6) {
5473 sa6 = (struct sockaddr_in6 *)sa;
5474 if (SCTP6_ARE_ADDR_EQUAL(
5475 sa6, &sin6)) {
5476 fnd = 1;
5477 break;
5478 }
5479 }
5480 #endif
5481 }
5482 if (!fnd) {
5483 /* New addr added! no need to look further */
5484 return (1);
5485 }
5486 }
5487 offset += SCTP_SIZE32(plen);
5488 phdr = sctp_get_next_param(in_initpkt, offset, ¶ms, sizeof(params));
5489 }
5490 return (0);
5491 }
5492
5493 /*
5494 * Given a MBUF chain that was sent into us containing an INIT. Build a
5495 * INIT-ACK with COOKIE and send back. We assume that the in_initpkt has done
5496 * a pullup to include IPv6/4header, SCTP header and initial part of INIT
5497 * message (i.e. the struct sctp_init_msg).
5498 */
5499 void
sctp_send_initiate_ack(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_nets * src_net,struct mbuf * init_pkt,int iphlen,int offset,struct sockaddr * src,struct sockaddr * dst,struct sctphdr * sh,struct sctp_init_chunk * init_chk,uint8_t mflowtype,uint32_t mflowid,uint32_t vrf_id,uint16_t port)5500 sctp_send_initiate_ack(struct sctp_inpcb *inp, struct sctp_tcb *stcb,
5501 struct sctp_nets *src_net, struct mbuf *init_pkt,
5502 int iphlen, int offset,
5503 struct sockaddr *src, struct sockaddr *dst,
5504 struct sctphdr *sh, struct sctp_init_chunk *init_chk,
5505 uint8_t mflowtype, uint32_t mflowid,
5506 uint32_t vrf_id, uint16_t port)
5507 {
5508 struct sctp_association *asoc;
5509 struct mbuf *m, *m_tmp, *m_last, *m_cookie, *op_err;
5510 struct sctp_init_ack_chunk *initack;
5511 struct sctp_adaptation_layer_indication *ali;
5512 struct sctp_supported_chunk_types_param *pr_supported;
5513 struct sctp_paramhdr *ph;
5514 union sctp_sockstore *over_addr;
5515 struct sctp_scoping scp;
5516 struct timeval now;
5517 #ifdef INET
5518 struct sockaddr_in *dst4 = (struct sockaddr_in *)dst;
5519 struct sockaddr_in *src4 = (struct sockaddr_in *)src;
5520 struct sockaddr_in *sin;
5521 #endif
5522 #ifdef INET6
5523 struct sockaddr_in6 *dst6 = (struct sockaddr_in6 *)dst;
5524 struct sockaddr_in6 *src6 = (struct sockaddr_in6 *)src;
5525 struct sockaddr_in6 *sin6;
5526 #endif
5527 struct sockaddr *to;
5528 struct sctp_state_cookie stc;
5529 struct sctp_nets *net = NULL;
5530 uint8_t *signature = NULL;
5531 int cnt_inits_to = 0;
5532 uint16_t his_limit, i_want;
5533 int abort_flag;
5534 int nat_friendly = 0;
5535 int error;
5536 struct socket *so;
5537 uint16_t num_ext, chunk_len, padding_len, parameter_len;
5538
5539 if (stcb) {
5540 asoc = &stcb->asoc;
5541 } else {
5542 asoc = NULL;
5543 }
5544 if ((asoc != NULL) &&
5545 (SCTP_GET_STATE(stcb) != SCTP_STATE_COOKIE_WAIT)) {
5546 if (sctp_are_there_new_addresses(asoc, init_pkt, offset, src)) {
5547 /*
5548 * new addresses, out of here in non-cookie-wait
5549 * states
5550 *
5551 * Send an ABORT, without the new address error
5552 * cause. This looks no different than if no
5553 * listener was present.
5554 */
5555 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
5556 "Address added");
5557 sctp_send_abort(init_pkt, iphlen, src, dst, sh, 0, op_err,
5558 mflowtype, mflowid, inp->fibnum,
5559 vrf_id, port);
5560 return;
5561 }
5562 if (src_net != NULL && (src_net->port != port)) {
5563 /*
5564 * change of remote encapsulation port, out of here
5565 * in non-cookie-wait states
5566 *
5567 * Send an ABORT, without an specific error cause.
5568 * This looks no different than if no listener was
5569 * present.
5570 */
5571 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
5572 "Remote encapsulation port changed");
5573 sctp_send_abort(init_pkt, iphlen, src, dst, sh, 0, op_err,
5574 mflowtype, mflowid, inp->fibnum,
5575 vrf_id, port);
5576 return;
5577 }
5578 }
5579 abort_flag = 0;
5580 op_err = sctp_arethere_unrecognized_parameters(init_pkt,
5581 (offset + sizeof(struct sctp_init_chunk)),
5582 &abort_flag,
5583 (struct sctp_chunkhdr *)init_chk,
5584 &nat_friendly, NULL);
5585 if (abort_flag) {
5586 do_a_abort:
5587 if (op_err == NULL) {
5588 char msg[SCTP_DIAG_INFO_LEN];
5589
5590 snprintf(msg, sizeof(msg), "%s:%d at %s", __FILE__, __LINE__, __func__);
5591 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
5592 msg);
5593 }
5594 sctp_send_abort(init_pkt, iphlen, src, dst, sh,
5595 init_chk->init.initiate_tag, op_err,
5596 mflowtype, mflowid, inp->fibnum,
5597 vrf_id, port);
5598 return;
5599 }
5600 m = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
5601 if (m == NULL) {
5602 /* No memory, INIT timer will re-attempt. */
5603 sctp_m_freem(op_err);
5604 return;
5605 }
5606 chunk_len = (uint16_t)sizeof(struct sctp_init_ack_chunk);
5607 padding_len = 0;
5608
5609 /*
5610 * We might not overwrite the identification[] completely and on
5611 * some platforms time_entered will contain some padding. Therefore
5612 * zero out the cookie to avoid putting uninitialized memory on the
5613 * wire.
5614 */
5615 memset(&stc, 0, sizeof(struct sctp_state_cookie));
5616
5617 /* the time I built cookie */
5618 (void)SCTP_GETTIME_TIMEVAL(&now);
5619 stc.time_entered.tv_sec = now.tv_sec;
5620 stc.time_entered.tv_usec = now.tv_usec;
5621
5622 /* populate any tie tags */
5623 if (asoc != NULL) {
5624 /* unlock before tag selections */
5625 stc.tie_tag_my_vtag = asoc->my_vtag_nonce;
5626 stc.tie_tag_peer_vtag = asoc->peer_vtag_nonce;
5627 stc.cookie_life = asoc->cookie_life;
5628 net = asoc->primary_destination;
5629 } else {
5630 stc.tie_tag_my_vtag = 0;
5631 stc.tie_tag_peer_vtag = 0;
5632 /* life I will award this cookie */
5633 stc.cookie_life = inp->sctp_ep.def_cookie_life;
5634 }
5635
5636 /* copy in the ports for later check */
5637 stc.myport = sh->dest_port;
5638 stc.peerport = sh->src_port;
5639
5640 /*
5641 * If we wanted to honor cookie life extensions, we would add to
5642 * stc.cookie_life. For now we should NOT honor any extension
5643 */
5644 stc.site_scope = stc.local_scope = stc.loopback_scope = 0;
5645 if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
5646 stc.ipv6_addr_legal = 1;
5647 if (SCTP_IPV6_V6ONLY(inp)) {
5648 stc.ipv4_addr_legal = 0;
5649 } else {
5650 stc.ipv4_addr_legal = 1;
5651 }
5652 } else {
5653 stc.ipv6_addr_legal = 0;
5654 stc.ipv4_addr_legal = 1;
5655 }
5656 stc.ipv4_scope = 0;
5657 if (net == NULL) {
5658 to = src;
5659 switch (dst->sa_family) {
5660 #ifdef INET
5661 case AF_INET:
5662 {
5663 /* lookup address */
5664 stc.address[0] = src4->sin_addr.s_addr;
5665 stc.address[1] = 0;
5666 stc.address[2] = 0;
5667 stc.address[3] = 0;
5668 stc.addr_type = SCTP_IPV4_ADDRESS;
5669 /* local from address */
5670 stc.laddress[0] = dst4->sin_addr.s_addr;
5671 stc.laddress[1] = 0;
5672 stc.laddress[2] = 0;
5673 stc.laddress[3] = 0;
5674 stc.laddr_type = SCTP_IPV4_ADDRESS;
5675 /* scope_id is only for v6 */
5676 stc.scope_id = 0;
5677 if ((IN4_ISPRIVATE_ADDRESS(&src4->sin_addr)) ||
5678 (IN4_ISPRIVATE_ADDRESS(&dst4->sin_addr))) {
5679 stc.ipv4_scope = 1;
5680 }
5681 /* Must use the address in this case */
5682 if (sctp_is_address_on_local_host(src, vrf_id)) {
5683 stc.loopback_scope = 1;
5684 stc.ipv4_scope = 1;
5685 stc.site_scope = 1;
5686 stc.local_scope = 0;
5687 }
5688 break;
5689 }
5690 #endif
5691 #ifdef INET6
5692 case AF_INET6:
5693 {
5694 stc.addr_type = SCTP_IPV6_ADDRESS;
5695 memcpy(&stc.address, &src6->sin6_addr, sizeof(struct in6_addr));
5696 stc.scope_id = ntohs(in6_getscope(&src6->sin6_addr));
5697 if (sctp_is_address_on_local_host(src, vrf_id)) {
5698 stc.loopback_scope = 1;
5699 stc.local_scope = 0;
5700 stc.site_scope = 1;
5701 stc.ipv4_scope = 1;
5702 } else if (IN6_IS_ADDR_LINKLOCAL(&src6->sin6_addr) ||
5703 IN6_IS_ADDR_LINKLOCAL(&dst6->sin6_addr)) {
5704 /*
5705 * If the new destination or source
5706 * is a LINK_LOCAL we must have
5707 * common both site and local scope.
5708 * Don't set local scope though
5709 * since we must depend on the
5710 * source to be added implicitly. We
5711 * cannot assure just because we
5712 * share one link that all links are
5713 * common.
5714 */
5715 stc.local_scope = 0;
5716 stc.site_scope = 1;
5717 stc.ipv4_scope = 1;
5718 /*
5719 * we start counting for the private
5720 * address stuff at 1. since the
5721 * link local we source from won't
5722 * show up in our scoped count.
5723 */
5724 cnt_inits_to = 1;
5725 /*
5726 * pull out the scope_id from
5727 * incoming pkt
5728 */
5729 } else if (IN6_IS_ADDR_SITELOCAL(&src6->sin6_addr) ||
5730 IN6_IS_ADDR_SITELOCAL(&dst6->sin6_addr)) {
5731 /*
5732 * If the new destination or source
5733 * is SITE_LOCAL then we must have
5734 * site scope in common.
5735 */
5736 stc.site_scope = 1;
5737 }
5738 memcpy(&stc.laddress, &dst6->sin6_addr, sizeof(struct in6_addr));
5739 stc.laddr_type = SCTP_IPV6_ADDRESS;
5740 break;
5741 }
5742 #endif
5743 default:
5744 /* TSNH */
5745 goto do_a_abort;
5746 break;
5747 }
5748 } else {
5749 /* set the scope per the existing tcb */
5750
5751 #ifdef INET6
5752 struct sctp_nets *lnet;
5753 #endif
5754
5755 stc.loopback_scope = asoc->scope.loopback_scope;
5756 stc.ipv4_scope = asoc->scope.ipv4_local_scope;
5757 stc.site_scope = asoc->scope.site_scope;
5758 stc.local_scope = asoc->scope.local_scope;
5759 #ifdef INET6
5760 /* Why do we not consider IPv4 LL addresses? */
5761 TAILQ_FOREACH(lnet, &asoc->nets, sctp_next) {
5762 if (lnet->ro._l_addr.sin6.sin6_family == AF_INET6) {
5763 if (IN6_IS_ADDR_LINKLOCAL(&lnet->ro._l_addr.sin6.sin6_addr)) {
5764 /*
5765 * if we have a LL address, start
5766 * counting at 1.
5767 */
5768 cnt_inits_to = 1;
5769 }
5770 }
5771 }
5772 #endif
5773 /* use the net pointer */
5774 to = (struct sockaddr *)&net->ro._l_addr;
5775 switch (to->sa_family) {
5776 #ifdef INET
5777 case AF_INET:
5778 sin = (struct sockaddr_in *)to;
5779 stc.address[0] = sin->sin_addr.s_addr;
5780 stc.address[1] = 0;
5781 stc.address[2] = 0;
5782 stc.address[3] = 0;
5783 stc.addr_type = SCTP_IPV4_ADDRESS;
5784 if (net->src_addr_selected == 0) {
5785 /*
5786 * strange case here, the INIT should have
5787 * did the selection.
5788 */
5789 net->ro._s_addr = sctp_source_address_selection(inp,
5790 stcb, (sctp_route_t *)&net->ro,
5791 net, 0, vrf_id);
5792 if (net->ro._s_addr == NULL) {
5793 sctp_m_freem(op_err);
5794 sctp_m_freem(m);
5795 return;
5796 }
5797
5798 net->src_addr_selected = 1;
5799
5800 }
5801 stc.laddress[0] = net->ro._s_addr->address.sin.sin_addr.s_addr;
5802 stc.laddress[1] = 0;
5803 stc.laddress[2] = 0;
5804 stc.laddress[3] = 0;
5805 stc.laddr_type = SCTP_IPV4_ADDRESS;
5806 /* scope_id is only for v6 */
5807 stc.scope_id = 0;
5808 break;
5809 #endif
5810 #ifdef INET6
5811 case AF_INET6:
5812 sin6 = (struct sockaddr_in6 *)to;
5813 memcpy(&stc.address, &sin6->sin6_addr,
5814 sizeof(struct in6_addr));
5815 stc.addr_type = SCTP_IPV6_ADDRESS;
5816 stc.scope_id = sin6->sin6_scope_id;
5817 if (net->src_addr_selected == 0) {
5818 /*
5819 * strange case here, the INIT should have
5820 * done the selection.
5821 */
5822 net->ro._s_addr = sctp_source_address_selection(inp,
5823 stcb, (sctp_route_t *)&net->ro,
5824 net, 0, vrf_id);
5825 if (net->ro._s_addr == NULL) {
5826 sctp_m_freem(op_err);
5827 sctp_m_freem(m);
5828 return;
5829 }
5830
5831 net->src_addr_selected = 1;
5832 }
5833 memcpy(&stc.laddress, &net->ro._s_addr->address.sin6.sin6_addr,
5834 sizeof(struct in6_addr));
5835 stc.laddr_type = SCTP_IPV6_ADDRESS;
5836 break;
5837 #endif
5838 }
5839 }
5840 /* Now lets put the SCTP header in place */
5841 initack = mtod(m, struct sctp_init_ack_chunk *);
5842 /* Save it off for quick ref */
5843 stc.peers_vtag = ntohl(init_chk->init.initiate_tag);
5844 /* who are we */
5845 memcpy(stc.identification, SCTP_VERSION_STRING,
5846 min(strlen(SCTP_VERSION_STRING), sizeof(stc.identification)));
5847 memset(stc.reserved, 0, SCTP_RESERVE_SPACE);
5848 /* now the chunk header */
5849 initack->ch.chunk_type = SCTP_INITIATION_ACK;
5850 initack->ch.chunk_flags = 0;
5851 /* fill in later from mbuf we build */
5852 initack->ch.chunk_length = 0;
5853 /* place in my tag */
5854 if ((asoc != NULL) &&
5855 ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT) ||
5856 (SCTP_GET_STATE(stcb) == SCTP_STATE_INUSE) ||
5857 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED))) {
5858 /* re-use the v-tags and init-seq here */
5859 initack->init.initiate_tag = htonl(asoc->my_vtag);
5860 initack->init.initial_tsn = htonl(asoc->init_seq_number);
5861 } else {
5862 uint32_t vtag, itsn;
5863
5864 if (asoc) {
5865 atomic_add_int(&asoc->refcnt, 1);
5866 SCTP_TCB_UNLOCK(stcb);
5867 new_tag:
5868 vtag = sctp_select_a_tag(inp, inp->sctp_lport, sh->src_port, 1);
5869 if ((asoc->peer_supports_nat) && (vtag == asoc->my_vtag)) {
5870 /*
5871 * Got a duplicate vtag on some guy behind a
5872 * nat make sure we don't use it.
5873 */
5874 goto new_tag;
5875 }
5876 initack->init.initiate_tag = htonl(vtag);
5877 /* get a TSN to use too */
5878 itsn = sctp_select_initial_TSN(&inp->sctp_ep);
5879 initack->init.initial_tsn = htonl(itsn);
5880 SCTP_TCB_LOCK(stcb);
5881 atomic_add_int(&asoc->refcnt, -1);
5882 } else {
5883 SCTP_INP_INCR_REF(inp);
5884 SCTP_INP_RUNLOCK(inp);
5885 vtag = sctp_select_a_tag(inp, inp->sctp_lport, sh->src_port, 1);
5886 initack->init.initiate_tag = htonl(vtag);
5887 /* get a TSN to use too */
5888 initack->init.initial_tsn = htonl(sctp_select_initial_TSN(&inp->sctp_ep));
5889 SCTP_INP_RLOCK(inp);
5890 SCTP_INP_DECR_REF(inp);
5891 }
5892 }
5893 /* save away my tag to */
5894 stc.my_vtag = initack->init.initiate_tag;
5895
5896 /* set up some of the credits. */
5897 so = inp->sctp_socket;
5898 if (so == NULL) {
5899 /* memory problem */
5900 sctp_m_freem(op_err);
5901 sctp_m_freem(m);
5902 return;
5903 } else {
5904 initack->init.a_rwnd = htonl(max(SCTP_SB_LIMIT_RCV(so), SCTP_MINIMAL_RWND));
5905 }
5906 /* set what I want */
5907 his_limit = ntohs(init_chk->init.num_inbound_streams);
5908 /* choose what I want */
5909 if (asoc != NULL) {
5910 if (asoc->streamoutcnt > asoc->pre_open_streams) {
5911 i_want = asoc->streamoutcnt;
5912 } else {
5913 i_want = asoc->pre_open_streams;
5914 }
5915 } else {
5916 i_want = inp->sctp_ep.pre_open_stream_count;
5917 }
5918 if (his_limit < i_want) {
5919 /* I Want more :< */
5920 initack->init.num_outbound_streams = init_chk->init.num_inbound_streams;
5921 } else {
5922 /* I can have what I want :> */
5923 initack->init.num_outbound_streams = htons(i_want);
5924 }
5925 /* tell him his limit. */
5926 initack->init.num_inbound_streams =
5927 htons(inp->sctp_ep.max_open_streams_intome);
5928
5929 /* adaptation layer indication parameter */
5930 if (inp->sctp_ep.adaptation_layer_indicator_provided) {
5931 parameter_len = (uint16_t)sizeof(struct sctp_adaptation_layer_indication);
5932 ali = (struct sctp_adaptation_layer_indication *)(mtod(m, caddr_t)+chunk_len);
5933 ali->ph.param_type = htons(SCTP_ULP_ADAPTATION);
5934 ali->ph.param_length = htons(parameter_len);
5935 ali->indication = htonl(inp->sctp_ep.adaptation_layer_indicator);
5936 chunk_len += parameter_len;
5937 }
5938
5939 /* ECN parameter */
5940 if (((asoc != NULL) && (asoc->ecn_supported == 1)) ||
5941 ((asoc == NULL) && (inp->ecn_supported == 1))) {
5942 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
5943 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
5944 ph->param_type = htons(SCTP_ECN_CAPABLE);
5945 ph->param_length = htons(parameter_len);
5946 chunk_len += parameter_len;
5947 }
5948
5949 /* PR-SCTP supported parameter */
5950 if (((asoc != NULL) && (asoc->prsctp_supported == 1)) ||
5951 ((asoc == NULL) && (inp->prsctp_supported == 1))) {
5952 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
5953 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
5954 ph->param_type = htons(SCTP_PRSCTP_SUPPORTED);
5955 ph->param_length = htons(parameter_len);
5956 chunk_len += parameter_len;
5957 }
5958
5959 /* Add NAT friendly parameter */
5960 if (nat_friendly) {
5961 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
5962 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
5963 ph->param_type = htons(SCTP_HAS_NAT_SUPPORT);
5964 ph->param_length = htons(parameter_len);
5965 chunk_len += parameter_len;
5966 }
5967
5968 /* And now tell the peer which extensions we support */
5969 num_ext = 0;
5970 pr_supported = (struct sctp_supported_chunk_types_param *)(mtod(m, caddr_t)+chunk_len);
5971 if (((asoc != NULL) && (asoc->prsctp_supported == 1)) ||
5972 ((asoc == NULL) && (inp->prsctp_supported == 1))) {
5973 pr_supported->chunk_types[num_ext++] = SCTP_FORWARD_CUM_TSN;
5974 if (((asoc != NULL) && (asoc->idata_supported == 1)) ||
5975 ((asoc == NULL) && (inp->idata_supported == 1))) {
5976 pr_supported->chunk_types[num_ext++] = SCTP_IFORWARD_CUM_TSN;
5977 }
5978 }
5979 if (((asoc != NULL) && (asoc->auth_supported == 1)) ||
5980 ((asoc == NULL) && (inp->auth_supported == 1))) {
5981 pr_supported->chunk_types[num_ext++] = SCTP_AUTHENTICATION;
5982 }
5983 if (((asoc != NULL) && (asoc->asconf_supported == 1)) ||
5984 ((asoc == NULL) && (inp->asconf_supported == 1))) {
5985 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF;
5986 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF_ACK;
5987 }
5988 if (((asoc != NULL) && (asoc->reconfig_supported == 1)) ||
5989 ((asoc == NULL) && (inp->reconfig_supported == 1))) {
5990 pr_supported->chunk_types[num_ext++] = SCTP_STREAM_RESET;
5991 }
5992 if (((asoc != NULL) && (asoc->idata_supported == 1)) ||
5993 ((asoc == NULL) && (inp->idata_supported == 1))) {
5994 pr_supported->chunk_types[num_ext++] = SCTP_IDATA;
5995 }
5996 if (((asoc != NULL) && (asoc->nrsack_supported == 1)) ||
5997 ((asoc == NULL) && (inp->nrsack_supported == 1))) {
5998 pr_supported->chunk_types[num_ext++] = SCTP_NR_SELECTIVE_ACK;
5999 }
6000 if (((asoc != NULL) && (asoc->pktdrop_supported == 1)) ||
6001 ((asoc == NULL) && (inp->pktdrop_supported == 1))) {
6002 pr_supported->chunk_types[num_ext++] = SCTP_PACKET_DROPPED;
6003 }
6004 if (num_ext > 0) {
6005 parameter_len = (uint16_t)sizeof(struct sctp_supported_chunk_types_param) + num_ext;
6006 pr_supported->ph.param_type = htons(SCTP_SUPPORTED_CHUNK_EXT);
6007 pr_supported->ph.param_length = htons(parameter_len);
6008 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6009 chunk_len += parameter_len;
6010 }
6011
6012 /* add authentication parameters */
6013 if (((asoc != NULL) && (asoc->auth_supported == 1)) ||
6014 ((asoc == NULL) && (inp->auth_supported == 1))) {
6015 struct sctp_auth_random *randp;
6016 struct sctp_auth_hmac_algo *hmacs;
6017 struct sctp_auth_chunk_list *chunks;
6018
6019 if (padding_len > 0) {
6020 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
6021 chunk_len += padding_len;
6022 padding_len = 0;
6023 }
6024 /* generate and add RANDOM parameter */
6025 randp = (struct sctp_auth_random *)(mtod(m, caddr_t)+chunk_len);
6026 parameter_len = (uint16_t)sizeof(struct sctp_auth_random) +
6027 SCTP_AUTH_RANDOM_SIZE_DEFAULT;
6028 randp->ph.param_type = htons(SCTP_RANDOM);
6029 randp->ph.param_length = htons(parameter_len);
6030 SCTP_READ_RANDOM(randp->random_data, SCTP_AUTH_RANDOM_SIZE_DEFAULT);
6031 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6032 chunk_len += parameter_len;
6033
6034 if (padding_len > 0) {
6035 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
6036 chunk_len += padding_len;
6037 padding_len = 0;
6038 }
6039 /* add HMAC_ALGO parameter */
6040 hmacs = (struct sctp_auth_hmac_algo *)(mtod(m, caddr_t)+chunk_len);
6041 parameter_len = (uint16_t)sizeof(struct sctp_auth_hmac_algo) +
6042 sctp_serialize_hmaclist(inp->sctp_ep.local_hmacs,
6043 (uint8_t *)hmacs->hmac_ids);
6044 hmacs->ph.param_type = htons(SCTP_HMAC_LIST);
6045 hmacs->ph.param_length = htons(parameter_len);
6046 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6047 chunk_len += parameter_len;
6048
6049 if (padding_len > 0) {
6050 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
6051 chunk_len += padding_len;
6052 padding_len = 0;
6053 }
6054 /* add CHUNKS parameter */
6055 chunks = (struct sctp_auth_chunk_list *)(mtod(m, caddr_t)+chunk_len);
6056 parameter_len = (uint16_t)sizeof(struct sctp_auth_chunk_list) +
6057 sctp_serialize_auth_chunks(inp->sctp_ep.local_auth_chunks,
6058 chunks->chunk_types);
6059 chunks->ph.param_type = htons(SCTP_CHUNK_LIST);
6060 chunks->ph.param_length = htons(parameter_len);
6061 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6062 chunk_len += parameter_len;
6063 }
6064 SCTP_BUF_LEN(m) = chunk_len;
6065 m_last = m;
6066 /* now the addresses */
6067 /*
6068 * To optimize this we could put the scoping stuff into a structure
6069 * and remove the individual uint8's from the stc structure. Then we
6070 * could just sifa in the address within the stc.. but for now this
6071 * is a quick hack to get the address stuff teased apart.
6072 */
6073 scp.ipv4_addr_legal = stc.ipv4_addr_legal;
6074 scp.ipv6_addr_legal = stc.ipv6_addr_legal;
6075 scp.loopback_scope = stc.loopback_scope;
6076 scp.ipv4_local_scope = stc.ipv4_scope;
6077 scp.local_scope = stc.local_scope;
6078 scp.site_scope = stc.site_scope;
6079 m_last = sctp_add_addresses_to_i_ia(inp, stcb, &scp, m_last,
6080 cnt_inits_to,
6081 &padding_len, &chunk_len);
6082 /* padding_len can only be positive, if no addresses have been added */
6083 if (padding_len > 0) {
6084 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
6085 chunk_len += padding_len;
6086 SCTP_BUF_LEN(m) += padding_len;
6087 padding_len = 0;
6088 }
6089
6090 /* tack on the operational error if present */
6091 if (op_err) {
6092 parameter_len = 0;
6093 for (m_tmp = op_err; m_tmp != NULL; m_tmp = SCTP_BUF_NEXT(m_tmp)) {
6094 parameter_len += SCTP_BUF_LEN(m_tmp);
6095 }
6096 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6097 SCTP_BUF_NEXT(m_last) = op_err;
6098 while (SCTP_BUF_NEXT(m_last) != NULL) {
6099 m_last = SCTP_BUF_NEXT(m_last);
6100 }
6101 chunk_len += parameter_len;
6102 }
6103 if (padding_len > 0) {
6104 m_last = sctp_add_pad_tombuf(m_last, padding_len);
6105 if (m_last == NULL) {
6106 /* Houston we have a problem, no space */
6107 sctp_m_freem(m);
6108 return;
6109 }
6110 chunk_len += padding_len;
6111 padding_len = 0;
6112 }
6113 /* Now we must build a cookie */
6114 m_cookie = sctp_add_cookie(init_pkt, offset, m, 0, &stc, &signature);
6115 if (m_cookie == NULL) {
6116 /* memory problem */
6117 sctp_m_freem(m);
6118 return;
6119 }
6120 /* Now append the cookie to the end and update the space/size */
6121 SCTP_BUF_NEXT(m_last) = m_cookie;
6122 parameter_len = 0;
6123 for (m_tmp = m_cookie; m_tmp != NULL; m_tmp = SCTP_BUF_NEXT(m_tmp)) {
6124 parameter_len += SCTP_BUF_LEN(m_tmp);
6125 if (SCTP_BUF_NEXT(m_tmp) == NULL) {
6126 m_last = m_tmp;
6127 }
6128 }
6129 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6130 chunk_len += parameter_len;
6131
6132 /*
6133 * Place in the size, but we don't include the last pad (if any) in
6134 * the INIT-ACK.
6135 */
6136 initack->ch.chunk_length = htons(chunk_len);
6137
6138 /*
6139 * Time to sign the cookie, we don't sign over the cookie signature
6140 * though thus we set trailer.
6141 */
6142 (void)sctp_hmac_m(SCTP_HMAC,
6143 (uint8_t *)inp->sctp_ep.secret_key[(int)(inp->sctp_ep.current_secret_number)],
6144 SCTP_SECRET_SIZE, m_cookie, sizeof(struct sctp_paramhdr),
6145 (uint8_t *)signature, SCTP_SIGNATURE_SIZE);
6146 /*
6147 * We sifa 0 here to NOT set IP_DF if its IPv4, we ignore the return
6148 * here since the timer will drive a retranmission.
6149 */
6150 if (padding_len > 0) {
6151 if (sctp_add_pad_tombuf(m_last, padding_len) == NULL) {
6152 sctp_m_freem(m);
6153 return;
6154 }
6155 }
6156 if (stc.loopback_scope) {
6157 over_addr = (union sctp_sockstore *)dst;
6158 } else {
6159 over_addr = NULL;
6160 }
6161
6162 if ((error = sctp_lowlevel_chunk_output(inp, NULL, NULL, to, m, 0, NULL, 0, 0,
6163 0, 0,
6164 inp->sctp_lport, sh->src_port, init_chk->init.initiate_tag,
6165 port, over_addr,
6166 mflowtype, mflowid,
6167 SCTP_SO_NOT_LOCKED))) {
6168 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Gak send error %d\n", error);
6169 if (error == ENOBUFS) {
6170 if (asoc != NULL) {
6171 asoc->ifp_had_enobuf = 1;
6172 }
6173 SCTP_STAT_INCR(sctps_lowlevelerr);
6174 }
6175 } else {
6176 if (asoc != NULL) {
6177 asoc->ifp_had_enobuf = 0;
6178 }
6179 }
6180 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
6181 }
6182
6183
6184 static void
sctp_prune_prsctp(struct sctp_tcb * stcb,struct sctp_association * asoc,struct sctp_sndrcvinfo * srcv,int dataout)6185 sctp_prune_prsctp(struct sctp_tcb *stcb,
6186 struct sctp_association *asoc,
6187 struct sctp_sndrcvinfo *srcv,
6188 int dataout)
6189 {
6190 int freed_spc = 0;
6191 struct sctp_tmit_chunk *chk, *nchk;
6192
6193 SCTP_TCB_LOCK_ASSERT(stcb);
6194 if ((asoc->prsctp_supported) &&
6195 (asoc->sent_queue_cnt_removeable > 0)) {
6196 TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) {
6197 /*
6198 * Look for chunks marked with the PR_SCTP flag AND
6199 * the buffer space flag. If the one being sent is
6200 * equal or greater priority then purge the old one
6201 * and free some space.
6202 */
6203 if (PR_SCTP_BUF_ENABLED(chk->flags)) {
6204 /*
6205 * This one is PR-SCTP AND buffer space
6206 * limited type
6207 */
6208 if (chk->rec.data.timetodrop.tv_sec >= (long)srcv->sinfo_timetolive) {
6209 /*
6210 * Lower numbers equates to higher
6211 * priority so if the one we are
6212 * looking at has a larger or equal
6213 * priority we want to drop the data
6214 * and NOT retransmit it.
6215 */
6216 if (chk->data) {
6217 /*
6218 * We release the book_size
6219 * if the mbuf is here
6220 */
6221 int ret_spc;
6222 uint8_t sent;
6223
6224 if (chk->sent > SCTP_DATAGRAM_UNSENT)
6225 sent = 1;
6226 else
6227 sent = 0;
6228 ret_spc = sctp_release_pr_sctp_chunk(stcb, chk,
6229 sent,
6230 SCTP_SO_LOCKED);
6231 freed_spc += ret_spc;
6232 if (freed_spc >= dataout) {
6233 return;
6234 }
6235 } /* if chunk was present */
6236 } /* if of sufficient priority */
6237 } /* if chunk has enabled */
6238 } /* tailqforeach */
6239
6240 TAILQ_FOREACH_SAFE(chk, &asoc->send_queue, sctp_next, nchk) {
6241 /* Here we must move to the sent queue and mark */
6242 if (PR_SCTP_BUF_ENABLED(chk->flags)) {
6243 if (chk->rec.data.timetodrop.tv_sec >= (long)srcv->sinfo_timetolive) {
6244 if (chk->data) {
6245 /*
6246 * We release the book_size
6247 * if the mbuf is here
6248 */
6249 int ret_spc;
6250
6251 ret_spc = sctp_release_pr_sctp_chunk(stcb, chk,
6252 0, SCTP_SO_LOCKED);
6253
6254 freed_spc += ret_spc;
6255 if (freed_spc >= dataout) {
6256 return;
6257 }
6258 } /* end if chk->data */
6259 } /* end if right class */
6260 } /* end if chk pr-sctp */
6261 } /* tailqforeachsafe (chk) */
6262 } /* if enabled in asoc */
6263 }
6264
6265 int
sctp_get_frag_point(struct sctp_tcb * stcb,struct sctp_association * asoc)6266 sctp_get_frag_point(struct sctp_tcb *stcb,
6267 struct sctp_association *asoc)
6268 {
6269 int siz, ovh;
6270
6271 /*
6272 * For endpoints that have both v6 and v4 addresses we must reserve
6273 * room for the ipv6 header, for those that are only dealing with V4
6274 * we use a larger frag point.
6275 */
6276 if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
6277 ovh = SCTP_MIN_OVERHEAD;
6278 } else {
6279 ovh = SCTP_MIN_V4_OVERHEAD;
6280 }
6281 ovh += SCTP_DATA_CHUNK_OVERHEAD(stcb);
6282 if (stcb->asoc.sctp_frag_point > asoc->smallest_mtu)
6283 siz = asoc->smallest_mtu - ovh;
6284 else
6285 siz = (stcb->asoc.sctp_frag_point - ovh);
6286 /*
6287 * if (siz > (MCLBYTES-sizeof(struct sctp_data_chunk))) {
6288 */
6289 /* A data chunk MUST fit in a cluster */
6290 /* siz = (MCLBYTES - sizeof(struct sctp_data_chunk)); */
6291 /* } */
6292
6293 /* adjust for an AUTH chunk if DATA requires auth */
6294 if (sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks))
6295 siz -= sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
6296
6297 if (siz % 4) {
6298 /* make it an even word boundary please */
6299 siz -= (siz % 4);
6300 }
6301 return (siz);
6302 }
6303
6304 static void
sctp_set_prsctp_policy(struct sctp_stream_queue_pending * sp)6305 sctp_set_prsctp_policy(struct sctp_stream_queue_pending *sp)
6306 {
6307 /*
6308 * We assume that the user wants PR_SCTP_TTL if the user provides a
6309 * positive lifetime but does not specify any PR_SCTP policy.
6310 */
6311 if (PR_SCTP_ENABLED(sp->sinfo_flags)) {
6312 sp->act_flags |= PR_SCTP_POLICY(sp->sinfo_flags);
6313 } else if (sp->timetolive > 0) {
6314 sp->sinfo_flags |= SCTP_PR_SCTP_TTL;
6315 sp->act_flags |= PR_SCTP_POLICY(sp->sinfo_flags);
6316 } else {
6317 return;
6318 }
6319 switch (PR_SCTP_POLICY(sp->sinfo_flags)) {
6320 case CHUNK_FLAGS_PR_SCTP_BUF:
6321 /*
6322 * Time to live is a priority stored in tv_sec when doing
6323 * the buffer drop thing.
6324 */
6325 sp->ts.tv_sec = sp->timetolive;
6326 sp->ts.tv_usec = 0;
6327 break;
6328 case CHUNK_FLAGS_PR_SCTP_TTL:
6329 {
6330 struct timeval tv;
6331
6332 (void)SCTP_GETTIME_TIMEVAL(&sp->ts);
6333 tv.tv_sec = sp->timetolive / 1000;
6334 tv.tv_usec = (sp->timetolive * 1000) % 1000000;
6335 /*
6336 * TODO sctp_constants.h needs alternative time
6337 * macros when _KERNEL is undefined.
6338 */
6339 timevaladd(&sp->ts, &tv);
6340 }
6341 break;
6342 case CHUNK_FLAGS_PR_SCTP_RTX:
6343 /*
6344 * Time to live is a the number or retransmissions stored in
6345 * tv_sec.
6346 */
6347 sp->ts.tv_sec = sp->timetolive;
6348 sp->ts.tv_usec = 0;
6349 break;
6350 default:
6351 SCTPDBG(SCTP_DEBUG_USRREQ1,
6352 "Unknown PR_SCTP policy %u.\n",
6353 PR_SCTP_POLICY(sp->sinfo_flags));
6354 break;
6355 }
6356 }
6357
6358 static int
sctp_msg_append(struct sctp_tcb * stcb,struct sctp_nets * net,struct mbuf * m,struct sctp_sndrcvinfo * srcv,int hold_stcb_lock)6359 sctp_msg_append(struct sctp_tcb *stcb,
6360 struct sctp_nets *net,
6361 struct mbuf *m,
6362 struct sctp_sndrcvinfo *srcv, int hold_stcb_lock)
6363 {
6364 int error = 0;
6365 struct mbuf *at;
6366 struct sctp_stream_queue_pending *sp = NULL;
6367 struct sctp_stream_out *strm;
6368
6369 /*
6370 * Given an mbuf chain, put it into the association send queue and
6371 * place it on the wheel
6372 */
6373 if (srcv->sinfo_stream >= stcb->asoc.streamoutcnt) {
6374 /* Invalid stream number */
6375 SCTP_LTRACE_ERR_RET_PKT(m, NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
6376 error = EINVAL;
6377 goto out_now;
6378 }
6379 if ((stcb->asoc.stream_locked) &&
6380 (stcb->asoc.stream_locked_on != srcv->sinfo_stream)) {
6381 SCTP_LTRACE_ERR_RET_PKT(m, NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
6382 error = EINVAL;
6383 goto out_now;
6384 }
6385 strm = &stcb->asoc.strmout[srcv->sinfo_stream];
6386 /* Now can we send this? */
6387 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_SENT) ||
6388 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_ACK_SENT) ||
6389 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
6390 (stcb->asoc.state & SCTP_STATE_SHUTDOWN_PENDING)) {
6391 /* got data while shutting down */
6392 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
6393 error = ECONNRESET;
6394 goto out_now;
6395 }
6396 sctp_alloc_a_strmoq(stcb, sp);
6397 if (sp == NULL) {
6398 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
6399 error = ENOMEM;
6400 goto out_now;
6401 }
6402 sp->sinfo_flags = srcv->sinfo_flags;
6403 sp->timetolive = srcv->sinfo_timetolive;
6404 sp->ppid = srcv->sinfo_ppid;
6405 sp->context = srcv->sinfo_context;
6406 sp->fsn = 0;
6407 if (sp->sinfo_flags & SCTP_ADDR_OVER) {
6408 sp->net = net;
6409 atomic_add_int(&sp->net->ref_count, 1);
6410 } else {
6411 sp->net = NULL;
6412 }
6413 (void)SCTP_GETTIME_TIMEVAL(&sp->ts);
6414 sp->sid = srcv->sinfo_stream;
6415 sp->msg_is_complete = 1;
6416 sp->sender_all_done = 1;
6417 sp->some_taken = 0;
6418 sp->data = m;
6419 sp->tail_mbuf = NULL;
6420 sctp_set_prsctp_policy(sp);
6421 /*
6422 * We could in theory (for sendall) sifa the length in, but we would
6423 * still have to hunt through the chain since we need to setup the
6424 * tail_mbuf
6425 */
6426 sp->length = 0;
6427 for (at = m; at; at = SCTP_BUF_NEXT(at)) {
6428 if (SCTP_BUF_NEXT(at) == NULL)
6429 sp->tail_mbuf = at;
6430 sp->length += SCTP_BUF_LEN(at);
6431 }
6432 if (srcv->sinfo_keynumber_valid) {
6433 sp->auth_keyid = srcv->sinfo_keynumber;
6434 } else {
6435 sp->auth_keyid = stcb->asoc.authinfo.active_keyid;
6436 }
6437 if (sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks)) {
6438 sctp_auth_key_acquire(stcb, sp->auth_keyid);
6439 sp->holds_key_ref = 1;
6440 }
6441 if (hold_stcb_lock == 0) {
6442 SCTP_TCB_SEND_LOCK(stcb);
6443 }
6444 sctp_snd_sb_alloc(stcb, sp->length);
6445 atomic_add_int(&stcb->asoc.stream_queue_cnt, 1);
6446 TAILQ_INSERT_TAIL(&strm->outqueue, sp, next);
6447 stcb->asoc.ss_functions.sctp_ss_add_to_stream(stcb, &stcb->asoc, strm, sp, 1);
6448 m = NULL;
6449 if (hold_stcb_lock == 0) {
6450 SCTP_TCB_SEND_UNLOCK(stcb);
6451 }
6452 out_now:
6453 if (m) {
6454 sctp_m_freem(m);
6455 }
6456 return (error);
6457 }
6458
6459
6460 static struct mbuf *
sctp_copy_mbufchain(struct mbuf * clonechain,struct mbuf * outchain,struct mbuf ** endofchain,int can_take_mbuf,int sizeofcpy,uint8_t copy_by_ref)6461 sctp_copy_mbufchain(struct mbuf *clonechain,
6462 struct mbuf *outchain,
6463 struct mbuf **endofchain,
6464 int can_take_mbuf,
6465 int sizeofcpy,
6466 uint8_t copy_by_ref)
6467 {
6468 struct mbuf *m;
6469 struct mbuf *appendchain;
6470 caddr_t cp;
6471 int len;
6472
6473 if (endofchain == NULL) {
6474 /* error */
6475 error_out:
6476 if (outchain)
6477 sctp_m_freem(outchain);
6478 return (NULL);
6479 }
6480 if (can_take_mbuf) {
6481 appendchain = clonechain;
6482 } else {
6483 if (!copy_by_ref &&
6484 (sizeofcpy <= (int)((((SCTP_BASE_SYSCTL(sctp_mbuf_threshold_count) - 1) * MLEN) + MHLEN)))
6485 ) {
6486 /* Its not in a cluster */
6487 if (*endofchain == NULL) {
6488 /* lets get a mbuf cluster */
6489 if (outchain == NULL) {
6490 /* This is the general case */
6491 new_mbuf:
6492 outchain = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_HEADER);
6493 if (outchain == NULL) {
6494 goto error_out;
6495 }
6496 SCTP_BUF_LEN(outchain) = 0;
6497 *endofchain = outchain;
6498 /* get the prepend space */
6499 SCTP_BUF_RESV_UF(outchain, (SCTP_FIRST_MBUF_RESV + 4));
6500 } else {
6501 /*
6502 * We really should not get a NULL
6503 * in endofchain
6504 */
6505 /* find end */
6506 m = outchain;
6507 while (m) {
6508 if (SCTP_BUF_NEXT(m) == NULL) {
6509 *endofchain = m;
6510 break;
6511 }
6512 m = SCTP_BUF_NEXT(m);
6513 }
6514 /* sanity */
6515 if (*endofchain == NULL) {
6516 /*
6517 * huh, TSNH XXX maybe we
6518 * should panic
6519 */
6520 sctp_m_freem(outchain);
6521 goto new_mbuf;
6522 }
6523 }
6524 /* get the new end of length */
6525 len = (int)M_TRAILINGSPACE(*endofchain);
6526 } else {
6527 /* how much is left at the end? */
6528 len = (int)M_TRAILINGSPACE(*endofchain);
6529 }
6530 /* Find the end of the data, for appending */
6531 cp = (mtod((*endofchain), caddr_t)+SCTP_BUF_LEN((*endofchain)));
6532
6533 /* Now lets copy it out */
6534 if (len >= sizeofcpy) {
6535 /* It all fits, copy it in */
6536 m_copydata(clonechain, 0, sizeofcpy, cp);
6537 SCTP_BUF_LEN((*endofchain)) += sizeofcpy;
6538 } else {
6539 /* fill up the end of the chain */
6540 if (len > 0) {
6541 m_copydata(clonechain, 0, len, cp);
6542 SCTP_BUF_LEN((*endofchain)) += len;
6543 /* now we need another one */
6544 sizeofcpy -= len;
6545 }
6546 m = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_HEADER);
6547 if (m == NULL) {
6548 /* We failed */
6549 goto error_out;
6550 }
6551 SCTP_BUF_NEXT((*endofchain)) = m;
6552 *endofchain = m;
6553 cp = mtod((*endofchain), caddr_t);
6554 m_copydata(clonechain, len, sizeofcpy, cp);
6555 SCTP_BUF_LEN((*endofchain)) += sizeofcpy;
6556 }
6557 return (outchain);
6558 } else {
6559 /* copy the old fashion way */
6560 appendchain = SCTP_M_COPYM(clonechain, 0, M_COPYALL, M_NOWAIT);
6561 #ifdef SCTP_MBUF_LOGGING
6562 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
6563 sctp_log_mbc(appendchain, SCTP_MBUF_ICOPY);
6564 }
6565 #endif
6566 }
6567 }
6568 if (appendchain == NULL) {
6569 /* error */
6570 if (outchain)
6571 sctp_m_freem(outchain);
6572 return (NULL);
6573 }
6574 if (outchain) {
6575 /* tack on to the end */
6576 if (*endofchain != NULL) {
6577 SCTP_BUF_NEXT(((*endofchain))) = appendchain;
6578 } else {
6579 m = outchain;
6580 while (m) {
6581 if (SCTP_BUF_NEXT(m) == NULL) {
6582 SCTP_BUF_NEXT(m) = appendchain;
6583 break;
6584 }
6585 m = SCTP_BUF_NEXT(m);
6586 }
6587 }
6588 /*
6589 * save off the end and update the end-chain position
6590 */
6591 m = appendchain;
6592 while (m) {
6593 if (SCTP_BUF_NEXT(m) == NULL) {
6594 *endofchain = m;
6595 break;
6596 }
6597 m = SCTP_BUF_NEXT(m);
6598 }
6599 return (outchain);
6600 } else {
6601 /* save off the end and update the end-chain position */
6602 m = appendchain;
6603 while (m) {
6604 if (SCTP_BUF_NEXT(m) == NULL) {
6605 *endofchain = m;
6606 break;
6607 }
6608 m = SCTP_BUF_NEXT(m);
6609 }
6610 return (appendchain);
6611 }
6612 }
6613
6614 static int
6615 sctp_med_chunk_output(struct sctp_inpcb *inp,
6616 struct sctp_tcb *stcb,
6617 struct sctp_association *asoc,
6618 int *num_out,
6619 int *reason_code,
6620 int control_only, int from_where,
6621 struct timeval *now, int *now_filled, int frag_point, int so_locked
6622 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
6623 SCTP_UNUSED
6624 #endif
6625 );
6626
6627 static void
sctp_sendall_iterator(struct sctp_inpcb * inp,struct sctp_tcb * stcb,void * ptr,uint32_t val SCTP_UNUSED)6628 sctp_sendall_iterator(struct sctp_inpcb *inp, struct sctp_tcb *stcb, void *ptr,
6629 uint32_t val SCTP_UNUSED)
6630 {
6631 struct sctp_copy_all *ca;
6632 struct mbuf *m;
6633 int ret = 0;
6634 int added_control = 0;
6635 int un_sent, do_chunk_output = 1;
6636 struct sctp_association *asoc;
6637 struct sctp_nets *net;
6638
6639 ca = (struct sctp_copy_all *)ptr;
6640 if (ca->m == NULL) {
6641 return;
6642 }
6643 if (ca->inp != inp) {
6644 /* TSNH */
6645 return;
6646 }
6647 if (ca->sndlen > 0) {
6648 m = SCTP_M_COPYM(ca->m, 0, M_COPYALL, M_NOWAIT);
6649 if (m == NULL) {
6650 /* can't copy so we are done */
6651 ca->cnt_failed++;
6652 return;
6653 }
6654 #ifdef SCTP_MBUF_LOGGING
6655 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
6656 sctp_log_mbc(m, SCTP_MBUF_ICOPY);
6657 }
6658 #endif
6659 } else {
6660 m = NULL;
6661 }
6662 SCTP_TCB_LOCK_ASSERT(stcb);
6663 if (stcb->asoc.alternate) {
6664 net = stcb->asoc.alternate;
6665 } else {
6666 net = stcb->asoc.primary_destination;
6667 }
6668 if (ca->sndrcv.sinfo_flags & SCTP_ABORT) {
6669 /* Abort this assoc with m as the user defined reason */
6670 if (m != NULL) {
6671 SCTP_BUF_PREPEND(m, sizeof(struct sctp_paramhdr), M_NOWAIT);
6672 } else {
6673 m = sctp_get_mbuf_for_msg(sizeof(struct sctp_paramhdr),
6674 0, M_NOWAIT, 1, MT_DATA);
6675 SCTP_BUF_LEN(m) = sizeof(struct sctp_paramhdr);
6676 }
6677 if (m != NULL) {
6678 struct sctp_paramhdr *ph;
6679
6680 ph = mtod(m, struct sctp_paramhdr *);
6681 ph->param_type = htons(SCTP_CAUSE_USER_INITIATED_ABT);
6682 ph->param_length = htons((uint16_t)(sizeof(struct sctp_paramhdr) + ca->sndlen));
6683 }
6684 /*
6685 * We add one here to keep the assoc from dis-appearing on
6686 * us.
6687 */
6688 atomic_add_int(&stcb->asoc.refcnt, 1);
6689 sctp_abort_an_association(inp, stcb, m, SCTP_SO_NOT_LOCKED);
6690 /*
6691 * sctp_abort_an_association calls sctp_free_asoc() free
6692 * association will NOT free it since we incremented the
6693 * refcnt .. we do this to prevent it being freed and things
6694 * getting tricky since we could end up (from free_asoc)
6695 * calling inpcb_free which would get a recursive lock call
6696 * to the iterator lock.. But as a consequence of that the
6697 * stcb will return to us un-locked.. since free_asoc
6698 * returns with either no TCB or the TCB unlocked, we must
6699 * relock.. to unlock in the iterator timer :-0
6700 */
6701 SCTP_TCB_LOCK(stcb);
6702 atomic_add_int(&stcb->asoc.refcnt, -1);
6703 goto no_chunk_output;
6704 } else {
6705 if (m) {
6706 ret = sctp_msg_append(stcb, net, m,
6707 &ca->sndrcv, 1);
6708 }
6709 asoc = &stcb->asoc;
6710 if (ca->sndrcv.sinfo_flags & SCTP_EOF) {
6711 /* shutdown this assoc */
6712 if (TAILQ_EMPTY(&asoc->send_queue) &&
6713 TAILQ_EMPTY(&asoc->sent_queue) &&
6714 sctp_is_there_unsent_data(stcb, SCTP_SO_NOT_LOCKED) == 0) {
6715 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
6716 goto abort_anyway;
6717 }
6718 /*
6719 * there is nothing queued to send, so I'm
6720 * done...
6721 */
6722 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
6723 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
6724 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
6725 /*
6726 * only send SHUTDOWN the first time
6727 * through
6728 */
6729 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
6730 SCTP_STAT_DECR_GAUGE32(sctps_currestab);
6731 }
6732 SCTP_SET_STATE(stcb, SCTP_STATE_SHUTDOWN_SENT);
6733 sctp_stop_timers_for_shutdown(stcb);
6734 sctp_send_shutdown(stcb, net);
6735 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN, stcb->sctp_ep, stcb,
6736 net);
6737 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
6738 asoc->primary_destination);
6739 added_control = 1;
6740 do_chunk_output = 0;
6741 }
6742 } else {
6743 /*
6744 * we still got (or just got) data to send,
6745 * so set SHUTDOWN_PENDING
6746 */
6747 /*
6748 * XXX sockets draft says that SCTP_EOF
6749 * should be sent with no data. currently,
6750 * we will allow user data to be sent first
6751 * and move to SHUTDOWN-PENDING
6752 */
6753 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
6754 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
6755 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
6756 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
6757 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_PARTIAL_MSG_LEFT);
6758 }
6759 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_SHUTDOWN_PENDING);
6760 if (TAILQ_EMPTY(&asoc->send_queue) &&
6761 TAILQ_EMPTY(&asoc->sent_queue) &&
6762 (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT)) {
6763 struct mbuf *op_err;
6764 char msg[SCTP_DIAG_INFO_LEN];
6765
6766 abort_anyway:
6767 snprintf(msg, sizeof(msg),
6768 "%s:%d at %s", __FILE__, __LINE__, __func__);
6769 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
6770 msg);
6771 atomic_add_int(&stcb->asoc.refcnt, 1);
6772 sctp_abort_an_association(stcb->sctp_ep, stcb,
6773 op_err, SCTP_SO_NOT_LOCKED);
6774 atomic_add_int(&stcb->asoc.refcnt, -1);
6775 goto no_chunk_output;
6776 }
6777 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
6778 asoc->primary_destination);
6779 }
6780 }
6781
6782 }
6783 }
6784 un_sent = ((stcb->asoc.total_output_queue_size - stcb->asoc.total_flight) +
6785 (stcb->asoc.stream_queue_cnt * SCTP_DATA_CHUNK_OVERHEAD(stcb)));
6786
6787 if ((sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY)) &&
6788 (stcb->asoc.total_flight > 0) &&
6789 (un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD))) {
6790 do_chunk_output = 0;
6791 }
6792 if (do_chunk_output)
6793 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_NOT_LOCKED);
6794 else if (added_control) {
6795 int num_out, reason, now_filled = 0;
6796 struct timeval now;
6797 int frag_point;
6798
6799 frag_point = sctp_get_frag_point(stcb, &stcb->asoc);
6800 (void)sctp_med_chunk_output(inp, stcb, &stcb->asoc, &num_out,
6801 &reason, 1, 1, &now, &now_filled, frag_point, SCTP_SO_NOT_LOCKED);
6802 }
6803 no_chunk_output:
6804 if (ret) {
6805 ca->cnt_failed++;
6806 } else {
6807 ca->cnt_sent++;
6808 }
6809 }
6810
6811 static void
sctp_sendall_completes(void * ptr,uint32_t val SCTP_UNUSED)6812 sctp_sendall_completes(void *ptr, uint32_t val SCTP_UNUSED)
6813 {
6814 struct sctp_copy_all *ca;
6815
6816 ca = (struct sctp_copy_all *)ptr;
6817 /*
6818 * Do a notify here? Kacheong suggests that the notify be done at
6819 * the send time.. so you would push up a notification if any send
6820 * failed. Don't know if this is feasible since the only failures we
6821 * have is "memory" related and if you cannot get an mbuf to send
6822 * the data you surely can't get an mbuf to send up to notify the
6823 * user you can't send the data :->
6824 */
6825
6826 /* now free everything */
6827 if (ca->inp) {
6828 /* Lets clear the flag to allow others to run. */
6829 ca->inp->sctp_flags &= ~SCTP_PCB_FLAGS_SND_ITERATOR_UP;
6830 }
6831 sctp_m_freem(ca->m);
6832 SCTP_FREE(ca, SCTP_M_COPYAL);
6833 }
6834
6835 static struct mbuf *
sctp_copy_out_all(struct uio * uio,ssize_t len)6836 sctp_copy_out_all(struct uio *uio, ssize_t len)
6837 {
6838 struct mbuf *ret, *at;
6839 ssize_t left, willcpy, cancpy, error;
6840
6841 ret = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_WAITOK, 1, MT_DATA);
6842 if (ret == NULL) {
6843 /* TSNH */
6844 return (NULL);
6845 }
6846 left = len;
6847 SCTP_BUF_LEN(ret) = 0;
6848 /* save space for the data chunk header */
6849 cancpy = (int)M_TRAILINGSPACE(ret);
6850 willcpy = min(cancpy, left);
6851 at = ret;
6852 while (left > 0) {
6853 /* Align data to the end */
6854 error = uiomove(mtod(at, caddr_t), (int)willcpy, uio);
6855 if (error) {
6856 err_out_now:
6857 sctp_m_freem(at);
6858 return (NULL);
6859 }
6860 SCTP_BUF_LEN(at) = (int)willcpy;
6861 SCTP_BUF_NEXT_PKT(at) = SCTP_BUF_NEXT(at) = 0;
6862 left -= willcpy;
6863 if (left > 0) {
6864 SCTP_BUF_NEXT(at) = sctp_get_mbuf_for_msg((unsigned int)left, 0, M_WAITOK, 1, MT_DATA);
6865 if (SCTP_BUF_NEXT(at) == NULL) {
6866 goto err_out_now;
6867 }
6868 at = SCTP_BUF_NEXT(at);
6869 SCTP_BUF_LEN(at) = 0;
6870 cancpy = (int)M_TRAILINGSPACE(at);
6871 willcpy = min(cancpy, left);
6872 }
6873 }
6874 return (ret);
6875 }
6876
6877 static int
sctp_sendall(struct sctp_inpcb * inp,struct uio * uio,struct mbuf * m,struct sctp_sndrcvinfo * srcv)6878 sctp_sendall(struct sctp_inpcb *inp, struct uio *uio, struct mbuf *m,
6879 struct sctp_sndrcvinfo *srcv)
6880 {
6881 int ret;
6882 struct sctp_copy_all *ca;
6883
6884 if (inp->sctp_flags & SCTP_PCB_FLAGS_SND_ITERATOR_UP) {
6885 /* There is another. */
6886 return (EBUSY);
6887 }
6888 if (uio->uio_resid > SCTP_MAX_SENDALL_LIMIT) {
6889 /* You must be less than the max! */
6890 return (EMSGSIZE);
6891 }
6892 SCTP_MALLOC(ca, struct sctp_copy_all *, sizeof(struct sctp_copy_all),
6893 SCTP_M_COPYAL);
6894 if (ca == NULL) {
6895 sctp_m_freem(m);
6896 SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
6897 return (ENOMEM);
6898 }
6899 memset(ca, 0, sizeof(struct sctp_copy_all));
6900
6901 ca->inp = inp;
6902 if (srcv) {
6903 memcpy(&ca->sndrcv, srcv, sizeof(struct sctp_nonpad_sndrcvinfo));
6904 }
6905 /*
6906 * take off the sendall flag, it would be bad if we failed to do
6907 * this :-0
6908 */
6909 ca->sndrcv.sinfo_flags &= ~SCTP_SENDALL;
6910 /* get length and mbuf chain */
6911 if (uio) {
6912 ca->sndlen = uio->uio_resid;
6913 ca->m = sctp_copy_out_all(uio, ca->sndlen);
6914 if (ca->m == NULL) {
6915 SCTP_FREE(ca, SCTP_M_COPYAL);
6916 SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
6917 return (ENOMEM);
6918 }
6919 } else {
6920 /* Gather the length of the send */
6921 struct mbuf *mat;
6922
6923 ca->sndlen = 0;
6924 for (mat = m; mat; mat = SCTP_BUF_NEXT(mat)) {
6925 ca->sndlen += SCTP_BUF_LEN(mat);
6926 }
6927 }
6928 inp->sctp_flags |= SCTP_PCB_FLAGS_SND_ITERATOR_UP;
6929 ret = sctp_initiate_iterator(NULL, sctp_sendall_iterator, NULL,
6930 SCTP_PCB_ANY_FLAGS, SCTP_PCB_ANY_FEATURES,
6931 SCTP_ASOC_ANY_STATE,
6932 (void *)ca, 0,
6933 sctp_sendall_completes, inp, 1);
6934 if (ret) {
6935 SCTP_PRINTF("Failed to initiate iterator for sendall\n");
6936 SCTP_FREE(ca, SCTP_M_COPYAL);
6937 SCTP_LTRACE_ERR_RET_PKT(m, inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EFAULT);
6938 return (EFAULT);
6939 }
6940 return (0);
6941 }
6942
6943
6944 void
sctp_toss_old_cookies(struct sctp_tcb * stcb,struct sctp_association * asoc)6945 sctp_toss_old_cookies(struct sctp_tcb *stcb, struct sctp_association *asoc)
6946 {
6947 struct sctp_tmit_chunk *chk, *nchk;
6948
6949 TAILQ_FOREACH_SAFE(chk, &asoc->control_send_queue, sctp_next, nchk) {
6950 if (chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) {
6951 TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next);
6952 asoc->ctrl_queue_cnt--;
6953 if (chk->data) {
6954 sctp_m_freem(chk->data);
6955 chk->data = NULL;
6956 }
6957 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
6958 }
6959 }
6960 }
6961
6962 void
sctp_toss_old_asconf(struct sctp_tcb * stcb)6963 sctp_toss_old_asconf(struct sctp_tcb *stcb)
6964 {
6965 struct sctp_association *asoc;
6966 struct sctp_tmit_chunk *chk, *nchk;
6967 struct sctp_asconf_chunk *acp;
6968
6969 asoc = &stcb->asoc;
6970 TAILQ_FOREACH_SAFE(chk, &asoc->asconf_send_queue, sctp_next, nchk) {
6971 /* find SCTP_ASCONF chunk in queue */
6972 if (chk->rec.chunk_id.id == SCTP_ASCONF) {
6973 if (chk->data) {
6974 acp = mtod(chk->data, struct sctp_asconf_chunk *);
6975 if (SCTP_TSN_GT(ntohl(acp->serial_number), asoc->asconf_seq_out_acked)) {
6976 /* Not Acked yet */
6977 break;
6978 }
6979 }
6980 TAILQ_REMOVE(&asoc->asconf_send_queue, chk, sctp_next);
6981 asoc->ctrl_queue_cnt--;
6982 if (chk->data) {
6983 sctp_m_freem(chk->data);
6984 chk->data = NULL;
6985 }
6986 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
6987 }
6988 }
6989 }
6990
6991
6992 static void
sctp_clean_up_datalist(struct sctp_tcb * stcb,struct sctp_association * asoc,struct sctp_tmit_chunk ** data_list,int bundle_at,struct sctp_nets * net)6993 sctp_clean_up_datalist(struct sctp_tcb *stcb,
6994 struct sctp_association *asoc,
6995 struct sctp_tmit_chunk **data_list,
6996 int bundle_at,
6997 struct sctp_nets *net)
6998 {
6999 int i;
7000 struct sctp_tmit_chunk *tp1;
7001
7002 for (i = 0; i < bundle_at; i++) {
7003 /* off of the send queue */
7004 TAILQ_REMOVE(&asoc->send_queue, data_list[i], sctp_next);
7005 asoc->send_queue_cnt--;
7006 if (i > 0) {
7007 /*
7008 * Any chunk NOT 0 you zap the time chunk 0 gets
7009 * zapped or set based on if a RTO measurment is
7010 * needed.
7011 */
7012 data_list[i]->do_rtt = 0;
7013 }
7014 /* record time */
7015 data_list[i]->sent_rcv_time = net->last_sent_time;
7016 data_list[i]->rec.data.cwnd_at_send = net->cwnd;
7017 data_list[i]->rec.data.fast_retran_tsn = data_list[i]->rec.data.tsn;
7018 if (data_list[i]->whoTo == NULL) {
7019 data_list[i]->whoTo = net;
7020 atomic_add_int(&net->ref_count, 1);
7021 }
7022 /* on to the sent queue */
7023 tp1 = TAILQ_LAST(&asoc->sent_queue, sctpchunk_listhead);
7024 if ((tp1) && SCTP_TSN_GT(tp1->rec.data.tsn, data_list[i]->rec.data.tsn)) {
7025 struct sctp_tmit_chunk *tpp;
7026
7027 /* need to move back */
7028 back_up_more:
7029 tpp = TAILQ_PREV(tp1, sctpchunk_listhead, sctp_next);
7030 if (tpp == NULL) {
7031 TAILQ_INSERT_BEFORE(tp1, data_list[i], sctp_next);
7032 goto all_done;
7033 }
7034 tp1 = tpp;
7035 if (SCTP_TSN_GT(tp1->rec.data.tsn, data_list[i]->rec.data.tsn)) {
7036 goto back_up_more;
7037 }
7038 TAILQ_INSERT_AFTER(&asoc->sent_queue, tp1, data_list[i], sctp_next);
7039 } else {
7040 TAILQ_INSERT_TAIL(&asoc->sent_queue,
7041 data_list[i],
7042 sctp_next);
7043 }
7044 all_done:
7045 /* This does not lower until the cum-ack passes it */
7046 asoc->sent_queue_cnt++;
7047 if ((asoc->peers_rwnd <= 0) &&
7048 (asoc->total_flight == 0) &&
7049 (bundle_at == 1)) {
7050 /* Mark the chunk as being a window probe */
7051 SCTP_STAT_INCR(sctps_windowprobed);
7052 }
7053 #ifdef SCTP_AUDITING_ENABLED
7054 sctp_audit_log(0xC2, 3);
7055 #endif
7056 data_list[i]->sent = SCTP_DATAGRAM_SENT;
7057 data_list[i]->snd_count = 1;
7058 data_list[i]->rec.data.chunk_was_revoked = 0;
7059 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
7060 sctp_misc_ints(SCTP_FLIGHT_LOG_UP,
7061 data_list[i]->whoTo->flight_size,
7062 data_list[i]->book_size,
7063 (uint32_t)(uintptr_t)data_list[i]->whoTo,
7064 data_list[i]->rec.data.tsn);
7065 }
7066 sctp_flight_size_increase(data_list[i]);
7067 sctp_total_flight_increase(stcb, data_list[i]);
7068 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_RWND_ENABLE) {
7069 sctp_log_rwnd(SCTP_DECREASE_PEER_RWND,
7070 asoc->peers_rwnd, data_list[i]->send_size, SCTP_BASE_SYSCTL(sctp_peer_chunk_oh));
7071 }
7072 asoc->peers_rwnd = sctp_sbspace_sub(asoc->peers_rwnd,
7073 (uint32_t)(data_list[i]->send_size + SCTP_BASE_SYSCTL(sctp_peer_chunk_oh)));
7074 if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
7075 /* SWS sender side engages */
7076 asoc->peers_rwnd = 0;
7077 }
7078 }
7079 if (asoc->cc_functions.sctp_cwnd_update_packet_transmitted) {
7080 (*asoc->cc_functions.sctp_cwnd_update_packet_transmitted) (stcb, net);
7081 }
7082 }
7083
7084 static void
sctp_clean_up_ctl(struct sctp_tcb * stcb,struct sctp_association * asoc,int so_locked SCTP_UNUSED)7085 sctp_clean_up_ctl(struct sctp_tcb *stcb, struct sctp_association *asoc, int so_locked
7086 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
7087 SCTP_UNUSED
7088 #endif
7089 )
7090 {
7091 struct sctp_tmit_chunk *chk, *nchk;
7092
7093 TAILQ_FOREACH_SAFE(chk, &asoc->control_send_queue, sctp_next, nchk) {
7094 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
7095 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK) || /* EY */
7096 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_REQUEST) ||
7097 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_ACK) ||
7098 (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) ||
7099 (chk->rec.chunk_id.id == SCTP_SHUTDOWN) ||
7100 (chk->rec.chunk_id.id == SCTP_SHUTDOWN_ACK) ||
7101 (chk->rec.chunk_id.id == SCTP_OPERATION_ERROR) ||
7102 (chk->rec.chunk_id.id == SCTP_PACKET_DROPPED) ||
7103 (chk->rec.chunk_id.id == SCTP_COOKIE_ACK) ||
7104 (chk->rec.chunk_id.id == SCTP_ECN_CWR) ||
7105 (chk->rec.chunk_id.id == SCTP_ASCONF_ACK)) {
7106 /* Stray chunks must be cleaned up */
7107 clean_up_anyway:
7108 TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next);
7109 asoc->ctrl_queue_cnt--;
7110 if (chk->data) {
7111 sctp_m_freem(chk->data);
7112 chk->data = NULL;
7113 }
7114 if (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) {
7115 asoc->fwd_tsn_cnt--;
7116 }
7117 sctp_free_a_chunk(stcb, chk, so_locked);
7118 } else if (chk->rec.chunk_id.id == SCTP_STREAM_RESET) {
7119 /* special handling, we must look into the param */
7120 if (chk != asoc->str_reset) {
7121 goto clean_up_anyway;
7122 }
7123 }
7124 }
7125 }
7126
7127 static uint32_t
sctp_can_we_split_this(struct sctp_tcb * stcb,uint32_t length,uint32_t space_left,uint32_t frag_point,int eeor_on)7128 sctp_can_we_split_this(struct sctp_tcb *stcb, uint32_t length,
7129 uint32_t space_left, uint32_t frag_point, int eeor_on)
7130 {
7131 /*
7132 * Make a decision on if I should split a msg into multiple parts.
7133 * This is only asked of incomplete messages.
7134 */
7135 if (eeor_on) {
7136 /*
7137 * If we are doing EEOR we need to always send it if its the
7138 * entire thing, since it might be all the guy is putting in
7139 * the hopper.
7140 */
7141 if (space_left >= length) {
7142 /*-
7143 * If we have data outstanding,
7144 * we get another chance when the sack
7145 * arrives to transmit - wait for more data
7146 */
7147 if (stcb->asoc.total_flight == 0) {
7148 /*
7149 * If nothing is in flight, we zero the
7150 * packet counter.
7151 */
7152 return (length);
7153 }
7154 return (0);
7155
7156 } else {
7157 /* You can fill the rest */
7158 return (space_left);
7159 }
7160 }
7161 /*-
7162 * For those strange folk that make the send buffer
7163 * smaller than our fragmentation point, we can't
7164 * get a full msg in so we have to allow splitting.
7165 */
7166 if (SCTP_SB_LIMIT_SND(stcb->sctp_socket) < frag_point) {
7167 return (length);
7168 }
7169 if ((length <= space_left) ||
7170 ((length - space_left) < SCTP_BASE_SYSCTL(sctp_min_residual))) {
7171 /* Sub-optimial residual don't split in non-eeor mode. */
7172 return (0);
7173 }
7174 /*
7175 * If we reach here length is larger than the space_left. Do we wish
7176 * to split it for the sake of packet putting together?
7177 */
7178 if (space_left >= min(SCTP_BASE_SYSCTL(sctp_min_split_point), frag_point)) {
7179 /* Its ok to split it */
7180 return (min(space_left, frag_point));
7181 }
7182 /* Nope, can't split */
7183 return (0);
7184 }
7185
7186 static uint32_t
sctp_move_to_outqueue(struct sctp_tcb * stcb,struct sctp_stream_out * strq,uint32_t space_left,uint32_t frag_point,int * giveup,int eeor_mode,int * bail,int so_locked SCTP_UNUSED)7187 sctp_move_to_outqueue(struct sctp_tcb *stcb,
7188 struct sctp_stream_out *strq,
7189 uint32_t space_left,
7190 uint32_t frag_point,
7191 int *giveup,
7192 int eeor_mode,
7193 int *bail,
7194 int so_locked
7195 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
7196 SCTP_UNUSED
7197 #endif
7198 )
7199 {
7200 /* Move from the stream to the send_queue keeping track of the total */
7201 struct sctp_association *asoc;
7202 struct sctp_stream_queue_pending *sp;
7203 struct sctp_tmit_chunk *chk;
7204 struct sctp_data_chunk *dchkh = NULL;
7205 struct sctp_idata_chunk *ndchkh = NULL;
7206 uint32_t to_move, length;
7207 int leading;
7208 uint8_t rcv_flags = 0;
7209 uint8_t some_taken;
7210 uint8_t send_lock_up = 0;
7211
7212 SCTP_TCB_LOCK_ASSERT(stcb);
7213 asoc = &stcb->asoc;
7214 one_more_time:
7215 /* sa_ignore FREED_MEMORY */
7216 sp = TAILQ_FIRST(&strq->outqueue);
7217 if (sp == NULL) {
7218 if (send_lock_up == 0) {
7219 SCTP_TCB_SEND_LOCK(stcb);
7220 send_lock_up = 1;
7221 }
7222 sp = TAILQ_FIRST(&strq->outqueue);
7223 if (sp) {
7224 goto one_more_time;
7225 }
7226 if ((sctp_is_feature_on(stcb->sctp_ep, SCTP_PCB_FLAGS_EXPLICIT_EOR) == 0) &&
7227 (stcb->asoc.idata_supported == 0) &&
7228 (strq->last_msg_incomplete)) {
7229 SCTP_PRINTF("Huh? Stream:%d lm_in_c=%d but queue is NULL\n",
7230 strq->sid,
7231 strq->last_msg_incomplete);
7232 strq->last_msg_incomplete = 0;
7233 }
7234 to_move = 0;
7235 if (send_lock_up) {
7236 SCTP_TCB_SEND_UNLOCK(stcb);
7237 send_lock_up = 0;
7238 }
7239 goto out_of;
7240 }
7241 if ((sp->msg_is_complete) && (sp->length == 0)) {
7242 if (sp->sender_all_done) {
7243 /*
7244 * We are doing deferred cleanup. Last time through
7245 * when we took all the data the sender_all_done was
7246 * not set.
7247 */
7248 if ((sp->put_last_out == 0) && (sp->discard_rest == 0)) {
7249 SCTP_PRINTF("Gak, put out entire msg with NO end!-1\n");
7250 SCTP_PRINTF("sender_done:%d len:%d msg_comp:%d put_last_out:%d send_lock:%d\n",
7251 sp->sender_all_done,
7252 sp->length,
7253 sp->msg_is_complete,
7254 sp->put_last_out,
7255 send_lock_up);
7256 }
7257 if ((TAILQ_NEXT(sp, next) == NULL) && (send_lock_up == 0)) {
7258 SCTP_TCB_SEND_LOCK(stcb);
7259 send_lock_up = 1;
7260 }
7261 atomic_subtract_int(&asoc->stream_queue_cnt, 1);
7262 TAILQ_REMOVE(&strq->outqueue, sp, next);
7263 stcb->asoc.ss_functions.sctp_ss_remove_from_stream(stcb, asoc, strq, sp, send_lock_up);
7264 if ((strq->state == SCTP_STREAM_RESET_PENDING) &&
7265 (strq->chunks_on_queues == 0) &&
7266 TAILQ_EMPTY(&strq->outqueue)) {
7267 stcb->asoc.trigger_reset = 1;
7268 }
7269 if (sp->net) {
7270 sctp_free_remote_addr(sp->net);
7271 sp->net = NULL;
7272 }
7273 if (sp->data) {
7274 sctp_m_freem(sp->data);
7275 sp->data = NULL;
7276 }
7277 sctp_free_a_strmoq(stcb, sp, so_locked);
7278 /* we can't be locked to it */
7279 if (send_lock_up) {
7280 SCTP_TCB_SEND_UNLOCK(stcb);
7281 send_lock_up = 0;
7282 }
7283 /* back to get the next msg */
7284 goto one_more_time;
7285 } else {
7286 /*
7287 * sender just finished this but still holds a
7288 * reference
7289 */
7290 *giveup = 1;
7291 to_move = 0;
7292 goto out_of;
7293 }
7294 } else {
7295 /* is there some to get */
7296 if (sp->length == 0) {
7297 /* no */
7298 *giveup = 1;
7299 to_move = 0;
7300 goto out_of;
7301 } else if (sp->discard_rest) {
7302 if (send_lock_up == 0) {
7303 SCTP_TCB_SEND_LOCK(stcb);
7304 send_lock_up = 1;
7305 }
7306 /* Whack down the size */
7307 atomic_subtract_int(&stcb->asoc.total_output_queue_size, sp->length);
7308 if ((stcb->sctp_socket != NULL) &&
7309 ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) ||
7310 (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL))) {
7311 atomic_subtract_int(&stcb->sctp_socket->so_snd.sb_cc, sp->length);
7312 }
7313 if (sp->data) {
7314 sctp_m_freem(sp->data);
7315 sp->data = NULL;
7316 sp->tail_mbuf = NULL;
7317 }
7318 sp->length = 0;
7319 sp->some_taken = 1;
7320 *giveup = 1;
7321 to_move = 0;
7322 goto out_of;
7323 }
7324 }
7325 some_taken = sp->some_taken;
7326 re_look:
7327 length = sp->length;
7328 if (sp->msg_is_complete) {
7329 /* The message is complete */
7330 to_move = min(length, frag_point);
7331 if (to_move == length) {
7332 /* All of it fits in the MTU */
7333 if (sp->some_taken) {
7334 rcv_flags |= SCTP_DATA_LAST_FRAG;
7335 } else {
7336 rcv_flags |= SCTP_DATA_NOT_FRAG;
7337 }
7338 sp->put_last_out = 1;
7339 if (sp->sinfo_flags & SCTP_SACK_IMMEDIATELY) {
7340 rcv_flags |= SCTP_DATA_SACK_IMMEDIATELY;
7341 }
7342 } else {
7343 /* Not all of it fits, we fragment */
7344 if (sp->some_taken == 0) {
7345 rcv_flags |= SCTP_DATA_FIRST_FRAG;
7346 }
7347 sp->some_taken = 1;
7348 }
7349 } else {
7350 to_move = sctp_can_we_split_this(stcb, length, space_left, frag_point, eeor_mode);
7351 if (to_move) {
7352 /*-
7353 * We use a snapshot of length in case it
7354 * is expanding during the compare.
7355 */
7356 uint32_t llen;
7357
7358 llen = length;
7359 if (to_move >= llen) {
7360 to_move = llen;
7361 if (send_lock_up == 0) {
7362 /*-
7363 * We are taking all of an incomplete msg
7364 * thus we need a send lock.
7365 */
7366 SCTP_TCB_SEND_LOCK(stcb);
7367 send_lock_up = 1;
7368 if (sp->msg_is_complete) {
7369 /*
7370 * the sender finished the
7371 * msg
7372 */
7373 goto re_look;
7374 }
7375 }
7376 }
7377 if (sp->some_taken == 0) {
7378 rcv_flags |= SCTP_DATA_FIRST_FRAG;
7379 sp->some_taken = 1;
7380 }
7381 } else {
7382 /* Nothing to take. */
7383 *giveup = 1;
7384 to_move = 0;
7385 goto out_of;
7386 }
7387 }
7388
7389 /* If we reach here, we can copy out a chunk */
7390 sctp_alloc_a_chunk(stcb, chk);
7391 if (chk == NULL) {
7392 /* No chunk memory */
7393 *giveup = 1;
7394 to_move = 0;
7395 goto out_of;
7396 }
7397 /*
7398 * Setup for unordered if needed by looking at the user sent info
7399 * flags.
7400 */
7401 if (sp->sinfo_flags & SCTP_UNORDERED) {
7402 rcv_flags |= SCTP_DATA_UNORDERED;
7403 }
7404 if (SCTP_BASE_SYSCTL(sctp_enable_sack_immediately) &&
7405 (sp->sinfo_flags & SCTP_EOF) == SCTP_EOF) {
7406 rcv_flags |= SCTP_DATA_SACK_IMMEDIATELY;
7407 }
7408 /* clear out the chunk before setting up */
7409 memset(chk, 0, sizeof(*chk));
7410 chk->rec.data.rcv_flags = rcv_flags;
7411
7412 if (to_move >= length) {
7413 /* we think we can steal the whole thing */
7414 if ((sp->sender_all_done == 0) && (send_lock_up == 0)) {
7415 SCTP_TCB_SEND_LOCK(stcb);
7416 send_lock_up = 1;
7417 }
7418 if (to_move < sp->length) {
7419 /* bail, it changed */
7420 goto dont_do_it;
7421 }
7422 chk->data = sp->data;
7423 chk->last_mbuf = sp->tail_mbuf;
7424 /* register the stealing */
7425 sp->data = sp->tail_mbuf = NULL;
7426 } else {
7427 struct mbuf *m;
7428
7429 dont_do_it:
7430 chk->data = SCTP_M_COPYM(sp->data, 0, to_move, M_NOWAIT);
7431 chk->last_mbuf = NULL;
7432 if (chk->data == NULL) {
7433 sp->some_taken = some_taken;
7434 sctp_free_a_chunk(stcb, chk, so_locked);
7435 *bail = 1;
7436 to_move = 0;
7437 goto out_of;
7438 }
7439 #ifdef SCTP_MBUF_LOGGING
7440 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
7441 sctp_log_mbc(chk->data, SCTP_MBUF_ICOPY);
7442 }
7443 #endif
7444 /* Pull off the data */
7445 m_adj(sp->data, to_move);
7446 /* Now lets work our way down and compact it */
7447 m = sp->data;
7448 while (m && (SCTP_BUF_LEN(m) == 0)) {
7449 sp->data = SCTP_BUF_NEXT(m);
7450 SCTP_BUF_NEXT(m) = NULL;
7451 if (sp->tail_mbuf == m) {
7452 /*-
7453 * Freeing tail? TSNH since
7454 * we supposedly were taking less
7455 * than the sp->length.
7456 */
7457 #ifdef INVARIANTS
7458 panic("Huh, freing tail? - TSNH");
7459 #else
7460 SCTP_PRINTF("Huh, freeing tail? - TSNH\n");
7461 sp->tail_mbuf = sp->data = NULL;
7462 sp->length = 0;
7463 #endif
7464
7465 }
7466 sctp_m_free(m);
7467 m = sp->data;
7468 }
7469 }
7470 if (SCTP_BUF_IS_EXTENDED(chk->data)) {
7471 chk->copy_by_ref = 1;
7472 } else {
7473 chk->copy_by_ref = 0;
7474 }
7475 /*
7476 * get last_mbuf and counts of mb usage This is ugly but hopefully
7477 * its only one mbuf.
7478 */
7479 if (chk->last_mbuf == NULL) {
7480 chk->last_mbuf = chk->data;
7481 while (SCTP_BUF_NEXT(chk->last_mbuf) != NULL) {
7482 chk->last_mbuf = SCTP_BUF_NEXT(chk->last_mbuf);
7483 }
7484 }
7485
7486 if (to_move > length) {
7487 /*- This should not happen either
7488 * since we always lower to_move to the size
7489 * of sp->length if its larger.
7490 */
7491 #ifdef INVARIANTS
7492 panic("Huh, how can to_move be larger?");
7493 #else
7494 SCTP_PRINTF("Huh, how can to_move be larger?\n");
7495 sp->length = 0;
7496 #endif
7497 } else {
7498 atomic_subtract_int(&sp->length, to_move);
7499 }
7500 leading = SCTP_DATA_CHUNK_OVERHEAD(stcb);
7501 if (M_LEADINGSPACE(chk->data) < leading) {
7502 /* Not enough room for a chunk header, get some */
7503 struct mbuf *m;
7504
7505 m = sctp_get_mbuf_for_msg(1, 0, M_NOWAIT, 1, MT_DATA);
7506 if (m == NULL) {
7507 /*
7508 * we're in trouble here. _PREPEND below will free
7509 * all the data if there is no leading space, so we
7510 * must put the data back and restore.
7511 */
7512 if (send_lock_up == 0) {
7513 SCTP_TCB_SEND_LOCK(stcb);
7514 send_lock_up = 1;
7515 }
7516 if (sp->data == NULL) {
7517 /* unsteal the data */
7518 sp->data = chk->data;
7519 sp->tail_mbuf = chk->last_mbuf;
7520 } else {
7521 struct mbuf *m_tmp;
7522
7523 /* reassemble the data */
7524 m_tmp = sp->data;
7525 sp->data = chk->data;
7526 SCTP_BUF_NEXT(chk->last_mbuf) = m_tmp;
7527 }
7528 sp->some_taken = some_taken;
7529 atomic_add_int(&sp->length, to_move);
7530 chk->data = NULL;
7531 *bail = 1;
7532 sctp_free_a_chunk(stcb, chk, so_locked);
7533 to_move = 0;
7534 goto out_of;
7535 } else {
7536 SCTP_BUF_LEN(m) = 0;
7537 SCTP_BUF_NEXT(m) = chk->data;
7538 chk->data = m;
7539 M_ALIGN(chk->data, 4);
7540 }
7541 }
7542 SCTP_BUF_PREPEND(chk->data, SCTP_DATA_CHUNK_OVERHEAD(stcb), M_NOWAIT);
7543 if (chk->data == NULL) {
7544 /* HELP, TSNH since we assured it would not above? */
7545 #ifdef INVARIANTS
7546 panic("prepend failes HELP?");
7547 #else
7548 SCTP_PRINTF("prepend fails HELP?\n");
7549 sctp_free_a_chunk(stcb, chk, so_locked);
7550 #endif
7551 *bail = 1;
7552 to_move = 0;
7553 goto out_of;
7554 }
7555 sctp_snd_sb_alloc(stcb, SCTP_DATA_CHUNK_OVERHEAD(stcb));
7556 chk->book_size = chk->send_size = (uint16_t)(to_move + SCTP_DATA_CHUNK_OVERHEAD(stcb));
7557 chk->book_size_scale = 0;
7558 chk->sent = SCTP_DATAGRAM_UNSENT;
7559
7560 chk->flags = 0;
7561 chk->asoc = &stcb->asoc;
7562 chk->pad_inplace = 0;
7563 chk->no_fr_allowed = 0;
7564 if (stcb->asoc.idata_supported == 0) {
7565 if (rcv_flags & SCTP_DATA_UNORDERED) {
7566 /* Just use 0. The receiver ignores the values. */
7567 chk->rec.data.mid = 0;
7568 } else {
7569 chk->rec.data.mid = strq->next_mid_ordered;
7570 if (rcv_flags & SCTP_DATA_LAST_FRAG) {
7571 strq->next_mid_ordered++;
7572 }
7573 }
7574 } else {
7575 if (rcv_flags & SCTP_DATA_UNORDERED) {
7576 chk->rec.data.mid = strq->next_mid_unordered;
7577 if (rcv_flags & SCTP_DATA_LAST_FRAG) {
7578 strq->next_mid_unordered++;
7579 }
7580 } else {
7581 chk->rec.data.mid = strq->next_mid_ordered;
7582 if (rcv_flags & SCTP_DATA_LAST_FRAG) {
7583 strq->next_mid_ordered++;
7584 }
7585 }
7586 }
7587 chk->rec.data.sid = sp->sid;
7588 chk->rec.data.ppid = sp->ppid;
7589 chk->rec.data.context = sp->context;
7590 chk->rec.data.doing_fast_retransmit = 0;
7591
7592 chk->rec.data.timetodrop = sp->ts;
7593 chk->flags = sp->act_flags;
7594
7595 if (sp->net) {
7596 chk->whoTo = sp->net;
7597 atomic_add_int(&chk->whoTo->ref_count, 1);
7598 } else
7599 chk->whoTo = NULL;
7600
7601 if (sp->holds_key_ref) {
7602 chk->auth_keyid = sp->auth_keyid;
7603 sctp_auth_key_acquire(stcb, chk->auth_keyid);
7604 chk->holds_key_ref = 1;
7605 }
7606 chk->rec.data.tsn = atomic_fetchadd_int(&asoc->sending_seq, 1);
7607 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_AT_SEND_2_OUTQ) {
7608 sctp_misc_ints(SCTP_STRMOUT_LOG_SEND,
7609 (uint32_t)(uintptr_t)stcb, sp->length,
7610 (uint32_t)((chk->rec.data.sid << 16) | (0x0000ffff & chk->rec.data.mid)),
7611 chk->rec.data.tsn);
7612 }
7613 if (stcb->asoc.idata_supported == 0) {
7614 dchkh = mtod(chk->data, struct sctp_data_chunk *);
7615 } else {
7616 ndchkh = mtod(chk->data, struct sctp_idata_chunk *);
7617 }
7618 /*
7619 * Put the rest of the things in place now. Size was done earlier in
7620 * previous loop prior to padding.
7621 */
7622
7623 #ifdef SCTP_ASOCLOG_OF_TSNS
7624 SCTP_TCB_LOCK_ASSERT(stcb);
7625 if (asoc->tsn_out_at >= SCTP_TSN_LOG_SIZE) {
7626 asoc->tsn_out_at = 0;
7627 asoc->tsn_out_wrapped = 1;
7628 }
7629 asoc->out_tsnlog[asoc->tsn_out_at].tsn = chk->rec.data.tsn;
7630 asoc->out_tsnlog[asoc->tsn_out_at].strm = chk->rec.data.sid;
7631 asoc->out_tsnlog[asoc->tsn_out_at].seq = chk->rec.data.mid;
7632 asoc->out_tsnlog[asoc->tsn_out_at].sz = chk->send_size;
7633 asoc->out_tsnlog[asoc->tsn_out_at].flgs = chk->rec.data.rcv_flags;
7634 asoc->out_tsnlog[asoc->tsn_out_at].stcb = (void *)stcb;
7635 asoc->out_tsnlog[asoc->tsn_out_at].in_pos = asoc->tsn_out_at;
7636 asoc->out_tsnlog[asoc->tsn_out_at].in_out = 2;
7637 asoc->tsn_out_at++;
7638 #endif
7639 if (stcb->asoc.idata_supported == 0) {
7640 dchkh->ch.chunk_type = SCTP_DATA;
7641 dchkh->ch.chunk_flags = chk->rec.data.rcv_flags;
7642 dchkh->dp.tsn = htonl(chk->rec.data.tsn);
7643 dchkh->dp.sid = htons(strq->sid);
7644 dchkh->dp.ssn = htons((uint16_t)chk->rec.data.mid);
7645 dchkh->dp.ppid = chk->rec.data.ppid;
7646 dchkh->ch.chunk_length = htons(chk->send_size);
7647 } else {
7648 ndchkh->ch.chunk_type = SCTP_IDATA;
7649 ndchkh->ch.chunk_flags = chk->rec.data.rcv_flags;
7650 ndchkh->dp.tsn = htonl(chk->rec.data.tsn);
7651 ndchkh->dp.sid = htons(strq->sid);
7652 ndchkh->dp.reserved = htons(0);
7653 ndchkh->dp.mid = htonl(chk->rec.data.mid);
7654 if (sp->fsn == 0)
7655 ndchkh->dp.ppid_fsn.ppid = chk->rec.data.ppid;
7656 else
7657 ndchkh->dp.ppid_fsn.fsn = htonl(sp->fsn);
7658 sp->fsn++;
7659 ndchkh->ch.chunk_length = htons(chk->send_size);
7660 }
7661 /* Now advance the chk->send_size by the actual pad needed. */
7662 if (chk->send_size < SCTP_SIZE32(chk->book_size)) {
7663 /* need a pad */
7664 struct mbuf *lm;
7665 int pads;
7666
7667 pads = SCTP_SIZE32(chk->book_size) - chk->send_size;
7668 lm = sctp_pad_lastmbuf(chk->data, pads, chk->last_mbuf);
7669 if (lm != NULL) {
7670 chk->last_mbuf = lm;
7671 chk->pad_inplace = 1;
7672 }
7673 chk->send_size += pads;
7674 }
7675 if (PR_SCTP_ENABLED(chk->flags)) {
7676 asoc->pr_sctp_cnt++;
7677 }
7678 if (sp->msg_is_complete && (sp->length == 0) && (sp->sender_all_done)) {
7679 /* All done pull and kill the message */
7680 if (sp->put_last_out == 0) {
7681 SCTP_PRINTF("Gak, put out entire msg with NO end!-2\n");
7682 SCTP_PRINTF("sender_done:%d len:%d msg_comp:%d put_last_out:%d send_lock:%d\n",
7683 sp->sender_all_done,
7684 sp->length,
7685 sp->msg_is_complete,
7686 sp->put_last_out,
7687 send_lock_up);
7688 }
7689 if ((send_lock_up == 0) && (TAILQ_NEXT(sp, next) == NULL)) {
7690 SCTP_TCB_SEND_LOCK(stcb);
7691 send_lock_up = 1;
7692 }
7693 atomic_subtract_int(&asoc->stream_queue_cnt, 1);
7694 TAILQ_REMOVE(&strq->outqueue, sp, next);
7695 stcb->asoc.ss_functions.sctp_ss_remove_from_stream(stcb, asoc, strq, sp, send_lock_up);
7696 if ((strq->state == SCTP_STREAM_RESET_PENDING) &&
7697 (strq->chunks_on_queues == 0) &&
7698 TAILQ_EMPTY(&strq->outqueue)) {
7699 stcb->asoc.trigger_reset = 1;
7700 }
7701 if (sp->net) {
7702 sctp_free_remote_addr(sp->net);
7703 sp->net = NULL;
7704 }
7705 if (sp->data) {
7706 sctp_m_freem(sp->data);
7707 sp->data = NULL;
7708 }
7709 sctp_free_a_strmoq(stcb, sp, so_locked);
7710 }
7711 asoc->chunks_on_out_queue++;
7712 strq->chunks_on_queues++;
7713 TAILQ_INSERT_TAIL(&asoc->send_queue, chk, sctp_next);
7714 asoc->send_queue_cnt++;
7715 out_of:
7716 if (send_lock_up) {
7717 SCTP_TCB_SEND_UNLOCK(stcb);
7718 }
7719 return (to_move);
7720 }
7721
7722
7723 static void
sctp_fill_outqueue(struct sctp_tcb * stcb,struct sctp_nets * net,int frag_point,int eeor_mode,int * quit_now,int so_locked SCTP_UNUSED)7724 sctp_fill_outqueue(struct sctp_tcb *stcb,
7725 struct sctp_nets *net, int frag_point, int eeor_mode, int *quit_now, int so_locked
7726 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
7727 SCTP_UNUSED
7728 #endif
7729 )
7730 {
7731 struct sctp_association *asoc;
7732 struct sctp_stream_out *strq;
7733 uint32_t space_left, moved, total_moved;
7734 int bail, giveup;
7735
7736 SCTP_TCB_LOCK_ASSERT(stcb);
7737 asoc = &stcb->asoc;
7738 total_moved = 0;
7739 switch (net->ro._l_addr.sa.sa_family) {
7740 #ifdef INET
7741 case AF_INET:
7742 space_left = net->mtu - SCTP_MIN_V4_OVERHEAD;
7743 break;
7744 #endif
7745 #ifdef INET6
7746 case AF_INET6:
7747 space_left = net->mtu - SCTP_MIN_OVERHEAD;
7748 break;
7749 #endif
7750 default:
7751 /* TSNH */
7752 space_left = net->mtu;
7753 break;
7754 }
7755 /* Need an allowance for the data chunk header too */
7756 space_left -= SCTP_DATA_CHUNK_OVERHEAD(stcb);
7757
7758 /* must make even word boundary */
7759 space_left &= 0xfffffffc;
7760 strq = stcb->asoc.ss_functions.sctp_ss_select_stream(stcb, net, asoc);
7761 giveup = 0;
7762 bail = 0;
7763 while ((space_left > 0) && (strq != NULL)) {
7764 moved = sctp_move_to_outqueue(stcb, strq, space_left, frag_point,
7765 &giveup, eeor_mode, &bail, so_locked);
7766 stcb->asoc.ss_functions.sctp_ss_scheduled(stcb, net, asoc, strq, moved);
7767 if ((giveup != 0) || (bail != 0)) {
7768 break;
7769 }
7770 strq = stcb->asoc.ss_functions.sctp_ss_select_stream(stcb, net, asoc);
7771 total_moved += moved;
7772 space_left -= moved;
7773 if (space_left >= SCTP_DATA_CHUNK_OVERHEAD(stcb)) {
7774 space_left -= SCTP_DATA_CHUNK_OVERHEAD(stcb);
7775 } else {
7776 space_left = 0;
7777 }
7778 space_left &= 0xfffffffc;
7779 }
7780 if (bail != 0)
7781 *quit_now = 1;
7782
7783 stcb->asoc.ss_functions.sctp_ss_packet_done(stcb, net, asoc);
7784
7785 if (total_moved == 0) {
7786 if ((stcb->asoc.sctp_cmt_on_off == 0) &&
7787 (net == stcb->asoc.primary_destination)) {
7788 /* ran dry for primary network net */
7789 SCTP_STAT_INCR(sctps_primary_randry);
7790 } else if (stcb->asoc.sctp_cmt_on_off > 0) {
7791 /* ran dry with CMT on */
7792 SCTP_STAT_INCR(sctps_cmt_randry);
7793 }
7794 }
7795 }
7796
7797 void
sctp_fix_ecn_echo(struct sctp_association * asoc)7798 sctp_fix_ecn_echo(struct sctp_association *asoc)
7799 {
7800 struct sctp_tmit_chunk *chk;
7801
7802 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
7803 if (chk->rec.chunk_id.id == SCTP_ECN_ECHO) {
7804 chk->sent = SCTP_DATAGRAM_UNSENT;
7805 }
7806 }
7807 }
7808
7809 void
sctp_move_chunks_from_net(struct sctp_tcb * stcb,struct sctp_nets * net)7810 sctp_move_chunks_from_net(struct sctp_tcb *stcb, struct sctp_nets *net)
7811 {
7812 struct sctp_association *asoc;
7813 struct sctp_tmit_chunk *chk;
7814 struct sctp_stream_queue_pending *sp;
7815 unsigned int i;
7816
7817 if (net == NULL) {
7818 return;
7819 }
7820 asoc = &stcb->asoc;
7821 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
7822 TAILQ_FOREACH(sp, &stcb->asoc.strmout[i].outqueue, next) {
7823 if (sp->net == net) {
7824 sctp_free_remote_addr(sp->net);
7825 sp->net = NULL;
7826 }
7827 }
7828 }
7829 TAILQ_FOREACH(chk, &asoc->send_queue, sctp_next) {
7830 if (chk->whoTo == net) {
7831 sctp_free_remote_addr(chk->whoTo);
7832 chk->whoTo = NULL;
7833 }
7834 }
7835 }
7836
7837 int
sctp_med_chunk_output(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_association * asoc,int * num_out,int * reason_code,int control_only,int from_where,struct timeval * now,int * now_filled,int frag_point,int so_locked SCTP_UNUSED)7838 sctp_med_chunk_output(struct sctp_inpcb *inp,
7839 struct sctp_tcb *stcb,
7840 struct sctp_association *asoc,
7841 int *num_out,
7842 int *reason_code,
7843 int control_only, int from_where,
7844 struct timeval *now, int *now_filled, int frag_point, int so_locked
7845 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
7846 SCTP_UNUSED
7847 #endif
7848 )
7849 {
7850 /**
7851 * Ok this is the generic chunk service queue. we must do the
7852 * following:
7853 * - Service the stream queue that is next, moving any
7854 * message (note I must get a complete message i.e. FIRST/MIDDLE and
7855 * LAST to the out queue in one pass) and assigning TSN's. This
7856 * only applys though if the peer does not support NDATA. For NDATA
7857 * chunks its ok to not send the entire message ;-)
7858 * - Check to see if the cwnd/rwnd allows any output, if so we go ahead and
7859 * fomulate and send the low level chunks. Making sure to combine
7860 * any control in the control chunk queue also.
7861 */
7862 struct sctp_nets *net, *start_at, *sack_goes_to = NULL, *old_start_at = NULL;
7863 struct mbuf *outchain, *endoutchain;
7864 struct sctp_tmit_chunk *chk, *nchk;
7865
7866 /* temp arrays for unlinking */
7867 struct sctp_tmit_chunk *data_list[SCTP_MAX_DATA_BUNDLING];
7868 int no_fragmentflg, error;
7869 unsigned int max_rwnd_per_dest, max_send_per_dest;
7870 int one_chunk, hbflag, skip_data_for_this_net;
7871 int asconf, cookie, no_out_cnt;
7872 int bundle_at, ctl_cnt, no_data_chunks, eeor_mode;
7873 unsigned int mtu, r_mtu, omtu, mx_mtu, to_out;
7874 int tsns_sent = 0;
7875 uint32_t auth_offset;
7876 struct sctp_auth_chunk *auth;
7877 uint16_t auth_keyid;
7878 int override_ok = 1;
7879 int skip_fill_up = 0;
7880 int data_auth_reqd = 0;
7881
7882 /*
7883 * JRS 5/14/07 - Add flag for whether a heartbeat is sent to the
7884 * destination.
7885 */
7886 int quit_now = 0;
7887
7888 *num_out = 0;
7889 *reason_code = 0;
7890 auth_keyid = stcb->asoc.authinfo.active_keyid;
7891 if ((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) ||
7892 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
7893 (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXPLICIT_EOR))) {
7894 eeor_mode = 1;
7895 } else {
7896 eeor_mode = 0;
7897 }
7898 ctl_cnt = no_out_cnt = asconf = cookie = 0;
7899 /*
7900 * First lets prime the pump. For each destination, if there is room
7901 * in the flight size, attempt to pull an MTU's worth out of the
7902 * stream queues into the general send_queue
7903 */
7904 #ifdef SCTP_AUDITING_ENABLED
7905 sctp_audit_log(0xC2, 2);
7906 #endif
7907 SCTP_TCB_LOCK_ASSERT(stcb);
7908 hbflag = 0;
7909 if (control_only)
7910 no_data_chunks = 1;
7911 else
7912 no_data_chunks = 0;
7913
7914 /* Nothing to possible to send? */
7915 if ((TAILQ_EMPTY(&asoc->control_send_queue) ||
7916 (asoc->ctrl_queue_cnt == stcb->asoc.ecn_echo_cnt_onq)) &&
7917 TAILQ_EMPTY(&asoc->asconf_send_queue) &&
7918 TAILQ_EMPTY(&asoc->send_queue) &&
7919 sctp_is_there_unsent_data(stcb, so_locked) == 0) {
7920 nothing_to_send:
7921 *reason_code = 9;
7922 return (0);
7923 }
7924 if (asoc->peers_rwnd == 0) {
7925 /* No room in peers rwnd */
7926 *reason_code = 1;
7927 if (asoc->total_flight > 0) {
7928 /* we are allowed one chunk in flight */
7929 no_data_chunks = 1;
7930 }
7931 }
7932 if (stcb->asoc.ecn_echo_cnt_onq) {
7933 /* Record where a sack goes, if any */
7934 if (no_data_chunks &&
7935 (asoc->ctrl_queue_cnt == stcb->asoc.ecn_echo_cnt_onq)) {
7936 /* Nothing but ECNe to send - we don't do that */
7937 goto nothing_to_send;
7938 }
7939 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
7940 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
7941 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK)) {
7942 sack_goes_to = chk->whoTo;
7943 break;
7944 }
7945 }
7946 }
7947 max_rwnd_per_dest = ((asoc->peers_rwnd + asoc->total_flight) / asoc->numnets);
7948 if (stcb->sctp_socket)
7949 max_send_per_dest = SCTP_SB_LIMIT_SND(stcb->sctp_socket) / asoc->numnets;
7950 else
7951 max_send_per_dest = 0;
7952 if (no_data_chunks == 0) {
7953 /* How many non-directed chunks are there? */
7954 TAILQ_FOREACH(chk, &asoc->send_queue, sctp_next) {
7955 if (chk->whoTo == NULL) {
7956 /*
7957 * We already have non-directed chunks on
7958 * the queue, no need to do a fill-up.
7959 */
7960 skip_fill_up = 1;
7961 break;
7962 }
7963 }
7964
7965 }
7966 if ((no_data_chunks == 0) &&
7967 (skip_fill_up == 0) &&
7968 (!stcb->asoc.ss_functions.sctp_ss_is_empty(stcb, asoc))) {
7969 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
7970 /*
7971 * This for loop we are in takes in each net, if
7972 * its's got space in cwnd and has data sent to it
7973 * (when CMT is off) then it calls
7974 * sctp_fill_outqueue for the net. This gets data on
7975 * the send queue for that network.
7976 *
7977 * In sctp_fill_outqueue TSN's are assigned and data
7978 * is copied out of the stream buffers. Note mostly
7979 * copy by reference (we hope).
7980 */
7981 net->window_probe = 0;
7982 if ((net != stcb->asoc.alternate) &&
7983 ((net->dest_state & SCTP_ADDR_PF) ||
7984 (!(net->dest_state & SCTP_ADDR_REACHABLE)) ||
7985 (net->dest_state & SCTP_ADDR_UNCONFIRMED))) {
7986 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
7987 sctp_log_cwnd(stcb, net, 1,
7988 SCTP_CWND_LOG_FILL_OUTQ_CALLED);
7989 }
7990 continue;
7991 }
7992 if ((stcb->asoc.cc_functions.sctp_cwnd_new_transmission_begins) &&
7993 (net->flight_size == 0)) {
7994 (*stcb->asoc.cc_functions.sctp_cwnd_new_transmission_begins) (stcb, net);
7995 }
7996 if (net->flight_size >= net->cwnd) {
7997 /* skip this network, no room - can't fill */
7998 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
7999 sctp_log_cwnd(stcb, net, 3,
8000 SCTP_CWND_LOG_FILL_OUTQ_CALLED);
8001 }
8002 continue;
8003 }
8004 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
8005 sctp_log_cwnd(stcb, net, 4, SCTP_CWND_LOG_FILL_OUTQ_CALLED);
8006 }
8007 sctp_fill_outqueue(stcb, net, frag_point, eeor_mode, &quit_now, so_locked);
8008 if (quit_now) {
8009 /* memory alloc failure */
8010 no_data_chunks = 1;
8011 break;
8012 }
8013 }
8014 }
8015 /* now service each destination and send out what we can for it */
8016 /* Nothing to send? */
8017 if (TAILQ_EMPTY(&asoc->control_send_queue) &&
8018 TAILQ_EMPTY(&asoc->asconf_send_queue) &&
8019 TAILQ_EMPTY(&asoc->send_queue)) {
8020 *reason_code = 8;
8021 return (0);
8022 }
8023
8024 if (asoc->sctp_cmt_on_off > 0) {
8025 /* get the last start point */
8026 start_at = asoc->last_net_cmt_send_started;
8027 if (start_at == NULL) {
8028 /* null so to beginning */
8029 start_at = TAILQ_FIRST(&asoc->nets);
8030 } else {
8031 start_at = TAILQ_NEXT(asoc->last_net_cmt_send_started, sctp_next);
8032 if (start_at == NULL) {
8033 start_at = TAILQ_FIRST(&asoc->nets);
8034 }
8035 }
8036 asoc->last_net_cmt_send_started = start_at;
8037 } else {
8038 start_at = TAILQ_FIRST(&asoc->nets);
8039 }
8040 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
8041 if (chk->whoTo == NULL) {
8042 if (asoc->alternate) {
8043 chk->whoTo = asoc->alternate;
8044 } else {
8045 chk->whoTo = asoc->primary_destination;
8046 }
8047 atomic_add_int(&chk->whoTo->ref_count, 1);
8048 }
8049 }
8050 old_start_at = NULL;
8051 again_one_more_time:
8052 for (net = start_at; net != NULL; net = TAILQ_NEXT(net, sctp_next)) {
8053 /* how much can we send? */
8054 /* SCTPDBG("Examine for sending net:%x\n", (uint32_t)net); */
8055 if (old_start_at && (old_start_at == net)) {
8056 /* through list ocmpletely. */
8057 break;
8058 }
8059 tsns_sent = 0xa;
8060 if (TAILQ_EMPTY(&asoc->control_send_queue) &&
8061 TAILQ_EMPTY(&asoc->asconf_send_queue) &&
8062 (net->flight_size >= net->cwnd)) {
8063 /*
8064 * Nothing on control or asconf and flight is full,
8065 * we can skip even in the CMT case.
8066 */
8067 continue;
8068 }
8069 bundle_at = 0;
8070 endoutchain = outchain = NULL;
8071 auth = NULL;
8072 auth_offset = 0;
8073 no_fragmentflg = 1;
8074 one_chunk = 0;
8075 if (net->dest_state & SCTP_ADDR_UNCONFIRMED) {
8076 skip_data_for_this_net = 1;
8077 } else {
8078 skip_data_for_this_net = 0;
8079 }
8080 switch (((struct sockaddr *)&net->ro._l_addr)->sa_family) {
8081 #ifdef INET
8082 case AF_INET:
8083 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8084 break;
8085 #endif
8086 #ifdef INET6
8087 case AF_INET6:
8088 mtu = net->mtu - SCTP_MIN_OVERHEAD;
8089 break;
8090 #endif
8091 default:
8092 /* TSNH */
8093 mtu = net->mtu;
8094 break;
8095 }
8096 mx_mtu = mtu;
8097 to_out = 0;
8098 if (mtu > asoc->peers_rwnd) {
8099 if (asoc->total_flight > 0) {
8100 /* We have a packet in flight somewhere */
8101 r_mtu = asoc->peers_rwnd;
8102 } else {
8103 /* We are always allowed to send one MTU out */
8104 one_chunk = 1;
8105 r_mtu = mtu;
8106 }
8107 } else {
8108 r_mtu = mtu;
8109 }
8110 error = 0;
8111 /************************/
8112 /* ASCONF transmission */
8113 /************************/
8114 /* Now first lets go through the asconf queue */
8115 TAILQ_FOREACH_SAFE(chk, &asoc->asconf_send_queue, sctp_next, nchk) {
8116 if (chk->rec.chunk_id.id != SCTP_ASCONF) {
8117 continue;
8118 }
8119 if (chk->whoTo == NULL) {
8120 if (asoc->alternate == NULL) {
8121 if (asoc->primary_destination != net) {
8122 break;
8123 }
8124 } else {
8125 if (asoc->alternate != net) {
8126 break;
8127 }
8128 }
8129 } else {
8130 if (chk->whoTo != net) {
8131 break;
8132 }
8133 }
8134 if (chk->data == NULL) {
8135 break;
8136 }
8137 if (chk->sent != SCTP_DATAGRAM_UNSENT &&
8138 chk->sent != SCTP_DATAGRAM_RESEND) {
8139 break;
8140 }
8141 /*
8142 * if no AUTH is yet included and this chunk
8143 * requires it, make sure to account for it. We
8144 * don't apply the size until the AUTH chunk is
8145 * actually added below in case there is no room for
8146 * this chunk. NOTE: we overload the use of "omtu"
8147 * here
8148 */
8149 if ((auth == NULL) &&
8150 sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8151 stcb->asoc.peer_auth_chunks)) {
8152 omtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
8153 } else
8154 omtu = 0;
8155 /* Here we do NOT factor the r_mtu */
8156 if ((chk->send_size < (int)(mtu - omtu)) ||
8157 (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) {
8158 /*
8159 * We probably should glom the mbuf chain
8160 * from the chk->data for control but the
8161 * problem is it becomes yet one more level
8162 * of tracking to do if for some reason
8163 * output fails. Then I have got to
8164 * reconstruct the merged control chain.. el
8165 * yucko.. for now we take the easy way and
8166 * do the copy
8167 */
8168 /*
8169 * Add an AUTH chunk, if chunk requires it
8170 * save the offset into the chain for AUTH
8171 */
8172 if ((auth == NULL) &&
8173 (sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8174 stcb->asoc.peer_auth_chunks))) {
8175 outchain = sctp_add_auth_chunk(outchain,
8176 &endoutchain,
8177 &auth,
8178 &auth_offset,
8179 stcb,
8180 chk->rec.chunk_id.id);
8181 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8182 }
8183 outchain = sctp_copy_mbufchain(chk->data, outchain, &endoutchain,
8184 (int)chk->rec.chunk_id.can_take_data,
8185 chk->send_size, chk->copy_by_ref);
8186 if (outchain == NULL) {
8187 *reason_code = 8;
8188 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
8189 return (ENOMEM);
8190 }
8191 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8192 /* update our MTU size */
8193 if (mtu > (chk->send_size + omtu))
8194 mtu -= (chk->send_size + omtu);
8195 else
8196 mtu = 0;
8197 to_out += (chk->send_size + omtu);
8198 /* Do clear IP_DF ? */
8199 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
8200 no_fragmentflg = 0;
8201 }
8202 if (chk->rec.chunk_id.can_take_data)
8203 chk->data = NULL;
8204 /*
8205 * set hb flag since we can use these for
8206 * RTO
8207 */
8208 hbflag = 1;
8209 asconf = 1;
8210 /*
8211 * should sysctl this: don't bundle data
8212 * with ASCONF since it requires AUTH
8213 */
8214 no_data_chunks = 1;
8215 chk->sent = SCTP_DATAGRAM_SENT;
8216 if (chk->whoTo == NULL) {
8217 chk->whoTo = net;
8218 atomic_add_int(&net->ref_count, 1);
8219 }
8220 chk->snd_count++;
8221 if (mtu == 0) {
8222 /*
8223 * Ok we are out of room but we can
8224 * output without effecting the
8225 * flight size since this little guy
8226 * is a control only packet.
8227 */
8228 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, net);
8229 /*
8230 * do NOT clear the asconf flag as
8231 * it is used to do appropriate
8232 * source address selection.
8233 */
8234 if (*now_filled == 0) {
8235 (void)SCTP_GETTIME_TIMEVAL(now);
8236 *now_filled = 1;
8237 }
8238 net->last_sent_time = *now;
8239 hbflag = 0;
8240 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
8241 (struct sockaddr *)&net->ro._l_addr,
8242 outchain, auth_offset, auth,
8243 stcb->asoc.authinfo.active_keyid,
8244 no_fragmentflg, 0, asconf,
8245 inp->sctp_lport, stcb->rport,
8246 htonl(stcb->asoc.peer_vtag),
8247 net->port, NULL,
8248 0, 0,
8249 so_locked))) {
8250 /*
8251 * error, we could not
8252 * output
8253 */
8254 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
8255 if (from_where == 0) {
8256 SCTP_STAT_INCR(sctps_lowlevelerrusr);
8257 }
8258 if (error == ENOBUFS) {
8259 asoc->ifp_had_enobuf = 1;
8260 SCTP_STAT_INCR(sctps_lowlevelerr);
8261 }
8262 /* error, could not output */
8263 if (error == EHOSTUNREACH) {
8264 /*
8265 * Destination went
8266 * unreachable
8267 * during this send
8268 */
8269 sctp_move_chunks_from_net(stcb, net);
8270 }
8271 *reason_code = 7;
8272 break;
8273 } else {
8274 asoc->ifp_had_enobuf = 0;
8275 }
8276 /*
8277 * increase the number we sent, if a
8278 * cookie is sent we don't tell them
8279 * any was sent out.
8280 */
8281 outchain = endoutchain = NULL;
8282 auth = NULL;
8283 auth_offset = 0;
8284 if (!no_out_cnt)
8285 *num_out += ctl_cnt;
8286 /* recalc a clean slate and setup */
8287 switch (net->ro._l_addr.sa.sa_family) {
8288 #ifdef INET
8289 case AF_INET:
8290 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8291 break;
8292 #endif
8293 #ifdef INET6
8294 case AF_INET6:
8295 mtu = net->mtu - SCTP_MIN_OVERHEAD;
8296 break;
8297 #endif
8298 default:
8299 /* TSNH */
8300 mtu = net->mtu;
8301 break;
8302 }
8303 to_out = 0;
8304 no_fragmentflg = 1;
8305 }
8306 }
8307 }
8308 if (error != 0) {
8309 /* try next net */
8310 continue;
8311 }
8312 /************************/
8313 /* Control transmission */
8314 /************************/
8315 /* Now first lets go through the control queue */
8316 TAILQ_FOREACH_SAFE(chk, &asoc->control_send_queue, sctp_next, nchk) {
8317 if ((sack_goes_to) &&
8318 (chk->rec.chunk_id.id == SCTP_ECN_ECHO) &&
8319 (chk->whoTo != sack_goes_to)) {
8320 /*
8321 * if we have a sack in queue, and we are
8322 * looking at an ecn echo that is NOT queued
8323 * to where the sack is going..
8324 */
8325 if (chk->whoTo == net) {
8326 /*
8327 * Don't transmit it to where its
8328 * going (current net)
8329 */
8330 continue;
8331 } else if (sack_goes_to == net) {
8332 /*
8333 * But do transmit it to this
8334 * address
8335 */
8336 goto skip_net_check;
8337 }
8338 }
8339 if (chk->whoTo == NULL) {
8340 if (asoc->alternate == NULL) {
8341 if (asoc->primary_destination != net) {
8342 continue;
8343 }
8344 } else {
8345 if (asoc->alternate != net) {
8346 continue;
8347 }
8348 }
8349 } else {
8350 if (chk->whoTo != net) {
8351 continue;
8352 }
8353 }
8354 skip_net_check:
8355 if (chk->data == NULL) {
8356 continue;
8357 }
8358 if (chk->sent != SCTP_DATAGRAM_UNSENT) {
8359 /*
8360 * It must be unsent. Cookies and ASCONF's
8361 * hang around but there timers will force
8362 * when marked for resend.
8363 */
8364 continue;
8365 }
8366 /*
8367 * if no AUTH is yet included and this chunk
8368 * requires it, make sure to account for it. We
8369 * don't apply the size until the AUTH chunk is
8370 * actually added below in case there is no room for
8371 * this chunk. NOTE: we overload the use of "omtu"
8372 * here
8373 */
8374 if ((auth == NULL) &&
8375 sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8376 stcb->asoc.peer_auth_chunks)) {
8377 omtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
8378 } else
8379 omtu = 0;
8380 /* Here we do NOT factor the r_mtu */
8381 if ((chk->send_size <= (int)(mtu - omtu)) ||
8382 (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) {
8383 /*
8384 * We probably should glom the mbuf chain
8385 * from the chk->data for control but the
8386 * problem is it becomes yet one more level
8387 * of tracking to do if for some reason
8388 * output fails. Then I have got to
8389 * reconstruct the merged control chain.. el
8390 * yucko.. for now we take the easy way and
8391 * do the copy
8392 */
8393 /*
8394 * Add an AUTH chunk, if chunk requires it
8395 * save the offset into the chain for AUTH
8396 */
8397 if ((auth == NULL) &&
8398 (sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8399 stcb->asoc.peer_auth_chunks))) {
8400 outchain = sctp_add_auth_chunk(outchain,
8401 &endoutchain,
8402 &auth,
8403 &auth_offset,
8404 stcb,
8405 chk->rec.chunk_id.id);
8406 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8407 }
8408 outchain = sctp_copy_mbufchain(chk->data, outchain, &endoutchain,
8409 (int)chk->rec.chunk_id.can_take_data,
8410 chk->send_size, chk->copy_by_ref);
8411 if (outchain == NULL) {
8412 *reason_code = 8;
8413 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
8414 return (ENOMEM);
8415 }
8416 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8417 /* update our MTU size */
8418 if (mtu > (chk->send_size + omtu))
8419 mtu -= (chk->send_size + omtu);
8420 else
8421 mtu = 0;
8422 to_out += (chk->send_size + omtu);
8423 /* Do clear IP_DF ? */
8424 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
8425 no_fragmentflg = 0;
8426 }
8427 if (chk->rec.chunk_id.can_take_data)
8428 chk->data = NULL;
8429 /* Mark things to be removed, if needed */
8430 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
8431 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK) || /* EY */
8432 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_REQUEST) ||
8433 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_ACK) ||
8434 (chk->rec.chunk_id.id == SCTP_SHUTDOWN) ||
8435 (chk->rec.chunk_id.id == SCTP_SHUTDOWN_ACK) ||
8436 (chk->rec.chunk_id.id == SCTP_OPERATION_ERROR) ||
8437 (chk->rec.chunk_id.id == SCTP_COOKIE_ACK) ||
8438 (chk->rec.chunk_id.id == SCTP_ECN_CWR) ||
8439 (chk->rec.chunk_id.id == SCTP_PACKET_DROPPED) ||
8440 (chk->rec.chunk_id.id == SCTP_ASCONF_ACK)) {
8441 if (chk->rec.chunk_id.id == SCTP_HEARTBEAT_REQUEST) {
8442 hbflag = 1;
8443 }
8444 /* remove these chunks at the end */
8445 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
8446 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK)) {
8447 /* turn off the timer */
8448 if (SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
8449 sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
8450 inp, stcb, net,
8451 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_1);
8452 }
8453 }
8454 ctl_cnt++;
8455 } else {
8456 /*
8457 * Other chunks, since they have
8458 * timers running (i.e. COOKIE) we
8459 * just "trust" that it gets sent or
8460 * retransmitted.
8461 */
8462 ctl_cnt++;
8463 if (chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) {
8464 cookie = 1;
8465 no_out_cnt = 1;
8466 } else if (chk->rec.chunk_id.id == SCTP_ECN_ECHO) {
8467 /*
8468 * Increment ecne send count
8469 * here this means we may be
8470 * over-zealous in our
8471 * counting if the send
8472 * fails, but its the best
8473 * place to do it (we used
8474 * to do it in the queue of
8475 * the chunk, but that did
8476 * not tell how many times
8477 * it was sent.
8478 */
8479 SCTP_STAT_INCR(sctps_sendecne);
8480 }
8481 chk->sent = SCTP_DATAGRAM_SENT;
8482 if (chk->whoTo == NULL) {
8483 chk->whoTo = net;
8484 atomic_add_int(&net->ref_count, 1);
8485 }
8486 chk->snd_count++;
8487 }
8488 if (mtu == 0) {
8489 /*
8490 * Ok we are out of room but we can
8491 * output without effecting the
8492 * flight size since this little guy
8493 * is a control only packet.
8494 */
8495 if (asconf) {
8496 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, net);
8497 /*
8498 * do NOT clear the asconf
8499 * flag as it is used to do
8500 * appropriate source
8501 * address selection.
8502 */
8503 }
8504 if (cookie) {
8505 sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, net);
8506 cookie = 0;
8507 }
8508 /* Only HB or ASCONF advances time */
8509 if (hbflag) {
8510 if (*now_filled == 0) {
8511 (void)SCTP_GETTIME_TIMEVAL(now);
8512 *now_filled = 1;
8513 }
8514 net->last_sent_time = *now;
8515 hbflag = 0;
8516 }
8517 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
8518 (struct sockaddr *)&net->ro._l_addr,
8519 outchain,
8520 auth_offset, auth,
8521 stcb->asoc.authinfo.active_keyid,
8522 no_fragmentflg, 0, asconf,
8523 inp->sctp_lport, stcb->rport,
8524 htonl(stcb->asoc.peer_vtag),
8525 net->port, NULL,
8526 0, 0,
8527 so_locked))) {
8528 /*
8529 * error, we could not
8530 * output
8531 */
8532 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
8533 if (from_where == 0) {
8534 SCTP_STAT_INCR(sctps_lowlevelerrusr);
8535 }
8536 if (error == ENOBUFS) {
8537 asoc->ifp_had_enobuf = 1;
8538 SCTP_STAT_INCR(sctps_lowlevelerr);
8539 }
8540 if (error == EHOSTUNREACH) {
8541 /*
8542 * Destination went
8543 * unreachable
8544 * during this send
8545 */
8546 sctp_move_chunks_from_net(stcb, net);
8547 }
8548 *reason_code = 7;
8549 break;
8550 } else {
8551 asoc->ifp_had_enobuf = 0;
8552 }
8553 /*
8554 * increase the number we sent, if a
8555 * cookie is sent we don't tell them
8556 * any was sent out.
8557 */
8558 outchain = endoutchain = NULL;
8559 auth = NULL;
8560 auth_offset = 0;
8561 if (!no_out_cnt)
8562 *num_out += ctl_cnt;
8563 /* recalc a clean slate and setup */
8564 switch (net->ro._l_addr.sa.sa_family) {
8565 #ifdef INET
8566 case AF_INET:
8567 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8568 break;
8569 #endif
8570 #ifdef INET6
8571 case AF_INET6:
8572 mtu = net->mtu - SCTP_MIN_OVERHEAD;
8573 break;
8574 #endif
8575 default:
8576 /* TSNH */
8577 mtu = net->mtu;
8578 break;
8579 }
8580 to_out = 0;
8581 no_fragmentflg = 1;
8582 }
8583 }
8584 }
8585 if (error != 0) {
8586 /* try next net */
8587 continue;
8588 }
8589 /* JRI: if dest is in PF state, do not send data to it */
8590 if ((asoc->sctp_cmt_on_off > 0) &&
8591 (net != stcb->asoc.alternate) &&
8592 (net->dest_state & SCTP_ADDR_PF)) {
8593 goto no_data_fill;
8594 }
8595 if (net->flight_size >= net->cwnd) {
8596 goto no_data_fill;
8597 }
8598 if ((asoc->sctp_cmt_on_off > 0) &&
8599 (SCTP_BASE_SYSCTL(sctp_buffer_splitting) & SCTP_RECV_BUFFER_SPLITTING) &&
8600 (net->flight_size > max_rwnd_per_dest)) {
8601 goto no_data_fill;
8602 }
8603 /*
8604 * We need a specific accounting for the usage of the send
8605 * buffer. We also need to check the number of messages per
8606 * net. For now, this is better than nothing and it disabled
8607 * by default...
8608 */
8609 if ((asoc->sctp_cmt_on_off > 0) &&
8610 (SCTP_BASE_SYSCTL(sctp_buffer_splitting) & SCTP_SEND_BUFFER_SPLITTING) &&
8611 (max_send_per_dest > 0) &&
8612 (net->flight_size > max_send_per_dest)) {
8613 goto no_data_fill;
8614 }
8615 /*********************/
8616 /* Data transmission */
8617 /*********************/
8618 /*
8619 * if AUTH for DATA is required and no AUTH has been added
8620 * yet, account for this in the mtu now... if no data can be
8621 * bundled, this adjustment won't matter anyways since the
8622 * packet will be going out...
8623 */
8624 data_auth_reqd = sctp_auth_is_required_chunk(SCTP_DATA,
8625 stcb->asoc.peer_auth_chunks);
8626 if (data_auth_reqd && (auth == NULL)) {
8627 mtu -= sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
8628 }
8629 /* now lets add any data within the MTU constraints */
8630 switch (((struct sockaddr *)&net->ro._l_addr)->sa_family) {
8631 #ifdef INET
8632 case AF_INET:
8633 if (net->mtu > SCTP_MIN_V4_OVERHEAD)
8634 omtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8635 else
8636 omtu = 0;
8637 break;
8638 #endif
8639 #ifdef INET6
8640 case AF_INET6:
8641 if (net->mtu > SCTP_MIN_OVERHEAD)
8642 omtu = net->mtu - SCTP_MIN_OVERHEAD;
8643 else
8644 omtu = 0;
8645 break;
8646 #endif
8647 default:
8648 /* TSNH */
8649 omtu = 0;
8650 break;
8651 }
8652 if ((((SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) ||
8653 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED)) &&
8654 (skip_data_for_this_net == 0)) ||
8655 (cookie)) {
8656 TAILQ_FOREACH_SAFE(chk, &asoc->send_queue, sctp_next, nchk) {
8657 if (no_data_chunks) {
8658 /* let only control go out */
8659 *reason_code = 1;
8660 break;
8661 }
8662 if (net->flight_size >= net->cwnd) {
8663 /* skip this net, no room for data */
8664 *reason_code = 2;
8665 break;
8666 }
8667 if ((chk->whoTo != NULL) &&
8668 (chk->whoTo != net)) {
8669 /* Don't send the chunk on this net */
8670 continue;
8671 }
8672
8673 if (asoc->sctp_cmt_on_off == 0) {
8674 if ((asoc->alternate) &&
8675 (asoc->alternate != net) &&
8676 (chk->whoTo == NULL)) {
8677 continue;
8678 } else if ((net != asoc->primary_destination) &&
8679 (asoc->alternate == NULL) &&
8680 (chk->whoTo == NULL)) {
8681 continue;
8682 }
8683 }
8684 if ((chk->send_size > omtu) && ((chk->flags & CHUNK_FLAGS_FRAGMENT_OK) == 0)) {
8685 /*-
8686 * strange, we have a chunk that is
8687 * to big for its destination and
8688 * yet no fragment ok flag.
8689 * Something went wrong when the
8690 * PMTU changed...we did not mark
8691 * this chunk for some reason?? I
8692 * will fix it here by letting IP
8693 * fragment it for now and printing
8694 * a warning. This really should not
8695 * happen ...
8696 */
8697 SCTP_PRINTF("Warning chunk of %d bytes > mtu:%d and yet PMTU disc missed\n",
8698 chk->send_size, mtu);
8699 chk->flags |= CHUNK_FLAGS_FRAGMENT_OK;
8700 }
8701 if (SCTP_BASE_SYSCTL(sctp_enable_sack_immediately) &&
8702 (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) {
8703 struct sctp_data_chunk *dchkh;
8704
8705 dchkh = mtod(chk->data, struct sctp_data_chunk *);
8706 dchkh->ch.chunk_flags |= SCTP_DATA_SACK_IMMEDIATELY;
8707 }
8708 if (((chk->send_size <= mtu) && (chk->send_size <= r_mtu)) ||
8709 ((chk->flags & CHUNK_FLAGS_FRAGMENT_OK) && (chk->send_size <= asoc->peers_rwnd))) {
8710 /* ok we will add this one */
8711
8712 /*
8713 * Add an AUTH chunk, if chunk
8714 * requires it, save the offset into
8715 * the chain for AUTH
8716 */
8717 if (data_auth_reqd) {
8718 if (auth == NULL) {
8719 outchain = sctp_add_auth_chunk(outchain,
8720 &endoutchain,
8721 &auth,
8722 &auth_offset,
8723 stcb,
8724 SCTP_DATA);
8725 auth_keyid = chk->auth_keyid;
8726 override_ok = 0;
8727 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8728 } else if (override_ok) {
8729 /*
8730 * use this data's
8731 * keyid
8732 */
8733 auth_keyid = chk->auth_keyid;
8734 override_ok = 0;
8735 } else if (auth_keyid != chk->auth_keyid) {
8736 /*
8737 * different keyid,
8738 * so done bundling
8739 */
8740 break;
8741 }
8742 }
8743 outchain = sctp_copy_mbufchain(chk->data, outchain, &endoutchain, 0,
8744 chk->send_size, chk->copy_by_ref);
8745 if (outchain == NULL) {
8746 SCTPDBG(SCTP_DEBUG_OUTPUT3, "No memory?\n");
8747 if (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
8748 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
8749 }
8750 *reason_code = 3;
8751 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
8752 return (ENOMEM);
8753 }
8754 /* upate our MTU size */
8755 /* Do clear IP_DF ? */
8756 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
8757 no_fragmentflg = 0;
8758 }
8759 /* unsigned subtraction of mtu */
8760 if (mtu > chk->send_size)
8761 mtu -= chk->send_size;
8762 else
8763 mtu = 0;
8764 /* unsigned subtraction of r_mtu */
8765 if (r_mtu > chk->send_size)
8766 r_mtu -= chk->send_size;
8767 else
8768 r_mtu = 0;
8769
8770 to_out += chk->send_size;
8771 if ((to_out > mx_mtu) && no_fragmentflg) {
8772 #ifdef INVARIANTS
8773 panic("Exceeding mtu of %d out size is %d", mx_mtu, to_out);
8774 #else
8775 SCTP_PRINTF("Exceeding mtu of %d out size is %d\n",
8776 mx_mtu, to_out);
8777 #endif
8778 }
8779 chk->window_probe = 0;
8780 data_list[bundle_at++] = chk;
8781 if (bundle_at >= SCTP_MAX_DATA_BUNDLING) {
8782 break;
8783 }
8784 if (chk->sent == SCTP_DATAGRAM_UNSENT) {
8785 if ((chk->rec.data.rcv_flags & SCTP_DATA_UNORDERED) == 0) {
8786 SCTP_STAT_INCR_COUNTER64(sctps_outorderchunks);
8787 } else {
8788 SCTP_STAT_INCR_COUNTER64(sctps_outunorderchunks);
8789 }
8790 if (((chk->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG) == SCTP_DATA_LAST_FRAG) &&
8791 ((chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) == 0))
8792 /*
8793 * Count number of
8794 * user msg's that
8795 * were fragmented
8796 * we do this by
8797 * counting when we
8798 * see a LAST
8799 * fragment only.
8800 */
8801 SCTP_STAT_INCR_COUNTER64(sctps_fragusrmsgs);
8802 }
8803 if ((mtu == 0) || (r_mtu == 0) || (one_chunk)) {
8804 if ((one_chunk) && (stcb->asoc.total_flight == 0)) {
8805 data_list[0]->window_probe = 1;
8806 net->window_probe = 1;
8807 }
8808 break;
8809 }
8810 } else {
8811 /*
8812 * Must be sent in order of the
8813 * TSN's (on a network)
8814 */
8815 break;
8816 }
8817 } /* for (chunk gather loop for this net) */
8818 } /* if asoc.state OPEN */
8819 no_data_fill:
8820 /* Is there something to send for this destination? */
8821 if (outchain) {
8822 /* We may need to start a control timer or two */
8823 if (asconf) {
8824 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp,
8825 stcb, net);
8826 /*
8827 * do NOT clear the asconf flag as it is
8828 * used to do appropriate source address
8829 * selection.
8830 */
8831 }
8832 if (cookie) {
8833 sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, net);
8834 cookie = 0;
8835 }
8836 /* must start a send timer if data is being sent */
8837 if (bundle_at && (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer))) {
8838 /*
8839 * no timer running on this destination
8840 * restart it.
8841 */
8842 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
8843 }
8844 if (bundle_at || hbflag) {
8845 /* For data/asconf and hb set time */
8846 if (*now_filled == 0) {
8847 (void)SCTP_GETTIME_TIMEVAL(now);
8848 *now_filled = 1;
8849 }
8850 net->last_sent_time = *now;
8851 }
8852 /* Now send it, if there is anything to send :> */
8853 if ((error = sctp_lowlevel_chunk_output(inp,
8854 stcb,
8855 net,
8856 (struct sockaddr *)&net->ro._l_addr,
8857 outchain,
8858 auth_offset,
8859 auth,
8860 auth_keyid,
8861 no_fragmentflg,
8862 bundle_at,
8863 asconf,
8864 inp->sctp_lport, stcb->rport,
8865 htonl(stcb->asoc.peer_vtag),
8866 net->port, NULL,
8867 0, 0,
8868 so_locked))) {
8869 /* error, we could not output */
8870 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
8871 if (from_where == 0) {
8872 SCTP_STAT_INCR(sctps_lowlevelerrusr);
8873 }
8874 if (error == ENOBUFS) {
8875 asoc->ifp_had_enobuf = 1;
8876 SCTP_STAT_INCR(sctps_lowlevelerr);
8877 }
8878 if (error == EHOSTUNREACH) {
8879 /*
8880 * Destination went unreachable
8881 * during this send
8882 */
8883 sctp_move_chunks_from_net(stcb, net);
8884 }
8885 *reason_code = 6;
8886 /*-
8887 * I add this line to be paranoid. As far as
8888 * I can tell the continue, takes us back to
8889 * the top of the for, but just to make sure
8890 * I will reset these again here.
8891 */
8892 ctl_cnt = bundle_at = 0;
8893 continue; /* This takes us back to the
8894 * for() for the nets. */
8895 } else {
8896 asoc->ifp_had_enobuf = 0;
8897 }
8898 endoutchain = NULL;
8899 auth = NULL;
8900 auth_offset = 0;
8901 if (!no_out_cnt) {
8902 *num_out += (ctl_cnt + bundle_at);
8903 }
8904 if (bundle_at) {
8905 /* setup for a RTO measurement */
8906 tsns_sent = data_list[0]->rec.data.tsn;
8907 /* fill time if not already filled */
8908 if (*now_filled == 0) {
8909 (void)SCTP_GETTIME_TIMEVAL(&asoc->time_last_sent);
8910 *now_filled = 1;
8911 *now = asoc->time_last_sent;
8912 } else {
8913 asoc->time_last_sent = *now;
8914 }
8915 if (net->rto_needed) {
8916 data_list[0]->do_rtt = 1;
8917 net->rto_needed = 0;
8918 }
8919 SCTP_STAT_INCR_BY(sctps_senddata, bundle_at);
8920 sctp_clean_up_datalist(stcb, asoc, data_list, bundle_at, net);
8921 }
8922 if (one_chunk) {
8923 break;
8924 }
8925 }
8926 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
8927 sctp_log_cwnd(stcb, net, tsns_sent, SCTP_CWND_LOG_FROM_SEND);
8928 }
8929 }
8930 if (old_start_at == NULL) {
8931 old_start_at = start_at;
8932 start_at = TAILQ_FIRST(&asoc->nets);
8933 if (old_start_at)
8934 goto again_one_more_time;
8935 }
8936
8937 /*
8938 * At the end there should be no NON timed chunks hanging on this
8939 * queue.
8940 */
8941 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
8942 sctp_log_cwnd(stcb, net, *num_out, SCTP_CWND_LOG_FROM_SEND);
8943 }
8944 if ((*num_out == 0) && (*reason_code == 0)) {
8945 *reason_code = 4;
8946 } else {
8947 *reason_code = 5;
8948 }
8949 sctp_clean_up_ctl(stcb, asoc, so_locked);
8950 return (0);
8951 }
8952
8953 void
sctp_queue_op_err(struct sctp_tcb * stcb,struct mbuf * op_err)8954 sctp_queue_op_err(struct sctp_tcb *stcb, struct mbuf *op_err)
8955 {
8956 /*-
8957 * Prepend a OPERATIONAL_ERROR chunk header and put on the end of
8958 * the control chunk queue.
8959 */
8960 struct sctp_chunkhdr *hdr;
8961 struct sctp_tmit_chunk *chk;
8962 struct mbuf *mat, *last_mbuf;
8963 uint32_t chunk_length;
8964 uint16_t padding_length;
8965
8966 SCTP_TCB_LOCK_ASSERT(stcb);
8967 SCTP_BUF_PREPEND(op_err, sizeof(struct sctp_chunkhdr), M_NOWAIT);
8968 if (op_err == NULL) {
8969 return;
8970 }
8971 last_mbuf = NULL;
8972 chunk_length = 0;
8973 for (mat = op_err; mat != NULL; mat = SCTP_BUF_NEXT(mat)) {
8974 chunk_length += SCTP_BUF_LEN(mat);
8975 if (SCTP_BUF_NEXT(mat) == NULL) {
8976 last_mbuf = mat;
8977 }
8978 }
8979 if (chunk_length > SCTP_MAX_CHUNK_LENGTH) {
8980 sctp_m_freem(op_err);
8981 return;
8982 }
8983 padding_length = chunk_length % 4;
8984 if (padding_length != 0) {
8985 padding_length = 4 - padding_length;
8986 }
8987 if (padding_length != 0) {
8988 if (sctp_add_pad_tombuf(last_mbuf, padding_length) == NULL) {
8989 sctp_m_freem(op_err);
8990 return;
8991 }
8992 }
8993 sctp_alloc_a_chunk(stcb, chk);
8994 if (chk == NULL) {
8995 /* no memory */
8996 sctp_m_freem(op_err);
8997 return;
8998 }
8999 chk->copy_by_ref = 0;
9000 chk->rec.chunk_id.id = SCTP_OPERATION_ERROR;
9001 chk->rec.chunk_id.can_take_data = 0;
9002 chk->flags = 0;
9003 chk->send_size = (uint16_t)chunk_length;
9004 chk->sent = SCTP_DATAGRAM_UNSENT;
9005 chk->snd_count = 0;
9006 chk->asoc = &stcb->asoc;
9007 chk->data = op_err;
9008 chk->whoTo = NULL;
9009 hdr = mtod(op_err, struct sctp_chunkhdr *);
9010 hdr->chunk_type = SCTP_OPERATION_ERROR;
9011 hdr->chunk_flags = 0;
9012 hdr->chunk_length = htons(chk->send_size);
9013 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9014 chk->asoc->ctrl_queue_cnt++;
9015 }
9016
9017 int
sctp_send_cookie_echo(struct mbuf * m,int offset,int limit,struct sctp_tcb * stcb,struct sctp_nets * net)9018 sctp_send_cookie_echo(struct mbuf *m,
9019 int offset, int limit,
9020 struct sctp_tcb *stcb,
9021 struct sctp_nets *net)
9022 {
9023 /*-
9024 * pull out the cookie and put it at the front of the control chunk
9025 * queue.
9026 */
9027 int at;
9028 struct mbuf *cookie;
9029 struct sctp_paramhdr param, *phdr;
9030 struct sctp_chunkhdr *hdr;
9031 struct sctp_tmit_chunk *chk;
9032 uint16_t ptype, plen;
9033
9034 SCTP_TCB_LOCK_ASSERT(stcb);
9035 /* First find the cookie in the param area */
9036 cookie = NULL;
9037 at = offset + sizeof(struct sctp_init_chunk);
9038 for (;;) {
9039 phdr = sctp_get_next_param(m, at, ¶m, sizeof(param));
9040 if (phdr == NULL) {
9041 return (-3);
9042 }
9043 ptype = ntohs(phdr->param_type);
9044 plen = ntohs(phdr->param_length);
9045 if (plen < sizeof(struct sctp_paramhdr)) {
9046 return (-6);
9047 }
9048 if (ptype == SCTP_STATE_COOKIE) {
9049 int pad;
9050
9051 /* found the cookie */
9052 if (at + plen > limit) {
9053 return (-7);
9054 }
9055 cookie = SCTP_M_COPYM(m, at, plen, M_NOWAIT);
9056 if (cookie == NULL) {
9057 /* No memory */
9058 return (-2);
9059 }
9060 if ((pad = (plen % 4)) > 0) {
9061 pad = 4 - pad;
9062 }
9063 if (pad > 0) {
9064 if (sctp_pad_lastmbuf(cookie, pad, NULL) == NULL) {
9065 return (-8);
9066 }
9067 }
9068 #ifdef SCTP_MBUF_LOGGING
9069 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
9070 sctp_log_mbc(cookie, SCTP_MBUF_ICOPY);
9071 }
9072 #endif
9073 break;
9074 }
9075 at += SCTP_SIZE32(plen);
9076 }
9077 /* ok, we got the cookie lets change it into a cookie echo chunk */
9078 /* first the change from param to cookie */
9079 hdr = mtod(cookie, struct sctp_chunkhdr *);
9080 hdr->chunk_type = SCTP_COOKIE_ECHO;
9081 hdr->chunk_flags = 0;
9082 /* get the chunk stuff now and place it in the FRONT of the queue */
9083 sctp_alloc_a_chunk(stcb, chk);
9084 if (chk == NULL) {
9085 /* no memory */
9086 sctp_m_freem(cookie);
9087 return (-5);
9088 }
9089 chk->copy_by_ref = 0;
9090 chk->rec.chunk_id.id = SCTP_COOKIE_ECHO;
9091 chk->rec.chunk_id.can_take_data = 0;
9092 chk->flags = CHUNK_FLAGS_FRAGMENT_OK;
9093 chk->send_size = SCTP_SIZE32(plen);
9094 chk->sent = SCTP_DATAGRAM_UNSENT;
9095 chk->snd_count = 0;
9096 chk->asoc = &stcb->asoc;
9097 chk->data = cookie;
9098 chk->whoTo = net;
9099 atomic_add_int(&chk->whoTo->ref_count, 1);
9100 TAILQ_INSERT_HEAD(&chk->asoc->control_send_queue, chk, sctp_next);
9101 chk->asoc->ctrl_queue_cnt++;
9102 return (0);
9103 }
9104
9105 void
sctp_send_heartbeat_ack(struct sctp_tcb * stcb,struct mbuf * m,int offset,int chk_length,struct sctp_nets * net)9106 sctp_send_heartbeat_ack(struct sctp_tcb *stcb,
9107 struct mbuf *m,
9108 int offset,
9109 int chk_length,
9110 struct sctp_nets *net)
9111 {
9112 /*
9113 * take a HB request and make it into a HB ack and send it.
9114 */
9115 struct mbuf *outchain;
9116 struct sctp_chunkhdr *chdr;
9117 struct sctp_tmit_chunk *chk;
9118
9119 if (net == NULL)
9120 /* must have a net pointer */
9121 return;
9122
9123 outchain = SCTP_M_COPYM(m, offset, chk_length, M_NOWAIT);
9124 if (outchain == NULL) {
9125 /* gak out of memory */
9126 return;
9127 }
9128 #ifdef SCTP_MBUF_LOGGING
9129 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
9130 sctp_log_mbc(outchain, SCTP_MBUF_ICOPY);
9131 }
9132 #endif
9133 chdr = mtod(outchain, struct sctp_chunkhdr *);
9134 chdr->chunk_type = SCTP_HEARTBEAT_ACK;
9135 chdr->chunk_flags = 0;
9136 if (chk_length % 4 != 0) {
9137 sctp_pad_lastmbuf(outchain, 4 - (chk_length % 4), NULL);
9138 }
9139 sctp_alloc_a_chunk(stcb, chk);
9140 if (chk == NULL) {
9141 /* no memory */
9142 sctp_m_freem(outchain);
9143 return;
9144 }
9145 chk->copy_by_ref = 0;
9146 chk->rec.chunk_id.id = SCTP_HEARTBEAT_ACK;
9147 chk->rec.chunk_id.can_take_data = 1;
9148 chk->flags = 0;
9149 chk->send_size = chk_length;
9150 chk->sent = SCTP_DATAGRAM_UNSENT;
9151 chk->snd_count = 0;
9152 chk->asoc = &stcb->asoc;
9153 chk->data = outchain;
9154 chk->whoTo = net;
9155 atomic_add_int(&chk->whoTo->ref_count, 1);
9156 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9157 chk->asoc->ctrl_queue_cnt++;
9158 }
9159
9160 void
sctp_send_cookie_ack(struct sctp_tcb * stcb)9161 sctp_send_cookie_ack(struct sctp_tcb *stcb)
9162 {
9163 /* formulate and queue a cookie-ack back to sender */
9164 struct mbuf *cookie_ack;
9165 struct sctp_chunkhdr *hdr;
9166 struct sctp_tmit_chunk *chk;
9167
9168 SCTP_TCB_LOCK_ASSERT(stcb);
9169
9170 cookie_ack = sctp_get_mbuf_for_msg(sizeof(struct sctp_chunkhdr), 0, M_NOWAIT, 1, MT_HEADER);
9171 if (cookie_ack == NULL) {
9172 /* no mbuf's */
9173 return;
9174 }
9175 SCTP_BUF_RESV_UF(cookie_ack, SCTP_MIN_OVERHEAD);
9176 sctp_alloc_a_chunk(stcb, chk);
9177 if (chk == NULL) {
9178 /* no memory */
9179 sctp_m_freem(cookie_ack);
9180 return;
9181 }
9182 chk->copy_by_ref = 0;
9183 chk->rec.chunk_id.id = SCTP_COOKIE_ACK;
9184 chk->rec.chunk_id.can_take_data = 1;
9185 chk->flags = 0;
9186 chk->send_size = sizeof(struct sctp_chunkhdr);
9187 chk->sent = SCTP_DATAGRAM_UNSENT;
9188 chk->snd_count = 0;
9189 chk->asoc = &stcb->asoc;
9190 chk->data = cookie_ack;
9191 if (chk->asoc->last_control_chunk_from != NULL) {
9192 chk->whoTo = chk->asoc->last_control_chunk_from;
9193 atomic_add_int(&chk->whoTo->ref_count, 1);
9194 } else {
9195 chk->whoTo = NULL;
9196 }
9197 hdr = mtod(cookie_ack, struct sctp_chunkhdr *);
9198 hdr->chunk_type = SCTP_COOKIE_ACK;
9199 hdr->chunk_flags = 0;
9200 hdr->chunk_length = htons(chk->send_size);
9201 SCTP_BUF_LEN(cookie_ack) = chk->send_size;
9202 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9203 chk->asoc->ctrl_queue_cnt++;
9204 return;
9205 }
9206
9207
9208 void
sctp_send_shutdown_ack(struct sctp_tcb * stcb,struct sctp_nets * net)9209 sctp_send_shutdown_ack(struct sctp_tcb *stcb, struct sctp_nets *net)
9210 {
9211 /* formulate and queue a SHUTDOWN-ACK back to the sender */
9212 struct mbuf *m_shutdown_ack;
9213 struct sctp_shutdown_ack_chunk *ack_cp;
9214 struct sctp_tmit_chunk *chk;
9215
9216 m_shutdown_ack = sctp_get_mbuf_for_msg(sizeof(struct sctp_shutdown_ack_chunk), 0, M_NOWAIT, 1, MT_HEADER);
9217 if (m_shutdown_ack == NULL) {
9218 /* no mbuf's */
9219 return;
9220 }
9221 SCTP_BUF_RESV_UF(m_shutdown_ack, SCTP_MIN_OVERHEAD);
9222 sctp_alloc_a_chunk(stcb, chk);
9223 if (chk == NULL) {
9224 /* no memory */
9225 sctp_m_freem(m_shutdown_ack);
9226 return;
9227 }
9228 chk->copy_by_ref = 0;
9229 chk->rec.chunk_id.id = SCTP_SHUTDOWN_ACK;
9230 chk->rec.chunk_id.can_take_data = 1;
9231 chk->flags = 0;
9232 chk->send_size = sizeof(struct sctp_chunkhdr);
9233 chk->sent = SCTP_DATAGRAM_UNSENT;
9234 chk->snd_count = 0;
9235 chk->asoc = &stcb->asoc;
9236 chk->data = m_shutdown_ack;
9237 chk->whoTo = net;
9238 if (chk->whoTo) {
9239 atomic_add_int(&chk->whoTo->ref_count, 1);
9240 }
9241 ack_cp = mtod(m_shutdown_ack, struct sctp_shutdown_ack_chunk *);
9242 ack_cp->ch.chunk_type = SCTP_SHUTDOWN_ACK;
9243 ack_cp->ch.chunk_flags = 0;
9244 ack_cp->ch.chunk_length = htons(chk->send_size);
9245 SCTP_BUF_LEN(m_shutdown_ack) = chk->send_size;
9246 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9247 chk->asoc->ctrl_queue_cnt++;
9248 return;
9249 }
9250
9251 void
sctp_send_shutdown(struct sctp_tcb * stcb,struct sctp_nets * net)9252 sctp_send_shutdown(struct sctp_tcb *stcb, struct sctp_nets *net)
9253 {
9254 /* formulate and queue a SHUTDOWN to the sender */
9255 struct mbuf *m_shutdown;
9256 struct sctp_shutdown_chunk *shutdown_cp;
9257 struct sctp_tmit_chunk *chk;
9258
9259 TAILQ_FOREACH(chk, &stcb->asoc.control_send_queue, sctp_next) {
9260 if (chk->rec.chunk_id.id == SCTP_SHUTDOWN) {
9261 /* We already have a SHUTDOWN queued. Reuse it. */
9262 if (chk->whoTo) {
9263 sctp_free_remote_addr(chk->whoTo);
9264 chk->whoTo = NULL;
9265 }
9266 break;
9267 }
9268 }
9269 if (chk == NULL) {
9270 m_shutdown = sctp_get_mbuf_for_msg(sizeof(struct sctp_shutdown_chunk), 0, M_NOWAIT, 1, MT_HEADER);
9271 if (m_shutdown == NULL) {
9272 /* no mbuf's */
9273 return;
9274 }
9275 SCTP_BUF_RESV_UF(m_shutdown, SCTP_MIN_OVERHEAD);
9276 sctp_alloc_a_chunk(stcb, chk);
9277 if (chk == NULL) {
9278 /* no memory */
9279 sctp_m_freem(m_shutdown);
9280 return;
9281 }
9282 chk->copy_by_ref = 0;
9283 chk->rec.chunk_id.id = SCTP_SHUTDOWN;
9284 chk->rec.chunk_id.can_take_data = 1;
9285 chk->flags = 0;
9286 chk->send_size = sizeof(struct sctp_shutdown_chunk);
9287 chk->sent = SCTP_DATAGRAM_UNSENT;
9288 chk->snd_count = 0;
9289 chk->asoc = &stcb->asoc;
9290 chk->data = m_shutdown;
9291 chk->whoTo = net;
9292 if (chk->whoTo) {
9293 atomic_add_int(&chk->whoTo->ref_count, 1);
9294 }
9295 shutdown_cp = mtod(m_shutdown, struct sctp_shutdown_chunk *);
9296 shutdown_cp->ch.chunk_type = SCTP_SHUTDOWN;
9297 shutdown_cp->ch.chunk_flags = 0;
9298 shutdown_cp->ch.chunk_length = htons(chk->send_size);
9299 shutdown_cp->cumulative_tsn_ack = htonl(stcb->asoc.cumulative_tsn);
9300 SCTP_BUF_LEN(m_shutdown) = chk->send_size;
9301 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9302 chk->asoc->ctrl_queue_cnt++;
9303 } else {
9304 TAILQ_REMOVE(&stcb->asoc.control_send_queue, chk, sctp_next);
9305 chk->whoTo = net;
9306 if (chk->whoTo) {
9307 atomic_add_int(&chk->whoTo->ref_count, 1);
9308 }
9309 shutdown_cp = mtod(chk->data, struct sctp_shutdown_chunk *);
9310 shutdown_cp->cumulative_tsn_ack = htonl(stcb->asoc.cumulative_tsn);
9311 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
9312 }
9313 return;
9314 }
9315
9316 void
sctp_send_asconf(struct sctp_tcb * stcb,struct sctp_nets * net,int addr_locked)9317 sctp_send_asconf(struct sctp_tcb *stcb, struct sctp_nets *net, int addr_locked)
9318 {
9319 /*
9320 * formulate and queue an ASCONF to the peer. ASCONF parameters
9321 * should be queued on the assoc queue.
9322 */
9323 struct sctp_tmit_chunk *chk;
9324 struct mbuf *m_asconf;
9325 int len;
9326
9327 SCTP_TCB_LOCK_ASSERT(stcb);
9328
9329 if ((!TAILQ_EMPTY(&stcb->asoc.asconf_send_queue)) &&
9330 (!sctp_is_feature_on(stcb->sctp_ep, SCTP_PCB_FLAGS_MULTIPLE_ASCONFS))) {
9331 /* can't send a new one if there is one in flight already */
9332 return;
9333 }
9334
9335 /* compose an ASCONF chunk, maximum length is PMTU */
9336 m_asconf = sctp_compose_asconf(stcb, &len, addr_locked);
9337 if (m_asconf == NULL) {
9338 return;
9339 }
9340
9341 sctp_alloc_a_chunk(stcb, chk);
9342 if (chk == NULL) {
9343 /* no memory */
9344 sctp_m_freem(m_asconf);
9345 return;
9346 }
9347
9348 chk->copy_by_ref = 0;
9349 chk->rec.chunk_id.id = SCTP_ASCONF;
9350 chk->rec.chunk_id.can_take_data = 0;
9351 chk->flags = CHUNK_FLAGS_FRAGMENT_OK;
9352 chk->data = m_asconf;
9353 chk->send_size = len;
9354 chk->sent = SCTP_DATAGRAM_UNSENT;
9355 chk->snd_count = 0;
9356 chk->asoc = &stcb->asoc;
9357 chk->whoTo = net;
9358 if (chk->whoTo) {
9359 atomic_add_int(&chk->whoTo->ref_count, 1);
9360 }
9361 TAILQ_INSERT_TAIL(&chk->asoc->asconf_send_queue, chk, sctp_next);
9362 chk->asoc->ctrl_queue_cnt++;
9363 return;
9364 }
9365
9366 void
sctp_send_asconf_ack(struct sctp_tcb * stcb)9367 sctp_send_asconf_ack(struct sctp_tcb *stcb)
9368 {
9369 /*
9370 * formulate and queue a asconf-ack back to sender. the asconf-ack
9371 * must be stored in the tcb.
9372 */
9373 struct sctp_tmit_chunk *chk;
9374 struct sctp_asconf_ack *ack, *latest_ack;
9375 struct mbuf *m_ack;
9376 struct sctp_nets *net = NULL;
9377
9378 SCTP_TCB_LOCK_ASSERT(stcb);
9379 /* Get the latest ASCONF-ACK */
9380 latest_ack = TAILQ_LAST(&stcb->asoc.asconf_ack_sent, sctp_asconf_ackhead);
9381 if (latest_ack == NULL) {
9382 return;
9383 }
9384 if (latest_ack->last_sent_to != NULL &&
9385 latest_ack->last_sent_to == stcb->asoc.last_control_chunk_from) {
9386 /* we're doing a retransmission */
9387 net = sctp_find_alternate_net(stcb, stcb->asoc.last_control_chunk_from, 0);
9388 if (net == NULL) {
9389 /* no alternate */
9390 if (stcb->asoc.last_control_chunk_from == NULL) {
9391 if (stcb->asoc.alternate) {
9392 net = stcb->asoc.alternate;
9393 } else {
9394 net = stcb->asoc.primary_destination;
9395 }
9396 } else {
9397 net = stcb->asoc.last_control_chunk_from;
9398 }
9399 }
9400 } else {
9401 /* normal case */
9402 if (stcb->asoc.last_control_chunk_from == NULL) {
9403 if (stcb->asoc.alternate) {
9404 net = stcb->asoc.alternate;
9405 } else {
9406 net = stcb->asoc.primary_destination;
9407 }
9408 } else {
9409 net = stcb->asoc.last_control_chunk_from;
9410 }
9411 }
9412 latest_ack->last_sent_to = net;
9413
9414 TAILQ_FOREACH(ack, &stcb->asoc.asconf_ack_sent, next) {
9415 if (ack->data == NULL) {
9416 continue;
9417 }
9418
9419 /* copy the asconf_ack */
9420 m_ack = SCTP_M_COPYM(ack->data, 0, M_COPYALL, M_NOWAIT);
9421 if (m_ack == NULL) {
9422 /* couldn't copy it */
9423 return;
9424 }
9425 #ifdef SCTP_MBUF_LOGGING
9426 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
9427 sctp_log_mbc(m_ack, SCTP_MBUF_ICOPY);
9428 }
9429 #endif
9430
9431 sctp_alloc_a_chunk(stcb, chk);
9432 if (chk == NULL) {
9433 /* no memory */
9434 if (m_ack)
9435 sctp_m_freem(m_ack);
9436 return;
9437 }
9438 chk->copy_by_ref = 0;
9439 chk->rec.chunk_id.id = SCTP_ASCONF_ACK;
9440 chk->rec.chunk_id.can_take_data = 1;
9441 chk->flags = CHUNK_FLAGS_FRAGMENT_OK;
9442 chk->whoTo = net;
9443 if (chk->whoTo) {
9444 atomic_add_int(&chk->whoTo->ref_count, 1);
9445 }
9446 chk->data = m_ack;
9447 chk->send_size = ack->len;
9448 chk->sent = SCTP_DATAGRAM_UNSENT;
9449 chk->snd_count = 0;
9450 chk->asoc = &stcb->asoc;
9451
9452 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9453 chk->asoc->ctrl_queue_cnt++;
9454 }
9455 return;
9456 }
9457
9458
9459 static int
sctp_chunk_retransmission(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_association * asoc,int * cnt_out,struct timeval * now,int * now_filled,int * fr_done,int so_locked SCTP_UNUSED)9460 sctp_chunk_retransmission(struct sctp_inpcb *inp,
9461 struct sctp_tcb *stcb,
9462 struct sctp_association *asoc,
9463 int *cnt_out, struct timeval *now, int *now_filled, int *fr_done, int so_locked
9464 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
9465 SCTP_UNUSED
9466 #endif
9467 )
9468 {
9469 /*-
9470 * send out one MTU of retransmission. If fast_retransmit is
9471 * happening we ignore the cwnd. Otherwise we obey the cwnd and
9472 * rwnd. For a Cookie or Asconf in the control chunk queue we
9473 * retransmit them by themselves.
9474 *
9475 * For data chunks we will pick out the lowest TSN's in the sent_queue
9476 * marked for resend and bundle them all together (up to a MTU of
9477 * destination). The address to send to should have been
9478 * selected/changed where the retransmission was marked (i.e. in FR
9479 * or t3-timeout routines).
9480 */
9481 struct sctp_tmit_chunk *data_list[SCTP_MAX_DATA_BUNDLING];
9482 struct sctp_tmit_chunk *chk, *fwd;
9483 struct mbuf *m, *endofchain;
9484 struct sctp_nets *net = NULL;
9485 uint32_t tsns_sent = 0;
9486 int no_fragmentflg, bundle_at, cnt_thru;
9487 unsigned int mtu;
9488 int error, i, one_chunk, fwd_tsn, ctl_cnt, tmr_started;
9489 struct sctp_auth_chunk *auth = NULL;
9490 uint32_t auth_offset = 0;
9491 uint16_t auth_keyid;
9492 int override_ok = 1;
9493 int data_auth_reqd = 0;
9494 uint32_t dmtu = 0;
9495
9496 SCTP_TCB_LOCK_ASSERT(stcb);
9497 tmr_started = ctl_cnt = bundle_at = error = 0;
9498 no_fragmentflg = 1;
9499 fwd_tsn = 0;
9500 *cnt_out = 0;
9501 fwd = NULL;
9502 endofchain = m = NULL;
9503 auth_keyid = stcb->asoc.authinfo.active_keyid;
9504 #ifdef SCTP_AUDITING_ENABLED
9505 sctp_audit_log(0xC3, 1);
9506 #endif
9507 if ((TAILQ_EMPTY(&asoc->sent_queue)) &&
9508 (TAILQ_EMPTY(&asoc->control_send_queue))) {
9509 SCTPDBG(SCTP_DEBUG_OUTPUT1, "SCTP hits empty queue with cnt set to %d?\n",
9510 asoc->sent_queue_retran_cnt);
9511 asoc->sent_queue_cnt = 0;
9512 asoc->sent_queue_cnt_removeable = 0;
9513 /* send back 0/0 so we enter normal transmission */
9514 *cnt_out = 0;
9515 return (0);
9516 }
9517 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
9518 if ((chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) ||
9519 (chk->rec.chunk_id.id == SCTP_STREAM_RESET) ||
9520 (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN)) {
9521 if (chk->sent != SCTP_DATAGRAM_RESEND) {
9522 continue;
9523 }
9524 if (chk->rec.chunk_id.id == SCTP_STREAM_RESET) {
9525 if (chk != asoc->str_reset) {
9526 /*
9527 * not eligible for retran if its
9528 * not ours
9529 */
9530 continue;
9531 }
9532 }
9533 ctl_cnt++;
9534 if (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) {
9535 fwd_tsn = 1;
9536 }
9537 /*
9538 * Add an AUTH chunk, if chunk requires it save the
9539 * offset into the chain for AUTH
9540 */
9541 if ((auth == NULL) &&
9542 (sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
9543 stcb->asoc.peer_auth_chunks))) {
9544 m = sctp_add_auth_chunk(m, &endofchain,
9545 &auth, &auth_offset,
9546 stcb,
9547 chk->rec.chunk_id.id);
9548 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
9549 }
9550 m = sctp_copy_mbufchain(chk->data, m, &endofchain, 0, chk->send_size, chk->copy_by_ref);
9551 break;
9552 }
9553 }
9554 one_chunk = 0;
9555 cnt_thru = 0;
9556 /* do we have control chunks to retransmit? */
9557 if (m != NULL) {
9558 /* Start a timer no matter if we succeed or fail */
9559 if (chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) {
9560 sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, chk->whoTo);
9561 } else if (chk->rec.chunk_id.id == SCTP_ASCONF)
9562 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, chk->whoTo);
9563 chk->snd_count++; /* update our count */
9564 if ((error = sctp_lowlevel_chunk_output(inp, stcb, chk->whoTo,
9565 (struct sockaddr *)&chk->whoTo->ro._l_addr, m,
9566 auth_offset, auth, stcb->asoc.authinfo.active_keyid,
9567 no_fragmentflg, 0, 0,
9568 inp->sctp_lport, stcb->rport, htonl(stcb->asoc.peer_vtag),
9569 chk->whoTo->port, NULL,
9570 0, 0,
9571 so_locked))) {
9572 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
9573 if (error == ENOBUFS) {
9574 asoc->ifp_had_enobuf = 1;
9575 SCTP_STAT_INCR(sctps_lowlevelerr);
9576 }
9577 return (error);
9578 } else {
9579 asoc->ifp_had_enobuf = 0;
9580 }
9581 endofchain = NULL;
9582 auth = NULL;
9583 auth_offset = 0;
9584 /*
9585 * We don't want to mark the net->sent time here since this
9586 * we use this for HB and retrans cannot measure RTT
9587 */
9588 /* (void)SCTP_GETTIME_TIMEVAL(&chk->whoTo->last_sent_time); */
9589 *cnt_out += 1;
9590 chk->sent = SCTP_DATAGRAM_SENT;
9591 sctp_ucount_decr(stcb->asoc.sent_queue_retran_cnt);
9592 if (fwd_tsn == 0) {
9593 return (0);
9594 } else {
9595 /* Clean up the fwd-tsn list */
9596 sctp_clean_up_ctl(stcb, asoc, so_locked);
9597 return (0);
9598 }
9599 }
9600 /*
9601 * Ok, it is just data retransmission we need to do or that and a
9602 * fwd-tsn with it all.
9603 */
9604 if (TAILQ_EMPTY(&asoc->sent_queue)) {
9605 return (SCTP_RETRAN_DONE);
9606 }
9607 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED) ||
9608 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT)) {
9609 /* not yet open, resend the cookie and that is it */
9610 return (1);
9611 }
9612 #ifdef SCTP_AUDITING_ENABLED
9613 sctp_auditing(20, inp, stcb, NULL);
9614 #endif
9615 data_auth_reqd = sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks);
9616 TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) {
9617 if (chk->sent != SCTP_DATAGRAM_RESEND) {
9618 /* No, not sent to this net or not ready for rtx */
9619 continue;
9620 }
9621 if (chk->data == NULL) {
9622 SCTP_PRINTF("TSN:%x chk->snd_count:%d chk->sent:%d can't retran - no data\n",
9623 chk->rec.data.tsn, chk->snd_count, chk->sent);
9624 continue;
9625 }
9626 if ((SCTP_BASE_SYSCTL(sctp_max_retran_chunk)) &&
9627 (chk->snd_count >= SCTP_BASE_SYSCTL(sctp_max_retran_chunk))) {
9628 struct mbuf *op_err;
9629 char msg[SCTP_DIAG_INFO_LEN];
9630
9631 snprintf(msg, sizeof(msg), "TSN %8.8x retransmitted %d times, giving up",
9632 chk->rec.data.tsn, chk->snd_count);
9633 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
9634 msg);
9635 atomic_add_int(&stcb->asoc.refcnt, 1);
9636 sctp_abort_an_association(stcb->sctp_ep, stcb, op_err,
9637 so_locked);
9638 SCTP_TCB_LOCK(stcb);
9639 atomic_subtract_int(&stcb->asoc.refcnt, 1);
9640 return (SCTP_RETRAN_EXIT);
9641 }
9642 /* pick up the net */
9643 net = chk->whoTo;
9644 switch (net->ro._l_addr.sa.sa_family) {
9645 #ifdef INET
9646 case AF_INET:
9647 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
9648 break;
9649 #endif
9650 #ifdef INET6
9651 case AF_INET6:
9652 mtu = net->mtu - SCTP_MIN_OVERHEAD;
9653 break;
9654 #endif
9655 default:
9656 /* TSNH */
9657 mtu = net->mtu;
9658 break;
9659 }
9660
9661 if ((asoc->peers_rwnd < mtu) && (asoc->total_flight > 0)) {
9662 /* No room in peers rwnd */
9663 uint32_t tsn;
9664
9665 tsn = asoc->last_acked_seq + 1;
9666 if (tsn == chk->rec.data.tsn) {
9667 /*
9668 * we make a special exception for this
9669 * case. The peer has no rwnd but is missing
9670 * the lowest chunk.. which is probably what
9671 * is holding up the rwnd.
9672 */
9673 goto one_chunk_around;
9674 }
9675 return (1);
9676 }
9677 one_chunk_around:
9678 if (asoc->peers_rwnd < mtu) {
9679 one_chunk = 1;
9680 if ((asoc->peers_rwnd == 0) &&
9681 (asoc->total_flight == 0)) {
9682 chk->window_probe = 1;
9683 chk->whoTo->window_probe = 1;
9684 }
9685 }
9686 #ifdef SCTP_AUDITING_ENABLED
9687 sctp_audit_log(0xC3, 2);
9688 #endif
9689 bundle_at = 0;
9690 m = NULL;
9691 net->fast_retran_ip = 0;
9692 if (chk->rec.data.doing_fast_retransmit == 0) {
9693 /*
9694 * if no FR in progress skip destination that have
9695 * flight_size > cwnd.
9696 */
9697 if (net->flight_size >= net->cwnd) {
9698 continue;
9699 }
9700 } else {
9701 /*
9702 * Mark the destination net to have FR recovery
9703 * limits put on it.
9704 */
9705 *fr_done = 1;
9706 net->fast_retran_ip = 1;
9707 }
9708
9709 /*
9710 * if no AUTH is yet included and this chunk requires it,
9711 * make sure to account for it. We don't apply the size
9712 * until the AUTH chunk is actually added below in case
9713 * there is no room for this chunk.
9714 */
9715 if (data_auth_reqd && (auth == NULL)) {
9716 dmtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
9717 } else
9718 dmtu = 0;
9719
9720 if ((chk->send_size <= (mtu - dmtu)) ||
9721 (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) {
9722 /* ok we will add this one */
9723 if (data_auth_reqd) {
9724 if (auth == NULL) {
9725 m = sctp_add_auth_chunk(m,
9726 &endofchain,
9727 &auth,
9728 &auth_offset,
9729 stcb,
9730 SCTP_DATA);
9731 auth_keyid = chk->auth_keyid;
9732 override_ok = 0;
9733 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
9734 } else if (override_ok) {
9735 auth_keyid = chk->auth_keyid;
9736 override_ok = 0;
9737 } else if (chk->auth_keyid != auth_keyid) {
9738 /* different keyid, so done bundling */
9739 break;
9740 }
9741 }
9742 m = sctp_copy_mbufchain(chk->data, m, &endofchain, 0, chk->send_size, chk->copy_by_ref);
9743 if (m == NULL) {
9744 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
9745 return (ENOMEM);
9746 }
9747 /* Do clear IP_DF ? */
9748 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
9749 no_fragmentflg = 0;
9750 }
9751 /* upate our MTU size */
9752 if (mtu > (chk->send_size + dmtu))
9753 mtu -= (chk->send_size + dmtu);
9754 else
9755 mtu = 0;
9756 data_list[bundle_at++] = chk;
9757 if (one_chunk && (asoc->total_flight <= 0)) {
9758 SCTP_STAT_INCR(sctps_windowprobed);
9759 }
9760 }
9761 if (one_chunk == 0) {
9762 /*
9763 * now are there anymore forward from chk to pick
9764 * up?
9765 */
9766 for (fwd = TAILQ_NEXT(chk, sctp_next); fwd != NULL; fwd = TAILQ_NEXT(fwd, sctp_next)) {
9767 if (fwd->sent != SCTP_DATAGRAM_RESEND) {
9768 /* Nope, not for retran */
9769 continue;
9770 }
9771 if (fwd->whoTo != net) {
9772 /* Nope, not the net in question */
9773 continue;
9774 }
9775 if (data_auth_reqd && (auth == NULL)) {
9776 dmtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
9777 } else
9778 dmtu = 0;
9779 if (fwd->send_size <= (mtu - dmtu)) {
9780 if (data_auth_reqd) {
9781 if (auth == NULL) {
9782 m = sctp_add_auth_chunk(m,
9783 &endofchain,
9784 &auth,
9785 &auth_offset,
9786 stcb,
9787 SCTP_DATA);
9788 auth_keyid = fwd->auth_keyid;
9789 override_ok = 0;
9790 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
9791 } else if (override_ok) {
9792 auth_keyid = fwd->auth_keyid;
9793 override_ok = 0;
9794 } else if (fwd->auth_keyid != auth_keyid) {
9795 /*
9796 * different keyid,
9797 * so done bundling
9798 */
9799 break;
9800 }
9801 }
9802 m = sctp_copy_mbufchain(fwd->data, m, &endofchain, 0, fwd->send_size, fwd->copy_by_ref);
9803 if (m == NULL) {
9804 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
9805 return (ENOMEM);
9806 }
9807 /* Do clear IP_DF ? */
9808 if (fwd->flags & CHUNK_FLAGS_FRAGMENT_OK) {
9809 no_fragmentflg = 0;
9810 }
9811 /* upate our MTU size */
9812 if (mtu > (fwd->send_size + dmtu))
9813 mtu -= (fwd->send_size + dmtu);
9814 else
9815 mtu = 0;
9816 data_list[bundle_at++] = fwd;
9817 if (bundle_at >= SCTP_MAX_DATA_BUNDLING) {
9818 break;
9819 }
9820 } else {
9821 /* can't fit so we are done */
9822 break;
9823 }
9824 }
9825 }
9826 /* Is there something to send for this destination? */
9827 if (m) {
9828 /*
9829 * No matter if we fail/or succeed we should start a
9830 * timer. A failure is like a lost IP packet :-)
9831 */
9832 if (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
9833 /*
9834 * no timer running on this destination
9835 * restart it.
9836 */
9837 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
9838 tmr_started = 1;
9839 }
9840 /* Now lets send it, if there is anything to send :> */
9841 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
9842 (struct sockaddr *)&net->ro._l_addr, m,
9843 auth_offset, auth, auth_keyid,
9844 no_fragmentflg, 0, 0,
9845 inp->sctp_lport, stcb->rport, htonl(stcb->asoc.peer_vtag),
9846 net->port, NULL,
9847 0, 0,
9848 so_locked))) {
9849 /* error, we could not output */
9850 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
9851 if (error == ENOBUFS) {
9852 asoc->ifp_had_enobuf = 1;
9853 SCTP_STAT_INCR(sctps_lowlevelerr);
9854 }
9855 return (error);
9856 } else {
9857 asoc->ifp_had_enobuf = 0;
9858 }
9859 endofchain = NULL;
9860 auth = NULL;
9861 auth_offset = 0;
9862 /* For HB's */
9863 /*
9864 * We don't want to mark the net->sent time here
9865 * since this we use this for HB and retrans cannot
9866 * measure RTT
9867 */
9868 /* (void)SCTP_GETTIME_TIMEVAL(&net->last_sent_time); */
9869
9870 /* For auto-close */
9871 cnt_thru++;
9872 if (*now_filled == 0) {
9873 (void)SCTP_GETTIME_TIMEVAL(&asoc->time_last_sent);
9874 *now = asoc->time_last_sent;
9875 *now_filled = 1;
9876 } else {
9877 asoc->time_last_sent = *now;
9878 }
9879 *cnt_out += bundle_at;
9880 #ifdef SCTP_AUDITING_ENABLED
9881 sctp_audit_log(0xC4, bundle_at);
9882 #endif
9883 if (bundle_at) {
9884 tsns_sent = data_list[0]->rec.data.tsn;
9885 }
9886 for (i = 0; i < bundle_at; i++) {
9887 SCTP_STAT_INCR(sctps_sendretransdata);
9888 data_list[i]->sent = SCTP_DATAGRAM_SENT;
9889 /*
9890 * When we have a revoked data, and we
9891 * retransmit it, then we clear the revoked
9892 * flag since this flag dictates if we
9893 * subtracted from the fs
9894 */
9895 if (data_list[i]->rec.data.chunk_was_revoked) {
9896 /* Deflate the cwnd */
9897 data_list[i]->whoTo->cwnd -= data_list[i]->book_size;
9898 data_list[i]->rec.data.chunk_was_revoked = 0;
9899 }
9900 data_list[i]->snd_count++;
9901 sctp_ucount_decr(asoc->sent_queue_retran_cnt);
9902 /* record the time */
9903 data_list[i]->sent_rcv_time = asoc->time_last_sent;
9904 if (data_list[i]->book_size_scale) {
9905 /*
9906 * need to double the book size on
9907 * this one
9908 */
9909 data_list[i]->book_size_scale = 0;
9910 /*
9911 * Since we double the booksize, we
9912 * must also double the output queue
9913 * size, since this get shrunk when
9914 * we free by this amount.
9915 */
9916 atomic_add_int(&((asoc)->total_output_queue_size), data_list[i]->book_size);
9917 data_list[i]->book_size *= 2;
9918
9919
9920 } else {
9921 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_RWND_ENABLE) {
9922 sctp_log_rwnd(SCTP_DECREASE_PEER_RWND,
9923 asoc->peers_rwnd, data_list[i]->send_size, SCTP_BASE_SYSCTL(sctp_peer_chunk_oh));
9924 }
9925 asoc->peers_rwnd = sctp_sbspace_sub(asoc->peers_rwnd,
9926 (uint32_t)(data_list[i]->send_size +
9927 SCTP_BASE_SYSCTL(sctp_peer_chunk_oh)));
9928 }
9929 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
9930 sctp_misc_ints(SCTP_FLIGHT_LOG_UP_RSND,
9931 data_list[i]->whoTo->flight_size,
9932 data_list[i]->book_size,
9933 (uint32_t)(uintptr_t)data_list[i]->whoTo,
9934 data_list[i]->rec.data.tsn);
9935 }
9936 sctp_flight_size_increase(data_list[i]);
9937 sctp_total_flight_increase(stcb, data_list[i]);
9938 if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
9939 /* SWS sender side engages */
9940 asoc->peers_rwnd = 0;
9941 }
9942 if ((i == 0) &&
9943 (data_list[i]->rec.data.doing_fast_retransmit)) {
9944 SCTP_STAT_INCR(sctps_sendfastretrans);
9945 if ((data_list[i] == TAILQ_FIRST(&asoc->sent_queue)) &&
9946 (tmr_started == 0)) {
9947 /*-
9948 * ok we just fast-retrans'd
9949 * the lowest TSN, i.e the
9950 * first on the list. In
9951 * this case we want to give
9952 * some more time to get a
9953 * SACK back without a
9954 * t3-expiring.
9955 */
9956 sctp_timer_stop(SCTP_TIMER_TYPE_SEND, inp, stcb, net,
9957 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_2);
9958 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
9959 }
9960 }
9961 }
9962 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
9963 sctp_log_cwnd(stcb, net, tsns_sent, SCTP_CWND_LOG_FROM_RESEND);
9964 }
9965 #ifdef SCTP_AUDITING_ENABLED
9966 sctp_auditing(21, inp, stcb, NULL);
9967 #endif
9968 } else {
9969 /* None will fit */
9970 return (1);
9971 }
9972 if (asoc->sent_queue_retran_cnt <= 0) {
9973 /* all done we have no more to retran */
9974 asoc->sent_queue_retran_cnt = 0;
9975 break;
9976 }
9977 if (one_chunk) {
9978 /* No more room in rwnd */
9979 return (1);
9980 }
9981 /* stop the for loop here. we sent out a packet */
9982 break;
9983 }
9984 return (0);
9985 }
9986
9987 static void
sctp_timer_validation(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_association * asoc)9988 sctp_timer_validation(struct sctp_inpcb *inp,
9989 struct sctp_tcb *stcb,
9990 struct sctp_association *asoc)
9991 {
9992 struct sctp_nets *net;
9993
9994 /* Validate that a timer is running somewhere */
9995 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
9996 if (SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
9997 /* Here is a timer */
9998 return;
9999 }
10000 }
10001 SCTP_TCB_LOCK_ASSERT(stcb);
10002 /* Gak, we did not have a timer somewhere */
10003 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Deadlock avoided starting timer on a dest at retran\n");
10004 if (asoc->alternate) {
10005 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, asoc->alternate);
10006 } else {
10007 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, asoc->primary_destination);
10008 }
10009 return;
10010 }
10011
10012 void
sctp_chunk_output(struct sctp_inpcb * inp,struct sctp_tcb * stcb,int from_where,int so_locked SCTP_UNUSED)10013 sctp_chunk_output(struct sctp_inpcb *inp,
10014 struct sctp_tcb *stcb,
10015 int from_where,
10016 int so_locked
10017 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
10018 SCTP_UNUSED
10019 #endif
10020 )
10021 {
10022 /*-
10023 * Ok this is the generic chunk service queue. we must do the
10024 * following:
10025 * - See if there are retransmits pending, if so we must
10026 * do these first.
10027 * - Service the stream queue that is next, moving any
10028 * message (note I must get a complete message i.e.
10029 * FIRST/MIDDLE and LAST to the out queue in one pass) and assigning
10030 * TSN's
10031 * - Check to see if the cwnd/rwnd allows any output, if so we
10032 * go ahead and fomulate and send the low level chunks. Making sure
10033 * to combine any control in the control chunk queue also.
10034 */
10035 struct sctp_association *asoc;
10036 struct sctp_nets *net;
10037 int error = 0, num_out, tot_out = 0, ret = 0, reason_code;
10038 unsigned int burst_cnt = 0;
10039 struct timeval now;
10040 int now_filled = 0;
10041 int nagle_on;
10042 int frag_point = sctp_get_frag_point(stcb, &stcb->asoc);
10043 int un_sent = 0;
10044 int fr_done;
10045 unsigned int tot_frs = 0;
10046
10047 asoc = &stcb->asoc;
10048 do_it_again:
10049 /* The Nagle algorithm is only applied when handling a send call. */
10050 if (from_where == SCTP_OUTPUT_FROM_USR_SEND) {
10051 if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_NODELAY)) {
10052 nagle_on = 0;
10053 } else {
10054 nagle_on = 1;
10055 }
10056 } else {
10057 nagle_on = 0;
10058 }
10059 SCTP_TCB_LOCK_ASSERT(stcb);
10060
10061 un_sent = (stcb->asoc.total_output_queue_size - stcb->asoc.total_flight);
10062
10063 if ((un_sent <= 0) &&
10064 (TAILQ_EMPTY(&asoc->control_send_queue)) &&
10065 (TAILQ_EMPTY(&asoc->asconf_send_queue)) &&
10066 (asoc->sent_queue_retran_cnt == 0) &&
10067 (asoc->trigger_reset == 0)) {
10068 /* Nothing to do unless there is something to be sent left */
10069 return;
10070 }
10071 /*
10072 * Do we have something to send, data or control AND a sack timer
10073 * running, if so piggy-back the sack.
10074 */
10075 if (SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
10076 sctp_send_sack(stcb, so_locked);
10077 (void)SCTP_OS_TIMER_STOP(&stcb->asoc.dack_timer.timer);
10078 }
10079 while (asoc->sent_queue_retran_cnt) {
10080 /*-
10081 * Ok, it is retransmission time only, we send out only ONE
10082 * packet with a single call off to the retran code.
10083 */
10084 if (from_where == SCTP_OUTPUT_FROM_COOKIE_ACK) {
10085 /*-
10086 * Special hook for handling cookiess discarded
10087 * by peer that carried data. Send cookie-ack only
10088 * and then the next call with get the retran's.
10089 */
10090 (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1,
10091 from_where,
10092 &now, &now_filled, frag_point, so_locked);
10093 return;
10094 } else if (from_where != SCTP_OUTPUT_FROM_HB_TMR) {
10095 /* if its not from a HB then do it */
10096 fr_done = 0;
10097 ret = sctp_chunk_retransmission(inp, stcb, asoc, &num_out, &now, &now_filled, &fr_done, so_locked);
10098 if (fr_done) {
10099 tot_frs++;
10100 }
10101 } else {
10102 /*
10103 * its from any other place, we don't allow retran
10104 * output (only control)
10105 */
10106 ret = 1;
10107 }
10108 if (ret > 0) {
10109 /* Can't send anymore */
10110 /*-
10111 * now lets push out control by calling med-level
10112 * output once. this assures that we WILL send HB's
10113 * if queued too.
10114 */
10115 (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1,
10116 from_where,
10117 &now, &now_filled, frag_point, so_locked);
10118 #ifdef SCTP_AUDITING_ENABLED
10119 sctp_auditing(8, inp, stcb, NULL);
10120 #endif
10121 sctp_timer_validation(inp, stcb, asoc);
10122 return;
10123 }
10124 if (ret < 0) {
10125 /*-
10126 * The count was off.. retran is not happening so do
10127 * the normal retransmission.
10128 */
10129 #ifdef SCTP_AUDITING_ENABLED
10130 sctp_auditing(9, inp, stcb, NULL);
10131 #endif
10132 if (ret == SCTP_RETRAN_EXIT) {
10133 return;
10134 }
10135 break;
10136 }
10137 if (from_where == SCTP_OUTPUT_FROM_T3) {
10138 /* Only one transmission allowed out of a timeout */
10139 #ifdef SCTP_AUDITING_ENABLED
10140 sctp_auditing(10, inp, stcb, NULL);
10141 #endif
10142 /* Push out any control */
10143 (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1, from_where,
10144 &now, &now_filled, frag_point, so_locked);
10145 return;
10146 }
10147 if ((asoc->fr_max_burst > 0) && (tot_frs >= asoc->fr_max_burst)) {
10148 /* Hit FR burst limit */
10149 return;
10150 }
10151 if ((num_out == 0) && (ret == 0)) {
10152 /* No more retrans to send */
10153 break;
10154 }
10155 }
10156 #ifdef SCTP_AUDITING_ENABLED
10157 sctp_auditing(12, inp, stcb, NULL);
10158 #endif
10159 /* Check for bad destinations, if they exist move chunks around. */
10160 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
10161 if (!(net->dest_state & SCTP_ADDR_REACHABLE)) {
10162 /*-
10163 * if possible move things off of this address we
10164 * still may send below due to the dormant state but
10165 * we try to find an alternate address to send to
10166 * and if we have one we move all queued data on the
10167 * out wheel to this alternate address.
10168 */
10169 if (net->ref_count > 1)
10170 sctp_move_chunks_from_net(stcb, net);
10171 } else {
10172 /*-
10173 * if ((asoc->sat_network) || (net->addr_is_local))
10174 * { burst_limit = asoc->max_burst *
10175 * SCTP_SAT_NETWORK_BURST_INCR; }
10176 */
10177 if (asoc->max_burst > 0) {
10178 if (SCTP_BASE_SYSCTL(sctp_use_cwnd_based_maxburst)) {
10179 if ((net->flight_size + (asoc->max_burst * net->mtu)) < net->cwnd) {
10180 /*
10181 * JRS - Use the congestion
10182 * control given in the
10183 * congestion control module
10184 */
10185 asoc->cc_functions.sctp_cwnd_update_after_output(stcb, net, asoc->max_burst);
10186 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_MAXBURST_ENABLE) {
10187 sctp_log_maxburst(stcb, net, 0, asoc->max_burst, SCTP_MAX_BURST_APPLIED);
10188 }
10189 SCTP_STAT_INCR(sctps_maxburstqueued);
10190 }
10191 net->fast_retran_ip = 0;
10192 } else {
10193 if (net->flight_size == 0) {
10194 /*
10195 * Should be decaying the
10196 * cwnd here
10197 */
10198 ;
10199 }
10200 }
10201 }
10202 }
10203
10204 }
10205 burst_cnt = 0;
10206 do {
10207 error = sctp_med_chunk_output(inp, stcb, asoc, &num_out,
10208 &reason_code, 0, from_where,
10209 &now, &now_filled, frag_point, so_locked);
10210 if (error) {
10211 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Error %d was returned from med-c-op\n", error);
10212 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_MAXBURST_ENABLE) {
10213 sctp_log_maxburst(stcb, asoc->primary_destination, error, burst_cnt, SCTP_MAX_BURST_ERROR_STOP);
10214 }
10215 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
10216 sctp_log_cwnd(stcb, NULL, error, SCTP_SEND_NOW_COMPLETES);
10217 sctp_log_cwnd(stcb, NULL, 0xdeadbeef, SCTP_SEND_NOW_COMPLETES);
10218 }
10219 break;
10220 }
10221 SCTPDBG(SCTP_DEBUG_OUTPUT3, "m-c-o put out %d\n", num_out);
10222
10223 tot_out += num_out;
10224 burst_cnt++;
10225 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
10226 sctp_log_cwnd(stcb, NULL, num_out, SCTP_SEND_NOW_COMPLETES);
10227 if (num_out == 0) {
10228 sctp_log_cwnd(stcb, NULL, reason_code, SCTP_SEND_NOW_COMPLETES);
10229 }
10230 }
10231 if (nagle_on) {
10232 /*
10233 * When the Nagle algorithm is used, look at how
10234 * much is unsent, then if its smaller than an MTU
10235 * and we have data in flight we stop, except if we
10236 * are handling a fragmented user message.
10237 */
10238 un_sent = stcb->asoc.total_output_queue_size - stcb->asoc.total_flight;
10239 if ((un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD)) &&
10240 (stcb->asoc.total_flight > 0)) {
10241 /* && sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXPLICIT_EOR))) {*/
10242 break;
10243 }
10244 }
10245 if (TAILQ_EMPTY(&asoc->control_send_queue) &&
10246 TAILQ_EMPTY(&asoc->send_queue) &&
10247 sctp_is_there_unsent_data(stcb, so_locked) == 0) {
10248 /* Nothing left to send */
10249 break;
10250 }
10251 if ((stcb->asoc.total_output_queue_size - stcb->asoc.total_flight) <= 0) {
10252 /* Nothing left to send */
10253 break;
10254 }
10255 } while (num_out &&
10256 ((asoc->max_burst == 0) ||
10257 SCTP_BASE_SYSCTL(sctp_use_cwnd_based_maxburst) ||
10258 (burst_cnt < asoc->max_burst)));
10259
10260 if (SCTP_BASE_SYSCTL(sctp_use_cwnd_based_maxburst) == 0) {
10261 if ((asoc->max_burst > 0) && (burst_cnt >= asoc->max_burst)) {
10262 SCTP_STAT_INCR(sctps_maxburstqueued);
10263 asoc->burst_limit_applied = 1;
10264 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_MAXBURST_ENABLE) {
10265 sctp_log_maxburst(stcb, asoc->primary_destination, 0, burst_cnt, SCTP_MAX_BURST_APPLIED);
10266 }
10267 } else {
10268 asoc->burst_limit_applied = 0;
10269 }
10270 }
10271 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
10272 sctp_log_cwnd(stcb, NULL, tot_out, SCTP_SEND_NOW_COMPLETES);
10273 }
10274 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Ok, we have put out %d chunks\n",
10275 tot_out);
10276
10277 /*-
10278 * Now we need to clean up the control chunk chain if a ECNE is on
10279 * it. It must be marked as UNSENT again so next call will continue
10280 * to send it until such time that we get a CWR, to remove it.
10281 */
10282 if (stcb->asoc.ecn_echo_cnt_onq)
10283 sctp_fix_ecn_echo(asoc);
10284
10285 if (stcb->asoc.trigger_reset) {
10286 if (sctp_send_stream_reset_out_if_possible(stcb, so_locked) == 0) {
10287 goto do_it_again;
10288 }
10289 }
10290 return;
10291 }
10292
10293
10294 int
sctp_output(struct sctp_inpcb * inp,struct mbuf * m,struct sockaddr * addr,struct mbuf * control,struct thread * p,int flags)10295 sctp_output(
10296 struct sctp_inpcb *inp,
10297 struct mbuf *m,
10298 struct sockaddr *addr,
10299 struct mbuf *control,
10300 struct thread *p,
10301 int flags)
10302 {
10303 if (inp == NULL) {
10304 SCTP_LTRACE_ERR_RET_PKT(m, inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
10305 return (EINVAL);
10306 }
10307
10308 if (inp->sctp_socket == NULL) {
10309 SCTP_LTRACE_ERR_RET_PKT(m, inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
10310 return (EINVAL);
10311 }
10312 return (sctp_sosend(inp->sctp_socket,
10313 addr,
10314 (struct uio *)NULL,
10315 m,
10316 control,
10317 flags, p
10318 ));
10319 }
10320
10321 void
send_forward_tsn(struct sctp_tcb * stcb,struct sctp_association * asoc)10322 send_forward_tsn(struct sctp_tcb *stcb,
10323 struct sctp_association *asoc)
10324 {
10325 struct sctp_tmit_chunk *chk, *at, *tp1, *last;
10326 struct sctp_forward_tsn_chunk *fwdtsn;
10327 struct sctp_strseq *strseq;
10328 struct sctp_strseq_mid *strseq_m;
10329 uint32_t advance_peer_ack_point;
10330 unsigned int cnt_of_space, i, ovh;
10331 unsigned int space_needed;
10332 unsigned int cnt_of_skipped = 0;
10333
10334 SCTP_TCB_LOCK_ASSERT(stcb);
10335 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
10336 if (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) {
10337 /* mark it to unsent */
10338 chk->sent = SCTP_DATAGRAM_UNSENT;
10339 chk->snd_count = 0;
10340 /* Do we correct its output location? */
10341 if (chk->whoTo) {
10342 sctp_free_remote_addr(chk->whoTo);
10343 chk->whoTo = NULL;
10344 }
10345 goto sctp_fill_in_rest;
10346 }
10347 }
10348 /* Ok if we reach here we must build one */
10349 sctp_alloc_a_chunk(stcb, chk);
10350 if (chk == NULL) {
10351 return;
10352 }
10353 asoc->fwd_tsn_cnt++;
10354 chk->copy_by_ref = 0;
10355 /*
10356 * We don't do the old thing here since this is used not for on-wire
10357 * but to tell if we are sending a fwd-tsn by the stack during
10358 * output. And if its a IFORWARD or a FORWARD it is a fwd-tsn.
10359 */
10360 chk->rec.chunk_id.id = SCTP_FORWARD_CUM_TSN;
10361 chk->rec.chunk_id.can_take_data = 0;
10362 chk->flags = 0;
10363 chk->asoc = asoc;
10364 chk->whoTo = NULL;
10365 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
10366 if (chk->data == NULL) {
10367 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
10368 return;
10369 }
10370 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
10371 chk->sent = SCTP_DATAGRAM_UNSENT;
10372 chk->snd_count = 0;
10373 TAILQ_INSERT_TAIL(&asoc->control_send_queue, chk, sctp_next);
10374 asoc->ctrl_queue_cnt++;
10375 sctp_fill_in_rest:
10376 /*-
10377 * Here we go through and fill out the part that deals with
10378 * stream/seq of the ones we skip.
10379 */
10380 SCTP_BUF_LEN(chk->data) = 0;
10381 TAILQ_FOREACH(at, &asoc->sent_queue, sctp_next) {
10382 if ((at->sent != SCTP_FORWARD_TSN_SKIP) &&
10383 (at->sent != SCTP_DATAGRAM_NR_ACKED)) {
10384 /* no more to look at */
10385 break;
10386 }
10387 if (!asoc->idata_supported && (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED)) {
10388 /* We don't report these */
10389 continue;
10390 }
10391 cnt_of_skipped++;
10392 }
10393 if (asoc->idata_supported) {
10394 space_needed = (sizeof(struct sctp_forward_tsn_chunk) +
10395 (cnt_of_skipped * sizeof(struct sctp_strseq_mid)));
10396 } else {
10397 space_needed = (sizeof(struct sctp_forward_tsn_chunk) +
10398 (cnt_of_skipped * sizeof(struct sctp_strseq)));
10399 }
10400 cnt_of_space = (unsigned int)M_TRAILINGSPACE(chk->data);
10401
10402 if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
10403 ovh = SCTP_MIN_OVERHEAD;
10404 } else {
10405 ovh = SCTP_MIN_V4_OVERHEAD;
10406 }
10407 if (cnt_of_space > (asoc->smallest_mtu - ovh)) {
10408 /* trim to a mtu size */
10409 cnt_of_space = asoc->smallest_mtu - ovh;
10410 }
10411 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
10412 sctp_misc_ints(SCTP_FWD_TSN_CHECK,
10413 0xff, 0, cnt_of_skipped,
10414 asoc->advanced_peer_ack_point);
10415 }
10416 advance_peer_ack_point = asoc->advanced_peer_ack_point;
10417 if (cnt_of_space < space_needed) {
10418 /*-
10419 * ok we must trim down the chunk by lowering the
10420 * advance peer ack point.
10421 */
10422 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
10423 sctp_misc_ints(SCTP_FWD_TSN_CHECK,
10424 0xff, 0xff, cnt_of_space,
10425 space_needed);
10426 }
10427 cnt_of_skipped = cnt_of_space - sizeof(struct sctp_forward_tsn_chunk);
10428 if (asoc->idata_supported) {
10429 cnt_of_skipped /= sizeof(struct sctp_strseq_mid);
10430 } else {
10431 cnt_of_skipped /= sizeof(struct sctp_strseq);
10432 }
10433 /*-
10434 * Go through and find the TSN that will be the one
10435 * we report.
10436 */
10437 at = TAILQ_FIRST(&asoc->sent_queue);
10438 if (at != NULL) {
10439 for (i = 0; i < cnt_of_skipped; i++) {
10440 tp1 = TAILQ_NEXT(at, sctp_next);
10441 if (tp1 == NULL) {
10442 break;
10443 }
10444 at = tp1;
10445 }
10446 }
10447 if (at && SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
10448 sctp_misc_ints(SCTP_FWD_TSN_CHECK,
10449 0xff, cnt_of_skipped, at->rec.data.tsn,
10450 asoc->advanced_peer_ack_point);
10451 }
10452 last = at;
10453 /*-
10454 * last now points to last one I can report, update
10455 * peer ack point
10456 */
10457 if (last) {
10458 advance_peer_ack_point = last->rec.data.tsn;
10459 }
10460 if (asoc->idata_supported) {
10461 space_needed = sizeof(struct sctp_forward_tsn_chunk) +
10462 cnt_of_skipped * sizeof(struct sctp_strseq_mid);
10463 } else {
10464 space_needed = sizeof(struct sctp_forward_tsn_chunk) +
10465 cnt_of_skipped * sizeof(struct sctp_strseq);
10466 }
10467 }
10468 chk->send_size = space_needed;
10469 /* Setup the chunk */
10470 fwdtsn = mtod(chk->data, struct sctp_forward_tsn_chunk *);
10471 fwdtsn->ch.chunk_length = htons(chk->send_size);
10472 fwdtsn->ch.chunk_flags = 0;
10473 if (asoc->idata_supported) {
10474 fwdtsn->ch.chunk_type = SCTP_IFORWARD_CUM_TSN;
10475 } else {
10476 fwdtsn->ch.chunk_type = SCTP_FORWARD_CUM_TSN;
10477 }
10478 fwdtsn->new_cumulative_tsn = htonl(advance_peer_ack_point);
10479 SCTP_BUF_LEN(chk->data) = chk->send_size;
10480 fwdtsn++;
10481 /*-
10482 * Move pointer to after the fwdtsn and transfer to the
10483 * strseq pointer.
10484 */
10485 if (asoc->idata_supported) {
10486 strseq_m = (struct sctp_strseq_mid *)fwdtsn;
10487 strseq = NULL;
10488 } else {
10489 strseq = (struct sctp_strseq *)fwdtsn;
10490 strseq_m = NULL;
10491 }
10492 /*-
10493 * Now populate the strseq list. This is done blindly
10494 * without pulling out duplicate stream info. This is
10495 * inefficent but won't harm the process since the peer will
10496 * look at these in sequence and will thus release anything.
10497 * It could mean we exceed the PMTU and chop off some that
10498 * we could have included.. but this is unlikely (aka 1432/4
10499 * would mean 300+ stream seq's would have to be reported in
10500 * one FWD-TSN. With a bit of work we can later FIX this to
10501 * optimize and pull out duplicates.. but it does add more
10502 * overhead. So for now... not!
10503 */
10504 i = 0;
10505 TAILQ_FOREACH(at, &asoc->sent_queue, sctp_next) {
10506 if (i >= cnt_of_skipped) {
10507 break;
10508 }
10509 if (!asoc->idata_supported && (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED)) {
10510 /* We don't report these */
10511 continue;
10512 }
10513 if (at->rec.data.tsn == advance_peer_ack_point) {
10514 at->rec.data.fwd_tsn_cnt = 0;
10515 }
10516 if (asoc->idata_supported) {
10517 strseq_m->sid = htons(at->rec.data.sid);
10518 if (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED) {
10519 strseq_m->flags = htons(PR_SCTP_UNORDERED_FLAG);
10520 } else {
10521 strseq_m->flags = 0;
10522 }
10523 strseq_m->mid = htonl(at->rec.data.mid);
10524 strseq_m++;
10525 } else {
10526 strseq->sid = htons(at->rec.data.sid);
10527 strseq->ssn = htons((uint16_t)at->rec.data.mid);
10528 strseq++;
10529 }
10530 i++;
10531 }
10532 return;
10533 }
10534
10535 void
sctp_send_sack(struct sctp_tcb * stcb,int so_locked SCTP_UNUSED)10536 sctp_send_sack(struct sctp_tcb *stcb, int so_locked
10537 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
10538 SCTP_UNUSED
10539 #endif
10540 )
10541 {
10542 /*-
10543 * Queue up a SACK or NR-SACK in the control queue.
10544 * We must first check to see if a SACK or NR-SACK is
10545 * somehow on the control queue.
10546 * If so, we will take and and remove the old one.
10547 */
10548 struct sctp_association *asoc;
10549 struct sctp_tmit_chunk *chk, *a_chk;
10550 struct sctp_sack_chunk *sack;
10551 struct sctp_nr_sack_chunk *nr_sack;
10552 struct sctp_gap_ack_block *gap_descriptor;
10553 const struct sack_track *selector;
10554 int mergeable = 0;
10555 int offset;
10556 caddr_t limit;
10557 uint32_t *dup;
10558 int limit_reached = 0;
10559 unsigned int i, siz, j;
10560 unsigned int num_gap_blocks = 0, num_nr_gap_blocks = 0, space;
10561 int num_dups = 0;
10562 int space_req;
10563 uint32_t highest_tsn;
10564 uint8_t flags;
10565 uint8_t type;
10566 uint8_t tsn_map;
10567
10568 if (stcb->asoc.nrsack_supported == 1) {
10569 type = SCTP_NR_SELECTIVE_ACK;
10570 } else {
10571 type = SCTP_SELECTIVE_ACK;
10572 }
10573 a_chk = NULL;
10574 asoc = &stcb->asoc;
10575 SCTP_TCB_LOCK_ASSERT(stcb);
10576 if (asoc->last_data_chunk_from == NULL) {
10577 /* Hmm we never received anything */
10578 return;
10579 }
10580 sctp_slide_mapping_arrays(stcb);
10581 sctp_set_rwnd(stcb, asoc);
10582 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
10583 if (chk->rec.chunk_id.id == type) {
10584 /* Hmm, found a sack already on queue, remove it */
10585 TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next);
10586 asoc->ctrl_queue_cnt--;
10587 a_chk = chk;
10588 if (a_chk->data) {
10589 sctp_m_freem(a_chk->data);
10590 a_chk->data = NULL;
10591 }
10592 if (a_chk->whoTo) {
10593 sctp_free_remote_addr(a_chk->whoTo);
10594 a_chk->whoTo = NULL;
10595 }
10596 break;
10597 }
10598 }
10599 if (a_chk == NULL) {
10600 sctp_alloc_a_chunk(stcb, a_chk);
10601 if (a_chk == NULL) {
10602 /* No memory so we drop the idea, and set a timer */
10603 if (stcb->asoc.delayed_ack) {
10604 sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
10605 stcb->sctp_ep, stcb, NULL,
10606 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_3);
10607 sctp_timer_start(SCTP_TIMER_TYPE_RECV,
10608 stcb->sctp_ep, stcb, NULL);
10609 } else {
10610 stcb->asoc.send_sack = 1;
10611 }
10612 return;
10613 }
10614 a_chk->copy_by_ref = 0;
10615 a_chk->rec.chunk_id.id = type;
10616 a_chk->rec.chunk_id.can_take_data = 1;
10617 }
10618 /* Clear our pkt counts */
10619 asoc->data_pkts_seen = 0;
10620
10621 a_chk->flags = 0;
10622 a_chk->asoc = asoc;
10623 a_chk->snd_count = 0;
10624 a_chk->send_size = 0; /* fill in later */
10625 a_chk->sent = SCTP_DATAGRAM_UNSENT;
10626 a_chk->whoTo = NULL;
10627
10628 if (!(asoc->last_data_chunk_from->dest_state & SCTP_ADDR_REACHABLE)) {
10629 /*-
10630 * Ok, the destination for the SACK is unreachable, lets see if
10631 * we can select an alternate to asoc->last_data_chunk_from
10632 */
10633 a_chk->whoTo = sctp_find_alternate_net(stcb, asoc->last_data_chunk_from, 0);
10634 if (a_chk->whoTo == NULL) {
10635 /* Nope, no alternate */
10636 a_chk->whoTo = asoc->last_data_chunk_from;
10637 }
10638 } else {
10639 a_chk->whoTo = asoc->last_data_chunk_from;
10640 }
10641 if (a_chk->whoTo) {
10642 atomic_add_int(&a_chk->whoTo->ref_count, 1);
10643 }
10644 if (SCTP_TSN_GT(asoc->highest_tsn_inside_map, asoc->highest_tsn_inside_nr_map)) {
10645 highest_tsn = asoc->highest_tsn_inside_map;
10646 } else {
10647 highest_tsn = asoc->highest_tsn_inside_nr_map;
10648 }
10649 if (highest_tsn == asoc->cumulative_tsn) {
10650 /* no gaps */
10651 if (type == SCTP_SELECTIVE_ACK) {
10652 space_req = sizeof(struct sctp_sack_chunk);
10653 } else {
10654 space_req = sizeof(struct sctp_nr_sack_chunk);
10655 }
10656 } else {
10657 /* gaps get a cluster */
10658 space_req = MCLBYTES;
10659 }
10660 /* Ok now lets formulate a MBUF with our sack */
10661 a_chk->data = sctp_get_mbuf_for_msg(space_req, 0, M_NOWAIT, 1, MT_DATA);
10662 if ((a_chk->data == NULL) ||
10663 (a_chk->whoTo == NULL)) {
10664 /* rats, no mbuf memory */
10665 if (a_chk->data) {
10666 /* was a problem with the destination */
10667 sctp_m_freem(a_chk->data);
10668 a_chk->data = NULL;
10669 }
10670 sctp_free_a_chunk(stcb, a_chk, so_locked);
10671 /* sa_ignore NO_NULL_CHK */
10672 if (stcb->asoc.delayed_ack) {
10673 sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
10674 stcb->sctp_ep, stcb, NULL,
10675 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_4);
10676 sctp_timer_start(SCTP_TIMER_TYPE_RECV,
10677 stcb->sctp_ep, stcb, NULL);
10678 } else {
10679 stcb->asoc.send_sack = 1;
10680 }
10681 return;
10682 }
10683 /* ok, lets go through and fill it in */
10684 SCTP_BUF_RESV_UF(a_chk->data, SCTP_MIN_OVERHEAD);
10685 space = (unsigned int)M_TRAILINGSPACE(a_chk->data);
10686 if (space > (a_chk->whoTo->mtu - SCTP_MIN_OVERHEAD)) {
10687 space = (a_chk->whoTo->mtu - SCTP_MIN_OVERHEAD);
10688 }
10689 limit = mtod(a_chk->data, caddr_t);
10690 limit += space;
10691
10692 flags = 0;
10693
10694 if ((asoc->sctp_cmt_on_off > 0) &&
10695 SCTP_BASE_SYSCTL(sctp_cmt_use_dac)) {
10696 /*-
10697 * CMT DAC algorithm: If 2 (i.e., 0x10) packets have been
10698 * received, then set high bit to 1, else 0. Reset
10699 * pkts_rcvd.
10700 */
10701 flags |= (asoc->cmt_dac_pkts_rcvd << 6);
10702 asoc->cmt_dac_pkts_rcvd = 0;
10703 }
10704 #ifdef SCTP_ASOCLOG_OF_TSNS
10705 stcb->asoc.cumack_logsnt[stcb->asoc.cumack_log_atsnt] = asoc->cumulative_tsn;
10706 stcb->asoc.cumack_log_atsnt++;
10707 if (stcb->asoc.cumack_log_atsnt >= SCTP_TSN_LOG_SIZE) {
10708 stcb->asoc.cumack_log_atsnt = 0;
10709 }
10710 #endif
10711 /* reset the readers interpretation */
10712 stcb->freed_by_sorcv_sincelast = 0;
10713
10714 if (type == SCTP_SELECTIVE_ACK) {
10715 sack = mtod(a_chk->data, struct sctp_sack_chunk *);
10716 nr_sack = NULL;
10717 gap_descriptor = (struct sctp_gap_ack_block *)((caddr_t)sack + sizeof(struct sctp_sack_chunk));
10718 if (highest_tsn > asoc->mapping_array_base_tsn) {
10719 siz = (((highest_tsn - asoc->mapping_array_base_tsn) + 1) + 7) / 8;
10720 } else {
10721 siz = (((MAX_TSN - highest_tsn) + 1) + highest_tsn + 7) / 8;
10722 }
10723 } else {
10724 sack = NULL;
10725 nr_sack = mtod(a_chk->data, struct sctp_nr_sack_chunk *);
10726 gap_descriptor = (struct sctp_gap_ack_block *)((caddr_t)nr_sack + sizeof(struct sctp_nr_sack_chunk));
10727 if (asoc->highest_tsn_inside_map > asoc->mapping_array_base_tsn) {
10728 siz = (((asoc->highest_tsn_inside_map - asoc->mapping_array_base_tsn) + 1) + 7) / 8;
10729 } else {
10730 siz = (((MAX_TSN - asoc->mapping_array_base_tsn) + 1) + asoc->highest_tsn_inside_map + 7) / 8;
10731 }
10732 }
10733
10734 if (SCTP_TSN_GT(asoc->mapping_array_base_tsn, asoc->cumulative_tsn)) {
10735 offset = 1;
10736 } else {
10737 offset = asoc->mapping_array_base_tsn - asoc->cumulative_tsn;
10738 }
10739 if (((type == SCTP_SELECTIVE_ACK) &&
10740 SCTP_TSN_GT(highest_tsn, asoc->cumulative_tsn)) ||
10741 ((type == SCTP_NR_SELECTIVE_ACK) &&
10742 SCTP_TSN_GT(asoc->highest_tsn_inside_map, asoc->cumulative_tsn))) {
10743 /* we have a gap .. maybe */
10744 for (i = 0; i < siz; i++) {
10745 tsn_map = asoc->mapping_array[i];
10746 if (type == SCTP_SELECTIVE_ACK) {
10747 tsn_map |= asoc->nr_mapping_array[i];
10748 }
10749 if (i == 0) {
10750 /*
10751 * Clear all bits corresponding to TSNs
10752 * smaller or equal to the cumulative TSN.
10753 */
10754 tsn_map &= (~0U << (1 - offset));
10755 }
10756 selector = &sack_array[tsn_map];
10757 if (mergeable && selector->right_edge) {
10758 /*
10759 * Backup, left and right edges were ok to
10760 * merge.
10761 */
10762 num_gap_blocks--;
10763 gap_descriptor--;
10764 }
10765 if (selector->num_entries == 0)
10766 mergeable = 0;
10767 else {
10768 for (j = 0; j < selector->num_entries; j++) {
10769 if (mergeable && selector->right_edge) {
10770 /*
10771 * do a merge by NOT setting
10772 * the left side
10773 */
10774 mergeable = 0;
10775 } else {
10776 /*
10777 * no merge, set the left
10778 * side
10779 */
10780 mergeable = 0;
10781 gap_descriptor->start = htons((selector->gaps[j].start + offset));
10782 }
10783 gap_descriptor->end = htons((selector->gaps[j].end + offset));
10784 num_gap_blocks++;
10785 gap_descriptor++;
10786 if (((caddr_t)gap_descriptor + sizeof(struct sctp_gap_ack_block)) > limit) {
10787 /* no more room */
10788 limit_reached = 1;
10789 break;
10790 }
10791 }
10792 if (selector->left_edge) {
10793 mergeable = 1;
10794 }
10795 }
10796 if (limit_reached) {
10797 /* Reached the limit stop */
10798 break;
10799 }
10800 offset += 8;
10801 }
10802 }
10803 if ((type == SCTP_NR_SELECTIVE_ACK) &&
10804 (limit_reached == 0)) {
10805
10806 mergeable = 0;
10807
10808 if (asoc->highest_tsn_inside_nr_map > asoc->mapping_array_base_tsn) {
10809 siz = (((asoc->highest_tsn_inside_nr_map - asoc->mapping_array_base_tsn) + 1) + 7) / 8;
10810 } else {
10811 siz = (((MAX_TSN - asoc->mapping_array_base_tsn) + 1) + asoc->highest_tsn_inside_nr_map + 7) / 8;
10812 }
10813
10814 if (SCTP_TSN_GT(asoc->mapping_array_base_tsn, asoc->cumulative_tsn)) {
10815 offset = 1;
10816 } else {
10817 offset = asoc->mapping_array_base_tsn - asoc->cumulative_tsn;
10818 }
10819 if (SCTP_TSN_GT(asoc->highest_tsn_inside_nr_map, asoc->cumulative_tsn)) {
10820 /* we have a gap .. maybe */
10821 for (i = 0; i < siz; i++) {
10822 tsn_map = asoc->nr_mapping_array[i];
10823 if (i == 0) {
10824 /*
10825 * Clear all bits corresponding to
10826 * TSNs smaller or equal to the
10827 * cumulative TSN.
10828 */
10829 tsn_map &= (~0U << (1 - offset));
10830 }
10831 selector = &sack_array[tsn_map];
10832 if (mergeable && selector->right_edge) {
10833 /*
10834 * Backup, left and right edges were
10835 * ok to merge.
10836 */
10837 num_nr_gap_blocks--;
10838 gap_descriptor--;
10839 }
10840 if (selector->num_entries == 0)
10841 mergeable = 0;
10842 else {
10843 for (j = 0; j < selector->num_entries; j++) {
10844 if (mergeable && selector->right_edge) {
10845 /*
10846 * do a merge by NOT
10847 * setting the left
10848 * side
10849 */
10850 mergeable = 0;
10851 } else {
10852 /*
10853 * no merge, set the
10854 * left side
10855 */
10856 mergeable = 0;
10857 gap_descriptor->start = htons((selector->gaps[j].start + offset));
10858 }
10859 gap_descriptor->end = htons((selector->gaps[j].end + offset));
10860 num_nr_gap_blocks++;
10861 gap_descriptor++;
10862 if (((caddr_t)gap_descriptor + sizeof(struct sctp_gap_ack_block)) > limit) {
10863 /* no more room */
10864 limit_reached = 1;
10865 break;
10866 }
10867 }
10868 if (selector->left_edge) {
10869 mergeable = 1;
10870 }
10871 }
10872 if (limit_reached) {
10873 /* Reached the limit stop */
10874 break;
10875 }
10876 offset += 8;
10877 }
10878 }
10879 }
10880 /* now we must add any dups we are going to report. */
10881 if ((limit_reached == 0) && (asoc->numduptsns)) {
10882 dup = (uint32_t *)gap_descriptor;
10883 for (i = 0; i < asoc->numduptsns; i++) {
10884 *dup = htonl(asoc->dup_tsns[i]);
10885 dup++;
10886 num_dups++;
10887 if (((caddr_t)dup + sizeof(uint32_t)) > limit) {
10888 /* no more room */
10889 break;
10890 }
10891 }
10892 asoc->numduptsns = 0;
10893 }
10894 /*
10895 * now that the chunk is prepared queue it to the control chunk
10896 * queue.
10897 */
10898 if (type == SCTP_SELECTIVE_ACK) {
10899 a_chk->send_size = (uint16_t)(sizeof(struct sctp_sack_chunk) +
10900 (num_gap_blocks + num_nr_gap_blocks) * sizeof(struct sctp_gap_ack_block) +
10901 num_dups * sizeof(int32_t));
10902 SCTP_BUF_LEN(a_chk->data) = a_chk->send_size;
10903 sack->sack.cum_tsn_ack = htonl(asoc->cumulative_tsn);
10904 sack->sack.a_rwnd = htonl(asoc->my_rwnd);
10905 sack->sack.num_gap_ack_blks = htons(num_gap_blocks);
10906 sack->sack.num_dup_tsns = htons(num_dups);
10907 sack->ch.chunk_type = type;
10908 sack->ch.chunk_flags = flags;
10909 sack->ch.chunk_length = htons(a_chk->send_size);
10910 } else {
10911 a_chk->send_size = (uint16_t)(sizeof(struct sctp_nr_sack_chunk) +
10912 (num_gap_blocks + num_nr_gap_blocks) * sizeof(struct sctp_gap_ack_block) +
10913 num_dups * sizeof(int32_t));
10914 SCTP_BUF_LEN(a_chk->data) = a_chk->send_size;
10915 nr_sack->nr_sack.cum_tsn_ack = htonl(asoc->cumulative_tsn);
10916 nr_sack->nr_sack.a_rwnd = htonl(asoc->my_rwnd);
10917 nr_sack->nr_sack.num_gap_ack_blks = htons(num_gap_blocks);
10918 nr_sack->nr_sack.num_nr_gap_ack_blks = htons(num_nr_gap_blocks);
10919 nr_sack->nr_sack.num_dup_tsns = htons(num_dups);
10920 nr_sack->nr_sack.reserved = 0;
10921 nr_sack->ch.chunk_type = type;
10922 nr_sack->ch.chunk_flags = flags;
10923 nr_sack->ch.chunk_length = htons(a_chk->send_size);
10924 }
10925 TAILQ_INSERT_TAIL(&asoc->control_send_queue, a_chk, sctp_next);
10926 asoc->my_last_reported_rwnd = asoc->my_rwnd;
10927 asoc->ctrl_queue_cnt++;
10928 asoc->send_sack = 0;
10929 SCTP_STAT_INCR(sctps_sendsacks);
10930 return;
10931 }
10932
10933 void
sctp_send_abort_tcb(struct sctp_tcb * stcb,struct mbuf * operr,int so_locked SCTP_UNUSED)10934 sctp_send_abort_tcb(struct sctp_tcb *stcb, struct mbuf *operr, int so_locked
10935 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
10936 SCTP_UNUSED
10937 #endif
10938 )
10939 {
10940 struct mbuf *m_abort, *m, *m_last;
10941 struct mbuf *m_out, *m_end = NULL;
10942 struct sctp_abort_chunk *abort;
10943 struct sctp_auth_chunk *auth = NULL;
10944 struct sctp_nets *net;
10945 uint32_t vtag;
10946 uint32_t auth_offset = 0;
10947 int error;
10948 uint16_t cause_len, chunk_len, padding_len;
10949
10950 SCTP_TCB_LOCK_ASSERT(stcb);
10951 /*-
10952 * Add an AUTH chunk, if chunk requires it and save the offset into
10953 * the chain for AUTH
10954 */
10955 if (sctp_auth_is_required_chunk(SCTP_ABORT_ASSOCIATION,
10956 stcb->asoc.peer_auth_chunks)) {
10957 m_out = sctp_add_auth_chunk(NULL, &m_end, &auth, &auth_offset,
10958 stcb, SCTP_ABORT_ASSOCIATION);
10959 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
10960 } else {
10961 m_out = NULL;
10962 }
10963 m_abort = sctp_get_mbuf_for_msg(sizeof(struct sctp_abort_chunk), 0, M_NOWAIT, 1, MT_HEADER);
10964 if (m_abort == NULL) {
10965 if (m_out) {
10966 sctp_m_freem(m_out);
10967 }
10968 if (operr) {
10969 sctp_m_freem(operr);
10970 }
10971 return;
10972 }
10973 /* link in any error */
10974 SCTP_BUF_NEXT(m_abort) = operr;
10975 cause_len = 0;
10976 m_last = NULL;
10977 for (m = operr; m; m = SCTP_BUF_NEXT(m)) {
10978 cause_len += (uint16_t)SCTP_BUF_LEN(m);
10979 if (SCTP_BUF_NEXT(m) == NULL) {
10980 m_last = m;
10981 }
10982 }
10983 SCTP_BUF_LEN(m_abort) = sizeof(struct sctp_abort_chunk);
10984 chunk_len = (uint16_t)sizeof(struct sctp_abort_chunk) + cause_len;
10985 padding_len = SCTP_SIZE32(chunk_len) - chunk_len;
10986 if (m_out == NULL) {
10987 /* NO Auth chunk prepended, so reserve space in front */
10988 SCTP_BUF_RESV_UF(m_abort, SCTP_MIN_OVERHEAD);
10989 m_out = m_abort;
10990 } else {
10991 /* Put AUTH chunk at the front of the chain */
10992 SCTP_BUF_NEXT(m_end) = m_abort;
10993 }
10994 if (stcb->asoc.alternate) {
10995 net = stcb->asoc.alternate;
10996 } else {
10997 net = stcb->asoc.primary_destination;
10998 }
10999 /* Fill in the ABORT chunk header. */
11000 abort = mtod(m_abort, struct sctp_abort_chunk *);
11001 abort->ch.chunk_type = SCTP_ABORT_ASSOCIATION;
11002 if (stcb->asoc.peer_vtag == 0) {
11003 /* This happens iff the assoc is in COOKIE-WAIT state. */
11004 vtag = stcb->asoc.my_vtag;
11005 abort->ch.chunk_flags = SCTP_HAD_NO_TCB;
11006 } else {
11007 vtag = stcb->asoc.peer_vtag;
11008 abort->ch.chunk_flags = 0;
11009 }
11010 abort->ch.chunk_length = htons(chunk_len);
11011 /* Add padding, if necessary. */
11012 if (padding_len > 0) {
11013 if ((m_last == NULL) ||
11014 (sctp_add_pad_tombuf(m_last, padding_len) == NULL)) {
11015 sctp_m_freem(m_out);
11016 return;
11017 }
11018 }
11019 if ((error = sctp_lowlevel_chunk_output(stcb->sctp_ep, stcb, net,
11020 (struct sockaddr *)&net->ro._l_addr,
11021 m_out, auth_offset, auth, stcb->asoc.authinfo.active_keyid, 1, 0, 0,
11022 stcb->sctp_ep->sctp_lport, stcb->rport, htonl(vtag),
11023 stcb->asoc.primary_destination->port, NULL,
11024 0, 0,
11025 so_locked))) {
11026 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
11027 if (error == ENOBUFS) {
11028 stcb->asoc.ifp_had_enobuf = 1;
11029 SCTP_STAT_INCR(sctps_lowlevelerr);
11030 }
11031 } else {
11032 stcb->asoc.ifp_had_enobuf = 0;
11033 }
11034 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
11035 }
11036
11037 void
sctp_send_shutdown_complete(struct sctp_tcb * stcb,struct sctp_nets * net,int reflect_vtag)11038 sctp_send_shutdown_complete(struct sctp_tcb *stcb,
11039 struct sctp_nets *net,
11040 int reflect_vtag)
11041 {
11042 /* formulate and SEND a SHUTDOWN-COMPLETE */
11043 struct mbuf *m_shutdown_comp;
11044 struct sctp_shutdown_complete_chunk *shutdown_complete;
11045 uint32_t vtag;
11046 int error;
11047 uint8_t flags;
11048
11049 m_shutdown_comp = sctp_get_mbuf_for_msg(sizeof(struct sctp_chunkhdr), 0, M_NOWAIT, 1, MT_HEADER);
11050 if (m_shutdown_comp == NULL) {
11051 /* no mbuf's */
11052 return;
11053 }
11054 if (reflect_vtag) {
11055 flags = SCTP_HAD_NO_TCB;
11056 vtag = stcb->asoc.my_vtag;
11057 } else {
11058 flags = 0;
11059 vtag = stcb->asoc.peer_vtag;
11060 }
11061 shutdown_complete = mtod(m_shutdown_comp, struct sctp_shutdown_complete_chunk *);
11062 shutdown_complete->ch.chunk_type = SCTP_SHUTDOWN_COMPLETE;
11063 shutdown_complete->ch.chunk_flags = flags;
11064 shutdown_complete->ch.chunk_length = htons(sizeof(struct sctp_shutdown_complete_chunk));
11065 SCTP_BUF_LEN(m_shutdown_comp) = sizeof(struct sctp_shutdown_complete_chunk);
11066 if ((error = sctp_lowlevel_chunk_output(stcb->sctp_ep, stcb, net,
11067 (struct sockaddr *)&net->ro._l_addr,
11068 m_shutdown_comp, 0, NULL, 0, 1, 0, 0,
11069 stcb->sctp_ep->sctp_lport, stcb->rport,
11070 htonl(vtag),
11071 net->port, NULL,
11072 0, 0,
11073 SCTP_SO_NOT_LOCKED))) {
11074 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
11075 if (error == ENOBUFS) {
11076 stcb->asoc.ifp_had_enobuf = 1;
11077 SCTP_STAT_INCR(sctps_lowlevelerr);
11078 }
11079 } else {
11080 stcb->asoc.ifp_had_enobuf = 0;
11081 }
11082 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
11083 return;
11084 }
11085
11086 static void
sctp_send_resp_msg(struct sockaddr * src,struct sockaddr * dst,struct sctphdr * sh,uint32_t vtag,uint8_t type,struct mbuf * cause,uint8_t mflowtype,uint32_t mflowid,uint16_t fibnum,uint32_t vrf_id,uint16_t port)11087 sctp_send_resp_msg(struct sockaddr *src, struct sockaddr *dst,
11088 struct sctphdr *sh, uint32_t vtag,
11089 uint8_t type, struct mbuf *cause,
11090 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
11091 uint32_t vrf_id, uint16_t port)
11092 {
11093 struct mbuf *o_pak;
11094 struct mbuf *mout;
11095 struct sctphdr *shout;
11096 struct sctp_chunkhdr *ch;
11097 #if defined(INET) || defined(INET6)
11098 struct udphdr *udp;
11099 #endif
11100 int ret, len, cause_len, padding_len;
11101 #ifdef INET
11102 struct sockaddr_in *src_sin, *dst_sin;
11103 struct ip *ip;
11104 #endif
11105 #ifdef INET6
11106 struct sockaddr_in6 *src_sin6, *dst_sin6;
11107 struct ip6_hdr *ip6;
11108 #endif
11109
11110 /* Compute the length of the cause and add final padding. */
11111 cause_len = 0;
11112 if (cause != NULL) {
11113 struct mbuf *m_at, *m_last = NULL;
11114
11115 for (m_at = cause; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
11116 if (SCTP_BUF_NEXT(m_at) == NULL)
11117 m_last = m_at;
11118 cause_len += SCTP_BUF_LEN(m_at);
11119 }
11120 padding_len = cause_len % 4;
11121 if (padding_len != 0) {
11122 padding_len = 4 - padding_len;
11123 }
11124 if (padding_len != 0) {
11125 if (sctp_add_pad_tombuf(m_last, padding_len) == NULL) {
11126 sctp_m_freem(cause);
11127 return;
11128 }
11129 }
11130 } else {
11131 padding_len = 0;
11132 }
11133 /* Get an mbuf for the header. */
11134 len = sizeof(struct sctphdr) + sizeof(struct sctp_chunkhdr);
11135 switch (dst->sa_family) {
11136 #ifdef INET
11137 case AF_INET:
11138 len += sizeof(struct ip);
11139 break;
11140 #endif
11141 #ifdef INET6
11142 case AF_INET6:
11143 len += sizeof(struct ip6_hdr);
11144 break;
11145 #endif
11146 default:
11147 break;
11148 }
11149 #if defined(INET) || defined(INET6)
11150 if (port) {
11151 len += sizeof(struct udphdr);
11152 }
11153 #endif
11154 mout = sctp_get_mbuf_for_msg(len + max_linkhdr, 1, M_NOWAIT, 1, MT_DATA);
11155 if (mout == NULL) {
11156 if (cause) {
11157 sctp_m_freem(cause);
11158 }
11159 return;
11160 }
11161 SCTP_BUF_RESV_UF(mout, max_linkhdr);
11162 SCTP_BUF_LEN(mout) = len;
11163 SCTP_BUF_NEXT(mout) = cause;
11164 M_SETFIB(mout, fibnum);
11165 mout->m_pkthdr.flowid = mflowid;
11166 M_HASHTYPE_SET(mout, mflowtype);
11167 #ifdef INET
11168 ip = NULL;
11169 #endif
11170 #ifdef INET6
11171 ip6 = NULL;
11172 #endif
11173 switch (dst->sa_family) {
11174 #ifdef INET
11175 case AF_INET:
11176 src_sin = (struct sockaddr_in *)src;
11177 dst_sin = (struct sockaddr_in *)dst;
11178 ip = mtod(mout, struct ip *);
11179 ip->ip_v = IPVERSION;
11180 ip->ip_hl = (sizeof(struct ip) >> 2);
11181 ip->ip_tos = 0;
11182 ip->ip_off = htons(IP_DF);
11183 ip_fillid(ip);
11184 ip->ip_ttl = MODULE_GLOBAL(ip_defttl);
11185 if (port) {
11186 ip->ip_p = IPPROTO_UDP;
11187 } else {
11188 ip->ip_p = IPPROTO_SCTP;
11189 }
11190 ip->ip_src.s_addr = dst_sin->sin_addr.s_addr;
11191 ip->ip_dst.s_addr = src_sin->sin_addr.s_addr;
11192 ip->ip_sum = 0;
11193 len = sizeof(struct ip);
11194 shout = (struct sctphdr *)((caddr_t)ip + len);
11195 break;
11196 #endif
11197 #ifdef INET6
11198 case AF_INET6:
11199 src_sin6 = (struct sockaddr_in6 *)src;
11200 dst_sin6 = (struct sockaddr_in6 *)dst;
11201 ip6 = mtod(mout, struct ip6_hdr *);
11202 ip6->ip6_flow = htonl(0x60000000);
11203 if (V_ip6_auto_flowlabel) {
11204 ip6->ip6_flow |= (htonl(ip6_randomflowlabel()) & IPV6_FLOWLABEL_MASK);
11205 }
11206 ip6->ip6_hlim = MODULE_GLOBAL(ip6_defhlim);
11207 if (port) {
11208 ip6->ip6_nxt = IPPROTO_UDP;
11209 } else {
11210 ip6->ip6_nxt = IPPROTO_SCTP;
11211 }
11212 ip6->ip6_src = dst_sin6->sin6_addr;
11213 ip6->ip6_dst = src_sin6->sin6_addr;
11214 len = sizeof(struct ip6_hdr);
11215 shout = (struct sctphdr *)((caddr_t)ip6 + len);
11216 break;
11217 #endif
11218 default:
11219 len = 0;
11220 shout = mtod(mout, struct sctphdr *);
11221 break;
11222 }
11223 #if defined(INET) || defined(INET6)
11224 if (port) {
11225 if (htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port)) == 0) {
11226 sctp_m_freem(mout);
11227 return;
11228 }
11229 udp = (struct udphdr *)shout;
11230 udp->uh_sport = htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port));
11231 udp->uh_dport = port;
11232 udp->uh_sum = 0;
11233 udp->uh_ulen = htons((uint16_t)(sizeof(struct udphdr) +
11234 sizeof(struct sctphdr) +
11235 sizeof(struct sctp_chunkhdr) +
11236 cause_len + padding_len));
11237 len += sizeof(struct udphdr);
11238 shout = (struct sctphdr *)((caddr_t)shout + sizeof(struct udphdr));
11239 } else {
11240 udp = NULL;
11241 }
11242 #endif
11243 shout->src_port = sh->dest_port;
11244 shout->dest_port = sh->src_port;
11245 shout->checksum = 0;
11246 if (vtag) {
11247 shout->v_tag = htonl(vtag);
11248 } else {
11249 shout->v_tag = sh->v_tag;
11250 }
11251 len += sizeof(struct sctphdr);
11252 ch = (struct sctp_chunkhdr *)((caddr_t)shout + sizeof(struct sctphdr));
11253 ch->chunk_type = type;
11254 if (vtag) {
11255 ch->chunk_flags = 0;
11256 } else {
11257 ch->chunk_flags = SCTP_HAD_NO_TCB;
11258 }
11259 ch->chunk_length = htons((uint16_t)(sizeof(struct sctp_chunkhdr) + cause_len));
11260 len += sizeof(struct sctp_chunkhdr);
11261 len += cause_len + padding_len;
11262
11263 if (SCTP_GET_HEADER_FOR_OUTPUT(o_pak)) {
11264 sctp_m_freem(mout);
11265 return;
11266 }
11267 SCTP_ATTACH_CHAIN(o_pak, mout, len);
11268 switch (dst->sa_family) {
11269 #ifdef INET
11270 case AF_INET:
11271 if (port) {
11272 if (V_udp_cksum) {
11273 udp->uh_sum = in_pseudo(ip->ip_src.s_addr, ip->ip_dst.s_addr, udp->uh_ulen + htons(IPPROTO_UDP));
11274 } else {
11275 udp->uh_sum = 0;
11276 }
11277 }
11278 ip->ip_len = htons(len);
11279 if (port) {
11280 shout->checksum = sctp_calculate_cksum(mout, sizeof(struct ip) + sizeof(struct udphdr));
11281 SCTP_STAT_INCR(sctps_sendswcrc);
11282 if (V_udp_cksum) {
11283 SCTP_ENABLE_UDP_CSUM(o_pak);
11284 }
11285 } else {
11286 mout->m_pkthdr.csum_flags = CSUM_SCTP;
11287 mout->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
11288 SCTP_STAT_INCR(sctps_sendhwcrc);
11289 }
11290 #ifdef SCTP_PACKET_LOGGING
11291 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING) {
11292 sctp_packet_log(o_pak);
11293 }
11294 #endif
11295 SCTP_PROBE5(send, NULL, NULL, ip, NULL, shout);
11296 SCTP_IP_OUTPUT(ret, o_pak, NULL, NULL, vrf_id);
11297 break;
11298 #endif
11299 #ifdef INET6
11300 case AF_INET6:
11301 ip6->ip6_plen = htons((uint16_t)(len - sizeof(struct ip6_hdr)));
11302 if (port) {
11303 shout->checksum = sctp_calculate_cksum(mout, sizeof(struct ip6_hdr) + sizeof(struct udphdr));
11304 SCTP_STAT_INCR(sctps_sendswcrc);
11305 if ((udp->uh_sum = in6_cksum(o_pak, IPPROTO_UDP, sizeof(struct ip6_hdr), len - sizeof(struct ip6_hdr))) == 0) {
11306 udp->uh_sum = 0xffff;
11307 }
11308 } else {
11309 mout->m_pkthdr.csum_flags = CSUM_SCTP_IPV6;
11310 mout->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
11311 SCTP_STAT_INCR(sctps_sendhwcrc);
11312 }
11313 #ifdef SCTP_PACKET_LOGGING
11314 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING) {
11315 sctp_packet_log(o_pak);
11316 }
11317 #endif
11318 SCTP_PROBE5(send, NULL, NULL, ip6, NULL, shout);
11319 SCTP_IP6_OUTPUT(ret, o_pak, NULL, NULL, NULL, vrf_id);
11320 break;
11321 #endif
11322 default:
11323 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Unknown protocol (TSNH) type %d\n",
11324 dst->sa_family);
11325 sctp_m_freem(mout);
11326 SCTP_LTRACE_ERR_RET_PKT(mout, NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EFAULT);
11327 return;
11328 }
11329 SCTPDBG(SCTP_DEBUG_OUTPUT3, "return from send is %d\n", ret);
11330 if (port) {
11331 UDPSTAT_INC(udps_opackets);
11332 }
11333 SCTP_STAT_INCR(sctps_sendpackets);
11334 SCTP_STAT_INCR_COUNTER64(sctps_outpackets);
11335 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
11336 if (ret) {
11337 SCTP_STAT_INCR(sctps_senderrors);
11338 }
11339 return;
11340 }
11341
11342 void
sctp_send_shutdown_complete2(struct sockaddr * src,struct sockaddr * dst,struct sctphdr * sh,uint8_t mflowtype,uint32_t mflowid,uint16_t fibnum,uint32_t vrf_id,uint16_t port)11343 sctp_send_shutdown_complete2(struct sockaddr *src, struct sockaddr *dst,
11344 struct sctphdr *sh,
11345 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
11346 uint32_t vrf_id, uint16_t port)
11347 {
11348 sctp_send_resp_msg(src, dst, sh, 0, SCTP_SHUTDOWN_COMPLETE, NULL,
11349 mflowtype, mflowid, fibnum,
11350 vrf_id, port);
11351 }
11352
11353 void
sctp_send_hb(struct sctp_tcb * stcb,struct sctp_nets * net,int so_locked SCTP_UNUSED)11354 sctp_send_hb(struct sctp_tcb *stcb, struct sctp_nets *net, int so_locked
11355 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
11356 SCTP_UNUSED
11357 #endif
11358 )
11359 {
11360 struct sctp_tmit_chunk *chk;
11361 struct sctp_heartbeat_chunk *hb;
11362 struct timeval now;
11363
11364 SCTP_TCB_LOCK_ASSERT(stcb);
11365 if (net == NULL) {
11366 return;
11367 }
11368 (void)SCTP_GETTIME_TIMEVAL(&now);
11369 switch (net->ro._l_addr.sa.sa_family) {
11370 #ifdef INET
11371 case AF_INET:
11372 break;
11373 #endif
11374 #ifdef INET6
11375 case AF_INET6:
11376 break;
11377 #endif
11378 default:
11379 return;
11380 }
11381 sctp_alloc_a_chunk(stcb, chk);
11382 if (chk == NULL) {
11383 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Gak, can't get a chunk for hb\n");
11384 return;
11385 }
11386
11387 chk->copy_by_ref = 0;
11388 chk->rec.chunk_id.id = SCTP_HEARTBEAT_REQUEST;
11389 chk->rec.chunk_id.can_take_data = 1;
11390 chk->flags = 0;
11391 chk->asoc = &stcb->asoc;
11392 chk->send_size = sizeof(struct sctp_heartbeat_chunk);
11393
11394 chk->data = sctp_get_mbuf_for_msg(chk->send_size, 0, M_NOWAIT, 1, MT_HEADER);
11395 if (chk->data == NULL) {
11396 sctp_free_a_chunk(stcb, chk, so_locked);
11397 return;
11398 }
11399 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11400 SCTP_BUF_LEN(chk->data) = chk->send_size;
11401 chk->sent = SCTP_DATAGRAM_UNSENT;
11402 chk->snd_count = 0;
11403 chk->whoTo = net;
11404 atomic_add_int(&chk->whoTo->ref_count, 1);
11405 /* Now we have a mbuf that we can fill in with the details */
11406 hb = mtod(chk->data, struct sctp_heartbeat_chunk *);
11407 memset(hb, 0, sizeof(struct sctp_heartbeat_chunk));
11408 /* fill out chunk header */
11409 hb->ch.chunk_type = SCTP_HEARTBEAT_REQUEST;
11410 hb->ch.chunk_flags = 0;
11411 hb->ch.chunk_length = htons(chk->send_size);
11412 /* Fill out hb parameter */
11413 hb->heartbeat.hb_info.ph.param_type = htons(SCTP_HEARTBEAT_INFO);
11414 hb->heartbeat.hb_info.ph.param_length = htons(sizeof(struct sctp_heartbeat_info_param));
11415 hb->heartbeat.hb_info.time_value_1 = now.tv_sec;
11416 hb->heartbeat.hb_info.time_value_2 = now.tv_usec;
11417 /* Did our user request this one, put it in */
11418 hb->heartbeat.hb_info.addr_family = (uint8_t)net->ro._l_addr.sa.sa_family;
11419 hb->heartbeat.hb_info.addr_len = net->ro._l_addr.sa.sa_len;
11420 if (net->dest_state & SCTP_ADDR_UNCONFIRMED) {
11421 /*
11422 * we only take from the entropy pool if the address is not
11423 * confirmed.
11424 */
11425 net->heartbeat_random1 = hb->heartbeat.hb_info.random_value1 = sctp_select_initial_TSN(&stcb->sctp_ep->sctp_ep);
11426 net->heartbeat_random2 = hb->heartbeat.hb_info.random_value2 = sctp_select_initial_TSN(&stcb->sctp_ep->sctp_ep);
11427 } else {
11428 net->heartbeat_random1 = hb->heartbeat.hb_info.random_value1 = 0;
11429 net->heartbeat_random2 = hb->heartbeat.hb_info.random_value2 = 0;
11430 }
11431 switch (net->ro._l_addr.sa.sa_family) {
11432 #ifdef INET
11433 case AF_INET:
11434 memcpy(hb->heartbeat.hb_info.address,
11435 &net->ro._l_addr.sin.sin_addr,
11436 sizeof(net->ro._l_addr.sin.sin_addr));
11437 break;
11438 #endif
11439 #ifdef INET6
11440 case AF_INET6:
11441 memcpy(hb->heartbeat.hb_info.address,
11442 &net->ro._l_addr.sin6.sin6_addr,
11443 sizeof(net->ro._l_addr.sin6.sin6_addr));
11444 break;
11445 #endif
11446 default:
11447 if (chk->data) {
11448 sctp_m_freem(chk->data);
11449 chk->data = NULL;
11450 }
11451 sctp_free_a_chunk(stcb, chk, so_locked);
11452 return;
11453 break;
11454 }
11455 net->hb_responded = 0;
11456 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
11457 stcb->asoc.ctrl_queue_cnt++;
11458 SCTP_STAT_INCR(sctps_sendheartbeat);
11459 return;
11460 }
11461
11462 void
sctp_send_ecn_echo(struct sctp_tcb * stcb,struct sctp_nets * net,uint32_t high_tsn)11463 sctp_send_ecn_echo(struct sctp_tcb *stcb, struct sctp_nets *net,
11464 uint32_t high_tsn)
11465 {
11466 struct sctp_association *asoc;
11467 struct sctp_ecne_chunk *ecne;
11468 struct sctp_tmit_chunk *chk;
11469
11470 if (net == NULL) {
11471 return;
11472 }
11473 asoc = &stcb->asoc;
11474 SCTP_TCB_LOCK_ASSERT(stcb);
11475 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
11476 if ((chk->rec.chunk_id.id == SCTP_ECN_ECHO) && (net == chk->whoTo)) {
11477 /* found a previous ECN_ECHO update it if needed */
11478 uint32_t cnt, ctsn;
11479
11480 ecne = mtod(chk->data, struct sctp_ecne_chunk *);
11481 ctsn = ntohl(ecne->tsn);
11482 if (SCTP_TSN_GT(high_tsn, ctsn)) {
11483 ecne->tsn = htonl(high_tsn);
11484 SCTP_STAT_INCR(sctps_queue_upd_ecne);
11485 }
11486 cnt = ntohl(ecne->num_pkts_since_cwr);
11487 cnt++;
11488 ecne->num_pkts_since_cwr = htonl(cnt);
11489 return;
11490 }
11491 }
11492 /* nope could not find one to update so we must build one */
11493 sctp_alloc_a_chunk(stcb, chk);
11494 if (chk == NULL) {
11495 return;
11496 }
11497 SCTP_STAT_INCR(sctps_queue_upd_ecne);
11498 chk->copy_by_ref = 0;
11499 chk->rec.chunk_id.id = SCTP_ECN_ECHO;
11500 chk->rec.chunk_id.can_take_data = 0;
11501 chk->flags = 0;
11502 chk->asoc = &stcb->asoc;
11503 chk->send_size = sizeof(struct sctp_ecne_chunk);
11504 chk->data = sctp_get_mbuf_for_msg(chk->send_size, 0, M_NOWAIT, 1, MT_HEADER);
11505 if (chk->data == NULL) {
11506 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11507 return;
11508 }
11509 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11510 SCTP_BUF_LEN(chk->data) = chk->send_size;
11511 chk->sent = SCTP_DATAGRAM_UNSENT;
11512 chk->snd_count = 0;
11513 chk->whoTo = net;
11514 atomic_add_int(&chk->whoTo->ref_count, 1);
11515
11516 stcb->asoc.ecn_echo_cnt_onq++;
11517 ecne = mtod(chk->data, struct sctp_ecne_chunk *);
11518 ecne->ch.chunk_type = SCTP_ECN_ECHO;
11519 ecne->ch.chunk_flags = 0;
11520 ecne->ch.chunk_length = htons(sizeof(struct sctp_ecne_chunk));
11521 ecne->tsn = htonl(high_tsn);
11522 ecne->num_pkts_since_cwr = htonl(1);
11523 TAILQ_INSERT_HEAD(&stcb->asoc.control_send_queue, chk, sctp_next);
11524 asoc->ctrl_queue_cnt++;
11525 }
11526
11527 void
sctp_send_packet_dropped(struct sctp_tcb * stcb,struct sctp_nets * net,struct mbuf * m,int len,int iphlen,int bad_crc)11528 sctp_send_packet_dropped(struct sctp_tcb *stcb, struct sctp_nets *net,
11529 struct mbuf *m, int len, int iphlen, int bad_crc)
11530 {
11531 struct sctp_association *asoc;
11532 struct sctp_pktdrop_chunk *drp;
11533 struct sctp_tmit_chunk *chk;
11534 uint8_t *datap;
11535 int was_trunc = 0;
11536 int fullsz = 0;
11537 long spc;
11538 int offset;
11539 struct sctp_chunkhdr *ch, chunk_buf;
11540 unsigned int chk_length;
11541
11542 if (!stcb) {
11543 return;
11544 }
11545 asoc = &stcb->asoc;
11546 SCTP_TCB_LOCK_ASSERT(stcb);
11547 if (asoc->pktdrop_supported == 0) {
11548 /*-
11549 * peer must declare support before I send one.
11550 */
11551 return;
11552 }
11553 if (stcb->sctp_socket == NULL) {
11554 return;
11555 }
11556 sctp_alloc_a_chunk(stcb, chk);
11557 if (chk == NULL) {
11558 return;
11559 }
11560 chk->copy_by_ref = 0;
11561 chk->rec.chunk_id.id = SCTP_PACKET_DROPPED;
11562 chk->rec.chunk_id.can_take_data = 1;
11563 chk->flags = 0;
11564 len -= iphlen;
11565 chk->send_size = len;
11566 /* Validate that we do not have an ABORT in here. */
11567 offset = iphlen + sizeof(struct sctphdr);
11568 ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, offset,
11569 sizeof(*ch), (uint8_t *)&chunk_buf);
11570 while (ch != NULL) {
11571 chk_length = ntohs(ch->chunk_length);
11572 if (chk_length < sizeof(*ch)) {
11573 /* break to abort land */
11574 break;
11575 }
11576 switch (ch->chunk_type) {
11577 case SCTP_PACKET_DROPPED:
11578 case SCTP_ABORT_ASSOCIATION:
11579 case SCTP_INITIATION_ACK:
11580 /**
11581 * We don't respond with an PKT-DROP to an ABORT
11582 * or PKT-DROP. We also do not respond to an
11583 * INIT-ACK, because we can't know if the initiation
11584 * tag is correct or not.
11585 */
11586 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11587 return;
11588 default:
11589 break;
11590 }
11591 offset += SCTP_SIZE32(chk_length);
11592 ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, offset,
11593 sizeof(*ch), (uint8_t *)&chunk_buf);
11594 }
11595
11596 if ((len + SCTP_MAX_OVERHEAD + sizeof(struct sctp_pktdrop_chunk)) >
11597 min(stcb->asoc.smallest_mtu, MCLBYTES)) {
11598 /*
11599 * only send 1 mtu worth, trim off the excess on the end.
11600 */
11601 fullsz = len;
11602 len = min(stcb->asoc.smallest_mtu, MCLBYTES) - SCTP_MAX_OVERHEAD;
11603 was_trunc = 1;
11604 }
11605 chk->asoc = &stcb->asoc;
11606 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
11607 if (chk->data == NULL) {
11608 jump_out:
11609 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11610 return;
11611 }
11612 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11613 drp = mtod(chk->data, struct sctp_pktdrop_chunk *);
11614 if (drp == NULL) {
11615 sctp_m_freem(chk->data);
11616 chk->data = NULL;
11617 goto jump_out;
11618 }
11619 chk->book_size = SCTP_SIZE32((chk->send_size + sizeof(struct sctp_pktdrop_chunk) +
11620 sizeof(struct sctphdr) + SCTP_MED_OVERHEAD));
11621 chk->book_size_scale = 0;
11622 if (was_trunc) {
11623 drp->ch.chunk_flags = SCTP_PACKET_TRUNCATED;
11624 drp->trunc_len = htons(fullsz);
11625 /*
11626 * Len is already adjusted to size minus overhead above take
11627 * out the pkt_drop chunk itself from it.
11628 */
11629 chk->send_size = (uint16_t)(len - sizeof(struct sctp_pktdrop_chunk));
11630 len = chk->send_size;
11631 } else {
11632 /* no truncation needed */
11633 drp->ch.chunk_flags = 0;
11634 drp->trunc_len = htons(0);
11635 }
11636 if (bad_crc) {
11637 drp->ch.chunk_flags |= SCTP_BADCRC;
11638 }
11639 chk->send_size += sizeof(struct sctp_pktdrop_chunk);
11640 SCTP_BUF_LEN(chk->data) = chk->send_size;
11641 chk->sent = SCTP_DATAGRAM_UNSENT;
11642 chk->snd_count = 0;
11643 if (net) {
11644 /* we should hit here */
11645 chk->whoTo = net;
11646 atomic_add_int(&chk->whoTo->ref_count, 1);
11647 } else {
11648 chk->whoTo = NULL;
11649 }
11650 drp->ch.chunk_type = SCTP_PACKET_DROPPED;
11651 drp->ch.chunk_length = htons(chk->send_size);
11652 spc = SCTP_SB_LIMIT_RCV(stcb->sctp_socket);
11653 if (spc < 0) {
11654 spc = 0;
11655 }
11656 drp->bottle_bw = htonl(spc);
11657 if (asoc->my_rwnd) {
11658 drp->current_onq = htonl(asoc->size_on_reasm_queue +
11659 asoc->size_on_all_streams +
11660 asoc->my_rwnd_control_len +
11661 stcb->sctp_socket->so_rcv.sb_cc);
11662 } else {
11663 /*-
11664 * If my rwnd is 0, possibly from mbuf depletion as well as
11665 * space used, tell the peer there is NO space aka onq == bw
11666 */
11667 drp->current_onq = htonl(spc);
11668 }
11669 drp->reserved = 0;
11670 datap = drp->data;
11671 m_copydata(m, iphlen, len, (caddr_t)datap);
11672 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
11673 asoc->ctrl_queue_cnt++;
11674 }
11675
11676 void
sctp_send_cwr(struct sctp_tcb * stcb,struct sctp_nets * net,uint32_t high_tsn,uint8_t override)11677 sctp_send_cwr(struct sctp_tcb *stcb, struct sctp_nets *net, uint32_t high_tsn, uint8_t override)
11678 {
11679 struct sctp_association *asoc;
11680 struct sctp_cwr_chunk *cwr;
11681 struct sctp_tmit_chunk *chk;
11682
11683 SCTP_TCB_LOCK_ASSERT(stcb);
11684 if (net == NULL) {
11685 return;
11686 }
11687 asoc = &stcb->asoc;
11688 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
11689 if ((chk->rec.chunk_id.id == SCTP_ECN_CWR) && (net == chk->whoTo)) {
11690 /*
11691 * found a previous CWR queued to same destination
11692 * update it if needed
11693 */
11694 uint32_t ctsn;
11695
11696 cwr = mtod(chk->data, struct sctp_cwr_chunk *);
11697 ctsn = ntohl(cwr->tsn);
11698 if (SCTP_TSN_GT(high_tsn, ctsn)) {
11699 cwr->tsn = htonl(high_tsn);
11700 }
11701 if (override & SCTP_CWR_REDUCE_OVERRIDE) {
11702 /* Make sure override is carried */
11703 cwr->ch.chunk_flags |= SCTP_CWR_REDUCE_OVERRIDE;
11704 }
11705 return;
11706 }
11707 }
11708 sctp_alloc_a_chunk(stcb, chk);
11709 if (chk == NULL) {
11710 return;
11711 }
11712 chk->copy_by_ref = 0;
11713 chk->rec.chunk_id.id = SCTP_ECN_CWR;
11714 chk->rec.chunk_id.can_take_data = 1;
11715 chk->flags = 0;
11716 chk->asoc = &stcb->asoc;
11717 chk->send_size = sizeof(struct sctp_cwr_chunk);
11718 chk->data = sctp_get_mbuf_for_msg(chk->send_size, 0, M_NOWAIT, 1, MT_HEADER);
11719 if (chk->data == NULL) {
11720 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11721 return;
11722 }
11723 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11724 SCTP_BUF_LEN(chk->data) = chk->send_size;
11725 chk->sent = SCTP_DATAGRAM_UNSENT;
11726 chk->snd_count = 0;
11727 chk->whoTo = net;
11728 atomic_add_int(&chk->whoTo->ref_count, 1);
11729 cwr = mtod(chk->data, struct sctp_cwr_chunk *);
11730 cwr->ch.chunk_type = SCTP_ECN_CWR;
11731 cwr->ch.chunk_flags = override;
11732 cwr->ch.chunk_length = htons(sizeof(struct sctp_cwr_chunk));
11733 cwr->tsn = htonl(high_tsn);
11734 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
11735 asoc->ctrl_queue_cnt++;
11736 }
11737
11738 static int
sctp_add_stream_reset_out(struct sctp_tcb * stcb,struct sctp_tmit_chunk * chk,uint32_t seq,uint32_t resp_seq,uint32_t last_sent)11739 sctp_add_stream_reset_out(struct sctp_tcb *stcb, struct sctp_tmit_chunk *chk,
11740 uint32_t seq, uint32_t resp_seq, uint32_t last_sent)
11741 {
11742 uint16_t len, old_len, i;
11743 struct sctp_stream_reset_out_request *req_out;
11744 struct sctp_chunkhdr *ch;
11745 int at;
11746 int number_entries = 0;
11747
11748 ch = mtod(chk->data, struct sctp_chunkhdr *);
11749 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11750 /* get to new offset for the param. */
11751 req_out = (struct sctp_stream_reset_out_request *)((caddr_t)ch + len);
11752 /* now how long will this param be? */
11753 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
11754 if ((stcb->asoc.strmout[i].state == SCTP_STREAM_RESET_PENDING) &&
11755 (stcb->asoc.strmout[i].chunks_on_queues == 0) &&
11756 TAILQ_EMPTY(&stcb->asoc.strmout[i].outqueue)) {
11757 number_entries++;
11758 }
11759 }
11760 if (number_entries == 0) {
11761 return (0);
11762 }
11763 if (number_entries == stcb->asoc.streamoutcnt) {
11764 number_entries = 0;
11765 }
11766 if (number_entries > SCTP_MAX_STREAMS_AT_ONCE_RESET) {
11767 number_entries = SCTP_MAX_STREAMS_AT_ONCE_RESET;
11768 }
11769 len = (uint16_t)(sizeof(struct sctp_stream_reset_out_request) + (sizeof(uint16_t) * number_entries));
11770 req_out->ph.param_type = htons(SCTP_STR_RESET_OUT_REQUEST);
11771 req_out->ph.param_length = htons(len);
11772 req_out->request_seq = htonl(seq);
11773 req_out->response_seq = htonl(resp_seq);
11774 req_out->send_reset_at_tsn = htonl(last_sent);
11775 at = 0;
11776 if (number_entries) {
11777 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
11778 if ((stcb->asoc.strmout[i].state == SCTP_STREAM_RESET_PENDING) &&
11779 (stcb->asoc.strmout[i].chunks_on_queues == 0) &&
11780 TAILQ_EMPTY(&stcb->asoc.strmout[i].outqueue)) {
11781 req_out->list_of_streams[at] = htons(i);
11782 at++;
11783 stcb->asoc.strmout[i].state = SCTP_STREAM_RESET_IN_FLIGHT;
11784 if (at >= number_entries) {
11785 break;
11786 }
11787 }
11788 }
11789 } else {
11790 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
11791 stcb->asoc.strmout[i].state = SCTP_STREAM_RESET_IN_FLIGHT;
11792 }
11793 }
11794 if (SCTP_SIZE32(len) > len) {
11795 /*-
11796 * Need to worry about the pad we may end up adding to the
11797 * end. This is easy since the struct is either aligned to 4
11798 * bytes or 2 bytes off.
11799 */
11800 req_out->list_of_streams[number_entries] = 0;
11801 }
11802 /* now fix the chunk length */
11803 ch->chunk_length = htons(len + old_len);
11804 chk->book_size = len + old_len;
11805 chk->book_size_scale = 0;
11806 chk->send_size = SCTP_SIZE32(chk->book_size);
11807 SCTP_BUF_LEN(chk->data) = chk->send_size;
11808 return (1);
11809 }
11810
11811 static void
sctp_add_stream_reset_in(struct sctp_tmit_chunk * chk,int number_entries,uint16_t * list,uint32_t seq)11812 sctp_add_stream_reset_in(struct sctp_tmit_chunk *chk,
11813 int number_entries, uint16_t *list,
11814 uint32_t seq)
11815 {
11816 uint16_t len, old_len, i;
11817 struct sctp_stream_reset_in_request *req_in;
11818 struct sctp_chunkhdr *ch;
11819
11820 ch = mtod(chk->data, struct sctp_chunkhdr *);
11821 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11822
11823 /* get to new offset for the param. */
11824 req_in = (struct sctp_stream_reset_in_request *)((caddr_t)ch + len);
11825 /* now how long will this param be? */
11826 len = (uint16_t)(sizeof(struct sctp_stream_reset_in_request) + (sizeof(uint16_t) * number_entries));
11827 req_in->ph.param_type = htons(SCTP_STR_RESET_IN_REQUEST);
11828 req_in->ph.param_length = htons(len);
11829 req_in->request_seq = htonl(seq);
11830 if (number_entries) {
11831 for (i = 0; i < number_entries; i++) {
11832 req_in->list_of_streams[i] = htons(list[i]);
11833 }
11834 }
11835 if (SCTP_SIZE32(len) > len) {
11836 /*-
11837 * Need to worry about the pad we may end up adding to the
11838 * end. This is easy since the struct is either aligned to 4
11839 * bytes or 2 bytes off.
11840 */
11841 req_in->list_of_streams[number_entries] = 0;
11842 }
11843 /* now fix the chunk length */
11844 ch->chunk_length = htons(len + old_len);
11845 chk->book_size = len + old_len;
11846 chk->book_size_scale = 0;
11847 chk->send_size = SCTP_SIZE32(chk->book_size);
11848 SCTP_BUF_LEN(chk->data) = chk->send_size;
11849 return;
11850 }
11851
11852 static void
sctp_add_stream_reset_tsn(struct sctp_tmit_chunk * chk,uint32_t seq)11853 sctp_add_stream_reset_tsn(struct sctp_tmit_chunk *chk,
11854 uint32_t seq)
11855 {
11856 uint16_t len, old_len;
11857 struct sctp_stream_reset_tsn_request *req_tsn;
11858 struct sctp_chunkhdr *ch;
11859
11860 ch = mtod(chk->data, struct sctp_chunkhdr *);
11861 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11862
11863 /* get to new offset for the param. */
11864 req_tsn = (struct sctp_stream_reset_tsn_request *)((caddr_t)ch + len);
11865 /* now how long will this param be? */
11866 len = sizeof(struct sctp_stream_reset_tsn_request);
11867 req_tsn->ph.param_type = htons(SCTP_STR_RESET_TSN_REQUEST);
11868 req_tsn->ph.param_length = htons(len);
11869 req_tsn->request_seq = htonl(seq);
11870
11871 /* now fix the chunk length */
11872 ch->chunk_length = htons(len + old_len);
11873 chk->send_size = len + old_len;
11874 chk->book_size = SCTP_SIZE32(chk->send_size);
11875 chk->book_size_scale = 0;
11876 SCTP_BUF_LEN(chk->data) = SCTP_SIZE32(chk->send_size);
11877 return;
11878 }
11879
11880 void
sctp_add_stream_reset_result(struct sctp_tmit_chunk * chk,uint32_t resp_seq,uint32_t result)11881 sctp_add_stream_reset_result(struct sctp_tmit_chunk *chk,
11882 uint32_t resp_seq, uint32_t result)
11883 {
11884 uint16_t len, old_len;
11885 struct sctp_stream_reset_response *resp;
11886 struct sctp_chunkhdr *ch;
11887
11888 ch = mtod(chk->data, struct sctp_chunkhdr *);
11889 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11890
11891 /* get to new offset for the param. */
11892 resp = (struct sctp_stream_reset_response *)((caddr_t)ch + len);
11893 /* now how long will this param be? */
11894 len = sizeof(struct sctp_stream_reset_response);
11895 resp->ph.param_type = htons(SCTP_STR_RESET_RESPONSE);
11896 resp->ph.param_length = htons(len);
11897 resp->response_seq = htonl(resp_seq);
11898 resp->result = ntohl(result);
11899
11900 /* now fix the chunk length */
11901 ch->chunk_length = htons(len + old_len);
11902 chk->book_size = len + old_len;
11903 chk->book_size_scale = 0;
11904 chk->send_size = SCTP_SIZE32(chk->book_size);
11905 SCTP_BUF_LEN(chk->data) = chk->send_size;
11906 return;
11907 }
11908
11909 void
sctp_send_deferred_reset_response(struct sctp_tcb * stcb,struct sctp_stream_reset_list * ent,int response)11910 sctp_send_deferred_reset_response(struct sctp_tcb *stcb,
11911 struct sctp_stream_reset_list *ent,
11912 int response)
11913 {
11914 struct sctp_association *asoc;
11915 struct sctp_tmit_chunk *chk;
11916 struct sctp_chunkhdr *ch;
11917
11918 asoc = &stcb->asoc;
11919
11920 /*
11921 * Reset our last reset action to the new one IP -> response
11922 * (PERFORMED probably). This assures that if we fail to send, a
11923 * retran from the peer will get the new response.
11924 */
11925 asoc->last_reset_action[0] = response;
11926 if (asoc->stream_reset_outstanding) {
11927 return;
11928 }
11929 sctp_alloc_a_chunk(stcb, chk);
11930 if (chk == NULL) {
11931 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
11932 return;
11933 }
11934 chk->copy_by_ref = 0;
11935 chk->rec.chunk_id.id = SCTP_STREAM_RESET;
11936 chk->rec.chunk_id.can_take_data = 0;
11937 chk->flags = 0;
11938 chk->asoc = &stcb->asoc;
11939 chk->book_size = sizeof(struct sctp_chunkhdr);
11940 chk->send_size = SCTP_SIZE32(chk->book_size);
11941 chk->book_size_scale = 0;
11942 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
11943 if (chk->data == NULL) {
11944 sctp_free_a_chunk(stcb, chk, SCTP_SO_LOCKED);
11945 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
11946 return;
11947 }
11948 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11949 /* setup chunk parameters */
11950 chk->sent = SCTP_DATAGRAM_UNSENT;
11951 chk->snd_count = 0;
11952 if (stcb->asoc.alternate) {
11953 chk->whoTo = stcb->asoc.alternate;
11954 } else {
11955 chk->whoTo = stcb->asoc.primary_destination;
11956 }
11957 ch = mtod(chk->data, struct sctp_chunkhdr *);
11958 ch->chunk_type = SCTP_STREAM_RESET;
11959 ch->chunk_flags = 0;
11960 ch->chunk_length = htons(chk->book_size);
11961 atomic_add_int(&chk->whoTo->ref_count, 1);
11962 SCTP_BUF_LEN(chk->data) = chk->send_size;
11963 sctp_add_stream_reset_result(chk, ent->seq, response);
11964 /* insert the chunk for sending */
11965 TAILQ_INSERT_TAIL(&asoc->control_send_queue,
11966 chk,
11967 sctp_next);
11968 asoc->ctrl_queue_cnt++;
11969 }
11970
11971 void
sctp_add_stream_reset_result_tsn(struct sctp_tmit_chunk * chk,uint32_t resp_seq,uint32_t result,uint32_t send_una,uint32_t recv_next)11972 sctp_add_stream_reset_result_tsn(struct sctp_tmit_chunk *chk,
11973 uint32_t resp_seq, uint32_t result,
11974 uint32_t send_una, uint32_t recv_next)
11975 {
11976 uint16_t len, old_len;
11977 struct sctp_stream_reset_response_tsn *resp;
11978 struct sctp_chunkhdr *ch;
11979
11980 ch = mtod(chk->data, struct sctp_chunkhdr *);
11981 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11982
11983 /* get to new offset for the param. */
11984 resp = (struct sctp_stream_reset_response_tsn *)((caddr_t)ch + len);
11985 /* now how long will this param be? */
11986 len = sizeof(struct sctp_stream_reset_response_tsn);
11987 resp->ph.param_type = htons(SCTP_STR_RESET_RESPONSE);
11988 resp->ph.param_length = htons(len);
11989 resp->response_seq = htonl(resp_seq);
11990 resp->result = htonl(result);
11991 resp->senders_next_tsn = htonl(send_una);
11992 resp->receivers_next_tsn = htonl(recv_next);
11993
11994 /* now fix the chunk length */
11995 ch->chunk_length = htons(len + old_len);
11996 chk->book_size = len + old_len;
11997 chk->send_size = SCTP_SIZE32(chk->book_size);
11998 chk->book_size_scale = 0;
11999 SCTP_BUF_LEN(chk->data) = chk->send_size;
12000 return;
12001 }
12002
12003 static void
sctp_add_an_out_stream(struct sctp_tmit_chunk * chk,uint32_t seq,uint16_t adding)12004 sctp_add_an_out_stream(struct sctp_tmit_chunk *chk,
12005 uint32_t seq,
12006 uint16_t adding)
12007 {
12008 uint16_t len, old_len;
12009 struct sctp_chunkhdr *ch;
12010 struct sctp_stream_reset_add_strm *addstr;
12011
12012 ch = mtod(chk->data, struct sctp_chunkhdr *);
12013 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
12014
12015 /* get to new offset for the param. */
12016 addstr = (struct sctp_stream_reset_add_strm *)((caddr_t)ch + len);
12017 /* now how long will this param be? */
12018 len = sizeof(struct sctp_stream_reset_add_strm);
12019
12020 /* Fill it out. */
12021 addstr->ph.param_type = htons(SCTP_STR_RESET_ADD_OUT_STREAMS);
12022 addstr->ph.param_length = htons(len);
12023 addstr->request_seq = htonl(seq);
12024 addstr->number_of_streams = htons(adding);
12025 addstr->reserved = 0;
12026
12027 /* now fix the chunk length */
12028 ch->chunk_length = htons(len + old_len);
12029 chk->send_size = len + old_len;
12030 chk->book_size = SCTP_SIZE32(chk->send_size);
12031 chk->book_size_scale = 0;
12032 SCTP_BUF_LEN(chk->data) = SCTP_SIZE32(chk->send_size);
12033 return;
12034 }
12035
12036 static void
sctp_add_an_in_stream(struct sctp_tmit_chunk * chk,uint32_t seq,uint16_t adding)12037 sctp_add_an_in_stream(struct sctp_tmit_chunk *chk,
12038 uint32_t seq,
12039 uint16_t adding)
12040 {
12041 uint16_t len, old_len;
12042 struct sctp_chunkhdr *ch;
12043 struct sctp_stream_reset_add_strm *addstr;
12044
12045 ch = mtod(chk->data, struct sctp_chunkhdr *);
12046 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
12047
12048 /* get to new offset for the param. */
12049 addstr = (struct sctp_stream_reset_add_strm *)((caddr_t)ch + len);
12050 /* now how long will this param be? */
12051 len = sizeof(struct sctp_stream_reset_add_strm);
12052 /* Fill it out. */
12053 addstr->ph.param_type = htons(SCTP_STR_RESET_ADD_IN_STREAMS);
12054 addstr->ph.param_length = htons(len);
12055 addstr->request_seq = htonl(seq);
12056 addstr->number_of_streams = htons(adding);
12057 addstr->reserved = 0;
12058
12059 /* now fix the chunk length */
12060 ch->chunk_length = htons(len + old_len);
12061 chk->send_size = len + old_len;
12062 chk->book_size = SCTP_SIZE32(chk->send_size);
12063 chk->book_size_scale = 0;
12064 SCTP_BUF_LEN(chk->data) = SCTP_SIZE32(chk->send_size);
12065 return;
12066 }
12067
12068 int
sctp_send_stream_reset_out_if_possible(struct sctp_tcb * stcb,int so_locked)12069 sctp_send_stream_reset_out_if_possible(struct sctp_tcb *stcb, int so_locked)
12070 {
12071 struct sctp_association *asoc;
12072 struct sctp_tmit_chunk *chk;
12073 struct sctp_chunkhdr *ch;
12074 uint32_t seq;
12075
12076 asoc = &stcb->asoc;
12077 asoc->trigger_reset = 0;
12078 if (asoc->stream_reset_outstanding) {
12079 return (EALREADY);
12080 }
12081 sctp_alloc_a_chunk(stcb, chk);
12082 if (chk == NULL) {
12083 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12084 return (ENOMEM);
12085 }
12086 chk->copy_by_ref = 0;
12087 chk->rec.chunk_id.id = SCTP_STREAM_RESET;
12088 chk->rec.chunk_id.can_take_data = 0;
12089 chk->flags = 0;
12090 chk->asoc = &stcb->asoc;
12091 chk->book_size = sizeof(struct sctp_chunkhdr);
12092 chk->send_size = SCTP_SIZE32(chk->book_size);
12093 chk->book_size_scale = 0;
12094 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
12095 if (chk->data == NULL) {
12096 sctp_free_a_chunk(stcb, chk, so_locked);
12097 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12098 return (ENOMEM);
12099 }
12100 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
12101
12102 /* setup chunk parameters */
12103 chk->sent = SCTP_DATAGRAM_UNSENT;
12104 chk->snd_count = 0;
12105 if (stcb->asoc.alternate) {
12106 chk->whoTo = stcb->asoc.alternate;
12107 } else {
12108 chk->whoTo = stcb->asoc.primary_destination;
12109 }
12110 ch = mtod(chk->data, struct sctp_chunkhdr *);
12111 ch->chunk_type = SCTP_STREAM_RESET;
12112 ch->chunk_flags = 0;
12113 ch->chunk_length = htons(chk->book_size);
12114 atomic_add_int(&chk->whoTo->ref_count, 1);
12115 SCTP_BUF_LEN(chk->data) = chk->send_size;
12116 seq = stcb->asoc.str_reset_seq_out;
12117 if (sctp_add_stream_reset_out(stcb, chk, seq, (stcb->asoc.str_reset_seq_in - 1), (stcb->asoc.sending_seq - 1))) {
12118 seq++;
12119 asoc->stream_reset_outstanding++;
12120 } else {
12121 m_freem(chk->data);
12122 chk->data = NULL;
12123 sctp_free_a_chunk(stcb, chk, so_locked);
12124 return (ENOENT);
12125 }
12126 asoc->str_reset = chk;
12127 /* insert the chunk for sending */
12128 TAILQ_INSERT_TAIL(&asoc->control_send_queue,
12129 chk,
12130 sctp_next);
12131 asoc->ctrl_queue_cnt++;
12132
12133 if (stcb->asoc.send_sack) {
12134 sctp_send_sack(stcb, so_locked);
12135 }
12136 sctp_timer_start(SCTP_TIMER_TYPE_STRRESET, stcb->sctp_ep, stcb, chk->whoTo);
12137 return (0);
12138 }
12139
12140 int
sctp_send_str_reset_req(struct sctp_tcb * stcb,uint16_t number_entries,uint16_t * list,uint8_t send_in_req,uint8_t send_tsn_req,uint8_t add_stream,uint16_t adding_o,uint16_t adding_i,uint8_t peer_asked)12141 sctp_send_str_reset_req(struct sctp_tcb *stcb,
12142 uint16_t number_entries, uint16_t *list,
12143 uint8_t send_in_req,
12144 uint8_t send_tsn_req,
12145 uint8_t add_stream,
12146 uint16_t adding_o,
12147 uint16_t adding_i, uint8_t peer_asked)
12148 {
12149 struct sctp_association *asoc;
12150 struct sctp_tmit_chunk *chk;
12151 struct sctp_chunkhdr *ch;
12152 int can_send_out_req = 0;
12153 uint32_t seq;
12154
12155 asoc = &stcb->asoc;
12156 if (asoc->stream_reset_outstanding) {
12157 /*-
12158 * Already one pending, must get ACK back to clear the flag.
12159 */
12160 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EBUSY);
12161 return (EBUSY);
12162 }
12163 if ((send_in_req == 0) && (send_tsn_req == 0) &&
12164 (add_stream == 0)) {
12165 /* nothing to do */
12166 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12167 return (EINVAL);
12168 }
12169 if (send_tsn_req && send_in_req) {
12170 /* error, can't do that */
12171 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12172 return (EINVAL);
12173 } else if (send_in_req) {
12174 can_send_out_req = 1;
12175 }
12176 if (number_entries > (MCLBYTES -
12177 SCTP_MIN_OVERHEAD -
12178 sizeof(struct sctp_chunkhdr) -
12179 sizeof(struct sctp_stream_reset_out_request)) /
12180 sizeof(uint16_t)) {
12181 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12182 return (ENOMEM);
12183 }
12184 sctp_alloc_a_chunk(stcb, chk);
12185 if (chk == NULL) {
12186 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12187 return (ENOMEM);
12188 }
12189 chk->copy_by_ref = 0;
12190 chk->rec.chunk_id.id = SCTP_STREAM_RESET;
12191 chk->rec.chunk_id.can_take_data = 0;
12192 chk->flags = 0;
12193 chk->asoc = &stcb->asoc;
12194 chk->book_size = sizeof(struct sctp_chunkhdr);
12195 chk->send_size = SCTP_SIZE32(chk->book_size);
12196 chk->book_size_scale = 0;
12197 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
12198 if (chk->data == NULL) {
12199 sctp_free_a_chunk(stcb, chk, SCTP_SO_LOCKED);
12200 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12201 return (ENOMEM);
12202 }
12203 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
12204
12205 /* setup chunk parameters */
12206 chk->sent = SCTP_DATAGRAM_UNSENT;
12207 chk->snd_count = 0;
12208 if (stcb->asoc.alternate) {
12209 chk->whoTo = stcb->asoc.alternate;
12210 } else {
12211 chk->whoTo = stcb->asoc.primary_destination;
12212 }
12213 atomic_add_int(&chk->whoTo->ref_count, 1);
12214 ch = mtod(chk->data, struct sctp_chunkhdr *);
12215 ch->chunk_type = SCTP_STREAM_RESET;
12216 ch->chunk_flags = 0;
12217 ch->chunk_length = htons(chk->book_size);
12218 SCTP_BUF_LEN(chk->data) = chk->send_size;
12219
12220 seq = stcb->asoc.str_reset_seq_out;
12221 if (can_send_out_req) {
12222 int ret;
12223
12224 ret = sctp_add_stream_reset_out(stcb, chk, seq, (stcb->asoc.str_reset_seq_in - 1), (stcb->asoc.sending_seq - 1));
12225 if (ret) {
12226 seq++;
12227 asoc->stream_reset_outstanding++;
12228 }
12229 }
12230 if ((add_stream & 1) &&
12231 ((stcb->asoc.strm_realoutsize - stcb->asoc.streamoutcnt) < adding_o)) {
12232 /* Need to allocate more */
12233 struct sctp_stream_out *oldstream;
12234 struct sctp_stream_queue_pending *sp, *nsp;
12235 int i;
12236 #if defined(SCTP_DETAILED_STR_STATS)
12237 int j;
12238 #endif
12239
12240 oldstream = stcb->asoc.strmout;
12241 /* get some more */
12242 SCTP_MALLOC(stcb->asoc.strmout, struct sctp_stream_out *,
12243 (stcb->asoc.streamoutcnt + adding_o) * sizeof(struct sctp_stream_out),
12244 SCTP_M_STRMO);
12245 if (stcb->asoc.strmout == NULL) {
12246 uint8_t x;
12247
12248 stcb->asoc.strmout = oldstream;
12249 /* Turn off the bit */
12250 x = add_stream & 0xfe;
12251 add_stream = x;
12252 goto skip_stuff;
12253 }
12254 /*
12255 * Ok now we proceed with copying the old out stuff and
12256 * initializing the new stuff.
12257 */
12258 SCTP_TCB_SEND_LOCK(stcb);
12259 stcb->asoc.ss_functions.sctp_ss_clear(stcb, &stcb->asoc, 0, 1);
12260 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
12261 TAILQ_INIT(&stcb->asoc.strmout[i].outqueue);
12262 stcb->asoc.strmout[i].chunks_on_queues = oldstream[i].chunks_on_queues;
12263 stcb->asoc.strmout[i].next_mid_ordered = oldstream[i].next_mid_ordered;
12264 stcb->asoc.strmout[i].next_mid_unordered = oldstream[i].next_mid_unordered;
12265 stcb->asoc.strmout[i].last_msg_incomplete = oldstream[i].last_msg_incomplete;
12266 stcb->asoc.strmout[i].sid = i;
12267 stcb->asoc.strmout[i].state = oldstream[i].state;
12268 /* FIX ME FIX ME */
12269 /*
12270 * This should be a SS_COPY operation FIX ME STREAM
12271 * SCHEDULER EXPERT
12272 */
12273 stcb->asoc.ss_functions.sctp_ss_init_stream(stcb, &stcb->asoc.strmout[i], &oldstream[i]);
12274 /* now anything on those queues? */
12275 TAILQ_FOREACH_SAFE(sp, &oldstream[i].outqueue, next, nsp) {
12276 TAILQ_REMOVE(&oldstream[i].outqueue, sp, next);
12277 TAILQ_INSERT_TAIL(&stcb->asoc.strmout[i].outqueue, sp, next);
12278 }
12279
12280 }
12281 /* now the new streams */
12282 stcb->asoc.ss_functions.sctp_ss_init(stcb, &stcb->asoc, 1);
12283 for (i = stcb->asoc.streamoutcnt; i < (stcb->asoc.streamoutcnt + adding_o); i++) {
12284 TAILQ_INIT(&stcb->asoc.strmout[i].outqueue);
12285 stcb->asoc.strmout[i].chunks_on_queues = 0;
12286 #if defined(SCTP_DETAILED_STR_STATS)
12287 for (j = 0; j < SCTP_PR_SCTP_MAX + 1; j++) {
12288 stcb->asoc.strmout[i].abandoned_sent[j] = 0;
12289 stcb->asoc.strmout[i].abandoned_unsent[j] = 0;
12290 }
12291 #else
12292 stcb->asoc.strmout[i].abandoned_sent[0] = 0;
12293 stcb->asoc.strmout[i].abandoned_unsent[0] = 0;
12294 #endif
12295 stcb->asoc.strmout[i].next_mid_ordered = 0;
12296 stcb->asoc.strmout[i].next_mid_unordered = 0;
12297 stcb->asoc.strmout[i].sid = i;
12298 stcb->asoc.strmout[i].last_msg_incomplete = 0;
12299 stcb->asoc.ss_functions.sctp_ss_init_stream(stcb, &stcb->asoc.strmout[i], NULL);
12300 stcb->asoc.strmout[i].state = SCTP_STREAM_CLOSED;
12301 }
12302 stcb->asoc.strm_realoutsize = stcb->asoc.streamoutcnt + adding_o;
12303 SCTP_FREE(oldstream, SCTP_M_STRMO);
12304 SCTP_TCB_SEND_UNLOCK(stcb);
12305 }
12306 skip_stuff:
12307 if ((add_stream & 1) && (adding_o > 0)) {
12308 asoc->strm_pending_add_size = adding_o;
12309 asoc->peer_req_out = peer_asked;
12310 sctp_add_an_out_stream(chk, seq, adding_o);
12311 seq++;
12312 asoc->stream_reset_outstanding++;
12313 }
12314 if ((add_stream & 2) && (adding_i > 0)) {
12315 sctp_add_an_in_stream(chk, seq, adding_i);
12316 seq++;
12317 asoc->stream_reset_outstanding++;
12318 }
12319 if (send_in_req) {
12320 sctp_add_stream_reset_in(chk, number_entries, list, seq);
12321 seq++;
12322 asoc->stream_reset_outstanding++;
12323 }
12324 if (send_tsn_req) {
12325 sctp_add_stream_reset_tsn(chk, seq);
12326 asoc->stream_reset_outstanding++;
12327 }
12328 asoc->str_reset = chk;
12329 /* insert the chunk for sending */
12330 TAILQ_INSERT_TAIL(&asoc->control_send_queue,
12331 chk,
12332 sctp_next);
12333 asoc->ctrl_queue_cnt++;
12334 if (stcb->asoc.send_sack) {
12335 sctp_send_sack(stcb, SCTP_SO_LOCKED);
12336 }
12337 sctp_timer_start(SCTP_TIMER_TYPE_STRRESET, stcb->sctp_ep, stcb, chk->whoTo);
12338 return (0);
12339 }
12340
12341 void
sctp_send_abort(struct mbuf * m,int iphlen,struct sockaddr * src,struct sockaddr * dst,struct sctphdr * sh,uint32_t vtag,struct mbuf * cause,uint8_t mflowtype,uint32_t mflowid,uint16_t fibnum,uint32_t vrf_id,uint16_t port)12342 sctp_send_abort(struct mbuf *m, int iphlen, struct sockaddr *src, struct sockaddr *dst,
12343 struct sctphdr *sh, uint32_t vtag, struct mbuf *cause,
12344 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
12345 uint32_t vrf_id, uint16_t port)
12346 {
12347 /* Don't respond to an ABORT with an ABORT. */
12348 if (sctp_is_there_an_abort_here(m, iphlen, &vtag)) {
12349 if (cause)
12350 sctp_m_freem(cause);
12351 return;
12352 }
12353 sctp_send_resp_msg(src, dst, sh, vtag, SCTP_ABORT_ASSOCIATION, cause,
12354 mflowtype, mflowid, fibnum,
12355 vrf_id, port);
12356 return;
12357 }
12358
12359 void
sctp_send_operr_to(struct sockaddr * src,struct sockaddr * dst,struct sctphdr * sh,uint32_t vtag,struct mbuf * cause,uint8_t mflowtype,uint32_t mflowid,uint16_t fibnum,uint32_t vrf_id,uint16_t port)12360 sctp_send_operr_to(struct sockaddr *src, struct sockaddr *dst,
12361 struct sctphdr *sh, uint32_t vtag, struct mbuf *cause,
12362 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
12363 uint32_t vrf_id, uint16_t port)
12364 {
12365 sctp_send_resp_msg(src, dst, sh, vtag, SCTP_OPERATION_ERROR, cause,
12366 mflowtype, mflowid, fibnum,
12367 vrf_id, port);
12368 return;
12369 }
12370
12371 static struct mbuf *
sctp_copy_resume(struct uio * uio,int max_send_len,int user_marks_eor,int * error,uint32_t * sndout,struct mbuf ** new_tail)12372 sctp_copy_resume(struct uio *uio,
12373 int max_send_len,
12374 int user_marks_eor,
12375 int *error,
12376 uint32_t *sndout,
12377 struct mbuf **new_tail)
12378 {
12379 struct mbuf *m;
12380
12381 m = m_uiotombuf(uio, M_WAITOK, max_send_len, 0,
12382 (M_PKTHDR | (user_marks_eor ? M_EOR : 0)));
12383 if (m == NULL) {
12384 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOBUFS);
12385 *error = ENOBUFS;
12386 } else {
12387 *sndout = m_length(m, NULL);
12388 *new_tail = m_last(m);
12389 }
12390 return (m);
12391 }
12392
12393 static int
sctp_copy_one(struct sctp_stream_queue_pending * sp,struct uio * uio,int resv_upfront)12394 sctp_copy_one(struct sctp_stream_queue_pending *sp,
12395 struct uio *uio,
12396 int resv_upfront)
12397 {
12398 sp->data = m_uiotombuf(uio, M_WAITOK, sp->length,
12399 resv_upfront, 0);
12400 if (sp->data == NULL) {
12401 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOBUFS);
12402 return (ENOBUFS);
12403 }
12404
12405 sp->tail_mbuf = m_last(sp->data);
12406 return (0);
12407 }
12408
12409
12410
12411 static struct sctp_stream_queue_pending *
sctp_copy_it_in(struct sctp_tcb * stcb,struct sctp_association * asoc,struct sctp_sndrcvinfo * srcv,struct uio * uio,struct sctp_nets * net,ssize_t max_send_len,int user_marks_eor,int * error)12412 sctp_copy_it_in(struct sctp_tcb *stcb,
12413 struct sctp_association *asoc,
12414 struct sctp_sndrcvinfo *srcv,
12415 struct uio *uio,
12416 struct sctp_nets *net,
12417 ssize_t max_send_len,
12418 int user_marks_eor,
12419 int *error)
12420 {
12421
12422 /*-
12423 * This routine must be very careful in its work. Protocol
12424 * processing is up and running so care must be taken to spl...()
12425 * when you need to do something that may effect the stcb/asoc. The
12426 * sb is locked however. When data is copied the protocol processing
12427 * should be enabled since this is a slower operation...
12428 */
12429 struct sctp_stream_queue_pending *sp = NULL;
12430 int resv_in_first;
12431
12432 *error = 0;
12433 /* Now can we send this? */
12434 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_SENT) ||
12435 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_ACK_SENT) ||
12436 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
12437 (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) {
12438 /* got data while shutting down */
12439 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
12440 *error = ECONNRESET;
12441 goto out_now;
12442 }
12443 sctp_alloc_a_strmoq(stcb, sp);
12444 if (sp == NULL) {
12445 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12446 *error = ENOMEM;
12447 goto out_now;
12448 }
12449 sp->act_flags = 0;
12450 sp->sender_all_done = 0;
12451 sp->sinfo_flags = srcv->sinfo_flags;
12452 sp->timetolive = srcv->sinfo_timetolive;
12453 sp->ppid = srcv->sinfo_ppid;
12454 sp->context = srcv->sinfo_context;
12455 sp->fsn = 0;
12456 (void)SCTP_GETTIME_TIMEVAL(&sp->ts);
12457
12458 sp->sid = srcv->sinfo_stream;
12459 sp->length = (uint32_t)min(uio->uio_resid, max_send_len);
12460 if ((sp->length == (uint32_t)uio->uio_resid) &&
12461 ((user_marks_eor == 0) ||
12462 (srcv->sinfo_flags & SCTP_EOF) ||
12463 (user_marks_eor && (srcv->sinfo_flags & SCTP_EOR)))) {
12464 sp->msg_is_complete = 1;
12465 } else {
12466 sp->msg_is_complete = 0;
12467 }
12468 sp->sender_all_done = 0;
12469 sp->some_taken = 0;
12470 sp->put_last_out = 0;
12471 resv_in_first = SCTP_DATA_CHUNK_OVERHEAD(stcb);
12472 sp->data = sp->tail_mbuf = NULL;
12473 if (sp->length == 0) {
12474 goto skip_copy;
12475 }
12476 if (srcv->sinfo_keynumber_valid) {
12477 sp->auth_keyid = srcv->sinfo_keynumber;
12478 } else {
12479 sp->auth_keyid = stcb->asoc.authinfo.active_keyid;
12480 }
12481 if (sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks)) {
12482 sctp_auth_key_acquire(stcb, sp->auth_keyid);
12483 sp->holds_key_ref = 1;
12484 }
12485 *error = sctp_copy_one(sp, uio, resv_in_first);
12486 skip_copy:
12487 if (*error) {
12488 sctp_free_a_strmoq(stcb, sp, SCTP_SO_LOCKED);
12489 sp = NULL;
12490 } else {
12491 if (sp->sinfo_flags & SCTP_ADDR_OVER) {
12492 sp->net = net;
12493 atomic_add_int(&sp->net->ref_count, 1);
12494 } else {
12495 sp->net = NULL;
12496 }
12497 sctp_set_prsctp_policy(sp);
12498 }
12499 out_now:
12500 return (sp);
12501 }
12502
12503
12504 int
sctp_sosend(struct socket * so,struct sockaddr * addr,struct uio * uio,struct mbuf * top,struct mbuf * control,int flags,struct thread * p)12505 sctp_sosend(struct socket *so,
12506 struct sockaddr *addr,
12507 struct uio *uio,
12508 struct mbuf *top,
12509 struct mbuf *control,
12510 int flags,
12511 struct thread *p
12512 )
12513 {
12514 int error, use_sndinfo = 0;
12515 struct sctp_sndrcvinfo sndrcvninfo;
12516 struct sockaddr *addr_to_use;
12517 #if defined(INET) && defined(INET6)
12518 struct sockaddr_in sin;
12519 #endif
12520
12521 if (control) {
12522 /* process cmsg snd/rcv info (maybe a assoc-id) */
12523 if (sctp_find_cmsg(SCTP_SNDRCV, (void *)&sndrcvninfo, control,
12524 sizeof(sndrcvninfo))) {
12525 /* got one */
12526 use_sndinfo = 1;
12527 }
12528 }
12529 addr_to_use = addr;
12530 #if defined(INET) && defined(INET6)
12531 if ((addr) && (addr->sa_family == AF_INET6)) {
12532 struct sockaddr_in6 *sin6;
12533
12534 sin6 = (struct sockaddr_in6 *)addr;
12535 if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
12536 in6_sin6_2_sin(&sin, sin6);
12537 addr_to_use = (struct sockaddr *)&sin;
12538 }
12539 }
12540 #endif
12541 error = sctp_lower_sosend(so, addr_to_use, uio, top,
12542 control,
12543 flags,
12544 use_sndinfo ? &sndrcvninfo : NULL
12545 ,p
12546 );
12547 return (error);
12548 }
12549
12550
12551 int
sctp_lower_sosend(struct socket * so,struct sockaddr * addr,struct uio * uio,struct mbuf * i_pak,struct mbuf * control,int flags,struct sctp_sndrcvinfo * srcv,struct thread * p)12552 sctp_lower_sosend(struct socket *so,
12553 struct sockaddr *addr,
12554 struct uio *uio,
12555 struct mbuf *i_pak,
12556 struct mbuf *control,
12557 int flags,
12558 struct sctp_sndrcvinfo *srcv
12559 ,
12560 struct thread *p
12561 )
12562 {
12563 ssize_t sndlen = 0, max_len, local_add_more;
12564 int error, len;
12565 struct mbuf *top = NULL;
12566 int queue_only = 0, queue_only_for_init = 0;
12567 int free_cnt_applied = 0;
12568 int un_sent;
12569 int now_filled = 0;
12570 unsigned int inqueue_bytes = 0;
12571 struct sctp_block_entry be;
12572 struct sctp_inpcb *inp;
12573 struct sctp_tcb *stcb = NULL;
12574 struct timeval now;
12575 struct sctp_nets *net;
12576 struct sctp_association *asoc;
12577 struct sctp_inpcb *t_inp;
12578 int user_marks_eor;
12579 int create_lock_applied = 0;
12580 int nagle_applies = 0;
12581 int some_on_control = 0;
12582 int got_all_of_the_send = 0;
12583 int hold_tcblock = 0;
12584 int non_blocking = 0;
12585 ssize_t local_soresv = 0;
12586 uint16_t port;
12587 uint16_t sinfo_flags;
12588 sctp_assoc_t sinfo_assoc_id;
12589
12590 error = 0;
12591 net = NULL;
12592 stcb = NULL;
12593 asoc = NULL;
12594
12595 t_inp = inp = (struct sctp_inpcb *)so->so_pcb;
12596 if (inp == NULL) {
12597 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12598 error = EINVAL;
12599 if (i_pak) {
12600 SCTP_RELEASE_PKT(i_pak);
12601 }
12602 return (error);
12603 }
12604 if ((uio == NULL) && (i_pak == NULL)) {
12605 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12606 return (EINVAL);
12607 }
12608 user_marks_eor = sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXPLICIT_EOR);
12609 atomic_add_int(&inp->total_sends, 1);
12610 if (uio) {
12611 if (uio->uio_resid < 0) {
12612 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12613 return (EINVAL);
12614 }
12615 sndlen = uio->uio_resid;
12616 } else {
12617 top = SCTP_HEADER_TO_CHAIN(i_pak);
12618 sndlen = SCTP_HEADER_LEN(i_pak);
12619 }
12620 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Send called addr:%p send length %zu\n",
12621 (void *)addr,
12622 sndlen);
12623 if ((inp->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) &&
12624 SCTP_IS_LISTENING(inp)) {
12625 /* The listener can NOT send */
12626 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOTCONN);
12627 error = ENOTCONN;
12628 goto out_unlocked;
12629 }
12630 /**
12631 * Pre-screen address, if one is given the sin-len
12632 * must be set correctly!
12633 */
12634 if (addr) {
12635 union sctp_sockstore *raddr = (union sctp_sockstore *)addr;
12636
12637 switch (raddr->sa.sa_family) {
12638 #ifdef INET
12639 case AF_INET:
12640 if (raddr->sin.sin_len != sizeof(struct sockaddr_in)) {
12641 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12642 error = EINVAL;
12643 goto out_unlocked;
12644 }
12645 port = raddr->sin.sin_port;
12646 break;
12647 #endif
12648 #ifdef INET6
12649 case AF_INET6:
12650 if (raddr->sin6.sin6_len != sizeof(struct sockaddr_in6)) {
12651 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12652 error = EINVAL;
12653 goto out_unlocked;
12654 }
12655 port = raddr->sin6.sin6_port;
12656 break;
12657 #endif
12658 default:
12659 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EAFNOSUPPORT);
12660 error = EAFNOSUPPORT;
12661 goto out_unlocked;
12662 }
12663 } else
12664 port = 0;
12665
12666 if (srcv) {
12667 sinfo_flags = srcv->sinfo_flags;
12668 sinfo_assoc_id = srcv->sinfo_assoc_id;
12669 if (INVALID_SINFO_FLAG(sinfo_flags) ||
12670 PR_SCTP_INVALID_POLICY(sinfo_flags)) {
12671 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12672 error = EINVAL;
12673 goto out_unlocked;
12674 }
12675 if (srcv->sinfo_flags)
12676 SCTP_STAT_INCR(sctps_sends_with_flags);
12677 } else {
12678 sinfo_flags = inp->def_send.sinfo_flags;
12679 sinfo_assoc_id = inp->def_send.sinfo_assoc_id;
12680 }
12681 if (flags & MSG_EOR) {
12682 sinfo_flags |= SCTP_EOR;
12683 }
12684 if (flags & MSG_EOF) {
12685 sinfo_flags |= SCTP_EOF;
12686 }
12687 if (sinfo_flags & SCTP_SENDALL) {
12688 /* its a sendall */
12689 error = sctp_sendall(inp, uio, top, srcv);
12690 top = NULL;
12691 goto out_unlocked;
12692 }
12693 if ((sinfo_flags & SCTP_ADDR_OVER) && (addr == NULL)) {
12694 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12695 error = EINVAL;
12696 goto out_unlocked;
12697 }
12698 /* now we must find the assoc */
12699 if ((inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED) ||
12700 (inp->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) {
12701 SCTP_INP_RLOCK(inp);
12702 stcb = LIST_FIRST(&inp->sctp_asoc_list);
12703 if (stcb) {
12704 SCTP_TCB_LOCK(stcb);
12705 hold_tcblock = 1;
12706 }
12707 SCTP_INP_RUNLOCK(inp);
12708 } else if (sinfo_assoc_id) {
12709 stcb = sctp_findassociation_ep_asocid(inp, sinfo_assoc_id, 1);
12710 if (stcb != NULL) {
12711 hold_tcblock = 1;
12712 }
12713 } else if (addr) {
12714 /*-
12715 * Since we did not use findep we must
12716 * increment it, and if we don't find a tcb
12717 * decrement it.
12718 */
12719 SCTP_INP_WLOCK(inp);
12720 SCTP_INP_INCR_REF(inp);
12721 SCTP_INP_WUNLOCK(inp);
12722 stcb = sctp_findassociation_ep_addr(&t_inp, addr, &net, NULL, NULL);
12723 if (stcb == NULL) {
12724 SCTP_INP_WLOCK(inp);
12725 SCTP_INP_DECR_REF(inp);
12726 SCTP_INP_WUNLOCK(inp);
12727 } else {
12728 hold_tcblock = 1;
12729 }
12730 }
12731 if ((stcb == NULL) && (addr)) {
12732 /* Possible implicit send? */
12733 SCTP_ASOC_CREATE_LOCK(inp);
12734 create_lock_applied = 1;
12735 if ((inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
12736 (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_ALLGONE)) {
12737 /* Should I really unlock ? */
12738 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12739 error = EINVAL;
12740 goto out_unlocked;
12741
12742 }
12743 if (((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) == 0) &&
12744 (addr->sa_family == AF_INET6)) {
12745 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12746 error = EINVAL;
12747 goto out_unlocked;
12748 }
12749 SCTP_INP_WLOCK(inp);
12750 SCTP_INP_INCR_REF(inp);
12751 SCTP_INP_WUNLOCK(inp);
12752 /* With the lock applied look again */
12753 stcb = sctp_findassociation_ep_addr(&t_inp, addr, &net, NULL, NULL);
12754 #if defined(INET) || defined(INET6)
12755 if ((stcb == NULL) && (control != NULL) && (port > 0)) {
12756 stcb = sctp_findassociation_cmsgs(&t_inp, port, control, &net, &error);
12757 }
12758 #endif
12759 if (stcb == NULL) {
12760 SCTP_INP_WLOCK(inp);
12761 SCTP_INP_DECR_REF(inp);
12762 SCTP_INP_WUNLOCK(inp);
12763 } else {
12764 hold_tcblock = 1;
12765 }
12766 if (error) {
12767 goto out_unlocked;
12768 }
12769 if (t_inp != inp) {
12770 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOTCONN);
12771 error = ENOTCONN;
12772 goto out_unlocked;
12773 }
12774 }
12775 if (stcb == NULL) {
12776 if (addr == NULL) {
12777 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOENT);
12778 error = ENOENT;
12779 goto out_unlocked;
12780 } else {
12781 /* We must go ahead and start the INIT process */
12782 uint32_t vrf_id;
12783
12784 if ((sinfo_flags & SCTP_ABORT) ||
12785 ((sinfo_flags & SCTP_EOF) && (sndlen == 0))) {
12786 /*-
12787 * User asks to abort a non-existant assoc,
12788 * or EOF a non-existant assoc with no data
12789 */
12790 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOENT);
12791 error = ENOENT;
12792 goto out_unlocked;
12793 }
12794 /* get an asoc/stcb struct */
12795 vrf_id = inp->def_vrf_id;
12796 #ifdef INVARIANTS
12797 if (create_lock_applied == 0) {
12798 panic("Error, should hold create lock and I don't?");
12799 }
12800 #endif
12801 stcb = sctp_aloc_assoc(inp, addr, &error, 0, vrf_id,
12802 inp->sctp_ep.pre_open_stream_count,
12803 inp->sctp_ep.port,
12804 p,
12805 SCTP_INITIALIZE_AUTH_PARAMS);
12806 if (stcb == NULL) {
12807 /* Error is setup for us in the call */
12808 goto out_unlocked;
12809 }
12810 if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) {
12811 stcb->sctp_ep->sctp_flags |= SCTP_PCB_FLAGS_CONNECTED;
12812 /*
12813 * Set the connected flag so we can queue
12814 * data
12815 */
12816 soisconnecting(so);
12817 }
12818 hold_tcblock = 1;
12819 if (create_lock_applied) {
12820 SCTP_ASOC_CREATE_UNLOCK(inp);
12821 create_lock_applied = 0;
12822 } else {
12823 SCTP_PRINTF("Huh-3? create lock should have been on??\n");
12824 }
12825 /*
12826 * Turn on queue only flag to prevent data from
12827 * being sent
12828 */
12829 queue_only = 1;
12830 asoc = &stcb->asoc;
12831 SCTP_SET_STATE(stcb, SCTP_STATE_COOKIE_WAIT);
12832 (void)SCTP_GETTIME_TIMEVAL(&asoc->time_entered);
12833
12834 if (control) {
12835 if (sctp_process_cmsgs_for_init(stcb, control, &error)) {
12836 sctp_free_assoc(inp, stcb, SCTP_PCBFREE_FORCE,
12837 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_5);
12838 hold_tcblock = 0;
12839 stcb = NULL;
12840 goto out_unlocked;
12841 }
12842 }
12843 /* out with the INIT */
12844 queue_only_for_init = 1;
12845 /*-
12846 * we may want to dig in after this call and adjust the MTU
12847 * value. It defaulted to 1500 (constant) but the ro
12848 * structure may now have an update and thus we may need to
12849 * change it BEFORE we append the message.
12850 */
12851 }
12852 } else
12853 asoc = &stcb->asoc;
12854 if (srcv == NULL) {
12855 srcv = (struct sctp_sndrcvinfo *)&asoc->def_send;
12856 sinfo_flags = srcv->sinfo_flags;
12857 if (flags & MSG_EOR) {
12858 sinfo_flags |= SCTP_EOR;
12859 }
12860 if (flags & MSG_EOF) {
12861 sinfo_flags |= SCTP_EOF;
12862 }
12863 }
12864 if (sinfo_flags & SCTP_ADDR_OVER) {
12865 if (addr)
12866 net = sctp_findnet(stcb, addr);
12867 else
12868 net = NULL;
12869 if ((net == NULL) ||
12870 ((port != 0) && (port != stcb->rport))) {
12871 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12872 error = EINVAL;
12873 goto out_unlocked;
12874 }
12875 } else {
12876 if (stcb->asoc.alternate) {
12877 net = stcb->asoc.alternate;
12878 } else {
12879 net = stcb->asoc.primary_destination;
12880 }
12881 }
12882 atomic_add_int(&stcb->total_sends, 1);
12883 /* Keep the stcb from being freed under our feet */
12884 atomic_add_int(&asoc->refcnt, 1);
12885 free_cnt_applied = 1;
12886
12887 if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_NO_FRAGMENT)) {
12888 if (sndlen > (ssize_t)asoc->smallest_mtu) {
12889 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EMSGSIZE);
12890 error = EMSGSIZE;
12891 goto out_unlocked;
12892 }
12893 }
12894 if (SCTP_SO_IS_NBIO(so)
12895 || (flags & (MSG_NBIO | MSG_DONTWAIT)) != 0
12896 ) {
12897 non_blocking = 1;
12898 }
12899 /* would we block? */
12900 if (non_blocking) {
12901 ssize_t amount;
12902
12903 if (hold_tcblock == 0) {
12904 SCTP_TCB_LOCK(stcb);
12905 hold_tcblock = 1;
12906 }
12907 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
12908 if (user_marks_eor == 0) {
12909 amount = sndlen;
12910 } else {
12911 amount = 1;
12912 }
12913 if ((SCTP_SB_LIMIT_SND(so) < (amount + inqueue_bytes + stcb->asoc.sb_send_resv)) ||
12914 (stcb->asoc.chunks_on_out_queue >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue))) {
12915 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EWOULDBLOCK);
12916 if (sndlen > (ssize_t)SCTP_SB_LIMIT_SND(so))
12917 error = EMSGSIZE;
12918 else
12919 error = EWOULDBLOCK;
12920 goto out_unlocked;
12921 }
12922 stcb->asoc.sb_send_resv += (uint32_t)sndlen;
12923 SCTP_TCB_UNLOCK(stcb);
12924 hold_tcblock = 0;
12925 } else {
12926 atomic_add_int(&stcb->asoc.sb_send_resv, sndlen);
12927 }
12928 local_soresv = sndlen;
12929 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
12930 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
12931 error = ECONNRESET;
12932 goto out_unlocked;
12933 }
12934 if (create_lock_applied) {
12935 SCTP_ASOC_CREATE_UNLOCK(inp);
12936 create_lock_applied = 0;
12937 }
12938 /* Is the stream no. valid? */
12939 if (srcv->sinfo_stream >= asoc->streamoutcnt) {
12940 /* Invalid stream number */
12941 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12942 error = EINVAL;
12943 goto out_unlocked;
12944 }
12945 if ((asoc->strmout[srcv->sinfo_stream].state != SCTP_STREAM_OPEN) &&
12946 (asoc->strmout[srcv->sinfo_stream].state != SCTP_STREAM_OPENING)) {
12947 /*
12948 * Can't queue any data while stream reset is underway.
12949 */
12950 if (asoc->strmout[srcv->sinfo_stream].state > SCTP_STREAM_OPEN) {
12951 error = EAGAIN;
12952 } else {
12953 error = EINVAL;
12954 }
12955 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, error);
12956 goto out_unlocked;
12957 }
12958 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT) ||
12959 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED)) {
12960 queue_only = 1;
12961 }
12962 /* we are now done with all control */
12963 if (control) {
12964 sctp_m_freem(control);
12965 control = NULL;
12966 }
12967 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_SENT) ||
12968 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
12969 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_ACK_SENT) ||
12970 (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) {
12971 if (sinfo_flags & SCTP_ABORT) {
12972 ;
12973 } else {
12974 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
12975 error = ECONNRESET;
12976 goto out_unlocked;
12977 }
12978 }
12979 /* Ok, we will attempt a msgsnd :> */
12980 if (p) {
12981 p->td_ru.ru_msgsnd++;
12982 }
12983 /* Are we aborting? */
12984 if (sinfo_flags & SCTP_ABORT) {
12985 struct mbuf *mm;
12986 ssize_t tot_demand, tot_out = 0, max_out;
12987
12988 SCTP_STAT_INCR(sctps_sends_with_abort);
12989 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT) ||
12990 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED)) {
12991 /* It has to be up before we abort */
12992 /* how big is the user initiated abort? */
12993 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12994 error = EINVAL;
12995 goto out;
12996 }
12997 if (hold_tcblock) {
12998 SCTP_TCB_UNLOCK(stcb);
12999 hold_tcblock = 0;
13000 }
13001 if (top) {
13002 struct mbuf *cntm = NULL;
13003
13004 mm = sctp_get_mbuf_for_msg(sizeof(struct sctp_paramhdr), 0, M_WAITOK, 1, MT_DATA);
13005 if (sndlen != 0) {
13006 for (cntm = top; cntm; cntm = SCTP_BUF_NEXT(cntm)) {
13007 tot_out += SCTP_BUF_LEN(cntm);
13008 }
13009 }
13010 } else {
13011 /* Must fit in a MTU */
13012 tot_out = sndlen;
13013 tot_demand = (tot_out + sizeof(struct sctp_paramhdr));
13014 if (tot_demand > SCTP_DEFAULT_ADD_MORE) {
13015 /* To big */
13016 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EMSGSIZE);
13017 error = EMSGSIZE;
13018 goto out;
13019 }
13020 mm = sctp_get_mbuf_for_msg((unsigned int)tot_demand, 0, M_WAITOK, 1, MT_DATA);
13021 }
13022 if (mm == NULL) {
13023 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
13024 error = ENOMEM;
13025 goto out;
13026 }
13027 max_out = asoc->smallest_mtu - sizeof(struct sctp_paramhdr);
13028 max_out -= sizeof(struct sctp_abort_msg);
13029 if (tot_out > max_out) {
13030 tot_out = max_out;
13031 }
13032 if (mm) {
13033 struct sctp_paramhdr *ph;
13034
13035 /* now move forward the data pointer */
13036 ph = mtod(mm, struct sctp_paramhdr *);
13037 ph->param_type = htons(SCTP_CAUSE_USER_INITIATED_ABT);
13038 ph->param_length = htons((uint16_t)(sizeof(struct sctp_paramhdr) + tot_out));
13039 ph++;
13040 SCTP_BUF_LEN(mm) = (int)(tot_out + sizeof(struct sctp_paramhdr));
13041 if (top == NULL) {
13042 error = uiomove((caddr_t)ph, (int)tot_out, uio);
13043 if (error) {
13044 /*-
13045 * Here if we can't get his data we
13046 * still abort we just don't get to
13047 * send the users note :-0
13048 */
13049 sctp_m_freem(mm);
13050 mm = NULL;
13051 }
13052 } else {
13053 if (sndlen != 0) {
13054 SCTP_BUF_NEXT(mm) = top;
13055 }
13056 }
13057 }
13058 if (hold_tcblock == 0) {
13059 SCTP_TCB_LOCK(stcb);
13060 }
13061 atomic_add_int(&stcb->asoc.refcnt, -1);
13062 free_cnt_applied = 0;
13063 /* release this lock, otherwise we hang on ourselves */
13064 sctp_abort_an_association(stcb->sctp_ep, stcb, mm, SCTP_SO_LOCKED);
13065 /* now relock the stcb so everything is sane */
13066 hold_tcblock = 0;
13067 stcb = NULL;
13068 /*
13069 * In this case top is already chained to mm avoid double
13070 * free, since we free it below if top != NULL and driver
13071 * would free it after sending the packet out
13072 */
13073 if (sndlen != 0) {
13074 top = NULL;
13075 }
13076 goto out_unlocked;
13077 }
13078 /* Calculate the maximum we can send */
13079 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13080 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes) {
13081 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13082 } else {
13083 max_len = 0;
13084 }
13085 if (hold_tcblock) {
13086 SCTP_TCB_UNLOCK(stcb);
13087 hold_tcblock = 0;
13088 }
13089 if (asoc->strmout == NULL) {
13090 /* huh? software error */
13091 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EFAULT);
13092 error = EFAULT;
13093 goto out_unlocked;
13094 }
13095
13096 /* Unless E_EOR mode is on, we must make a send FIT in one call. */
13097 if ((user_marks_eor == 0) &&
13098 (sndlen > (ssize_t)SCTP_SB_LIMIT_SND(stcb->sctp_socket))) {
13099 /* It will NEVER fit */
13100 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EMSGSIZE);
13101 error = EMSGSIZE;
13102 goto out_unlocked;
13103 }
13104 if ((uio == NULL) && user_marks_eor) {
13105 /*-
13106 * We do not support eeor mode for
13107 * sending with mbuf chains (like sendfile).
13108 */
13109 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
13110 error = EINVAL;
13111 goto out_unlocked;
13112 }
13113
13114 if (user_marks_eor) {
13115 local_add_more = (ssize_t)min(SCTP_SB_LIMIT_SND(so), SCTP_BASE_SYSCTL(sctp_add_more_threshold));
13116 } else {
13117 /*-
13118 * For non-eeor the whole message must fit in
13119 * the socket send buffer.
13120 */
13121 local_add_more = sndlen;
13122 }
13123 len = 0;
13124 if (non_blocking) {
13125 goto skip_preblock;
13126 }
13127 if (((max_len <= local_add_more) &&
13128 ((ssize_t)SCTP_SB_LIMIT_SND(so) >= local_add_more)) ||
13129 (max_len == 0) ||
13130 ((stcb->asoc.chunks_on_out_queue + stcb->asoc.stream_queue_cnt) >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue))) {
13131 /* No room right now ! */
13132 SOCKBUF_LOCK(&so->so_snd);
13133 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13134 while ((SCTP_SB_LIMIT_SND(so) < (inqueue_bytes + local_add_more)) ||
13135 ((stcb->asoc.stream_queue_cnt + stcb->asoc.chunks_on_out_queue) >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue))) {
13136 SCTPDBG(SCTP_DEBUG_OUTPUT1, "pre_block limit:%u <(inq:%d + %zd) || (%d+%d > %d)\n",
13137 (unsigned int)SCTP_SB_LIMIT_SND(so),
13138 inqueue_bytes,
13139 local_add_more,
13140 stcb->asoc.stream_queue_cnt,
13141 stcb->asoc.chunks_on_out_queue,
13142 SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue));
13143 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13144 sctp_log_block(SCTP_BLOCK_LOG_INTO_BLKA, asoc, sndlen);
13145 }
13146 be.error = 0;
13147 stcb->block_entry = &be;
13148 error = sbwait(&so->so_snd);
13149 stcb->block_entry = NULL;
13150 if (error || so->so_error || be.error) {
13151 if (error == 0) {
13152 if (so->so_error)
13153 error = so->so_error;
13154 if (be.error) {
13155 error = be.error;
13156 }
13157 }
13158 SOCKBUF_UNLOCK(&so->so_snd);
13159 goto out_unlocked;
13160 }
13161 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13162 sctp_log_block(SCTP_BLOCK_LOG_OUTOF_BLK,
13163 asoc, stcb->asoc.total_output_queue_size);
13164 }
13165 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
13166 SOCKBUF_UNLOCK(&so->so_snd);
13167 goto out_unlocked;
13168 }
13169 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13170 }
13171 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes) {
13172 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13173 } else {
13174 max_len = 0;
13175 }
13176 SOCKBUF_UNLOCK(&so->so_snd);
13177 }
13178
13179 skip_preblock:
13180 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
13181 goto out_unlocked;
13182 }
13183 /*
13184 * sndlen covers for mbuf case uio_resid covers for the non-mbuf
13185 * case NOTE: uio will be null when top/mbuf is passed
13186 */
13187 if (sndlen == 0) {
13188 if (sinfo_flags & SCTP_EOF) {
13189 got_all_of_the_send = 1;
13190 goto dataless_eof;
13191 } else {
13192 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
13193 error = EINVAL;
13194 goto out;
13195 }
13196 }
13197 if (top == NULL) {
13198 struct sctp_stream_queue_pending *sp;
13199 struct sctp_stream_out *strm;
13200 uint32_t sndout;
13201
13202 SCTP_TCB_SEND_LOCK(stcb);
13203 if ((asoc->stream_locked) &&
13204 (asoc->stream_locked_on != srcv->sinfo_stream)) {
13205 SCTP_TCB_SEND_UNLOCK(stcb);
13206 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
13207 error = EINVAL;
13208 goto out;
13209 }
13210 strm = &stcb->asoc.strmout[srcv->sinfo_stream];
13211 if (strm->last_msg_incomplete == 0) {
13212 do_a_copy_in:
13213 SCTP_TCB_SEND_UNLOCK(stcb);
13214 sp = sctp_copy_it_in(stcb, asoc, srcv, uio, net, max_len, user_marks_eor, &error);
13215 if (error) {
13216 goto out;
13217 }
13218 SCTP_TCB_SEND_LOCK(stcb);
13219 if (sp->msg_is_complete) {
13220 strm->last_msg_incomplete = 0;
13221 asoc->stream_locked = 0;
13222 } else {
13223 /*
13224 * Just got locked to this guy in case of an
13225 * interrupt.
13226 */
13227 strm->last_msg_incomplete = 1;
13228 if (stcb->asoc.idata_supported == 0) {
13229 asoc->stream_locked = 1;
13230 asoc->stream_locked_on = srcv->sinfo_stream;
13231 }
13232 sp->sender_all_done = 0;
13233 }
13234 sctp_snd_sb_alloc(stcb, sp->length);
13235 atomic_add_int(&asoc->stream_queue_cnt, 1);
13236 if (sinfo_flags & SCTP_UNORDERED) {
13237 SCTP_STAT_INCR(sctps_sends_with_unord);
13238 }
13239 sp->processing = 1;
13240 TAILQ_INSERT_TAIL(&strm->outqueue, sp, next);
13241 stcb->asoc.ss_functions.sctp_ss_add_to_stream(stcb, asoc, strm, sp, 1);
13242 } else {
13243 sp = TAILQ_LAST(&strm->outqueue, sctp_streamhead);
13244 if (sp == NULL) {
13245 /* ???? Huh ??? last msg is gone */
13246 #ifdef INVARIANTS
13247 panic("Warning: Last msg marked incomplete, yet nothing left?");
13248 #else
13249 SCTP_PRINTF("Warning: Last msg marked incomplete, yet nothing left?\n");
13250 strm->last_msg_incomplete = 0;
13251 #endif
13252 goto do_a_copy_in;
13253
13254 }
13255 if (sp->processing) {
13256 SCTP_TCB_SEND_UNLOCK(stcb);
13257 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
13258 error = EINVAL;
13259 goto out;
13260 } else {
13261 sp->processing = 1;
13262 }
13263 }
13264 SCTP_TCB_SEND_UNLOCK(stcb);
13265 while (uio->uio_resid > 0) {
13266 /* How much room do we have? */
13267 struct mbuf *new_tail, *mm;
13268
13269 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13270 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes)
13271 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13272 else
13273 max_len = 0;
13274
13275 if ((max_len > (ssize_t)SCTP_BASE_SYSCTL(sctp_add_more_threshold)) ||
13276 (max_len && (SCTP_SB_LIMIT_SND(so) < SCTP_BASE_SYSCTL(sctp_add_more_threshold))) ||
13277 (uio->uio_resid && (uio->uio_resid <= max_len))) {
13278 sndout = 0;
13279 new_tail = NULL;
13280 if (hold_tcblock) {
13281 SCTP_TCB_UNLOCK(stcb);
13282 hold_tcblock = 0;
13283 }
13284 mm = sctp_copy_resume(uio, (int)max_len, user_marks_eor, &error, &sndout, &new_tail);
13285 if ((mm == NULL) || error) {
13286 if (mm) {
13287 sctp_m_freem(mm);
13288 }
13289 SCTP_TCB_SEND_LOCK(stcb);
13290 if (sp != NULL) {
13291 sp->processing = 0;
13292 }
13293 SCTP_TCB_SEND_UNLOCK(stcb);
13294 goto out;
13295 }
13296 /* Update the mbuf and count */
13297 SCTP_TCB_SEND_LOCK(stcb);
13298 if ((stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) ||
13299 (stcb->asoc.state & SCTP_STATE_WAS_ABORTED)) {
13300 /*
13301 * we need to get out. Peer probably
13302 * aborted.
13303 */
13304 sctp_m_freem(mm);
13305 if (stcb->asoc.state & SCTP_STATE_WAS_ABORTED) {
13306 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
13307 error = ECONNRESET;
13308 }
13309 if (sp != NULL) {
13310 sp->processing = 0;
13311 }
13312 SCTP_TCB_SEND_UNLOCK(stcb);
13313 goto out;
13314 }
13315 if (sp->tail_mbuf) {
13316 /* tack it to the end */
13317 SCTP_BUF_NEXT(sp->tail_mbuf) = mm;
13318 sp->tail_mbuf = new_tail;
13319 } else {
13320 /* A stolen mbuf */
13321 sp->data = mm;
13322 sp->tail_mbuf = new_tail;
13323 }
13324 sctp_snd_sb_alloc(stcb, sndout);
13325 atomic_add_int(&sp->length, sndout);
13326 len += sndout;
13327 if (sinfo_flags & SCTP_SACK_IMMEDIATELY) {
13328 sp->sinfo_flags |= SCTP_SACK_IMMEDIATELY;
13329 }
13330
13331 /* Did we reach EOR? */
13332 if ((uio->uio_resid == 0) &&
13333 ((user_marks_eor == 0) ||
13334 (sinfo_flags & SCTP_EOF) ||
13335 (user_marks_eor && (sinfo_flags & SCTP_EOR)))) {
13336 sp->msg_is_complete = 1;
13337 } else {
13338 sp->msg_is_complete = 0;
13339 }
13340 SCTP_TCB_SEND_UNLOCK(stcb);
13341 }
13342 if (uio->uio_resid == 0) {
13343 /* got it all? */
13344 continue;
13345 }
13346 /* PR-SCTP? */
13347 if ((asoc->prsctp_supported) && (asoc->sent_queue_cnt_removeable > 0)) {
13348 /*
13349 * This is ugly but we must assure locking
13350 * order
13351 */
13352 if (hold_tcblock == 0) {
13353 SCTP_TCB_LOCK(stcb);
13354 hold_tcblock = 1;
13355 }
13356 sctp_prune_prsctp(stcb, asoc, srcv, (int)sndlen);
13357 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13358 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes)
13359 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13360 else
13361 max_len = 0;
13362 if (max_len > 0) {
13363 continue;
13364 }
13365 SCTP_TCB_UNLOCK(stcb);
13366 hold_tcblock = 0;
13367 }
13368 /* wait for space now */
13369 if (non_blocking) {
13370 /* Non-blocking io in place out */
13371 SCTP_TCB_SEND_LOCK(stcb);
13372 if (sp != NULL) {
13373 sp->processing = 0;
13374 }
13375 SCTP_TCB_SEND_UNLOCK(stcb);
13376 goto skip_out_eof;
13377 }
13378 /* What about the INIT, send it maybe */
13379 if (queue_only_for_init) {
13380 if (hold_tcblock == 0) {
13381 SCTP_TCB_LOCK(stcb);
13382 hold_tcblock = 1;
13383 }
13384 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
13385 /* a collision took us forward? */
13386 queue_only = 0;
13387 } else {
13388 sctp_send_initiate(inp, stcb, SCTP_SO_LOCKED);
13389 SCTP_SET_STATE(stcb, SCTP_STATE_COOKIE_WAIT);
13390 queue_only = 1;
13391 }
13392 }
13393 if ((net->flight_size > net->cwnd) &&
13394 (asoc->sctp_cmt_on_off == 0)) {
13395 SCTP_STAT_INCR(sctps_send_cwnd_avoid);
13396 queue_only = 1;
13397 } else if (asoc->ifp_had_enobuf) {
13398 SCTP_STAT_INCR(sctps_ifnomemqueued);
13399 if (net->flight_size > (2 * net->mtu)) {
13400 queue_only = 1;
13401 }
13402 asoc->ifp_had_enobuf = 0;
13403 }
13404 un_sent = stcb->asoc.total_output_queue_size - stcb->asoc.total_flight;
13405 if ((sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY)) &&
13406 (stcb->asoc.total_flight > 0) &&
13407 (stcb->asoc.stream_queue_cnt < SCTP_MAX_DATA_BUNDLING) &&
13408 (un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD))) {
13409
13410 /*-
13411 * Ok, Nagle is set on and we have data outstanding.
13412 * Don't send anything and let SACKs drive out the
13413 * data unless we have a "full" segment to send.
13414 */
13415 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13416 sctp_log_nagle_event(stcb, SCTP_NAGLE_APPLIED);
13417 }
13418 SCTP_STAT_INCR(sctps_naglequeued);
13419 nagle_applies = 1;
13420 } else {
13421 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13422 if (sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY))
13423 sctp_log_nagle_event(stcb, SCTP_NAGLE_SKIPPED);
13424 }
13425 SCTP_STAT_INCR(sctps_naglesent);
13426 nagle_applies = 0;
13427 }
13428 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13429
13430 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, queue_only_for_init, queue_only,
13431 nagle_applies, un_sent);
13432 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, stcb->asoc.total_output_queue_size,
13433 stcb->asoc.total_flight,
13434 stcb->asoc.chunks_on_out_queue, stcb->asoc.total_flight_count);
13435 }
13436 if (queue_only_for_init)
13437 queue_only_for_init = 0;
13438 if ((queue_only == 0) && (nagle_applies == 0)) {
13439 /*-
13440 * need to start chunk output
13441 * before blocking.. note that if
13442 * a lock is already applied, then
13443 * the input via the net is happening
13444 * and I don't need to start output :-D
13445 */
13446 if (hold_tcblock == 0) {
13447 if (SCTP_TCB_TRYLOCK(stcb)) {
13448 hold_tcblock = 1;
13449 sctp_chunk_output(inp,
13450 stcb,
13451 SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13452 }
13453 } else {
13454 sctp_chunk_output(inp,
13455 stcb,
13456 SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13457 }
13458 }
13459 if (hold_tcblock == 1) {
13460 SCTP_TCB_UNLOCK(stcb);
13461 hold_tcblock = 0;
13462 }
13463 SOCKBUF_LOCK(&so->so_snd);
13464 /*-
13465 * This is a bit strange, but I think it will
13466 * work. The total_output_queue_size is locked and
13467 * protected by the TCB_LOCK, which we just released.
13468 * There is a race that can occur between releasing it
13469 * above, and me getting the socket lock, where sacks
13470 * come in but we have not put the SB_WAIT on the
13471 * so_snd buffer to get the wakeup. After the LOCK
13472 * is applied the sack_processing will also need to
13473 * LOCK the so->so_snd to do the actual sowwakeup(). So
13474 * once we have the socket buffer lock if we recheck the
13475 * size we KNOW we will get to sleep safely with the
13476 * wakeup flag in place.
13477 */
13478 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13479 if (SCTP_SB_LIMIT_SND(so) <= (inqueue_bytes +
13480 min(SCTP_BASE_SYSCTL(sctp_add_more_threshold), SCTP_SB_LIMIT_SND(so)))) {
13481 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13482 sctp_log_block(SCTP_BLOCK_LOG_INTO_BLK,
13483 asoc, uio->uio_resid);
13484 }
13485 be.error = 0;
13486 stcb->block_entry = &be;
13487 error = sbwait(&so->so_snd);
13488 stcb->block_entry = NULL;
13489
13490 if (error || so->so_error || be.error) {
13491 if (error == 0) {
13492 if (so->so_error)
13493 error = so->so_error;
13494 if (be.error) {
13495 error = be.error;
13496 }
13497 }
13498 SOCKBUF_UNLOCK(&so->so_snd);
13499 SCTP_TCB_SEND_LOCK(stcb);
13500 if (sp != NULL) {
13501 sp->processing = 0;
13502 }
13503 SCTP_TCB_SEND_UNLOCK(stcb);
13504 goto out_unlocked;
13505 }
13506
13507 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13508 sctp_log_block(SCTP_BLOCK_LOG_OUTOF_BLK,
13509 asoc, stcb->asoc.total_output_queue_size);
13510 }
13511 }
13512 SOCKBUF_UNLOCK(&so->so_snd);
13513 SCTP_TCB_SEND_LOCK(stcb);
13514 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
13515 if (sp != NULL) {
13516 sp->processing = 0;
13517 }
13518 SCTP_TCB_SEND_UNLOCK(stcb);
13519 goto out_unlocked;
13520 }
13521 SCTP_TCB_SEND_UNLOCK(stcb);
13522 }
13523 SCTP_TCB_SEND_LOCK(stcb);
13524 if ((stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) ||
13525 (stcb->asoc.state & SCTP_STATE_WAS_ABORTED)) {
13526 SCTP_TCB_SEND_UNLOCK(stcb);
13527 goto out_unlocked;
13528 }
13529 if (sp) {
13530 if (sp->msg_is_complete == 0) {
13531 strm->last_msg_incomplete = 1;
13532 if (stcb->asoc.idata_supported == 0) {
13533 asoc->stream_locked = 1;
13534 asoc->stream_locked_on = srcv->sinfo_stream;
13535 }
13536 } else {
13537 sp->sender_all_done = 1;
13538 strm->last_msg_incomplete = 0;
13539 asoc->stream_locked = 0;
13540 }
13541 sp->processing = 0;
13542 } else {
13543 SCTP_PRINTF("Huh no sp TSNH?\n");
13544 strm->last_msg_incomplete = 0;
13545 asoc->stream_locked = 0;
13546 }
13547 SCTP_TCB_SEND_UNLOCK(stcb);
13548 if (uio->uio_resid == 0) {
13549 got_all_of_the_send = 1;
13550 }
13551 } else {
13552 /* We send in a 0, since we do NOT have any locks */
13553 error = sctp_msg_append(stcb, net, top, srcv, 0);
13554 top = NULL;
13555 if (sinfo_flags & SCTP_EOF) {
13556 /*
13557 * This should only happen for Panda for the mbuf
13558 * send case, which does NOT yet support EEOR mode.
13559 * Thus, we can just set this flag to do the proper
13560 * EOF handling.
13561 */
13562 got_all_of_the_send = 1;
13563 }
13564 }
13565 if (error) {
13566 goto out;
13567 }
13568 dataless_eof:
13569 /* EOF thing ? */
13570 if ((sinfo_flags & SCTP_EOF) &&
13571 (got_all_of_the_send == 1)) {
13572 SCTP_STAT_INCR(sctps_sends_with_eof);
13573 error = 0;
13574 if (hold_tcblock == 0) {
13575 SCTP_TCB_LOCK(stcb);
13576 hold_tcblock = 1;
13577 }
13578 if (TAILQ_EMPTY(&asoc->send_queue) &&
13579 TAILQ_EMPTY(&asoc->sent_queue) &&
13580 sctp_is_there_unsent_data(stcb, SCTP_SO_LOCKED) == 0) {
13581 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
13582 goto abort_anyway;
13583 }
13584 /* there is nothing queued to send, so I'm done... */
13585 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
13586 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
13587 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
13588 struct sctp_nets *netp;
13589
13590 /* only send SHUTDOWN the first time through */
13591 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
13592 SCTP_STAT_DECR_GAUGE32(sctps_currestab);
13593 }
13594 SCTP_SET_STATE(stcb, SCTP_STATE_SHUTDOWN_SENT);
13595 sctp_stop_timers_for_shutdown(stcb);
13596 if (stcb->asoc.alternate) {
13597 netp = stcb->asoc.alternate;
13598 } else {
13599 netp = stcb->asoc.primary_destination;
13600 }
13601 sctp_send_shutdown(stcb, netp);
13602 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN, stcb->sctp_ep, stcb,
13603 netp);
13604 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
13605 asoc->primary_destination);
13606 }
13607 } else {
13608 /*-
13609 * we still got (or just got) data to send, so set
13610 * SHUTDOWN_PENDING
13611 */
13612 /*-
13613 * XXX sockets draft says that SCTP_EOF should be
13614 * sent with no data. currently, we will allow user
13615 * data to be sent first and move to
13616 * SHUTDOWN-PENDING
13617 */
13618 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
13619 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
13620 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
13621 if (hold_tcblock == 0) {
13622 SCTP_TCB_LOCK(stcb);
13623 hold_tcblock = 1;
13624 }
13625 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
13626 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_PARTIAL_MSG_LEFT);
13627 }
13628 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_SHUTDOWN_PENDING);
13629 if (TAILQ_EMPTY(&asoc->send_queue) &&
13630 TAILQ_EMPTY(&asoc->sent_queue) &&
13631 (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT)) {
13632 struct mbuf *op_err;
13633 char msg[SCTP_DIAG_INFO_LEN];
13634
13635 abort_anyway:
13636 if (free_cnt_applied) {
13637 atomic_add_int(&stcb->asoc.refcnt, -1);
13638 free_cnt_applied = 0;
13639 }
13640 snprintf(msg, sizeof(msg),
13641 "%s:%d at %s", __FILE__, __LINE__, __func__);
13642 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
13643 msg);
13644 sctp_abort_an_association(stcb->sctp_ep, stcb,
13645 op_err, SCTP_SO_LOCKED);
13646 /*
13647 * now relock the stcb so everything
13648 * is sane
13649 */
13650 hold_tcblock = 0;
13651 stcb = NULL;
13652 goto out;
13653 }
13654 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
13655 asoc->primary_destination);
13656 sctp_feature_off(inp, SCTP_PCB_FLAGS_NODELAY);
13657 }
13658 }
13659 }
13660 skip_out_eof:
13661 if (!TAILQ_EMPTY(&stcb->asoc.control_send_queue)) {
13662 some_on_control = 1;
13663 }
13664 if (queue_only_for_init) {
13665 if (hold_tcblock == 0) {
13666 SCTP_TCB_LOCK(stcb);
13667 hold_tcblock = 1;
13668 }
13669 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
13670 /* a collision took us forward? */
13671 queue_only = 0;
13672 } else {
13673 sctp_send_initiate(inp, stcb, SCTP_SO_LOCKED);
13674 SCTP_SET_STATE(stcb, SCTP_STATE_COOKIE_WAIT);
13675 queue_only = 1;
13676 }
13677 }
13678 if ((net->flight_size > net->cwnd) &&
13679 (stcb->asoc.sctp_cmt_on_off == 0)) {
13680 SCTP_STAT_INCR(sctps_send_cwnd_avoid);
13681 queue_only = 1;
13682 } else if (asoc->ifp_had_enobuf) {
13683 SCTP_STAT_INCR(sctps_ifnomemqueued);
13684 if (net->flight_size > (2 * net->mtu)) {
13685 queue_only = 1;
13686 }
13687 asoc->ifp_had_enobuf = 0;
13688 }
13689 un_sent = stcb->asoc.total_output_queue_size - stcb->asoc.total_flight;
13690 if ((sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY)) &&
13691 (stcb->asoc.total_flight > 0) &&
13692 (stcb->asoc.stream_queue_cnt < SCTP_MAX_DATA_BUNDLING) &&
13693 (un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD))) {
13694 /*-
13695 * Ok, Nagle is set on and we have data outstanding.
13696 * Don't send anything and let SACKs drive out the
13697 * data unless wen have a "full" segment to send.
13698 */
13699 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13700 sctp_log_nagle_event(stcb, SCTP_NAGLE_APPLIED);
13701 }
13702 SCTP_STAT_INCR(sctps_naglequeued);
13703 nagle_applies = 1;
13704 } else {
13705 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13706 if (sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY))
13707 sctp_log_nagle_event(stcb, SCTP_NAGLE_SKIPPED);
13708 }
13709 SCTP_STAT_INCR(sctps_naglesent);
13710 nagle_applies = 0;
13711 }
13712 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13713 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, queue_only_for_init, queue_only,
13714 nagle_applies, un_sent);
13715 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, stcb->asoc.total_output_queue_size,
13716 stcb->asoc.total_flight,
13717 stcb->asoc.chunks_on_out_queue, stcb->asoc.total_flight_count);
13718 }
13719 if ((queue_only == 0) && (nagle_applies == 0) && (stcb->asoc.peers_rwnd && un_sent)) {
13720 /* we can attempt to send too. */
13721 if (hold_tcblock == 0) {
13722 /*
13723 * If there is activity recv'ing sacks no need to
13724 * send
13725 */
13726 if (SCTP_TCB_TRYLOCK(stcb)) {
13727 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13728 hold_tcblock = 1;
13729 }
13730 } else {
13731 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13732 }
13733 } else if ((queue_only == 0) &&
13734 (stcb->asoc.peers_rwnd == 0) &&
13735 (stcb->asoc.total_flight == 0)) {
13736 /* We get to have a probe outstanding */
13737 if (hold_tcblock == 0) {
13738 hold_tcblock = 1;
13739 SCTP_TCB_LOCK(stcb);
13740 }
13741 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13742 } else if (some_on_control) {
13743 int num_out, reason, frag_point;
13744
13745 /* Here we do control only */
13746 if (hold_tcblock == 0) {
13747 hold_tcblock = 1;
13748 SCTP_TCB_LOCK(stcb);
13749 }
13750 frag_point = sctp_get_frag_point(stcb, &stcb->asoc);
13751 (void)sctp_med_chunk_output(inp, stcb, &stcb->asoc, &num_out,
13752 &reason, 1, 1, &now, &now_filled, frag_point, SCTP_SO_LOCKED);
13753 }
13754 SCTPDBG(SCTP_DEBUG_OUTPUT1, "USR Send complete qo:%d prw:%d unsent:%d tf:%d cooq:%d toqs:%d err:%d\n",
13755 queue_only, stcb->asoc.peers_rwnd, un_sent,
13756 stcb->asoc.total_flight, stcb->asoc.chunks_on_out_queue,
13757 stcb->asoc.total_output_queue_size, error);
13758
13759 out:
13760 out_unlocked:
13761
13762 if (local_soresv && stcb) {
13763 atomic_subtract_int(&stcb->asoc.sb_send_resv, sndlen);
13764 }
13765 if (create_lock_applied) {
13766 SCTP_ASOC_CREATE_UNLOCK(inp);
13767 }
13768 if ((stcb) && hold_tcblock) {
13769 SCTP_TCB_UNLOCK(stcb);
13770 }
13771 if (stcb && free_cnt_applied) {
13772 atomic_add_int(&stcb->asoc.refcnt, -1);
13773 }
13774 #ifdef INVARIANTS
13775 if (stcb) {
13776 if (mtx_owned(&stcb->tcb_mtx)) {
13777 panic("Leaving with tcb mtx owned?");
13778 }
13779 if (mtx_owned(&stcb->tcb_send_mtx)) {
13780 panic("Leaving with tcb send mtx owned?");
13781 }
13782 }
13783 #endif
13784 if (top) {
13785 sctp_m_freem(top);
13786 }
13787 if (control) {
13788 sctp_m_freem(control);
13789 }
13790 return (error);
13791 }
13792
13793
13794 /*
13795 * generate an AUTHentication chunk, if required
13796 */
13797 struct mbuf *
sctp_add_auth_chunk(struct mbuf * m,struct mbuf ** m_end,struct sctp_auth_chunk ** auth_ret,uint32_t * offset,struct sctp_tcb * stcb,uint8_t chunk)13798 sctp_add_auth_chunk(struct mbuf *m, struct mbuf **m_end,
13799 struct sctp_auth_chunk **auth_ret, uint32_t *offset,
13800 struct sctp_tcb *stcb, uint8_t chunk)
13801 {
13802 struct mbuf *m_auth;
13803 struct sctp_auth_chunk *auth;
13804 int chunk_len;
13805 struct mbuf *cn;
13806
13807 if ((m_end == NULL) || (auth_ret == NULL) || (offset == NULL) ||
13808 (stcb == NULL))
13809 return (m);
13810
13811 if (stcb->asoc.auth_supported == 0) {
13812 return (m);
13813 }
13814 /* does the requested chunk require auth? */
13815 if (!sctp_auth_is_required_chunk(chunk, stcb->asoc.peer_auth_chunks)) {
13816 return (m);
13817 }
13818 m_auth = sctp_get_mbuf_for_msg(sizeof(*auth), 0, M_NOWAIT, 1, MT_HEADER);
13819 if (m_auth == NULL) {
13820 /* no mbuf's */
13821 return (m);
13822 }
13823 /* reserve some space if this will be the first mbuf */
13824 if (m == NULL)
13825 SCTP_BUF_RESV_UF(m_auth, SCTP_MIN_OVERHEAD);
13826 /* fill in the AUTH chunk details */
13827 auth = mtod(m_auth, struct sctp_auth_chunk *);
13828 memset(auth, 0, sizeof(*auth));
13829 auth->ch.chunk_type = SCTP_AUTHENTICATION;
13830 auth->ch.chunk_flags = 0;
13831 chunk_len = sizeof(*auth) +
13832 sctp_get_hmac_digest_len(stcb->asoc.peer_hmac_id);
13833 auth->ch.chunk_length = htons(chunk_len);
13834 auth->hmac_id = htons(stcb->asoc.peer_hmac_id);
13835 /* key id and hmac digest will be computed and filled in upon send */
13836
13837 /* save the offset where the auth was inserted into the chain */
13838 *offset = 0;
13839 for (cn = m; cn; cn = SCTP_BUF_NEXT(cn)) {
13840 *offset += SCTP_BUF_LEN(cn);
13841 }
13842
13843 /* update length and return pointer to the auth chunk */
13844 SCTP_BUF_LEN(m_auth) = chunk_len;
13845 m = sctp_copy_mbufchain(m_auth, m, m_end, 1, chunk_len, 0);
13846 if (auth_ret != NULL)
13847 *auth_ret = auth;
13848
13849 return (m);
13850 }
13851
13852 #ifdef INET6
13853 int
sctp_v6src_match_nexthop(struct sockaddr_in6 * src6,sctp_route_t * ro)13854 sctp_v6src_match_nexthop(struct sockaddr_in6 *src6, sctp_route_t *ro)
13855 {
13856 struct nd_prefix *pfx = NULL;
13857 struct nd_pfxrouter *pfxrtr = NULL;
13858 struct sockaddr_in6 gw6;
13859
13860 if (ro == NULL || ro->ro_rt == NULL || src6->sin6_family != AF_INET6)
13861 return (0);
13862
13863 /* get prefix entry of address */
13864 ND6_RLOCK();
13865 LIST_FOREACH(pfx, &MODULE_GLOBAL(nd_prefix), ndpr_entry) {
13866 if (pfx->ndpr_stateflags & NDPRF_DETACHED)
13867 continue;
13868 if (IN6_ARE_MASKED_ADDR_EQUAL(&pfx->ndpr_prefix.sin6_addr,
13869 &src6->sin6_addr, &pfx->ndpr_mask))
13870 break;
13871 }
13872 /* no prefix entry in the prefix list */
13873 if (pfx == NULL) {
13874 ND6_RUNLOCK();
13875 SCTPDBG(SCTP_DEBUG_OUTPUT2, "No prefix entry for ");
13876 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)src6);
13877 return (0);
13878 }
13879
13880 SCTPDBG(SCTP_DEBUG_OUTPUT2, "v6src_match_nexthop(), Prefix entry is ");
13881 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)src6);
13882
13883 /* search installed gateway from prefix entry */
13884 LIST_FOREACH(pfxrtr, &pfx->ndpr_advrtrs, pfr_entry) {
13885 memset(&gw6, 0, sizeof(struct sockaddr_in6));
13886 gw6.sin6_family = AF_INET6;
13887 gw6.sin6_len = sizeof(struct sockaddr_in6);
13888 memcpy(&gw6.sin6_addr, &pfxrtr->router->rtaddr,
13889 sizeof(struct in6_addr));
13890 SCTPDBG(SCTP_DEBUG_OUTPUT2, "prefix router is ");
13891 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)&gw6);
13892 SCTPDBG(SCTP_DEBUG_OUTPUT2, "installed router is ");
13893 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, ro->ro_rt->rt_gateway);
13894 if (sctp_cmpaddr((struct sockaddr *)&gw6, ro->ro_rt->rt_gateway)) {
13895 ND6_RUNLOCK();
13896 SCTPDBG(SCTP_DEBUG_OUTPUT2, "pfxrouter is installed\n");
13897 return (1);
13898 }
13899 }
13900 ND6_RUNLOCK();
13901 SCTPDBG(SCTP_DEBUG_OUTPUT2, "pfxrouter is not installed\n");
13902 return (0);
13903 }
13904 #endif
13905
13906 int
sctp_v4src_match_nexthop(struct sctp_ifa * sifa,sctp_route_t * ro)13907 sctp_v4src_match_nexthop(struct sctp_ifa *sifa, sctp_route_t *ro)
13908 {
13909 #ifdef INET
13910 struct sockaddr_in *sin, *mask;
13911 struct ifaddr *ifa;
13912 struct in_addr srcnetaddr, gwnetaddr;
13913
13914 if (ro == NULL || ro->ro_rt == NULL ||
13915 sifa->address.sa.sa_family != AF_INET) {
13916 return (0);
13917 }
13918 ifa = (struct ifaddr *)sifa->ifa;
13919 mask = (struct sockaddr_in *)(ifa->ifa_netmask);
13920 sin = &sifa->address.sin;
13921 srcnetaddr.s_addr = (sin->sin_addr.s_addr & mask->sin_addr.s_addr);
13922 SCTPDBG(SCTP_DEBUG_OUTPUT1, "match_nexthop4: src address is ");
13923 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &sifa->address.sa);
13924 SCTPDBG(SCTP_DEBUG_OUTPUT1, "network address is %x\n", srcnetaddr.s_addr);
13925
13926 sin = (struct sockaddr_in *)ro->ro_rt->rt_gateway;
13927 gwnetaddr.s_addr = (sin->sin_addr.s_addr & mask->sin_addr.s_addr);
13928 SCTPDBG(SCTP_DEBUG_OUTPUT1, "match_nexthop4: nexthop is ");
13929 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, ro->ro_rt->rt_gateway);
13930 SCTPDBG(SCTP_DEBUG_OUTPUT1, "network address is %x\n", gwnetaddr.s_addr);
13931 if (srcnetaddr.s_addr == gwnetaddr.s_addr) {
13932 return (1);
13933 }
13934 #endif
13935 return (0);
13936 }
13937