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: releng/12.0/sys/netinet/sctp_output.c 339221 2018-10-07 15:13:47Z tuexen $");
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
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 *
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 *
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 *
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 *
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
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
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 *
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 *
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 *
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
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 *
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 *
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
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
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 static struct sctp_tcb *
3737 sctp_findassociation_cmsgs(struct sctp_inpcb **inp_p,
3738 uint16_t port,
3739 struct mbuf *control,
3740 struct sctp_nets **net_p,
3741 int *error)
3742 {
3743 struct cmsghdr cmh;
3744 struct sctp_tcb *stcb;
3745 struct sockaddr *addr;
3746 #ifdef INET
3747 struct sockaddr_in sin;
3748 #endif
3749 #ifdef INET6
3750 struct sockaddr_in6 sin6;
3751 #endif
3752 int tot_len, rem_len, cmsg_data_len, cmsg_data_off, off;
3753
3754 tot_len = SCTP_BUF_LEN(control);
3755 for (off = 0; off < tot_len; off += CMSG_ALIGN(cmh.cmsg_len)) {
3756 rem_len = tot_len - off;
3757 if (rem_len < (int)CMSG_ALIGN(sizeof(cmh))) {
3758 /* There is not enough room for one more. */
3759 *error = EINVAL;
3760 return (NULL);
3761 }
3762 m_copydata(control, off, sizeof(cmh), (caddr_t)&cmh);
3763 if (cmh.cmsg_len < CMSG_ALIGN(sizeof(cmh))) {
3764 /* We dont't have a complete CMSG header. */
3765 *error = EINVAL;
3766 return (NULL);
3767 }
3768 if ((cmh.cmsg_len > INT_MAX) || ((int)cmh.cmsg_len > rem_len)) {
3769 /* We don't have the complete CMSG. */
3770 *error = EINVAL;
3771 return (NULL);
3772 }
3773 cmsg_data_len = (int)cmh.cmsg_len - CMSG_ALIGN(sizeof(cmh));
3774 cmsg_data_off = off + CMSG_ALIGN(sizeof(cmh));
3775 if (cmh.cmsg_level == IPPROTO_SCTP) {
3776 switch (cmh.cmsg_type) {
3777 #ifdef INET
3778 case SCTP_DSTADDRV4:
3779 if (cmsg_data_len < (int)sizeof(struct in_addr)) {
3780 *error = EINVAL;
3781 return (NULL);
3782 }
3783 memset(&sin, 0, sizeof(struct sockaddr_in));
3784 sin.sin_family = AF_INET;
3785 sin.sin_len = sizeof(struct sockaddr_in);
3786 sin.sin_port = port;
3787 m_copydata(control, cmsg_data_off, sizeof(struct in_addr), (caddr_t)&sin.sin_addr);
3788 addr = (struct sockaddr *)&sin;
3789 break;
3790 #endif
3791 #ifdef INET6
3792 case SCTP_DSTADDRV6:
3793 if (cmsg_data_len < (int)sizeof(struct in6_addr)) {
3794 *error = EINVAL;
3795 return (NULL);
3796 }
3797 memset(&sin6, 0, sizeof(struct sockaddr_in6));
3798 sin6.sin6_family = AF_INET6;
3799 sin6.sin6_len = sizeof(struct sockaddr_in6);
3800 sin6.sin6_port = port;
3801 m_copydata(control, cmsg_data_off, sizeof(struct in6_addr), (caddr_t)&sin6.sin6_addr);
3802 #ifdef INET
3803 if (IN6_IS_ADDR_V4MAPPED(&sin6.sin6_addr)) {
3804 in6_sin6_2_sin(&sin, &sin6);
3805 addr = (struct sockaddr *)&sin;
3806 } else
3807 #endif
3808 addr = (struct sockaddr *)&sin6;
3809 break;
3810 #endif
3811 default:
3812 addr = NULL;
3813 break;
3814 }
3815 if (addr) {
3816 stcb = sctp_findassociation_ep_addr(inp_p, addr, net_p, NULL, NULL);
3817 if (stcb != NULL) {
3818 return (stcb);
3819 }
3820 }
3821 }
3822 }
3823 return (NULL);
3824 }
3825
3826 static struct mbuf *
3827 sctp_add_cookie(struct mbuf *init, int init_offset,
3828 struct mbuf *initack, int initack_offset, struct sctp_state_cookie *stc_in, uint8_t **signature)
3829 {
3830 struct mbuf *copy_init, *copy_initack, *m_at, *sig, *mret;
3831 struct sctp_state_cookie *stc;
3832 struct sctp_paramhdr *ph;
3833 uint8_t *foo;
3834 int sig_offset;
3835 uint16_t cookie_sz;
3836
3837 mret = sctp_get_mbuf_for_msg((sizeof(struct sctp_state_cookie) +
3838 sizeof(struct sctp_paramhdr)), 0,
3839 M_NOWAIT, 1, MT_DATA);
3840 if (mret == NULL) {
3841 return (NULL);
3842 }
3843 copy_init = SCTP_M_COPYM(init, init_offset, M_COPYALL, M_NOWAIT);
3844 if (copy_init == NULL) {
3845 sctp_m_freem(mret);
3846 return (NULL);
3847 }
3848 #ifdef SCTP_MBUF_LOGGING
3849 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
3850 sctp_log_mbc(copy_init, SCTP_MBUF_ICOPY);
3851 }
3852 #endif
3853 copy_initack = SCTP_M_COPYM(initack, initack_offset, M_COPYALL,
3854 M_NOWAIT);
3855 if (copy_initack == NULL) {
3856 sctp_m_freem(mret);
3857 sctp_m_freem(copy_init);
3858 return (NULL);
3859 }
3860 #ifdef SCTP_MBUF_LOGGING
3861 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
3862 sctp_log_mbc(copy_initack, SCTP_MBUF_ICOPY);
3863 }
3864 #endif
3865 /* easy side we just drop it on the end */
3866 ph = mtod(mret, struct sctp_paramhdr *);
3867 SCTP_BUF_LEN(mret) = sizeof(struct sctp_state_cookie) +
3868 sizeof(struct sctp_paramhdr);
3869 stc = (struct sctp_state_cookie *)((caddr_t)ph +
3870 sizeof(struct sctp_paramhdr));
3871 ph->param_type = htons(SCTP_STATE_COOKIE);
3872 ph->param_length = 0; /* fill in at the end */
3873 /* Fill in the stc cookie data */
3874 memcpy(stc, stc_in, sizeof(struct sctp_state_cookie));
3875
3876 /* tack the INIT and then the INIT-ACK onto the chain */
3877 cookie_sz = 0;
3878 for (m_at = mret; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
3879 cookie_sz += SCTP_BUF_LEN(m_at);
3880 if (SCTP_BUF_NEXT(m_at) == NULL) {
3881 SCTP_BUF_NEXT(m_at) = copy_init;
3882 break;
3883 }
3884 }
3885 for (m_at = copy_init; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
3886 cookie_sz += SCTP_BUF_LEN(m_at);
3887 if (SCTP_BUF_NEXT(m_at) == NULL) {
3888 SCTP_BUF_NEXT(m_at) = copy_initack;
3889 break;
3890 }
3891 }
3892 for (m_at = copy_initack; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
3893 cookie_sz += SCTP_BUF_LEN(m_at);
3894 if (SCTP_BUF_NEXT(m_at) == NULL) {
3895 break;
3896 }
3897 }
3898 sig = sctp_get_mbuf_for_msg(SCTP_SECRET_SIZE, 0, M_NOWAIT, 1, MT_DATA);
3899 if (sig == NULL) {
3900 /* no space, so free the entire chain */
3901 sctp_m_freem(mret);
3902 return (NULL);
3903 }
3904 SCTP_BUF_LEN(sig) = 0;
3905 SCTP_BUF_NEXT(m_at) = sig;
3906 sig_offset = 0;
3907 foo = (uint8_t *)(mtod(sig, caddr_t)+sig_offset);
3908 memset(foo, 0, SCTP_SIGNATURE_SIZE);
3909 *signature = foo;
3910 SCTP_BUF_LEN(sig) += SCTP_SIGNATURE_SIZE;
3911 cookie_sz += SCTP_SIGNATURE_SIZE;
3912 ph->param_length = htons(cookie_sz);
3913 return (mret);
3914 }
3915
3916
3917 static uint8_t
3918 sctp_get_ect(struct sctp_tcb *stcb)
3919 {
3920 if ((stcb != NULL) && (stcb->asoc.ecn_supported == 1)) {
3921 return (SCTP_ECT0_BIT);
3922 } else {
3923 return (0);
3924 }
3925 }
3926
3927 #if defined(INET) || defined(INET6)
3928 static void
3929 sctp_handle_no_route(struct sctp_tcb *stcb,
3930 struct sctp_nets *net,
3931 int so_locked)
3932 {
3933 SCTPDBG(SCTP_DEBUG_OUTPUT1, "dropped packet - no valid source addr\n");
3934
3935 if (net) {
3936 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Destination was ");
3937 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT1, &net->ro._l_addr.sa);
3938 if (net->dest_state & SCTP_ADDR_CONFIRMED) {
3939 if ((net->dest_state & SCTP_ADDR_REACHABLE) && stcb) {
3940 SCTPDBG(SCTP_DEBUG_OUTPUT1, "no route takes interface %p down\n", (void *)net);
3941 sctp_ulp_notify(SCTP_NOTIFY_INTERFACE_DOWN,
3942 stcb, 0,
3943 (void *)net,
3944 so_locked);
3945 net->dest_state &= ~SCTP_ADDR_REACHABLE;
3946 net->dest_state &= ~SCTP_ADDR_PF;
3947 }
3948 }
3949 if (stcb) {
3950 if (net == stcb->asoc.primary_destination) {
3951 /* need a new primary */
3952 struct sctp_nets *alt;
3953
3954 alt = sctp_find_alternate_net(stcb, net, 0);
3955 if (alt != net) {
3956 if (stcb->asoc.alternate) {
3957 sctp_free_remote_addr(stcb->asoc.alternate);
3958 }
3959 stcb->asoc.alternate = alt;
3960 atomic_add_int(&stcb->asoc.alternate->ref_count, 1);
3961 if (net->ro._s_addr) {
3962 sctp_free_ifa(net->ro._s_addr);
3963 net->ro._s_addr = NULL;
3964 }
3965 net->src_addr_selected = 0;
3966 }
3967 }
3968 }
3969 }
3970 }
3971 #endif
3972
3973 static int
3974 sctp_lowlevel_chunk_output(struct sctp_inpcb *inp,
3975 struct sctp_tcb *stcb, /* may be NULL */
3976 struct sctp_nets *net,
3977 struct sockaddr *to,
3978 struct mbuf *m,
3979 uint32_t auth_offset,
3980 struct sctp_auth_chunk *auth,
3981 uint16_t auth_keyid,
3982 int nofragment_flag,
3983 int ecn_ok,
3984 int out_of_asoc_ok,
3985 uint16_t src_port,
3986 uint16_t dest_port,
3987 uint32_t v_tag,
3988 uint16_t port,
3989 union sctp_sockstore *over_addr,
3990 uint8_t mflowtype, uint32_t mflowid,
3991 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
3992 int so_locked SCTP_UNUSED
3993 #else
3994 int so_locked
3995 #endif
3996 )
3997 {
3998 /* nofragment_flag to tell if IP_DF should be set (IPv4 only) */
3999 /**
4000 * Given a mbuf chain (via SCTP_BUF_NEXT()) that holds a packet header
4001 * WITH an SCTPHDR but no IP header, endpoint inp and sa structure:
4002 * - fill in the HMAC digest of any AUTH chunk in the packet.
4003 * - calculate and fill in the SCTP checksum.
4004 * - prepend an IP address header.
4005 * - if boundall use INADDR_ANY.
4006 * - if boundspecific do source address selection.
4007 * - set fragmentation option for ipV4.
4008 * - On return from IP output, check/adjust mtu size of output
4009 * interface and smallest_mtu size as well.
4010 */
4011 /* Will need ifdefs around this */
4012 struct mbuf *newm;
4013 struct sctphdr *sctphdr;
4014 int packet_length;
4015 int ret;
4016 #if defined(INET) || defined(INET6)
4017 uint32_t vrf_id;
4018 #endif
4019 #if defined(INET) || defined(INET6)
4020 struct mbuf *o_pak;
4021 sctp_route_t *ro = NULL;
4022 struct udphdr *udp = NULL;
4023 #endif
4024 uint8_t tos_value;
4025 #if defined(__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
4026 struct socket *so = NULL;
4027 #endif
4028
4029 if ((net) && (net->dest_state & SCTP_ADDR_OUT_OF_SCOPE)) {
4030 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EFAULT);
4031 sctp_m_freem(m);
4032 return (EFAULT);
4033 }
4034 #if defined(INET) || defined(INET6)
4035 if (stcb) {
4036 vrf_id = stcb->asoc.vrf_id;
4037 } else {
4038 vrf_id = inp->def_vrf_id;
4039 }
4040 #endif
4041 /* fill in the HMAC digest for any AUTH chunk in the packet */
4042 if ((auth != NULL) && (stcb != NULL)) {
4043 sctp_fill_hmac_digest_m(m, auth_offset, auth, stcb, auth_keyid);
4044 }
4045
4046 if (net) {
4047 tos_value = net->dscp;
4048 } else if (stcb) {
4049 tos_value = stcb->asoc.default_dscp;
4050 } else {
4051 tos_value = inp->sctp_ep.default_dscp;
4052 }
4053
4054 switch (to->sa_family) {
4055 #ifdef INET
4056 case AF_INET:
4057 {
4058 struct ip *ip = NULL;
4059 sctp_route_t iproute;
4060 int len;
4061
4062 len = SCTP_MIN_V4_OVERHEAD;
4063 if (port) {
4064 len += sizeof(struct udphdr);
4065 }
4066 newm = sctp_get_mbuf_for_msg(len, 1, M_NOWAIT, 1, MT_DATA);
4067 if (newm == NULL) {
4068 sctp_m_freem(m);
4069 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4070 return (ENOMEM);
4071 }
4072 SCTP_ALIGN_TO_END(newm, len);
4073 SCTP_BUF_LEN(newm) = len;
4074 SCTP_BUF_NEXT(newm) = m;
4075 m = newm;
4076 if (net != NULL) {
4077 m->m_pkthdr.flowid = net->flowid;
4078 M_HASHTYPE_SET(m, net->flowtype);
4079 } else {
4080 m->m_pkthdr.flowid = mflowid;
4081 M_HASHTYPE_SET(m, mflowtype);
4082 }
4083 packet_length = sctp_calculate_len(m);
4084 ip = mtod(m, struct ip *);
4085 ip->ip_v = IPVERSION;
4086 ip->ip_hl = (sizeof(struct ip) >> 2);
4087 if (tos_value == 0) {
4088 /*
4089 * This means especially, that it is not set
4090 * at the SCTP layer. So use the value from
4091 * the IP layer.
4092 */
4093 tos_value = inp->ip_inp.inp.inp_ip_tos;
4094 }
4095 tos_value &= 0xfc;
4096 if (ecn_ok) {
4097 tos_value |= sctp_get_ect(stcb);
4098 }
4099 if ((nofragment_flag) && (port == 0)) {
4100 ip->ip_off = htons(IP_DF);
4101 } else {
4102 ip->ip_off = htons(0);
4103 }
4104 /* FreeBSD has a function for ip_id's */
4105 ip_fillid(ip);
4106
4107 ip->ip_ttl = inp->ip_inp.inp.inp_ip_ttl;
4108 ip->ip_len = htons(packet_length);
4109 ip->ip_tos = tos_value;
4110 if (port) {
4111 ip->ip_p = IPPROTO_UDP;
4112 } else {
4113 ip->ip_p = IPPROTO_SCTP;
4114 }
4115 ip->ip_sum = 0;
4116 if (net == NULL) {
4117 ro = &iproute;
4118 memset(&iproute, 0, sizeof(iproute));
4119 memcpy(&ro->ro_dst, to, to->sa_len);
4120 } else {
4121 ro = (sctp_route_t *)&net->ro;
4122 }
4123 /* Now the address selection part */
4124 ip->ip_dst.s_addr = ((struct sockaddr_in *)to)->sin_addr.s_addr;
4125
4126 /* call the routine to select the src address */
4127 if (net && out_of_asoc_ok == 0) {
4128 if (net->ro._s_addr && (net->ro._s_addr->localifa_flags & (SCTP_BEING_DELETED | SCTP_ADDR_IFA_UNUSEABLE))) {
4129 sctp_free_ifa(net->ro._s_addr);
4130 net->ro._s_addr = NULL;
4131 net->src_addr_selected = 0;
4132 if (ro->ro_rt) {
4133 RTFREE(ro->ro_rt);
4134 ro->ro_rt = NULL;
4135 }
4136 }
4137 if (net->src_addr_selected == 0) {
4138 /* Cache the source address */
4139 net->ro._s_addr = sctp_source_address_selection(inp, stcb,
4140 ro, net, 0,
4141 vrf_id);
4142 net->src_addr_selected = 1;
4143 }
4144 if (net->ro._s_addr == NULL) {
4145 /* No route to host */
4146 net->src_addr_selected = 0;
4147 sctp_handle_no_route(stcb, net, so_locked);
4148 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4149 sctp_m_freem(m);
4150 return (EHOSTUNREACH);
4151 }
4152 ip->ip_src = net->ro._s_addr->address.sin.sin_addr;
4153 } else {
4154 if (over_addr == NULL) {
4155 struct sctp_ifa *_lsrc;
4156
4157 _lsrc = sctp_source_address_selection(inp, stcb, ro,
4158 net,
4159 out_of_asoc_ok,
4160 vrf_id);
4161 if (_lsrc == NULL) {
4162 sctp_handle_no_route(stcb, net, so_locked);
4163 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4164 sctp_m_freem(m);
4165 return (EHOSTUNREACH);
4166 }
4167 ip->ip_src = _lsrc->address.sin.sin_addr;
4168 sctp_free_ifa(_lsrc);
4169 } else {
4170 ip->ip_src = over_addr->sin.sin_addr;
4171 SCTP_RTALLOC(ro, vrf_id, inp->fibnum);
4172 }
4173 }
4174 if (port) {
4175 if (htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port)) == 0) {
4176 sctp_handle_no_route(stcb, net, so_locked);
4177 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4178 sctp_m_freem(m);
4179 return (EHOSTUNREACH);
4180 }
4181 udp = (struct udphdr *)((caddr_t)ip + sizeof(struct ip));
4182 udp->uh_sport = htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port));
4183 udp->uh_dport = port;
4184 udp->uh_ulen = htons((uint16_t)(packet_length - sizeof(struct ip)));
4185 if (V_udp_cksum) {
4186 udp->uh_sum = in_pseudo(ip->ip_src.s_addr, ip->ip_dst.s_addr, udp->uh_ulen + htons(IPPROTO_UDP));
4187 } else {
4188 udp->uh_sum = 0;
4189 }
4190 sctphdr = (struct sctphdr *)((caddr_t)udp + sizeof(struct udphdr));
4191 } else {
4192 sctphdr = (struct sctphdr *)((caddr_t)ip + sizeof(struct ip));
4193 }
4194
4195 sctphdr->src_port = src_port;
4196 sctphdr->dest_port = dest_port;
4197 sctphdr->v_tag = v_tag;
4198 sctphdr->checksum = 0;
4199
4200 /*
4201 * If source address selection fails and we find no
4202 * route then the ip_output should fail as well with
4203 * a NO_ROUTE_TO_HOST type error. We probably should
4204 * catch that somewhere and abort the association
4205 * right away (assuming this is an INIT being sent).
4206 */
4207 if (ro->ro_rt == NULL) {
4208 /*
4209 * src addr selection failed to find a route
4210 * (or valid source addr), so we can't get
4211 * there from here (yet)!
4212 */
4213 sctp_handle_no_route(stcb, net, so_locked);
4214 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4215 sctp_m_freem(m);
4216 return (EHOSTUNREACH);
4217 }
4218 if (ro != &iproute) {
4219 memcpy(&iproute, ro, sizeof(*ro));
4220 }
4221 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Calling ipv4 output routine from low level src addr:%x\n",
4222 (uint32_t)(ntohl(ip->ip_src.s_addr)));
4223 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Destination is %x\n",
4224 (uint32_t)(ntohl(ip->ip_dst.s_addr)));
4225 SCTPDBG(SCTP_DEBUG_OUTPUT3, "RTP route is %p through\n",
4226 (void *)ro->ro_rt);
4227
4228 if (SCTP_GET_HEADER_FOR_OUTPUT(o_pak)) {
4229 /* failed to prepend data, give up */
4230 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4231 sctp_m_freem(m);
4232 return (ENOMEM);
4233 }
4234 SCTP_ATTACH_CHAIN(o_pak, m, packet_length);
4235 if (port) {
4236 sctphdr->checksum = sctp_calculate_cksum(m, sizeof(struct ip) + sizeof(struct udphdr));
4237 SCTP_STAT_INCR(sctps_sendswcrc);
4238 if (V_udp_cksum) {
4239 SCTP_ENABLE_UDP_CSUM(o_pak);
4240 }
4241 } else {
4242 m->m_pkthdr.csum_flags = CSUM_SCTP;
4243 m->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
4244 SCTP_STAT_INCR(sctps_sendhwcrc);
4245 }
4246 #ifdef SCTP_PACKET_LOGGING
4247 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING)
4248 sctp_packet_log(o_pak);
4249 #endif
4250 /* send it out. table id is taken from stcb */
4251 #if defined(__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
4252 if ((SCTP_BASE_SYSCTL(sctp_output_unlocked)) && (so_locked)) {
4253 so = SCTP_INP_SO(inp);
4254 SCTP_SOCKET_UNLOCK(so, 0);
4255 }
4256 #endif
4257 SCTP_PROBE5(send, NULL, stcb, ip, stcb, sctphdr);
4258 SCTP_IP_OUTPUT(ret, o_pak, ro, stcb, vrf_id);
4259 #if defined(__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
4260 if ((SCTP_BASE_SYSCTL(sctp_output_unlocked)) && (so_locked)) {
4261 atomic_add_int(&stcb->asoc.refcnt, 1);
4262 SCTP_TCB_UNLOCK(stcb);
4263 SCTP_SOCKET_LOCK(so, 0);
4264 SCTP_TCB_LOCK(stcb);
4265 atomic_subtract_int(&stcb->asoc.refcnt, 1);
4266 }
4267 #endif
4268 if (port) {
4269 UDPSTAT_INC(udps_opackets);
4270 }
4271 SCTP_STAT_INCR(sctps_sendpackets);
4272 SCTP_STAT_INCR_COUNTER64(sctps_outpackets);
4273 if (ret)
4274 SCTP_STAT_INCR(sctps_senderrors);
4275
4276 SCTPDBG(SCTP_DEBUG_OUTPUT3, "IP output returns %d\n", ret);
4277 if (net == NULL) {
4278 /* free tempy routes */
4279 RO_RTFREE(ro);
4280 } else {
4281 if ((ro->ro_rt != NULL) && (net->ro._s_addr) &&
4282 ((net->dest_state & SCTP_ADDR_NO_PMTUD) == 0)) {
4283 uint32_t mtu;
4284
4285 mtu = SCTP_GATHER_MTU_FROM_ROUTE(net->ro._s_addr, &net->ro._l_addr.sa, ro->ro_rt);
4286 if (mtu > 0) {
4287 if (net->port) {
4288 mtu -= sizeof(struct udphdr);
4289 }
4290 if ((stcb != NULL) && (stcb->asoc.smallest_mtu > mtu)) {
4291 sctp_mtu_size_reset(inp, &stcb->asoc, mtu);
4292 }
4293 net->mtu = mtu;
4294 }
4295 } else if (ro->ro_rt == NULL) {
4296 /* route was freed */
4297 if (net->ro._s_addr &&
4298 net->src_addr_selected) {
4299 sctp_free_ifa(net->ro._s_addr);
4300 net->ro._s_addr = NULL;
4301 }
4302 net->src_addr_selected = 0;
4303 }
4304 }
4305 return (ret);
4306 }
4307 #endif
4308 #ifdef INET6
4309 case AF_INET6:
4310 {
4311 uint32_t flowlabel, flowinfo;
4312 struct ip6_hdr *ip6h;
4313 struct route_in6 ip6route;
4314 struct ifnet *ifp;
4315 struct sockaddr_in6 *sin6, tmp, *lsa6, lsa6_tmp;
4316 int prev_scope = 0;
4317 struct sockaddr_in6 lsa6_storage;
4318 int error;
4319 u_short prev_port = 0;
4320 int len;
4321
4322 if (net) {
4323 flowlabel = net->flowlabel;
4324 } else if (stcb) {
4325 flowlabel = stcb->asoc.default_flowlabel;
4326 } else {
4327 flowlabel = inp->sctp_ep.default_flowlabel;
4328 }
4329 if (flowlabel == 0) {
4330 /*
4331 * This means especially, that it is not set
4332 * at the SCTP layer. So use the value from
4333 * the IP layer.
4334 */
4335 flowlabel = ntohl(((struct in6pcb *)inp)->in6p_flowinfo);
4336 }
4337 flowlabel &= 0x000fffff;
4338 len = SCTP_MIN_OVERHEAD;
4339 if (port) {
4340 len += sizeof(struct udphdr);
4341 }
4342 newm = sctp_get_mbuf_for_msg(len, 1, M_NOWAIT, 1, MT_DATA);
4343 if (newm == NULL) {
4344 sctp_m_freem(m);
4345 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4346 return (ENOMEM);
4347 }
4348 SCTP_ALIGN_TO_END(newm, len);
4349 SCTP_BUF_LEN(newm) = len;
4350 SCTP_BUF_NEXT(newm) = m;
4351 m = newm;
4352 if (net != NULL) {
4353 m->m_pkthdr.flowid = net->flowid;
4354 M_HASHTYPE_SET(m, net->flowtype);
4355 } else {
4356 m->m_pkthdr.flowid = mflowid;
4357 M_HASHTYPE_SET(m, mflowtype);
4358 }
4359 packet_length = sctp_calculate_len(m);
4360
4361 ip6h = mtod(m, struct ip6_hdr *);
4362 /* protect *sin6 from overwrite */
4363 sin6 = (struct sockaddr_in6 *)to;
4364 tmp = *sin6;
4365 sin6 = &tmp;
4366
4367 /* KAME hack: embed scopeid */
4368 if (sa6_embedscope(sin6, MODULE_GLOBAL(ip6_use_defzone)) != 0) {
4369 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
4370 sctp_m_freem(m);
4371 return (EINVAL);
4372 }
4373 if (net == NULL) {
4374 memset(&ip6route, 0, sizeof(ip6route));
4375 ro = (sctp_route_t *)&ip6route;
4376 memcpy(&ro->ro_dst, sin6, sin6->sin6_len);
4377 } else {
4378 ro = (sctp_route_t *)&net->ro;
4379 }
4380 /*
4381 * We assume here that inp_flow is in host byte
4382 * order within the TCB!
4383 */
4384 if (tos_value == 0) {
4385 /*
4386 * This means especially, that it is not set
4387 * at the SCTP layer. So use the value from
4388 * the IP layer.
4389 */
4390 tos_value = (ntohl(((struct in6pcb *)inp)->in6p_flowinfo) >> 20) & 0xff;
4391 }
4392 tos_value &= 0xfc;
4393 if (ecn_ok) {
4394 tos_value |= sctp_get_ect(stcb);
4395 }
4396 flowinfo = 0x06;
4397 flowinfo <<= 8;
4398 flowinfo |= tos_value;
4399 flowinfo <<= 20;
4400 flowinfo |= flowlabel;
4401 ip6h->ip6_flow = htonl(flowinfo);
4402 if (port) {
4403 ip6h->ip6_nxt = IPPROTO_UDP;
4404 } else {
4405 ip6h->ip6_nxt = IPPROTO_SCTP;
4406 }
4407 ip6h->ip6_plen = htons((uint16_t)(packet_length - sizeof(struct ip6_hdr)));
4408 ip6h->ip6_dst = sin6->sin6_addr;
4409
4410 /*
4411 * Add SRC address selection here: we can only reuse
4412 * to a limited degree the kame src-addr-sel, since
4413 * we can try their selection but it may not be
4414 * bound.
4415 */
4416 memset(&lsa6_tmp, 0, sizeof(lsa6_tmp));
4417 lsa6_tmp.sin6_family = AF_INET6;
4418 lsa6_tmp.sin6_len = sizeof(lsa6_tmp);
4419 lsa6 = &lsa6_tmp;
4420 if (net && out_of_asoc_ok == 0) {
4421 if (net->ro._s_addr && (net->ro._s_addr->localifa_flags & (SCTP_BEING_DELETED | SCTP_ADDR_IFA_UNUSEABLE))) {
4422 sctp_free_ifa(net->ro._s_addr);
4423 net->ro._s_addr = NULL;
4424 net->src_addr_selected = 0;
4425 if (ro->ro_rt) {
4426 RTFREE(ro->ro_rt);
4427 ro->ro_rt = NULL;
4428 }
4429 }
4430 if (net->src_addr_selected == 0) {
4431 sin6 = (struct sockaddr_in6 *)&net->ro._l_addr;
4432 /* KAME hack: embed scopeid */
4433 if (sa6_embedscope(sin6, MODULE_GLOBAL(ip6_use_defzone)) != 0) {
4434 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
4435 sctp_m_freem(m);
4436 return (EINVAL);
4437 }
4438 /* Cache the source address */
4439 net->ro._s_addr = sctp_source_address_selection(inp,
4440 stcb,
4441 ro,
4442 net,
4443 0,
4444 vrf_id);
4445 (void)sa6_recoverscope(sin6);
4446 net->src_addr_selected = 1;
4447 }
4448 if (net->ro._s_addr == NULL) {
4449 SCTPDBG(SCTP_DEBUG_OUTPUT3, "V6:No route to host\n");
4450 net->src_addr_selected = 0;
4451 sctp_handle_no_route(stcb, net, so_locked);
4452 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4453 sctp_m_freem(m);
4454 return (EHOSTUNREACH);
4455 }
4456 lsa6->sin6_addr = net->ro._s_addr->address.sin6.sin6_addr;
4457 } else {
4458 sin6 = (struct sockaddr_in6 *)&ro->ro_dst;
4459 /* KAME hack: embed scopeid */
4460 if (sa6_embedscope(sin6, MODULE_GLOBAL(ip6_use_defzone)) != 0) {
4461 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
4462 sctp_m_freem(m);
4463 return (EINVAL);
4464 }
4465 if (over_addr == NULL) {
4466 struct sctp_ifa *_lsrc;
4467
4468 _lsrc = sctp_source_address_selection(inp, stcb, ro,
4469 net,
4470 out_of_asoc_ok,
4471 vrf_id);
4472 if (_lsrc == NULL) {
4473 sctp_handle_no_route(stcb, net, so_locked);
4474 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4475 sctp_m_freem(m);
4476 return (EHOSTUNREACH);
4477 }
4478 lsa6->sin6_addr = _lsrc->address.sin6.sin6_addr;
4479 sctp_free_ifa(_lsrc);
4480 } else {
4481 lsa6->sin6_addr = over_addr->sin6.sin6_addr;
4482 SCTP_RTALLOC(ro, vrf_id, inp->fibnum);
4483 }
4484 (void)sa6_recoverscope(sin6);
4485 }
4486 lsa6->sin6_port = inp->sctp_lport;
4487
4488 if (ro->ro_rt == NULL) {
4489 /*
4490 * src addr selection failed to find a route
4491 * (or valid source addr), so we can't get
4492 * there from here!
4493 */
4494 sctp_handle_no_route(stcb, net, so_locked);
4495 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4496 sctp_m_freem(m);
4497 return (EHOSTUNREACH);
4498 }
4499 /*
4500 * XXX: sa6 may not have a valid sin6_scope_id in
4501 * the non-SCOPEDROUTING case.
4502 */
4503 memset(&lsa6_storage, 0, sizeof(lsa6_storage));
4504 lsa6_storage.sin6_family = AF_INET6;
4505 lsa6_storage.sin6_len = sizeof(lsa6_storage);
4506 lsa6_storage.sin6_addr = lsa6->sin6_addr;
4507 if ((error = sa6_recoverscope(&lsa6_storage)) != 0) {
4508 SCTPDBG(SCTP_DEBUG_OUTPUT3, "recover scope fails error %d\n", error);
4509 sctp_m_freem(m);
4510 return (error);
4511 }
4512 /* XXX */
4513 lsa6_storage.sin6_addr = lsa6->sin6_addr;
4514 lsa6_storage.sin6_port = inp->sctp_lport;
4515 lsa6 = &lsa6_storage;
4516 ip6h->ip6_src = lsa6->sin6_addr;
4517
4518 if (port) {
4519 if (htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port)) == 0) {
4520 sctp_handle_no_route(stcb, net, so_locked);
4521 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4522 sctp_m_freem(m);
4523 return (EHOSTUNREACH);
4524 }
4525 udp = (struct udphdr *)((caddr_t)ip6h + sizeof(struct ip6_hdr));
4526 udp->uh_sport = htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port));
4527 udp->uh_dport = port;
4528 udp->uh_ulen = htons((uint16_t)(packet_length - sizeof(struct ip6_hdr)));
4529 udp->uh_sum = 0;
4530 sctphdr = (struct sctphdr *)((caddr_t)udp + sizeof(struct udphdr));
4531 } else {
4532 sctphdr = (struct sctphdr *)((caddr_t)ip6h + sizeof(struct ip6_hdr));
4533 }
4534
4535 sctphdr->src_port = src_port;
4536 sctphdr->dest_port = dest_port;
4537 sctphdr->v_tag = v_tag;
4538 sctphdr->checksum = 0;
4539
4540 /*
4541 * We set the hop limit now since there is a good
4542 * chance that our ro pointer is now filled
4543 */
4544 ip6h->ip6_hlim = SCTP_GET_HLIM(inp, ro);
4545 ifp = SCTP_GET_IFN_VOID_FROM_ROUTE(ro);
4546
4547 #ifdef SCTP_DEBUG
4548 /* Copy to be sure something bad is not happening */
4549 sin6->sin6_addr = ip6h->ip6_dst;
4550 lsa6->sin6_addr = ip6h->ip6_src;
4551 #endif
4552
4553 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Calling ipv6 output routine from low level\n");
4554 SCTPDBG(SCTP_DEBUG_OUTPUT3, "src: ");
4555 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT3, (struct sockaddr *)lsa6);
4556 SCTPDBG(SCTP_DEBUG_OUTPUT3, "dst: ");
4557 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT3, (struct sockaddr *)sin6);
4558 if (net) {
4559 sin6 = (struct sockaddr_in6 *)&net->ro._l_addr;
4560 /*
4561 * preserve the port and scope for link
4562 * local send
4563 */
4564 prev_scope = sin6->sin6_scope_id;
4565 prev_port = sin6->sin6_port;
4566 }
4567
4568 if (SCTP_GET_HEADER_FOR_OUTPUT(o_pak)) {
4569 /* failed to prepend data, give up */
4570 sctp_m_freem(m);
4571 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4572 return (ENOMEM);
4573 }
4574 SCTP_ATTACH_CHAIN(o_pak, m, packet_length);
4575 if (port) {
4576 sctphdr->checksum = sctp_calculate_cksum(m, sizeof(struct ip6_hdr) + sizeof(struct udphdr));
4577 SCTP_STAT_INCR(sctps_sendswcrc);
4578 if ((udp->uh_sum = in6_cksum(o_pak, IPPROTO_UDP, sizeof(struct ip6_hdr), packet_length - sizeof(struct ip6_hdr))) == 0) {
4579 udp->uh_sum = 0xffff;
4580 }
4581 } else {
4582 m->m_pkthdr.csum_flags = CSUM_SCTP_IPV6;
4583 m->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
4584 SCTP_STAT_INCR(sctps_sendhwcrc);
4585 }
4586 /* send it out. table id is taken from stcb */
4587 #if defined(__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
4588 if ((SCTP_BASE_SYSCTL(sctp_output_unlocked)) && (so_locked)) {
4589 so = SCTP_INP_SO(inp);
4590 SCTP_SOCKET_UNLOCK(so, 0);
4591 }
4592 #endif
4593 #ifdef SCTP_PACKET_LOGGING
4594 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING)
4595 sctp_packet_log(o_pak);
4596 #endif
4597 SCTP_PROBE5(send, NULL, stcb, ip6h, stcb, sctphdr);
4598 SCTP_IP6_OUTPUT(ret, o_pak, (struct route_in6 *)ro, &ifp, stcb, vrf_id);
4599 #if defined(__APPLE__) || defined(SCTP_SO_LOCK_TESTING)
4600 if ((SCTP_BASE_SYSCTL(sctp_output_unlocked)) && (so_locked)) {
4601 atomic_add_int(&stcb->asoc.refcnt, 1);
4602 SCTP_TCB_UNLOCK(stcb);
4603 SCTP_SOCKET_LOCK(so, 0);
4604 SCTP_TCB_LOCK(stcb);
4605 atomic_subtract_int(&stcb->asoc.refcnt, 1);
4606 }
4607 #endif
4608 if (net) {
4609 /* for link local this must be done */
4610 sin6->sin6_scope_id = prev_scope;
4611 sin6->sin6_port = prev_port;
4612 }
4613 SCTPDBG(SCTP_DEBUG_OUTPUT3, "return from send is %d\n", ret);
4614 if (port) {
4615 UDPSTAT_INC(udps_opackets);
4616 }
4617 SCTP_STAT_INCR(sctps_sendpackets);
4618 SCTP_STAT_INCR_COUNTER64(sctps_outpackets);
4619 if (ret) {
4620 SCTP_STAT_INCR(sctps_senderrors);
4621 }
4622 if (net == NULL) {
4623 /* Now if we had a temp route free it */
4624 RO_RTFREE(ro);
4625 } else {
4626 /*
4627 * PMTU check versus smallest asoc MTU goes
4628 * here
4629 */
4630 if (ro->ro_rt == NULL) {
4631 /* Route was freed */
4632 if (net->ro._s_addr &&
4633 net->src_addr_selected) {
4634 sctp_free_ifa(net->ro._s_addr);
4635 net->ro._s_addr = NULL;
4636 }
4637 net->src_addr_selected = 0;
4638 }
4639 if ((ro->ro_rt != NULL) && (net->ro._s_addr) &&
4640 ((net->dest_state & SCTP_ADDR_NO_PMTUD) == 0)) {
4641 uint32_t mtu;
4642
4643 mtu = SCTP_GATHER_MTU_FROM_ROUTE(net->ro._s_addr, &net->ro._l_addr.sa, ro->ro_rt);
4644 if (mtu > 0) {
4645 if (net->port) {
4646 mtu -= sizeof(struct udphdr);
4647 }
4648 if ((stcb != NULL) && (stcb->asoc.smallest_mtu > mtu)) {
4649 sctp_mtu_size_reset(inp, &stcb->asoc, mtu);
4650 }
4651 net->mtu = mtu;
4652 }
4653 } else if (ifp) {
4654 if (ND_IFINFO(ifp)->linkmtu &&
4655 (stcb->asoc.smallest_mtu > ND_IFINFO(ifp)->linkmtu)) {
4656 sctp_mtu_size_reset(inp,
4657 &stcb->asoc,
4658 ND_IFINFO(ifp)->linkmtu);
4659 }
4660 }
4661 }
4662 return (ret);
4663 }
4664 #endif
4665 default:
4666 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Unknown protocol (TSNH) type %d\n",
4667 ((struct sockaddr *)to)->sa_family);
4668 sctp_m_freem(m);
4669 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EFAULT);
4670 return (EFAULT);
4671 }
4672 }
4673
4674
4675 void
4676 sctp_send_initiate(struct sctp_inpcb *inp, struct sctp_tcb *stcb, int so_locked
4677 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
4678 SCTP_UNUSED
4679 #endif
4680 )
4681 {
4682 struct mbuf *m, *m_last;
4683 struct sctp_nets *net;
4684 struct sctp_init_chunk *init;
4685 struct sctp_supported_addr_param *sup_addr;
4686 struct sctp_adaptation_layer_indication *ali;
4687 struct sctp_supported_chunk_types_param *pr_supported;
4688 struct sctp_paramhdr *ph;
4689 int cnt_inits_to = 0;
4690 int error;
4691 uint16_t num_ext, chunk_len, padding_len, parameter_len;
4692
4693 /* INIT's always go to the primary (and usually ONLY address) */
4694 net = stcb->asoc.primary_destination;
4695 if (net == NULL) {
4696 net = TAILQ_FIRST(&stcb->asoc.nets);
4697 if (net == NULL) {
4698 /* TSNH */
4699 return;
4700 }
4701 /* we confirm any address we send an INIT to */
4702 net->dest_state &= ~SCTP_ADDR_UNCONFIRMED;
4703 (void)sctp_set_primary_addr(stcb, NULL, net);
4704 } else {
4705 /* we confirm any address we send an INIT to */
4706 net->dest_state &= ~SCTP_ADDR_UNCONFIRMED;
4707 }
4708 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT\n");
4709 #ifdef INET6
4710 if (net->ro._l_addr.sa.sa_family == AF_INET6) {
4711 /*
4712 * special hook, if we are sending to link local it will not
4713 * show up in our private address count.
4714 */
4715 if (IN6_IS_ADDR_LINKLOCAL(&net->ro._l_addr.sin6.sin6_addr))
4716 cnt_inits_to = 1;
4717 }
4718 #endif
4719 if (SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
4720 /* This case should not happen */
4721 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT - failed timer?\n");
4722 return;
4723 }
4724 /* start the INIT timer */
4725 sctp_timer_start(SCTP_TIMER_TYPE_INIT, inp, stcb, net);
4726
4727 m = sctp_get_mbuf_for_msg(MCLBYTES, 1, M_NOWAIT, 1, MT_DATA);
4728 if (m == NULL) {
4729 /* No memory, INIT timer will re-attempt. */
4730 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT - mbuf?\n");
4731 return;
4732 }
4733 chunk_len = (uint16_t)sizeof(struct sctp_init_chunk);
4734 padding_len = 0;
4735 /* Now lets put the chunk header in place */
4736 init = mtod(m, struct sctp_init_chunk *);
4737 /* now the chunk header */
4738 init->ch.chunk_type = SCTP_INITIATION;
4739 init->ch.chunk_flags = 0;
4740 /* fill in later from mbuf we build */
4741 init->ch.chunk_length = 0;
4742 /* place in my tag */
4743 init->init.initiate_tag = htonl(stcb->asoc.my_vtag);
4744 /* set up some of the credits. */
4745 init->init.a_rwnd = htonl(max(inp->sctp_socket ? SCTP_SB_LIMIT_RCV(inp->sctp_socket) : 0,
4746 SCTP_MINIMAL_RWND));
4747 init->init.num_outbound_streams = htons(stcb->asoc.pre_open_streams);
4748 init->init.num_inbound_streams = htons(stcb->asoc.max_inbound_streams);
4749 init->init.initial_tsn = htonl(stcb->asoc.init_seq_number);
4750
4751 /* Adaptation layer indication parameter */
4752 if (inp->sctp_ep.adaptation_layer_indicator_provided) {
4753 parameter_len = (uint16_t)sizeof(struct sctp_adaptation_layer_indication);
4754 ali = (struct sctp_adaptation_layer_indication *)(mtod(m, caddr_t)+chunk_len);
4755 ali->ph.param_type = htons(SCTP_ULP_ADAPTATION);
4756 ali->ph.param_length = htons(parameter_len);
4757 ali->indication = htonl(inp->sctp_ep.adaptation_layer_indicator);
4758 chunk_len += parameter_len;
4759 }
4760
4761 /* ECN parameter */
4762 if (stcb->asoc.ecn_supported == 1) {
4763 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4764 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
4765 ph->param_type = htons(SCTP_ECN_CAPABLE);
4766 ph->param_length = htons(parameter_len);
4767 chunk_len += parameter_len;
4768 }
4769
4770 /* PR-SCTP supported parameter */
4771 if (stcb->asoc.prsctp_supported == 1) {
4772 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4773 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
4774 ph->param_type = htons(SCTP_PRSCTP_SUPPORTED);
4775 ph->param_length = htons(parameter_len);
4776 chunk_len += parameter_len;
4777 }
4778
4779 /* Add NAT friendly parameter. */
4780 if (SCTP_BASE_SYSCTL(sctp_inits_include_nat_friendly)) {
4781 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4782 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
4783 ph->param_type = htons(SCTP_HAS_NAT_SUPPORT);
4784 ph->param_length = htons(parameter_len);
4785 chunk_len += parameter_len;
4786 }
4787
4788 /* And now tell the peer which extensions we support */
4789 num_ext = 0;
4790 pr_supported = (struct sctp_supported_chunk_types_param *)(mtod(m, caddr_t)+chunk_len);
4791 if (stcb->asoc.prsctp_supported == 1) {
4792 pr_supported->chunk_types[num_ext++] = SCTP_FORWARD_CUM_TSN;
4793 if (stcb->asoc.idata_supported) {
4794 pr_supported->chunk_types[num_ext++] = SCTP_IFORWARD_CUM_TSN;
4795 }
4796 }
4797 if (stcb->asoc.auth_supported == 1) {
4798 pr_supported->chunk_types[num_ext++] = SCTP_AUTHENTICATION;
4799 }
4800 if (stcb->asoc.asconf_supported == 1) {
4801 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF;
4802 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF_ACK;
4803 }
4804 if (stcb->asoc.reconfig_supported == 1) {
4805 pr_supported->chunk_types[num_ext++] = SCTP_STREAM_RESET;
4806 }
4807 if (stcb->asoc.idata_supported) {
4808 pr_supported->chunk_types[num_ext++] = SCTP_IDATA;
4809 }
4810 if (stcb->asoc.nrsack_supported == 1) {
4811 pr_supported->chunk_types[num_ext++] = SCTP_NR_SELECTIVE_ACK;
4812 }
4813 if (stcb->asoc.pktdrop_supported == 1) {
4814 pr_supported->chunk_types[num_ext++] = SCTP_PACKET_DROPPED;
4815 }
4816 if (num_ext > 0) {
4817 parameter_len = (uint16_t)sizeof(struct sctp_supported_chunk_types_param) + num_ext;
4818 pr_supported->ph.param_type = htons(SCTP_SUPPORTED_CHUNK_EXT);
4819 pr_supported->ph.param_length = htons(parameter_len);
4820 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4821 chunk_len += parameter_len;
4822 }
4823 /* add authentication parameters */
4824 if (stcb->asoc.auth_supported) {
4825 /* attach RANDOM parameter, if available */
4826 if (stcb->asoc.authinfo.random != NULL) {
4827 struct sctp_auth_random *randp;
4828
4829 if (padding_len > 0) {
4830 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4831 chunk_len += padding_len;
4832 padding_len = 0;
4833 }
4834 randp = (struct sctp_auth_random *)(mtod(m, caddr_t)+chunk_len);
4835 parameter_len = (uint16_t)sizeof(struct sctp_auth_random) + stcb->asoc.authinfo.random_len;
4836 /* random key already contains the header */
4837 memcpy(randp, stcb->asoc.authinfo.random->key, parameter_len);
4838 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4839 chunk_len += parameter_len;
4840 }
4841 /* add HMAC_ALGO parameter */
4842 if (stcb->asoc.local_hmacs != NULL) {
4843 struct sctp_auth_hmac_algo *hmacs;
4844
4845 if (padding_len > 0) {
4846 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4847 chunk_len += padding_len;
4848 padding_len = 0;
4849 }
4850 hmacs = (struct sctp_auth_hmac_algo *)(mtod(m, caddr_t)+chunk_len);
4851 parameter_len = (uint16_t)(sizeof(struct sctp_auth_hmac_algo) +
4852 stcb->asoc.local_hmacs->num_algo * sizeof(uint16_t));
4853 hmacs->ph.param_type = htons(SCTP_HMAC_LIST);
4854 hmacs->ph.param_length = htons(parameter_len);
4855 sctp_serialize_hmaclist(stcb->asoc.local_hmacs, (uint8_t *)hmacs->hmac_ids);
4856 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4857 chunk_len += parameter_len;
4858 }
4859 /* add CHUNKS parameter */
4860 if (stcb->asoc.local_auth_chunks != NULL) {
4861 struct sctp_auth_chunk_list *chunks;
4862
4863 if (padding_len > 0) {
4864 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4865 chunk_len += padding_len;
4866 padding_len = 0;
4867 }
4868 chunks = (struct sctp_auth_chunk_list *)(mtod(m, caddr_t)+chunk_len);
4869 parameter_len = (uint16_t)(sizeof(struct sctp_auth_chunk_list) +
4870 sctp_auth_get_chklist_size(stcb->asoc.local_auth_chunks));
4871 chunks->ph.param_type = htons(SCTP_CHUNK_LIST);
4872 chunks->ph.param_length = htons(parameter_len);
4873 sctp_serialize_auth_chunks(stcb->asoc.local_auth_chunks, chunks->chunk_types);
4874 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4875 chunk_len += parameter_len;
4876 }
4877 }
4878
4879 /* now any cookie time extensions */
4880 if (stcb->asoc.cookie_preserve_req) {
4881 struct sctp_cookie_perserve_param *cookie_preserve;
4882
4883 if (padding_len > 0) {
4884 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4885 chunk_len += padding_len;
4886 padding_len = 0;
4887 }
4888 parameter_len = (uint16_t)sizeof(struct sctp_cookie_perserve_param);
4889 cookie_preserve = (struct sctp_cookie_perserve_param *)(mtod(m, caddr_t)+chunk_len);
4890 cookie_preserve->ph.param_type = htons(SCTP_COOKIE_PRESERVE);
4891 cookie_preserve->ph.param_length = htons(parameter_len);
4892 cookie_preserve->time = htonl(stcb->asoc.cookie_preserve_req);
4893 stcb->asoc.cookie_preserve_req = 0;
4894 chunk_len += parameter_len;
4895 }
4896
4897 if (stcb->asoc.scope.ipv4_addr_legal || stcb->asoc.scope.ipv6_addr_legal) {
4898 uint8_t i;
4899
4900 if (padding_len > 0) {
4901 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4902 chunk_len += padding_len;
4903 padding_len = 0;
4904 }
4905 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4906 if (stcb->asoc.scope.ipv4_addr_legal) {
4907 parameter_len += (uint16_t)sizeof(uint16_t);
4908 }
4909 if (stcb->asoc.scope.ipv6_addr_legal) {
4910 parameter_len += (uint16_t)sizeof(uint16_t);
4911 }
4912 sup_addr = (struct sctp_supported_addr_param *)(mtod(m, caddr_t)+chunk_len);
4913 sup_addr->ph.param_type = htons(SCTP_SUPPORTED_ADDRTYPE);
4914 sup_addr->ph.param_length = htons(parameter_len);
4915 i = 0;
4916 if (stcb->asoc.scope.ipv4_addr_legal) {
4917 sup_addr->addr_type[i++] = htons(SCTP_IPV4_ADDRESS);
4918 }
4919 if (stcb->asoc.scope.ipv6_addr_legal) {
4920 sup_addr->addr_type[i++] = htons(SCTP_IPV6_ADDRESS);
4921 }
4922 padding_len = 4 - 2 * i;
4923 chunk_len += parameter_len;
4924 }
4925
4926 SCTP_BUF_LEN(m) = chunk_len;
4927 /* now the addresses */
4928 /*
4929 * To optimize this we could put the scoping stuff into a structure
4930 * and remove the individual uint8's from the assoc structure. Then
4931 * we could just sifa in the address within the stcb. But for now
4932 * this is a quick hack to get the address stuff teased apart.
4933 */
4934 m_last = sctp_add_addresses_to_i_ia(inp, stcb, &stcb->asoc.scope,
4935 m, cnt_inits_to,
4936 &padding_len, &chunk_len);
4937
4938 init->ch.chunk_length = htons(chunk_len);
4939 if (padding_len > 0) {
4940 if (sctp_add_pad_tombuf(m_last, padding_len) == NULL) {
4941 sctp_m_freem(m);
4942 return;
4943 }
4944 }
4945 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT - calls lowlevel_output\n");
4946 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
4947 (struct sockaddr *)&net->ro._l_addr,
4948 m, 0, NULL, 0, 0, 0, 0,
4949 inp->sctp_lport, stcb->rport, htonl(0),
4950 net->port, NULL,
4951 0, 0,
4952 so_locked))) {
4953 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Gak send error %d\n", error);
4954 if (error == ENOBUFS) {
4955 stcb->asoc.ifp_had_enobuf = 1;
4956 SCTP_STAT_INCR(sctps_lowlevelerr);
4957 }
4958 } else {
4959 stcb->asoc.ifp_had_enobuf = 0;
4960 }
4961 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
4962 (void)SCTP_GETTIME_TIMEVAL(&net->last_sent_time);
4963 }
4964
4965 struct mbuf *
4966 sctp_arethere_unrecognized_parameters(struct mbuf *in_initpkt,
4967 int param_offset, int *abort_processing, struct sctp_chunkhdr *cp, int *nat_friendly)
4968 {
4969 /*
4970 * Given a mbuf containing an INIT or INIT-ACK with the param_offset
4971 * being equal to the beginning of the params i.e. (iphlen +
4972 * sizeof(struct sctp_init_msg) parse through the parameters to the
4973 * end of the mbuf verifying that all parameters are known.
4974 *
4975 * For unknown parameters build and return a mbuf with
4976 * UNRECOGNIZED_PARAMETER errors. If the flags indicate to stop
4977 * processing this chunk stop, and set *abort_processing to 1.
4978 *
4979 * By having param_offset be pre-set to where parameters begin it is
4980 * hoped that this routine may be reused in the future by new
4981 * features.
4982 */
4983 struct sctp_paramhdr *phdr, params;
4984
4985 struct mbuf *mat, *op_err;
4986 int at, limit, pad_needed;
4987 uint16_t ptype, plen, padded_size;
4988 int err_at;
4989
4990 *abort_processing = 0;
4991 mat = in_initpkt;
4992 err_at = 0;
4993 limit = ntohs(cp->chunk_length) - sizeof(struct sctp_init_chunk);
4994 at = param_offset;
4995 op_err = NULL;
4996 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Check for unrecognized param's\n");
4997 phdr = sctp_get_next_param(mat, at, ¶ms, sizeof(params));
4998 while ((phdr != NULL) && ((size_t)limit >= sizeof(struct sctp_paramhdr))) {
4999 ptype = ntohs(phdr->param_type);
5000 plen = ntohs(phdr->param_length);
5001 if ((plen > limit) || (plen < sizeof(struct sctp_paramhdr))) {
5002 /* wacked parameter */
5003 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error %d\n", plen);
5004 goto invalid_size;
5005 }
5006 limit -= SCTP_SIZE32(plen);
5007 /*-
5008 * All parameters for all chunks that we know/understand are
5009 * listed here. We process them other places and make
5010 * appropriate stop actions per the upper bits. However this
5011 * is the generic routine processor's can call to get back
5012 * an operr.. to either incorporate (init-ack) or send.
5013 */
5014 padded_size = SCTP_SIZE32(plen);
5015 switch (ptype) {
5016 /* Param's with variable size */
5017 case SCTP_HEARTBEAT_INFO:
5018 case SCTP_STATE_COOKIE:
5019 case SCTP_UNRECOG_PARAM:
5020 case SCTP_ERROR_CAUSE_IND:
5021 /* ok skip fwd */
5022 at += padded_size;
5023 break;
5024 /* Param's with variable size within a range */
5025 case SCTP_CHUNK_LIST:
5026 case SCTP_SUPPORTED_CHUNK_EXT:
5027 if (padded_size > (sizeof(struct sctp_supported_chunk_types_param) + (sizeof(uint8_t) * SCTP_MAX_SUPPORTED_EXT))) {
5028 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error chklist %d\n", plen);
5029 goto invalid_size;
5030 }
5031 at += padded_size;
5032 break;
5033 case SCTP_SUPPORTED_ADDRTYPE:
5034 if (padded_size > SCTP_MAX_ADDR_PARAMS_SIZE) {
5035 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error supaddrtype %d\n", plen);
5036 goto invalid_size;
5037 }
5038 at += padded_size;
5039 break;
5040 case SCTP_RANDOM:
5041 if (padded_size > (sizeof(struct sctp_auth_random) + SCTP_RANDOM_MAX_SIZE)) {
5042 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error random %d\n", plen);
5043 goto invalid_size;
5044 }
5045 at += padded_size;
5046 break;
5047 case SCTP_SET_PRIM_ADDR:
5048 case SCTP_DEL_IP_ADDRESS:
5049 case SCTP_ADD_IP_ADDRESS:
5050 if ((padded_size != sizeof(struct sctp_asconf_addrv4_param)) &&
5051 (padded_size != sizeof(struct sctp_asconf_addr_param))) {
5052 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error setprim %d\n", plen);
5053 goto invalid_size;
5054 }
5055 at += padded_size;
5056 break;
5057 /* Param's with a fixed size */
5058 case SCTP_IPV4_ADDRESS:
5059 if (padded_size != sizeof(struct sctp_ipv4addr_param)) {
5060 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error ipv4 addr %d\n", plen);
5061 goto invalid_size;
5062 }
5063 at += padded_size;
5064 break;
5065 case SCTP_IPV6_ADDRESS:
5066 if (padded_size != sizeof(struct sctp_ipv6addr_param)) {
5067 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error ipv6 addr %d\n", plen);
5068 goto invalid_size;
5069 }
5070 at += padded_size;
5071 break;
5072 case SCTP_COOKIE_PRESERVE:
5073 if (padded_size != sizeof(struct sctp_cookie_perserve_param)) {
5074 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error cookie-preserve %d\n", plen);
5075 goto invalid_size;
5076 }
5077 at += padded_size;
5078 break;
5079 case SCTP_HAS_NAT_SUPPORT:
5080 *nat_friendly = 1;
5081 /* fall through */
5082 case SCTP_PRSCTP_SUPPORTED:
5083 if (padded_size != sizeof(struct sctp_paramhdr)) {
5084 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error prsctp/nat support %d\n", plen);
5085 goto invalid_size;
5086 }
5087 at += padded_size;
5088 break;
5089 case SCTP_ECN_CAPABLE:
5090 if (padded_size != sizeof(struct sctp_paramhdr)) {
5091 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error ecn %d\n", plen);
5092 goto invalid_size;
5093 }
5094 at += padded_size;
5095 break;
5096 case SCTP_ULP_ADAPTATION:
5097 if (padded_size != sizeof(struct sctp_adaptation_layer_indication)) {
5098 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error adapatation %d\n", plen);
5099 goto invalid_size;
5100 }
5101 at += padded_size;
5102 break;
5103 case SCTP_SUCCESS_REPORT:
5104 if (padded_size != sizeof(struct sctp_asconf_paramhdr)) {
5105 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error success %d\n", plen);
5106 goto invalid_size;
5107 }
5108 at += padded_size;
5109 break;
5110 case SCTP_HOSTNAME_ADDRESS:
5111 {
5112 /* We can NOT handle HOST NAME addresses!! */
5113 int l_len;
5114
5115 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Can't handle hostname addresses.. abort processing\n");
5116 *abort_processing = 1;
5117 if (op_err == NULL) {
5118 /* Ok need to try to get a mbuf */
5119 #ifdef INET6
5120 l_len = SCTP_MIN_OVERHEAD;
5121 #else
5122 l_len = SCTP_MIN_V4_OVERHEAD;
5123 #endif
5124 l_len += sizeof(struct sctp_chunkhdr);
5125 l_len += sizeof(struct sctp_gen_error_cause);
5126 op_err = sctp_get_mbuf_for_msg(l_len, 0, M_NOWAIT, 1, MT_DATA);
5127 if (op_err) {
5128 SCTP_BUF_LEN(op_err) = 0;
5129 /*
5130 * Pre-reserve space for IP,
5131 * SCTP, and chunk header.
5132 */
5133 #ifdef INET6
5134 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip6_hdr));
5135 #else
5136 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip));
5137 #endif
5138 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctphdr));
5139 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctp_chunkhdr));
5140 }
5141 }
5142 if (op_err) {
5143 /* If we have space */
5144 struct sctp_gen_error_cause cause;
5145
5146 if (err_at % 4) {
5147 uint32_t cpthis = 0;
5148
5149 pad_needed = 4 - (err_at % 4);
5150 m_copyback(op_err, err_at, pad_needed, (caddr_t)&cpthis);
5151 err_at += pad_needed;
5152 }
5153 cause.code = htons(SCTP_CAUSE_UNRESOLVABLE_ADDR);
5154 cause.length = htons((uint16_t)(sizeof(struct sctp_gen_error_cause) + plen));
5155 m_copyback(op_err, err_at, sizeof(struct sctp_gen_error_cause), (caddr_t)&cause);
5156 err_at += sizeof(struct sctp_gen_error_cause);
5157 SCTP_BUF_NEXT(op_err) = SCTP_M_COPYM(mat, at, plen, M_NOWAIT);
5158 if (SCTP_BUF_NEXT(op_err) == NULL) {
5159 sctp_m_freem(op_err);
5160 return (NULL);
5161 }
5162 }
5163 return (op_err);
5164 break;
5165 }
5166 default:
5167 /*
5168 * we do not recognize the parameter figure out what
5169 * we do.
5170 */
5171 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Hit default param %x\n", ptype);
5172 if ((ptype & 0x4000) == 0x4000) {
5173 /* Report bit is set?? */
5174 SCTPDBG(SCTP_DEBUG_OUTPUT1, "report op err\n");
5175 if (op_err == NULL) {
5176 int l_len;
5177
5178 /* Ok need to try to get an mbuf */
5179 #ifdef INET6
5180 l_len = SCTP_MIN_OVERHEAD;
5181 #else
5182 l_len = SCTP_MIN_V4_OVERHEAD;
5183 #endif
5184 l_len += sizeof(struct sctp_chunkhdr);
5185 l_len += sizeof(struct sctp_paramhdr);
5186 op_err = sctp_get_mbuf_for_msg(l_len, 0, M_NOWAIT, 1, MT_DATA);
5187 if (op_err) {
5188 SCTP_BUF_LEN(op_err) = 0;
5189 #ifdef INET6
5190 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip6_hdr));
5191 #else
5192 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip));
5193 #endif
5194 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctphdr));
5195 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctp_chunkhdr));
5196 }
5197 }
5198 if (op_err) {
5199 /* If we have space */
5200 struct sctp_paramhdr s;
5201
5202 if (err_at % 4) {
5203 uint32_t cpthis = 0;
5204
5205 pad_needed = 4 - (err_at % 4);
5206 m_copyback(op_err, err_at, pad_needed, (caddr_t)&cpthis);
5207 err_at += pad_needed;
5208 }
5209 s.param_type = htons(SCTP_UNRECOG_PARAM);
5210 s.param_length = htons((uint16_t)sizeof(struct sctp_paramhdr) + plen);
5211 m_copyback(op_err, err_at, sizeof(struct sctp_paramhdr), (caddr_t)&s);
5212 err_at += sizeof(struct sctp_paramhdr);
5213 SCTP_BUF_NEXT(op_err) = SCTP_M_COPYM(mat, at, plen, M_NOWAIT);
5214 if (SCTP_BUF_NEXT(op_err) == NULL) {
5215 sctp_m_freem(op_err);
5216 /*
5217 * we are out of memory but
5218 * we still need to have a
5219 * look at what to do (the
5220 * system is in trouble
5221 * though).
5222 */
5223 op_err = NULL;
5224 goto more_processing;
5225 }
5226 err_at += plen;
5227 }
5228 }
5229 more_processing:
5230 if ((ptype & 0x8000) == 0x0000) {
5231 SCTPDBG(SCTP_DEBUG_OUTPUT1, "stop proc\n");
5232 return (op_err);
5233 } else {
5234 /* skip this chunk and continue processing */
5235 SCTPDBG(SCTP_DEBUG_OUTPUT1, "move on\n");
5236 at += SCTP_SIZE32(plen);
5237 }
5238 break;
5239
5240 }
5241 phdr = sctp_get_next_param(mat, at, ¶ms, sizeof(params));
5242 }
5243 return (op_err);
5244 invalid_size:
5245 SCTPDBG(SCTP_DEBUG_OUTPUT1, "abort flag set\n");
5246 *abort_processing = 1;
5247 if ((op_err == NULL) && phdr) {
5248 int l_len;
5249 #ifdef INET6
5250 l_len = SCTP_MIN_OVERHEAD;
5251 #else
5252 l_len = SCTP_MIN_V4_OVERHEAD;
5253 #endif
5254 l_len += sizeof(struct sctp_chunkhdr);
5255 l_len += (2 * sizeof(struct sctp_paramhdr));
5256 op_err = sctp_get_mbuf_for_msg(l_len, 0, M_NOWAIT, 1, MT_DATA);
5257 if (op_err) {
5258 SCTP_BUF_LEN(op_err) = 0;
5259 #ifdef INET6
5260 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip6_hdr));
5261 #else
5262 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip));
5263 #endif
5264 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctphdr));
5265 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctp_chunkhdr));
5266 }
5267 }
5268 if ((op_err) && phdr) {
5269 struct sctp_paramhdr s;
5270
5271 if (err_at % 4) {
5272 uint32_t cpthis = 0;
5273
5274 pad_needed = 4 - (err_at % 4);
5275 m_copyback(op_err, err_at, pad_needed, (caddr_t)&cpthis);
5276 err_at += pad_needed;
5277 }
5278 s.param_type = htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
5279 s.param_length = htons(sizeof(s) + sizeof(struct sctp_paramhdr));
5280 m_copyback(op_err, err_at, sizeof(s), (caddr_t)&s);
5281 err_at += sizeof(s);
5282 /* Only copy back the p-hdr that caused the issue */
5283 m_copyback(op_err, err_at, sizeof(struct sctp_paramhdr), (caddr_t)phdr);
5284 }
5285 return (op_err);
5286 }
5287
5288 static int
5289 sctp_are_there_new_addresses(struct sctp_association *asoc,
5290 struct mbuf *in_initpkt, int offset, struct sockaddr *src)
5291 {
5292 /*
5293 * Given a INIT packet, look through the packet to verify that there
5294 * are NO new addresses. As we go through the parameters add reports
5295 * of any un-understood parameters that require an error. Also we
5296 * must return (1) to drop the packet if we see a un-understood
5297 * parameter that tells us to drop the chunk.
5298 */
5299 struct sockaddr *sa_touse;
5300 struct sockaddr *sa;
5301 struct sctp_paramhdr *phdr, params;
5302 uint16_t ptype, plen;
5303 uint8_t fnd;
5304 struct sctp_nets *net;
5305 int check_src;
5306 #ifdef INET
5307 struct sockaddr_in sin4, *sa4;
5308 #endif
5309 #ifdef INET6
5310 struct sockaddr_in6 sin6, *sa6;
5311 #endif
5312
5313 #ifdef INET
5314 memset(&sin4, 0, sizeof(sin4));
5315 sin4.sin_family = AF_INET;
5316 sin4.sin_len = sizeof(sin4);
5317 #endif
5318 #ifdef INET6
5319 memset(&sin6, 0, sizeof(sin6));
5320 sin6.sin6_family = AF_INET6;
5321 sin6.sin6_len = sizeof(sin6);
5322 #endif
5323 /* First what about the src address of the pkt ? */
5324 check_src = 0;
5325 switch (src->sa_family) {
5326 #ifdef INET
5327 case AF_INET:
5328 if (asoc->scope.ipv4_addr_legal) {
5329 check_src = 1;
5330 }
5331 break;
5332 #endif
5333 #ifdef INET6
5334 case AF_INET6:
5335 if (asoc->scope.ipv6_addr_legal) {
5336 check_src = 1;
5337 }
5338 break;
5339 #endif
5340 default:
5341 /* TSNH */
5342 break;
5343 }
5344 if (check_src) {
5345 fnd = 0;
5346 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5347 sa = (struct sockaddr *)&net->ro._l_addr;
5348 if (sa->sa_family == src->sa_family) {
5349 #ifdef INET
5350 if (sa->sa_family == AF_INET) {
5351 struct sockaddr_in *src4;
5352
5353 sa4 = (struct sockaddr_in *)sa;
5354 src4 = (struct sockaddr_in *)src;
5355 if (sa4->sin_addr.s_addr == src4->sin_addr.s_addr) {
5356 fnd = 1;
5357 break;
5358 }
5359 }
5360 #endif
5361 #ifdef INET6
5362 if (sa->sa_family == AF_INET6) {
5363 struct sockaddr_in6 *src6;
5364
5365 sa6 = (struct sockaddr_in6 *)sa;
5366 src6 = (struct sockaddr_in6 *)src;
5367 if (SCTP6_ARE_ADDR_EQUAL(sa6, src6)) {
5368 fnd = 1;
5369 break;
5370 }
5371 }
5372 #endif
5373 }
5374 }
5375 if (fnd == 0) {
5376 /* New address added! no need to look further. */
5377 return (1);
5378 }
5379 }
5380 /* Ok so far lets munge through the rest of the packet */
5381 offset += sizeof(struct sctp_init_chunk);
5382 phdr = sctp_get_next_param(in_initpkt, offset, ¶ms, sizeof(params));
5383 while (phdr) {
5384 sa_touse = NULL;
5385 ptype = ntohs(phdr->param_type);
5386 plen = ntohs(phdr->param_length);
5387 switch (ptype) {
5388 #ifdef INET
5389 case SCTP_IPV4_ADDRESS:
5390 {
5391 struct sctp_ipv4addr_param *p4, p4_buf;
5392
5393 if (plen != sizeof(struct sctp_ipv4addr_param)) {
5394 return (1);
5395 }
5396 phdr = sctp_get_next_param(in_initpkt, offset,
5397 (struct sctp_paramhdr *)&p4_buf, sizeof(p4_buf));
5398 if (phdr == NULL) {
5399 return (1);
5400 }
5401 if (asoc->scope.ipv4_addr_legal) {
5402 p4 = (struct sctp_ipv4addr_param *)phdr;
5403 sin4.sin_addr.s_addr = p4->addr;
5404 sa_touse = (struct sockaddr *)&sin4;
5405 }
5406 break;
5407 }
5408 #endif
5409 #ifdef INET6
5410 case SCTP_IPV6_ADDRESS:
5411 {
5412 struct sctp_ipv6addr_param *p6, p6_buf;
5413
5414 if (plen != sizeof(struct sctp_ipv6addr_param)) {
5415 return (1);
5416 }
5417 phdr = sctp_get_next_param(in_initpkt, offset,
5418 (struct sctp_paramhdr *)&p6_buf, sizeof(p6_buf));
5419 if (phdr == NULL) {
5420 return (1);
5421 }
5422 if (asoc->scope.ipv6_addr_legal) {
5423 p6 = (struct sctp_ipv6addr_param *)phdr;
5424 memcpy((caddr_t)&sin6.sin6_addr, p6->addr,
5425 sizeof(p6->addr));
5426 sa_touse = (struct sockaddr *)&sin6;
5427 }
5428 break;
5429 }
5430 #endif
5431 default:
5432 sa_touse = NULL;
5433 break;
5434 }
5435 if (sa_touse) {
5436 /* ok, sa_touse points to one to check */
5437 fnd = 0;
5438 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5439 sa = (struct sockaddr *)&net->ro._l_addr;
5440 if (sa->sa_family != sa_touse->sa_family) {
5441 continue;
5442 }
5443 #ifdef INET
5444 if (sa->sa_family == AF_INET) {
5445 sa4 = (struct sockaddr_in *)sa;
5446 if (sa4->sin_addr.s_addr ==
5447 sin4.sin_addr.s_addr) {
5448 fnd = 1;
5449 break;
5450 }
5451 }
5452 #endif
5453 #ifdef INET6
5454 if (sa->sa_family == AF_INET6) {
5455 sa6 = (struct sockaddr_in6 *)sa;
5456 if (SCTP6_ARE_ADDR_EQUAL(
5457 sa6, &sin6)) {
5458 fnd = 1;
5459 break;
5460 }
5461 }
5462 #endif
5463 }
5464 if (!fnd) {
5465 /* New addr added! no need to look further */
5466 return (1);
5467 }
5468 }
5469 offset += SCTP_SIZE32(plen);
5470 phdr = sctp_get_next_param(in_initpkt, offset, ¶ms, sizeof(params));
5471 }
5472 return (0);
5473 }
5474
5475 /*
5476 * Given a MBUF chain that was sent into us containing an INIT. Build a
5477 * INIT-ACK with COOKIE and send back. We assume that the in_initpkt has done
5478 * a pullup to include IPv6/4header, SCTP header and initial part of INIT
5479 * message (i.e. the struct sctp_init_msg).
5480 */
5481 void
5482 sctp_send_initiate_ack(struct sctp_inpcb *inp, struct sctp_tcb *stcb,
5483 struct sctp_nets *src_net, struct mbuf *init_pkt,
5484 int iphlen, int offset,
5485 struct sockaddr *src, struct sockaddr *dst,
5486 struct sctphdr *sh, struct sctp_init_chunk *init_chk,
5487 uint8_t mflowtype, uint32_t mflowid,
5488 uint32_t vrf_id, uint16_t port)
5489 {
5490 struct sctp_association *asoc;
5491 struct mbuf *m, *m_tmp, *m_last, *m_cookie, *op_err;
5492 struct sctp_init_ack_chunk *initack;
5493 struct sctp_adaptation_layer_indication *ali;
5494 struct sctp_supported_chunk_types_param *pr_supported;
5495 struct sctp_paramhdr *ph;
5496 union sctp_sockstore *over_addr;
5497 struct sctp_scoping scp;
5498 struct timeval now;
5499 #ifdef INET
5500 struct sockaddr_in *dst4 = (struct sockaddr_in *)dst;
5501 struct sockaddr_in *src4 = (struct sockaddr_in *)src;
5502 struct sockaddr_in *sin;
5503 #endif
5504 #ifdef INET6
5505 struct sockaddr_in6 *dst6 = (struct sockaddr_in6 *)dst;
5506 struct sockaddr_in6 *src6 = (struct sockaddr_in6 *)src;
5507 struct sockaddr_in6 *sin6;
5508 #endif
5509 struct sockaddr *to;
5510 struct sctp_state_cookie stc;
5511 struct sctp_nets *net = NULL;
5512 uint8_t *signature = NULL;
5513 int cnt_inits_to = 0;
5514 uint16_t his_limit, i_want;
5515 int abort_flag;
5516 int nat_friendly = 0;
5517 int error;
5518 struct socket *so;
5519 uint16_t num_ext, chunk_len, padding_len, parameter_len;
5520
5521 if (stcb) {
5522 asoc = &stcb->asoc;
5523 } else {
5524 asoc = NULL;
5525 }
5526 if ((asoc != NULL) &&
5527 (SCTP_GET_STATE(stcb) != SCTP_STATE_COOKIE_WAIT)) {
5528 if (sctp_are_there_new_addresses(asoc, init_pkt, offset, src)) {
5529 /*
5530 * new addresses, out of here in non-cookie-wait
5531 * states
5532 *
5533 * Send an ABORT, without the new address error
5534 * cause. This looks no different than if no
5535 * listener was present.
5536 */
5537 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
5538 "Address added");
5539 sctp_send_abort(init_pkt, iphlen, src, dst, sh, 0, op_err,
5540 mflowtype, mflowid, inp->fibnum,
5541 vrf_id, port);
5542 return;
5543 }
5544 if (src_net != NULL && (src_net->port != port)) {
5545 /*
5546 * change of remote encapsulation port, out of here
5547 * in non-cookie-wait states
5548 *
5549 * Send an ABORT, without an specific error cause.
5550 * This looks no different than if no listener was
5551 * present.
5552 */
5553 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
5554 "Remote encapsulation port changed");
5555 sctp_send_abort(init_pkt, iphlen, src, dst, sh, 0, op_err,
5556 mflowtype, mflowid, inp->fibnum,
5557 vrf_id, port);
5558 return;
5559 }
5560 }
5561 abort_flag = 0;
5562 op_err = sctp_arethere_unrecognized_parameters(init_pkt,
5563 (offset + sizeof(struct sctp_init_chunk)),
5564 &abort_flag, (struct sctp_chunkhdr *)init_chk, &nat_friendly);
5565 if (abort_flag) {
5566 do_a_abort:
5567 if (op_err == NULL) {
5568 char msg[SCTP_DIAG_INFO_LEN];
5569
5570 snprintf(msg, sizeof(msg), "%s:%d at %s", __FILE__, __LINE__, __func__);
5571 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
5572 msg);
5573 }
5574 sctp_send_abort(init_pkt, iphlen, src, dst, sh,
5575 init_chk->init.initiate_tag, op_err,
5576 mflowtype, mflowid, inp->fibnum,
5577 vrf_id, port);
5578 return;
5579 }
5580 m = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
5581 if (m == NULL) {
5582 /* No memory, INIT timer will re-attempt. */
5583 if (op_err)
5584 sctp_m_freem(op_err);
5585 return;
5586 }
5587 chunk_len = (uint16_t)sizeof(struct sctp_init_ack_chunk);
5588 padding_len = 0;
5589
5590 /*
5591 * We might not overwrite the identification[] completely and on
5592 * some platforms time_entered will contain some padding. Therefore
5593 * zero out the cookie to avoid putting uninitialized memory on the
5594 * wire.
5595 */
5596 memset(&stc, 0, sizeof(struct sctp_state_cookie));
5597
5598 /* the time I built cookie */
5599 (void)SCTP_GETTIME_TIMEVAL(&now);
5600 stc.time_entered.tv_sec = now.tv_sec;
5601 stc.time_entered.tv_usec = now.tv_usec;
5602
5603 /* populate any tie tags */
5604 if (asoc != NULL) {
5605 /* unlock before tag selections */
5606 stc.tie_tag_my_vtag = asoc->my_vtag_nonce;
5607 stc.tie_tag_peer_vtag = asoc->peer_vtag_nonce;
5608 stc.cookie_life = asoc->cookie_life;
5609 net = asoc->primary_destination;
5610 } else {
5611 stc.tie_tag_my_vtag = 0;
5612 stc.tie_tag_peer_vtag = 0;
5613 /* life I will award this cookie */
5614 stc.cookie_life = inp->sctp_ep.def_cookie_life;
5615 }
5616
5617 /* copy in the ports for later check */
5618 stc.myport = sh->dest_port;
5619 stc.peerport = sh->src_port;
5620
5621 /*
5622 * If we wanted to honor cookie life extensions, we would add to
5623 * stc.cookie_life. For now we should NOT honor any extension
5624 */
5625 stc.site_scope = stc.local_scope = stc.loopback_scope = 0;
5626 if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
5627 stc.ipv6_addr_legal = 1;
5628 if (SCTP_IPV6_V6ONLY(inp)) {
5629 stc.ipv4_addr_legal = 0;
5630 } else {
5631 stc.ipv4_addr_legal = 1;
5632 }
5633 } else {
5634 stc.ipv6_addr_legal = 0;
5635 stc.ipv4_addr_legal = 1;
5636 }
5637 stc.ipv4_scope = 0;
5638 if (net == NULL) {
5639 to = src;
5640 switch (dst->sa_family) {
5641 #ifdef INET
5642 case AF_INET:
5643 {
5644 /* lookup address */
5645 stc.address[0] = src4->sin_addr.s_addr;
5646 stc.address[1] = 0;
5647 stc.address[2] = 0;
5648 stc.address[3] = 0;
5649 stc.addr_type = SCTP_IPV4_ADDRESS;
5650 /* local from address */
5651 stc.laddress[0] = dst4->sin_addr.s_addr;
5652 stc.laddress[1] = 0;
5653 stc.laddress[2] = 0;
5654 stc.laddress[3] = 0;
5655 stc.laddr_type = SCTP_IPV4_ADDRESS;
5656 /* scope_id is only for v6 */
5657 stc.scope_id = 0;
5658 if ((IN4_ISPRIVATE_ADDRESS(&src4->sin_addr)) ||
5659 (IN4_ISPRIVATE_ADDRESS(&dst4->sin_addr))) {
5660 stc.ipv4_scope = 1;
5661 }
5662 /* Must use the address in this case */
5663 if (sctp_is_address_on_local_host(src, vrf_id)) {
5664 stc.loopback_scope = 1;
5665 stc.ipv4_scope = 1;
5666 stc.site_scope = 1;
5667 stc.local_scope = 0;
5668 }
5669 break;
5670 }
5671 #endif
5672 #ifdef INET6
5673 case AF_INET6:
5674 {
5675 stc.addr_type = SCTP_IPV6_ADDRESS;
5676 memcpy(&stc.address, &src6->sin6_addr, sizeof(struct in6_addr));
5677 stc.scope_id = ntohs(in6_getscope(&src6->sin6_addr));
5678 if (sctp_is_address_on_local_host(src, vrf_id)) {
5679 stc.loopback_scope = 1;
5680 stc.local_scope = 0;
5681 stc.site_scope = 1;
5682 stc.ipv4_scope = 1;
5683 } else if (IN6_IS_ADDR_LINKLOCAL(&src6->sin6_addr) ||
5684 IN6_IS_ADDR_LINKLOCAL(&dst6->sin6_addr)) {
5685 /*
5686 * If the new destination or source
5687 * is a LINK_LOCAL we must have
5688 * common both site and local scope.
5689 * Don't set local scope though
5690 * since we must depend on the
5691 * source to be added implicitly. We
5692 * cannot assure just because we
5693 * share one link that all links are
5694 * common.
5695 */
5696 stc.local_scope = 0;
5697 stc.site_scope = 1;
5698 stc.ipv4_scope = 1;
5699 /*
5700 * we start counting for the private
5701 * address stuff at 1. since the
5702 * link local we source from won't
5703 * show up in our scoped count.
5704 */
5705 cnt_inits_to = 1;
5706 /*
5707 * pull out the scope_id from
5708 * incoming pkt
5709 */
5710 } else if (IN6_IS_ADDR_SITELOCAL(&src6->sin6_addr) ||
5711 IN6_IS_ADDR_SITELOCAL(&dst6->sin6_addr)) {
5712 /*
5713 * If the new destination or source
5714 * is SITE_LOCAL then we must have
5715 * site scope in common.
5716 */
5717 stc.site_scope = 1;
5718 }
5719 memcpy(&stc.laddress, &dst6->sin6_addr, sizeof(struct in6_addr));
5720 stc.laddr_type = SCTP_IPV6_ADDRESS;
5721 break;
5722 }
5723 #endif
5724 default:
5725 /* TSNH */
5726 goto do_a_abort;
5727 break;
5728 }
5729 } else {
5730 /* set the scope per the existing tcb */
5731
5732 #ifdef INET6
5733 struct sctp_nets *lnet;
5734 #endif
5735
5736 stc.loopback_scope = asoc->scope.loopback_scope;
5737 stc.ipv4_scope = asoc->scope.ipv4_local_scope;
5738 stc.site_scope = asoc->scope.site_scope;
5739 stc.local_scope = asoc->scope.local_scope;
5740 #ifdef INET6
5741 /* Why do we not consider IPv4 LL addresses? */
5742 TAILQ_FOREACH(lnet, &asoc->nets, sctp_next) {
5743 if (lnet->ro._l_addr.sin6.sin6_family == AF_INET6) {
5744 if (IN6_IS_ADDR_LINKLOCAL(&lnet->ro._l_addr.sin6.sin6_addr)) {
5745 /*
5746 * if we have a LL address, start
5747 * counting at 1.
5748 */
5749 cnt_inits_to = 1;
5750 }
5751 }
5752 }
5753 #endif
5754 /* use the net pointer */
5755 to = (struct sockaddr *)&net->ro._l_addr;
5756 switch (to->sa_family) {
5757 #ifdef INET
5758 case AF_INET:
5759 sin = (struct sockaddr_in *)to;
5760 stc.address[0] = sin->sin_addr.s_addr;
5761 stc.address[1] = 0;
5762 stc.address[2] = 0;
5763 stc.address[3] = 0;
5764 stc.addr_type = SCTP_IPV4_ADDRESS;
5765 if (net->src_addr_selected == 0) {
5766 /*
5767 * strange case here, the INIT should have
5768 * did the selection.
5769 */
5770 net->ro._s_addr = sctp_source_address_selection(inp,
5771 stcb, (sctp_route_t *)&net->ro,
5772 net, 0, vrf_id);
5773 if (net->ro._s_addr == NULL)
5774 return;
5775
5776 net->src_addr_selected = 1;
5777
5778 }
5779 stc.laddress[0] = net->ro._s_addr->address.sin.sin_addr.s_addr;
5780 stc.laddress[1] = 0;
5781 stc.laddress[2] = 0;
5782 stc.laddress[3] = 0;
5783 stc.laddr_type = SCTP_IPV4_ADDRESS;
5784 /* scope_id is only for v6 */
5785 stc.scope_id = 0;
5786 break;
5787 #endif
5788 #ifdef INET6
5789 case AF_INET6:
5790 sin6 = (struct sockaddr_in6 *)to;
5791 memcpy(&stc.address, &sin6->sin6_addr,
5792 sizeof(struct in6_addr));
5793 stc.addr_type = SCTP_IPV6_ADDRESS;
5794 stc.scope_id = sin6->sin6_scope_id;
5795 if (net->src_addr_selected == 0) {
5796 /*
5797 * strange case here, the INIT should have
5798 * done the selection.
5799 */
5800 net->ro._s_addr = sctp_source_address_selection(inp,
5801 stcb, (sctp_route_t *)&net->ro,
5802 net, 0, vrf_id);
5803 if (net->ro._s_addr == NULL)
5804 return;
5805
5806 net->src_addr_selected = 1;
5807 }
5808 memcpy(&stc.laddress, &net->ro._s_addr->address.sin6.sin6_addr,
5809 sizeof(struct in6_addr));
5810 stc.laddr_type = SCTP_IPV6_ADDRESS;
5811 break;
5812 #endif
5813 }
5814 }
5815 /* Now lets put the SCTP header in place */
5816 initack = mtod(m, struct sctp_init_ack_chunk *);
5817 /* Save it off for quick ref */
5818 stc.peers_vtag = ntohl(init_chk->init.initiate_tag);
5819 /* who are we */
5820 memcpy(stc.identification, SCTP_VERSION_STRING,
5821 min(strlen(SCTP_VERSION_STRING), sizeof(stc.identification)));
5822 memset(stc.reserved, 0, SCTP_RESERVE_SPACE);
5823 /* now the chunk header */
5824 initack->ch.chunk_type = SCTP_INITIATION_ACK;
5825 initack->ch.chunk_flags = 0;
5826 /* fill in later from mbuf we build */
5827 initack->ch.chunk_length = 0;
5828 /* place in my tag */
5829 if ((asoc != NULL) &&
5830 ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT) ||
5831 (SCTP_GET_STATE(stcb) == SCTP_STATE_INUSE) ||
5832 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED))) {
5833 /* re-use the v-tags and init-seq here */
5834 initack->init.initiate_tag = htonl(asoc->my_vtag);
5835 initack->init.initial_tsn = htonl(asoc->init_seq_number);
5836 } else {
5837 uint32_t vtag, itsn;
5838
5839 if (asoc) {
5840 atomic_add_int(&asoc->refcnt, 1);
5841 SCTP_TCB_UNLOCK(stcb);
5842 new_tag:
5843 vtag = sctp_select_a_tag(inp, inp->sctp_lport, sh->src_port, 1);
5844 if ((asoc->peer_supports_nat) && (vtag == asoc->my_vtag)) {
5845 /*
5846 * Got a duplicate vtag on some guy behind a
5847 * nat make sure we don't use it.
5848 */
5849 goto new_tag;
5850 }
5851 initack->init.initiate_tag = htonl(vtag);
5852 /* get a TSN to use too */
5853 itsn = sctp_select_initial_TSN(&inp->sctp_ep);
5854 initack->init.initial_tsn = htonl(itsn);
5855 SCTP_TCB_LOCK(stcb);
5856 atomic_add_int(&asoc->refcnt, -1);
5857 } else {
5858 SCTP_INP_INCR_REF(inp);
5859 SCTP_INP_RUNLOCK(inp);
5860 vtag = sctp_select_a_tag(inp, inp->sctp_lport, sh->src_port, 1);
5861 initack->init.initiate_tag = htonl(vtag);
5862 /* get a TSN to use too */
5863 initack->init.initial_tsn = htonl(sctp_select_initial_TSN(&inp->sctp_ep));
5864 SCTP_INP_RLOCK(inp);
5865 SCTP_INP_DECR_REF(inp);
5866 }
5867 }
5868 /* save away my tag to */
5869 stc.my_vtag = initack->init.initiate_tag;
5870
5871 /* set up some of the credits. */
5872 so = inp->sctp_socket;
5873 if (so == NULL) {
5874 /* memory problem */
5875 sctp_m_freem(m);
5876 return;
5877 } else {
5878 initack->init.a_rwnd = htonl(max(SCTP_SB_LIMIT_RCV(so), SCTP_MINIMAL_RWND));
5879 }
5880 /* set what I want */
5881 his_limit = ntohs(init_chk->init.num_inbound_streams);
5882 /* choose what I want */
5883 if (asoc != NULL) {
5884 if (asoc->streamoutcnt > asoc->pre_open_streams) {
5885 i_want = asoc->streamoutcnt;
5886 } else {
5887 i_want = asoc->pre_open_streams;
5888 }
5889 } else {
5890 i_want = inp->sctp_ep.pre_open_stream_count;
5891 }
5892 if (his_limit < i_want) {
5893 /* I Want more :< */
5894 initack->init.num_outbound_streams = init_chk->init.num_inbound_streams;
5895 } else {
5896 /* I can have what I want :> */
5897 initack->init.num_outbound_streams = htons(i_want);
5898 }
5899 /* tell him his limit. */
5900 initack->init.num_inbound_streams =
5901 htons(inp->sctp_ep.max_open_streams_intome);
5902
5903 /* adaptation layer indication parameter */
5904 if (inp->sctp_ep.adaptation_layer_indicator_provided) {
5905 parameter_len = (uint16_t)sizeof(struct sctp_adaptation_layer_indication);
5906 ali = (struct sctp_adaptation_layer_indication *)(mtod(m, caddr_t)+chunk_len);
5907 ali->ph.param_type = htons(SCTP_ULP_ADAPTATION);
5908 ali->ph.param_length = htons(parameter_len);
5909 ali->indication = htonl(inp->sctp_ep.adaptation_layer_indicator);
5910 chunk_len += parameter_len;
5911 }
5912
5913 /* ECN parameter */
5914 if (((asoc != NULL) && (asoc->ecn_supported == 1)) ||
5915 ((asoc == NULL) && (inp->ecn_supported == 1))) {
5916 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
5917 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
5918 ph->param_type = htons(SCTP_ECN_CAPABLE);
5919 ph->param_length = htons(parameter_len);
5920 chunk_len += parameter_len;
5921 }
5922
5923 /* PR-SCTP supported parameter */
5924 if (((asoc != NULL) && (asoc->prsctp_supported == 1)) ||
5925 ((asoc == NULL) && (inp->prsctp_supported == 1))) {
5926 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
5927 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
5928 ph->param_type = htons(SCTP_PRSCTP_SUPPORTED);
5929 ph->param_length = htons(parameter_len);
5930 chunk_len += parameter_len;
5931 }
5932
5933 /* Add NAT friendly parameter */
5934 if (nat_friendly) {
5935 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
5936 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
5937 ph->param_type = htons(SCTP_HAS_NAT_SUPPORT);
5938 ph->param_length = htons(parameter_len);
5939 chunk_len += parameter_len;
5940 }
5941
5942 /* And now tell the peer which extensions we support */
5943 num_ext = 0;
5944 pr_supported = (struct sctp_supported_chunk_types_param *)(mtod(m, caddr_t)+chunk_len);
5945 if (((asoc != NULL) && (asoc->prsctp_supported == 1)) ||
5946 ((asoc == NULL) && (inp->prsctp_supported == 1))) {
5947 pr_supported->chunk_types[num_ext++] = SCTP_FORWARD_CUM_TSN;
5948 if (((asoc != NULL) && (asoc->idata_supported == 1)) ||
5949 ((asoc == NULL) && (inp->idata_supported == 1))) {
5950 pr_supported->chunk_types[num_ext++] = SCTP_IFORWARD_CUM_TSN;
5951 }
5952 }
5953 if (((asoc != NULL) && (asoc->auth_supported == 1)) ||
5954 ((asoc == NULL) && (inp->auth_supported == 1))) {
5955 pr_supported->chunk_types[num_ext++] = SCTP_AUTHENTICATION;
5956 }
5957 if (((asoc != NULL) && (asoc->asconf_supported == 1)) ||
5958 ((asoc == NULL) && (inp->asconf_supported == 1))) {
5959 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF;
5960 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF_ACK;
5961 }
5962 if (((asoc != NULL) && (asoc->reconfig_supported == 1)) ||
5963 ((asoc == NULL) && (inp->reconfig_supported == 1))) {
5964 pr_supported->chunk_types[num_ext++] = SCTP_STREAM_RESET;
5965 }
5966 if (((asoc != NULL) && (asoc->idata_supported == 1)) ||
5967 ((asoc == NULL) && (inp->idata_supported == 1))) {
5968 pr_supported->chunk_types[num_ext++] = SCTP_IDATA;
5969 }
5970 if (((asoc != NULL) && (asoc->nrsack_supported == 1)) ||
5971 ((asoc == NULL) && (inp->nrsack_supported == 1))) {
5972 pr_supported->chunk_types[num_ext++] = SCTP_NR_SELECTIVE_ACK;
5973 }
5974 if (((asoc != NULL) && (asoc->pktdrop_supported == 1)) ||
5975 ((asoc == NULL) && (inp->pktdrop_supported == 1))) {
5976 pr_supported->chunk_types[num_ext++] = SCTP_PACKET_DROPPED;
5977 }
5978 if (num_ext > 0) {
5979 parameter_len = (uint16_t)sizeof(struct sctp_supported_chunk_types_param) + num_ext;
5980 pr_supported->ph.param_type = htons(SCTP_SUPPORTED_CHUNK_EXT);
5981 pr_supported->ph.param_length = htons(parameter_len);
5982 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
5983 chunk_len += parameter_len;
5984 }
5985
5986 /* add authentication parameters */
5987 if (((asoc != NULL) && (asoc->auth_supported == 1)) ||
5988 ((asoc == NULL) && (inp->auth_supported == 1))) {
5989 struct sctp_auth_random *randp;
5990 struct sctp_auth_hmac_algo *hmacs;
5991 struct sctp_auth_chunk_list *chunks;
5992
5993 if (padding_len > 0) {
5994 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
5995 chunk_len += padding_len;
5996 padding_len = 0;
5997 }
5998 /* generate and add RANDOM parameter */
5999 randp = (struct sctp_auth_random *)(mtod(m, caddr_t)+chunk_len);
6000 parameter_len = (uint16_t)sizeof(struct sctp_auth_random) +
6001 SCTP_AUTH_RANDOM_SIZE_DEFAULT;
6002 randp->ph.param_type = htons(SCTP_RANDOM);
6003 randp->ph.param_length = htons(parameter_len);
6004 SCTP_READ_RANDOM(randp->random_data, SCTP_AUTH_RANDOM_SIZE_DEFAULT);
6005 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6006 chunk_len += parameter_len;
6007
6008 if (padding_len > 0) {
6009 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
6010 chunk_len += padding_len;
6011 padding_len = 0;
6012 }
6013 /* add HMAC_ALGO parameter */
6014 hmacs = (struct sctp_auth_hmac_algo *)(mtod(m, caddr_t)+chunk_len);
6015 parameter_len = (uint16_t)sizeof(struct sctp_auth_hmac_algo) +
6016 sctp_serialize_hmaclist(inp->sctp_ep.local_hmacs,
6017 (uint8_t *)hmacs->hmac_ids);
6018 hmacs->ph.param_type = htons(SCTP_HMAC_LIST);
6019 hmacs->ph.param_length = htons(parameter_len);
6020 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6021 chunk_len += parameter_len;
6022
6023 if (padding_len > 0) {
6024 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
6025 chunk_len += padding_len;
6026 padding_len = 0;
6027 }
6028 /* add CHUNKS parameter */
6029 chunks = (struct sctp_auth_chunk_list *)(mtod(m, caddr_t)+chunk_len);
6030 parameter_len = (uint16_t)sizeof(struct sctp_auth_chunk_list) +
6031 sctp_serialize_auth_chunks(inp->sctp_ep.local_auth_chunks,
6032 chunks->chunk_types);
6033 chunks->ph.param_type = htons(SCTP_CHUNK_LIST);
6034 chunks->ph.param_length = htons(parameter_len);
6035 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6036 chunk_len += parameter_len;
6037 }
6038 SCTP_BUF_LEN(m) = chunk_len;
6039 m_last = m;
6040 /* now the addresses */
6041 /*
6042 * To optimize this we could put the scoping stuff into a structure
6043 * and remove the individual uint8's from the stc structure. Then we
6044 * could just sifa in the address within the stc.. but for now this
6045 * is a quick hack to get the address stuff teased apart.
6046 */
6047 scp.ipv4_addr_legal = stc.ipv4_addr_legal;
6048 scp.ipv6_addr_legal = stc.ipv6_addr_legal;
6049 scp.loopback_scope = stc.loopback_scope;
6050 scp.ipv4_local_scope = stc.ipv4_scope;
6051 scp.local_scope = stc.local_scope;
6052 scp.site_scope = stc.site_scope;
6053 m_last = sctp_add_addresses_to_i_ia(inp, stcb, &scp, m_last,
6054 cnt_inits_to,
6055 &padding_len, &chunk_len);
6056 /* padding_len can only be positive, if no addresses have been added */
6057 if (padding_len > 0) {
6058 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
6059 chunk_len += padding_len;
6060 SCTP_BUF_LEN(m) += padding_len;
6061 padding_len = 0;
6062 }
6063
6064 /* tack on the operational error if present */
6065 if (op_err) {
6066 parameter_len = 0;
6067 for (m_tmp = op_err; m_tmp != NULL; m_tmp = SCTP_BUF_NEXT(m_tmp)) {
6068 parameter_len += SCTP_BUF_LEN(m_tmp);
6069 }
6070 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6071 SCTP_BUF_NEXT(m_last) = op_err;
6072 while (SCTP_BUF_NEXT(m_last) != NULL) {
6073 m_last = SCTP_BUF_NEXT(m_last);
6074 }
6075 chunk_len += parameter_len;
6076 }
6077 if (padding_len > 0) {
6078 m_last = sctp_add_pad_tombuf(m_last, padding_len);
6079 if (m_last == NULL) {
6080 /* Houston we have a problem, no space */
6081 sctp_m_freem(m);
6082 return;
6083 }
6084 chunk_len += padding_len;
6085 padding_len = 0;
6086 }
6087 /* Now we must build a cookie */
6088 m_cookie = sctp_add_cookie(init_pkt, offset, m, 0, &stc, &signature);
6089 if (m_cookie == NULL) {
6090 /* memory problem */
6091 sctp_m_freem(m);
6092 return;
6093 }
6094 /* Now append the cookie to the end and update the space/size */
6095 SCTP_BUF_NEXT(m_last) = m_cookie;
6096 parameter_len = 0;
6097 for (m_tmp = m_cookie; m_tmp != NULL; m_tmp = SCTP_BUF_NEXT(m_tmp)) {
6098 parameter_len += SCTP_BUF_LEN(m_tmp);
6099 if (SCTP_BUF_NEXT(m_tmp) == NULL) {
6100 m_last = m_tmp;
6101 }
6102 }
6103 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6104 chunk_len += parameter_len;
6105
6106 /*
6107 * Place in the size, but we don't include the last pad (if any) in
6108 * the INIT-ACK.
6109 */
6110 initack->ch.chunk_length = htons(chunk_len);
6111
6112 /*
6113 * Time to sign the cookie, we don't sign over the cookie signature
6114 * though thus we set trailer.
6115 */
6116 (void)sctp_hmac_m(SCTP_HMAC,
6117 (uint8_t *)inp->sctp_ep.secret_key[(int)(inp->sctp_ep.current_secret_number)],
6118 SCTP_SECRET_SIZE, m_cookie, sizeof(struct sctp_paramhdr),
6119 (uint8_t *)signature, SCTP_SIGNATURE_SIZE);
6120 /*
6121 * We sifa 0 here to NOT set IP_DF if its IPv4, we ignore the return
6122 * here since the timer will drive a retranmission.
6123 */
6124 if (padding_len > 0) {
6125 if (sctp_add_pad_tombuf(m_last, padding_len) == NULL) {
6126 sctp_m_freem(m);
6127 return;
6128 }
6129 }
6130 if (stc.loopback_scope) {
6131 over_addr = (union sctp_sockstore *)dst;
6132 } else {
6133 over_addr = NULL;
6134 }
6135
6136 if ((error = sctp_lowlevel_chunk_output(inp, NULL, NULL, to, m, 0, NULL, 0, 0,
6137 0, 0,
6138 inp->sctp_lport, sh->src_port, init_chk->init.initiate_tag,
6139 port, over_addr,
6140 mflowtype, mflowid,
6141 SCTP_SO_NOT_LOCKED))) {
6142 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Gak send error %d\n", error);
6143 if (error == ENOBUFS) {
6144 if (asoc != NULL) {
6145 asoc->ifp_had_enobuf = 1;
6146 }
6147 SCTP_STAT_INCR(sctps_lowlevelerr);
6148 }
6149 } else {
6150 if (asoc != NULL) {
6151 asoc->ifp_had_enobuf = 0;
6152 }
6153 }
6154 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
6155 }
6156
6157
6158 static void
6159 sctp_prune_prsctp(struct sctp_tcb *stcb,
6160 struct sctp_association *asoc,
6161 struct sctp_sndrcvinfo *srcv,
6162 int dataout)
6163 {
6164 int freed_spc = 0;
6165 struct sctp_tmit_chunk *chk, *nchk;
6166
6167 SCTP_TCB_LOCK_ASSERT(stcb);
6168 if ((asoc->prsctp_supported) &&
6169 (asoc->sent_queue_cnt_removeable > 0)) {
6170 TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) {
6171 /*
6172 * Look for chunks marked with the PR_SCTP flag AND
6173 * the buffer space flag. If the one being sent is
6174 * equal or greater priority then purge the old one
6175 * and free some space.
6176 */
6177 if (PR_SCTP_BUF_ENABLED(chk->flags)) {
6178 /*
6179 * This one is PR-SCTP AND buffer space
6180 * limited type
6181 */
6182 if (chk->rec.data.timetodrop.tv_sec >= (long)srcv->sinfo_timetolive) {
6183 /*
6184 * Lower numbers equates to higher
6185 * priority so if the one we are
6186 * looking at has a larger or equal
6187 * priority we want to drop the data
6188 * and NOT retransmit it.
6189 */
6190 if (chk->data) {
6191 /*
6192 * We release the book_size
6193 * if the mbuf is here
6194 */
6195 int ret_spc;
6196 uint8_t sent;
6197
6198 if (chk->sent > SCTP_DATAGRAM_UNSENT)
6199 sent = 1;
6200 else
6201 sent = 0;
6202 ret_spc = sctp_release_pr_sctp_chunk(stcb, chk,
6203 sent,
6204 SCTP_SO_LOCKED);
6205 freed_spc += ret_spc;
6206 if (freed_spc >= dataout) {
6207 return;
6208 }
6209 } /* if chunk was present */
6210 } /* if of sufficient priority */
6211 } /* if chunk has enabled */
6212 } /* tailqforeach */
6213
6214 TAILQ_FOREACH_SAFE(chk, &asoc->send_queue, sctp_next, nchk) {
6215 /* Here we must move to the sent queue and mark */
6216 if (PR_SCTP_BUF_ENABLED(chk->flags)) {
6217 if (chk->rec.data.timetodrop.tv_sec >= (long)srcv->sinfo_timetolive) {
6218 if (chk->data) {
6219 /*
6220 * We release the book_size
6221 * if the mbuf is here
6222 */
6223 int ret_spc;
6224
6225 ret_spc = sctp_release_pr_sctp_chunk(stcb, chk,
6226 0, SCTP_SO_LOCKED);
6227
6228 freed_spc += ret_spc;
6229 if (freed_spc >= dataout) {
6230 return;
6231 }
6232 } /* end if chk->data */
6233 } /* end if right class */
6234 } /* end if chk pr-sctp */
6235 } /* tailqforeachsafe (chk) */
6236 } /* if enabled in asoc */
6237 }
6238
6239 int
6240 sctp_get_frag_point(struct sctp_tcb *stcb,
6241 struct sctp_association *asoc)
6242 {
6243 int siz, ovh;
6244
6245 /*
6246 * For endpoints that have both v6 and v4 addresses we must reserve
6247 * room for the ipv6 header, for those that are only dealing with V4
6248 * we use a larger frag point.
6249 */
6250 if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
6251 ovh = SCTP_MIN_OVERHEAD;
6252 } else {
6253 ovh = SCTP_MIN_V4_OVERHEAD;
6254 }
6255 ovh += SCTP_DATA_CHUNK_OVERHEAD(stcb);
6256 if (stcb->asoc.sctp_frag_point > asoc->smallest_mtu)
6257 siz = asoc->smallest_mtu - ovh;
6258 else
6259 siz = (stcb->asoc.sctp_frag_point - ovh);
6260 /*
6261 * if (siz > (MCLBYTES-sizeof(struct sctp_data_chunk))) {
6262 */
6263 /* A data chunk MUST fit in a cluster */
6264 /* siz = (MCLBYTES - sizeof(struct sctp_data_chunk)); */
6265 /* } */
6266
6267 /* adjust for an AUTH chunk if DATA requires auth */
6268 if (sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks))
6269 siz -= sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
6270
6271 if (siz % 4) {
6272 /* make it an even word boundary please */
6273 siz -= (siz % 4);
6274 }
6275 return (siz);
6276 }
6277
6278 static void
6279 sctp_set_prsctp_policy(struct sctp_stream_queue_pending *sp)
6280 {
6281 /*
6282 * We assume that the user wants PR_SCTP_TTL if the user provides a
6283 * positive lifetime but does not specify any PR_SCTP policy.
6284 */
6285 if (PR_SCTP_ENABLED(sp->sinfo_flags)) {
6286 sp->act_flags |= PR_SCTP_POLICY(sp->sinfo_flags);
6287 } else if (sp->timetolive > 0) {
6288 sp->sinfo_flags |= SCTP_PR_SCTP_TTL;
6289 sp->act_flags |= PR_SCTP_POLICY(sp->sinfo_flags);
6290 } else {
6291 return;
6292 }
6293 switch (PR_SCTP_POLICY(sp->sinfo_flags)) {
6294 case CHUNK_FLAGS_PR_SCTP_BUF:
6295 /*
6296 * Time to live is a priority stored in tv_sec when doing
6297 * the buffer drop thing.
6298 */
6299 sp->ts.tv_sec = sp->timetolive;
6300 sp->ts.tv_usec = 0;
6301 break;
6302 case CHUNK_FLAGS_PR_SCTP_TTL:
6303 {
6304 struct timeval tv;
6305
6306 (void)SCTP_GETTIME_TIMEVAL(&sp->ts);
6307 tv.tv_sec = sp->timetolive / 1000;
6308 tv.tv_usec = (sp->timetolive * 1000) % 1000000;
6309 /*
6310 * TODO sctp_constants.h needs alternative time
6311 * macros when _KERNEL is undefined.
6312 */
6313 timevaladd(&sp->ts, &tv);
6314 }
6315 break;
6316 case CHUNK_FLAGS_PR_SCTP_RTX:
6317 /*
6318 * Time to live is a the number or retransmissions stored in
6319 * tv_sec.
6320 */
6321 sp->ts.tv_sec = sp->timetolive;
6322 sp->ts.tv_usec = 0;
6323 break;
6324 default:
6325 SCTPDBG(SCTP_DEBUG_USRREQ1,
6326 "Unknown PR_SCTP policy %u.\n",
6327 PR_SCTP_POLICY(sp->sinfo_flags));
6328 break;
6329 }
6330 }
6331
6332 static int
6333 sctp_msg_append(struct sctp_tcb *stcb,
6334 struct sctp_nets *net,
6335 struct mbuf *m,
6336 struct sctp_sndrcvinfo *srcv, int hold_stcb_lock)
6337 {
6338 int error = 0;
6339 struct mbuf *at;
6340 struct sctp_stream_queue_pending *sp = NULL;
6341 struct sctp_stream_out *strm;
6342
6343 /*
6344 * Given an mbuf chain, put it into the association send queue and
6345 * place it on the wheel
6346 */
6347 if (srcv->sinfo_stream >= stcb->asoc.streamoutcnt) {
6348 /* Invalid stream number */
6349 SCTP_LTRACE_ERR_RET_PKT(m, NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
6350 error = EINVAL;
6351 goto out_now;
6352 }
6353 if ((stcb->asoc.stream_locked) &&
6354 (stcb->asoc.stream_locked_on != srcv->sinfo_stream)) {
6355 SCTP_LTRACE_ERR_RET_PKT(m, NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
6356 error = EINVAL;
6357 goto out_now;
6358 }
6359 strm = &stcb->asoc.strmout[srcv->sinfo_stream];
6360 /* Now can we send this? */
6361 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_SENT) ||
6362 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_ACK_SENT) ||
6363 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
6364 (stcb->asoc.state & SCTP_STATE_SHUTDOWN_PENDING)) {
6365 /* got data while shutting down */
6366 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
6367 error = ECONNRESET;
6368 goto out_now;
6369 }
6370 sctp_alloc_a_strmoq(stcb, sp);
6371 if (sp == NULL) {
6372 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
6373 error = ENOMEM;
6374 goto out_now;
6375 }
6376 sp->sinfo_flags = srcv->sinfo_flags;
6377 sp->timetolive = srcv->sinfo_timetolive;
6378 sp->ppid = srcv->sinfo_ppid;
6379 sp->context = srcv->sinfo_context;
6380 sp->fsn = 0;
6381 if (sp->sinfo_flags & SCTP_ADDR_OVER) {
6382 sp->net = net;
6383 atomic_add_int(&sp->net->ref_count, 1);
6384 } else {
6385 sp->net = NULL;
6386 }
6387 (void)SCTP_GETTIME_TIMEVAL(&sp->ts);
6388 sp->sid = srcv->sinfo_stream;
6389 sp->msg_is_complete = 1;
6390 sp->sender_all_done = 1;
6391 sp->some_taken = 0;
6392 sp->data = m;
6393 sp->tail_mbuf = NULL;
6394 sctp_set_prsctp_policy(sp);
6395 /*
6396 * We could in theory (for sendall) sifa the length in, but we would
6397 * still have to hunt through the chain since we need to setup the
6398 * tail_mbuf
6399 */
6400 sp->length = 0;
6401 for (at = m; at; at = SCTP_BUF_NEXT(at)) {
6402 if (SCTP_BUF_NEXT(at) == NULL)
6403 sp->tail_mbuf = at;
6404 sp->length += SCTP_BUF_LEN(at);
6405 }
6406 if (srcv->sinfo_keynumber_valid) {
6407 sp->auth_keyid = srcv->sinfo_keynumber;
6408 } else {
6409 sp->auth_keyid = stcb->asoc.authinfo.active_keyid;
6410 }
6411 if (sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks)) {
6412 sctp_auth_key_acquire(stcb, sp->auth_keyid);
6413 sp->holds_key_ref = 1;
6414 }
6415 if (hold_stcb_lock == 0) {
6416 SCTP_TCB_SEND_LOCK(stcb);
6417 }
6418 sctp_snd_sb_alloc(stcb, sp->length);
6419 atomic_add_int(&stcb->asoc.stream_queue_cnt, 1);
6420 TAILQ_INSERT_TAIL(&strm->outqueue, sp, next);
6421 stcb->asoc.ss_functions.sctp_ss_add_to_stream(stcb, &stcb->asoc, strm, sp, 1);
6422 m = NULL;
6423 if (hold_stcb_lock == 0) {
6424 SCTP_TCB_SEND_UNLOCK(stcb);
6425 }
6426 out_now:
6427 if (m) {
6428 sctp_m_freem(m);
6429 }
6430 return (error);
6431 }
6432
6433
6434 static struct mbuf *
6435 sctp_copy_mbufchain(struct mbuf *clonechain,
6436 struct mbuf *outchain,
6437 struct mbuf **endofchain,
6438 int can_take_mbuf,
6439 int sizeofcpy,
6440 uint8_t copy_by_ref)
6441 {
6442 struct mbuf *m;
6443 struct mbuf *appendchain;
6444 caddr_t cp;
6445 int len;
6446
6447 if (endofchain == NULL) {
6448 /* error */
6449 error_out:
6450 if (outchain)
6451 sctp_m_freem(outchain);
6452 return (NULL);
6453 }
6454 if (can_take_mbuf) {
6455 appendchain = clonechain;
6456 } else {
6457 if (!copy_by_ref &&
6458 (sizeofcpy <= (int)((((SCTP_BASE_SYSCTL(sctp_mbuf_threshold_count) - 1) * MLEN) + MHLEN)))
6459 ) {
6460 /* Its not in a cluster */
6461 if (*endofchain == NULL) {
6462 /* lets get a mbuf cluster */
6463 if (outchain == NULL) {
6464 /* This is the general case */
6465 new_mbuf:
6466 outchain = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_HEADER);
6467 if (outchain == NULL) {
6468 goto error_out;
6469 }
6470 SCTP_BUF_LEN(outchain) = 0;
6471 *endofchain = outchain;
6472 /* get the prepend space */
6473 SCTP_BUF_RESV_UF(outchain, (SCTP_FIRST_MBUF_RESV + 4));
6474 } else {
6475 /*
6476 * We really should not get a NULL
6477 * in endofchain
6478 */
6479 /* find end */
6480 m = outchain;
6481 while (m) {
6482 if (SCTP_BUF_NEXT(m) == NULL) {
6483 *endofchain = m;
6484 break;
6485 }
6486 m = SCTP_BUF_NEXT(m);
6487 }
6488 /* sanity */
6489 if (*endofchain == NULL) {
6490 /*
6491 * huh, TSNH XXX maybe we
6492 * should panic
6493 */
6494 sctp_m_freem(outchain);
6495 goto new_mbuf;
6496 }
6497 }
6498 /* get the new end of length */
6499 len = (int)M_TRAILINGSPACE(*endofchain);
6500 } else {
6501 /* how much is left at the end? */
6502 len = (int)M_TRAILINGSPACE(*endofchain);
6503 }
6504 /* Find the end of the data, for appending */
6505 cp = (mtod((*endofchain), caddr_t)+SCTP_BUF_LEN((*endofchain)));
6506
6507 /* Now lets copy it out */
6508 if (len >= sizeofcpy) {
6509 /* It all fits, copy it in */
6510 m_copydata(clonechain, 0, sizeofcpy, cp);
6511 SCTP_BUF_LEN((*endofchain)) += sizeofcpy;
6512 } else {
6513 /* fill up the end of the chain */
6514 if (len > 0) {
6515 m_copydata(clonechain, 0, len, cp);
6516 SCTP_BUF_LEN((*endofchain)) += len;
6517 /* now we need another one */
6518 sizeofcpy -= len;
6519 }
6520 m = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_HEADER);
6521 if (m == NULL) {
6522 /* We failed */
6523 goto error_out;
6524 }
6525 SCTP_BUF_NEXT((*endofchain)) = m;
6526 *endofchain = m;
6527 cp = mtod((*endofchain), caddr_t);
6528 m_copydata(clonechain, len, sizeofcpy, cp);
6529 SCTP_BUF_LEN((*endofchain)) += sizeofcpy;
6530 }
6531 return (outchain);
6532 } else {
6533 /* copy the old fashion way */
6534 appendchain = SCTP_M_COPYM(clonechain, 0, M_COPYALL, M_NOWAIT);
6535 #ifdef SCTP_MBUF_LOGGING
6536 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
6537 sctp_log_mbc(appendchain, SCTP_MBUF_ICOPY);
6538 }
6539 #endif
6540 }
6541 }
6542 if (appendchain == NULL) {
6543 /* error */
6544 if (outchain)
6545 sctp_m_freem(outchain);
6546 return (NULL);
6547 }
6548 if (outchain) {
6549 /* tack on to the end */
6550 if (*endofchain != NULL) {
6551 SCTP_BUF_NEXT(((*endofchain))) = appendchain;
6552 } else {
6553 m = outchain;
6554 while (m) {
6555 if (SCTP_BUF_NEXT(m) == NULL) {
6556 SCTP_BUF_NEXT(m) = appendchain;
6557 break;
6558 }
6559 m = SCTP_BUF_NEXT(m);
6560 }
6561 }
6562 /*
6563 * save off the end and update the end-chain position
6564 */
6565 m = appendchain;
6566 while (m) {
6567 if (SCTP_BUF_NEXT(m) == NULL) {
6568 *endofchain = m;
6569 break;
6570 }
6571 m = SCTP_BUF_NEXT(m);
6572 }
6573 return (outchain);
6574 } else {
6575 /* save off the end and update the end-chain position */
6576 m = appendchain;
6577 while (m) {
6578 if (SCTP_BUF_NEXT(m) == NULL) {
6579 *endofchain = m;
6580 break;
6581 }
6582 m = SCTP_BUF_NEXT(m);
6583 }
6584 return (appendchain);
6585 }
6586 }
6587
6588 static int
6589 sctp_med_chunk_output(struct sctp_inpcb *inp,
6590 struct sctp_tcb *stcb,
6591 struct sctp_association *asoc,
6592 int *num_out,
6593 int *reason_code,
6594 int control_only, int from_where,
6595 struct timeval *now, int *now_filled, int frag_point, int so_locked
6596 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
6597 SCTP_UNUSED
6598 #endif
6599 );
6600
6601 static void
6602 sctp_sendall_iterator(struct sctp_inpcb *inp, struct sctp_tcb *stcb, void *ptr,
6603 uint32_t val SCTP_UNUSED)
6604 {
6605 struct sctp_copy_all *ca;
6606 struct mbuf *m;
6607 int ret = 0;
6608 int added_control = 0;
6609 int un_sent, do_chunk_output = 1;
6610 struct sctp_association *asoc;
6611 struct sctp_nets *net;
6612
6613 ca = (struct sctp_copy_all *)ptr;
6614 if (ca->m == NULL) {
6615 return;
6616 }
6617 if (ca->inp != inp) {
6618 /* TSNH */
6619 return;
6620 }
6621 if (ca->sndlen > 0) {
6622 m = SCTP_M_COPYM(ca->m, 0, M_COPYALL, M_NOWAIT);
6623 if (m == NULL) {
6624 /* can't copy so we are done */
6625 ca->cnt_failed++;
6626 return;
6627 }
6628 #ifdef SCTP_MBUF_LOGGING
6629 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
6630 sctp_log_mbc(m, SCTP_MBUF_ICOPY);
6631 }
6632 #endif
6633 } else {
6634 m = NULL;
6635 }
6636 SCTP_TCB_LOCK_ASSERT(stcb);
6637 if (stcb->asoc.alternate) {
6638 net = stcb->asoc.alternate;
6639 } else {
6640 net = stcb->asoc.primary_destination;
6641 }
6642 if (ca->sndrcv.sinfo_flags & SCTP_ABORT) {
6643 /* Abort this assoc with m as the user defined reason */
6644 if (m != NULL) {
6645 SCTP_BUF_PREPEND(m, sizeof(struct sctp_paramhdr), M_NOWAIT);
6646 } else {
6647 m = sctp_get_mbuf_for_msg(sizeof(struct sctp_paramhdr),
6648 0, M_NOWAIT, 1, MT_DATA);
6649 SCTP_BUF_LEN(m) = sizeof(struct sctp_paramhdr);
6650 }
6651 if (m != NULL) {
6652 struct sctp_paramhdr *ph;
6653
6654 ph = mtod(m, struct sctp_paramhdr *);
6655 ph->param_type = htons(SCTP_CAUSE_USER_INITIATED_ABT);
6656 ph->param_length = htons((uint16_t)(sizeof(struct sctp_paramhdr) + ca->sndlen));
6657 }
6658 /*
6659 * We add one here to keep the assoc from dis-appearing on
6660 * us.
6661 */
6662 atomic_add_int(&stcb->asoc.refcnt, 1);
6663 sctp_abort_an_association(inp, stcb, m, SCTP_SO_NOT_LOCKED);
6664 /*
6665 * sctp_abort_an_association calls sctp_free_asoc() free
6666 * association will NOT free it since we incremented the
6667 * refcnt .. we do this to prevent it being freed and things
6668 * getting tricky since we could end up (from free_asoc)
6669 * calling inpcb_free which would get a recursive lock call
6670 * to the iterator lock.. But as a consequence of that the
6671 * stcb will return to us un-locked.. since free_asoc
6672 * returns with either no TCB or the TCB unlocked, we must
6673 * relock.. to unlock in the iterator timer :-0
6674 */
6675 SCTP_TCB_LOCK(stcb);
6676 atomic_add_int(&stcb->asoc.refcnt, -1);
6677 goto no_chunk_output;
6678 } else {
6679 if (m) {
6680 ret = sctp_msg_append(stcb, net, m,
6681 &ca->sndrcv, 1);
6682 }
6683 asoc = &stcb->asoc;
6684 if (ca->sndrcv.sinfo_flags & SCTP_EOF) {
6685 /* shutdown this assoc */
6686 if (TAILQ_EMPTY(&asoc->send_queue) &&
6687 TAILQ_EMPTY(&asoc->sent_queue) &&
6688 sctp_is_there_unsent_data(stcb, SCTP_SO_NOT_LOCKED) == 0) {
6689 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
6690 goto abort_anyway;
6691 }
6692 /*
6693 * there is nothing queued to send, so I'm
6694 * done...
6695 */
6696 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
6697 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
6698 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
6699 /*
6700 * only send SHUTDOWN the first time
6701 * through
6702 */
6703 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
6704 SCTP_STAT_DECR_GAUGE32(sctps_currestab);
6705 }
6706 SCTP_SET_STATE(stcb, SCTP_STATE_SHUTDOWN_SENT);
6707 sctp_stop_timers_for_shutdown(stcb);
6708 sctp_send_shutdown(stcb, net);
6709 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN, stcb->sctp_ep, stcb,
6710 net);
6711 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
6712 asoc->primary_destination);
6713 added_control = 1;
6714 do_chunk_output = 0;
6715 }
6716 } else {
6717 /*
6718 * we still got (or just got) data to send,
6719 * so set SHUTDOWN_PENDING
6720 */
6721 /*
6722 * XXX sockets draft says that SCTP_EOF
6723 * should be sent with no data. currently,
6724 * we will allow user data to be sent first
6725 * and move to SHUTDOWN-PENDING
6726 */
6727 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
6728 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
6729 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
6730 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
6731 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_PARTIAL_MSG_LEFT);
6732 }
6733 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_SHUTDOWN_PENDING);
6734 if (TAILQ_EMPTY(&asoc->send_queue) &&
6735 TAILQ_EMPTY(&asoc->sent_queue) &&
6736 (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT)) {
6737 struct mbuf *op_err;
6738 char msg[SCTP_DIAG_INFO_LEN];
6739
6740 abort_anyway:
6741 snprintf(msg, sizeof(msg),
6742 "%s:%d at %s", __FILE__, __LINE__, __func__);
6743 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
6744 msg);
6745 atomic_add_int(&stcb->asoc.refcnt, 1);
6746 sctp_abort_an_association(stcb->sctp_ep, stcb,
6747 op_err, SCTP_SO_NOT_LOCKED);
6748 atomic_add_int(&stcb->asoc.refcnt, -1);
6749 goto no_chunk_output;
6750 }
6751 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
6752 asoc->primary_destination);
6753 }
6754 }
6755
6756 }
6757 }
6758 un_sent = ((stcb->asoc.total_output_queue_size - stcb->asoc.total_flight) +
6759 (stcb->asoc.stream_queue_cnt * SCTP_DATA_CHUNK_OVERHEAD(stcb)));
6760
6761 if ((sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY)) &&
6762 (stcb->asoc.total_flight > 0) &&
6763 (un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD))) {
6764 do_chunk_output = 0;
6765 }
6766 if (do_chunk_output)
6767 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_NOT_LOCKED);
6768 else if (added_control) {
6769 int num_out, reason, now_filled = 0;
6770 struct timeval now;
6771 int frag_point;
6772
6773 frag_point = sctp_get_frag_point(stcb, &stcb->asoc);
6774 (void)sctp_med_chunk_output(inp, stcb, &stcb->asoc, &num_out,
6775 &reason, 1, 1, &now, &now_filled, frag_point, SCTP_SO_NOT_LOCKED);
6776 }
6777 no_chunk_output:
6778 if (ret) {
6779 ca->cnt_failed++;
6780 } else {
6781 ca->cnt_sent++;
6782 }
6783 }
6784
6785 static void
6786 sctp_sendall_completes(void *ptr, uint32_t val SCTP_UNUSED)
6787 {
6788 struct sctp_copy_all *ca;
6789
6790 ca = (struct sctp_copy_all *)ptr;
6791 /*
6792 * Do a notify here? Kacheong suggests that the notify be done at
6793 * the send time.. so you would push up a notification if any send
6794 * failed. Don't know if this is feasible since the only failures we
6795 * have is "memory" related and if you cannot get an mbuf to send
6796 * the data you surely can't get an mbuf to send up to notify the
6797 * user you can't send the data :->
6798 */
6799
6800 /* now free everything */
6801 sctp_m_freem(ca->m);
6802 SCTP_FREE(ca, SCTP_M_COPYAL);
6803 }
6804
6805 static struct mbuf *
6806 sctp_copy_out_all(struct uio *uio, int len)
6807 {
6808 struct mbuf *ret, *at;
6809 int left, willcpy, cancpy, error;
6810
6811 ret = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_WAITOK, 1, MT_DATA);
6812 if (ret == NULL) {
6813 /* TSNH */
6814 return (NULL);
6815 }
6816 left = len;
6817 SCTP_BUF_LEN(ret) = 0;
6818 /* save space for the data chunk header */
6819 cancpy = (int)M_TRAILINGSPACE(ret);
6820 willcpy = min(cancpy, left);
6821 at = ret;
6822 while (left > 0) {
6823 /* Align data to the end */
6824 error = uiomove(mtod(at, caddr_t), willcpy, uio);
6825 if (error) {
6826 err_out_now:
6827 sctp_m_freem(at);
6828 return (NULL);
6829 }
6830 SCTP_BUF_LEN(at) = willcpy;
6831 SCTP_BUF_NEXT_PKT(at) = SCTP_BUF_NEXT(at) = 0;
6832 left -= willcpy;
6833 if (left > 0) {
6834 SCTP_BUF_NEXT(at) = sctp_get_mbuf_for_msg(left, 0, M_WAITOK, 1, MT_DATA);
6835 if (SCTP_BUF_NEXT(at) == NULL) {
6836 goto err_out_now;
6837 }
6838 at = SCTP_BUF_NEXT(at);
6839 SCTP_BUF_LEN(at) = 0;
6840 cancpy = (int)M_TRAILINGSPACE(at);
6841 willcpy = min(cancpy, left);
6842 }
6843 }
6844 return (ret);
6845 }
6846
6847 static int
6848 sctp_sendall(struct sctp_inpcb *inp, struct uio *uio, struct mbuf *m,
6849 struct sctp_sndrcvinfo *srcv)
6850 {
6851 int ret;
6852 struct sctp_copy_all *ca;
6853
6854 SCTP_MALLOC(ca, struct sctp_copy_all *, sizeof(struct sctp_copy_all),
6855 SCTP_M_COPYAL);
6856 if (ca == NULL) {
6857 sctp_m_freem(m);
6858 SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
6859 return (ENOMEM);
6860 }
6861 memset(ca, 0, sizeof(struct sctp_copy_all));
6862
6863 ca->inp = inp;
6864 if (srcv) {
6865 memcpy(&ca->sndrcv, srcv, sizeof(struct sctp_nonpad_sndrcvinfo));
6866 }
6867 /*
6868 * take off the sendall flag, it would be bad if we failed to do
6869 * this :-0
6870 */
6871 ca->sndrcv.sinfo_flags &= ~SCTP_SENDALL;
6872 /* get length and mbuf chain */
6873 if (uio) {
6874 ca->sndlen = (int)uio->uio_resid;
6875 ca->m = sctp_copy_out_all(uio, ca->sndlen);
6876 if (ca->m == NULL) {
6877 SCTP_FREE(ca, SCTP_M_COPYAL);
6878 SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
6879 return (ENOMEM);
6880 }
6881 } else {
6882 /* Gather the length of the send */
6883 struct mbuf *mat;
6884
6885 ca->sndlen = 0;
6886 for (mat = m; mat; mat = SCTP_BUF_NEXT(mat)) {
6887 ca->sndlen += SCTP_BUF_LEN(mat);
6888 }
6889 }
6890 ret = sctp_initiate_iterator(NULL, sctp_sendall_iterator, NULL,
6891 SCTP_PCB_ANY_FLAGS, SCTP_PCB_ANY_FEATURES,
6892 SCTP_ASOC_ANY_STATE,
6893 (void *)ca, 0,
6894 sctp_sendall_completes, inp, 1);
6895 if (ret) {
6896 SCTP_PRINTF("Failed to initiate iterator for sendall\n");
6897 SCTP_FREE(ca, SCTP_M_COPYAL);
6898 SCTP_LTRACE_ERR_RET_PKT(m, inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EFAULT);
6899 return (EFAULT);
6900 }
6901 return (0);
6902 }
6903
6904
6905 void
6906 sctp_toss_old_cookies(struct sctp_tcb *stcb, struct sctp_association *asoc)
6907 {
6908 struct sctp_tmit_chunk *chk, *nchk;
6909
6910 TAILQ_FOREACH_SAFE(chk, &asoc->control_send_queue, sctp_next, nchk) {
6911 if (chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) {
6912 TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next);
6913 asoc->ctrl_queue_cnt--;
6914 if (chk->data) {
6915 sctp_m_freem(chk->data);
6916 chk->data = NULL;
6917 }
6918 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
6919 }
6920 }
6921 }
6922
6923 void
6924 sctp_toss_old_asconf(struct sctp_tcb *stcb)
6925 {
6926 struct sctp_association *asoc;
6927 struct sctp_tmit_chunk *chk, *nchk;
6928 struct sctp_asconf_chunk *acp;
6929
6930 asoc = &stcb->asoc;
6931 TAILQ_FOREACH_SAFE(chk, &asoc->asconf_send_queue, sctp_next, nchk) {
6932 /* find SCTP_ASCONF chunk in queue */
6933 if (chk->rec.chunk_id.id == SCTP_ASCONF) {
6934 if (chk->data) {
6935 acp = mtod(chk->data, struct sctp_asconf_chunk *);
6936 if (SCTP_TSN_GT(ntohl(acp->serial_number), asoc->asconf_seq_out_acked)) {
6937 /* Not Acked yet */
6938 break;
6939 }
6940 }
6941 TAILQ_REMOVE(&asoc->asconf_send_queue, chk, sctp_next);
6942 asoc->ctrl_queue_cnt--;
6943 if (chk->data) {
6944 sctp_m_freem(chk->data);
6945 chk->data = NULL;
6946 }
6947 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
6948 }
6949 }
6950 }
6951
6952
6953 static void
6954 sctp_clean_up_datalist(struct sctp_tcb *stcb,
6955 struct sctp_association *asoc,
6956 struct sctp_tmit_chunk **data_list,
6957 int bundle_at,
6958 struct sctp_nets *net)
6959 {
6960 int i;
6961 struct sctp_tmit_chunk *tp1;
6962
6963 for (i = 0; i < bundle_at; i++) {
6964 /* off of the send queue */
6965 TAILQ_REMOVE(&asoc->send_queue, data_list[i], sctp_next);
6966 asoc->send_queue_cnt--;
6967 if (i > 0) {
6968 /*
6969 * Any chunk NOT 0 you zap the time chunk 0 gets
6970 * zapped or set based on if a RTO measurment is
6971 * needed.
6972 */
6973 data_list[i]->do_rtt = 0;
6974 }
6975 /* record time */
6976 data_list[i]->sent_rcv_time = net->last_sent_time;
6977 data_list[i]->rec.data.cwnd_at_send = net->cwnd;
6978 data_list[i]->rec.data.fast_retran_tsn = data_list[i]->rec.data.tsn;
6979 if (data_list[i]->whoTo == NULL) {
6980 data_list[i]->whoTo = net;
6981 atomic_add_int(&net->ref_count, 1);
6982 }
6983 /* on to the sent queue */
6984 tp1 = TAILQ_LAST(&asoc->sent_queue, sctpchunk_listhead);
6985 if ((tp1) && SCTP_TSN_GT(tp1->rec.data.tsn, data_list[i]->rec.data.tsn)) {
6986 struct sctp_tmit_chunk *tpp;
6987
6988 /* need to move back */
6989 back_up_more:
6990 tpp = TAILQ_PREV(tp1, sctpchunk_listhead, sctp_next);
6991 if (tpp == NULL) {
6992 TAILQ_INSERT_BEFORE(tp1, data_list[i], sctp_next);
6993 goto all_done;
6994 }
6995 tp1 = tpp;
6996 if (SCTP_TSN_GT(tp1->rec.data.tsn, data_list[i]->rec.data.tsn)) {
6997 goto back_up_more;
6998 }
6999 TAILQ_INSERT_AFTER(&asoc->sent_queue, tp1, data_list[i], sctp_next);
7000 } else {
7001 TAILQ_INSERT_TAIL(&asoc->sent_queue,
7002 data_list[i],
7003 sctp_next);
7004 }
7005 all_done:
7006 /* This does not lower until the cum-ack passes it */
7007 asoc->sent_queue_cnt++;
7008 if ((asoc->peers_rwnd <= 0) &&
7009 (asoc->total_flight == 0) &&
7010 (bundle_at == 1)) {
7011 /* Mark the chunk as being a window probe */
7012 SCTP_STAT_INCR(sctps_windowprobed);
7013 }
7014 #ifdef SCTP_AUDITING_ENABLED
7015 sctp_audit_log(0xC2, 3);
7016 #endif
7017 data_list[i]->sent = SCTP_DATAGRAM_SENT;
7018 data_list[i]->snd_count = 1;
7019 data_list[i]->rec.data.chunk_was_revoked = 0;
7020 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
7021 sctp_misc_ints(SCTP_FLIGHT_LOG_UP,
7022 data_list[i]->whoTo->flight_size,
7023 data_list[i]->book_size,
7024 (uint32_t)(uintptr_t)data_list[i]->whoTo,
7025 data_list[i]->rec.data.tsn);
7026 }
7027 sctp_flight_size_increase(data_list[i]);
7028 sctp_total_flight_increase(stcb, data_list[i]);
7029 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_RWND_ENABLE) {
7030 sctp_log_rwnd(SCTP_DECREASE_PEER_RWND,
7031 asoc->peers_rwnd, data_list[i]->send_size, SCTP_BASE_SYSCTL(sctp_peer_chunk_oh));
7032 }
7033 asoc->peers_rwnd = sctp_sbspace_sub(asoc->peers_rwnd,
7034 (uint32_t)(data_list[i]->send_size + SCTP_BASE_SYSCTL(sctp_peer_chunk_oh)));
7035 if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
7036 /* SWS sender side engages */
7037 asoc->peers_rwnd = 0;
7038 }
7039 }
7040 if (asoc->cc_functions.sctp_cwnd_update_packet_transmitted) {
7041 (*asoc->cc_functions.sctp_cwnd_update_packet_transmitted) (stcb, net);
7042 }
7043 }
7044
7045 static void
7046 sctp_clean_up_ctl(struct sctp_tcb *stcb, struct sctp_association *asoc, int so_locked
7047 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
7048 SCTP_UNUSED
7049 #endif
7050 )
7051 {
7052 struct sctp_tmit_chunk *chk, *nchk;
7053
7054 TAILQ_FOREACH_SAFE(chk, &asoc->control_send_queue, sctp_next, nchk) {
7055 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
7056 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK) || /* EY */
7057 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_REQUEST) ||
7058 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_ACK) ||
7059 (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) ||
7060 (chk->rec.chunk_id.id == SCTP_SHUTDOWN) ||
7061 (chk->rec.chunk_id.id == SCTP_SHUTDOWN_ACK) ||
7062 (chk->rec.chunk_id.id == SCTP_OPERATION_ERROR) ||
7063 (chk->rec.chunk_id.id == SCTP_PACKET_DROPPED) ||
7064 (chk->rec.chunk_id.id == SCTP_COOKIE_ACK) ||
7065 (chk->rec.chunk_id.id == SCTP_ECN_CWR) ||
7066 (chk->rec.chunk_id.id == SCTP_ASCONF_ACK)) {
7067 /* Stray chunks must be cleaned up */
7068 clean_up_anyway:
7069 TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next);
7070 asoc->ctrl_queue_cnt--;
7071 if (chk->data) {
7072 sctp_m_freem(chk->data);
7073 chk->data = NULL;
7074 }
7075 if (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) {
7076 asoc->fwd_tsn_cnt--;
7077 }
7078 sctp_free_a_chunk(stcb, chk, so_locked);
7079 } else if (chk->rec.chunk_id.id == SCTP_STREAM_RESET) {
7080 /* special handling, we must look into the param */
7081 if (chk != asoc->str_reset) {
7082 goto clean_up_anyway;
7083 }
7084 }
7085 }
7086 }
7087
7088 static uint32_t
7089 sctp_can_we_split_this(struct sctp_tcb *stcb, uint32_t length,
7090 uint32_t space_left, uint32_t frag_point, int eeor_on)
7091 {
7092 /*
7093 * Make a decision on if I should split a msg into multiple parts.
7094 * This is only asked of incomplete messages.
7095 */
7096 if (eeor_on) {
7097 /*
7098 * If we are doing EEOR we need to always send it if its the
7099 * entire thing, since it might be all the guy is putting in
7100 * the hopper.
7101 */
7102 if (space_left >= length) {
7103 /*-
7104 * If we have data outstanding,
7105 * we get another chance when the sack
7106 * arrives to transmit - wait for more data
7107 */
7108 if (stcb->asoc.total_flight == 0) {
7109 /*
7110 * If nothing is in flight, we zero the
7111 * packet counter.
7112 */
7113 return (length);
7114 }
7115 return (0);
7116
7117 } else {
7118 /* You can fill the rest */
7119 return (space_left);
7120 }
7121 }
7122 /*-
7123 * For those strange folk that make the send buffer
7124 * smaller than our fragmentation point, we can't
7125 * get a full msg in so we have to allow splitting.
7126 */
7127 if (SCTP_SB_LIMIT_SND(stcb->sctp_socket) < frag_point) {
7128 return (length);
7129 }
7130 if ((length <= space_left) ||
7131 ((length - space_left) < SCTP_BASE_SYSCTL(sctp_min_residual))) {
7132 /* Sub-optimial residual don't split in non-eeor mode. */
7133 return (0);
7134 }
7135 /*
7136 * If we reach here length is larger than the space_left. Do we wish
7137 * to split it for the sake of packet putting together?
7138 */
7139 if (space_left >= min(SCTP_BASE_SYSCTL(sctp_min_split_point), frag_point)) {
7140 /* Its ok to split it */
7141 return (min(space_left, frag_point));
7142 }
7143 /* Nope, can't split */
7144 return (0);
7145 }
7146
7147 static uint32_t
7148 sctp_move_to_outqueue(struct sctp_tcb *stcb,
7149 struct sctp_stream_out *strq,
7150 uint32_t space_left,
7151 uint32_t frag_point,
7152 int *giveup,
7153 int eeor_mode,
7154 int *bail,
7155 int so_locked
7156 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
7157 SCTP_UNUSED
7158 #endif
7159 )
7160 {
7161 /* Move from the stream to the send_queue keeping track of the total */
7162 struct sctp_association *asoc;
7163 struct sctp_stream_queue_pending *sp;
7164 struct sctp_tmit_chunk *chk;
7165 struct sctp_data_chunk *dchkh = NULL;
7166 struct sctp_idata_chunk *ndchkh = NULL;
7167 uint32_t to_move, length;
7168 int leading;
7169 uint8_t rcv_flags = 0;
7170 uint8_t some_taken;
7171 uint8_t send_lock_up = 0;
7172
7173 SCTP_TCB_LOCK_ASSERT(stcb);
7174 asoc = &stcb->asoc;
7175 one_more_time:
7176 /* sa_ignore FREED_MEMORY */
7177 sp = TAILQ_FIRST(&strq->outqueue);
7178 if (sp == NULL) {
7179 if (send_lock_up == 0) {
7180 SCTP_TCB_SEND_LOCK(stcb);
7181 send_lock_up = 1;
7182 }
7183 sp = TAILQ_FIRST(&strq->outqueue);
7184 if (sp) {
7185 goto one_more_time;
7186 }
7187 if ((sctp_is_feature_on(stcb->sctp_ep, SCTP_PCB_FLAGS_EXPLICIT_EOR) == 0) &&
7188 (stcb->asoc.idata_supported == 0) &&
7189 (strq->last_msg_incomplete)) {
7190 SCTP_PRINTF("Huh? Stream:%d lm_in_c=%d but queue is NULL\n",
7191 strq->sid,
7192 strq->last_msg_incomplete);
7193 strq->last_msg_incomplete = 0;
7194 }
7195 to_move = 0;
7196 if (send_lock_up) {
7197 SCTP_TCB_SEND_UNLOCK(stcb);
7198 send_lock_up = 0;
7199 }
7200 goto out_of;
7201 }
7202 if ((sp->msg_is_complete) && (sp->length == 0)) {
7203 if (sp->sender_all_done) {
7204 /*
7205 * We are doing deferred cleanup. Last time through
7206 * when we took all the data the sender_all_done was
7207 * not set.
7208 */
7209 if ((sp->put_last_out == 0) && (sp->discard_rest == 0)) {
7210 SCTP_PRINTF("Gak, put out entire msg with NO end!-1\n");
7211 SCTP_PRINTF("sender_done:%d len:%d msg_comp:%d put_last_out:%d send_lock:%d\n",
7212 sp->sender_all_done,
7213 sp->length,
7214 sp->msg_is_complete,
7215 sp->put_last_out,
7216 send_lock_up);
7217 }
7218 if ((TAILQ_NEXT(sp, next) == NULL) && (send_lock_up == 0)) {
7219 SCTP_TCB_SEND_LOCK(stcb);
7220 send_lock_up = 1;
7221 }
7222 atomic_subtract_int(&asoc->stream_queue_cnt, 1);
7223 TAILQ_REMOVE(&strq->outqueue, sp, next);
7224 stcb->asoc.ss_functions.sctp_ss_remove_from_stream(stcb, asoc, strq, sp, send_lock_up);
7225 if ((strq->state == SCTP_STREAM_RESET_PENDING) &&
7226 (strq->chunks_on_queues == 0) &&
7227 TAILQ_EMPTY(&strq->outqueue)) {
7228 stcb->asoc.trigger_reset = 1;
7229 }
7230 if (sp->net) {
7231 sctp_free_remote_addr(sp->net);
7232 sp->net = NULL;
7233 }
7234 if (sp->data) {
7235 sctp_m_freem(sp->data);
7236 sp->data = NULL;
7237 }
7238 sctp_free_a_strmoq(stcb, sp, so_locked);
7239 /* we can't be locked to it */
7240 if (send_lock_up) {
7241 SCTP_TCB_SEND_UNLOCK(stcb);
7242 send_lock_up = 0;
7243 }
7244 /* back to get the next msg */
7245 goto one_more_time;
7246 } else {
7247 /*
7248 * sender just finished this but still holds a
7249 * reference
7250 */
7251 *giveup = 1;
7252 to_move = 0;
7253 goto out_of;
7254 }
7255 } else {
7256 /* is there some to get */
7257 if (sp->length == 0) {
7258 /* no */
7259 *giveup = 1;
7260 to_move = 0;
7261 goto out_of;
7262 } else if (sp->discard_rest) {
7263 if (send_lock_up == 0) {
7264 SCTP_TCB_SEND_LOCK(stcb);
7265 send_lock_up = 1;
7266 }
7267 /* Whack down the size */
7268 atomic_subtract_int(&stcb->asoc.total_output_queue_size, sp->length);
7269 if ((stcb->sctp_socket != NULL) &&
7270 ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) ||
7271 (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL))) {
7272 atomic_subtract_int(&stcb->sctp_socket->so_snd.sb_cc, sp->length);
7273 }
7274 if (sp->data) {
7275 sctp_m_freem(sp->data);
7276 sp->data = NULL;
7277 sp->tail_mbuf = NULL;
7278 }
7279 sp->length = 0;
7280 sp->some_taken = 1;
7281 *giveup = 1;
7282 to_move = 0;
7283 goto out_of;
7284 }
7285 }
7286 some_taken = sp->some_taken;
7287 re_look:
7288 length = sp->length;
7289 if (sp->msg_is_complete) {
7290 /* The message is complete */
7291 to_move = min(length, frag_point);
7292 if (to_move == length) {
7293 /* All of it fits in the MTU */
7294 if (sp->some_taken) {
7295 rcv_flags |= SCTP_DATA_LAST_FRAG;
7296 } else {
7297 rcv_flags |= SCTP_DATA_NOT_FRAG;
7298 }
7299 sp->put_last_out = 1;
7300 if (sp->sinfo_flags & SCTP_SACK_IMMEDIATELY) {
7301 rcv_flags |= SCTP_DATA_SACK_IMMEDIATELY;
7302 }
7303 } else {
7304 /* Not all of it fits, we fragment */
7305 if (sp->some_taken == 0) {
7306 rcv_flags |= SCTP_DATA_FIRST_FRAG;
7307 }
7308 sp->some_taken = 1;
7309 }
7310 } else {
7311 to_move = sctp_can_we_split_this(stcb, length, space_left, frag_point, eeor_mode);
7312 if (to_move) {
7313 /*-
7314 * We use a snapshot of length in case it
7315 * is expanding during the compare.
7316 */
7317 uint32_t llen;
7318
7319 llen = length;
7320 if (to_move >= llen) {
7321 to_move = llen;
7322 if (send_lock_up == 0) {
7323 /*-
7324 * We are taking all of an incomplete msg
7325 * thus we need a send lock.
7326 */
7327 SCTP_TCB_SEND_LOCK(stcb);
7328 send_lock_up = 1;
7329 if (sp->msg_is_complete) {
7330 /*
7331 * the sender finished the
7332 * msg
7333 */
7334 goto re_look;
7335 }
7336 }
7337 }
7338 if (sp->some_taken == 0) {
7339 rcv_flags |= SCTP_DATA_FIRST_FRAG;
7340 sp->some_taken = 1;
7341 }
7342 } else {
7343 /* Nothing to take. */
7344 *giveup = 1;
7345 to_move = 0;
7346 goto out_of;
7347 }
7348 }
7349
7350 /* If we reach here, we can copy out a chunk */
7351 sctp_alloc_a_chunk(stcb, chk);
7352 if (chk == NULL) {
7353 /* No chunk memory */
7354 *giveup = 1;
7355 to_move = 0;
7356 goto out_of;
7357 }
7358 /*
7359 * Setup for unordered if needed by looking at the user sent info
7360 * flags.
7361 */
7362 if (sp->sinfo_flags & SCTP_UNORDERED) {
7363 rcv_flags |= SCTP_DATA_UNORDERED;
7364 }
7365 if (SCTP_BASE_SYSCTL(sctp_enable_sack_immediately) &&
7366 (sp->sinfo_flags & SCTP_EOF) == SCTP_EOF) {
7367 rcv_flags |= SCTP_DATA_SACK_IMMEDIATELY;
7368 }
7369 /* clear out the chunk before setting up */
7370 memset(chk, 0, sizeof(*chk));
7371 chk->rec.data.rcv_flags = rcv_flags;
7372
7373 if (to_move >= length) {
7374 /* we think we can steal the whole thing */
7375 if ((sp->sender_all_done == 0) && (send_lock_up == 0)) {
7376 SCTP_TCB_SEND_LOCK(stcb);
7377 send_lock_up = 1;
7378 }
7379 if (to_move < sp->length) {
7380 /* bail, it changed */
7381 goto dont_do_it;
7382 }
7383 chk->data = sp->data;
7384 chk->last_mbuf = sp->tail_mbuf;
7385 /* register the stealing */
7386 sp->data = sp->tail_mbuf = NULL;
7387 } else {
7388 struct mbuf *m;
7389
7390 dont_do_it:
7391 chk->data = SCTP_M_COPYM(sp->data, 0, to_move, M_NOWAIT);
7392 chk->last_mbuf = NULL;
7393 if (chk->data == NULL) {
7394 sp->some_taken = some_taken;
7395 sctp_free_a_chunk(stcb, chk, so_locked);
7396 *bail = 1;
7397 to_move = 0;
7398 goto out_of;
7399 }
7400 #ifdef SCTP_MBUF_LOGGING
7401 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
7402 sctp_log_mbc(chk->data, SCTP_MBUF_ICOPY);
7403 }
7404 #endif
7405 /* Pull off the data */
7406 m_adj(sp->data, to_move);
7407 /* Now lets work our way down and compact it */
7408 m = sp->data;
7409 while (m && (SCTP_BUF_LEN(m) == 0)) {
7410 sp->data = SCTP_BUF_NEXT(m);
7411 SCTP_BUF_NEXT(m) = NULL;
7412 if (sp->tail_mbuf == m) {
7413 /*-
7414 * Freeing tail? TSNH since
7415 * we supposedly were taking less
7416 * than the sp->length.
7417 */
7418 #ifdef INVARIANTS
7419 panic("Huh, freing tail? - TSNH");
7420 #else
7421 SCTP_PRINTF("Huh, freeing tail? - TSNH\n");
7422 sp->tail_mbuf = sp->data = NULL;
7423 sp->length = 0;
7424 #endif
7425
7426 }
7427 sctp_m_free(m);
7428 m = sp->data;
7429 }
7430 }
7431 if (SCTP_BUF_IS_EXTENDED(chk->data)) {
7432 chk->copy_by_ref = 1;
7433 } else {
7434 chk->copy_by_ref = 0;
7435 }
7436 /*
7437 * get last_mbuf and counts of mb usage This is ugly but hopefully
7438 * its only one mbuf.
7439 */
7440 if (chk->last_mbuf == NULL) {
7441 chk->last_mbuf = chk->data;
7442 while (SCTP_BUF_NEXT(chk->last_mbuf) != NULL) {
7443 chk->last_mbuf = SCTP_BUF_NEXT(chk->last_mbuf);
7444 }
7445 }
7446
7447 if (to_move > length) {
7448 /*- This should not happen either
7449 * since we always lower to_move to the size
7450 * of sp->length if its larger.
7451 */
7452 #ifdef INVARIANTS
7453 panic("Huh, how can to_move be larger?");
7454 #else
7455 SCTP_PRINTF("Huh, how can to_move be larger?\n");
7456 sp->length = 0;
7457 #endif
7458 } else {
7459 atomic_subtract_int(&sp->length, to_move);
7460 }
7461 leading = SCTP_DATA_CHUNK_OVERHEAD(stcb);
7462 if (M_LEADINGSPACE(chk->data) < leading) {
7463 /* Not enough room for a chunk header, get some */
7464 struct mbuf *m;
7465
7466 m = sctp_get_mbuf_for_msg(1, 0, M_NOWAIT, 1, MT_DATA);
7467 if (m == NULL) {
7468 /*
7469 * we're in trouble here. _PREPEND below will free
7470 * all the data if there is no leading space, so we
7471 * must put the data back and restore.
7472 */
7473 if (send_lock_up == 0) {
7474 SCTP_TCB_SEND_LOCK(stcb);
7475 send_lock_up = 1;
7476 }
7477 if (sp->data == NULL) {
7478 /* unsteal the data */
7479 sp->data = chk->data;
7480 sp->tail_mbuf = chk->last_mbuf;
7481 } else {
7482 struct mbuf *m_tmp;
7483
7484 /* reassemble the data */
7485 m_tmp = sp->data;
7486 sp->data = chk->data;
7487 SCTP_BUF_NEXT(chk->last_mbuf) = m_tmp;
7488 }
7489 sp->some_taken = some_taken;
7490 atomic_add_int(&sp->length, to_move);
7491 chk->data = NULL;
7492 *bail = 1;
7493 sctp_free_a_chunk(stcb, chk, so_locked);
7494 to_move = 0;
7495 goto out_of;
7496 } else {
7497 SCTP_BUF_LEN(m) = 0;
7498 SCTP_BUF_NEXT(m) = chk->data;
7499 chk->data = m;
7500 M_ALIGN(chk->data, 4);
7501 }
7502 }
7503 SCTP_BUF_PREPEND(chk->data, SCTP_DATA_CHUNK_OVERHEAD(stcb), M_NOWAIT);
7504 if (chk->data == NULL) {
7505 /* HELP, TSNH since we assured it would not above? */
7506 #ifdef INVARIANTS
7507 panic("prepend failes HELP?");
7508 #else
7509 SCTP_PRINTF("prepend fails HELP?\n");
7510 sctp_free_a_chunk(stcb, chk, so_locked);
7511 #endif
7512 *bail = 1;
7513 to_move = 0;
7514 goto out_of;
7515 }
7516 sctp_snd_sb_alloc(stcb, SCTP_DATA_CHUNK_OVERHEAD(stcb));
7517 chk->book_size = chk->send_size = (uint16_t)(to_move + SCTP_DATA_CHUNK_OVERHEAD(stcb));
7518 chk->book_size_scale = 0;
7519 chk->sent = SCTP_DATAGRAM_UNSENT;
7520
7521 chk->flags = 0;
7522 chk->asoc = &stcb->asoc;
7523 chk->pad_inplace = 0;
7524 chk->no_fr_allowed = 0;
7525 if (stcb->asoc.idata_supported == 0) {
7526 if (rcv_flags & SCTP_DATA_UNORDERED) {
7527 /* Just use 0. The receiver ignores the values. */
7528 chk->rec.data.mid = 0;
7529 } else {
7530 chk->rec.data.mid = strq->next_mid_ordered;
7531 if (rcv_flags & SCTP_DATA_LAST_FRAG) {
7532 strq->next_mid_ordered++;
7533 }
7534 }
7535 } else {
7536 if (rcv_flags & SCTP_DATA_UNORDERED) {
7537 chk->rec.data.mid = strq->next_mid_unordered;
7538 if (rcv_flags & SCTP_DATA_LAST_FRAG) {
7539 strq->next_mid_unordered++;
7540 }
7541 } else {
7542 chk->rec.data.mid = strq->next_mid_ordered;
7543 if (rcv_flags & SCTP_DATA_LAST_FRAG) {
7544 strq->next_mid_ordered++;
7545 }
7546 }
7547 }
7548 chk->rec.data.sid = sp->sid;
7549 chk->rec.data.ppid = sp->ppid;
7550 chk->rec.data.context = sp->context;
7551 chk->rec.data.doing_fast_retransmit = 0;
7552
7553 chk->rec.data.timetodrop = sp->ts;
7554 chk->flags = sp->act_flags;
7555
7556 if (sp->net) {
7557 chk->whoTo = sp->net;
7558 atomic_add_int(&chk->whoTo->ref_count, 1);
7559 } else
7560 chk->whoTo = NULL;
7561
7562 if (sp->holds_key_ref) {
7563 chk->auth_keyid = sp->auth_keyid;
7564 sctp_auth_key_acquire(stcb, chk->auth_keyid);
7565 chk->holds_key_ref = 1;
7566 }
7567 chk->rec.data.tsn = atomic_fetchadd_int(&asoc->sending_seq, 1);
7568 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_AT_SEND_2_OUTQ) {
7569 sctp_misc_ints(SCTP_STRMOUT_LOG_SEND,
7570 (uint32_t)(uintptr_t)stcb, sp->length,
7571 (uint32_t)((chk->rec.data.sid << 16) | (0x0000ffff & chk->rec.data.mid)),
7572 chk->rec.data.tsn);
7573 }
7574 if (stcb->asoc.idata_supported == 0) {
7575 dchkh = mtod(chk->data, struct sctp_data_chunk *);
7576 } else {
7577 ndchkh = mtod(chk->data, struct sctp_idata_chunk *);
7578 }
7579 /*
7580 * Put the rest of the things in place now. Size was done earlier in
7581 * previous loop prior to padding.
7582 */
7583
7584 #ifdef SCTP_ASOCLOG_OF_TSNS
7585 SCTP_TCB_LOCK_ASSERT(stcb);
7586 if (asoc->tsn_out_at >= SCTP_TSN_LOG_SIZE) {
7587 asoc->tsn_out_at = 0;
7588 asoc->tsn_out_wrapped = 1;
7589 }
7590 asoc->out_tsnlog[asoc->tsn_out_at].tsn = chk->rec.data.tsn;
7591 asoc->out_tsnlog[asoc->tsn_out_at].strm = chk->rec.data.sid;
7592 asoc->out_tsnlog[asoc->tsn_out_at].seq = chk->rec.data.mid;
7593 asoc->out_tsnlog[asoc->tsn_out_at].sz = chk->send_size;
7594 asoc->out_tsnlog[asoc->tsn_out_at].flgs = chk->rec.data.rcv_flags;
7595 asoc->out_tsnlog[asoc->tsn_out_at].stcb = (void *)stcb;
7596 asoc->out_tsnlog[asoc->tsn_out_at].in_pos = asoc->tsn_out_at;
7597 asoc->out_tsnlog[asoc->tsn_out_at].in_out = 2;
7598 asoc->tsn_out_at++;
7599 #endif
7600 if (stcb->asoc.idata_supported == 0) {
7601 dchkh->ch.chunk_type = SCTP_DATA;
7602 dchkh->ch.chunk_flags = chk->rec.data.rcv_flags;
7603 dchkh->dp.tsn = htonl(chk->rec.data.tsn);
7604 dchkh->dp.sid = htons(strq->sid);
7605 dchkh->dp.ssn = htons((uint16_t)chk->rec.data.mid);
7606 dchkh->dp.ppid = chk->rec.data.ppid;
7607 dchkh->ch.chunk_length = htons(chk->send_size);
7608 } else {
7609 ndchkh->ch.chunk_type = SCTP_IDATA;
7610 ndchkh->ch.chunk_flags = chk->rec.data.rcv_flags;
7611 ndchkh->dp.tsn = htonl(chk->rec.data.tsn);
7612 ndchkh->dp.sid = htons(strq->sid);
7613 ndchkh->dp.reserved = htons(0);
7614 ndchkh->dp.mid = htonl(chk->rec.data.mid);
7615 if (sp->fsn == 0)
7616 ndchkh->dp.ppid_fsn.ppid = chk->rec.data.ppid;
7617 else
7618 ndchkh->dp.ppid_fsn.fsn = htonl(sp->fsn);
7619 sp->fsn++;
7620 ndchkh->ch.chunk_length = htons(chk->send_size);
7621 }
7622 /* Now advance the chk->send_size by the actual pad needed. */
7623 if (chk->send_size < SCTP_SIZE32(chk->book_size)) {
7624 /* need a pad */
7625 struct mbuf *lm;
7626 int pads;
7627
7628 pads = SCTP_SIZE32(chk->book_size) - chk->send_size;
7629 lm = sctp_pad_lastmbuf(chk->data, pads, chk->last_mbuf);
7630 if (lm != NULL) {
7631 chk->last_mbuf = lm;
7632 chk->pad_inplace = 1;
7633 }
7634 chk->send_size += pads;
7635 }
7636 if (PR_SCTP_ENABLED(chk->flags)) {
7637 asoc->pr_sctp_cnt++;
7638 }
7639 if (sp->msg_is_complete && (sp->length == 0) && (sp->sender_all_done)) {
7640 /* All done pull and kill the message */
7641 if (sp->put_last_out == 0) {
7642 SCTP_PRINTF("Gak, put out entire msg with NO end!-2\n");
7643 SCTP_PRINTF("sender_done:%d len:%d msg_comp:%d put_last_out:%d send_lock:%d\n",
7644 sp->sender_all_done,
7645 sp->length,
7646 sp->msg_is_complete,
7647 sp->put_last_out,
7648 send_lock_up);
7649 }
7650 if ((send_lock_up == 0) && (TAILQ_NEXT(sp, next) == NULL)) {
7651 SCTP_TCB_SEND_LOCK(stcb);
7652 send_lock_up = 1;
7653 }
7654 atomic_subtract_int(&asoc->stream_queue_cnt, 1);
7655 TAILQ_REMOVE(&strq->outqueue, sp, next);
7656 stcb->asoc.ss_functions.sctp_ss_remove_from_stream(stcb, asoc, strq, sp, send_lock_up);
7657 if ((strq->state == SCTP_STREAM_RESET_PENDING) &&
7658 (strq->chunks_on_queues == 0) &&
7659 TAILQ_EMPTY(&strq->outqueue)) {
7660 stcb->asoc.trigger_reset = 1;
7661 }
7662 if (sp->net) {
7663 sctp_free_remote_addr(sp->net);
7664 sp->net = NULL;
7665 }
7666 if (sp->data) {
7667 sctp_m_freem(sp->data);
7668 sp->data = NULL;
7669 }
7670 sctp_free_a_strmoq(stcb, sp, so_locked);
7671 }
7672 asoc->chunks_on_out_queue++;
7673 strq->chunks_on_queues++;
7674 TAILQ_INSERT_TAIL(&asoc->send_queue, chk, sctp_next);
7675 asoc->send_queue_cnt++;
7676 out_of:
7677 if (send_lock_up) {
7678 SCTP_TCB_SEND_UNLOCK(stcb);
7679 }
7680 return (to_move);
7681 }
7682
7683
7684 static void
7685 sctp_fill_outqueue(struct sctp_tcb *stcb,
7686 struct sctp_nets *net, int frag_point, int eeor_mode, int *quit_now, int so_locked
7687 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
7688 SCTP_UNUSED
7689 #endif
7690 )
7691 {
7692 struct sctp_association *asoc;
7693 struct sctp_stream_out *strq;
7694 uint32_t space_left, moved, total_moved;
7695 int bail, giveup;
7696
7697 SCTP_TCB_LOCK_ASSERT(stcb);
7698 asoc = &stcb->asoc;
7699 total_moved = 0;
7700 switch (net->ro._l_addr.sa.sa_family) {
7701 #ifdef INET
7702 case AF_INET:
7703 space_left = net->mtu - SCTP_MIN_V4_OVERHEAD;
7704 break;
7705 #endif
7706 #ifdef INET6
7707 case AF_INET6:
7708 space_left = net->mtu - SCTP_MIN_OVERHEAD;
7709 break;
7710 #endif
7711 default:
7712 /* TSNH */
7713 space_left = net->mtu;
7714 break;
7715 }
7716 /* Need an allowance for the data chunk header too */
7717 space_left -= SCTP_DATA_CHUNK_OVERHEAD(stcb);
7718
7719 /* must make even word boundary */
7720 space_left &= 0xfffffffc;
7721 strq = stcb->asoc.ss_functions.sctp_ss_select_stream(stcb, net, asoc);
7722 giveup = 0;
7723 bail = 0;
7724 while ((space_left > 0) && (strq != NULL)) {
7725 moved = sctp_move_to_outqueue(stcb, strq, space_left, frag_point,
7726 &giveup, eeor_mode, &bail, so_locked);
7727 stcb->asoc.ss_functions.sctp_ss_scheduled(stcb, net, asoc, strq, moved);
7728 if ((giveup != 0) || (bail != 0)) {
7729 break;
7730 }
7731 strq = stcb->asoc.ss_functions.sctp_ss_select_stream(stcb, net, asoc);
7732 total_moved += moved;
7733 space_left -= moved;
7734 if (space_left >= SCTP_DATA_CHUNK_OVERHEAD(stcb)) {
7735 space_left -= SCTP_DATA_CHUNK_OVERHEAD(stcb);
7736 } else {
7737 space_left = 0;
7738 }
7739 space_left &= 0xfffffffc;
7740 }
7741 if (bail != 0)
7742 *quit_now = 1;
7743
7744 stcb->asoc.ss_functions.sctp_ss_packet_done(stcb, net, asoc);
7745
7746 if (total_moved == 0) {
7747 if ((stcb->asoc.sctp_cmt_on_off == 0) &&
7748 (net == stcb->asoc.primary_destination)) {
7749 /* ran dry for primary network net */
7750 SCTP_STAT_INCR(sctps_primary_randry);
7751 } else if (stcb->asoc.sctp_cmt_on_off > 0) {
7752 /* ran dry with CMT on */
7753 SCTP_STAT_INCR(sctps_cmt_randry);
7754 }
7755 }
7756 }
7757
7758 void
7759 sctp_fix_ecn_echo(struct sctp_association *asoc)
7760 {
7761 struct sctp_tmit_chunk *chk;
7762
7763 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
7764 if (chk->rec.chunk_id.id == SCTP_ECN_ECHO) {
7765 chk->sent = SCTP_DATAGRAM_UNSENT;
7766 }
7767 }
7768 }
7769
7770 void
7771 sctp_move_chunks_from_net(struct sctp_tcb *stcb, struct sctp_nets *net)
7772 {
7773 struct sctp_association *asoc;
7774 struct sctp_tmit_chunk *chk;
7775 struct sctp_stream_queue_pending *sp;
7776 unsigned int i;
7777
7778 if (net == NULL) {
7779 return;
7780 }
7781 asoc = &stcb->asoc;
7782 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
7783 TAILQ_FOREACH(sp, &stcb->asoc.strmout[i].outqueue, next) {
7784 if (sp->net == net) {
7785 sctp_free_remote_addr(sp->net);
7786 sp->net = NULL;
7787 }
7788 }
7789 }
7790 TAILQ_FOREACH(chk, &asoc->send_queue, sctp_next) {
7791 if (chk->whoTo == net) {
7792 sctp_free_remote_addr(chk->whoTo);
7793 chk->whoTo = NULL;
7794 }
7795 }
7796 }
7797
7798 int
7799 sctp_med_chunk_output(struct sctp_inpcb *inp,
7800 struct sctp_tcb *stcb,
7801 struct sctp_association *asoc,
7802 int *num_out,
7803 int *reason_code,
7804 int control_only, int from_where,
7805 struct timeval *now, int *now_filled, int frag_point, int so_locked
7806 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
7807 SCTP_UNUSED
7808 #endif
7809 )
7810 {
7811 /**
7812 * Ok this is the generic chunk service queue. we must do the
7813 * following:
7814 * - Service the stream queue that is next, moving any
7815 * message (note I must get a complete message i.e. FIRST/MIDDLE and
7816 * LAST to the out queue in one pass) and assigning TSN's. This
7817 * only applys though if the peer does not support NDATA. For NDATA
7818 * chunks its ok to not send the entire message ;-)
7819 * - Check to see if the cwnd/rwnd allows any output, if so we go ahead and
7820 * fomulate and send the low level chunks. Making sure to combine
7821 * any control in the control chunk queue also.
7822 */
7823 struct sctp_nets *net, *start_at, *sack_goes_to = NULL, *old_start_at = NULL;
7824 struct mbuf *outchain, *endoutchain;
7825 struct sctp_tmit_chunk *chk, *nchk;
7826
7827 /* temp arrays for unlinking */
7828 struct sctp_tmit_chunk *data_list[SCTP_MAX_DATA_BUNDLING];
7829 int no_fragmentflg, error;
7830 unsigned int max_rwnd_per_dest, max_send_per_dest;
7831 int one_chunk, hbflag, skip_data_for_this_net;
7832 int asconf, cookie, no_out_cnt;
7833 int bundle_at, ctl_cnt, no_data_chunks, eeor_mode;
7834 unsigned int mtu, r_mtu, omtu, mx_mtu, to_out;
7835 int tsns_sent = 0;
7836 uint32_t auth_offset = 0;
7837 struct sctp_auth_chunk *auth = NULL;
7838 uint16_t auth_keyid;
7839 int override_ok = 1;
7840 int skip_fill_up = 0;
7841 int data_auth_reqd = 0;
7842
7843 /*
7844 * JRS 5/14/07 - Add flag for whether a heartbeat is sent to the
7845 * destination.
7846 */
7847 int quit_now = 0;
7848
7849 *num_out = 0;
7850 *reason_code = 0;
7851 auth_keyid = stcb->asoc.authinfo.active_keyid;
7852 if ((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) ||
7853 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
7854 (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXPLICIT_EOR))) {
7855 eeor_mode = 1;
7856 } else {
7857 eeor_mode = 0;
7858 }
7859 ctl_cnt = no_out_cnt = asconf = cookie = 0;
7860 /*
7861 * First lets prime the pump. For each destination, if there is room
7862 * in the flight size, attempt to pull an MTU's worth out of the
7863 * stream queues into the general send_queue
7864 */
7865 #ifdef SCTP_AUDITING_ENABLED
7866 sctp_audit_log(0xC2, 2);
7867 #endif
7868 SCTP_TCB_LOCK_ASSERT(stcb);
7869 hbflag = 0;
7870 if (control_only)
7871 no_data_chunks = 1;
7872 else
7873 no_data_chunks = 0;
7874
7875 /* Nothing to possible to send? */
7876 if ((TAILQ_EMPTY(&asoc->control_send_queue) ||
7877 (asoc->ctrl_queue_cnt == stcb->asoc.ecn_echo_cnt_onq)) &&
7878 TAILQ_EMPTY(&asoc->asconf_send_queue) &&
7879 TAILQ_EMPTY(&asoc->send_queue) &&
7880 sctp_is_there_unsent_data(stcb, so_locked) == 0) {
7881 nothing_to_send:
7882 *reason_code = 9;
7883 return (0);
7884 }
7885 if (asoc->peers_rwnd == 0) {
7886 /* No room in peers rwnd */
7887 *reason_code = 1;
7888 if (asoc->total_flight > 0) {
7889 /* we are allowed one chunk in flight */
7890 no_data_chunks = 1;
7891 }
7892 }
7893 if (stcb->asoc.ecn_echo_cnt_onq) {
7894 /* Record where a sack goes, if any */
7895 if (no_data_chunks &&
7896 (asoc->ctrl_queue_cnt == stcb->asoc.ecn_echo_cnt_onq)) {
7897 /* Nothing but ECNe to send - we don't do that */
7898 goto nothing_to_send;
7899 }
7900 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
7901 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
7902 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK)) {
7903 sack_goes_to = chk->whoTo;
7904 break;
7905 }
7906 }
7907 }
7908 max_rwnd_per_dest = ((asoc->peers_rwnd + asoc->total_flight) / asoc->numnets);
7909 if (stcb->sctp_socket)
7910 max_send_per_dest = SCTP_SB_LIMIT_SND(stcb->sctp_socket) / asoc->numnets;
7911 else
7912 max_send_per_dest = 0;
7913 if (no_data_chunks == 0) {
7914 /* How many non-directed chunks are there? */
7915 TAILQ_FOREACH(chk, &asoc->send_queue, sctp_next) {
7916 if (chk->whoTo == NULL) {
7917 /*
7918 * We already have non-directed chunks on
7919 * the queue, no need to do a fill-up.
7920 */
7921 skip_fill_up = 1;
7922 break;
7923 }
7924 }
7925
7926 }
7927 if ((no_data_chunks == 0) &&
7928 (skip_fill_up == 0) &&
7929 (!stcb->asoc.ss_functions.sctp_ss_is_empty(stcb, asoc))) {
7930 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
7931 /*
7932 * This for loop we are in takes in each net, if
7933 * its's got space in cwnd and has data sent to it
7934 * (when CMT is off) then it calls
7935 * sctp_fill_outqueue for the net. This gets data on
7936 * the send queue for that network.
7937 *
7938 * In sctp_fill_outqueue TSN's are assigned and data
7939 * is copied out of the stream buffers. Note mostly
7940 * copy by reference (we hope).
7941 */
7942 net->window_probe = 0;
7943 if ((net != stcb->asoc.alternate) &&
7944 ((net->dest_state & SCTP_ADDR_PF) ||
7945 (!(net->dest_state & SCTP_ADDR_REACHABLE)) ||
7946 (net->dest_state & SCTP_ADDR_UNCONFIRMED))) {
7947 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
7948 sctp_log_cwnd(stcb, net, 1,
7949 SCTP_CWND_LOG_FILL_OUTQ_CALLED);
7950 }
7951 continue;
7952 }
7953 if ((stcb->asoc.cc_functions.sctp_cwnd_new_transmission_begins) &&
7954 (net->flight_size == 0)) {
7955 (*stcb->asoc.cc_functions.sctp_cwnd_new_transmission_begins) (stcb, net);
7956 }
7957 if (net->flight_size >= net->cwnd) {
7958 /* skip this network, no room - can't fill */
7959 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
7960 sctp_log_cwnd(stcb, net, 3,
7961 SCTP_CWND_LOG_FILL_OUTQ_CALLED);
7962 }
7963 continue;
7964 }
7965 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
7966 sctp_log_cwnd(stcb, net, 4, SCTP_CWND_LOG_FILL_OUTQ_CALLED);
7967 }
7968 sctp_fill_outqueue(stcb, net, frag_point, eeor_mode, &quit_now, so_locked);
7969 if (quit_now) {
7970 /* memory alloc failure */
7971 no_data_chunks = 1;
7972 break;
7973 }
7974 }
7975 }
7976 /* now service each destination and send out what we can for it */
7977 /* Nothing to send? */
7978 if (TAILQ_EMPTY(&asoc->control_send_queue) &&
7979 TAILQ_EMPTY(&asoc->asconf_send_queue) &&
7980 TAILQ_EMPTY(&asoc->send_queue)) {
7981 *reason_code = 8;
7982 return (0);
7983 }
7984
7985 if (asoc->sctp_cmt_on_off > 0) {
7986 /* get the last start point */
7987 start_at = asoc->last_net_cmt_send_started;
7988 if (start_at == NULL) {
7989 /* null so to beginning */
7990 start_at = TAILQ_FIRST(&asoc->nets);
7991 } else {
7992 start_at = TAILQ_NEXT(asoc->last_net_cmt_send_started, sctp_next);
7993 if (start_at == NULL) {
7994 start_at = TAILQ_FIRST(&asoc->nets);
7995 }
7996 }
7997 asoc->last_net_cmt_send_started = start_at;
7998 } else {
7999 start_at = TAILQ_FIRST(&asoc->nets);
8000 }
8001 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
8002 if (chk->whoTo == NULL) {
8003 if (asoc->alternate) {
8004 chk->whoTo = asoc->alternate;
8005 } else {
8006 chk->whoTo = asoc->primary_destination;
8007 }
8008 atomic_add_int(&chk->whoTo->ref_count, 1);
8009 }
8010 }
8011 old_start_at = NULL;
8012 again_one_more_time:
8013 for (net = start_at; net != NULL; net = TAILQ_NEXT(net, sctp_next)) {
8014 /* how much can we send? */
8015 /* SCTPDBG("Examine for sending net:%x\n", (uint32_t)net); */
8016 if (old_start_at && (old_start_at == net)) {
8017 /* through list ocmpletely. */
8018 break;
8019 }
8020 tsns_sent = 0xa;
8021 if (TAILQ_EMPTY(&asoc->control_send_queue) &&
8022 TAILQ_EMPTY(&asoc->asconf_send_queue) &&
8023 (net->flight_size >= net->cwnd)) {
8024 /*
8025 * Nothing on control or asconf and flight is full,
8026 * we can skip even in the CMT case.
8027 */
8028 continue;
8029 }
8030 bundle_at = 0;
8031 endoutchain = outchain = NULL;
8032 no_fragmentflg = 1;
8033 one_chunk = 0;
8034 if (net->dest_state & SCTP_ADDR_UNCONFIRMED) {
8035 skip_data_for_this_net = 1;
8036 } else {
8037 skip_data_for_this_net = 0;
8038 }
8039 switch (((struct sockaddr *)&net->ro._l_addr)->sa_family) {
8040 #ifdef INET
8041 case AF_INET:
8042 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8043 break;
8044 #endif
8045 #ifdef INET6
8046 case AF_INET6:
8047 mtu = net->mtu - SCTP_MIN_OVERHEAD;
8048 break;
8049 #endif
8050 default:
8051 /* TSNH */
8052 mtu = net->mtu;
8053 break;
8054 }
8055 mx_mtu = mtu;
8056 to_out = 0;
8057 if (mtu > asoc->peers_rwnd) {
8058 if (asoc->total_flight > 0) {
8059 /* We have a packet in flight somewhere */
8060 r_mtu = asoc->peers_rwnd;
8061 } else {
8062 /* We are always allowed to send one MTU out */
8063 one_chunk = 1;
8064 r_mtu = mtu;
8065 }
8066 } else {
8067 r_mtu = mtu;
8068 }
8069 error = 0;
8070 /************************/
8071 /* ASCONF transmission */
8072 /************************/
8073 /* Now first lets go through the asconf queue */
8074 TAILQ_FOREACH_SAFE(chk, &asoc->asconf_send_queue, sctp_next, nchk) {
8075 if (chk->rec.chunk_id.id != SCTP_ASCONF) {
8076 continue;
8077 }
8078 if (chk->whoTo == NULL) {
8079 if (asoc->alternate == NULL) {
8080 if (asoc->primary_destination != net) {
8081 break;
8082 }
8083 } else {
8084 if (asoc->alternate != net) {
8085 break;
8086 }
8087 }
8088 } else {
8089 if (chk->whoTo != net) {
8090 break;
8091 }
8092 }
8093 if (chk->data == NULL) {
8094 break;
8095 }
8096 if (chk->sent != SCTP_DATAGRAM_UNSENT &&
8097 chk->sent != SCTP_DATAGRAM_RESEND) {
8098 break;
8099 }
8100 /*
8101 * if no AUTH is yet included and this chunk
8102 * requires it, make sure to account for it. We
8103 * don't apply the size until the AUTH chunk is
8104 * actually added below in case there is no room for
8105 * this chunk. NOTE: we overload the use of "omtu"
8106 * here
8107 */
8108 if ((auth == NULL) &&
8109 sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8110 stcb->asoc.peer_auth_chunks)) {
8111 omtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
8112 } else
8113 omtu = 0;
8114 /* Here we do NOT factor the r_mtu */
8115 if ((chk->send_size < (int)(mtu - omtu)) ||
8116 (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) {
8117 /*
8118 * We probably should glom the mbuf chain
8119 * from the chk->data for control but the
8120 * problem is it becomes yet one more level
8121 * of tracking to do if for some reason
8122 * output fails. Then I have got to
8123 * reconstruct the merged control chain.. el
8124 * yucko.. for now we take the easy way and
8125 * do the copy
8126 */
8127 /*
8128 * Add an AUTH chunk, if chunk requires it
8129 * save the offset into the chain for AUTH
8130 */
8131 if ((auth == NULL) &&
8132 (sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8133 stcb->asoc.peer_auth_chunks))) {
8134 outchain = sctp_add_auth_chunk(outchain,
8135 &endoutchain,
8136 &auth,
8137 &auth_offset,
8138 stcb,
8139 chk->rec.chunk_id.id);
8140 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8141 }
8142 outchain = sctp_copy_mbufchain(chk->data, outchain, &endoutchain,
8143 (int)chk->rec.chunk_id.can_take_data,
8144 chk->send_size, chk->copy_by_ref);
8145 if (outchain == NULL) {
8146 *reason_code = 8;
8147 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
8148 return (ENOMEM);
8149 }
8150 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8151 /* update our MTU size */
8152 if (mtu > (chk->send_size + omtu))
8153 mtu -= (chk->send_size + omtu);
8154 else
8155 mtu = 0;
8156 to_out += (chk->send_size + omtu);
8157 /* Do clear IP_DF ? */
8158 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
8159 no_fragmentflg = 0;
8160 }
8161 if (chk->rec.chunk_id.can_take_data)
8162 chk->data = NULL;
8163 /*
8164 * set hb flag since we can use these for
8165 * RTO
8166 */
8167 hbflag = 1;
8168 asconf = 1;
8169 /*
8170 * should sysctl this: don't bundle data
8171 * with ASCONF since it requires AUTH
8172 */
8173 no_data_chunks = 1;
8174 chk->sent = SCTP_DATAGRAM_SENT;
8175 if (chk->whoTo == NULL) {
8176 chk->whoTo = net;
8177 atomic_add_int(&net->ref_count, 1);
8178 }
8179 chk->snd_count++;
8180 if (mtu == 0) {
8181 /*
8182 * Ok we are out of room but we can
8183 * output without effecting the
8184 * flight size since this little guy
8185 * is a control only packet.
8186 */
8187 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, net);
8188 /*
8189 * do NOT clear the asconf flag as
8190 * it is used to do appropriate
8191 * source address selection.
8192 */
8193 if (*now_filled == 0) {
8194 (void)SCTP_GETTIME_TIMEVAL(now);
8195 *now_filled = 1;
8196 }
8197 net->last_sent_time = *now;
8198 hbflag = 0;
8199 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
8200 (struct sockaddr *)&net->ro._l_addr,
8201 outchain, auth_offset, auth,
8202 stcb->asoc.authinfo.active_keyid,
8203 no_fragmentflg, 0, asconf,
8204 inp->sctp_lport, stcb->rport,
8205 htonl(stcb->asoc.peer_vtag),
8206 net->port, NULL,
8207 0, 0,
8208 so_locked))) {
8209 /*
8210 * error, we could not
8211 * output
8212 */
8213 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
8214 if (from_where == 0) {
8215 SCTP_STAT_INCR(sctps_lowlevelerrusr);
8216 }
8217 if (error == ENOBUFS) {
8218 asoc->ifp_had_enobuf = 1;
8219 SCTP_STAT_INCR(sctps_lowlevelerr);
8220 }
8221 /* error, could not output */
8222 if (error == EHOSTUNREACH) {
8223 /*
8224 * Destination went
8225 * unreachable
8226 * during this send
8227 */
8228 sctp_move_chunks_from_net(stcb, net);
8229 }
8230 *reason_code = 7;
8231 break;
8232 } else {
8233 asoc->ifp_had_enobuf = 0;
8234 }
8235 /*
8236 * increase the number we sent, if a
8237 * cookie is sent we don't tell them
8238 * any was sent out.
8239 */
8240 outchain = endoutchain = NULL;
8241 auth = NULL;
8242 auth_offset = 0;
8243 if (!no_out_cnt)
8244 *num_out += ctl_cnt;
8245 /* recalc a clean slate and setup */
8246 switch (net->ro._l_addr.sa.sa_family) {
8247 #ifdef INET
8248 case AF_INET:
8249 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8250 break;
8251 #endif
8252 #ifdef INET6
8253 case AF_INET6:
8254 mtu = net->mtu - SCTP_MIN_OVERHEAD;
8255 break;
8256 #endif
8257 default:
8258 /* TSNH */
8259 mtu = net->mtu;
8260 break;
8261 }
8262 to_out = 0;
8263 no_fragmentflg = 1;
8264 }
8265 }
8266 }
8267 if (error != 0) {
8268 /* try next net */
8269 continue;
8270 }
8271 /************************/
8272 /* Control transmission */
8273 /************************/
8274 /* Now first lets go through the control queue */
8275 TAILQ_FOREACH_SAFE(chk, &asoc->control_send_queue, sctp_next, nchk) {
8276 if ((sack_goes_to) &&
8277 (chk->rec.chunk_id.id == SCTP_ECN_ECHO) &&
8278 (chk->whoTo != sack_goes_to)) {
8279 /*
8280 * if we have a sack in queue, and we are
8281 * looking at an ecn echo that is NOT queued
8282 * to where the sack is going..
8283 */
8284 if (chk->whoTo == net) {
8285 /*
8286 * Don't transmit it to where its
8287 * going (current net)
8288 */
8289 continue;
8290 } else if (sack_goes_to == net) {
8291 /*
8292 * But do transmit it to this
8293 * address
8294 */
8295 goto skip_net_check;
8296 }
8297 }
8298 if (chk->whoTo == NULL) {
8299 if (asoc->alternate == NULL) {
8300 if (asoc->primary_destination != net) {
8301 continue;
8302 }
8303 } else {
8304 if (asoc->alternate != net) {
8305 continue;
8306 }
8307 }
8308 } else {
8309 if (chk->whoTo != net) {
8310 continue;
8311 }
8312 }
8313 skip_net_check:
8314 if (chk->data == NULL) {
8315 continue;
8316 }
8317 if (chk->sent != SCTP_DATAGRAM_UNSENT) {
8318 /*
8319 * It must be unsent. Cookies and ASCONF's
8320 * hang around but there timers will force
8321 * when marked for resend.
8322 */
8323 continue;
8324 }
8325 /*
8326 * if no AUTH is yet included and this chunk
8327 * requires it, make sure to account for it. We
8328 * don't apply the size until the AUTH chunk is
8329 * actually added below in case there is no room for
8330 * this chunk. NOTE: we overload the use of "omtu"
8331 * here
8332 */
8333 if ((auth == NULL) &&
8334 sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8335 stcb->asoc.peer_auth_chunks)) {
8336 omtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
8337 } else
8338 omtu = 0;
8339 /* Here we do NOT factor the r_mtu */
8340 if ((chk->send_size <= (int)(mtu - omtu)) ||
8341 (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) {
8342 /*
8343 * We probably should glom the mbuf chain
8344 * from the chk->data for control but the
8345 * problem is it becomes yet one more level
8346 * of tracking to do if for some reason
8347 * output fails. Then I have got to
8348 * reconstruct the merged control chain.. el
8349 * yucko.. for now we take the easy way and
8350 * do the copy
8351 */
8352 /*
8353 * Add an AUTH chunk, if chunk requires it
8354 * save the offset into the chain for AUTH
8355 */
8356 if ((auth == NULL) &&
8357 (sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8358 stcb->asoc.peer_auth_chunks))) {
8359 outchain = sctp_add_auth_chunk(outchain,
8360 &endoutchain,
8361 &auth,
8362 &auth_offset,
8363 stcb,
8364 chk->rec.chunk_id.id);
8365 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8366 }
8367 outchain = sctp_copy_mbufchain(chk->data, outchain, &endoutchain,
8368 (int)chk->rec.chunk_id.can_take_data,
8369 chk->send_size, chk->copy_by_ref);
8370 if (outchain == NULL) {
8371 *reason_code = 8;
8372 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
8373 return (ENOMEM);
8374 }
8375 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8376 /* update our MTU size */
8377 if (mtu > (chk->send_size + omtu))
8378 mtu -= (chk->send_size + omtu);
8379 else
8380 mtu = 0;
8381 to_out += (chk->send_size + omtu);
8382 /* Do clear IP_DF ? */
8383 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
8384 no_fragmentflg = 0;
8385 }
8386 if (chk->rec.chunk_id.can_take_data)
8387 chk->data = NULL;
8388 /* Mark things to be removed, if needed */
8389 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
8390 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK) || /* EY */
8391 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_REQUEST) ||
8392 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_ACK) ||
8393 (chk->rec.chunk_id.id == SCTP_SHUTDOWN) ||
8394 (chk->rec.chunk_id.id == SCTP_SHUTDOWN_ACK) ||
8395 (chk->rec.chunk_id.id == SCTP_OPERATION_ERROR) ||
8396 (chk->rec.chunk_id.id == SCTP_COOKIE_ACK) ||
8397 (chk->rec.chunk_id.id == SCTP_ECN_CWR) ||
8398 (chk->rec.chunk_id.id == SCTP_PACKET_DROPPED) ||
8399 (chk->rec.chunk_id.id == SCTP_ASCONF_ACK)) {
8400 if (chk->rec.chunk_id.id == SCTP_HEARTBEAT_REQUEST) {
8401 hbflag = 1;
8402 }
8403 /* remove these chunks at the end */
8404 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
8405 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK)) {
8406 /* turn off the timer */
8407 if (SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
8408 sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
8409 inp, stcb, net,
8410 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_1);
8411 }
8412 }
8413 ctl_cnt++;
8414 } else {
8415 /*
8416 * Other chunks, since they have
8417 * timers running (i.e. COOKIE) we
8418 * just "trust" that it gets sent or
8419 * retransmitted.
8420 */
8421 ctl_cnt++;
8422 if (chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) {
8423 cookie = 1;
8424 no_out_cnt = 1;
8425 } else if (chk->rec.chunk_id.id == SCTP_ECN_ECHO) {
8426 /*
8427 * Increment ecne send count
8428 * here this means we may be
8429 * over-zealous in our
8430 * counting if the send
8431 * fails, but its the best
8432 * place to do it (we used
8433 * to do it in the queue of
8434 * the chunk, but that did
8435 * not tell how many times
8436 * it was sent.
8437 */
8438 SCTP_STAT_INCR(sctps_sendecne);
8439 }
8440 chk->sent = SCTP_DATAGRAM_SENT;
8441 if (chk->whoTo == NULL) {
8442 chk->whoTo = net;
8443 atomic_add_int(&net->ref_count, 1);
8444 }
8445 chk->snd_count++;
8446 }
8447 if (mtu == 0) {
8448 /*
8449 * Ok we are out of room but we can
8450 * output without effecting the
8451 * flight size since this little guy
8452 * is a control only packet.
8453 */
8454 if (asconf) {
8455 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, net);
8456 /*
8457 * do NOT clear the asconf
8458 * flag as it is used to do
8459 * appropriate source
8460 * address selection.
8461 */
8462 }
8463 if (cookie) {
8464 sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, net);
8465 cookie = 0;
8466 }
8467 /* Only HB or ASCONF advances time */
8468 if (hbflag) {
8469 if (*now_filled == 0) {
8470 (void)SCTP_GETTIME_TIMEVAL(now);
8471 *now_filled = 1;
8472 }
8473 net->last_sent_time = *now;
8474 hbflag = 0;
8475 }
8476 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
8477 (struct sockaddr *)&net->ro._l_addr,
8478 outchain,
8479 auth_offset, auth,
8480 stcb->asoc.authinfo.active_keyid,
8481 no_fragmentflg, 0, asconf,
8482 inp->sctp_lport, stcb->rport,
8483 htonl(stcb->asoc.peer_vtag),
8484 net->port, NULL,
8485 0, 0,
8486 so_locked))) {
8487 /*
8488 * error, we could not
8489 * output
8490 */
8491 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
8492 if (from_where == 0) {
8493 SCTP_STAT_INCR(sctps_lowlevelerrusr);
8494 }
8495 if (error == ENOBUFS) {
8496 asoc->ifp_had_enobuf = 1;
8497 SCTP_STAT_INCR(sctps_lowlevelerr);
8498 }
8499 if (error == EHOSTUNREACH) {
8500 /*
8501 * Destination went
8502 * unreachable
8503 * during this send
8504 */
8505 sctp_move_chunks_from_net(stcb, net);
8506 }
8507 *reason_code = 7;
8508 break;
8509 } else {
8510 asoc->ifp_had_enobuf = 0;
8511 }
8512 /*
8513 * increase the number we sent, if a
8514 * cookie is sent we don't tell them
8515 * any was sent out.
8516 */
8517 outchain = endoutchain = NULL;
8518 auth = NULL;
8519 auth_offset = 0;
8520 if (!no_out_cnt)
8521 *num_out += ctl_cnt;
8522 /* recalc a clean slate and setup */
8523 switch (net->ro._l_addr.sa.sa_family) {
8524 #ifdef INET
8525 case AF_INET:
8526 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8527 break;
8528 #endif
8529 #ifdef INET6
8530 case AF_INET6:
8531 mtu = net->mtu - SCTP_MIN_OVERHEAD;
8532 break;
8533 #endif
8534 default:
8535 /* TSNH */
8536 mtu = net->mtu;
8537 break;
8538 }
8539 to_out = 0;
8540 no_fragmentflg = 1;
8541 }
8542 }
8543 }
8544 if (error != 0) {
8545 /* try next net */
8546 continue;
8547 }
8548 /* JRI: if dest is in PF state, do not send data to it */
8549 if ((asoc->sctp_cmt_on_off > 0) &&
8550 (net != stcb->asoc.alternate) &&
8551 (net->dest_state & SCTP_ADDR_PF)) {
8552 goto no_data_fill;
8553 }
8554 if (net->flight_size >= net->cwnd) {
8555 goto no_data_fill;
8556 }
8557 if ((asoc->sctp_cmt_on_off > 0) &&
8558 (SCTP_BASE_SYSCTL(sctp_buffer_splitting) & SCTP_RECV_BUFFER_SPLITTING) &&
8559 (net->flight_size > max_rwnd_per_dest)) {
8560 goto no_data_fill;
8561 }
8562 /*
8563 * We need a specific accounting for the usage of the send
8564 * buffer. We also need to check the number of messages per
8565 * net. For now, this is better than nothing and it disabled
8566 * by default...
8567 */
8568 if ((asoc->sctp_cmt_on_off > 0) &&
8569 (SCTP_BASE_SYSCTL(sctp_buffer_splitting) & SCTP_SEND_BUFFER_SPLITTING) &&
8570 (max_send_per_dest > 0) &&
8571 (net->flight_size > max_send_per_dest)) {
8572 goto no_data_fill;
8573 }
8574 /*********************/
8575 /* Data transmission */
8576 /*********************/
8577 /*
8578 * if AUTH for DATA is required and no AUTH has been added
8579 * yet, account for this in the mtu now... if no data can be
8580 * bundled, this adjustment won't matter anyways since the
8581 * packet will be going out...
8582 */
8583 data_auth_reqd = sctp_auth_is_required_chunk(SCTP_DATA,
8584 stcb->asoc.peer_auth_chunks);
8585 if (data_auth_reqd && (auth == NULL)) {
8586 mtu -= sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
8587 }
8588 /* now lets add any data within the MTU constraints */
8589 switch (((struct sockaddr *)&net->ro._l_addr)->sa_family) {
8590 #ifdef INET
8591 case AF_INET:
8592 if (net->mtu > SCTP_MIN_V4_OVERHEAD)
8593 omtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8594 else
8595 omtu = 0;
8596 break;
8597 #endif
8598 #ifdef INET6
8599 case AF_INET6:
8600 if (net->mtu > SCTP_MIN_OVERHEAD)
8601 omtu = net->mtu - SCTP_MIN_OVERHEAD;
8602 else
8603 omtu = 0;
8604 break;
8605 #endif
8606 default:
8607 /* TSNH */
8608 omtu = 0;
8609 break;
8610 }
8611 if ((((SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) ||
8612 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED)) &&
8613 (skip_data_for_this_net == 0)) ||
8614 (cookie)) {
8615 TAILQ_FOREACH_SAFE(chk, &asoc->send_queue, sctp_next, nchk) {
8616 if (no_data_chunks) {
8617 /* let only control go out */
8618 *reason_code = 1;
8619 break;
8620 }
8621 if (net->flight_size >= net->cwnd) {
8622 /* skip this net, no room for data */
8623 *reason_code = 2;
8624 break;
8625 }
8626 if ((chk->whoTo != NULL) &&
8627 (chk->whoTo != net)) {
8628 /* Don't send the chunk on this net */
8629 continue;
8630 }
8631
8632 if (asoc->sctp_cmt_on_off == 0) {
8633 if ((asoc->alternate) &&
8634 (asoc->alternate != net) &&
8635 (chk->whoTo == NULL)) {
8636 continue;
8637 } else if ((net != asoc->primary_destination) &&
8638 (asoc->alternate == NULL) &&
8639 (chk->whoTo == NULL)) {
8640 continue;
8641 }
8642 }
8643 if ((chk->send_size > omtu) && ((chk->flags & CHUNK_FLAGS_FRAGMENT_OK) == 0)) {
8644 /*-
8645 * strange, we have a chunk that is
8646 * to big for its destination and
8647 * yet no fragment ok flag.
8648 * Something went wrong when the
8649 * PMTU changed...we did not mark
8650 * this chunk for some reason?? I
8651 * will fix it here by letting IP
8652 * fragment it for now and printing
8653 * a warning. This really should not
8654 * happen ...
8655 */
8656 SCTP_PRINTF("Warning chunk of %d bytes > mtu:%d and yet PMTU disc missed\n",
8657 chk->send_size, mtu);
8658 chk->flags |= CHUNK_FLAGS_FRAGMENT_OK;
8659 }
8660 if (SCTP_BASE_SYSCTL(sctp_enable_sack_immediately) &&
8661 (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) {
8662 struct sctp_data_chunk *dchkh;
8663
8664 dchkh = mtod(chk->data, struct sctp_data_chunk *);
8665 dchkh->ch.chunk_flags |= SCTP_DATA_SACK_IMMEDIATELY;
8666 }
8667 if (((chk->send_size <= mtu) && (chk->send_size <= r_mtu)) ||
8668 ((chk->flags & CHUNK_FLAGS_FRAGMENT_OK) && (chk->send_size <= asoc->peers_rwnd))) {
8669 /* ok we will add this one */
8670
8671 /*
8672 * Add an AUTH chunk, if chunk
8673 * requires it, save the offset into
8674 * the chain for AUTH
8675 */
8676 if (data_auth_reqd) {
8677 if (auth == NULL) {
8678 outchain = sctp_add_auth_chunk(outchain,
8679 &endoutchain,
8680 &auth,
8681 &auth_offset,
8682 stcb,
8683 SCTP_DATA);
8684 auth_keyid = chk->auth_keyid;
8685 override_ok = 0;
8686 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8687 } else if (override_ok) {
8688 /*
8689 * use this data's
8690 * keyid
8691 */
8692 auth_keyid = chk->auth_keyid;
8693 override_ok = 0;
8694 } else if (auth_keyid != chk->auth_keyid) {
8695 /*
8696 * different keyid,
8697 * so done bundling
8698 */
8699 break;
8700 }
8701 }
8702 outchain = sctp_copy_mbufchain(chk->data, outchain, &endoutchain, 0,
8703 chk->send_size, chk->copy_by_ref);
8704 if (outchain == NULL) {
8705 SCTPDBG(SCTP_DEBUG_OUTPUT3, "No memory?\n");
8706 if (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
8707 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
8708 }
8709 *reason_code = 3;
8710 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
8711 return (ENOMEM);
8712 }
8713 /* upate our MTU size */
8714 /* Do clear IP_DF ? */
8715 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
8716 no_fragmentflg = 0;
8717 }
8718 /* unsigned subtraction of mtu */
8719 if (mtu > chk->send_size)
8720 mtu -= chk->send_size;
8721 else
8722 mtu = 0;
8723 /* unsigned subtraction of r_mtu */
8724 if (r_mtu > chk->send_size)
8725 r_mtu -= chk->send_size;
8726 else
8727 r_mtu = 0;
8728
8729 to_out += chk->send_size;
8730 if ((to_out > mx_mtu) && no_fragmentflg) {
8731 #ifdef INVARIANTS
8732 panic("Exceeding mtu of %d out size is %d", mx_mtu, to_out);
8733 #else
8734 SCTP_PRINTF("Exceeding mtu of %d out size is %d\n",
8735 mx_mtu, to_out);
8736 #endif
8737 }
8738 chk->window_probe = 0;
8739 data_list[bundle_at++] = chk;
8740 if (bundle_at >= SCTP_MAX_DATA_BUNDLING) {
8741 break;
8742 }
8743 if (chk->sent == SCTP_DATAGRAM_UNSENT) {
8744 if ((chk->rec.data.rcv_flags & SCTP_DATA_UNORDERED) == 0) {
8745 SCTP_STAT_INCR_COUNTER64(sctps_outorderchunks);
8746 } else {
8747 SCTP_STAT_INCR_COUNTER64(sctps_outunorderchunks);
8748 }
8749 if (((chk->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG) == SCTP_DATA_LAST_FRAG) &&
8750 ((chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) == 0))
8751 /*
8752 * Count number of
8753 * user msg's that
8754 * were fragmented
8755 * we do this by
8756 * counting when we
8757 * see a LAST
8758 * fragment only.
8759 */
8760 SCTP_STAT_INCR_COUNTER64(sctps_fragusrmsgs);
8761 }
8762 if ((mtu == 0) || (r_mtu == 0) || (one_chunk)) {
8763 if ((one_chunk) && (stcb->asoc.total_flight == 0)) {
8764 data_list[0]->window_probe = 1;
8765 net->window_probe = 1;
8766 }
8767 break;
8768 }
8769 } else {
8770 /*
8771 * Must be sent in order of the
8772 * TSN's (on a network)
8773 */
8774 break;
8775 }
8776 } /* for (chunk gather loop for this net) */
8777 } /* if asoc.state OPEN */
8778 no_data_fill:
8779 /* Is there something to send for this destination? */
8780 if (outchain) {
8781 /* We may need to start a control timer or two */
8782 if (asconf) {
8783 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp,
8784 stcb, net);
8785 /*
8786 * do NOT clear the asconf flag as it is
8787 * used to do appropriate source address
8788 * selection.
8789 */
8790 }
8791 if (cookie) {
8792 sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, net);
8793 cookie = 0;
8794 }
8795 /* must start a send timer if data is being sent */
8796 if (bundle_at && (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer))) {
8797 /*
8798 * no timer running on this destination
8799 * restart it.
8800 */
8801 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
8802 }
8803 if (bundle_at || hbflag) {
8804 /* For data/asconf and hb set time */
8805 if (*now_filled == 0) {
8806 (void)SCTP_GETTIME_TIMEVAL(now);
8807 *now_filled = 1;
8808 }
8809 net->last_sent_time = *now;
8810 }
8811 /* Now send it, if there is anything to send :> */
8812 if ((error = sctp_lowlevel_chunk_output(inp,
8813 stcb,
8814 net,
8815 (struct sockaddr *)&net->ro._l_addr,
8816 outchain,
8817 auth_offset,
8818 auth,
8819 auth_keyid,
8820 no_fragmentflg,
8821 bundle_at,
8822 asconf,
8823 inp->sctp_lport, stcb->rport,
8824 htonl(stcb->asoc.peer_vtag),
8825 net->port, NULL,
8826 0, 0,
8827 so_locked))) {
8828 /* error, we could not output */
8829 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
8830 if (from_where == 0) {
8831 SCTP_STAT_INCR(sctps_lowlevelerrusr);
8832 }
8833 if (error == ENOBUFS) {
8834 asoc->ifp_had_enobuf = 1;
8835 SCTP_STAT_INCR(sctps_lowlevelerr);
8836 }
8837 if (error == EHOSTUNREACH) {
8838 /*
8839 * Destination went unreachable
8840 * during this send
8841 */
8842 sctp_move_chunks_from_net(stcb, net);
8843 }
8844 *reason_code = 6;
8845 /*-
8846 * I add this line to be paranoid. As far as
8847 * I can tell the continue, takes us back to
8848 * the top of the for, but just to make sure
8849 * I will reset these again here.
8850 */
8851 ctl_cnt = bundle_at = 0;
8852 continue; /* This takes us back to the
8853 * for() for the nets. */
8854 } else {
8855 asoc->ifp_had_enobuf = 0;
8856 }
8857 endoutchain = NULL;
8858 auth = NULL;
8859 auth_offset = 0;
8860 if (!no_out_cnt) {
8861 *num_out += (ctl_cnt + bundle_at);
8862 }
8863 if (bundle_at) {
8864 /* setup for a RTO measurement */
8865 tsns_sent = data_list[0]->rec.data.tsn;
8866 /* fill time if not already filled */
8867 if (*now_filled == 0) {
8868 (void)SCTP_GETTIME_TIMEVAL(&asoc->time_last_sent);
8869 *now_filled = 1;
8870 *now = asoc->time_last_sent;
8871 } else {
8872 asoc->time_last_sent = *now;
8873 }
8874 if (net->rto_needed) {
8875 data_list[0]->do_rtt = 1;
8876 net->rto_needed = 0;
8877 }
8878 SCTP_STAT_INCR_BY(sctps_senddata, bundle_at);
8879 sctp_clean_up_datalist(stcb, asoc, data_list, bundle_at, net);
8880 }
8881 if (one_chunk) {
8882 break;
8883 }
8884 }
8885 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
8886 sctp_log_cwnd(stcb, net, tsns_sent, SCTP_CWND_LOG_FROM_SEND);
8887 }
8888 }
8889 if (old_start_at == NULL) {
8890 old_start_at = start_at;
8891 start_at = TAILQ_FIRST(&asoc->nets);
8892 if (old_start_at)
8893 goto again_one_more_time;
8894 }
8895
8896 /*
8897 * At the end there should be no NON timed chunks hanging on this
8898 * queue.
8899 */
8900 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
8901 sctp_log_cwnd(stcb, net, *num_out, SCTP_CWND_LOG_FROM_SEND);
8902 }
8903 if ((*num_out == 0) && (*reason_code == 0)) {
8904 *reason_code = 4;
8905 } else {
8906 *reason_code = 5;
8907 }
8908 sctp_clean_up_ctl(stcb, asoc, so_locked);
8909 return (0);
8910 }
8911
8912 void
8913 sctp_queue_op_err(struct sctp_tcb *stcb, struct mbuf *op_err)
8914 {
8915 /*-
8916 * Prepend a OPERATIONAL_ERROR chunk header and put on the end of
8917 * the control chunk queue.
8918 */
8919 struct sctp_chunkhdr *hdr;
8920 struct sctp_tmit_chunk *chk;
8921 struct mbuf *mat, *last_mbuf;
8922 uint32_t chunk_length;
8923 uint16_t padding_length;
8924
8925 SCTP_TCB_LOCK_ASSERT(stcb);
8926 SCTP_BUF_PREPEND(op_err, sizeof(struct sctp_chunkhdr), M_NOWAIT);
8927 if (op_err == NULL) {
8928 return;
8929 }
8930 last_mbuf = NULL;
8931 chunk_length = 0;
8932 for (mat = op_err; mat != NULL; mat = SCTP_BUF_NEXT(mat)) {
8933 chunk_length += SCTP_BUF_LEN(mat);
8934 if (SCTP_BUF_NEXT(mat) == NULL) {
8935 last_mbuf = mat;
8936 }
8937 }
8938 if (chunk_length > SCTP_MAX_CHUNK_LENGTH) {
8939 sctp_m_freem(op_err);
8940 return;
8941 }
8942 padding_length = chunk_length % 4;
8943 if (padding_length != 0) {
8944 padding_length = 4 - padding_length;
8945 }
8946 if (padding_length != 0) {
8947 if (sctp_add_pad_tombuf(last_mbuf, padding_length) == NULL) {
8948 sctp_m_freem(op_err);
8949 return;
8950 }
8951 }
8952 sctp_alloc_a_chunk(stcb, chk);
8953 if (chk == NULL) {
8954 /* no memory */
8955 sctp_m_freem(op_err);
8956 return;
8957 }
8958 chk->copy_by_ref = 0;
8959 chk->rec.chunk_id.id = SCTP_OPERATION_ERROR;
8960 chk->rec.chunk_id.can_take_data = 0;
8961 chk->flags = 0;
8962 chk->send_size = (uint16_t)chunk_length;
8963 chk->sent = SCTP_DATAGRAM_UNSENT;
8964 chk->snd_count = 0;
8965 chk->asoc = &stcb->asoc;
8966 chk->data = op_err;
8967 chk->whoTo = NULL;
8968 hdr = mtod(op_err, struct sctp_chunkhdr *);
8969 hdr->chunk_type = SCTP_OPERATION_ERROR;
8970 hdr->chunk_flags = 0;
8971 hdr->chunk_length = htons(chk->send_size);
8972 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
8973 chk->asoc->ctrl_queue_cnt++;
8974 }
8975
8976 int
8977 sctp_send_cookie_echo(struct mbuf *m,
8978 int offset,
8979 struct sctp_tcb *stcb,
8980 struct sctp_nets *net)
8981 {
8982 /*-
8983 * pull out the cookie and put it at the front of the control chunk
8984 * queue.
8985 */
8986 int at;
8987 struct mbuf *cookie;
8988 struct sctp_paramhdr param, *phdr;
8989 struct sctp_chunkhdr *hdr;
8990 struct sctp_tmit_chunk *chk;
8991 uint16_t ptype, plen;
8992
8993 SCTP_TCB_LOCK_ASSERT(stcb);
8994 /* First find the cookie in the param area */
8995 cookie = NULL;
8996 at = offset + sizeof(struct sctp_init_chunk);
8997 for (;;) {
8998 phdr = sctp_get_next_param(m, at, ¶m, sizeof(param));
8999 if (phdr == NULL) {
9000 return (-3);
9001 }
9002 ptype = ntohs(phdr->param_type);
9003 plen = ntohs(phdr->param_length);
9004 if (ptype == SCTP_STATE_COOKIE) {
9005 int pad;
9006
9007 /* found the cookie */
9008 if ((pad = (plen % 4))) {
9009 plen += 4 - pad;
9010 }
9011 cookie = SCTP_M_COPYM(m, at, plen, M_NOWAIT);
9012 if (cookie == NULL) {
9013 /* No memory */
9014 return (-2);
9015 }
9016 #ifdef SCTP_MBUF_LOGGING
9017 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
9018 sctp_log_mbc(cookie, SCTP_MBUF_ICOPY);
9019 }
9020 #endif
9021 break;
9022 }
9023 at += SCTP_SIZE32(plen);
9024 }
9025 /* ok, we got the cookie lets change it into a cookie echo chunk */
9026 /* first the change from param to cookie */
9027 hdr = mtod(cookie, struct sctp_chunkhdr *);
9028 hdr->chunk_type = SCTP_COOKIE_ECHO;
9029 hdr->chunk_flags = 0;
9030 /* get the chunk stuff now and place it in the FRONT of the queue */
9031 sctp_alloc_a_chunk(stcb, chk);
9032 if (chk == NULL) {
9033 /* no memory */
9034 sctp_m_freem(cookie);
9035 return (-5);
9036 }
9037 chk->copy_by_ref = 0;
9038 chk->rec.chunk_id.id = SCTP_COOKIE_ECHO;
9039 chk->rec.chunk_id.can_take_data = 0;
9040 chk->flags = CHUNK_FLAGS_FRAGMENT_OK;
9041 chk->send_size = plen;
9042 chk->sent = SCTP_DATAGRAM_UNSENT;
9043 chk->snd_count = 0;
9044 chk->asoc = &stcb->asoc;
9045 chk->data = cookie;
9046 chk->whoTo = net;
9047 atomic_add_int(&chk->whoTo->ref_count, 1);
9048 TAILQ_INSERT_HEAD(&chk->asoc->control_send_queue, chk, sctp_next);
9049 chk->asoc->ctrl_queue_cnt++;
9050 return (0);
9051 }
9052
9053 void
9054 sctp_send_heartbeat_ack(struct sctp_tcb *stcb,
9055 struct mbuf *m,
9056 int offset,
9057 int chk_length,
9058 struct sctp_nets *net)
9059 {
9060 /*
9061 * take a HB request and make it into a HB ack and send it.
9062 */
9063 struct mbuf *outchain;
9064 struct sctp_chunkhdr *chdr;
9065 struct sctp_tmit_chunk *chk;
9066
9067
9068 if (net == NULL)
9069 /* must have a net pointer */
9070 return;
9071
9072 outchain = SCTP_M_COPYM(m, offset, chk_length, M_NOWAIT);
9073 if (outchain == NULL) {
9074 /* gak out of memory */
9075 return;
9076 }
9077 #ifdef SCTP_MBUF_LOGGING
9078 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
9079 sctp_log_mbc(outchain, SCTP_MBUF_ICOPY);
9080 }
9081 #endif
9082 chdr = mtod(outchain, struct sctp_chunkhdr *);
9083 chdr->chunk_type = SCTP_HEARTBEAT_ACK;
9084 chdr->chunk_flags = 0;
9085 if (chk_length % 4) {
9086 /* need pad */
9087 uint32_t cpthis = 0;
9088 int padlen;
9089
9090 padlen = 4 - (chk_length % 4);
9091 m_copyback(outchain, chk_length, padlen, (caddr_t)&cpthis);
9092 }
9093 sctp_alloc_a_chunk(stcb, chk);
9094 if (chk == NULL) {
9095 /* no memory */
9096 sctp_m_freem(outchain);
9097 return;
9098 }
9099 chk->copy_by_ref = 0;
9100 chk->rec.chunk_id.id = SCTP_HEARTBEAT_ACK;
9101 chk->rec.chunk_id.can_take_data = 1;
9102 chk->flags = 0;
9103 chk->send_size = chk_length;
9104 chk->sent = SCTP_DATAGRAM_UNSENT;
9105 chk->snd_count = 0;
9106 chk->asoc = &stcb->asoc;
9107 chk->data = outchain;
9108 chk->whoTo = net;
9109 atomic_add_int(&chk->whoTo->ref_count, 1);
9110 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9111 chk->asoc->ctrl_queue_cnt++;
9112 }
9113
9114 void
9115 sctp_send_cookie_ack(struct sctp_tcb *stcb)
9116 {
9117 /* formulate and queue a cookie-ack back to sender */
9118 struct mbuf *cookie_ack;
9119 struct sctp_chunkhdr *hdr;
9120 struct sctp_tmit_chunk *chk;
9121
9122 SCTP_TCB_LOCK_ASSERT(stcb);
9123
9124 cookie_ack = sctp_get_mbuf_for_msg(sizeof(struct sctp_chunkhdr), 0, M_NOWAIT, 1, MT_HEADER);
9125 if (cookie_ack == NULL) {
9126 /* no mbuf's */
9127 return;
9128 }
9129 SCTP_BUF_RESV_UF(cookie_ack, SCTP_MIN_OVERHEAD);
9130 sctp_alloc_a_chunk(stcb, chk);
9131 if (chk == NULL) {
9132 /* no memory */
9133 sctp_m_freem(cookie_ack);
9134 return;
9135 }
9136 chk->copy_by_ref = 0;
9137 chk->rec.chunk_id.id = SCTP_COOKIE_ACK;
9138 chk->rec.chunk_id.can_take_data = 1;
9139 chk->flags = 0;
9140 chk->send_size = sizeof(struct sctp_chunkhdr);
9141 chk->sent = SCTP_DATAGRAM_UNSENT;
9142 chk->snd_count = 0;
9143 chk->asoc = &stcb->asoc;
9144 chk->data = cookie_ack;
9145 if (chk->asoc->last_control_chunk_from != NULL) {
9146 chk->whoTo = chk->asoc->last_control_chunk_from;
9147 atomic_add_int(&chk->whoTo->ref_count, 1);
9148 } else {
9149 chk->whoTo = NULL;
9150 }
9151 hdr = mtod(cookie_ack, struct sctp_chunkhdr *);
9152 hdr->chunk_type = SCTP_COOKIE_ACK;
9153 hdr->chunk_flags = 0;
9154 hdr->chunk_length = htons(chk->send_size);
9155 SCTP_BUF_LEN(cookie_ack) = chk->send_size;
9156 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9157 chk->asoc->ctrl_queue_cnt++;
9158 return;
9159 }
9160
9161
9162 void
9163 sctp_send_shutdown_ack(struct sctp_tcb *stcb, struct sctp_nets *net)
9164 {
9165 /* formulate and queue a SHUTDOWN-ACK back to the sender */
9166 struct mbuf *m_shutdown_ack;
9167 struct sctp_shutdown_ack_chunk *ack_cp;
9168 struct sctp_tmit_chunk *chk;
9169
9170 m_shutdown_ack = sctp_get_mbuf_for_msg(sizeof(struct sctp_shutdown_ack_chunk), 0, M_NOWAIT, 1, MT_HEADER);
9171 if (m_shutdown_ack == NULL) {
9172 /* no mbuf's */
9173 return;
9174 }
9175 SCTP_BUF_RESV_UF(m_shutdown_ack, SCTP_MIN_OVERHEAD);
9176 sctp_alloc_a_chunk(stcb, chk);
9177 if (chk == NULL) {
9178 /* no memory */
9179 sctp_m_freem(m_shutdown_ack);
9180 return;
9181 }
9182 chk->copy_by_ref = 0;
9183 chk->rec.chunk_id.id = SCTP_SHUTDOWN_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 = m_shutdown_ack;
9191 chk->whoTo = net;
9192 if (chk->whoTo) {
9193 atomic_add_int(&chk->whoTo->ref_count, 1);
9194 }
9195 ack_cp = mtod(m_shutdown_ack, struct sctp_shutdown_ack_chunk *);
9196 ack_cp->ch.chunk_type = SCTP_SHUTDOWN_ACK;
9197 ack_cp->ch.chunk_flags = 0;
9198 ack_cp->ch.chunk_length = htons(chk->send_size);
9199 SCTP_BUF_LEN(m_shutdown_ack) = chk->send_size;
9200 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9201 chk->asoc->ctrl_queue_cnt++;
9202 return;
9203 }
9204
9205 void
9206 sctp_send_shutdown(struct sctp_tcb *stcb, struct sctp_nets *net)
9207 {
9208 /* formulate and queue a SHUTDOWN to the sender */
9209 struct mbuf *m_shutdown;
9210 struct sctp_shutdown_chunk *shutdown_cp;
9211 struct sctp_tmit_chunk *chk;
9212
9213 TAILQ_FOREACH(chk, &stcb->asoc.control_send_queue, sctp_next) {
9214 if (chk->rec.chunk_id.id == SCTP_SHUTDOWN) {
9215 /* We already have a SHUTDOWN queued. Reuse it. */
9216 if (chk->whoTo) {
9217 sctp_free_remote_addr(chk->whoTo);
9218 chk->whoTo = NULL;
9219 }
9220 break;
9221 }
9222 }
9223 if (chk == NULL) {
9224 m_shutdown = sctp_get_mbuf_for_msg(sizeof(struct sctp_shutdown_chunk), 0, M_NOWAIT, 1, MT_HEADER);
9225 if (m_shutdown == NULL) {
9226 /* no mbuf's */
9227 return;
9228 }
9229 SCTP_BUF_RESV_UF(m_shutdown, SCTP_MIN_OVERHEAD);
9230 sctp_alloc_a_chunk(stcb, chk);
9231 if (chk == NULL) {
9232 /* no memory */
9233 sctp_m_freem(m_shutdown);
9234 return;
9235 }
9236 chk->copy_by_ref = 0;
9237 chk->rec.chunk_id.id = SCTP_SHUTDOWN;
9238 chk->rec.chunk_id.can_take_data = 1;
9239 chk->flags = 0;
9240 chk->send_size = sizeof(struct sctp_shutdown_chunk);
9241 chk->sent = SCTP_DATAGRAM_UNSENT;
9242 chk->snd_count = 0;
9243 chk->asoc = &stcb->asoc;
9244 chk->data = m_shutdown;
9245 chk->whoTo = net;
9246 if (chk->whoTo) {
9247 atomic_add_int(&chk->whoTo->ref_count, 1);
9248 }
9249 shutdown_cp = mtod(m_shutdown, struct sctp_shutdown_chunk *);
9250 shutdown_cp->ch.chunk_type = SCTP_SHUTDOWN;
9251 shutdown_cp->ch.chunk_flags = 0;
9252 shutdown_cp->ch.chunk_length = htons(chk->send_size);
9253 shutdown_cp->cumulative_tsn_ack = htonl(stcb->asoc.cumulative_tsn);
9254 SCTP_BUF_LEN(m_shutdown) = chk->send_size;
9255 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9256 chk->asoc->ctrl_queue_cnt++;
9257 } else {
9258 TAILQ_REMOVE(&stcb->asoc.control_send_queue, chk, sctp_next);
9259 chk->whoTo = net;
9260 if (chk->whoTo) {
9261 atomic_add_int(&chk->whoTo->ref_count, 1);
9262 }
9263 shutdown_cp = mtod(chk->data, struct sctp_shutdown_chunk *);
9264 shutdown_cp->cumulative_tsn_ack = htonl(stcb->asoc.cumulative_tsn);
9265 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
9266 }
9267 return;
9268 }
9269
9270 void
9271 sctp_send_asconf(struct sctp_tcb *stcb, struct sctp_nets *net, int addr_locked)
9272 {
9273 /*
9274 * formulate and queue an ASCONF to the peer. ASCONF parameters
9275 * should be queued on the assoc queue.
9276 */
9277 struct sctp_tmit_chunk *chk;
9278 struct mbuf *m_asconf;
9279 int len;
9280
9281 SCTP_TCB_LOCK_ASSERT(stcb);
9282
9283 if ((!TAILQ_EMPTY(&stcb->asoc.asconf_send_queue)) &&
9284 (!sctp_is_feature_on(stcb->sctp_ep, SCTP_PCB_FLAGS_MULTIPLE_ASCONFS))) {
9285 /* can't send a new one if there is one in flight already */
9286 return;
9287 }
9288
9289 /* compose an ASCONF chunk, maximum length is PMTU */
9290 m_asconf = sctp_compose_asconf(stcb, &len, addr_locked);
9291 if (m_asconf == NULL) {
9292 return;
9293 }
9294
9295 sctp_alloc_a_chunk(stcb, chk);
9296 if (chk == NULL) {
9297 /* no memory */
9298 sctp_m_freem(m_asconf);
9299 return;
9300 }
9301
9302 chk->copy_by_ref = 0;
9303 chk->rec.chunk_id.id = SCTP_ASCONF;
9304 chk->rec.chunk_id.can_take_data = 0;
9305 chk->flags = CHUNK_FLAGS_FRAGMENT_OK;
9306 chk->data = m_asconf;
9307 chk->send_size = len;
9308 chk->sent = SCTP_DATAGRAM_UNSENT;
9309 chk->snd_count = 0;
9310 chk->asoc = &stcb->asoc;
9311 chk->whoTo = net;
9312 if (chk->whoTo) {
9313 atomic_add_int(&chk->whoTo->ref_count, 1);
9314 }
9315 TAILQ_INSERT_TAIL(&chk->asoc->asconf_send_queue, chk, sctp_next);
9316 chk->asoc->ctrl_queue_cnt++;
9317 return;
9318 }
9319
9320 void
9321 sctp_send_asconf_ack(struct sctp_tcb *stcb)
9322 {
9323 /*
9324 * formulate and queue a asconf-ack back to sender. the asconf-ack
9325 * must be stored in the tcb.
9326 */
9327 struct sctp_tmit_chunk *chk;
9328 struct sctp_asconf_ack *ack, *latest_ack;
9329 struct mbuf *m_ack;
9330 struct sctp_nets *net = NULL;
9331
9332 SCTP_TCB_LOCK_ASSERT(stcb);
9333 /* Get the latest ASCONF-ACK */
9334 latest_ack = TAILQ_LAST(&stcb->asoc.asconf_ack_sent, sctp_asconf_ackhead);
9335 if (latest_ack == NULL) {
9336 return;
9337 }
9338 if (latest_ack->last_sent_to != NULL &&
9339 latest_ack->last_sent_to == stcb->asoc.last_control_chunk_from) {
9340 /* we're doing a retransmission */
9341 net = sctp_find_alternate_net(stcb, stcb->asoc.last_control_chunk_from, 0);
9342 if (net == NULL) {
9343 /* no alternate */
9344 if (stcb->asoc.last_control_chunk_from == NULL) {
9345 if (stcb->asoc.alternate) {
9346 net = stcb->asoc.alternate;
9347 } else {
9348 net = stcb->asoc.primary_destination;
9349 }
9350 } else {
9351 net = stcb->asoc.last_control_chunk_from;
9352 }
9353 }
9354 } else {
9355 /* normal case */
9356 if (stcb->asoc.last_control_chunk_from == NULL) {
9357 if (stcb->asoc.alternate) {
9358 net = stcb->asoc.alternate;
9359 } else {
9360 net = stcb->asoc.primary_destination;
9361 }
9362 } else {
9363 net = stcb->asoc.last_control_chunk_from;
9364 }
9365 }
9366 latest_ack->last_sent_to = net;
9367
9368 TAILQ_FOREACH(ack, &stcb->asoc.asconf_ack_sent, next) {
9369 if (ack->data == NULL) {
9370 continue;
9371 }
9372
9373 /* copy the asconf_ack */
9374 m_ack = SCTP_M_COPYM(ack->data, 0, M_COPYALL, M_NOWAIT);
9375 if (m_ack == NULL) {
9376 /* couldn't copy it */
9377 return;
9378 }
9379 #ifdef SCTP_MBUF_LOGGING
9380 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
9381 sctp_log_mbc(m_ack, SCTP_MBUF_ICOPY);
9382 }
9383 #endif
9384
9385 sctp_alloc_a_chunk(stcb, chk);
9386 if (chk == NULL) {
9387 /* no memory */
9388 if (m_ack)
9389 sctp_m_freem(m_ack);
9390 return;
9391 }
9392 chk->copy_by_ref = 0;
9393 chk->rec.chunk_id.id = SCTP_ASCONF_ACK;
9394 chk->rec.chunk_id.can_take_data = 1;
9395 chk->flags = CHUNK_FLAGS_FRAGMENT_OK;
9396 chk->whoTo = net;
9397 if (chk->whoTo) {
9398 atomic_add_int(&chk->whoTo->ref_count, 1);
9399 }
9400 chk->data = m_ack;
9401 chk->send_size = ack->len;
9402 chk->sent = SCTP_DATAGRAM_UNSENT;
9403 chk->snd_count = 0;
9404 chk->asoc = &stcb->asoc;
9405
9406 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9407 chk->asoc->ctrl_queue_cnt++;
9408 }
9409 return;
9410 }
9411
9412
9413 static int
9414 sctp_chunk_retransmission(struct sctp_inpcb *inp,
9415 struct sctp_tcb *stcb,
9416 struct sctp_association *asoc,
9417 int *cnt_out, struct timeval *now, int *now_filled, int *fr_done, int so_locked
9418 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
9419 SCTP_UNUSED
9420 #endif
9421 )
9422 {
9423 /*-
9424 * send out one MTU of retransmission. If fast_retransmit is
9425 * happening we ignore the cwnd. Otherwise we obey the cwnd and
9426 * rwnd. For a Cookie or Asconf in the control chunk queue we
9427 * retransmit them by themselves.
9428 *
9429 * For data chunks we will pick out the lowest TSN's in the sent_queue
9430 * marked for resend and bundle them all together (up to a MTU of
9431 * destination). The address to send to should have been
9432 * selected/changed where the retransmission was marked (i.e. in FR
9433 * or t3-timeout routines).
9434 */
9435 struct sctp_tmit_chunk *data_list[SCTP_MAX_DATA_BUNDLING];
9436 struct sctp_tmit_chunk *chk, *fwd;
9437 struct mbuf *m, *endofchain;
9438 struct sctp_nets *net = NULL;
9439 uint32_t tsns_sent = 0;
9440 int no_fragmentflg, bundle_at, cnt_thru;
9441 unsigned int mtu;
9442 int error, i, one_chunk, fwd_tsn, ctl_cnt, tmr_started;
9443 struct sctp_auth_chunk *auth = NULL;
9444 uint32_t auth_offset = 0;
9445 uint16_t auth_keyid;
9446 int override_ok = 1;
9447 int data_auth_reqd = 0;
9448 uint32_t dmtu = 0;
9449
9450 SCTP_TCB_LOCK_ASSERT(stcb);
9451 tmr_started = ctl_cnt = bundle_at = error = 0;
9452 no_fragmentflg = 1;
9453 fwd_tsn = 0;
9454 *cnt_out = 0;
9455 fwd = NULL;
9456 endofchain = m = NULL;
9457 auth_keyid = stcb->asoc.authinfo.active_keyid;
9458 #ifdef SCTP_AUDITING_ENABLED
9459 sctp_audit_log(0xC3, 1);
9460 #endif
9461 if ((TAILQ_EMPTY(&asoc->sent_queue)) &&
9462 (TAILQ_EMPTY(&asoc->control_send_queue))) {
9463 SCTPDBG(SCTP_DEBUG_OUTPUT1, "SCTP hits empty queue with cnt set to %d?\n",
9464 asoc->sent_queue_retran_cnt);
9465 asoc->sent_queue_cnt = 0;
9466 asoc->sent_queue_cnt_removeable = 0;
9467 /* send back 0/0 so we enter normal transmission */
9468 *cnt_out = 0;
9469 return (0);
9470 }
9471 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
9472 if ((chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) ||
9473 (chk->rec.chunk_id.id == SCTP_STREAM_RESET) ||
9474 (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN)) {
9475 if (chk->sent != SCTP_DATAGRAM_RESEND) {
9476 continue;
9477 }
9478 if (chk->rec.chunk_id.id == SCTP_STREAM_RESET) {
9479 if (chk != asoc->str_reset) {
9480 /*
9481 * not eligible for retran if its
9482 * not ours
9483 */
9484 continue;
9485 }
9486 }
9487 ctl_cnt++;
9488 if (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) {
9489 fwd_tsn = 1;
9490 }
9491 /*
9492 * Add an AUTH chunk, if chunk requires it save the
9493 * offset into the chain for AUTH
9494 */
9495 if ((auth == NULL) &&
9496 (sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
9497 stcb->asoc.peer_auth_chunks))) {
9498 m = sctp_add_auth_chunk(m, &endofchain,
9499 &auth, &auth_offset,
9500 stcb,
9501 chk->rec.chunk_id.id);
9502 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
9503 }
9504 m = sctp_copy_mbufchain(chk->data, m, &endofchain, 0, chk->send_size, chk->copy_by_ref);
9505 break;
9506 }
9507 }
9508 one_chunk = 0;
9509 cnt_thru = 0;
9510 /* do we have control chunks to retransmit? */
9511 if (m != NULL) {
9512 /* Start a timer no matter if we succeed or fail */
9513 if (chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) {
9514 sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, chk->whoTo);
9515 } else if (chk->rec.chunk_id.id == SCTP_ASCONF)
9516 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, chk->whoTo);
9517 chk->snd_count++; /* update our count */
9518 if ((error = sctp_lowlevel_chunk_output(inp, stcb, chk->whoTo,
9519 (struct sockaddr *)&chk->whoTo->ro._l_addr, m,
9520 auth_offset, auth, stcb->asoc.authinfo.active_keyid,
9521 no_fragmentflg, 0, 0,
9522 inp->sctp_lport, stcb->rport, htonl(stcb->asoc.peer_vtag),
9523 chk->whoTo->port, NULL,
9524 0, 0,
9525 so_locked))) {
9526 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
9527 if (error == ENOBUFS) {
9528 asoc->ifp_had_enobuf = 1;
9529 SCTP_STAT_INCR(sctps_lowlevelerr);
9530 }
9531 return (error);
9532 } else {
9533 asoc->ifp_had_enobuf = 0;
9534 }
9535 endofchain = NULL;
9536 auth = NULL;
9537 auth_offset = 0;
9538 /*
9539 * We don't want to mark the net->sent time here since this
9540 * we use this for HB and retrans cannot measure RTT
9541 */
9542 /* (void)SCTP_GETTIME_TIMEVAL(&chk->whoTo->last_sent_time); */
9543 *cnt_out += 1;
9544 chk->sent = SCTP_DATAGRAM_SENT;
9545 sctp_ucount_decr(stcb->asoc.sent_queue_retran_cnt);
9546 if (fwd_tsn == 0) {
9547 return (0);
9548 } else {
9549 /* Clean up the fwd-tsn list */
9550 sctp_clean_up_ctl(stcb, asoc, so_locked);
9551 return (0);
9552 }
9553 }
9554 /*
9555 * Ok, it is just data retransmission we need to do or that and a
9556 * fwd-tsn with it all.
9557 */
9558 if (TAILQ_EMPTY(&asoc->sent_queue)) {
9559 return (SCTP_RETRAN_DONE);
9560 }
9561 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED) ||
9562 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT)) {
9563 /* not yet open, resend the cookie and that is it */
9564 return (1);
9565 }
9566 #ifdef SCTP_AUDITING_ENABLED
9567 sctp_auditing(20, inp, stcb, NULL);
9568 #endif
9569 data_auth_reqd = sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks);
9570 TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) {
9571 if (chk->sent != SCTP_DATAGRAM_RESEND) {
9572 /* No, not sent to this net or not ready for rtx */
9573 continue;
9574 }
9575 if (chk->data == NULL) {
9576 SCTP_PRINTF("TSN:%x chk->snd_count:%d chk->sent:%d can't retran - no data\n",
9577 chk->rec.data.tsn, chk->snd_count, chk->sent);
9578 continue;
9579 }
9580 if ((SCTP_BASE_SYSCTL(sctp_max_retran_chunk)) &&
9581 (chk->snd_count >= SCTP_BASE_SYSCTL(sctp_max_retran_chunk))) {
9582 struct mbuf *op_err;
9583 char msg[SCTP_DIAG_INFO_LEN];
9584
9585 snprintf(msg, sizeof(msg), "TSN %8.8x retransmitted %d times, giving up",
9586 chk->rec.data.tsn, chk->snd_count);
9587 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
9588 msg);
9589 atomic_add_int(&stcb->asoc.refcnt, 1);
9590 sctp_abort_an_association(stcb->sctp_ep, stcb, op_err,
9591 so_locked);
9592 SCTP_TCB_LOCK(stcb);
9593 atomic_subtract_int(&stcb->asoc.refcnt, 1);
9594 return (SCTP_RETRAN_EXIT);
9595 }
9596 /* pick up the net */
9597 net = chk->whoTo;
9598 switch (net->ro._l_addr.sa.sa_family) {
9599 #ifdef INET
9600 case AF_INET:
9601 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
9602 break;
9603 #endif
9604 #ifdef INET6
9605 case AF_INET6:
9606 mtu = net->mtu - SCTP_MIN_OVERHEAD;
9607 break;
9608 #endif
9609 default:
9610 /* TSNH */
9611 mtu = net->mtu;
9612 break;
9613 }
9614
9615 if ((asoc->peers_rwnd < mtu) && (asoc->total_flight > 0)) {
9616 /* No room in peers rwnd */
9617 uint32_t tsn;
9618
9619 tsn = asoc->last_acked_seq + 1;
9620 if (tsn == chk->rec.data.tsn) {
9621 /*
9622 * we make a special exception for this
9623 * case. The peer has no rwnd but is missing
9624 * the lowest chunk.. which is probably what
9625 * is holding up the rwnd.
9626 */
9627 goto one_chunk_around;
9628 }
9629 return (1);
9630 }
9631 one_chunk_around:
9632 if (asoc->peers_rwnd < mtu) {
9633 one_chunk = 1;
9634 if ((asoc->peers_rwnd == 0) &&
9635 (asoc->total_flight == 0)) {
9636 chk->window_probe = 1;
9637 chk->whoTo->window_probe = 1;
9638 }
9639 }
9640 #ifdef SCTP_AUDITING_ENABLED
9641 sctp_audit_log(0xC3, 2);
9642 #endif
9643 bundle_at = 0;
9644 m = NULL;
9645 net->fast_retran_ip = 0;
9646 if (chk->rec.data.doing_fast_retransmit == 0) {
9647 /*
9648 * if no FR in progress skip destination that have
9649 * flight_size > cwnd.
9650 */
9651 if (net->flight_size >= net->cwnd) {
9652 continue;
9653 }
9654 } else {
9655 /*
9656 * Mark the destination net to have FR recovery
9657 * limits put on it.
9658 */
9659 *fr_done = 1;
9660 net->fast_retran_ip = 1;
9661 }
9662
9663 /*
9664 * if no AUTH is yet included and this chunk requires it,
9665 * make sure to account for it. We don't apply the size
9666 * until the AUTH chunk is actually added below in case
9667 * there is no room for this chunk.
9668 */
9669 if (data_auth_reqd && (auth == NULL)) {
9670 dmtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
9671 } else
9672 dmtu = 0;
9673
9674 if ((chk->send_size <= (mtu - dmtu)) ||
9675 (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) {
9676 /* ok we will add this one */
9677 if (data_auth_reqd) {
9678 if (auth == NULL) {
9679 m = sctp_add_auth_chunk(m,
9680 &endofchain,
9681 &auth,
9682 &auth_offset,
9683 stcb,
9684 SCTP_DATA);
9685 auth_keyid = chk->auth_keyid;
9686 override_ok = 0;
9687 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
9688 } else if (override_ok) {
9689 auth_keyid = chk->auth_keyid;
9690 override_ok = 0;
9691 } else if (chk->auth_keyid != auth_keyid) {
9692 /* different keyid, so done bundling */
9693 break;
9694 }
9695 }
9696 m = sctp_copy_mbufchain(chk->data, m, &endofchain, 0, chk->send_size, chk->copy_by_ref);
9697 if (m == NULL) {
9698 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
9699 return (ENOMEM);
9700 }
9701 /* Do clear IP_DF ? */
9702 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
9703 no_fragmentflg = 0;
9704 }
9705 /* upate our MTU size */
9706 if (mtu > (chk->send_size + dmtu))
9707 mtu -= (chk->send_size + dmtu);
9708 else
9709 mtu = 0;
9710 data_list[bundle_at++] = chk;
9711 if (one_chunk && (asoc->total_flight <= 0)) {
9712 SCTP_STAT_INCR(sctps_windowprobed);
9713 }
9714 }
9715 if (one_chunk == 0) {
9716 /*
9717 * now are there anymore forward from chk to pick
9718 * up?
9719 */
9720 for (fwd = TAILQ_NEXT(chk, sctp_next); fwd != NULL; fwd = TAILQ_NEXT(fwd, sctp_next)) {
9721 if (fwd->sent != SCTP_DATAGRAM_RESEND) {
9722 /* Nope, not for retran */
9723 continue;
9724 }
9725 if (fwd->whoTo != net) {
9726 /* Nope, not the net in question */
9727 continue;
9728 }
9729 if (data_auth_reqd && (auth == NULL)) {
9730 dmtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
9731 } else
9732 dmtu = 0;
9733 if (fwd->send_size <= (mtu - dmtu)) {
9734 if (data_auth_reqd) {
9735 if (auth == NULL) {
9736 m = sctp_add_auth_chunk(m,
9737 &endofchain,
9738 &auth,
9739 &auth_offset,
9740 stcb,
9741 SCTP_DATA);
9742 auth_keyid = fwd->auth_keyid;
9743 override_ok = 0;
9744 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
9745 } else if (override_ok) {
9746 auth_keyid = fwd->auth_keyid;
9747 override_ok = 0;
9748 } else if (fwd->auth_keyid != auth_keyid) {
9749 /*
9750 * different keyid,
9751 * so done bundling
9752 */
9753 break;
9754 }
9755 }
9756 m = sctp_copy_mbufchain(fwd->data, m, &endofchain, 0, fwd->send_size, fwd->copy_by_ref);
9757 if (m == NULL) {
9758 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
9759 return (ENOMEM);
9760 }
9761 /* Do clear IP_DF ? */
9762 if (fwd->flags & CHUNK_FLAGS_FRAGMENT_OK) {
9763 no_fragmentflg = 0;
9764 }
9765 /* upate our MTU size */
9766 if (mtu > (fwd->send_size + dmtu))
9767 mtu -= (fwd->send_size + dmtu);
9768 else
9769 mtu = 0;
9770 data_list[bundle_at++] = fwd;
9771 if (bundle_at >= SCTP_MAX_DATA_BUNDLING) {
9772 break;
9773 }
9774 } else {
9775 /* can't fit so we are done */
9776 break;
9777 }
9778 }
9779 }
9780 /* Is there something to send for this destination? */
9781 if (m) {
9782 /*
9783 * No matter if we fail/or succeed we should start a
9784 * timer. A failure is like a lost IP packet :-)
9785 */
9786 if (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
9787 /*
9788 * no timer running on this destination
9789 * restart it.
9790 */
9791 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
9792 tmr_started = 1;
9793 }
9794 /* Now lets send it, if there is anything to send :> */
9795 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
9796 (struct sockaddr *)&net->ro._l_addr, m,
9797 auth_offset, auth, auth_keyid,
9798 no_fragmentflg, 0, 0,
9799 inp->sctp_lport, stcb->rport, htonl(stcb->asoc.peer_vtag),
9800 net->port, NULL,
9801 0, 0,
9802 so_locked))) {
9803 /* error, we could not output */
9804 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
9805 if (error == ENOBUFS) {
9806 asoc->ifp_had_enobuf = 1;
9807 SCTP_STAT_INCR(sctps_lowlevelerr);
9808 }
9809 return (error);
9810 } else {
9811 asoc->ifp_had_enobuf = 0;
9812 }
9813 endofchain = NULL;
9814 auth = NULL;
9815 auth_offset = 0;
9816 /* For HB's */
9817 /*
9818 * We don't want to mark the net->sent time here
9819 * since this we use this for HB and retrans cannot
9820 * measure RTT
9821 */
9822 /* (void)SCTP_GETTIME_TIMEVAL(&net->last_sent_time); */
9823
9824 /* For auto-close */
9825 cnt_thru++;
9826 if (*now_filled == 0) {
9827 (void)SCTP_GETTIME_TIMEVAL(&asoc->time_last_sent);
9828 *now = asoc->time_last_sent;
9829 *now_filled = 1;
9830 } else {
9831 asoc->time_last_sent = *now;
9832 }
9833 *cnt_out += bundle_at;
9834 #ifdef SCTP_AUDITING_ENABLED
9835 sctp_audit_log(0xC4, bundle_at);
9836 #endif
9837 if (bundle_at) {
9838 tsns_sent = data_list[0]->rec.data.tsn;
9839 }
9840 for (i = 0; i < bundle_at; i++) {
9841 SCTP_STAT_INCR(sctps_sendretransdata);
9842 data_list[i]->sent = SCTP_DATAGRAM_SENT;
9843 /*
9844 * When we have a revoked data, and we
9845 * retransmit it, then we clear the revoked
9846 * flag since this flag dictates if we
9847 * subtracted from the fs
9848 */
9849 if (data_list[i]->rec.data.chunk_was_revoked) {
9850 /* Deflate the cwnd */
9851 data_list[i]->whoTo->cwnd -= data_list[i]->book_size;
9852 data_list[i]->rec.data.chunk_was_revoked = 0;
9853 }
9854 data_list[i]->snd_count++;
9855 sctp_ucount_decr(asoc->sent_queue_retran_cnt);
9856 /* record the time */
9857 data_list[i]->sent_rcv_time = asoc->time_last_sent;
9858 if (data_list[i]->book_size_scale) {
9859 /*
9860 * need to double the book size on
9861 * this one
9862 */
9863 data_list[i]->book_size_scale = 0;
9864 /*
9865 * Since we double the booksize, we
9866 * must also double the output queue
9867 * size, since this get shrunk when
9868 * we free by this amount.
9869 */
9870 atomic_add_int(&((asoc)->total_output_queue_size), data_list[i]->book_size);
9871 data_list[i]->book_size *= 2;
9872
9873
9874 } else {
9875 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_RWND_ENABLE) {
9876 sctp_log_rwnd(SCTP_DECREASE_PEER_RWND,
9877 asoc->peers_rwnd, data_list[i]->send_size, SCTP_BASE_SYSCTL(sctp_peer_chunk_oh));
9878 }
9879 asoc->peers_rwnd = sctp_sbspace_sub(asoc->peers_rwnd,
9880 (uint32_t)(data_list[i]->send_size +
9881 SCTP_BASE_SYSCTL(sctp_peer_chunk_oh)));
9882 }
9883 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
9884 sctp_misc_ints(SCTP_FLIGHT_LOG_UP_RSND,
9885 data_list[i]->whoTo->flight_size,
9886 data_list[i]->book_size,
9887 (uint32_t)(uintptr_t)data_list[i]->whoTo,
9888 data_list[i]->rec.data.tsn);
9889 }
9890 sctp_flight_size_increase(data_list[i]);
9891 sctp_total_flight_increase(stcb, data_list[i]);
9892 if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
9893 /* SWS sender side engages */
9894 asoc->peers_rwnd = 0;
9895 }
9896 if ((i == 0) &&
9897 (data_list[i]->rec.data.doing_fast_retransmit)) {
9898 SCTP_STAT_INCR(sctps_sendfastretrans);
9899 if ((data_list[i] == TAILQ_FIRST(&asoc->sent_queue)) &&
9900 (tmr_started == 0)) {
9901 /*-
9902 * ok we just fast-retrans'd
9903 * the lowest TSN, i.e the
9904 * first on the list. In
9905 * this case we want to give
9906 * some more time to get a
9907 * SACK back without a
9908 * t3-expiring.
9909 */
9910 sctp_timer_stop(SCTP_TIMER_TYPE_SEND, inp, stcb, net,
9911 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_2);
9912 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
9913 }
9914 }
9915 }
9916 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
9917 sctp_log_cwnd(stcb, net, tsns_sent, SCTP_CWND_LOG_FROM_RESEND);
9918 }
9919 #ifdef SCTP_AUDITING_ENABLED
9920 sctp_auditing(21, inp, stcb, NULL);
9921 #endif
9922 } else {
9923 /* None will fit */
9924 return (1);
9925 }
9926 if (asoc->sent_queue_retran_cnt <= 0) {
9927 /* all done we have no more to retran */
9928 asoc->sent_queue_retran_cnt = 0;
9929 break;
9930 }
9931 if (one_chunk) {
9932 /* No more room in rwnd */
9933 return (1);
9934 }
9935 /* stop the for loop here. we sent out a packet */
9936 break;
9937 }
9938 return (0);
9939 }
9940
9941 static void
9942 sctp_timer_validation(struct sctp_inpcb *inp,
9943 struct sctp_tcb *stcb,
9944 struct sctp_association *asoc)
9945 {
9946 struct sctp_nets *net;
9947
9948 /* Validate that a timer is running somewhere */
9949 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
9950 if (SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
9951 /* Here is a timer */
9952 return;
9953 }
9954 }
9955 SCTP_TCB_LOCK_ASSERT(stcb);
9956 /* Gak, we did not have a timer somewhere */
9957 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Deadlock avoided starting timer on a dest at retran\n");
9958 if (asoc->alternate) {
9959 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, asoc->alternate);
9960 } else {
9961 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, asoc->primary_destination);
9962 }
9963 return;
9964 }
9965
9966 void
9967 sctp_chunk_output(struct sctp_inpcb *inp,
9968 struct sctp_tcb *stcb,
9969 int from_where,
9970 int so_locked
9971 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
9972 SCTP_UNUSED
9973 #endif
9974 )
9975 {
9976 /*-
9977 * Ok this is the generic chunk service queue. we must do the
9978 * following:
9979 * - See if there are retransmits pending, if so we must
9980 * do these first.
9981 * - Service the stream queue that is next, moving any
9982 * message (note I must get a complete message i.e.
9983 * FIRST/MIDDLE and LAST to the out queue in one pass) and assigning
9984 * TSN's
9985 * - Check to see if the cwnd/rwnd allows any output, if so we
9986 * go ahead and fomulate and send the low level chunks. Making sure
9987 * to combine any control in the control chunk queue also.
9988 */
9989 struct sctp_association *asoc;
9990 struct sctp_nets *net;
9991 int error = 0, num_out, tot_out = 0, ret = 0, reason_code;
9992 unsigned int burst_cnt = 0;
9993 struct timeval now;
9994 int now_filled = 0;
9995 int nagle_on;
9996 int frag_point = sctp_get_frag_point(stcb, &stcb->asoc);
9997 int un_sent = 0;
9998 int fr_done;
9999 unsigned int tot_frs = 0;
10000
10001 asoc = &stcb->asoc;
10002 do_it_again:
10003 /* The Nagle algorithm is only applied when handling a send call. */
10004 if (from_where == SCTP_OUTPUT_FROM_USR_SEND) {
10005 if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_NODELAY)) {
10006 nagle_on = 0;
10007 } else {
10008 nagle_on = 1;
10009 }
10010 } else {
10011 nagle_on = 0;
10012 }
10013 SCTP_TCB_LOCK_ASSERT(stcb);
10014
10015 un_sent = (stcb->asoc.total_output_queue_size - stcb->asoc.total_flight);
10016
10017 if ((un_sent <= 0) &&
10018 (TAILQ_EMPTY(&asoc->control_send_queue)) &&
10019 (TAILQ_EMPTY(&asoc->asconf_send_queue)) &&
10020 (asoc->sent_queue_retran_cnt == 0) &&
10021 (asoc->trigger_reset == 0)) {
10022 /* Nothing to do unless there is something to be sent left */
10023 return;
10024 }
10025 /*
10026 * Do we have something to send, data or control AND a sack timer
10027 * running, if so piggy-back the sack.
10028 */
10029 if (SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
10030 sctp_send_sack(stcb, so_locked);
10031 (void)SCTP_OS_TIMER_STOP(&stcb->asoc.dack_timer.timer);
10032 }
10033 while (asoc->sent_queue_retran_cnt) {
10034 /*-
10035 * Ok, it is retransmission time only, we send out only ONE
10036 * packet with a single call off to the retran code.
10037 */
10038 if (from_where == SCTP_OUTPUT_FROM_COOKIE_ACK) {
10039 /*-
10040 * Special hook for handling cookiess discarded
10041 * by peer that carried data. Send cookie-ack only
10042 * and then the next call with get the retran's.
10043 */
10044 (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1,
10045 from_where,
10046 &now, &now_filled, frag_point, so_locked);
10047 return;
10048 } else if (from_where != SCTP_OUTPUT_FROM_HB_TMR) {
10049 /* if its not from a HB then do it */
10050 fr_done = 0;
10051 ret = sctp_chunk_retransmission(inp, stcb, asoc, &num_out, &now, &now_filled, &fr_done, so_locked);
10052 if (fr_done) {
10053 tot_frs++;
10054 }
10055 } else {
10056 /*
10057 * its from any other place, we don't allow retran
10058 * output (only control)
10059 */
10060 ret = 1;
10061 }
10062 if (ret > 0) {
10063 /* Can't send anymore */
10064 /*-
10065 * now lets push out control by calling med-level
10066 * output once. this assures that we WILL send HB's
10067 * if queued too.
10068 */
10069 (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1,
10070 from_where,
10071 &now, &now_filled, frag_point, so_locked);
10072 #ifdef SCTP_AUDITING_ENABLED
10073 sctp_auditing(8, inp, stcb, NULL);
10074 #endif
10075 sctp_timer_validation(inp, stcb, asoc);
10076 return;
10077 }
10078 if (ret < 0) {
10079 /*-
10080 * The count was off.. retran is not happening so do
10081 * the normal retransmission.
10082 */
10083 #ifdef SCTP_AUDITING_ENABLED
10084 sctp_auditing(9, inp, stcb, NULL);
10085 #endif
10086 if (ret == SCTP_RETRAN_EXIT) {
10087 return;
10088 }
10089 break;
10090 }
10091 if (from_where == SCTP_OUTPUT_FROM_T3) {
10092 /* Only one transmission allowed out of a timeout */
10093 #ifdef SCTP_AUDITING_ENABLED
10094 sctp_auditing(10, inp, stcb, NULL);
10095 #endif
10096 /* Push out any control */
10097 (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1, from_where,
10098 &now, &now_filled, frag_point, so_locked);
10099 return;
10100 }
10101 if ((asoc->fr_max_burst > 0) && (tot_frs >= asoc->fr_max_burst)) {
10102 /* Hit FR burst limit */
10103 return;
10104 }
10105 if ((num_out == 0) && (ret == 0)) {
10106 /* No more retrans to send */
10107 break;
10108 }
10109 }
10110 #ifdef SCTP_AUDITING_ENABLED
10111 sctp_auditing(12, inp, stcb, NULL);
10112 #endif
10113 /* Check for bad destinations, if they exist move chunks around. */
10114 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
10115 if (!(net->dest_state & SCTP_ADDR_REACHABLE)) {
10116 /*-
10117 * if possible move things off of this address we
10118 * still may send below due to the dormant state but
10119 * we try to find an alternate address to send to
10120 * and if we have one we move all queued data on the
10121 * out wheel to this alternate address.
10122 */
10123 if (net->ref_count > 1)
10124 sctp_move_chunks_from_net(stcb, net);
10125 } else {
10126 /*-
10127 * if ((asoc->sat_network) || (net->addr_is_local))
10128 * { burst_limit = asoc->max_burst *
10129 * SCTP_SAT_NETWORK_BURST_INCR; }
10130 */
10131 if (asoc->max_burst > 0) {
10132 if (SCTP_BASE_SYSCTL(sctp_use_cwnd_based_maxburst)) {
10133 if ((net->flight_size + (asoc->max_burst * net->mtu)) < net->cwnd) {
10134 /*
10135 * JRS - Use the congestion
10136 * control given in the
10137 * congestion control module
10138 */
10139 asoc->cc_functions.sctp_cwnd_update_after_output(stcb, net, asoc->max_burst);
10140 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_MAXBURST_ENABLE) {
10141 sctp_log_maxburst(stcb, net, 0, asoc->max_burst, SCTP_MAX_BURST_APPLIED);
10142 }
10143 SCTP_STAT_INCR(sctps_maxburstqueued);
10144 }
10145 net->fast_retran_ip = 0;
10146 } else {
10147 if (net->flight_size == 0) {
10148 /*
10149 * Should be decaying the
10150 * cwnd here
10151 */
10152 ;
10153 }
10154 }
10155 }
10156 }
10157
10158 }
10159 burst_cnt = 0;
10160 do {
10161 error = sctp_med_chunk_output(inp, stcb, asoc, &num_out,
10162 &reason_code, 0, from_where,
10163 &now, &now_filled, frag_point, so_locked);
10164 if (error) {
10165 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Error %d was returned from med-c-op\n", error);
10166 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_MAXBURST_ENABLE) {
10167 sctp_log_maxburst(stcb, asoc->primary_destination, error, burst_cnt, SCTP_MAX_BURST_ERROR_STOP);
10168 }
10169 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
10170 sctp_log_cwnd(stcb, NULL, error, SCTP_SEND_NOW_COMPLETES);
10171 sctp_log_cwnd(stcb, NULL, 0xdeadbeef, SCTP_SEND_NOW_COMPLETES);
10172 }
10173 break;
10174 }
10175 SCTPDBG(SCTP_DEBUG_OUTPUT3, "m-c-o put out %d\n", num_out);
10176
10177 tot_out += num_out;
10178 burst_cnt++;
10179 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
10180 sctp_log_cwnd(stcb, NULL, num_out, SCTP_SEND_NOW_COMPLETES);
10181 if (num_out == 0) {
10182 sctp_log_cwnd(stcb, NULL, reason_code, SCTP_SEND_NOW_COMPLETES);
10183 }
10184 }
10185 if (nagle_on) {
10186 /*
10187 * When the Nagle algorithm is used, look at how
10188 * much is unsent, then if its smaller than an MTU
10189 * and we have data in flight we stop, except if we
10190 * are handling a fragmented user message.
10191 */
10192 un_sent = stcb->asoc.total_output_queue_size - stcb->asoc.total_flight;
10193 if ((un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD)) &&
10194 (stcb->asoc.total_flight > 0)) {
10195 /* && sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXPLICIT_EOR))) {*/
10196 break;
10197 }
10198 }
10199 if (TAILQ_EMPTY(&asoc->control_send_queue) &&
10200 TAILQ_EMPTY(&asoc->send_queue) &&
10201 sctp_is_there_unsent_data(stcb, so_locked) == 0) {
10202 /* Nothing left to send */
10203 break;
10204 }
10205 if ((stcb->asoc.total_output_queue_size - stcb->asoc.total_flight) <= 0) {
10206 /* Nothing left to send */
10207 break;
10208 }
10209 } while (num_out &&
10210 ((asoc->max_burst == 0) ||
10211 SCTP_BASE_SYSCTL(sctp_use_cwnd_based_maxburst) ||
10212 (burst_cnt < asoc->max_burst)));
10213
10214 if (SCTP_BASE_SYSCTL(sctp_use_cwnd_based_maxburst) == 0) {
10215 if ((asoc->max_burst > 0) && (burst_cnt >= asoc->max_burst)) {
10216 SCTP_STAT_INCR(sctps_maxburstqueued);
10217 asoc->burst_limit_applied = 1;
10218 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_MAXBURST_ENABLE) {
10219 sctp_log_maxburst(stcb, asoc->primary_destination, 0, burst_cnt, SCTP_MAX_BURST_APPLIED);
10220 }
10221 } else {
10222 asoc->burst_limit_applied = 0;
10223 }
10224 }
10225 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
10226 sctp_log_cwnd(stcb, NULL, tot_out, SCTP_SEND_NOW_COMPLETES);
10227 }
10228 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Ok, we have put out %d chunks\n",
10229 tot_out);
10230
10231 /*-
10232 * Now we need to clean up the control chunk chain if a ECNE is on
10233 * it. It must be marked as UNSENT again so next call will continue
10234 * to send it until such time that we get a CWR, to remove it.
10235 */
10236 if (stcb->asoc.ecn_echo_cnt_onq)
10237 sctp_fix_ecn_echo(asoc);
10238
10239 if (stcb->asoc.trigger_reset) {
10240 if (sctp_send_stream_reset_out_if_possible(stcb, so_locked) == 0) {
10241 goto do_it_again;
10242 }
10243 }
10244 return;
10245 }
10246
10247
10248 int
10249 sctp_output(
10250 struct sctp_inpcb *inp,
10251 struct mbuf *m,
10252 struct sockaddr *addr,
10253 struct mbuf *control,
10254 struct thread *p,
10255 int flags)
10256 {
10257 if (inp == NULL) {
10258 SCTP_LTRACE_ERR_RET_PKT(m, inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
10259 return (EINVAL);
10260 }
10261
10262 if (inp->sctp_socket == NULL) {
10263 SCTP_LTRACE_ERR_RET_PKT(m, inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
10264 return (EINVAL);
10265 }
10266 return (sctp_sosend(inp->sctp_socket,
10267 addr,
10268 (struct uio *)NULL,
10269 m,
10270 control,
10271 flags, p
10272 ));
10273 }
10274
10275 void
10276 send_forward_tsn(struct sctp_tcb *stcb,
10277 struct sctp_association *asoc)
10278 {
10279 struct sctp_tmit_chunk *chk, *at, *tp1, *last;
10280 struct sctp_forward_tsn_chunk *fwdtsn;
10281 struct sctp_strseq *strseq;
10282 struct sctp_strseq_mid *strseq_m;
10283 uint32_t advance_peer_ack_point;
10284 unsigned int cnt_of_space, i, ovh;
10285 unsigned int space_needed;
10286 unsigned int cnt_of_skipped = 0;
10287
10288 SCTP_TCB_LOCK_ASSERT(stcb);
10289 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
10290 if (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) {
10291 /* mark it to unsent */
10292 chk->sent = SCTP_DATAGRAM_UNSENT;
10293 chk->snd_count = 0;
10294 /* Do we correct its output location? */
10295 if (chk->whoTo) {
10296 sctp_free_remote_addr(chk->whoTo);
10297 chk->whoTo = NULL;
10298 }
10299 goto sctp_fill_in_rest;
10300 }
10301 }
10302 /* Ok if we reach here we must build one */
10303 sctp_alloc_a_chunk(stcb, chk);
10304 if (chk == NULL) {
10305 return;
10306 }
10307 asoc->fwd_tsn_cnt++;
10308 chk->copy_by_ref = 0;
10309 /*
10310 * We don't do the old thing here since this is used not for on-wire
10311 * but to tell if we are sending a fwd-tsn by the stack during
10312 * output. And if its a IFORWARD or a FORWARD it is a fwd-tsn.
10313 */
10314 chk->rec.chunk_id.id = SCTP_FORWARD_CUM_TSN;
10315 chk->rec.chunk_id.can_take_data = 0;
10316 chk->flags = 0;
10317 chk->asoc = asoc;
10318 chk->whoTo = NULL;
10319 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
10320 if (chk->data == NULL) {
10321 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
10322 return;
10323 }
10324 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
10325 chk->sent = SCTP_DATAGRAM_UNSENT;
10326 chk->snd_count = 0;
10327 TAILQ_INSERT_TAIL(&asoc->control_send_queue, chk, sctp_next);
10328 asoc->ctrl_queue_cnt++;
10329 sctp_fill_in_rest:
10330 /*-
10331 * Here we go through and fill out the part that deals with
10332 * stream/seq of the ones we skip.
10333 */
10334 SCTP_BUF_LEN(chk->data) = 0;
10335 TAILQ_FOREACH(at, &asoc->sent_queue, sctp_next) {
10336 if ((at->sent != SCTP_FORWARD_TSN_SKIP) &&
10337 (at->sent != SCTP_DATAGRAM_NR_ACKED)) {
10338 /* no more to look at */
10339 break;
10340 }
10341 if (!asoc->idata_supported && (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED)) {
10342 /* We don't report these */
10343 continue;
10344 }
10345 cnt_of_skipped++;
10346 }
10347 if (asoc->idata_supported) {
10348 space_needed = (sizeof(struct sctp_forward_tsn_chunk) +
10349 (cnt_of_skipped * sizeof(struct sctp_strseq_mid)));
10350 } else {
10351 space_needed = (sizeof(struct sctp_forward_tsn_chunk) +
10352 (cnt_of_skipped * sizeof(struct sctp_strseq)));
10353 }
10354 cnt_of_space = (unsigned int)M_TRAILINGSPACE(chk->data);
10355
10356 if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
10357 ovh = SCTP_MIN_OVERHEAD;
10358 } else {
10359 ovh = SCTP_MIN_V4_OVERHEAD;
10360 }
10361 if (cnt_of_space > (asoc->smallest_mtu - ovh)) {
10362 /* trim to a mtu size */
10363 cnt_of_space = asoc->smallest_mtu - ovh;
10364 }
10365 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
10366 sctp_misc_ints(SCTP_FWD_TSN_CHECK,
10367 0xff, 0, cnt_of_skipped,
10368 asoc->advanced_peer_ack_point);
10369 }
10370 advance_peer_ack_point = asoc->advanced_peer_ack_point;
10371 if (cnt_of_space < space_needed) {
10372 /*-
10373 * ok we must trim down the chunk by lowering the
10374 * advance peer ack point.
10375 */
10376 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
10377 sctp_misc_ints(SCTP_FWD_TSN_CHECK,
10378 0xff, 0xff, cnt_of_space,
10379 space_needed);
10380 }
10381 cnt_of_skipped = cnt_of_space - sizeof(struct sctp_forward_tsn_chunk);
10382 if (asoc->idata_supported) {
10383 cnt_of_skipped /= sizeof(struct sctp_strseq_mid);
10384 } else {
10385 cnt_of_skipped /= sizeof(struct sctp_strseq);
10386 }
10387 /*-
10388 * Go through and find the TSN that will be the one
10389 * we report.
10390 */
10391 at = TAILQ_FIRST(&asoc->sent_queue);
10392 if (at != NULL) {
10393 for (i = 0; i < cnt_of_skipped; i++) {
10394 tp1 = TAILQ_NEXT(at, sctp_next);
10395 if (tp1 == NULL) {
10396 break;
10397 }
10398 at = tp1;
10399 }
10400 }
10401 if (at && SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
10402 sctp_misc_ints(SCTP_FWD_TSN_CHECK,
10403 0xff, cnt_of_skipped, at->rec.data.tsn,
10404 asoc->advanced_peer_ack_point);
10405 }
10406 last = at;
10407 /*-
10408 * last now points to last one I can report, update
10409 * peer ack point
10410 */
10411 if (last) {
10412 advance_peer_ack_point = last->rec.data.tsn;
10413 }
10414 if (asoc->idata_supported) {
10415 space_needed = sizeof(struct sctp_forward_tsn_chunk) +
10416 cnt_of_skipped * sizeof(struct sctp_strseq_mid);
10417 } else {
10418 space_needed = sizeof(struct sctp_forward_tsn_chunk) +
10419 cnt_of_skipped * sizeof(struct sctp_strseq);
10420 }
10421 }
10422 chk->send_size = space_needed;
10423 /* Setup the chunk */
10424 fwdtsn = mtod(chk->data, struct sctp_forward_tsn_chunk *);
10425 fwdtsn->ch.chunk_length = htons(chk->send_size);
10426 fwdtsn->ch.chunk_flags = 0;
10427 if (asoc->idata_supported) {
10428 fwdtsn->ch.chunk_type = SCTP_IFORWARD_CUM_TSN;
10429 } else {
10430 fwdtsn->ch.chunk_type = SCTP_FORWARD_CUM_TSN;
10431 }
10432 fwdtsn->new_cumulative_tsn = htonl(advance_peer_ack_point);
10433 SCTP_BUF_LEN(chk->data) = chk->send_size;
10434 fwdtsn++;
10435 /*-
10436 * Move pointer to after the fwdtsn and transfer to the
10437 * strseq pointer.
10438 */
10439 if (asoc->idata_supported) {
10440 strseq_m = (struct sctp_strseq_mid *)fwdtsn;
10441 strseq = NULL;
10442 } else {
10443 strseq = (struct sctp_strseq *)fwdtsn;
10444 strseq_m = NULL;
10445 }
10446 /*-
10447 * Now populate the strseq list. This is done blindly
10448 * without pulling out duplicate stream info. This is
10449 * inefficent but won't harm the process since the peer will
10450 * look at these in sequence and will thus release anything.
10451 * It could mean we exceed the PMTU and chop off some that
10452 * we could have included.. but this is unlikely (aka 1432/4
10453 * would mean 300+ stream seq's would have to be reported in
10454 * one FWD-TSN. With a bit of work we can later FIX this to
10455 * optimize and pull out duplicates.. but it does add more
10456 * overhead. So for now... not!
10457 */
10458 i = 0;
10459 TAILQ_FOREACH(at, &asoc->sent_queue, sctp_next) {
10460 if (i >= cnt_of_skipped) {
10461 break;
10462 }
10463 if (!asoc->idata_supported && (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED)) {
10464 /* We don't report these */
10465 continue;
10466 }
10467 if (at->rec.data.tsn == advance_peer_ack_point) {
10468 at->rec.data.fwd_tsn_cnt = 0;
10469 }
10470 if (asoc->idata_supported) {
10471 strseq_m->sid = htons(at->rec.data.sid);
10472 if (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED) {
10473 strseq_m->flags = htons(PR_SCTP_UNORDERED_FLAG);
10474 } else {
10475 strseq_m->flags = 0;
10476 }
10477 strseq_m->mid = htonl(at->rec.data.mid);
10478 strseq_m++;
10479 } else {
10480 strseq->sid = htons(at->rec.data.sid);
10481 strseq->ssn = htons((uint16_t)at->rec.data.mid);
10482 strseq++;
10483 }
10484 i++;
10485 }
10486 return;
10487 }
10488
10489 void
10490 sctp_send_sack(struct sctp_tcb *stcb, int so_locked
10491 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
10492 SCTP_UNUSED
10493 #endif
10494 )
10495 {
10496 /*-
10497 * Queue up a SACK or NR-SACK in the control queue.
10498 * We must first check to see if a SACK or NR-SACK is
10499 * somehow on the control queue.
10500 * If so, we will take and and remove the old one.
10501 */
10502 struct sctp_association *asoc;
10503 struct sctp_tmit_chunk *chk, *a_chk;
10504 struct sctp_sack_chunk *sack;
10505 struct sctp_nr_sack_chunk *nr_sack;
10506 struct sctp_gap_ack_block *gap_descriptor;
10507 const struct sack_track *selector;
10508 int mergeable = 0;
10509 int offset;
10510 caddr_t limit;
10511 uint32_t *dup;
10512 int limit_reached = 0;
10513 unsigned int i, siz, j;
10514 unsigned int num_gap_blocks = 0, num_nr_gap_blocks = 0, space;
10515 int num_dups = 0;
10516 int space_req;
10517 uint32_t highest_tsn;
10518 uint8_t flags;
10519 uint8_t type;
10520 uint8_t tsn_map;
10521
10522 if (stcb->asoc.nrsack_supported == 1) {
10523 type = SCTP_NR_SELECTIVE_ACK;
10524 } else {
10525 type = SCTP_SELECTIVE_ACK;
10526 }
10527 a_chk = NULL;
10528 asoc = &stcb->asoc;
10529 SCTP_TCB_LOCK_ASSERT(stcb);
10530 if (asoc->last_data_chunk_from == NULL) {
10531 /* Hmm we never received anything */
10532 return;
10533 }
10534 sctp_slide_mapping_arrays(stcb);
10535 sctp_set_rwnd(stcb, asoc);
10536 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
10537 if (chk->rec.chunk_id.id == type) {
10538 /* Hmm, found a sack already on queue, remove it */
10539 TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next);
10540 asoc->ctrl_queue_cnt--;
10541 a_chk = chk;
10542 if (a_chk->data) {
10543 sctp_m_freem(a_chk->data);
10544 a_chk->data = NULL;
10545 }
10546 if (a_chk->whoTo) {
10547 sctp_free_remote_addr(a_chk->whoTo);
10548 a_chk->whoTo = NULL;
10549 }
10550 break;
10551 }
10552 }
10553 if (a_chk == NULL) {
10554 sctp_alloc_a_chunk(stcb, a_chk);
10555 if (a_chk == NULL) {
10556 /* No memory so we drop the idea, and set a timer */
10557 if (stcb->asoc.delayed_ack) {
10558 sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
10559 stcb->sctp_ep, stcb, NULL,
10560 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_3);
10561 sctp_timer_start(SCTP_TIMER_TYPE_RECV,
10562 stcb->sctp_ep, stcb, NULL);
10563 } else {
10564 stcb->asoc.send_sack = 1;
10565 }
10566 return;
10567 }
10568 a_chk->copy_by_ref = 0;
10569 a_chk->rec.chunk_id.id = type;
10570 a_chk->rec.chunk_id.can_take_data = 1;
10571 }
10572 /* Clear our pkt counts */
10573 asoc->data_pkts_seen = 0;
10574
10575 a_chk->flags = 0;
10576 a_chk->asoc = asoc;
10577 a_chk->snd_count = 0;
10578 a_chk->send_size = 0; /* fill in later */
10579 a_chk->sent = SCTP_DATAGRAM_UNSENT;
10580 a_chk->whoTo = NULL;
10581
10582 if (!(asoc->last_data_chunk_from->dest_state & SCTP_ADDR_REACHABLE)) {
10583 /*-
10584 * Ok, the destination for the SACK is unreachable, lets see if
10585 * we can select an alternate to asoc->last_data_chunk_from
10586 */
10587 a_chk->whoTo = sctp_find_alternate_net(stcb, asoc->last_data_chunk_from, 0);
10588 if (a_chk->whoTo == NULL) {
10589 /* Nope, no alternate */
10590 a_chk->whoTo = asoc->last_data_chunk_from;
10591 }
10592 } else {
10593 a_chk->whoTo = asoc->last_data_chunk_from;
10594 }
10595 if (a_chk->whoTo) {
10596 atomic_add_int(&a_chk->whoTo->ref_count, 1);
10597 }
10598 if (SCTP_TSN_GT(asoc->highest_tsn_inside_map, asoc->highest_tsn_inside_nr_map)) {
10599 highest_tsn = asoc->highest_tsn_inside_map;
10600 } else {
10601 highest_tsn = asoc->highest_tsn_inside_nr_map;
10602 }
10603 if (highest_tsn == asoc->cumulative_tsn) {
10604 /* no gaps */
10605 if (type == SCTP_SELECTIVE_ACK) {
10606 space_req = sizeof(struct sctp_sack_chunk);
10607 } else {
10608 space_req = sizeof(struct sctp_nr_sack_chunk);
10609 }
10610 } else {
10611 /* gaps get a cluster */
10612 space_req = MCLBYTES;
10613 }
10614 /* Ok now lets formulate a MBUF with our sack */
10615 a_chk->data = sctp_get_mbuf_for_msg(space_req, 0, M_NOWAIT, 1, MT_DATA);
10616 if ((a_chk->data == NULL) ||
10617 (a_chk->whoTo == NULL)) {
10618 /* rats, no mbuf memory */
10619 if (a_chk->data) {
10620 /* was a problem with the destination */
10621 sctp_m_freem(a_chk->data);
10622 a_chk->data = NULL;
10623 }
10624 sctp_free_a_chunk(stcb, a_chk, so_locked);
10625 /* sa_ignore NO_NULL_CHK */
10626 if (stcb->asoc.delayed_ack) {
10627 sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
10628 stcb->sctp_ep, stcb, NULL,
10629 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_4);
10630 sctp_timer_start(SCTP_TIMER_TYPE_RECV,
10631 stcb->sctp_ep, stcb, NULL);
10632 } else {
10633 stcb->asoc.send_sack = 1;
10634 }
10635 return;
10636 }
10637 /* ok, lets go through and fill it in */
10638 SCTP_BUF_RESV_UF(a_chk->data, SCTP_MIN_OVERHEAD);
10639 space = (unsigned int)M_TRAILINGSPACE(a_chk->data);
10640 if (space > (a_chk->whoTo->mtu - SCTP_MIN_OVERHEAD)) {
10641 space = (a_chk->whoTo->mtu - SCTP_MIN_OVERHEAD);
10642 }
10643 limit = mtod(a_chk->data, caddr_t);
10644 limit += space;
10645
10646 flags = 0;
10647
10648 if ((asoc->sctp_cmt_on_off > 0) &&
10649 SCTP_BASE_SYSCTL(sctp_cmt_use_dac)) {
10650 /*-
10651 * CMT DAC algorithm: If 2 (i.e., 0x10) packets have been
10652 * received, then set high bit to 1, else 0. Reset
10653 * pkts_rcvd.
10654 */
10655 flags |= (asoc->cmt_dac_pkts_rcvd << 6);
10656 asoc->cmt_dac_pkts_rcvd = 0;
10657 }
10658 #ifdef SCTP_ASOCLOG_OF_TSNS
10659 stcb->asoc.cumack_logsnt[stcb->asoc.cumack_log_atsnt] = asoc->cumulative_tsn;
10660 stcb->asoc.cumack_log_atsnt++;
10661 if (stcb->asoc.cumack_log_atsnt >= SCTP_TSN_LOG_SIZE) {
10662 stcb->asoc.cumack_log_atsnt = 0;
10663 }
10664 #endif
10665 /* reset the readers interpretation */
10666 stcb->freed_by_sorcv_sincelast = 0;
10667
10668 if (type == SCTP_SELECTIVE_ACK) {
10669 sack = mtod(a_chk->data, struct sctp_sack_chunk *);
10670 nr_sack = NULL;
10671 gap_descriptor = (struct sctp_gap_ack_block *)((caddr_t)sack + sizeof(struct sctp_sack_chunk));
10672 if (highest_tsn > asoc->mapping_array_base_tsn) {
10673 siz = (((highest_tsn - asoc->mapping_array_base_tsn) + 1) + 7) / 8;
10674 } else {
10675 siz = (((MAX_TSN - highest_tsn) + 1) + highest_tsn + 7) / 8;
10676 }
10677 } else {
10678 sack = NULL;
10679 nr_sack = mtod(a_chk->data, struct sctp_nr_sack_chunk *);
10680 gap_descriptor = (struct sctp_gap_ack_block *)((caddr_t)nr_sack + sizeof(struct sctp_nr_sack_chunk));
10681 if (asoc->highest_tsn_inside_map > asoc->mapping_array_base_tsn) {
10682 siz = (((asoc->highest_tsn_inside_map - asoc->mapping_array_base_tsn) + 1) + 7) / 8;
10683 } else {
10684 siz = (((MAX_TSN - asoc->mapping_array_base_tsn) + 1) + asoc->highest_tsn_inside_map + 7) / 8;
10685 }
10686 }
10687
10688 if (SCTP_TSN_GT(asoc->mapping_array_base_tsn, asoc->cumulative_tsn)) {
10689 offset = 1;
10690 } else {
10691 offset = asoc->mapping_array_base_tsn - asoc->cumulative_tsn;
10692 }
10693 if (((type == SCTP_SELECTIVE_ACK) &&
10694 SCTP_TSN_GT(highest_tsn, asoc->cumulative_tsn)) ||
10695 ((type == SCTP_NR_SELECTIVE_ACK) &&
10696 SCTP_TSN_GT(asoc->highest_tsn_inside_map, asoc->cumulative_tsn))) {
10697 /* we have a gap .. maybe */
10698 for (i = 0; i < siz; i++) {
10699 tsn_map = asoc->mapping_array[i];
10700 if (type == SCTP_SELECTIVE_ACK) {
10701 tsn_map |= asoc->nr_mapping_array[i];
10702 }
10703 if (i == 0) {
10704 /*
10705 * Clear all bits corresponding to TSNs
10706 * smaller or equal to the cumulative TSN.
10707 */
10708 tsn_map &= (~0U << (1 - offset));
10709 }
10710 selector = &sack_array[tsn_map];
10711 if (mergeable && selector->right_edge) {
10712 /*
10713 * Backup, left and right edges were ok to
10714 * merge.
10715 */
10716 num_gap_blocks--;
10717 gap_descriptor--;
10718 }
10719 if (selector->num_entries == 0)
10720 mergeable = 0;
10721 else {
10722 for (j = 0; j < selector->num_entries; j++) {
10723 if (mergeable && selector->right_edge) {
10724 /*
10725 * do a merge by NOT setting
10726 * the left side
10727 */
10728 mergeable = 0;
10729 } else {
10730 /*
10731 * no merge, set the left
10732 * side
10733 */
10734 mergeable = 0;
10735 gap_descriptor->start = htons((selector->gaps[j].start + offset));
10736 }
10737 gap_descriptor->end = htons((selector->gaps[j].end + offset));
10738 num_gap_blocks++;
10739 gap_descriptor++;
10740 if (((caddr_t)gap_descriptor + sizeof(struct sctp_gap_ack_block)) > limit) {
10741 /* no more room */
10742 limit_reached = 1;
10743 break;
10744 }
10745 }
10746 if (selector->left_edge) {
10747 mergeable = 1;
10748 }
10749 }
10750 if (limit_reached) {
10751 /* Reached the limit stop */
10752 break;
10753 }
10754 offset += 8;
10755 }
10756 }
10757 if ((type == SCTP_NR_SELECTIVE_ACK) &&
10758 (limit_reached == 0)) {
10759
10760 mergeable = 0;
10761
10762 if (asoc->highest_tsn_inside_nr_map > asoc->mapping_array_base_tsn) {
10763 siz = (((asoc->highest_tsn_inside_nr_map - asoc->mapping_array_base_tsn) + 1) + 7) / 8;
10764 } else {
10765 siz = (((MAX_TSN - asoc->mapping_array_base_tsn) + 1) + asoc->highest_tsn_inside_nr_map + 7) / 8;
10766 }
10767
10768 if (SCTP_TSN_GT(asoc->mapping_array_base_tsn, asoc->cumulative_tsn)) {
10769 offset = 1;
10770 } else {
10771 offset = asoc->mapping_array_base_tsn - asoc->cumulative_tsn;
10772 }
10773 if (SCTP_TSN_GT(asoc->highest_tsn_inside_nr_map, asoc->cumulative_tsn)) {
10774 /* we have a gap .. maybe */
10775 for (i = 0; i < siz; i++) {
10776 tsn_map = asoc->nr_mapping_array[i];
10777 if (i == 0) {
10778 /*
10779 * Clear all bits corresponding to
10780 * TSNs smaller or equal to the
10781 * cumulative TSN.
10782 */
10783 tsn_map &= (~0U << (1 - offset));
10784 }
10785 selector = &sack_array[tsn_map];
10786 if (mergeable && selector->right_edge) {
10787 /*
10788 * Backup, left and right edges were
10789 * ok to merge.
10790 */
10791 num_nr_gap_blocks--;
10792 gap_descriptor--;
10793 }
10794 if (selector->num_entries == 0)
10795 mergeable = 0;
10796 else {
10797 for (j = 0; j < selector->num_entries; j++) {
10798 if (mergeable && selector->right_edge) {
10799 /*
10800 * do a merge by NOT
10801 * setting the left
10802 * side
10803 */
10804 mergeable = 0;
10805 } else {
10806 /*
10807 * no merge, set the
10808 * left side
10809 */
10810 mergeable = 0;
10811 gap_descriptor->start = htons((selector->gaps[j].start + offset));
10812 }
10813 gap_descriptor->end = htons((selector->gaps[j].end + offset));
10814 num_nr_gap_blocks++;
10815 gap_descriptor++;
10816 if (((caddr_t)gap_descriptor + sizeof(struct sctp_gap_ack_block)) > limit) {
10817 /* no more room */
10818 limit_reached = 1;
10819 break;
10820 }
10821 }
10822 if (selector->left_edge) {
10823 mergeable = 1;
10824 }
10825 }
10826 if (limit_reached) {
10827 /* Reached the limit stop */
10828 break;
10829 }
10830 offset += 8;
10831 }
10832 }
10833 }
10834 /* now we must add any dups we are going to report. */
10835 if ((limit_reached == 0) && (asoc->numduptsns)) {
10836 dup = (uint32_t *)gap_descriptor;
10837 for (i = 0; i < asoc->numduptsns; i++) {
10838 *dup = htonl(asoc->dup_tsns[i]);
10839 dup++;
10840 num_dups++;
10841 if (((caddr_t)dup + sizeof(uint32_t)) > limit) {
10842 /* no more room */
10843 break;
10844 }
10845 }
10846 asoc->numduptsns = 0;
10847 }
10848 /*
10849 * now that the chunk is prepared queue it to the control chunk
10850 * queue.
10851 */
10852 if (type == SCTP_SELECTIVE_ACK) {
10853 a_chk->send_size = (uint16_t)(sizeof(struct sctp_sack_chunk) +
10854 (num_gap_blocks + num_nr_gap_blocks) * sizeof(struct sctp_gap_ack_block) +
10855 num_dups * sizeof(int32_t));
10856 SCTP_BUF_LEN(a_chk->data) = a_chk->send_size;
10857 sack->sack.cum_tsn_ack = htonl(asoc->cumulative_tsn);
10858 sack->sack.a_rwnd = htonl(asoc->my_rwnd);
10859 sack->sack.num_gap_ack_blks = htons(num_gap_blocks);
10860 sack->sack.num_dup_tsns = htons(num_dups);
10861 sack->ch.chunk_type = type;
10862 sack->ch.chunk_flags = flags;
10863 sack->ch.chunk_length = htons(a_chk->send_size);
10864 } else {
10865 a_chk->send_size = (uint16_t)(sizeof(struct sctp_nr_sack_chunk) +
10866 (num_gap_blocks + num_nr_gap_blocks) * sizeof(struct sctp_gap_ack_block) +
10867 num_dups * sizeof(int32_t));
10868 SCTP_BUF_LEN(a_chk->data) = a_chk->send_size;
10869 nr_sack->nr_sack.cum_tsn_ack = htonl(asoc->cumulative_tsn);
10870 nr_sack->nr_sack.a_rwnd = htonl(asoc->my_rwnd);
10871 nr_sack->nr_sack.num_gap_ack_blks = htons(num_gap_blocks);
10872 nr_sack->nr_sack.num_nr_gap_ack_blks = htons(num_nr_gap_blocks);
10873 nr_sack->nr_sack.num_dup_tsns = htons(num_dups);
10874 nr_sack->nr_sack.reserved = 0;
10875 nr_sack->ch.chunk_type = type;
10876 nr_sack->ch.chunk_flags = flags;
10877 nr_sack->ch.chunk_length = htons(a_chk->send_size);
10878 }
10879 TAILQ_INSERT_TAIL(&asoc->control_send_queue, a_chk, sctp_next);
10880 asoc->my_last_reported_rwnd = asoc->my_rwnd;
10881 asoc->ctrl_queue_cnt++;
10882 asoc->send_sack = 0;
10883 SCTP_STAT_INCR(sctps_sendsacks);
10884 return;
10885 }
10886
10887 void
10888 sctp_send_abort_tcb(struct sctp_tcb *stcb, struct mbuf *operr, int so_locked
10889 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
10890 SCTP_UNUSED
10891 #endif
10892 )
10893 {
10894 struct mbuf *m_abort, *m, *m_last;
10895 struct mbuf *m_out, *m_end = NULL;
10896 struct sctp_abort_chunk *abort;
10897 struct sctp_auth_chunk *auth = NULL;
10898 struct sctp_nets *net;
10899 uint32_t vtag;
10900 uint32_t auth_offset = 0;
10901 int error;
10902 uint16_t cause_len, chunk_len, padding_len;
10903
10904 SCTP_TCB_LOCK_ASSERT(stcb);
10905 /*-
10906 * Add an AUTH chunk, if chunk requires it and save the offset into
10907 * the chain for AUTH
10908 */
10909 if (sctp_auth_is_required_chunk(SCTP_ABORT_ASSOCIATION,
10910 stcb->asoc.peer_auth_chunks)) {
10911 m_out = sctp_add_auth_chunk(NULL, &m_end, &auth, &auth_offset,
10912 stcb, SCTP_ABORT_ASSOCIATION);
10913 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
10914 } else {
10915 m_out = NULL;
10916 }
10917 m_abort = sctp_get_mbuf_for_msg(sizeof(struct sctp_abort_chunk), 0, M_NOWAIT, 1, MT_HEADER);
10918 if (m_abort == NULL) {
10919 if (m_out) {
10920 sctp_m_freem(m_out);
10921 }
10922 if (operr) {
10923 sctp_m_freem(operr);
10924 }
10925 return;
10926 }
10927 /* link in any error */
10928 SCTP_BUF_NEXT(m_abort) = operr;
10929 cause_len = 0;
10930 m_last = NULL;
10931 for (m = operr; m; m = SCTP_BUF_NEXT(m)) {
10932 cause_len += (uint16_t)SCTP_BUF_LEN(m);
10933 if (SCTP_BUF_NEXT(m) == NULL) {
10934 m_last = m;
10935 }
10936 }
10937 SCTP_BUF_LEN(m_abort) = sizeof(struct sctp_abort_chunk);
10938 chunk_len = (uint16_t)sizeof(struct sctp_abort_chunk) + cause_len;
10939 padding_len = SCTP_SIZE32(chunk_len) - chunk_len;
10940 if (m_out == NULL) {
10941 /* NO Auth chunk prepended, so reserve space in front */
10942 SCTP_BUF_RESV_UF(m_abort, SCTP_MIN_OVERHEAD);
10943 m_out = m_abort;
10944 } else {
10945 /* Put AUTH chunk at the front of the chain */
10946 SCTP_BUF_NEXT(m_end) = m_abort;
10947 }
10948 if (stcb->asoc.alternate) {
10949 net = stcb->asoc.alternate;
10950 } else {
10951 net = stcb->asoc.primary_destination;
10952 }
10953 /* Fill in the ABORT chunk header. */
10954 abort = mtod(m_abort, struct sctp_abort_chunk *);
10955 abort->ch.chunk_type = SCTP_ABORT_ASSOCIATION;
10956 if (stcb->asoc.peer_vtag == 0) {
10957 /* This happens iff the assoc is in COOKIE-WAIT state. */
10958 vtag = stcb->asoc.my_vtag;
10959 abort->ch.chunk_flags = SCTP_HAD_NO_TCB;
10960 } else {
10961 vtag = stcb->asoc.peer_vtag;
10962 abort->ch.chunk_flags = 0;
10963 }
10964 abort->ch.chunk_length = htons(chunk_len);
10965 /* Add padding, if necessary. */
10966 if (padding_len > 0) {
10967 if ((m_last == NULL) ||
10968 (sctp_add_pad_tombuf(m_last, padding_len) == NULL)) {
10969 sctp_m_freem(m_out);
10970 return;
10971 }
10972 }
10973 if ((error = sctp_lowlevel_chunk_output(stcb->sctp_ep, stcb, net,
10974 (struct sockaddr *)&net->ro._l_addr,
10975 m_out, auth_offset, auth, stcb->asoc.authinfo.active_keyid, 1, 0, 0,
10976 stcb->sctp_ep->sctp_lport, stcb->rport, htonl(vtag),
10977 stcb->asoc.primary_destination->port, NULL,
10978 0, 0,
10979 so_locked))) {
10980 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
10981 if (error == ENOBUFS) {
10982 stcb->asoc.ifp_had_enobuf = 1;
10983 SCTP_STAT_INCR(sctps_lowlevelerr);
10984 }
10985 } else {
10986 stcb->asoc.ifp_had_enobuf = 0;
10987 }
10988 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
10989 }
10990
10991 void
10992 sctp_send_shutdown_complete(struct sctp_tcb *stcb,
10993 struct sctp_nets *net,
10994 int reflect_vtag)
10995 {
10996 /* formulate and SEND a SHUTDOWN-COMPLETE */
10997 struct mbuf *m_shutdown_comp;
10998 struct sctp_shutdown_complete_chunk *shutdown_complete;
10999 uint32_t vtag;
11000 int error;
11001 uint8_t flags;
11002
11003 m_shutdown_comp = sctp_get_mbuf_for_msg(sizeof(struct sctp_chunkhdr), 0, M_NOWAIT, 1, MT_HEADER);
11004 if (m_shutdown_comp == NULL) {
11005 /* no mbuf's */
11006 return;
11007 }
11008 if (reflect_vtag) {
11009 flags = SCTP_HAD_NO_TCB;
11010 vtag = stcb->asoc.my_vtag;
11011 } else {
11012 flags = 0;
11013 vtag = stcb->asoc.peer_vtag;
11014 }
11015 shutdown_complete = mtod(m_shutdown_comp, struct sctp_shutdown_complete_chunk *);
11016 shutdown_complete->ch.chunk_type = SCTP_SHUTDOWN_COMPLETE;
11017 shutdown_complete->ch.chunk_flags = flags;
11018 shutdown_complete->ch.chunk_length = htons(sizeof(struct sctp_shutdown_complete_chunk));
11019 SCTP_BUF_LEN(m_shutdown_comp) = sizeof(struct sctp_shutdown_complete_chunk);
11020 if ((error = sctp_lowlevel_chunk_output(stcb->sctp_ep, stcb, net,
11021 (struct sockaddr *)&net->ro._l_addr,
11022 m_shutdown_comp, 0, NULL, 0, 1, 0, 0,
11023 stcb->sctp_ep->sctp_lport, stcb->rport,
11024 htonl(vtag),
11025 net->port, NULL,
11026 0, 0,
11027 SCTP_SO_NOT_LOCKED))) {
11028 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
11029 if (error == ENOBUFS) {
11030 stcb->asoc.ifp_had_enobuf = 1;
11031 SCTP_STAT_INCR(sctps_lowlevelerr);
11032 }
11033 } else {
11034 stcb->asoc.ifp_had_enobuf = 0;
11035 }
11036 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
11037 return;
11038 }
11039
11040 static void
11041 sctp_send_resp_msg(struct sockaddr *src, struct sockaddr *dst,
11042 struct sctphdr *sh, uint32_t vtag,
11043 uint8_t type, struct mbuf *cause,
11044 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
11045 uint32_t vrf_id, uint16_t port)
11046 {
11047 struct mbuf *o_pak;
11048 struct mbuf *mout;
11049 struct sctphdr *shout;
11050 struct sctp_chunkhdr *ch;
11051 #if defined(INET) || defined(INET6)
11052 struct udphdr *udp;
11053 #endif
11054 int ret, len, cause_len, padding_len;
11055 #ifdef INET
11056 struct sockaddr_in *src_sin, *dst_sin;
11057 struct ip *ip;
11058 #endif
11059 #ifdef INET6
11060 struct sockaddr_in6 *src_sin6, *dst_sin6;
11061 struct ip6_hdr *ip6;
11062 #endif
11063
11064 /* Compute the length of the cause and add final padding. */
11065 cause_len = 0;
11066 if (cause != NULL) {
11067 struct mbuf *m_at, *m_last = NULL;
11068
11069 for (m_at = cause; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
11070 if (SCTP_BUF_NEXT(m_at) == NULL)
11071 m_last = m_at;
11072 cause_len += SCTP_BUF_LEN(m_at);
11073 }
11074 padding_len = cause_len % 4;
11075 if (padding_len != 0) {
11076 padding_len = 4 - padding_len;
11077 }
11078 if (padding_len != 0) {
11079 if (sctp_add_pad_tombuf(m_last, padding_len) == NULL) {
11080 sctp_m_freem(cause);
11081 return;
11082 }
11083 }
11084 } else {
11085 padding_len = 0;
11086 }
11087 /* Get an mbuf for the header. */
11088 len = sizeof(struct sctphdr) + sizeof(struct sctp_chunkhdr);
11089 switch (dst->sa_family) {
11090 #ifdef INET
11091 case AF_INET:
11092 len += sizeof(struct ip);
11093 break;
11094 #endif
11095 #ifdef INET6
11096 case AF_INET6:
11097 len += sizeof(struct ip6_hdr);
11098 break;
11099 #endif
11100 default:
11101 break;
11102 }
11103 #if defined(INET) || defined(INET6)
11104 if (port) {
11105 len += sizeof(struct udphdr);
11106 }
11107 #endif
11108 mout = sctp_get_mbuf_for_msg(len + max_linkhdr, 1, M_NOWAIT, 1, MT_DATA);
11109 if (mout == NULL) {
11110 if (cause) {
11111 sctp_m_freem(cause);
11112 }
11113 return;
11114 }
11115 SCTP_BUF_RESV_UF(mout, max_linkhdr);
11116 SCTP_BUF_LEN(mout) = len;
11117 SCTP_BUF_NEXT(mout) = cause;
11118 M_SETFIB(mout, fibnum);
11119 mout->m_pkthdr.flowid = mflowid;
11120 M_HASHTYPE_SET(mout, mflowtype);
11121 #ifdef INET
11122 ip = NULL;
11123 #endif
11124 #ifdef INET6
11125 ip6 = NULL;
11126 #endif
11127 switch (dst->sa_family) {
11128 #ifdef INET
11129 case AF_INET:
11130 src_sin = (struct sockaddr_in *)src;
11131 dst_sin = (struct sockaddr_in *)dst;
11132 ip = mtod(mout, struct ip *);
11133 ip->ip_v = IPVERSION;
11134 ip->ip_hl = (sizeof(struct ip) >> 2);
11135 ip->ip_tos = 0;
11136 ip->ip_off = htons(IP_DF);
11137 ip_fillid(ip);
11138 ip->ip_ttl = MODULE_GLOBAL(ip_defttl);
11139 if (port) {
11140 ip->ip_p = IPPROTO_UDP;
11141 } else {
11142 ip->ip_p = IPPROTO_SCTP;
11143 }
11144 ip->ip_src.s_addr = dst_sin->sin_addr.s_addr;
11145 ip->ip_dst.s_addr = src_sin->sin_addr.s_addr;
11146 ip->ip_sum = 0;
11147 len = sizeof(struct ip);
11148 shout = (struct sctphdr *)((caddr_t)ip + len);
11149 break;
11150 #endif
11151 #ifdef INET6
11152 case AF_INET6:
11153 src_sin6 = (struct sockaddr_in6 *)src;
11154 dst_sin6 = (struct sockaddr_in6 *)dst;
11155 ip6 = mtod(mout, struct ip6_hdr *);
11156 ip6->ip6_flow = htonl(0x60000000);
11157 if (V_ip6_auto_flowlabel) {
11158 ip6->ip6_flow |= (htonl(ip6_randomflowlabel()) & IPV6_FLOWLABEL_MASK);
11159 }
11160 ip6->ip6_hlim = MODULE_GLOBAL(ip6_defhlim);
11161 if (port) {
11162 ip6->ip6_nxt = IPPROTO_UDP;
11163 } else {
11164 ip6->ip6_nxt = IPPROTO_SCTP;
11165 }
11166 ip6->ip6_src = dst_sin6->sin6_addr;
11167 ip6->ip6_dst = src_sin6->sin6_addr;
11168 len = sizeof(struct ip6_hdr);
11169 shout = (struct sctphdr *)((caddr_t)ip6 + len);
11170 break;
11171 #endif
11172 default:
11173 len = 0;
11174 shout = mtod(mout, struct sctphdr *);
11175 break;
11176 }
11177 #if defined(INET) || defined(INET6)
11178 if (port) {
11179 if (htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port)) == 0) {
11180 sctp_m_freem(mout);
11181 return;
11182 }
11183 udp = (struct udphdr *)shout;
11184 udp->uh_sport = htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port));
11185 udp->uh_dport = port;
11186 udp->uh_sum = 0;
11187 udp->uh_ulen = htons((uint16_t)(sizeof(struct udphdr) +
11188 sizeof(struct sctphdr) +
11189 sizeof(struct sctp_chunkhdr) +
11190 cause_len + padding_len));
11191 len += sizeof(struct udphdr);
11192 shout = (struct sctphdr *)((caddr_t)shout + sizeof(struct udphdr));
11193 } else {
11194 udp = NULL;
11195 }
11196 #endif
11197 shout->src_port = sh->dest_port;
11198 shout->dest_port = sh->src_port;
11199 shout->checksum = 0;
11200 if (vtag) {
11201 shout->v_tag = htonl(vtag);
11202 } else {
11203 shout->v_tag = sh->v_tag;
11204 }
11205 len += sizeof(struct sctphdr);
11206 ch = (struct sctp_chunkhdr *)((caddr_t)shout + sizeof(struct sctphdr));
11207 ch->chunk_type = type;
11208 if (vtag) {
11209 ch->chunk_flags = 0;
11210 } else {
11211 ch->chunk_flags = SCTP_HAD_NO_TCB;
11212 }
11213 ch->chunk_length = htons((uint16_t)(sizeof(struct sctp_chunkhdr) + cause_len));
11214 len += sizeof(struct sctp_chunkhdr);
11215 len += cause_len + padding_len;
11216
11217 if (SCTP_GET_HEADER_FOR_OUTPUT(o_pak)) {
11218 sctp_m_freem(mout);
11219 return;
11220 }
11221 SCTP_ATTACH_CHAIN(o_pak, mout, len);
11222 switch (dst->sa_family) {
11223 #ifdef INET
11224 case AF_INET:
11225 if (port) {
11226 if (V_udp_cksum) {
11227 udp->uh_sum = in_pseudo(ip->ip_src.s_addr, ip->ip_dst.s_addr, udp->uh_ulen + htons(IPPROTO_UDP));
11228 } else {
11229 udp->uh_sum = 0;
11230 }
11231 }
11232 ip->ip_len = htons(len);
11233 if (port) {
11234 shout->checksum = sctp_calculate_cksum(mout, sizeof(struct ip) + sizeof(struct udphdr));
11235 SCTP_STAT_INCR(sctps_sendswcrc);
11236 if (V_udp_cksum) {
11237 SCTP_ENABLE_UDP_CSUM(o_pak);
11238 }
11239 } else {
11240 mout->m_pkthdr.csum_flags = CSUM_SCTP;
11241 mout->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
11242 SCTP_STAT_INCR(sctps_sendhwcrc);
11243 }
11244 #ifdef SCTP_PACKET_LOGGING
11245 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING) {
11246 sctp_packet_log(o_pak);
11247 }
11248 #endif
11249 SCTP_PROBE5(send, NULL, NULL, ip, NULL, shout);
11250 SCTP_IP_OUTPUT(ret, o_pak, NULL, NULL, vrf_id);
11251 break;
11252 #endif
11253 #ifdef INET6
11254 case AF_INET6:
11255 ip6->ip6_plen = htons((uint16_t)(len - sizeof(struct ip6_hdr)));
11256 if (port) {
11257 shout->checksum = sctp_calculate_cksum(mout, sizeof(struct ip6_hdr) + sizeof(struct udphdr));
11258 SCTP_STAT_INCR(sctps_sendswcrc);
11259 if ((udp->uh_sum = in6_cksum(o_pak, IPPROTO_UDP, sizeof(struct ip6_hdr), len - sizeof(struct ip6_hdr))) == 0) {
11260 udp->uh_sum = 0xffff;
11261 }
11262 } else {
11263 mout->m_pkthdr.csum_flags = CSUM_SCTP_IPV6;
11264 mout->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
11265 SCTP_STAT_INCR(sctps_sendhwcrc);
11266 }
11267 #ifdef SCTP_PACKET_LOGGING
11268 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING) {
11269 sctp_packet_log(o_pak);
11270 }
11271 #endif
11272 SCTP_PROBE5(send, NULL, NULL, ip6, NULL, shout);
11273 SCTP_IP6_OUTPUT(ret, o_pak, NULL, NULL, NULL, vrf_id);
11274 break;
11275 #endif
11276 default:
11277 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Unknown protocol (TSNH) type %d\n",
11278 dst->sa_family);
11279 sctp_m_freem(mout);
11280 SCTP_LTRACE_ERR_RET_PKT(mout, NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EFAULT);
11281 return;
11282 }
11283 SCTPDBG(SCTP_DEBUG_OUTPUT3, "return from send is %d\n", ret);
11284 if (port) {
11285 UDPSTAT_INC(udps_opackets);
11286 }
11287 SCTP_STAT_INCR(sctps_sendpackets);
11288 SCTP_STAT_INCR_COUNTER64(sctps_outpackets);
11289 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
11290 if (ret) {
11291 SCTP_STAT_INCR(sctps_senderrors);
11292 }
11293 return;
11294 }
11295
11296 void
11297 sctp_send_shutdown_complete2(struct sockaddr *src, struct sockaddr *dst,
11298 struct sctphdr *sh,
11299 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
11300 uint32_t vrf_id, uint16_t port)
11301 {
11302 sctp_send_resp_msg(src, dst, sh, 0, SCTP_SHUTDOWN_COMPLETE, NULL,
11303 mflowtype, mflowid, fibnum,
11304 vrf_id, port);
11305 }
11306
11307 void
11308 sctp_send_hb(struct sctp_tcb *stcb, struct sctp_nets *net, int so_locked
11309 #if !defined(__APPLE__) && !defined(SCTP_SO_LOCK_TESTING)
11310 SCTP_UNUSED
11311 #endif
11312 )
11313 {
11314 struct sctp_tmit_chunk *chk;
11315 struct sctp_heartbeat_chunk *hb;
11316 struct timeval now;
11317
11318 SCTP_TCB_LOCK_ASSERT(stcb);
11319 if (net == NULL) {
11320 return;
11321 }
11322 (void)SCTP_GETTIME_TIMEVAL(&now);
11323 switch (net->ro._l_addr.sa.sa_family) {
11324 #ifdef INET
11325 case AF_INET:
11326 break;
11327 #endif
11328 #ifdef INET6
11329 case AF_INET6:
11330 break;
11331 #endif
11332 default:
11333 return;
11334 }
11335 sctp_alloc_a_chunk(stcb, chk);
11336 if (chk == NULL) {
11337 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Gak, can't get a chunk for hb\n");
11338 return;
11339 }
11340
11341 chk->copy_by_ref = 0;
11342 chk->rec.chunk_id.id = SCTP_HEARTBEAT_REQUEST;
11343 chk->rec.chunk_id.can_take_data = 1;
11344 chk->flags = 0;
11345 chk->asoc = &stcb->asoc;
11346 chk->send_size = sizeof(struct sctp_heartbeat_chunk);
11347
11348 chk->data = sctp_get_mbuf_for_msg(chk->send_size, 0, M_NOWAIT, 1, MT_HEADER);
11349 if (chk->data == NULL) {
11350 sctp_free_a_chunk(stcb, chk, so_locked);
11351 return;
11352 }
11353 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11354 SCTP_BUF_LEN(chk->data) = chk->send_size;
11355 chk->sent = SCTP_DATAGRAM_UNSENT;
11356 chk->snd_count = 0;
11357 chk->whoTo = net;
11358 atomic_add_int(&chk->whoTo->ref_count, 1);
11359 /* Now we have a mbuf that we can fill in with the details */
11360 hb = mtod(chk->data, struct sctp_heartbeat_chunk *);
11361 memset(hb, 0, sizeof(struct sctp_heartbeat_chunk));
11362 /* fill out chunk header */
11363 hb->ch.chunk_type = SCTP_HEARTBEAT_REQUEST;
11364 hb->ch.chunk_flags = 0;
11365 hb->ch.chunk_length = htons(chk->send_size);
11366 /* Fill out hb parameter */
11367 hb->heartbeat.hb_info.ph.param_type = htons(SCTP_HEARTBEAT_INFO);
11368 hb->heartbeat.hb_info.ph.param_length = htons(sizeof(struct sctp_heartbeat_info_param));
11369 hb->heartbeat.hb_info.time_value_1 = now.tv_sec;
11370 hb->heartbeat.hb_info.time_value_2 = now.tv_usec;
11371 /* Did our user request this one, put it in */
11372 hb->heartbeat.hb_info.addr_family = (uint8_t)net->ro._l_addr.sa.sa_family;
11373 hb->heartbeat.hb_info.addr_len = net->ro._l_addr.sa.sa_len;
11374 if (net->dest_state & SCTP_ADDR_UNCONFIRMED) {
11375 /*
11376 * we only take from the entropy pool if the address is not
11377 * confirmed.
11378 */
11379 net->heartbeat_random1 = hb->heartbeat.hb_info.random_value1 = sctp_select_initial_TSN(&stcb->sctp_ep->sctp_ep);
11380 net->heartbeat_random2 = hb->heartbeat.hb_info.random_value2 = sctp_select_initial_TSN(&stcb->sctp_ep->sctp_ep);
11381 } else {
11382 net->heartbeat_random1 = hb->heartbeat.hb_info.random_value1 = 0;
11383 net->heartbeat_random2 = hb->heartbeat.hb_info.random_value2 = 0;
11384 }
11385 switch (net->ro._l_addr.sa.sa_family) {
11386 #ifdef INET
11387 case AF_INET:
11388 memcpy(hb->heartbeat.hb_info.address,
11389 &net->ro._l_addr.sin.sin_addr,
11390 sizeof(net->ro._l_addr.sin.sin_addr));
11391 break;
11392 #endif
11393 #ifdef INET6
11394 case AF_INET6:
11395 memcpy(hb->heartbeat.hb_info.address,
11396 &net->ro._l_addr.sin6.sin6_addr,
11397 sizeof(net->ro._l_addr.sin6.sin6_addr));
11398 break;
11399 #endif
11400 default:
11401 if (chk->data) {
11402 sctp_m_freem(chk->data);
11403 chk->data = NULL;
11404 }
11405 sctp_free_a_chunk(stcb, chk, so_locked);
11406 return;
11407 break;
11408 }
11409 net->hb_responded = 0;
11410 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
11411 stcb->asoc.ctrl_queue_cnt++;
11412 SCTP_STAT_INCR(sctps_sendheartbeat);
11413 return;
11414 }
11415
11416 void
11417 sctp_send_ecn_echo(struct sctp_tcb *stcb, struct sctp_nets *net,
11418 uint32_t high_tsn)
11419 {
11420 struct sctp_association *asoc;
11421 struct sctp_ecne_chunk *ecne;
11422 struct sctp_tmit_chunk *chk;
11423
11424 if (net == NULL) {
11425 return;
11426 }
11427 asoc = &stcb->asoc;
11428 SCTP_TCB_LOCK_ASSERT(stcb);
11429 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
11430 if ((chk->rec.chunk_id.id == SCTP_ECN_ECHO) && (net == chk->whoTo)) {
11431 /* found a previous ECN_ECHO update it if needed */
11432 uint32_t cnt, ctsn;
11433
11434 ecne = mtod(chk->data, struct sctp_ecne_chunk *);
11435 ctsn = ntohl(ecne->tsn);
11436 if (SCTP_TSN_GT(high_tsn, ctsn)) {
11437 ecne->tsn = htonl(high_tsn);
11438 SCTP_STAT_INCR(sctps_queue_upd_ecne);
11439 }
11440 cnt = ntohl(ecne->num_pkts_since_cwr);
11441 cnt++;
11442 ecne->num_pkts_since_cwr = htonl(cnt);
11443 return;
11444 }
11445 }
11446 /* nope could not find one to update so we must build one */
11447 sctp_alloc_a_chunk(stcb, chk);
11448 if (chk == NULL) {
11449 return;
11450 }
11451 SCTP_STAT_INCR(sctps_queue_upd_ecne);
11452 chk->copy_by_ref = 0;
11453 chk->rec.chunk_id.id = SCTP_ECN_ECHO;
11454 chk->rec.chunk_id.can_take_data = 0;
11455 chk->flags = 0;
11456 chk->asoc = &stcb->asoc;
11457 chk->send_size = sizeof(struct sctp_ecne_chunk);
11458 chk->data = sctp_get_mbuf_for_msg(chk->send_size, 0, M_NOWAIT, 1, MT_HEADER);
11459 if (chk->data == NULL) {
11460 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11461 return;
11462 }
11463 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11464 SCTP_BUF_LEN(chk->data) = chk->send_size;
11465 chk->sent = SCTP_DATAGRAM_UNSENT;
11466 chk->snd_count = 0;
11467 chk->whoTo = net;
11468 atomic_add_int(&chk->whoTo->ref_count, 1);
11469
11470 stcb->asoc.ecn_echo_cnt_onq++;
11471 ecne = mtod(chk->data, struct sctp_ecne_chunk *);
11472 ecne->ch.chunk_type = SCTP_ECN_ECHO;
11473 ecne->ch.chunk_flags = 0;
11474 ecne->ch.chunk_length = htons(sizeof(struct sctp_ecne_chunk));
11475 ecne->tsn = htonl(high_tsn);
11476 ecne->num_pkts_since_cwr = htonl(1);
11477 TAILQ_INSERT_HEAD(&stcb->asoc.control_send_queue, chk, sctp_next);
11478 asoc->ctrl_queue_cnt++;
11479 }
11480
11481 void
11482 sctp_send_packet_dropped(struct sctp_tcb *stcb, struct sctp_nets *net,
11483 struct mbuf *m, int len, int iphlen, int bad_crc)
11484 {
11485 struct sctp_association *asoc;
11486 struct sctp_pktdrop_chunk *drp;
11487 struct sctp_tmit_chunk *chk;
11488 uint8_t *datap;
11489 int was_trunc = 0;
11490 int fullsz = 0;
11491 long spc;
11492 int offset;
11493 struct sctp_chunkhdr *ch, chunk_buf;
11494 unsigned int chk_length;
11495
11496 if (!stcb) {
11497 return;
11498 }
11499 asoc = &stcb->asoc;
11500 SCTP_TCB_LOCK_ASSERT(stcb);
11501 if (asoc->pktdrop_supported == 0) {
11502 /*-
11503 * peer must declare support before I send one.
11504 */
11505 return;
11506 }
11507 if (stcb->sctp_socket == NULL) {
11508 return;
11509 }
11510 sctp_alloc_a_chunk(stcb, chk);
11511 if (chk == NULL) {
11512 return;
11513 }
11514 chk->copy_by_ref = 0;
11515 chk->rec.chunk_id.id = SCTP_PACKET_DROPPED;
11516 chk->rec.chunk_id.can_take_data = 1;
11517 chk->flags = 0;
11518 len -= iphlen;
11519 chk->send_size = len;
11520 /* Validate that we do not have an ABORT in here. */
11521 offset = iphlen + sizeof(struct sctphdr);
11522 ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, offset,
11523 sizeof(*ch), (uint8_t *)&chunk_buf);
11524 while (ch != NULL) {
11525 chk_length = ntohs(ch->chunk_length);
11526 if (chk_length < sizeof(*ch)) {
11527 /* break to abort land */
11528 break;
11529 }
11530 switch (ch->chunk_type) {
11531 case SCTP_PACKET_DROPPED:
11532 case SCTP_ABORT_ASSOCIATION:
11533 case SCTP_INITIATION_ACK:
11534 /**
11535 * We don't respond with an PKT-DROP to an ABORT
11536 * or PKT-DROP. We also do not respond to an
11537 * INIT-ACK, because we can't know if the initiation
11538 * tag is correct or not.
11539 */
11540 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11541 return;
11542 default:
11543 break;
11544 }
11545 offset += SCTP_SIZE32(chk_length);
11546 ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, offset,
11547 sizeof(*ch), (uint8_t *)&chunk_buf);
11548 }
11549
11550 if ((len + SCTP_MAX_OVERHEAD + sizeof(struct sctp_pktdrop_chunk)) >
11551 min(stcb->asoc.smallest_mtu, MCLBYTES)) {
11552 /*
11553 * only send 1 mtu worth, trim off the excess on the end.
11554 */
11555 fullsz = len;
11556 len = min(stcb->asoc.smallest_mtu, MCLBYTES) - SCTP_MAX_OVERHEAD;
11557 was_trunc = 1;
11558 }
11559 chk->asoc = &stcb->asoc;
11560 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
11561 if (chk->data == NULL) {
11562 jump_out:
11563 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11564 return;
11565 }
11566 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11567 drp = mtod(chk->data, struct sctp_pktdrop_chunk *);
11568 if (drp == NULL) {
11569 sctp_m_freem(chk->data);
11570 chk->data = NULL;
11571 goto jump_out;
11572 }
11573 chk->book_size = SCTP_SIZE32((chk->send_size + sizeof(struct sctp_pktdrop_chunk) +
11574 sizeof(struct sctphdr) + SCTP_MED_OVERHEAD));
11575 chk->book_size_scale = 0;
11576 if (was_trunc) {
11577 drp->ch.chunk_flags = SCTP_PACKET_TRUNCATED;
11578 drp->trunc_len = htons(fullsz);
11579 /*
11580 * Len is already adjusted to size minus overhead above take
11581 * out the pkt_drop chunk itself from it.
11582 */
11583 chk->send_size = (uint16_t)(len - sizeof(struct sctp_pktdrop_chunk));
11584 len = chk->send_size;
11585 } else {
11586 /* no truncation needed */
11587 drp->ch.chunk_flags = 0;
11588 drp->trunc_len = htons(0);
11589 }
11590 if (bad_crc) {
11591 drp->ch.chunk_flags |= SCTP_BADCRC;
11592 }
11593 chk->send_size += sizeof(struct sctp_pktdrop_chunk);
11594 SCTP_BUF_LEN(chk->data) = chk->send_size;
11595 chk->sent = SCTP_DATAGRAM_UNSENT;
11596 chk->snd_count = 0;
11597 if (net) {
11598 /* we should hit here */
11599 chk->whoTo = net;
11600 atomic_add_int(&chk->whoTo->ref_count, 1);
11601 } else {
11602 chk->whoTo = NULL;
11603 }
11604 drp->ch.chunk_type = SCTP_PACKET_DROPPED;
11605 drp->ch.chunk_length = htons(chk->send_size);
11606 spc = SCTP_SB_LIMIT_RCV(stcb->sctp_socket);
11607 if (spc < 0) {
11608 spc = 0;
11609 }
11610 drp->bottle_bw = htonl(spc);
11611 if (asoc->my_rwnd) {
11612 drp->current_onq = htonl(asoc->size_on_reasm_queue +
11613 asoc->size_on_all_streams +
11614 asoc->my_rwnd_control_len +
11615 stcb->sctp_socket->so_rcv.sb_cc);
11616 } else {
11617 /*-
11618 * If my rwnd is 0, possibly from mbuf depletion as well as
11619 * space used, tell the peer there is NO space aka onq == bw
11620 */
11621 drp->current_onq = htonl(spc);
11622 }
11623 drp->reserved = 0;
11624 datap = drp->data;
11625 m_copydata(m, iphlen, len, (caddr_t)datap);
11626 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
11627 asoc->ctrl_queue_cnt++;
11628 }
11629
11630 void
11631 sctp_send_cwr(struct sctp_tcb *stcb, struct sctp_nets *net, uint32_t high_tsn, uint8_t override)
11632 {
11633 struct sctp_association *asoc;
11634 struct sctp_cwr_chunk *cwr;
11635 struct sctp_tmit_chunk *chk;
11636
11637 SCTP_TCB_LOCK_ASSERT(stcb);
11638 if (net == NULL) {
11639 return;
11640 }
11641 asoc = &stcb->asoc;
11642 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
11643 if ((chk->rec.chunk_id.id == SCTP_ECN_CWR) && (net == chk->whoTo)) {
11644 /*
11645 * found a previous CWR queued to same destination
11646 * update it if needed
11647 */
11648 uint32_t ctsn;
11649
11650 cwr = mtod(chk->data, struct sctp_cwr_chunk *);
11651 ctsn = ntohl(cwr->tsn);
11652 if (SCTP_TSN_GT(high_tsn, ctsn)) {
11653 cwr->tsn = htonl(high_tsn);
11654 }
11655 if (override & SCTP_CWR_REDUCE_OVERRIDE) {
11656 /* Make sure override is carried */
11657 cwr->ch.chunk_flags |= SCTP_CWR_REDUCE_OVERRIDE;
11658 }
11659 return;
11660 }
11661 }
11662 sctp_alloc_a_chunk(stcb, chk);
11663 if (chk == NULL) {
11664 return;
11665 }
11666 chk->copy_by_ref = 0;
11667 chk->rec.chunk_id.id = SCTP_ECN_CWR;
11668 chk->rec.chunk_id.can_take_data = 1;
11669 chk->flags = 0;
11670 chk->asoc = &stcb->asoc;
11671 chk->send_size = sizeof(struct sctp_cwr_chunk);
11672 chk->data = sctp_get_mbuf_for_msg(chk->send_size, 0, M_NOWAIT, 1, MT_HEADER);
11673 if (chk->data == NULL) {
11674 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11675 return;
11676 }
11677 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11678 SCTP_BUF_LEN(chk->data) = chk->send_size;
11679 chk->sent = SCTP_DATAGRAM_UNSENT;
11680 chk->snd_count = 0;
11681 chk->whoTo = net;
11682 atomic_add_int(&chk->whoTo->ref_count, 1);
11683 cwr = mtod(chk->data, struct sctp_cwr_chunk *);
11684 cwr->ch.chunk_type = SCTP_ECN_CWR;
11685 cwr->ch.chunk_flags = override;
11686 cwr->ch.chunk_length = htons(sizeof(struct sctp_cwr_chunk));
11687 cwr->tsn = htonl(high_tsn);
11688 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
11689 asoc->ctrl_queue_cnt++;
11690 }
11691
11692 static int
11693 sctp_add_stream_reset_out(struct sctp_tcb *stcb, struct sctp_tmit_chunk *chk,
11694 uint32_t seq, uint32_t resp_seq, uint32_t last_sent)
11695 {
11696 uint16_t len, old_len, i;
11697 struct sctp_stream_reset_out_request *req_out;
11698 struct sctp_chunkhdr *ch;
11699 int at;
11700 int number_entries = 0;
11701
11702 ch = mtod(chk->data, struct sctp_chunkhdr *);
11703 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11704 /* get to new offset for the param. */
11705 req_out = (struct sctp_stream_reset_out_request *)((caddr_t)ch + len);
11706 /* now how long will this param be? */
11707 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
11708 if ((stcb->asoc.strmout[i].state == SCTP_STREAM_RESET_PENDING) &&
11709 (stcb->asoc.strmout[i].chunks_on_queues == 0) &&
11710 TAILQ_EMPTY(&stcb->asoc.strmout[i].outqueue)) {
11711 number_entries++;
11712 }
11713 }
11714 if (number_entries == 0) {
11715 return (0);
11716 }
11717 if (number_entries == stcb->asoc.streamoutcnt) {
11718 number_entries = 0;
11719 }
11720 if (number_entries > SCTP_MAX_STREAMS_AT_ONCE_RESET) {
11721 number_entries = SCTP_MAX_STREAMS_AT_ONCE_RESET;
11722 }
11723 len = (uint16_t)(sizeof(struct sctp_stream_reset_out_request) + (sizeof(uint16_t) * number_entries));
11724 req_out->ph.param_type = htons(SCTP_STR_RESET_OUT_REQUEST);
11725 req_out->ph.param_length = htons(len);
11726 req_out->request_seq = htonl(seq);
11727 req_out->response_seq = htonl(resp_seq);
11728 req_out->send_reset_at_tsn = htonl(last_sent);
11729 at = 0;
11730 if (number_entries) {
11731 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
11732 if ((stcb->asoc.strmout[i].state == SCTP_STREAM_RESET_PENDING) &&
11733 (stcb->asoc.strmout[i].chunks_on_queues == 0) &&
11734 TAILQ_EMPTY(&stcb->asoc.strmout[i].outqueue)) {
11735 req_out->list_of_streams[at] = htons(i);
11736 at++;
11737 stcb->asoc.strmout[i].state = SCTP_STREAM_RESET_IN_FLIGHT;
11738 if (at >= number_entries) {
11739 break;
11740 }
11741 }
11742 }
11743 } else {
11744 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
11745 stcb->asoc.strmout[i].state = SCTP_STREAM_RESET_IN_FLIGHT;
11746 }
11747 }
11748 if (SCTP_SIZE32(len) > len) {
11749 /*-
11750 * Need to worry about the pad we may end up adding to the
11751 * end. This is easy since the struct is either aligned to 4
11752 * bytes or 2 bytes off.
11753 */
11754 req_out->list_of_streams[number_entries] = 0;
11755 }
11756 /* now fix the chunk length */
11757 ch->chunk_length = htons(len + old_len);
11758 chk->book_size = len + old_len;
11759 chk->book_size_scale = 0;
11760 chk->send_size = SCTP_SIZE32(chk->book_size);
11761 SCTP_BUF_LEN(chk->data) = chk->send_size;
11762 return (1);
11763 }
11764
11765 static void
11766 sctp_add_stream_reset_in(struct sctp_tmit_chunk *chk,
11767 int number_entries, uint16_t *list,
11768 uint32_t seq)
11769 {
11770 uint16_t len, old_len, i;
11771 struct sctp_stream_reset_in_request *req_in;
11772 struct sctp_chunkhdr *ch;
11773
11774 ch = mtod(chk->data, struct sctp_chunkhdr *);
11775 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11776
11777 /* get to new offset for the param. */
11778 req_in = (struct sctp_stream_reset_in_request *)((caddr_t)ch + len);
11779 /* now how long will this param be? */
11780 len = (uint16_t)(sizeof(struct sctp_stream_reset_in_request) + (sizeof(uint16_t) * number_entries));
11781 req_in->ph.param_type = htons(SCTP_STR_RESET_IN_REQUEST);
11782 req_in->ph.param_length = htons(len);
11783 req_in->request_seq = htonl(seq);
11784 if (number_entries) {
11785 for (i = 0; i < number_entries; i++) {
11786 req_in->list_of_streams[i] = htons(list[i]);
11787 }
11788 }
11789 if (SCTP_SIZE32(len) > len) {
11790 /*-
11791 * Need to worry about the pad we may end up adding to the
11792 * end. This is easy since the struct is either aligned to 4
11793 * bytes or 2 bytes off.
11794 */
11795 req_in->list_of_streams[number_entries] = 0;
11796 }
11797 /* now fix the chunk length */
11798 ch->chunk_length = htons(len + old_len);
11799 chk->book_size = len + old_len;
11800 chk->book_size_scale = 0;
11801 chk->send_size = SCTP_SIZE32(chk->book_size);
11802 SCTP_BUF_LEN(chk->data) = chk->send_size;
11803 return;
11804 }
11805
11806 static void
11807 sctp_add_stream_reset_tsn(struct sctp_tmit_chunk *chk,
11808 uint32_t seq)
11809 {
11810 uint16_t len, old_len;
11811 struct sctp_stream_reset_tsn_request *req_tsn;
11812 struct sctp_chunkhdr *ch;
11813
11814 ch = mtod(chk->data, struct sctp_chunkhdr *);
11815 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11816
11817 /* get to new offset for the param. */
11818 req_tsn = (struct sctp_stream_reset_tsn_request *)((caddr_t)ch + len);
11819 /* now how long will this param be? */
11820 len = sizeof(struct sctp_stream_reset_tsn_request);
11821 req_tsn->ph.param_type = htons(SCTP_STR_RESET_TSN_REQUEST);
11822 req_tsn->ph.param_length = htons(len);
11823 req_tsn->request_seq = htonl(seq);
11824
11825 /* now fix the chunk length */
11826 ch->chunk_length = htons(len + old_len);
11827 chk->send_size = len + old_len;
11828 chk->book_size = SCTP_SIZE32(chk->send_size);
11829 chk->book_size_scale = 0;
11830 SCTP_BUF_LEN(chk->data) = SCTP_SIZE32(chk->send_size);
11831 return;
11832 }
11833
11834 void
11835 sctp_add_stream_reset_result(struct sctp_tmit_chunk *chk,
11836 uint32_t resp_seq, uint32_t result)
11837 {
11838 uint16_t len, old_len;
11839 struct sctp_stream_reset_response *resp;
11840 struct sctp_chunkhdr *ch;
11841
11842 ch = mtod(chk->data, struct sctp_chunkhdr *);
11843 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11844
11845 /* get to new offset for the param. */
11846 resp = (struct sctp_stream_reset_response *)((caddr_t)ch + len);
11847 /* now how long will this param be? */
11848 len = sizeof(struct sctp_stream_reset_response);
11849 resp->ph.param_type = htons(SCTP_STR_RESET_RESPONSE);
11850 resp->ph.param_length = htons(len);
11851 resp->response_seq = htonl(resp_seq);
11852 resp->result = ntohl(result);
11853
11854 /* now fix the chunk length */
11855 ch->chunk_length = htons(len + old_len);
11856 chk->book_size = len + old_len;
11857 chk->book_size_scale = 0;
11858 chk->send_size = SCTP_SIZE32(chk->book_size);
11859 SCTP_BUF_LEN(chk->data) = chk->send_size;
11860 return;
11861 }
11862
11863 void
11864 sctp_send_deferred_reset_response(struct sctp_tcb *stcb,
11865 struct sctp_stream_reset_list *ent,
11866 int response)
11867 {
11868 struct sctp_association *asoc;
11869 struct sctp_tmit_chunk *chk;
11870 struct sctp_chunkhdr *ch;
11871
11872 asoc = &stcb->asoc;
11873
11874 /*
11875 * Reset our last reset action to the new one IP -> response
11876 * (PERFORMED probably). This assures that if we fail to send, a
11877 * retran from the peer will get the new response.
11878 */
11879 asoc->last_reset_action[0] = response;
11880 if (asoc->stream_reset_outstanding) {
11881 return;
11882 }
11883 sctp_alloc_a_chunk(stcb, chk);
11884 if (chk == NULL) {
11885 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
11886 return;
11887 }
11888 chk->copy_by_ref = 0;
11889 chk->rec.chunk_id.id = SCTP_STREAM_RESET;
11890 chk->rec.chunk_id.can_take_data = 0;
11891 chk->flags = 0;
11892 chk->asoc = &stcb->asoc;
11893 chk->book_size = sizeof(struct sctp_chunkhdr);
11894 chk->send_size = SCTP_SIZE32(chk->book_size);
11895 chk->book_size_scale = 0;
11896 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
11897 if (chk->data == NULL) {
11898 sctp_free_a_chunk(stcb, chk, SCTP_SO_LOCKED);
11899 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
11900 return;
11901 }
11902 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11903 /* setup chunk parameters */
11904 chk->sent = SCTP_DATAGRAM_UNSENT;
11905 chk->snd_count = 0;
11906 if (stcb->asoc.alternate) {
11907 chk->whoTo = stcb->asoc.alternate;
11908 } else {
11909 chk->whoTo = stcb->asoc.primary_destination;
11910 }
11911 ch = mtod(chk->data, struct sctp_chunkhdr *);
11912 ch->chunk_type = SCTP_STREAM_RESET;
11913 ch->chunk_flags = 0;
11914 ch->chunk_length = htons(chk->book_size);
11915 atomic_add_int(&chk->whoTo->ref_count, 1);
11916 SCTP_BUF_LEN(chk->data) = chk->send_size;
11917 sctp_add_stream_reset_result(chk, ent->seq, response);
11918 /* insert the chunk for sending */
11919 TAILQ_INSERT_TAIL(&asoc->control_send_queue,
11920 chk,
11921 sctp_next);
11922 asoc->ctrl_queue_cnt++;
11923 }
11924
11925 void
11926 sctp_add_stream_reset_result_tsn(struct sctp_tmit_chunk *chk,
11927 uint32_t resp_seq, uint32_t result,
11928 uint32_t send_una, uint32_t recv_next)
11929 {
11930 uint16_t len, old_len;
11931 struct sctp_stream_reset_response_tsn *resp;
11932 struct sctp_chunkhdr *ch;
11933
11934 ch = mtod(chk->data, struct sctp_chunkhdr *);
11935 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11936
11937 /* get to new offset for the param. */
11938 resp = (struct sctp_stream_reset_response_tsn *)((caddr_t)ch + len);
11939 /* now how long will this param be? */
11940 len = sizeof(struct sctp_stream_reset_response_tsn);
11941 resp->ph.param_type = htons(SCTP_STR_RESET_RESPONSE);
11942 resp->ph.param_length = htons(len);
11943 resp->response_seq = htonl(resp_seq);
11944 resp->result = htonl(result);
11945 resp->senders_next_tsn = htonl(send_una);
11946 resp->receivers_next_tsn = htonl(recv_next);
11947
11948 /* now fix the chunk length */
11949 ch->chunk_length = htons(len + old_len);
11950 chk->book_size = len + old_len;
11951 chk->send_size = SCTP_SIZE32(chk->book_size);
11952 chk->book_size_scale = 0;
11953 SCTP_BUF_LEN(chk->data) = chk->send_size;
11954 return;
11955 }
11956
11957 static void
11958 sctp_add_an_out_stream(struct sctp_tmit_chunk *chk,
11959 uint32_t seq,
11960 uint16_t adding)
11961 {
11962 uint16_t len, old_len;
11963 struct sctp_chunkhdr *ch;
11964 struct sctp_stream_reset_add_strm *addstr;
11965
11966 ch = mtod(chk->data, struct sctp_chunkhdr *);
11967 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11968
11969 /* get to new offset for the param. */
11970 addstr = (struct sctp_stream_reset_add_strm *)((caddr_t)ch + len);
11971 /* now how long will this param be? */
11972 len = sizeof(struct sctp_stream_reset_add_strm);
11973
11974 /* Fill it out. */
11975 addstr->ph.param_type = htons(SCTP_STR_RESET_ADD_OUT_STREAMS);
11976 addstr->ph.param_length = htons(len);
11977 addstr->request_seq = htonl(seq);
11978 addstr->number_of_streams = htons(adding);
11979 addstr->reserved = 0;
11980
11981 /* now fix the chunk length */
11982 ch->chunk_length = htons(len + old_len);
11983 chk->send_size = len + old_len;
11984 chk->book_size = SCTP_SIZE32(chk->send_size);
11985 chk->book_size_scale = 0;
11986 SCTP_BUF_LEN(chk->data) = SCTP_SIZE32(chk->send_size);
11987 return;
11988 }
11989
11990 static void
11991 sctp_add_an_in_stream(struct sctp_tmit_chunk *chk,
11992 uint32_t seq,
11993 uint16_t adding)
11994 {
11995 uint16_t len, old_len;
11996 struct sctp_chunkhdr *ch;
11997 struct sctp_stream_reset_add_strm *addstr;
11998
11999 ch = mtod(chk->data, struct sctp_chunkhdr *);
12000 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
12001
12002 /* get to new offset for the param. */
12003 addstr = (struct sctp_stream_reset_add_strm *)((caddr_t)ch + len);
12004 /* now how long will this param be? */
12005 len = sizeof(struct sctp_stream_reset_add_strm);
12006 /* Fill it out. */
12007 addstr->ph.param_type = htons(SCTP_STR_RESET_ADD_IN_STREAMS);
12008 addstr->ph.param_length = htons(len);
12009 addstr->request_seq = htonl(seq);
12010 addstr->number_of_streams = htons(adding);
12011 addstr->reserved = 0;
12012
12013 /* now fix the chunk length */
12014 ch->chunk_length = htons(len + old_len);
12015 chk->send_size = len + old_len;
12016 chk->book_size = SCTP_SIZE32(chk->send_size);
12017 chk->book_size_scale = 0;
12018 SCTP_BUF_LEN(chk->data) = SCTP_SIZE32(chk->send_size);
12019 return;
12020 }
12021
12022 int
12023 sctp_send_stream_reset_out_if_possible(struct sctp_tcb *stcb, int so_locked)
12024 {
12025 struct sctp_association *asoc;
12026 struct sctp_tmit_chunk *chk;
12027 struct sctp_chunkhdr *ch;
12028 uint32_t seq;
12029
12030 asoc = &stcb->asoc;
12031 asoc->trigger_reset = 0;
12032 if (asoc->stream_reset_outstanding) {
12033 return (EALREADY);
12034 }
12035 sctp_alloc_a_chunk(stcb, chk);
12036 if (chk == NULL) {
12037 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12038 return (ENOMEM);
12039 }
12040 chk->copy_by_ref = 0;
12041 chk->rec.chunk_id.id = SCTP_STREAM_RESET;
12042 chk->rec.chunk_id.can_take_data = 0;
12043 chk->flags = 0;
12044 chk->asoc = &stcb->asoc;
12045 chk->book_size = sizeof(struct sctp_chunkhdr);
12046 chk->send_size = SCTP_SIZE32(chk->book_size);
12047 chk->book_size_scale = 0;
12048 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
12049 if (chk->data == NULL) {
12050 sctp_free_a_chunk(stcb, chk, so_locked);
12051 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12052 return (ENOMEM);
12053 }
12054 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
12055
12056 /* setup chunk parameters */
12057 chk->sent = SCTP_DATAGRAM_UNSENT;
12058 chk->snd_count = 0;
12059 if (stcb->asoc.alternate) {
12060 chk->whoTo = stcb->asoc.alternate;
12061 } else {
12062 chk->whoTo = stcb->asoc.primary_destination;
12063 }
12064 ch = mtod(chk->data, struct sctp_chunkhdr *);
12065 ch->chunk_type = SCTP_STREAM_RESET;
12066 ch->chunk_flags = 0;
12067 ch->chunk_length = htons(chk->book_size);
12068 atomic_add_int(&chk->whoTo->ref_count, 1);
12069 SCTP_BUF_LEN(chk->data) = chk->send_size;
12070 seq = stcb->asoc.str_reset_seq_out;
12071 if (sctp_add_stream_reset_out(stcb, chk, seq, (stcb->asoc.str_reset_seq_in - 1), (stcb->asoc.sending_seq - 1))) {
12072 seq++;
12073 asoc->stream_reset_outstanding++;
12074 } else {
12075 m_freem(chk->data);
12076 chk->data = NULL;
12077 sctp_free_a_chunk(stcb, chk, so_locked);
12078 return (ENOENT);
12079 }
12080 asoc->str_reset = chk;
12081 /* insert the chunk for sending */
12082 TAILQ_INSERT_TAIL(&asoc->control_send_queue,
12083 chk,
12084 sctp_next);
12085 asoc->ctrl_queue_cnt++;
12086
12087 if (stcb->asoc.send_sack) {
12088 sctp_send_sack(stcb, so_locked);
12089 }
12090 sctp_timer_start(SCTP_TIMER_TYPE_STRRESET, stcb->sctp_ep, stcb, chk->whoTo);
12091 return (0);
12092 }
12093
12094 int
12095 sctp_send_str_reset_req(struct sctp_tcb *stcb,
12096 uint16_t number_entries, uint16_t *list,
12097 uint8_t send_in_req,
12098 uint8_t send_tsn_req,
12099 uint8_t add_stream,
12100 uint16_t adding_o,
12101 uint16_t adding_i, uint8_t peer_asked)
12102 {
12103 struct sctp_association *asoc;
12104 struct sctp_tmit_chunk *chk;
12105 struct sctp_chunkhdr *ch;
12106 int can_send_out_req = 0;
12107 uint32_t seq;
12108
12109 asoc = &stcb->asoc;
12110 if (asoc->stream_reset_outstanding) {
12111 /*-
12112 * Already one pending, must get ACK back to clear the flag.
12113 */
12114 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EBUSY);
12115 return (EBUSY);
12116 }
12117 if ((send_in_req == 0) && (send_tsn_req == 0) &&
12118 (add_stream == 0)) {
12119 /* nothing to do */
12120 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12121 return (EINVAL);
12122 }
12123 if (send_tsn_req && send_in_req) {
12124 /* error, can't do that */
12125 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12126 return (EINVAL);
12127 } else if (send_in_req) {
12128 can_send_out_req = 1;
12129 }
12130 if (number_entries > (MCLBYTES -
12131 SCTP_MIN_OVERHEAD -
12132 sizeof(struct sctp_chunkhdr) -
12133 sizeof(struct sctp_stream_reset_out_request)) /
12134 sizeof(uint16_t)) {
12135 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12136 return (ENOMEM);
12137 }
12138 sctp_alloc_a_chunk(stcb, chk);
12139 if (chk == NULL) {
12140 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12141 return (ENOMEM);
12142 }
12143 chk->copy_by_ref = 0;
12144 chk->rec.chunk_id.id = SCTP_STREAM_RESET;
12145 chk->rec.chunk_id.can_take_data = 0;
12146 chk->flags = 0;
12147 chk->asoc = &stcb->asoc;
12148 chk->book_size = sizeof(struct sctp_chunkhdr);
12149 chk->send_size = SCTP_SIZE32(chk->book_size);
12150 chk->book_size_scale = 0;
12151 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
12152 if (chk->data == NULL) {
12153 sctp_free_a_chunk(stcb, chk, SCTP_SO_LOCKED);
12154 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12155 return (ENOMEM);
12156 }
12157 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
12158
12159 /* setup chunk parameters */
12160 chk->sent = SCTP_DATAGRAM_UNSENT;
12161 chk->snd_count = 0;
12162 if (stcb->asoc.alternate) {
12163 chk->whoTo = stcb->asoc.alternate;
12164 } else {
12165 chk->whoTo = stcb->asoc.primary_destination;
12166 }
12167 atomic_add_int(&chk->whoTo->ref_count, 1);
12168 ch = mtod(chk->data, struct sctp_chunkhdr *);
12169 ch->chunk_type = SCTP_STREAM_RESET;
12170 ch->chunk_flags = 0;
12171 ch->chunk_length = htons(chk->book_size);
12172 SCTP_BUF_LEN(chk->data) = chk->send_size;
12173
12174 seq = stcb->asoc.str_reset_seq_out;
12175 if (can_send_out_req) {
12176 int ret;
12177
12178 ret = sctp_add_stream_reset_out(stcb, chk, seq, (stcb->asoc.str_reset_seq_in - 1), (stcb->asoc.sending_seq - 1));
12179 if (ret) {
12180 seq++;
12181 asoc->stream_reset_outstanding++;
12182 }
12183 }
12184 if ((add_stream & 1) &&
12185 ((stcb->asoc.strm_realoutsize - stcb->asoc.streamoutcnt) < adding_o)) {
12186 /* Need to allocate more */
12187 struct sctp_stream_out *oldstream;
12188 struct sctp_stream_queue_pending *sp, *nsp;
12189 int i;
12190 #if defined(SCTP_DETAILED_STR_STATS)
12191 int j;
12192 #endif
12193
12194 oldstream = stcb->asoc.strmout;
12195 /* get some more */
12196 SCTP_MALLOC(stcb->asoc.strmout, struct sctp_stream_out *,
12197 (stcb->asoc.streamoutcnt + adding_o) * sizeof(struct sctp_stream_out),
12198 SCTP_M_STRMO);
12199 if (stcb->asoc.strmout == NULL) {
12200 uint8_t x;
12201
12202 stcb->asoc.strmout = oldstream;
12203 /* Turn off the bit */
12204 x = add_stream & 0xfe;
12205 add_stream = x;
12206 goto skip_stuff;
12207 }
12208 /*
12209 * Ok now we proceed with copying the old out stuff and
12210 * initializing the new stuff.
12211 */
12212 SCTP_TCB_SEND_LOCK(stcb);
12213 stcb->asoc.ss_functions.sctp_ss_clear(stcb, &stcb->asoc, 0, 1);
12214 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
12215 TAILQ_INIT(&stcb->asoc.strmout[i].outqueue);
12216 stcb->asoc.strmout[i].chunks_on_queues = oldstream[i].chunks_on_queues;
12217 stcb->asoc.strmout[i].next_mid_ordered = oldstream[i].next_mid_ordered;
12218 stcb->asoc.strmout[i].next_mid_unordered = oldstream[i].next_mid_unordered;
12219 stcb->asoc.strmout[i].last_msg_incomplete = oldstream[i].last_msg_incomplete;
12220 stcb->asoc.strmout[i].sid = i;
12221 stcb->asoc.strmout[i].state = oldstream[i].state;
12222 /* FIX ME FIX ME */
12223 /*
12224 * This should be a SS_COPY operation FIX ME STREAM
12225 * SCHEDULER EXPERT
12226 */
12227 stcb->asoc.ss_functions.sctp_ss_init_stream(stcb, &stcb->asoc.strmout[i], &oldstream[i]);
12228 /* now anything on those queues? */
12229 TAILQ_FOREACH_SAFE(sp, &oldstream[i].outqueue, next, nsp) {
12230 TAILQ_REMOVE(&oldstream[i].outqueue, sp, next);
12231 TAILQ_INSERT_TAIL(&stcb->asoc.strmout[i].outqueue, sp, next);
12232 }
12233
12234 }
12235 /* now the new streams */
12236 stcb->asoc.ss_functions.sctp_ss_init(stcb, &stcb->asoc, 1);
12237 for (i = stcb->asoc.streamoutcnt; i < (stcb->asoc.streamoutcnt + adding_o); i++) {
12238 TAILQ_INIT(&stcb->asoc.strmout[i].outqueue);
12239 stcb->asoc.strmout[i].chunks_on_queues = 0;
12240 #if defined(SCTP_DETAILED_STR_STATS)
12241 for (j = 0; j < SCTP_PR_SCTP_MAX + 1; j++) {
12242 stcb->asoc.strmout[i].abandoned_sent[j] = 0;
12243 stcb->asoc.strmout[i].abandoned_unsent[j] = 0;
12244 }
12245 #else
12246 stcb->asoc.strmout[i].abandoned_sent[0] = 0;
12247 stcb->asoc.strmout[i].abandoned_unsent[0] = 0;
12248 #endif
12249 stcb->asoc.strmout[i].next_mid_ordered = 0;
12250 stcb->asoc.strmout[i].next_mid_unordered = 0;
12251 stcb->asoc.strmout[i].sid = i;
12252 stcb->asoc.strmout[i].last_msg_incomplete = 0;
12253 stcb->asoc.ss_functions.sctp_ss_init_stream(stcb, &stcb->asoc.strmout[i], NULL);
12254 stcb->asoc.strmout[i].state = SCTP_STREAM_CLOSED;
12255 }
12256 stcb->asoc.strm_realoutsize = stcb->asoc.streamoutcnt + adding_o;
12257 SCTP_FREE(oldstream, SCTP_M_STRMO);
12258 SCTP_TCB_SEND_UNLOCK(stcb);
12259 }
12260 skip_stuff:
12261 if ((add_stream & 1) && (adding_o > 0)) {
12262 asoc->strm_pending_add_size = adding_o;
12263 asoc->peer_req_out = peer_asked;
12264 sctp_add_an_out_stream(chk, seq, adding_o);
12265 seq++;
12266 asoc->stream_reset_outstanding++;
12267 }
12268 if ((add_stream & 2) && (adding_i > 0)) {
12269 sctp_add_an_in_stream(chk, seq, adding_i);
12270 seq++;
12271 asoc->stream_reset_outstanding++;
12272 }
12273 if (send_in_req) {
12274 sctp_add_stream_reset_in(chk, number_entries, list, seq);
12275 seq++;
12276 asoc->stream_reset_outstanding++;
12277 }
12278 if (send_tsn_req) {
12279 sctp_add_stream_reset_tsn(chk, seq);
12280 asoc->stream_reset_outstanding++;
12281 }
12282 asoc->str_reset = chk;
12283 /* insert the chunk for sending */
12284 TAILQ_INSERT_TAIL(&asoc->control_send_queue,
12285 chk,
12286 sctp_next);
12287 asoc->ctrl_queue_cnt++;
12288 if (stcb->asoc.send_sack) {
12289 sctp_send_sack(stcb, SCTP_SO_LOCKED);
12290 }
12291 sctp_timer_start(SCTP_TIMER_TYPE_STRRESET, stcb->sctp_ep, stcb, chk->whoTo);
12292 return (0);
12293 }
12294
12295 void
12296 sctp_send_abort(struct mbuf *m, int iphlen, struct sockaddr *src, struct sockaddr *dst,
12297 struct sctphdr *sh, uint32_t vtag, struct mbuf *cause,
12298 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
12299 uint32_t vrf_id, uint16_t port)
12300 {
12301 /* Don't respond to an ABORT with an ABORT. */
12302 if (sctp_is_there_an_abort_here(m, iphlen, &vtag)) {
12303 if (cause)
12304 sctp_m_freem(cause);
12305 return;
12306 }
12307 sctp_send_resp_msg(src, dst, sh, vtag, SCTP_ABORT_ASSOCIATION, cause,
12308 mflowtype, mflowid, fibnum,
12309 vrf_id, port);
12310 return;
12311 }
12312
12313 void
12314 sctp_send_operr_to(struct sockaddr *src, struct sockaddr *dst,
12315 struct sctphdr *sh, uint32_t vtag, struct mbuf *cause,
12316 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
12317 uint32_t vrf_id, uint16_t port)
12318 {
12319 sctp_send_resp_msg(src, dst, sh, vtag, SCTP_OPERATION_ERROR, cause,
12320 mflowtype, mflowid, fibnum,
12321 vrf_id, port);
12322 return;
12323 }
12324
12325 static struct mbuf *
12326 sctp_copy_resume(struct uio *uio,
12327 int max_send_len,
12328 int user_marks_eor,
12329 int *error,
12330 uint32_t *sndout,
12331 struct mbuf **new_tail)
12332 {
12333 struct mbuf *m;
12334
12335 m = m_uiotombuf(uio, M_WAITOK, max_send_len, 0,
12336 (M_PKTHDR | (user_marks_eor ? M_EOR : 0)));
12337 if (m == NULL) {
12338 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOBUFS);
12339 *error = ENOBUFS;
12340 } else {
12341 *sndout = m_length(m, NULL);
12342 *new_tail = m_last(m);
12343 }
12344 return (m);
12345 }
12346
12347 static int
12348 sctp_copy_one(struct sctp_stream_queue_pending *sp,
12349 struct uio *uio,
12350 int resv_upfront)
12351 {
12352 sp->data = m_uiotombuf(uio, M_WAITOK, sp->length,
12353 resv_upfront, 0);
12354 if (sp->data == NULL) {
12355 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOBUFS);
12356 return (ENOBUFS);
12357 }
12358
12359 sp->tail_mbuf = m_last(sp->data);
12360 return (0);
12361 }
12362
12363
12364
12365 static struct sctp_stream_queue_pending *
12366 sctp_copy_it_in(struct sctp_tcb *stcb,
12367 struct sctp_association *asoc,
12368 struct sctp_sndrcvinfo *srcv,
12369 struct uio *uio,
12370 struct sctp_nets *net,
12371 int max_send_len,
12372 int user_marks_eor,
12373 int *error)
12374 {
12375
12376 /*-
12377 * This routine must be very careful in its work. Protocol
12378 * processing is up and running so care must be taken to spl...()
12379 * when you need to do something that may effect the stcb/asoc. The
12380 * sb is locked however. When data is copied the protocol processing
12381 * should be enabled since this is a slower operation...
12382 */
12383 struct sctp_stream_queue_pending *sp = NULL;
12384 int resv_in_first;
12385
12386 *error = 0;
12387 /* Now can we send this? */
12388 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_SENT) ||
12389 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_ACK_SENT) ||
12390 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
12391 (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) {
12392 /* got data while shutting down */
12393 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
12394 *error = ECONNRESET;
12395 goto out_now;
12396 }
12397 sctp_alloc_a_strmoq(stcb, sp);
12398 if (sp == NULL) {
12399 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12400 *error = ENOMEM;
12401 goto out_now;
12402 }
12403 sp->act_flags = 0;
12404 sp->sender_all_done = 0;
12405 sp->sinfo_flags = srcv->sinfo_flags;
12406 sp->timetolive = srcv->sinfo_timetolive;
12407 sp->ppid = srcv->sinfo_ppid;
12408 sp->context = srcv->sinfo_context;
12409 sp->fsn = 0;
12410 (void)SCTP_GETTIME_TIMEVAL(&sp->ts);
12411
12412 sp->sid = srcv->sinfo_stream;
12413 sp->length = (uint32_t)min(uio->uio_resid, max_send_len);
12414 if ((sp->length == (uint32_t)uio->uio_resid) &&
12415 ((user_marks_eor == 0) ||
12416 (srcv->sinfo_flags & SCTP_EOF) ||
12417 (user_marks_eor && (srcv->sinfo_flags & SCTP_EOR)))) {
12418 sp->msg_is_complete = 1;
12419 } else {
12420 sp->msg_is_complete = 0;
12421 }
12422 sp->sender_all_done = 0;
12423 sp->some_taken = 0;
12424 sp->put_last_out = 0;
12425 resv_in_first = SCTP_DATA_CHUNK_OVERHEAD(stcb);
12426 sp->data = sp->tail_mbuf = NULL;
12427 if (sp->length == 0) {
12428 goto skip_copy;
12429 }
12430 if (srcv->sinfo_keynumber_valid) {
12431 sp->auth_keyid = srcv->sinfo_keynumber;
12432 } else {
12433 sp->auth_keyid = stcb->asoc.authinfo.active_keyid;
12434 }
12435 if (sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks)) {
12436 sctp_auth_key_acquire(stcb, sp->auth_keyid);
12437 sp->holds_key_ref = 1;
12438 }
12439 *error = sctp_copy_one(sp, uio, resv_in_first);
12440 skip_copy:
12441 if (*error) {
12442 sctp_free_a_strmoq(stcb, sp, SCTP_SO_LOCKED);
12443 sp = NULL;
12444 } else {
12445 if (sp->sinfo_flags & SCTP_ADDR_OVER) {
12446 sp->net = net;
12447 atomic_add_int(&sp->net->ref_count, 1);
12448 } else {
12449 sp->net = NULL;
12450 }
12451 sctp_set_prsctp_policy(sp);
12452 }
12453 out_now:
12454 return (sp);
12455 }
12456
12457
12458 int
12459 sctp_sosend(struct socket *so,
12460 struct sockaddr *addr,
12461 struct uio *uio,
12462 struct mbuf *top,
12463 struct mbuf *control,
12464 int flags,
12465 struct thread *p
12466 )
12467 {
12468 int error, use_sndinfo = 0;
12469 struct sctp_sndrcvinfo sndrcvninfo;
12470 struct sockaddr *addr_to_use;
12471 #if defined(INET) && defined(INET6)
12472 struct sockaddr_in sin;
12473 #endif
12474
12475 if (control) {
12476 /* process cmsg snd/rcv info (maybe a assoc-id) */
12477 if (sctp_find_cmsg(SCTP_SNDRCV, (void *)&sndrcvninfo, control,
12478 sizeof(sndrcvninfo))) {
12479 /* got one */
12480 use_sndinfo = 1;
12481 }
12482 }
12483 addr_to_use = addr;
12484 #if defined(INET) && defined(INET6)
12485 if ((addr) && (addr->sa_family == AF_INET6)) {
12486 struct sockaddr_in6 *sin6;
12487
12488 sin6 = (struct sockaddr_in6 *)addr;
12489 if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
12490 in6_sin6_2_sin(&sin, sin6);
12491 addr_to_use = (struct sockaddr *)&sin;
12492 }
12493 }
12494 #endif
12495 error = sctp_lower_sosend(so, addr_to_use, uio, top,
12496 control,
12497 flags,
12498 use_sndinfo ? &sndrcvninfo : NULL
12499 ,p
12500 );
12501 return (error);
12502 }
12503
12504
12505 int
12506 sctp_lower_sosend(struct socket *so,
12507 struct sockaddr *addr,
12508 struct uio *uio,
12509 struct mbuf *i_pak,
12510 struct mbuf *control,
12511 int flags,
12512 struct sctp_sndrcvinfo *srcv
12513 ,
12514 struct thread *p
12515 )
12516 {
12517 unsigned int sndlen = 0, max_len;
12518 int error, len;
12519 struct mbuf *top = NULL;
12520 int queue_only = 0, queue_only_for_init = 0;
12521 int free_cnt_applied = 0;
12522 int un_sent;
12523 int now_filled = 0;
12524 unsigned int inqueue_bytes = 0;
12525 struct sctp_block_entry be;
12526 struct sctp_inpcb *inp;
12527 struct sctp_tcb *stcb = NULL;
12528 struct timeval now;
12529 struct sctp_nets *net;
12530 struct sctp_association *asoc;
12531 struct sctp_inpcb *t_inp;
12532 int user_marks_eor;
12533 int create_lock_applied = 0;
12534 int nagle_applies = 0;
12535 int some_on_control = 0;
12536 int got_all_of_the_send = 0;
12537 int hold_tcblock = 0;
12538 int non_blocking = 0;
12539 uint32_t local_add_more, local_soresv = 0;
12540 uint16_t port;
12541 uint16_t sinfo_flags;
12542 sctp_assoc_t sinfo_assoc_id;
12543
12544 error = 0;
12545 net = NULL;
12546 stcb = NULL;
12547 asoc = NULL;
12548
12549 t_inp = inp = (struct sctp_inpcb *)so->so_pcb;
12550 if (inp == NULL) {
12551 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12552 error = EINVAL;
12553 if (i_pak) {
12554 SCTP_RELEASE_PKT(i_pak);
12555 }
12556 return (error);
12557 }
12558 if ((uio == NULL) && (i_pak == NULL)) {
12559 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12560 return (EINVAL);
12561 }
12562 user_marks_eor = sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXPLICIT_EOR);
12563 atomic_add_int(&inp->total_sends, 1);
12564 if (uio) {
12565 if (uio->uio_resid < 0) {
12566 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12567 return (EINVAL);
12568 }
12569 sndlen = (unsigned int)uio->uio_resid;
12570 } else {
12571 top = SCTP_HEADER_TO_CHAIN(i_pak);
12572 sndlen = SCTP_HEADER_LEN(i_pak);
12573 }
12574 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Send called addr:%p send length %d\n",
12575 (void *)addr,
12576 sndlen);
12577 if ((inp->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) &&
12578 SCTP_IS_LISTENING(inp)) {
12579 /* The listener can NOT send */
12580 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOTCONN);
12581 error = ENOTCONN;
12582 goto out_unlocked;
12583 }
12584 /**
12585 * Pre-screen address, if one is given the sin-len
12586 * must be set correctly!
12587 */
12588 if (addr) {
12589 union sctp_sockstore *raddr = (union sctp_sockstore *)addr;
12590
12591 switch (raddr->sa.sa_family) {
12592 #ifdef INET
12593 case AF_INET:
12594 if (raddr->sin.sin_len != sizeof(struct sockaddr_in)) {
12595 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12596 error = EINVAL;
12597 goto out_unlocked;
12598 }
12599 port = raddr->sin.sin_port;
12600 break;
12601 #endif
12602 #ifdef INET6
12603 case AF_INET6:
12604 if (raddr->sin6.sin6_len != sizeof(struct sockaddr_in6)) {
12605 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12606 error = EINVAL;
12607 goto out_unlocked;
12608 }
12609 port = raddr->sin6.sin6_port;
12610 break;
12611 #endif
12612 default:
12613 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EAFNOSUPPORT);
12614 error = EAFNOSUPPORT;
12615 goto out_unlocked;
12616 }
12617 } else
12618 port = 0;
12619
12620 if (srcv) {
12621 sinfo_flags = srcv->sinfo_flags;
12622 sinfo_assoc_id = srcv->sinfo_assoc_id;
12623 if (INVALID_SINFO_FLAG(sinfo_flags) ||
12624 PR_SCTP_INVALID_POLICY(sinfo_flags)) {
12625 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12626 error = EINVAL;
12627 goto out_unlocked;
12628 }
12629 if (srcv->sinfo_flags)
12630 SCTP_STAT_INCR(sctps_sends_with_flags);
12631 } else {
12632 sinfo_flags = inp->def_send.sinfo_flags;
12633 sinfo_assoc_id = inp->def_send.sinfo_assoc_id;
12634 }
12635 if (sinfo_flags & SCTP_SENDALL) {
12636 /* its a sendall */
12637 error = sctp_sendall(inp, uio, top, srcv);
12638 top = NULL;
12639 goto out_unlocked;
12640 }
12641 if ((sinfo_flags & SCTP_ADDR_OVER) && (addr == NULL)) {
12642 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12643 error = EINVAL;
12644 goto out_unlocked;
12645 }
12646 /* now we must find the assoc */
12647 if ((inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED) ||
12648 (inp->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) {
12649 SCTP_INP_RLOCK(inp);
12650 stcb = LIST_FIRST(&inp->sctp_asoc_list);
12651 if (stcb) {
12652 SCTP_TCB_LOCK(stcb);
12653 hold_tcblock = 1;
12654 }
12655 SCTP_INP_RUNLOCK(inp);
12656 } else if (sinfo_assoc_id) {
12657 stcb = sctp_findassociation_ep_asocid(inp, sinfo_assoc_id, 1);
12658 if (stcb != NULL) {
12659 hold_tcblock = 1;
12660 }
12661 } else if (addr) {
12662 /*-
12663 * Since we did not use findep we must
12664 * increment it, and if we don't find a tcb
12665 * decrement it.
12666 */
12667 SCTP_INP_WLOCK(inp);
12668 SCTP_INP_INCR_REF(inp);
12669 SCTP_INP_WUNLOCK(inp);
12670 stcb = sctp_findassociation_ep_addr(&t_inp, addr, &net, NULL, NULL);
12671 if (stcb == NULL) {
12672 SCTP_INP_WLOCK(inp);
12673 SCTP_INP_DECR_REF(inp);
12674 SCTP_INP_WUNLOCK(inp);
12675 } else {
12676 hold_tcblock = 1;
12677 }
12678 }
12679 if ((stcb == NULL) && (addr)) {
12680 /* Possible implicit send? */
12681 SCTP_ASOC_CREATE_LOCK(inp);
12682 create_lock_applied = 1;
12683 if ((inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
12684 (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_ALLGONE)) {
12685 /* Should I really unlock ? */
12686 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12687 error = EINVAL;
12688 goto out_unlocked;
12689
12690 }
12691 if (((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) == 0) &&
12692 (addr->sa_family == AF_INET6)) {
12693 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12694 error = EINVAL;
12695 goto out_unlocked;
12696 }
12697 SCTP_INP_WLOCK(inp);
12698 SCTP_INP_INCR_REF(inp);
12699 SCTP_INP_WUNLOCK(inp);
12700 /* With the lock applied look again */
12701 stcb = sctp_findassociation_ep_addr(&t_inp, addr, &net, NULL, NULL);
12702 if ((stcb == NULL) && (control != NULL) && (port > 0)) {
12703 stcb = sctp_findassociation_cmsgs(&t_inp, port, control, &net, &error);
12704 }
12705 if (stcb == NULL) {
12706 SCTP_INP_WLOCK(inp);
12707 SCTP_INP_DECR_REF(inp);
12708 SCTP_INP_WUNLOCK(inp);
12709 } else {
12710 hold_tcblock = 1;
12711 }
12712 if (error) {
12713 goto out_unlocked;
12714 }
12715 if (t_inp != inp) {
12716 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOTCONN);
12717 error = ENOTCONN;
12718 goto out_unlocked;
12719 }
12720 }
12721 if (stcb == NULL) {
12722 if (addr == NULL) {
12723 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOENT);
12724 error = ENOENT;
12725 goto out_unlocked;
12726 } else {
12727 /* We must go ahead and start the INIT process */
12728 uint32_t vrf_id;
12729
12730 if ((sinfo_flags & SCTP_ABORT) ||
12731 ((sinfo_flags & SCTP_EOF) && (sndlen == 0))) {
12732 /*-
12733 * User asks to abort a non-existant assoc,
12734 * or EOF a non-existant assoc with no data
12735 */
12736 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOENT);
12737 error = ENOENT;
12738 goto out_unlocked;
12739 }
12740 /* get an asoc/stcb struct */
12741 vrf_id = inp->def_vrf_id;
12742 #ifdef INVARIANTS
12743 if (create_lock_applied == 0) {
12744 panic("Error, should hold create lock and I don't?");
12745 }
12746 #endif
12747 stcb = sctp_aloc_assoc(inp, addr, &error, 0, vrf_id,
12748 inp->sctp_ep.pre_open_stream_count,
12749 inp->sctp_ep.port,
12750 p);
12751 if (stcb == NULL) {
12752 /* Error is setup for us in the call */
12753 goto out_unlocked;
12754 }
12755 if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) {
12756 stcb->sctp_ep->sctp_flags |= SCTP_PCB_FLAGS_CONNECTED;
12757 /*
12758 * Set the connected flag so we can queue
12759 * data
12760 */
12761 soisconnecting(so);
12762 }
12763 hold_tcblock = 1;
12764 if (create_lock_applied) {
12765 SCTP_ASOC_CREATE_UNLOCK(inp);
12766 create_lock_applied = 0;
12767 } else {
12768 SCTP_PRINTF("Huh-3? create lock should have been on??\n");
12769 }
12770 /*
12771 * Turn on queue only flag to prevent data from
12772 * being sent
12773 */
12774 queue_only = 1;
12775 asoc = &stcb->asoc;
12776 SCTP_SET_STATE(stcb, SCTP_STATE_COOKIE_WAIT);
12777 (void)SCTP_GETTIME_TIMEVAL(&asoc->time_entered);
12778
12779 /* initialize authentication params for the assoc */
12780 sctp_initialize_auth_params(inp, stcb);
12781
12782 if (control) {
12783 if (sctp_process_cmsgs_for_init(stcb, control, &error)) {
12784 sctp_free_assoc(inp, stcb, SCTP_PCBFREE_FORCE,
12785 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_5);
12786 hold_tcblock = 0;
12787 stcb = NULL;
12788 goto out_unlocked;
12789 }
12790 }
12791 /* out with the INIT */
12792 queue_only_for_init = 1;
12793 /*-
12794 * we may want to dig in after this call and adjust the MTU
12795 * value. It defaulted to 1500 (constant) but the ro
12796 * structure may now have an update and thus we may need to
12797 * change it BEFORE we append the message.
12798 */
12799 }
12800 } else
12801 asoc = &stcb->asoc;
12802 if (srcv == NULL)
12803 srcv = (struct sctp_sndrcvinfo *)&asoc->def_send;
12804 if (srcv->sinfo_flags & SCTP_ADDR_OVER) {
12805 if (addr)
12806 net = sctp_findnet(stcb, addr);
12807 else
12808 net = NULL;
12809 if ((net == NULL) ||
12810 ((port != 0) && (port != stcb->rport))) {
12811 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12812 error = EINVAL;
12813 goto out_unlocked;
12814 }
12815 } else {
12816 if (stcb->asoc.alternate) {
12817 net = stcb->asoc.alternate;
12818 } else {
12819 net = stcb->asoc.primary_destination;
12820 }
12821 }
12822 atomic_add_int(&stcb->total_sends, 1);
12823 /* Keep the stcb from being freed under our feet */
12824 atomic_add_int(&asoc->refcnt, 1);
12825 free_cnt_applied = 1;
12826
12827 if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_NO_FRAGMENT)) {
12828 if (sndlen > asoc->smallest_mtu) {
12829 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EMSGSIZE);
12830 error = EMSGSIZE;
12831 goto out_unlocked;
12832 }
12833 }
12834 if (SCTP_SO_IS_NBIO(so)
12835 || (flags & MSG_NBIO)
12836 ) {
12837 non_blocking = 1;
12838 }
12839 /* would we block? */
12840 if (non_blocking) {
12841 uint32_t amount;
12842
12843 if (hold_tcblock == 0) {
12844 SCTP_TCB_LOCK(stcb);
12845 hold_tcblock = 1;
12846 }
12847 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
12848 if (user_marks_eor == 0) {
12849 amount = sndlen;
12850 } else {
12851 amount = 1;
12852 }
12853 if ((SCTP_SB_LIMIT_SND(so) < (amount + inqueue_bytes + stcb->asoc.sb_send_resv)) ||
12854 (stcb->asoc.chunks_on_out_queue >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue))) {
12855 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EWOULDBLOCK);
12856 if (sndlen > SCTP_SB_LIMIT_SND(so))
12857 error = EMSGSIZE;
12858 else
12859 error = EWOULDBLOCK;
12860 goto out_unlocked;
12861 }
12862 stcb->asoc.sb_send_resv += sndlen;
12863 SCTP_TCB_UNLOCK(stcb);
12864 hold_tcblock = 0;
12865 } else {
12866 atomic_add_int(&stcb->asoc.sb_send_resv, sndlen);
12867 }
12868 local_soresv = sndlen;
12869 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
12870 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
12871 error = ECONNRESET;
12872 goto out_unlocked;
12873 }
12874 if (create_lock_applied) {
12875 SCTP_ASOC_CREATE_UNLOCK(inp);
12876 create_lock_applied = 0;
12877 }
12878 /* Is the stream no. valid? */
12879 if (srcv->sinfo_stream >= asoc->streamoutcnt) {
12880 /* Invalid stream number */
12881 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12882 error = EINVAL;
12883 goto out_unlocked;
12884 }
12885 if ((asoc->strmout[srcv->sinfo_stream].state != SCTP_STREAM_OPEN) &&
12886 (asoc->strmout[srcv->sinfo_stream].state != SCTP_STREAM_OPENING)) {
12887 /*
12888 * Can't queue any data while stream reset is underway.
12889 */
12890 if (asoc->strmout[srcv->sinfo_stream].state > SCTP_STREAM_OPEN) {
12891 error = EAGAIN;
12892 } else {
12893 error = EINVAL;
12894 }
12895 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, error);
12896 goto out_unlocked;
12897 }
12898 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT) ||
12899 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED)) {
12900 queue_only = 1;
12901 }
12902 /* we are now done with all control */
12903 if (control) {
12904 sctp_m_freem(control);
12905 control = NULL;
12906 }
12907 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_SENT) ||
12908 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
12909 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_ACK_SENT) ||
12910 (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) {
12911 if (srcv->sinfo_flags & SCTP_ABORT) {
12912 ;
12913 } else {
12914 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
12915 error = ECONNRESET;
12916 goto out_unlocked;
12917 }
12918 }
12919 /* Ok, we will attempt a msgsnd :> */
12920 if (p) {
12921 p->td_ru.ru_msgsnd++;
12922 }
12923 /* Are we aborting? */
12924 if (srcv->sinfo_flags & SCTP_ABORT) {
12925 struct mbuf *mm;
12926 int tot_demand, tot_out = 0, max_out;
12927
12928 SCTP_STAT_INCR(sctps_sends_with_abort);
12929 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT) ||
12930 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED)) {
12931 /* It has to be up before we abort */
12932 /* how big is the user initiated abort? */
12933 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12934 error = EINVAL;
12935 goto out;
12936 }
12937 if (hold_tcblock) {
12938 SCTP_TCB_UNLOCK(stcb);
12939 hold_tcblock = 0;
12940 }
12941 if (top) {
12942 struct mbuf *cntm = NULL;
12943
12944 mm = sctp_get_mbuf_for_msg(sizeof(struct sctp_paramhdr), 0, M_WAITOK, 1, MT_DATA);
12945 if (sndlen != 0) {
12946 for (cntm = top; cntm; cntm = SCTP_BUF_NEXT(cntm)) {
12947 tot_out += SCTP_BUF_LEN(cntm);
12948 }
12949 }
12950 } else {
12951 /* Must fit in a MTU */
12952 tot_out = sndlen;
12953 tot_demand = (tot_out + sizeof(struct sctp_paramhdr));
12954 if (tot_demand > SCTP_DEFAULT_ADD_MORE) {
12955 /* To big */
12956 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EMSGSIZE);
12957 error = EMSGSIZE;
12958 goto out;
12959 }
12960 mm = sctp_get_mbuf_for_msg(tot_demand, 0, M_WAITOK, 1, MT_DATA);
12961 }
12962 if (mm == NULL) {
12963 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12964 error = ENOMEM;
12965 goto out;
12966 }
12967 max_out = asoc->smallest_mtu - sizeof(struct sctp_paramhdr);
12968 max_out -= sizeof(struct sctp_abort_msg);
12969 if (tot_out > max_out) {
12970 tot_out = max_out;
12971 }
12972 if (mm) {
12973 struct sctp_paramhdr *ph;
12974
12975 /* now move forward the data pointer */
12976 ph = mtod(mm, struct sctp_paramhdr *);
12977 ph->param_type = htons(SCTP_CAUSE_USER_INITIATED_ABT);
12978 ph->param_length = htons((uint16_t)(sizeof(struct sctp_paramhdr) + tot_out));
12979 ph++;
12980 SCTP_BUF_LEN(mm) = tot_out + sizeof(struct sctp_paramhdr);
12981 if (top == NULL) {
12982 error = uiomove((caddr_t)ph, (int)tot_out, uio);
12983 if (error) {
12984 /*-
12985 * Here if we can't get his data we
12986 * still abort we just don't get to
12987 * send the users note :-0
12988 */
12989 sctp_m_freem(mm);
12990 mm = NULL;
12991 }
12992 } else {
12993 if (sndlen != 0) {
12994 SCTP_BUF_NEXT(mm) = top;
12995 }
12996 }
12997 }
12998 if (hold_tcblock == 0) {
12999 SCTP_TCB_LOCK(stcb);
13000 }
13001 atomic_add_int(&stcb->asoc.refcnt, -1);
13002 free_cnt_applied = 0;
13003 /* release this lock, otherwise we hang on ourselves */
13004 sctp_abort_an_association(stcb->sctp_ep, stcb, mm, SCTP_SO_LOCKED);
13005 /* now relock the stcb so everything is sane */
13006 hold_tcblock = 0;
13007 stcb = NULL;
13008 /*
13009 * In this case top is already chained to mm avoid double
13010 * free, since we free it below if top != NULL and driver
13011 * would free it after sending the packet out
13012 */
13013 if (sndlen != 0) {
13014 top = NULL;
13015 }
13016 goto out_unlocked;
13017 }
13018 /* Calculate the maximum we can send */
13019 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13020 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes) {
13021 if (non_blocking) {
13022 /* we already checked for non-blocking above. */
13023 max_len = sndlen;
13024 } else {
13025 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13026 }
13027 } else {
13028 max_len = 0;
13029 }
13030 if (hold_tcblock) {
13031 SCTP_TCB_UNLOCK(stcb);
13032 hold_tcblock = 0;
13033 }
13034 if (asoc->strmout == NULL) {
13035 /* huh? software error */
13036 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EFAULT);
13037 error = EFAULT;
13038 goto out_unlocked;
13039 }
13040
13041 /* Unless E_EOR mode is on, we must make a send FIT in one call. */
13042 if ((user_marks_eor == 0) &&
13043 (sndlen > SCTP_SB_LIMIT_SND(stcb->sctp_socket))) {
13044 /* It will NEVER fit */
13045 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EMSGSIZE);
13046 error = EMSGSIZE;
13047 goto out_unlocked;
13048 }
13049 if ((uio == NULL) && user_marks_eor) {
13050 /*-
13051 * We do not support eeor mode for
13052 * sending with mbuf chains (like sendfile).
13053 */
13054 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
13055 error = EINVAL;
13056 goto out_unlocked;
13057 }
13058
13059 if (user_marks_eor) {
13060 local_add_more = min(SCTP_SB_LIMIT_SND(so), SCTP_BASE_SYSCTL(sctp_add_more_threshold));
13061 } else {
13062 /*-
13063 * For non-eeor the whole message must fit in
13064 * the socket send buffer.
13065 */
13066 local_add_more = sndlen;
13067 }
13068 len = 0;
13069 if (non_blocking) {
13070 goto skip_preblock;
13071 }
13072 if (((max_len <= local_add_more) &&
13073 (SCTP_SB_LIMIT_SND(so) >= local_add_more)) ||
13074 (max_len == 0) ||
13075 ((stcb->asoc.chunks_on_out_queue + stcb->asoc.stream_queue_cnt) >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue))) {
13076 /* No room right now ! */
13077 SOCKBUF_LOCK(&so->so_snd);
13078 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13079 while ((SCTP_SB_LIMIT_SND(so) < (inqueue_bytes + local_add_more)) ||
13080 ((stcb->asoc.stream_queue_cnt + stcb->asoc.chunks_on_out_queue) >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue))) {
13081 SCTPDBG(SCTP_DEBUG_OUTPUT1, "pre_block limit:%u <(inq:%d + %d) || (%d+%d > %d)\n",
13082 (unsigned int)SCTP_SB_LIMIT_SND(so),
13083 inqueue_bytes,
13084 local_add_more,
13085 stcb->asoc.stream_queue_cnt,
13086 stcb->asoc.chunks_on_out_queue,
13087 SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue));
13088 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13089 sctp_log_block(SCTP_BLOCK_LOG_INTO_BLKA, asoc, sndlen);
13090 }
13091 be.error = 0;
13092 stcb->block_entry = &be;
13093 error = sbwait(&so->so_snd);
13094 stcb->block_entry = NULL;
13095 if (error || so->so_error || be.error) {
13096 if (error == 0) {
13097 if (so->so_error)
13098 error = so->so_error;
13099 if (be.error) {
13100 error = be.error;
13101 }
13102 }
13103 SOCKBUF_UNLOCK(&so->so_snd);
13104 goto out_unlocked;
13105 }
13106 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13107 sctp_log_block(SCTP_BLOCK_LOG_OUTOF_BLK,
13108 asoc, stcb->asoc.total_output_queue_size);
13109 }
13110 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
13111 SOCKBUF_UNLOCK(&so->so_snd);
13112 goto out_unlocked;
13113 }
13114 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13115 }
13116 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes) {
13117 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13118 } else {
13119 max_len = 0;
13120 }
13121 SOCKBUF_UNLOCK(&so->so_snd);
13122 }
13123
13124 skip_preblock:
13125 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
13126 goto out_unlocked;
13127 }
13128 /*
13129 * sndlen covers for mbuf case uio_resid covers for the non-mbuf
13130 * case NOTE: uio will be null when top/mbuf is passed
13131 */
13132 if (sndlen == 0) {
13133 if (srcv->sinfo_flags & SCTP_EOF) {
13134 got_all_of_the_send = 1;
13135 goto dataless_eof;
13136 } else {
13137 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
13138 error = EINVAL;
13139 goto out;
13140 }
13141 }
13142 if (top == NULL) {
13143 struct sctp_stream_queue_pending *sp;
13144 struct sctp_stream_out *strm;
13145 uint32_t sndout;
13146
13147 SCTP_TCB_SEND_LOCK(stcb);
13148 if ((asoc->stream_locked) &&
13149 (asoc->stream_locked_on != srcv->sinfo_stream)) {
13150 SCTP_TCB_SEND_UNLOCK(stcb);
13151 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
13152 error = EINVAL;
13153 goto out;
13154 }
13155 SCTP_TCB_SEND_UNLOCK(stcb);
13156
13157 strm = &stcb->asoc.strmout[srcv->sinfo_stream];
13158 if (strm->last_msg_incomplete == 0) {
13159 do_a_copy_in:
13160 sp = sctp_copy_it_in(stcb, asoc, srcv, uio, net, max_len, user_marks_eor, &error);
13161 if (error) {
13162 goto out;
13163 }
13164 SCTP_TCB_SEND_LOCK(stcb);
13165 if (sp->msg_is_complete) {
13166 strm->last_msg_incomplete = 0;
13167 asoc->stream_locked = 0;
13168 } else {
13169 /*
13170 * Just got locked to this guy in case of an
13171 * interrupt.
13172 */
13173 strm->last_msg_incomplete = 1;
13174 if (stcb->asoc.idata_supported == 0) {
13175 asoc->stream_locked = 1;
13176 asoc->stream_locked_on = srcv->sinfo_stream;
13177 }
13178 sp->sender_all_done = 0;
13179 }
13180 sctp_snd_sb_alloc(stcb, sp->length);
13181 atomic_add_int(&asoc->stream_queue_cnt, 1);
13182 if (srcv->sinfo_flags & SCTP_UNORDERED) {
13183 SCTP_STAT_INCR(sctps_sends_with_unord);
13184 }
13185 TAILQ_INSERT_TAIL(&strm->outqueue, sp, next);
13186 stcb->asoc.ss_functions.sctp_ss_add_to_stream(stcb, asoc, strm, sp, 1);
13187 SCTP_TCB_SEND_UNLOCK(stcb);
13188 } else {
13189 SCTP_TCB_SEND_LOCK(stcb);
13190 sp = TAILQ_LAST(&strm->outqueue, sctp_streamhead);
13191 SCTP_TCB_SEND_UNLOCK(stcb);
13192 if (sp == NULL) {
13193 /* ???? Huh ??? last msg is gone */
13194 #ifdef INVARIANTS
13195 panic("Warning: Last msg marked incomplete, yet nothing left?");
13196 #else
13197 SCTP_PRINTF("Warning: Last msg marked incomplete, yet nothing left?\n");
13198 strm->last_msg_incomplete = 0;
13199 #endif
13200 goto do_a_copy_in;
13201
13202 }
13203 }
13204 while (uio->uio_resid > 0) {
13205 /* How much room do we have? */
13206 struct mbuf *new_tail, *mm;
13207
13208 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13209 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes)
13210 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13211 else
13212 max_len = 0;
13213
13214 if ((max_len > SCTP_BASE_SYSCTL(sctp_add_more_threshold)) ||
13215 (max_len && (SCTP_SB_LIMIT_SND(so) < SCTP_BASE_SYSCTL(sctp_add_more_threshold))) ||
13216 (uio->uio_resid && (uio->uio_resid <= (int)max_len))) {
13217 sndout = 0;
13218 new_tail = NULL;
13219 if (hold_tcblock) {
13220 SCTP_TCB_UNLOCK(stcb);
13221 hold_tcblock = 0;
13222 }
13223 mm = sctp_copy_resume(uio, max_len, user_marks_eor, &error, &sndout, &new_tail);
13224 if ((mm == NULL) || error) {
13225 if (mm) {
13226 sctp_m_freem(mm);
13227 }
13228 goto out;
13229 }
13230 /* Update the mbuf and count */
13231 SCTP_TCB_SEND_LOCK(stcb);
13232 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
13233 /*
13234 * we need to get out. Peer probably
13235 * aborted.
13236 */
13237 sctp_m_freem(mm);
13238 if (stcb->asoc.state & SCTP_PCB_FLAGS_WAS_ABORTED) {
13239 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
13240 error = ECONNRESET;
13241 }
13242 SCTP_TCB_SEND_UNLOCK(stcb);
13243 goto out;
13244 }
13245 if (sp->tail_mbuf) {
13246 /* tack it to the end */
13247 SCTP_BUF_NEXT(sp->tail_mbuf) = mm;
13248 sp->tail_mbuf = new_tail;
13249 } else {
13250 /* A stolen mbuf */
13251 sp->data = mm;
13252 sp->tail_mbuf = new_tail;
13253 }
13254 sctp_snd_sb_alloc(stcb, sndout);
13255 atomic_add_int(&sp->length, sndout);
13256 len += sndout;
13257 if (srcv->sinfo_flags & SCTP_SACK_IMMEDIATELY) {
13258 sp->sinfo_flags |= SCTP_SACK_IMMEDIATELY;
13259 }
13260
13261 /* Did we reach EOR? */
13262 if ((uio->uio_resid == 0) &&
13263 ((user_marks_eor == 0) ||
13264 (srcv->sinfo_flags & SCTP_EOF) ||
13265 (user_marks_eor && (srcv->sinfo_flags & SCTP_EOR)))) {
13266 sp->msg_is_complete = 1;
13267 } else {
13268 sp->msg_is_complete = 0;
13269 }
13270 SCTP_TCB_SEND_UNLOCK(stcb);
13271 }
13272 if (uio->uio_resid == 0) {
13273 /* got it all? */
13274 continue;
13275 }
13276 /* PR-SCTP? */
13277 if ((asoc->prsctp_supported) && (asoc->sent_queue_cnt_removeable > 0)) {
13278 /*
13279 * This is ugly but we must assure locking
13280 * order
13281 */
13282 if (hold_tcblock == 0) {
13283 SCTP_TCB_LOCK(stcb);
13284 hold_tcblock = 1;
13285 }
13286 sctp_prune_prsctp(stcb, asoc, srcv, sndlen);
13287 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13288 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes)
13289 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13290 else
13291 max_len = 0;
13292 if (max_len > 0) {
13293 continue;
13294 }
13295 SCTP_TCB_UNLOCK(stcb);
13296 hold_tcblock = 0;
13297 }
13298 /* wait for space now */
13299 if (non_blocking) {
13300 /* Non-blocking io in place out */
13301 goto skip_out_eof;
13302 }
13303 /* What about the INIT, send it maybe */
13304 if (queue_only_for_init) {
13305 if (hold_tcblock == 0) {
13306 SCTP_TCB_LOCK(stcb);
13307 hold_tcblock = 1;
13308 }
13309 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
13310 /* a collision took us forward? */
13311 queue_only = 0;
13312 } else {
13313 sctp_send_initiate(inp, stcb, SCTP_SO_LOCKED);
13314 SCTP_SET_STATE(stcb, SCTP_STATE_COOKIE_WAIT);
13315 queue_only = 1;
13316 }
13317 }
13318 if ((net->flight_size > net->cwnd) &&
13319 (asoc->sctp_cmt_on_off == 0)) {
13320 SCTP_STAT_INCR(sctps_send_cwnd_avoid);
13321 queue_only = 1;
13322 } else if (asoc->ifp_had_enobuf) {
13323 SCTP_STAT_INCR(sctps_ifnomemqueued);
13324 if (net->flight_size > (2 * net->mtu)) {
13325 queue_only = 1;
13326 }
13327 asoc->ifp_had_enobuf = 0;
13328 }
13329 un_sent = stcb->asoc.total_output_queue_size - stcb->asoc.total_flight;
13330 if ((sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY)) &&
13331 (stcb->asoc.total_flight > 0) &&
13332 (stcb->asoc.stream_queue_cnt < SCTP_MAX_DATA_BUNDLING) &&
13333 (un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD))) {
13334
13335 /*-
13336 * Ok, Nagle is set on and we have data outstanding.
13337 * Don't send anything and let SACKs drive out the
13338 * data unless we have a "full" segment to send.
13339 */
13340 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13341 sctp_log_nagle_event(stcb, SCTP_NAGLE_APPLIED);
13342 }
13343 SCTP_STAT_INCR(sctps_naglequeued);
13344 nagle_applies = 1;
13345 } else {
13346 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13347 if (sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY))
13348 sctp_log_nagle_event(stcb, SCTP_NAGLE_SKIPPED);
13349 }
13350 SCTP_STAT_INCR(sctps_naglesent);
13351 nagle_applies = 0;
13352 }
13353 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13354
13355 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, queue_only_for_init, queue_only,
13356 nagle_applies, un_sent);
13357 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, stcb->asoc.total_output_queue_size,
13358 stcb->asoc.total_flight,
13359 stcb->asoc.chunks_on_out_queue, stcb->asoc.total_flight_count);
13360 }
13361 if (queue_only_for_init)
13362 queue_only_for_init = 0;
13363 if ((queue_only == 0) && (nagle_applies == 0)) {
13364 /*-
13365 * need to start chunk output
13366 * before blocking.. note that if
13367 * a lock is already applied, then
13368 * the input via the net is happening
13369 * and I don't need to start output :-D
13370 */
13371 if (hold_tcblock == 0) {
13372 if (SCTP_TCB_TRYLOCK(stcb)) {
13373 hold_tcblock = 1;
13374 sctp_chunk_output(inp,
13375 stcb,
13376 SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13377 }
13378 } else {
13379 sctp_chunk_output(inp,
13380 stcb,
13381 SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13382 }
13383 if (hold_tcblock == 1) {
13384 SCTP_TCB_UNLOCK(stcb);
13385 hold_tcblock = 0;
13386 }
13387 }
13388 SOCKBUF_LOCK(&so->so_snd);
13389 /*-
13390 * This is a bit strange, but I think it will
13391 * work. The total_output_queue_size is locked and
13392 * protected by the TCB_LOCK, which we just released.
13393 * There is a race that can occur between releasing it
13394 * above, and me getting the socket lock, where sacks
13395 * come in but we have not put the SB_WAIT on the
13396 * so_snd buffer to get the wakeup. After the LOCK
13397 * is applied the sack_processing will also need to
13398 * LOCK the so->so_snd to do the actual sowwakeup(). So
13399 * once we have the socket buffer lock if we recheck the
13400 * size we KNOW we will get to sleep safely with the
13401 * wakeup flag in place.
13402 */
13403 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13404 if (SCTP_SB_LIMIT_SND(so) <= (inqueue_bytes +
13405 min(SCTP_BASE_SYSCTL(sctp_add_more_threshold), SCTP_SB_LIMIT_SND(so)))) {
13406 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13407 sctp_log_block(SCTP_BLOCK_LOG_INTO_BLK,
13408 asoc, (size_t)uio->uio_resid);
13409 }
13410 be.error = 0;
13411 stcb->block_entry = &be;
13412 error = sbwait(&so->so_snd);
13413 stcb->block_entry = NULL;
13414
13415 if (error || so->so_error || be.error) {
13416 if (error == 0) {
13417 if (so->so_error)
13418 error = so->so_error;
13419 if (be.error) {
13420 error = be.error;
13421 }
13422 }
13423 SOCKBUF_UNLOCK(&so->so_snd);
13424 goto out_unlocked;
13425 }
13426
13427 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13428 sctp_log_block(SCTP_BLOCK_LOG_OUTOF_BLK,
13429 asoc, stcb->asoc.total_output_queue_size);
13430 }
13431 }
13432 SOCKBUF_UNLOCK(&so->so_snd);
13433 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
13434 goto out_unlocked;
13435 }
13436 }
13437 SCTP_TCB_SEND_LOCK(stcb);
13438 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
13439 SCTP_TCB_SEND_UNLOCK(stcb);
13440 goto out_unlocked;
13441 }
13442 if (sp) {
13443 if (sp->msg_is_complete == 0) {
13444 strm->last_msg_incomplete = 1;
13445 if (stcb->asoc.idata_supported == 0) {
13446 asoc->stream_locked = 1;
13447 asoc->stream_locked_on = srcv->sinfo_stream;
13448 }
13449 } else {
13450 sp->sender_all_done = 1;
13451 strm->last_msg_incomplete = 0;
13452 asoc->stream_locked = 0;
13453 }
13454 } else {
13455 SCTP_PRINTF("Huh no sp TSNH?\n");
13456 strm->last_msg_incomplete = 0;
13457 asoc->stream_locked = 0;
13458 }
13459 SCTP_TCB_SEND_UNLOCK(stcb);
13460 if (uio->uio_resid == 0) {
13461 got_all_of_the_send = 1;
13462 }
13463 } else {
13464 /* We send in a 0, since we do NOT have any locks */
13465 error = sctp_msg_append(stcb, net, top, srcv, 0);
13466 top = NULL;
13467 if (srcv->sinfo_flags & SCTP_EOF) {
13468 /*
13469 * This should only happen for Panda for the mbuf
13470 * send case, which does NOT yet support EEOR mode.
13471 * Thus, we can just set this flag to do the proper
13472 * EOF handling.
13473 */
13474 got_all_of_the_send = 1;
13475 }
13476 }
13477 if (error) {
13478 goto out;
13479 }
13480 dataless_eof:
13481 /* EOF thing ? */
13482 if ((srcv->sinfo_flags & SCTP_EOF) &&
13483 (got_all_of_the_send == 1)) {
13484 SCTP_STAT_INCR(sctps_sends_with_eof);
13485 error = 0;
13486 if (hold_tcblock == 0) {
13487 SCTP_TCB_LOCK(stcb);
13488 hold_tcblock = 1;
13489 }
13490 if (TAILQ_EMPTY(&asoc->send_queue) &&
13491 TAILQ_EMPTY(&asoc->sent_queue) &&
13492 sctp_is_there_unsent_data(stcb, SCTP_SO_LOCKED) == 0) {
13493 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
13494 goto abort_anyway;
13495 }
13496 /* there is nothing queued to send, so I'm done... */
13497 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
13498 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
13499 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
13500 struct sctp_nets *netp;
13501
13502 /* only send SHUTDOWN the first time through */
13503 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
13504 SCTP_STAT_DECR_GAUGE32(sctps_currestab);
13505 }
13506 SCTP_SET_STATE(stcb, SCTP_STATE_SHUTDOWN_SENT);
13507 sctp_stop_timers_for_shutdown(stcb);
13508 if (stcb->asoc.alternate) {
13509 netp = stcb->asoc.alternate;
13510 } else {
13511 netp = stcb->asoc.primary_destination;
13512 }
13513 sctp_send_shutdown(stcb, netp);
13514 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN, stcb->sctp_ep, stcb,
13515 netp);
13516 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
13517 asoc->primary_destination);
13518 }
13519 } else {
13520 /*-
13521 * we still got (or just got) data to send, so set
13522 * SHUTDOWN_PENDING
13523 */
13524 /*-
13525 * XXX sockets draft says that SCTP_EOF should be
13526 * sent with no data. currently, we will allow user
13527 * data to be sent first and move to
13528 * SHUTDOWN-PENDING
13529 */
13530 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
13531 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
13532 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
13533 if (hold_tcblock == 0) {
13534 SCTP_TCB_LOCK(stcb);
13535 hold_tcblock = 1;
13536 }
13537 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
13538 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_PARTIAL_MSG_LEFT);
13539 }
13540 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_SHUTDOWN_PENDING);
13541 if (TAILQ_EMPTY(&asoc->send_queue) &&
13542 TAILQ_EMPTY(&asoc->sent_queue) &&
13543 (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT)) {
13544 struct mbuf *op_err;
13545 char msg[SCTP_DIAG_INFO_LEN];
13546
13547 abort_anyway:
13548 if (free_cnt_applied) {
13549 atomic_add_int(&stcb->asoc.refcnt, -1);
13550 free_cnt_applied = 0;
13551 }
13552 snprintf(msg, sizeof(msg),
13553 "%s:%d at %s", __FILE__, __LINE__, __func__);
13554 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
13555 msg);
13556 sctp_abort_an_association(stcb->sctp_ep, stcb,
13557 op_err, SCTP_SO_LOCKED);
13558 /*
13559 * now relock the stcb so everything
13560 * is sane
13561 */
13562 hold_tcblock = 0;
13563 stcb = NULL;
13564 goto out;
13565 }
13566 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
13567 asoc->primary_destination);
13568 sctp_feature_off(inp, SCTP_PCB_FLAGS_NODELAY);
13569 }
13570 }
13571 }
13572 skip_out_eof:
13573 if (!TAILQ_EMPTY(&stcb->asoc.control_send_queue)) {
13574 some_on_control = 1;
13575 }
13576 if (queue_only_for_init) {
13577 if (hold_tcblock == 0) {
13578 SCTP_TCB_LOCK(stcb);
13579 hold_tcblock = 1;
13580 }
13581 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
13582 /* a collision took us forward? */
13583 queue_only = 0;
13584 } else {
13585 sctp_send_initiate(inp, stcb, SCTP_SO_LOCKED);
13586 SCTP_SET_STATE(stcb, SCTP_STATE_COOKIE_WAIT);
13587 queue_only = 1;
13588 }
13589 }
13590 if ((net->flight_size > net->cwnd) &&
13591 (stcb->asoc.sctp_cmt_on_off == 0)) {
13592 SCTP_STAT_INCR(sctps_send_cwnd_avoid);
13593 queue_only = 1;
13594 } else if (asoc->ifp_had_enobuf) {
13595 SCTP_STAT_INCR(sctps_ifnomemqueued);
13596 if (net->flight_size > (2 * net->mtu)) {
13597 queue_only = 1;
13598 }
13599 asoc->ifp_had_enobuf = 0;
13600 }
13601 un_sent = stcb->asoc.total_output_queue_size - stcb->asoc.total_flight;
13602 if ((sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY)) &&
13603 (stcb->asoc.total_flight > 0) &&
13604 (stcb->asoc.stream_queue_cnt < SCTP_MAX_DATA_BUNDLING) &&
13605 (un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD))) {
13606 /*-
13607 * Ok, Nagle is set on and we have data outstanding.
13608 * Don't send anything and let SACKs drive out the
13609 * data unless wen have a "full" segment to send.
13610 */
13611 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13612 sctp_log_nagle_event(stcb, SCTP_NAGLE_APPLIED);
13613 }
13614 SCTP_STAT_INCR(sctps_naglequeued);
13615 nagle_applies = 1;
13616 } else {
13617 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13618 if (sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY))
13619 sctp_log_nagle_event(stcb, SCTP_NAGLE_SKIPPED);
13620 }
13621 SCTP_STAT_INCR(sctps_naglesent);
13622 nagle_applies = 0;
13623 }
13624 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13625 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, queue_only_for_init, queue_only,
13626 nagle_applies, un_sent);
13627 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, stcb->asoc.total_output_queue_size,
13628 stcb->asoc.total_flight,
13629 stcb->asoc.chunks_on_out_queue, stcb->asoc.total_flight_count);
13630 }
13631 if ((queue_only == 0) && (nagle_applies == 0) && (stcb->asoc.peers_rwnd && un_sent)) {
13632 /* we can attempt to send too. */
13633 if (hold_tcblock == 0) {
13634 /*
13635 * If there is activity recv'ing sacks no need to
13636 * send
13637 */
13638 if (SCTP_TCB_TRYLOCK(stcb)) {
13639 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13640 hold_tcblock = 1;
13641 }
13642 } else {
13643 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13644 }
13645 } else if ((queue_only == 0) &&
13646 (stcb->asoc.peers_rwnd == 0) &&
13647 (stcb->asoc.total_flight == 0)) {
13648 /* We get to have a probe outstanding */
13649 if (hold_tcblock == 0) {
13650 hold_tcblock = 1;
13651 SCTP_TCB_LOCK(stcb);
13652 }
13653 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13654 } else if (some_on_control) {
13655 int num_out, reason, frag_point;
13656
13657 /* Here we do control only */
13658 if (hold_tcblock == 0) {
13659 hold_tcblock = 1;
13660 SCTP_TCB_LOCK(stcb);
13661 }
13662 frag_point = sctp_get_frag_point(stcb, &stcb->asoc);
13663 (void)sctp_med_chunk_output(inp, stcb, &stcb->asoc, &num_out,
13664 &reason, 1, 1, &now, &now_filled, frag_point, SCTP_SO_LOCKED);
13665 }
13666 SCTPDBG(SCTP_DEBUG_OUTPUT1, "USR Send complete qo:%d prw:%d unsent:%d tf:%d cooq:%d toqs:%d err:%d\n",
13667 queue_only, stcb->asoc.peers_rwnd, un_sent,
13668 stcb->asoc.total_flight, stcb->asoc.chunks_on_out_queue,
13669 stcb->asoc.total_output_queue_size, error);
13670
13671 out:
13672 out_unlocked:
13673
13674 if (local_soresv && stcb) {
13675 atomic_subtract_int(&stcb->asoc.sb_send_resv, sndlen);
13676 }
13677 if (create_lock_applied) {
13678 SCTP_ASOC_CREATE_UNLOCK(inp);
13679 }
13680 if ((stcb) && hold_tcblock) {
13681 SCTP_TCB_UNLOCK(stcb);
13682 }
13683 if (stcb && free_cnt_applied) {
13684 atomic_add_int(&stcb->asoc.refcnt, -1);
13685 }
13686 #ifdef INVARIANTS
13687 if (stcb) {
13688 if (mtx_owned(&stcb->tcb_mtx)) {
13689 panic("Leaving with tcb mtx owned?");
13690 }
13691 if (mtx_owned(&stcb->tcb_send_mtx)) {
13692 panic("Leaving with tcb send mtx owned?");
13693 }
13694 }
13695 #endif
13696 if (top) {
13697 sctp_m_freem(top);
13698 }
13699 if (control) {
13700 sctp_m_freem(control);
13701 }
13702 return (error);
13703 }
13704
13705
13706 /*
13707 * generate an AUTHentication chunk, if required
13708 */
13709 struct mbuf *
13710 sctp_add_auth_chunk(struct mbuf *m, struct mbuf **m_end,
13711 struct sctp_auth_chunk **auth_ret, uint32_t *offset,
13712 struct sctp_tcb *stcb, uint8_t chunk)
13713 {
13714 struct mbuf *m_auth;
13715 struct sctp_auth_chunk *auth;
13716 int chunk_len;
13717 struct mbuf *cn;
13718
13719 if ((m_end == NULL) || (auth_ret == NULL) || (offset == NULL) ||
13720 (stcb == NULL))
13721 return (m);
13722
13723 if (stcb->asoc.auth_supported == 0) {
13724 return (m);
13725 }
13726 /* does the requested chunk require auth? */
13727 if (!sctp_auth_is_required_chunk(chunk, stcb->asoc.peer_auth_chunks)) {
13728 return (m);
13729 }
13730 m_auth = sctp_get_mbuf_for_msg(sizeof(*auth), 0, M_NOWAIT, 1, MT_HEADER);
13731 if (m_auth == NULL) {
13732 /* no mbuf's */
13733 return (m);
13734 }
13735 /* reserve some space if this will be the first mbuf */
13736 if (m == NULL)
13737 SCTP_BUF_RESV_UF(m_auth, SCTP_MIN_OVERHEAD);
13738 /* fill in the AUTH chunk details */
13739 auth = mtod(m_auth, struct sctp_auth_chunk *);
13740 memset(auth, 0, sizeof(*auth));
13741 auth->ch.chunk_type = SCTP_AUTHENTICATION;
13742 auth->ch.chunk_flags = 0;
13743 chunk_len = sizeof(*auth) +
13744 sctp_get_hmac_digest_len(stcb->asoc.peer_hmac_id);
13745 auth->ch.chunk_length = htons(chunk_len);
13746 auth->hmac_id = htons(stcb->asoc.peer_hmac_id);
13747 /* key id and hmac digest will be computed and filled in upon send */
13748
13749 /* save the offset where the auth was inserted into the chain */
13750 *offset = 0;
13751 for (cn = m; cn; cn = SCTP_BUF_NEXT(cn)) {
13752 *offset += SCTP_BUF_LEN(cn);
13753 }
13754
13755 /* update length and return pointer to the auth chunk */
13756 SCTP_BUF_LEN(m_auth) = chunk_len;
13757 m = sctp_copy_mbufchain(m_auth, m, m_end, 1, chunk_len, 0);
13758 if (auth_ret != NULL)
13759 *auth_ret = auth;
13760
13761 return (m);
13762 }
13763
13764 #ifdef INET6
13765 int
13766 sctp_v6src_match_nexthop(struct sockaddr_in6 *src6, sctp_route_t *ro)
13767 {
13768 struct nd_prefix *pfx = NULL;
13769 struct nd_pfxrouter *pfxrtr = NULL;
13770 struct sockaddr_in6 gw6;
13771
13772 if (ro == NULL || ro->ro_rt == NULL || src6->sin6_family != AF_INET6)
13773 return (0);
13774
13775 /* get prefix entry of address */
13776 ND6_RLOCK();
13777 LIST_FOREACH(pfx, &MODULE_GLOBAL(nd_prefix), ndpr_entry) {
13778 if (pfx->ndpr_stateflags & NDPRF_DETACHED)
13779 continue;
13780 if (IN6_ARE_MASKED_ADDR_EQUAL(&pfx->ndpr_prefix.sin6_addr,
13781 &src6->sin6_addr, &pfx->ndpr_mask))
13782 break;
13783 }
13784 /* no prefix entry in the prefix list */
13785 if (pfx == NULL) {
13786 ND6_RUNLOCK();
13787 SCTPDBG(SCTP_DEBUG_OUTPUT2, "No prefix entry for ");
13788 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)src6);
13789 return (0);
13790 }
13791
13792 SCTPDBG(SCTP_DEBUG_OUTPUT2, "v6src_match_nexthop(), Prefix entry is ");
13793 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)src6);
13794
13795 /* search installed gateway from prefix entry */
13796 LIST_FOREACH(pfxrtr, &pfx->ndpr_advrtrs, pfr_entry) {
13797 memset(&gw6, 0, sizeof(struct sockaddr_in6));
13798 gw6.sin6_family = AF_INET6;
13799 gw6.sin6_len = sizeof(struct sockaddr_in6);
13800 memcpy(&gw6.sin6_addr, &pfxrtr->router->rtaddr,
13801 sizeof(struct in6_addr));
13802 SCTPDBG(SCTP_DEBUG_OUTPUT2, "prefix router is ");
13803 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)&gw6);
13804 SCTPDBG(SCTP_DEBUG_OUTPUT2, "installed router is ");
13805 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, ro->ro_rt->rt_gateway);
13806 if (sctp_cmpaddr((struct sockaddr *)&gw6, ro->ro_rt->rt_gateway)) {
13807 ND6_RUNLOCK();
13808 SCTPDBG(SCTP_DEBUG_OUTPUT2, "pfxrouter is installed\n");
13809 return (1);
13810 }
13811 }
13812 ND6_RUNLOCK();
13813 SCTPDBG(SCTP_DEBUG_OUTPUT2, "pfxrouter is not installed\n");
13814 return (0);
13815 }
13816 #endif
13817
13818 int
13819 sctp_v4src_match_nexthop(struct sctp_ifa *sifa, sctp_route_t *ro)
13820 {
13821 #ifdef INET
13822 struct sockaddr_in *sin, *mask;
13823 struct ifaddr *ifa;
13824 struct in_addr srcnetaddr, gwnetaddr;
13825
13826 if (ro == NULL || ro->ro_rt == NULL ||
13827 sifa->address.sa.sa_family != AF_INET) {
13828 return (0);
13829 }
13830 ifa = (struct ifaddr *)sifa->ifa;
13831 mask = (struct sockaddr_in *)(ifa->ifa_netmask);
13832 sin = &sifa->address.sin;
13833 srcnetaddr.s_addr = (sin->sin_addr.s_addr & mask->sin_addr.s_addr);
13834 SCTPDBG(SCTP_DEBUG_OUTPUT1, "match_nexthop4: src address is ");
13835 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &sifa->address.sa);
13836 SCTPDBG(SCTP_DEBUG_OUTPUT1, "network address is %x\n", srcnetaddr.s_addr);
13837
13838 sin = (struct sockaddr_in *)ro->ro_rt->rt_gateway;
13839 gwnetaddr.s_addr = (sin->sin_addr.s_addr & mask->sin_addr.s_addr);
13840 SCTPDBG(SCTP_DEBUG_OUTPUT1, "match_nexthop4: nexthop is ");
13841 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, ro->ro_rt->rt_gateway);
13842 SCTPDBG(SCTP_DEBUG_OUTPUT1, "network address is %x\n", gwnetaddr.s_addr);
13843 if (srcnetaddr.s_addr == gwnetaddr.s_addr) {
13844 return (1);
13845 }
13846 #endif
13847 return (0);
13848 }
Cache object: 0630e4593e90eadf784a604445e2ad4d
|