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: stable/12/sys/netinet/sctp_output.c 372318 2022-07-29 18:49:53Z dim $");
37
38 #include <netinet/sctp_os.h>
39 #include <sys/proc.h>
40 #include <netinet/sctp_var.h>
41 #include <netinet/sctp_sysctl.h>
42 #include <netinet/sctp_header.h>
43 #include <netinet/sctp_pcb.h>
44 #include <netinet/sctputil.h>
45 #include <netinet/sctp_output.h>
46 #include <netinet/sctp_uio.h>
47 #include <netinet/sctputil.h>
48 #include <netinet/sctp_auth.h>
49 #include <netinet/sctp_timer.h>
50 #include <netinet/sctp_asconf.h>
51 #include <netinet/sctp_indata.h>
52 #include <netinet/sctp_bsd_addr.h>
53 #include <netinet/sctp_input.h>
54 #include <netinet/sctp_crc32.h>
55 #include <netinet/sctp_kdtrace.h>
56 #if defined(INET) || defined(INET6)
57 #include <netinet/udp.h>
58 #endif
59 #include <netinet/udp_var.h>
60 #include <machine/in_cksum.h>
61
62
63 #define SCTP_MAX_GAPS_INARRAY 4
64 struct sack_track {
65 uint8_t right_edge; /* mergable on the right edge */
66 uint8_t left_edge; /* mergable on the left edge */
67 uint8_t num_entries;
68 uint8_t spare;
69 struct sctp_gap_ack_block gaps[SCTP_MAX_GAPS_INARRAY];
70 };
71
72 const struct sack_track sack_array[256] = {
73 {0, 0, 0, 0, /* 0x00 */
74 {{0, 0},
75 {0, 0},
76 {0, 0},
77 {0, 0}
78 }
79 },
80 {1, 0, 1, 0, /* 0x01 */
81 {{0, 0},
82 {0, 0},
83 {0, 0},
84 {0, 0}
85 }
86 },
87 {0, 0, 1, 0, /* 0x02 */
88 {{1, 1},
89 {0, 0},
90 {0, 0},
91 {0, 0}
92 }
93 },
94 {1, 0, 1, 0, /* 0x03 */
95 {{0, 1},
96 {0, 0},
97 {0, 0},
98 {0, 0}
99 }
100 },
101 {0, 0, 1, 0, /* 0x04 */
102 {{2, 2},
103 {0, 0},
104 {0, 0},
105 {0, 0}
106 }
107 },
108 {1, 0, 2, 0, /* 0x05 */
109 {{0, 0},
110 {2, 2},
111 {0, 0},
112 {0, 0}
113 }
114 },
115 {0, 0, 1, 0, /* 0x06 */
116 {{1, 2},
117 {0, 0},
118 {0, 0},
119 {0, 0}
120 }
121 },
122 {1, 0, 1, 0, /* 0x07 */
123 {{0, 2},
124 {0, 0},
125 {0, 0},
126 {0, 0}
127 }
128 },
129 {0, 0, 1, 0, /* 0x08 */
130 {{3, 3},
131 {0, 0},
132 {0, 0},
133 {0, 0}
134 }
135 },
136 {1, 0, 2, 0, /* 0x09 */
137 {{0, 0},
138 {3, 3},
139 {0, 0},
140 {0, 0}
141 }
142 },
143 {0, 0, 2, 0, /* 0x0a */
144 {{1, 1},
145 {3, 3},
146 {0, 0},
147 {0, 0}
148 }
149 },
150 {1, 0, 2, 0, /* 0x0b */
151 {{0, 1},
152 {3, 3},
153 {0, 0},
154 {0, 0}
155 }
156 },
157 {0, 0, 1, 0, /* 0x0c */
158 {{2, 3},
159 {0, 0},
160 {0, 0},
161 {0, 0}
162 }
163 },
164 {1, 0, 2, 0, /* 0x0d */
165 {{0, 0},
166 {2, 3},
167 {0, 0},
168 {0, 0}
169 }
170 },
171 {0, 0, 1, 0, /* 0x0e */
172 {{1, 3},
173 {0, 0},
174 {0, 0},
175 {0, 0}
176 }
177 },
178 {1, 0, 1, 0, /* 0x0f */
179 {{0, 3},
180 {0, 0},
181 {0, 0},
182 {0, 0}
183 }
184 },
185 {0, 0, 1, 0, /* 0x10 */
186 {{4, 4},
187 {0, 0},
188 {0, 0},
189 {0, 0}
190 }
191 },
192 {1, 0, 2, 0, /* 0x11 */
193 {{0, 0},
194 {4, 4},
195 {0, 0},
196 {0, 0}
197 }
198 },
199 {0, 0, 2, 0, /* 0x12 */
200 {{1, 1},
201 {4, 4},
202 {0, 0},
203 {0, 0}
204 }
205 },
206 {1, 0, 2, 0, /* 0x13 */
207 {{0, 1},
208 {4, 4},
209 {0, 0},
210 {0, 0}
211 }
212 },
213 {0, 0, 2, 0, /* 0x14 */
214 {{2, 2},
215 {4, 4},
216 {0, 0},
217 {0, 0}
218 }
219 },
220 {1, 0, 3, 0, /* 0x15 */
221 {{0, 0},
222 {2, 2},
223 {4, 4},
224 {0, 0}
225 }
226 },
227 {0, 0, 2, 0, /* 0x16 */
228 {{1, 2},
229 {4, 4},
230 {0, 0},
231 {0, 0}
232 }
233 },
234 {1, 0, 2, 0, /* 0x17 */
235 {{0, 2},
236 {4, 4},
237 {0, 0},
238 {0, 0}
239 }
240 },
241 {0, 0, 1, 0, /* 0x18 */
242 {{3, 4},
243 {0, 0},
244 {0, 0},
245 {0, 0}
246 }
247 },
248 {1, 0, 2, 0, /* 0x19 */
249 {{0, 0},
250 {3, 4},
251 {0, 0},
252 {0, 0}
253 }
254 },
255 {0, 0, 2, 0, /* 0x1a */
256 {{1, 1},
257 {3, 4},
258 {0, 0},
259 {0, 0}
260 }
261 },
262 {1, 0, 2, 0, /* 0x1b */
263 {{0, 1},
264 {3, 4},
265 {0, 0},
266 {0, 0}
267 }
268 },
269 {0, 0, 1, 0, /* 0x1c */
270 {{2, 4},
271 {0, 0},
272 {0, 0},
273 {0, 0}
274 }
275 },
276 {1, 0, 2, 0, /* 0x1d */
277 {{0, 0},
278 {2, 4},
279 {0, 0},
280 {0, 0}
281 }
282 },
283 {0, 0, 1, 0, /* 0x1e */
284 {{1, 4},
285 {0, 0},
286 {0, 0},
287 {0, 0}
288 }
289 },
290 {1, 0, 1, 0, /* 0x1f */
291 {{0, 4},
292 {0, 0},
293 {0, 0},
294 {0, 0}
295 }
296 },
297 {0, 0, 1, 0, /* 0x20 */
298 {{5, 5},
299 {0, 0},
300 {0, 0},
301 {0, 0}
302 }
303 },
304 {1, 0, 2, 0, /* 0x21 */
305 {{0, 0},
306 {5, 5},
307 {0, 0},
308 {0, 0}
309 }
310 },
311 {0, 0, 2, 0, /* 0x22 */
312 {{1, 1},
313 {5, 5},
314 {0, 0},
315 {0, 0}
316 }
317 },
318 {1, 0, 2, 0, /* 0x23 */
319 {{0, 1},
320 {5, 5},
321 {0, 0},
322 {0, 0}
323 }
324 },
325 {0, 0, 2, 0, /* 0x24 */
326 {{2, 2},
327 {5, 5},
328 {0, 0},
329 {0, 0}
330 }
331 },
332 {1, 0, 3, 0, /* 0x25 */
333 {{0, 0},
334 {2, 2},
335 {5, 5},
336 {0, 0}
337 }
338 },
339 {0, 0, 2, 0, /* 0x26 */
340 {{1, 2},
341 {5, 5},
342 {0, 0},
343 {0, 0}
344 }
345 },
346 {1, 0, 2, 0, /* 0x27 */
347 {{0, 2},
348 {5, 5},
349 {0, 0},
350 {0, 0}
351 }
352 },
353 {0, 0, 2, 0, /* 0x28 */
354 {{3, 3},
355 {5, 5},
356 {0, 0},
357 {0, 0}
358 }
359 },
360 {1, 0, 3, 0, /* 0x29 */
361 {{0, 0},
362 {3, 3},
363 {5, 5},
364 {0, 0}
365 }
366 },
367 {0, 0, 3, 0, /* 0x2a */
368 {{1, 1},
369 {3, 3},
370 {5, 5},
371 {0, 0}
372 }
373 },
374 {1, 0, 3, 0, /* 0x2b */
375 {{0, 1},
376 {3, 3},
377 {5, 5},
378 {0, 0}
379 }
380 },
381 {0, 0, 2, 0, /* 0x2c */
382 {{2, 3},
383 {5, 5},
384 {0, 0},
385 {0, 0}
386 }
387 },
388 {1, 0, 3, 0, /* 0x2d */
389 {{0, 0},
390 {2, 3},
391 {5, 5},
392 {0, 0}
393 }
394 },
395 {0, 0, 2, 0, /* 0x2e */
396 {{1, 3},
397 {5, 5},
398 {0, 0},
399 {0, 0}
400 }
401 },
402 {1, 0, 2, 0, /* 0x2f */
403 {{0, 3},
404 {5, 5},
405 {0, 0},
406 {0, 0}
407 }
408 },
409 {0, 0, 1, 0, /* 0x30 */
410 {{4, 5},
411 {0, 0},
412 {0, 0},
413 {0, 0}
414 }
415 },
416 {1, 0, 2, 0, /* 0x31 */
417 {{0, 0},
418 {4, 5},
419 {0, 0},
420 {0, 0}
421 }
422 },
423 {0, 0, 2, 0, /* 0x32 */
424 {{1, 1},
425 {4, 5},
426 {0, 0},
427 {0, 0}
428 }
429 },
430 {1, 0, 2, 0, /* 0x33 */
431 {{0, 1},
432 {4, 5},
433 {0, 0},
434 {0, 0}
435 }
436 },
437 {0, 0, 2, 0, /* 0x34 */
438 {{2, 2},
439 {4, 5},
440 {0, 0},
441 {0, 0}
442 }
443 },
444 {1, 0, 3, 0, /* 0x35 */
445 {{0, 0},
446 {2, 2},
447 {4, 5},
448 {0, 0}
449 }
450 },
451 {0, 0, 2, 0, /* 0x36 */
452 {{1, 2},
453 {4, 5},
454 {0, 0},
455 {0, 0}
456 }
457 },
458 {1, 0, 2, 0, /* 0x37 */
459 {{0, 2},
460 {4, 5},
461 {0, 0},
462 {0, 0}
463 }
464 },
465 {0, 0, 1, 0, /* 0x38 */
466 {{3, 5},
467 {0, 0},
468 {0, 0},
469 {0, 0}
470 }
471 },
472 {1, 0, 2, 0, /* 0x39 */
473 {{0, 0},
474 {3, 5},
475 {0, 0},
476 {0, 0}
477 }
478 },
479 {0, 0, 2, 0, /* 0x3a */
480 {{1, 1},
481 {3, 5},
482 {0, 0},
483 {0, 0}
484 }
485 },
486 {1, 0, 2, 0, /* 0x3b */
487 {{0, 1},
488 {3, 5},
489 {0, 0},
490 {0, 0}
491 }
492 },
493 {0, 0, 1, 0, /* 0x3c */
494 {{2, 5},
495 {0, 0},
496 {0, 0},
497 {0, 0}
498 }
499 },
500 {1, 0, 2, 0, /* 0x3d */
501 {{0, 0},
502 {2, 5},
503 {0, 0},
504 {0, 0}
505 }
506 },
507 {0, 0, 1, 0, /* 0x3e */
508 {{1, 5},
509 {0, 0},
510 {0, 0},
511 {0, 0}
512 }
513 },
514 {1, 0, 1, 0, /* 0x3f */
515 {{0, 5},
516 {0, 0},
517 {0, 0},
518 {0, 0}
519 }
520 },
521 {0, 0, 1, 0, /* 0x40 */
522 {{6, 6},
523 {0, 0},
524 {0, 0},
525 {0, 0}
526 }
527 },
528 {1, 0, 2, 0, /* 0x41 */
529 {{0, 0},
530 {6, 6},
531 {0, 0},
532 {0, 0}
533 }
534 },
535 {0, 0, 2, 0, /* 0x42 */
536 {{1, 1},
537 {6, 6},
538 {0, 0},
539 {0, 0}
540 }
541 },
542 {1, 0, 2, 0, /* 0x43 */
543 {{0, 1},
544 {6, 6},
545 {0, 0},
546 {0, 0}
547 }
548 },
549 {0, 0, 2, 0, /* 0x44 */
550 {{2, 2},
551 {6, 6},
552 {0, 0},
553 {0, 0}
554 }
555 },
556 {1, 0, 3, 0, /* 0x45 */
557 {{0, 0},
558 {2, 2},
559 {6, 6},
560 {0, 0}
561 }
562 },
563 {0, 0, 2, 0, /* 0x46 */
564 {{1, 2},
565 {6, 6},
566 {0, 0},
567 {0, 0}
568 }
569 },
570 {1, 0, 2, 0, /* 0x47 */
571 {{0, 2},
572 {6, 6},
573 {0, 0},
574 {0, 0}
575 }
576 },
577 {0, 0, 2, 0, /* 0x48 */
578 {{3, 3},
579 {6, 6},
580 {0, 0},
581 {0, 0}
582 }
583 },
584 {1, 0, 3, 0, /* 0x49 */
585 {{0, 0},
586 {3, 3},
587 {6, 6},
588 {0, 0}
589 }
590 },
591 {0, 0, 3, 0, /* 0x4a */
592 {{1, 1},
593 {3, 3},
594 {6, 6},
595 {0, 0}
596 }
597 },
598 {1, 0, 3, 0, /* 0x4b */
599 {{0, 1},
600 {3, 3},
601 {6, 6},
602 {0, 0}
603 }
604 },
605 {0, 0, 2, 0, /* 0x4c */
606 {{2, 3},
607 {6, 6},
608 {0, 0},
609 {0, 0}
610 }
611 },
612 {1, 0, 3, 0, /* 0x4d */
613 {{0, 0},
614 {2, 3},
615 {6, 6},
616 {0, 0}
617 }
618 },
619 {0, 0, 2, 0, /* 0x4e */
620 {{1, 3},
621 {6, 6},
622 {0, 0},
623 {0, 0}
624 }
625 },
626 {1, 0, 2, 0, /* 0x4f */
627 {{0, 3},
628 {6, 6},
629 {0, 0},
630 {0, 0}
631 }
632 },
633 {0, 0, 2, 0, /* 0x50 */
634 {{4, 4},
635 {6, 6},
636 {0, 0},
637 {0, 0}
638 }
639 },
640 {1, 0, 3, 0, /* 0x51 */
641 {{0, 0},
642 {4, 4},
643 {6, 6},
644 {0, 0}
645 }
646 },
647 {0, 0, 3, 0, /* 0x52 */
648 {{1, 1},
649 {4, 4},
650 {6, 6},
651 {0, 0}
652 }
653 },
654 {1, 0, 3, 0, /* 0x53 */
655 {{0, 1},
656 {4, 4},
657 {6, 6},
658 {0, 0}
659 }
660 },
661 {0, 0, 3, 0, /* 0x54 */
662 {{2, 2},
663 {4, 4},
664 {6, 6},
665 {0, 0}
666 }
667 },
668 {1, 0, 4, 0, /* 0x55 */
669 {{0, 0},
670 {2, 2},
671 {4, 4},
672 {6, 6}
673 }
674 },
675 {0, 0, 3, 0, /* 0x56 */
676 {{1, 2},
677 {4, 4},
678 {6, 6},
679 {0, 0}
680 }
681 },
682 {1, 0, 3, 0, /* 0x57 */
683 {{0, 2},
684 {4, 4},
685 {6, 6},
686 {0, 0}
687 }
688 },
689 {0, 0, 2, 0, /* 0x58 */
690 {{3, 4},
691 {6, 6},
692 {0, 0},
693 {0, 0}
694 }
695 },
696 {1, 0, 3, 0, /* 0x59 */
697 {{0, 0},
698 {3, 4},
699 {6, 6},
700 {0, 0}
701 }
702 },
703 {0, 0, 3, 0, /* 0x5a */
704 {{1, 1},
705 {3, 4},
706 {6, 6},
707 {0, 0}
708 }
709 },
710 {1, 0, 3, 0, /* 0x5b */
711 {{0, 1},
712 {3, 4},
713 {6, 6},
714 {0, 0}
715 }
716 },
717 {0, 0, 2, 0, /* 0x5c */
718 {{2, 4},
719 {6, 6},
720 {0, 0},
721 {0, 0}
722 }
723 },
724 {1, 0, 3, 0, /* 0x5d */
725 {{0, 0},
726 {2, 4},
727 {6, 6},
728 {0, 0}
729 }
730 },
731 {0, 0, 2, 0, /* 0x5e */
732 {{1, 4},
733 {6, 6},
734 {0, 0},
735 {0, 0}
736 }
737 },
738 {1, 0, 2, 0, /* 0x5f */
739 {{0, 4},
740 {6, 6},
741 {0, 0},
742 {0, 0}
743 }
744 },
745 {0, 0, 1, 0, /* 0x60 */
746 {{5, 6},
747 {0, 0},
748 {0, 0},
749 {0, 0}
750 }
751 },
752 {1, 0, 2, 0, /* 0x61 */
753 {{0, 0},
754 {5, 6},
755 {0, 0},
756 {0, 0}
757 }
758 },
759 {0, 0, 2, 0, /* 0x62 */
760 {{1, 1},
761 {5, 6},
762 {0, 0},
763 {0, 0}
764 }
765 },
766 {1, 0, 2, 0, /* 0x63 */
767 {{0, 1},
768 {5, 6},
769 {0, 0},
770 {0, 0}
771 }
772 },
773 {0, 0, 2, 0, /* 0x64 */
774 {{2, 2},
775 {5, 6},
776 {0, 0},
777 {0, 0}
778 }
779 },
780 {1, 0, 3, 0, /* 0x65 */
781 {{0, 0},
782 {2, 2},
783 {5, 6},
784 {0, 0}
785 }
786 },
787 {0, 0, 2, 0, /* 0x66 */
788 {{1, 2},
789 {5, 6},
790 {0, 0},
791 {0, 0}
792 }
793 },
794 {1, 0, 2, 0, /* 0x67 */
795 {{0, 2},
796 {5, 6},
797 {0, 0},
798 {0, 0}
799 }
800 },
801 {0, 0, 2, 0, /* 0x68 */
802 {{3, 3},
803 {5, 6},
804 {0, 0},
805 {0, 0}
806 }
807 },
808 {1, 0, 3, 0, /* 0x69 */
809 {{0, 0},
810 {3, 3},
811 {5, 6},
812 {0, 0}
813 }
814 },
815 {0, 0, 3, 0, /* 0x6a */
816 {{1, 1},
817 {3, 3},
818 {5, 6},
819 {0, 0}
820 }
821 },
822 {1, 0, 3, 0, /* 0x6b */
823 {{0, 1},
824 {3, 3},
825 {5, 6},
826 {0, 0}
827 }
828 },
829 {0, 0, 2, 0, /* 0x6c */
830 {{2, 3},
831 {5, 6},
832 {0, 0},
833 {0, 0}
834 }
835 },
836 {1, 0, 3, 0, /* 0x6d */
837 {{0, 0},
838 {2, 3},
839 {5, 6},
840 {0, 0}
841 }
842 },
843 {0, 0, 2, 0, /* 0x6e */
844 {{1, 3},
845 {5, 6},
846 {0, 0},
847 {0, 0}
848 }
849 },
850 {1, 0, 2, 0, /* 0x6f */
851 {{0, 3},
852 {5, 6},
853 {0, 0},
854 {0, 0}
855 }
856 },
857 {0, 0, 1, 0, /* 0x70 */
858 {{4, 6},
859 {0, 0},
860 {0, 0},
861 {0, 0}
862 }
863 },
864 {1, 0, 2, 0, /* 0x71 */
865 {{0, 0},
866 {4, 6},
867 {0, 0},
868 {0, 0}
869 }
870 },
871 {0, 0, 2, 0, /* 0x72 */
872 {{1, 1},
873 {4, 6},
874 {0, 0},
875 {0, 0}
876 }
877 },
878 {1, 0, 2, 0, /* 0x73 */
879 {{0, 1},
880 {4, 6},
881 {0, 0},
882 {0, 0}
883 }
884 },
885 {0, 0, 2, 0, /* 0x74 */
886 {{2, 2},
887 {4, 6},
888 {0, 0},
889 {0, 0}
890 }
891 },
892 {1, 0, 3, 0, /* 0x75 */
893 {{0, 0},
894 {2, 2},
895 {4, 6},
896 {0, 0}
897 }
898 },
899 {0, 0, 2, 0, /* 0x76 */
900 {{1, 2},
901 {4, 6},
902 {0, 0},
903 {0, 0}
904 }
905 },
906 {1, 0, 2, 0, /* 0x77 */
907 {{0, 2},
908 {4, 6},
909 {0, 0},
910 {0, 0}
911 }
912 },
913 {0, 0, 1, 0, /* 0x78 */
914 {{3, 6},
915 {0, 0},
916 {0, 0},
917 {0, 0}
918 }
919 },
920 {1, 0, 2, 0, /* 0x79 */
921 {{0, 0},
922 {3, 6},
923 {0, 0},
924 {0, 0}
925 }
926 },
927 {0, 0, 2, 0, /* 0x7a */
928 {{1, 1},
929 {3, 6},
930 {0, 0},
931 {0, 0}
932 }
933 },
934 {1, 0, 2, 0, /* 0x7b */
935 {{0, 1},
936 {3, 6},
937 {0, 0},
938 {0, 0}
939 }
940 },
941 {0, 0, 1, 0, /* 0x7c */
942 {{2, 6},
943 {0, 0},
944 {0, 0},
945 {0, 0}
946 }
947 },
948 {1, 0, 2, 0, /* 0x7d */
949 {{0, 0},
950 {2, 6},
951 {0, 0},
952 {0, 0}
953 }
954 },
955 {0, 0, 1, 0, /* 0x7e */
956 {{1, 6},
957 {0, 0},
958 {0, 0},
959 {0, 0}
960 }
961 },
962 {1, 0, 1, 0, /* 0x7f */
963 {{0, 6},
964 {0, 0},
965 {0, 0},
966 {0, 0}
967 }
968 },
969 {0, 1, 1, 0, /* 0x80 */
970 {{7, 7},
971 {0, 0},
972 {0, 0},
973 {0, 0}
974 }
975 },
976 {1, 1, 2, 0, /* 0x81 */
977 {{0, 0},
978 {7, 7},
979 {0, 0},
980 {0, 0}
981 }
982 },
983 {0, 1, 2, 0, /* 0x82 */
984 {{1, 1},
985 {7, 7},
986 {0, 0},
987 {0, 0}
988 }
989 },
990 {1, 1, 2, 0, /* 0x83 */
991 {{0, 1},
992 {7, 7},
993 {0, 0},
994 {0, 0}
995 }
996 },
997 {0, 1, 2, 0, /* 0x84 */
998 {{2, 2},
999 {7, 7},
1000 {0, 0},
1001 {0, 0}
1002 }
1003 },
1004 {1, 1, 3, 0, /* 0x85 */
1005 {{0, 0},
1006 {2, 2},
1007 {7, 7},
1008 {0, 0}
1009 }
1010 },
1011 {0, 1, 2, 0, /* 0x86 */
1012 {{1, 2},
1013 {7, 7},
1014 {0, 0},
1015 {0, 0}
1016 }
1017 },
1018 {1, 1, 2, 0, /* 0x87 */
1019 {{0, 2},
1020 {7, 7},
1021 {0, 0},
1022 {0, 0}
1023 }
1024 },
1025 {0, 1, 2, 0, /* 0x88 */
1026 {{3, 3},
1027 {7, 7},
1028 {0, 0},
1029 {0, 0}
1030 }
1031 },
1032 {1, 1, 3, 0, /* 0x89 */
1033 {{0, 0},
1034 {3, 3},
1035 {7, 7},
1036 {0, 0}
1037 }
1038 },
1039 {0, 1, 3, 0, /* 0x8a */
1040 {{1, 1},
1041 {3, 3},
1042 {7, 7},
1043 {0, 0}
1044 }
1045 },
1046 {1, 1, 3, 0, /* 0x8b */
1047 {{0, 1},
1048 {3, 3},
1049 {7, 7},
1050 {0, 0}
1051 }
1052 },
1053 {0, 1, 2, 0, /* 0x8c */
1054 {{2, 3},
1055 {7, 7},
1056 {0, 0},
1057 {0, 0}
1058 }
1059 },
1060 {1, 1, 3, 0, /* 0x8d */
1061 {{0, 0},
1062 {2, 3},
1063 {7, 7},
1064 {0, 0}
1065 }
1066 },
1067 {0, 1, 2, 0, /* 0x8e */
1068 {{1, 3},
1069 {7, 7},
1070 {0, 0},
1071 {0, 0}
1072 }
1073 },
1074 {1, 1, 2, 0, /* 0x8f */
1075 {{0, 3},
1076 {7, 7},
1077 {0, 0},
1078 {0, 0}
1079 }
1080 },
1081 {0, 1, 2, 0, /* 0x90 */
1082 {{4, 4},
1083 {7, 7},
1084 {0, 0},
1085 {0, 0}
1086 }
1087 },
1088 {1, 1, 3, 0, /* 0x91 */
1089 {{0, 0},
1090 {4, 4},
1091 {7, 7},
1092 {0, 0}
1093 }
1094 },
1095 {0, 1, 3, 0, /* 0x92 */
1096 {{1, 1},
1097 {4, 4},
1098 {7, 7},
1099 {0, 0}
1100 }
1101 },
1102 {1, 1, 3, 0, /* 0x93 */
1103 {{0, 1},
1104 {4, 4},
1105 {7, 7},
1106 {0, 0}
1107 }
1108 },
1109 {0, 1, 3, 0, /* 0x94 */
1110 {{2, 2},
1111 {4, 4},
1112 {7, 7},
1113 {0, 0}
1114 }
1115 },
1116 {1, 1, 4, 0, /* 0x95 */
1117 {{0, 0},
1118 {2, 2},
1119 {4, 4},
1120 {7, 7}
1121 }
1122 },
1123 {0, 1, 3, 0, /* 0x96 */
1124 {{1, 2},
1125 {4, 4},
1126 {7, 7},
1127 {0, 0}
1128 }
1129 },
1130 {1, 1, 3, 0, /* 0x97 */
1131 {{0, 2},
1132 {4, 4},
1133 {7, 7},
1134 {0, 0}
1135 }
1136 },
1137 {0, 1, 2, 0, /* 0x98 */
1138 {{3, 4},
1139 {7, 7},
1140 {0, 0},
1141 {0, 0}
1142 }
1143 },
1144 {1, 1, 3, 0, /* 0x99 */
1145 {{0, 0},
1146 {3, 4},
1147 {7, 7},
1148 {0, 0}
1149 }
1150 },
1151 {0, 1, 3, 0, /* 0x9a */
1152 {{1, 1},
1153 {3, 4},
1154 {7, 7},
1155 {0, 0}
1156 }
1157 },
1158 {1, 1, 3, 0, /* 0x9b */
1159 {{0, 1},
1160 {3, 4},
1161 {7, 7},
1162 {0, 0}
1163 }
1164 },
1165 {0, 1, 2, 0, /* 0x9c */
1166 {{2, 4},
1167 {7, 7},
1168 {0, 0},
1169 {0, 0}
1170 }
1171 },
1172 {1, 1, 3, 0, /* 0x9d */
1173 {{0, 0},
1174 {2, 4},
1175 {7, 7},
1176 {0, 0}
1177 }
1178 },
1179 {0, 1, 2, 0, /* 0x9e */
1180 {{1, 4},
1181 {7, 7},
1182 {0, 0},
1183 {0, 0}
1184 }
1185 },
1186 {1, 1, 2, 0, /* 0x9f */
1187 {{0, 4},
1188 {7, 7},
1189 {0, 0},
1190 {0, 0}
1191 }
1192 },
1193 {0, 1, 2, 0, /* 0xa0 */
1194 {{5, 5},
1195 {7, 7},
1196 {0, 0},
1197 {0, 0}
1198 }
1199 },
1200 {1, 1, 3, 0, /* 0xa1 */
1201 {{0, 0},
1202 {5, 5},
1203 {7, 7},
1204 {0, 0}
1205 }
1206 },
1207 {0, 1, 3, 0, /* 0xa2 */
1208 {{1, 1},
1209 {5, 5},
1210 {7, 7},
1211 {0, 0}
1212 }
1213 },
1214 {1, 1, 3, 0, /* 0xa3 */
1215 {{0, 1},
1216 {5, 5},
1217 {7, 7},
1218 {0, 0}
1219 }
1220 },
1221 {0, 1, 3, 0, /* 0xa4 */
1222 {{2, 2},
1223 {5, 5},
1224 {7, 7},
1225 {0, 0}
1226 }
1227 },
1228 {1, 1, 4, 0, /* 0xa5 */
1229 {{0, 0},
1230 {2, 2},
1231 {5, 5},
1232 {7, 7}
1233 }
1234 },
1235 {0, 1, 3, 0, /* 0xa6 */
1236 {{1, 2},
1237 {5, 5},
1238 {7, 7},
1239 {0, 0}
1240 }
1241 },
1242 {1, 1, 3, 0, /* 0xa7 */
1243 {{0, 2},
1244 {5, 5},
1245 {7, 7},
1246 {0, 0}
1247 }
1248 },
1249 {0, 1, 3, 0, /* 0xa8 */
1250 {{3, 3},
1251 {5, 5},
1252 {7, 7},
1253 {0, 0}
1254 }
1255 },
1256 {1, 1, 4, 0, /* 0xa9 */
1257 {{0, 0},
1258 {3, 3},
1259 {5, 5},
1260 {7, 7}
1261 }
1262 },
1263 {0, 1, 4, 0, /* 0xaa */
1264 {{1, 1},
1265 {3, 3},
1266 {5, 5},
1267 {7, 7}
1268 }
1269 },
1270 {1, 1, 4, 0, /* 0xab */
1271 {{0, 1},
1272 {3, 3},
1273 {5, 5},
1274 {7, 7}
1275 }
1276 },
1277 {0, 1, 3, 0, /* 0xac */
1278 {{2, 3},
1279 {5, 5},
1280 {7, 7},
1281 {0, 0}
1282 }
1283 },
1284 {1, 1, 4, 0, /* 0xad */
1285 {{0, 0},
1286 {2, 3},
1287 {5, 5},
1288 {7, 7}
1289 }
1290 },
1291 {0, 1, 3, 0, /* 0xae */
1292 {{1, 3},
1293 {5, 5},
1294 {7, 7},
1295 {0, 0}
1296 }
1297 },
1298 {1, 1, 3, 0, /* 0xaf */
1299 {{0, 3},
1300 {5, 5},
1301 {7, 7},
1302 {0, 0}
1303 }
1304 },
1305 {0, 1, 2, 0, /* 0xb0 */
1306 {{4, 5},
1307 {7, 7},
1308 {0, 0},
1309 {0, 0}
1310 }
1311 },
1312 {1, 1, 3, 0, /* 0xb1 */
1313 {{0, 0},
1314 {4, 5},
1315 {7, 7},
1316 {0, 0}
1317 }
1318 },
1319 {0, 1, 3, 0, /* 0xb2 */
1320 {{1, 1},
1321 {4, 5},
1322 {7, 7},
1323 {0, 0}
1324 }
1325 },
1326 {1, 1, 3, 0, /* 0xb3 */
1327 {{0, 1},
1328 {4, 5},
1329 {7, 7},
1330 {0, 0}
1331 }
1332 },
1333 {0, 1, 3, 0, /* 0xb4 */
1334 {{2, 2},
1335 {4, 5},
1336 {7, 7},
1337 {0, 0}
1338 }
1339 },
1340 {1, 1, 4, 0, /* 0xb5 */
1341 {{0, 0},
1342 {2, 2},
1343 {4, 5},
1344 {7, 7}
1345 }
1346 },
1347 {0, 1, 3, 0, /* 0xb6 */
1348 {{1, 2},
1349 {4, 5},
1350 {7, 7},
1351 {0, 0}
1352 }
1353 },
1354 {1, 1, 3, 0, /* 0xb7 */
1355 {{0, 2},
1356 {4, 5},
1357 {7, 7},
1358 {0, 0}
1359 }
1360 },
1361 {0, 1, 2, 0, /* 0xb8 */
1362 {{3, 5},
1363 {7, 7},
1364 {0, 0},
1365 {0, 0}
1366 }
1367 },
1368 {1, 1, 3, 0, /* 0xb9 */
1369 {{0, 0},
1370 {3, 5},
1371 {7, 7},
1372 {0, 0}
1373 }
1374 },
1375 {0, 1, 3, 0, /* 0xba */
1376 {{1, 1},
1377 {3, 5},
1378 {7, 7},
1379 {0, 0}
1380 }
1381 },
1382 {1, 1, 3, 0, /* 0xbb */
1383 {{0, 1},
1384 {3, 5},
1385 {7, 7},
1386 {0, 0}
1387 }
1388 },
1389 {0, 1, 2, 0, /* 0xbc */
1390 {{2, 5},
1391 {7, 7},
1392 {0, 0},
1393 {0, 0}
1394 }
1395 },
1396 {1, 1, 3, 0, /* 0xbd */
1397 {{0, 0},
1398 {2, 5},
1399 {7, 7},
1400 {0, 0}
1401 }
1402 },
1403 {0, 1, 2, 0, /* 0xbe */
1404 {{1, 5},
1405 {7, 7},
1406 {0, 0},
1407 {0, 0}
1408 }
1409 },
1410 {1, 1, 2, 0, /* 0xbf */
1411 {{0, 5},
1412 {7, 7},
1413 {0, 0},
1414 {0, 0}
1415 }
1416 },
1417 {0, 1, 1, 0, /* 0xc0 */
1418 {{6, 7},
1419 {0, 0},
1420 {0, 0},
1421 {0, 0}
1422 }
1423 },
1424 {1, 1, 2, 0, /* 0xc1 */
1425 {{0, 0},
1426 {6, 7},
1427 {0, 0},
1428 {0, 0}
1429 }
1430 },
1431 {0, 1, 2, 0, /* 0xc2 */
1432 {{1, 1},
1433 {6, 7},
1434 {0, 0},
1435 {0, 0}
1436 }
1437 },
1438 {1, 1, 2, 0, /* 0xc3 */
1439 {{0, 1},
1440 {6, 7},
1441 {0, 0},
1442 {0, 0}
1443 }
1444 },
1445 {0, 1, 2, 0, /* 0xc4 */
1446 {{2, 2},
1447 {6, 7},
1448 {0, 0},
1449 {0, 0}
1450 }
1451 },
1452 {1, 1, 3, 0, /* 0xc5 */
1453 {{0, 0},
1454 {2, 2},
1455 {6, 7},
1456 {0, 0}
1457 }
1458 },
1459 {0, 1, 2, 0, /* 0xc6 */
1460 {{1, 2},
1461 {6, 7},
1462 {0, 0},
1463 {0, 0}
1464 }
1465 },
1466 {1, 1, 2, 0, /* 0xc7 */
1467 {{0, 2},
1468 {6, 7},
1469 {0, 0},
1470 {0, 0}
1471 }
1472 },
1473 {0, 1, 2, 0, /* 0xc8 */
1474 {{3, 3},
1475 {6, 7},
1476 {0, 0},
1477 {0, 0}
1478 }
1479 },
1480 {1, 1, 3, 0, /* 0xc9 */
1481 {{0, 0},
1482 {3, 3},
1483 {6, 7},
1484 {0, 0}
1485 }
1486 },
1487 {0, 1, 3, 0, /* 0xca */
1488 {{1, 1},
1489 {3, 3},
1490 {6, 7},
1491 {0, 0}
1492 }
1493 },
1494 {1, 1, 3, 0, /* 0xcb */
1495 {{0, 1},
1496 {3, 3},
1497 {6, 7},
1498 {0, 0}
1499 }
1500 },
1501 {0, 1, 2, 0, /* 0xcc */
1502 {{2, 3},
1503 {6, 7},
1504 {0, 0},
1505 {0, 0}
1506 }
1507 },
1508 {1, 1, 3, 0, /* 0xcd */
1509 {{0, 0},
1510 {2, 3},
1511 {6, 7},
1512 {0, 0}
1513 }
1514 },
1515 {0, 1, 2, 0, /* 0xce */
1516 {{1, 3},
1517 {6, 7},
1518 {0, 0},
1519 {0, 0}
1520 }
1521 },
1522 {1, 1, 2, 0, /* 0xcf */
1523 {{0, 3},
1524 {6, 7},
1525 {0, 0},
1526 {0, 0}
1527 }
1528 },
1529 {0, 1, 2, 0, /* 0xd0 */
1530 {{4, 4},
1531 {6, 7},
1532 {0, 0},
1533 {0, 0}
1534 }
1535 },
1536 {1, 1, 3, 0, /* 0xd1 */
1537 {{0, 0},
1538 {4, 4},
1539 {6, 7},
1540 {0, 0}
1541 }
1542 },
1543 {0, 1, 3, 0, /* 0xd2 */
1544 {{1, 1},
1545 {4, 4},
1546 {6, 7},
1547 {0, 0}
1548 }
1549 },
1550 {1, 1, 3, 0, /* 0xd3 */
1551 {{0, 1},
1552 {4, 4},
1553 {6, 7},
1554 {0, 0}
1555 }
1556 },
1557 {0, 1, 3, 0, /* 0xd4 */
1558 {{2, 2},
1559 {4, 4},
1560 {6, 7},
1561 {0, 0}
1562 }
1563 },
1564 {1, 1, 4, 0, /* 0xd5 */
1565 {{0, 0},
1566 {2, 2},
1567 {4, 4},
1568 {6, 7}
1569 }
1570 },
1571 {0, 1, 3, 0, /* 0xd6 */
1572 {{1, 2},
1573 {4, 4},
1574 {6, 7},
1575 {0, 0}
1576 }
1577 },
1578 {1, 1, 3, 0, /* 0xd7 */
1579 {{0, 2},
1580 {4, 4},
1581 {6, 7},
1582 {0, 0}
1583 }
1584 },
1585 {0, 1, 2, 0, /* 0xd8 */
1586 {{3, 4},
1587 {6, 7},
1588 {0, 0},
1589 {0, 0}
1590 }
1591 },
1592 {1, 1, 3, 0, /* 0xd9 */
1593 {{0, 0},
1594 {3, 4},
1595 {6, 7},
1596 {0, 0}
1597 }
1598 },
1599 {0, 1, 3, 0, /* 0xda */
1600 {{1, 1},
1601 {3, 4},
1602 {6, 7},
1603 {0, 0}
1604 }
1605 },
1606 {1, 1, 3, 0, /* 0xdb */
1607 {{0, 1},
1608 {3, 4},
1609 {6, 7},
1610 {0, 0}
1611 }
1612 },
1613 {0, 1, 2, 0, /* 0xdc */
1614 {{2, 4},
1615 {6, 7},
1616 {0, 0},
1617 {0, 0}
1618 }
1619 },
1620 {1, 1, 3, 0, /* 0xdd */
1621 {{0, 0},
1622 {2, 4},
1623 {6, 7},
1624 {0, 0}
1625 }
1626 },
1627 {0, 1, 2, 0, /* 0xde */
1628 {{1, 4},
1629 {6, 7},
1630 {0, 0},
1631 {0, 0}
1632 }
1633 },
1634 {1, 1, 2, 0, /* 0xdf */
1635 {{0, 4},
1636 {6, 7},
1637 {0, 0},
1638 {0, 0}
1639 }
1640 },
1641 {0, 1, 1, 0, /* 0xe0 */
1642 {{5, 7},
1643 {0, 0},
1644 {0, 0},
1645 {0, 0}
1646 }
1647 },
1648 {1, 1, 2, 0, /* 0xe1 */
1649 {{0, 0},
1650 {5, 7},
1651 {0, 0},
1652 {0, 0}
1653 }
1654 },
1655 {0, 1, 2, 0, /* 0xe2 */
1656 {{1, 1},
1657 {5, 7},
1658 {0, 0},
1659 {0, 0}
1660 }
1661 },
1662 {1, 1, 2, 0, /* 0xe3 */
1663 {{0, 1},
1664 {5, 7},
1665 {0, 0},
1666 {0, 0}
1667 }
1668 },
1669 {0, 1, 2, 0, /* 0xe4 */
1670 {{2, 2},
1671 {5, 7},
1672 {0, 0},
1673 {0, 0}
1674 }
1675 },
1676 {1, 1, 3, 0, /* 0xe5 */
1677 {{0, 0},
1678 {2, 2},
1679 {5, 7},
1680 {0, 0}
1681 }
1682 },
1683 {0, 1, 2, 0, /* 0xe6 */
1684 {{1, 2},
1685 {5, 7},
1686 {0, 0},
1687 {0, 0}
1688 }
1689 },
1690 {1, 1, 2, 0, /* 0xe7 */
1691 {{0, 2},
1692 {5, 7},
1693 {0, 0},
1694 {0, 0}
1695 }
1696 },
1697 {0, 1, 2, 0, /* 0xe8 */
1698 {{3, 3},
1699 {5, 7},
1700 {0, 0},
1701 {0, 0}
1702 }
1703 },
1704 {1, 1, 3, 0, /* 0xe9 */
1705 {{0, 0},
1706 {3, 3},
1707 {5, 7},
1708 {0, 0}
1709 }
1710 },
1711 {0, 1, 3, 0, /* 0xea */
1712 {{1, 1},
1713 {3, 3},
1714 {5, 7},
1715 {0, 0}
1716 }
1717 },
1718 {1, 1, 3, 0, /* 0xeb */
1719 {{0, 1},
1720 {3, 3},
1721 {5, 7},
1722 {0, 0}
1723 }
1724 },
1725 {0, 1, 2, 0, /* 0xec */
1726 {{2, 3},
1727 {5, 7},
1728 {0, 0},
1729 {0, 0}
1730 }
1731 },
1732 {1, 1, 3, 0, /* 0xed */
1733 {{0, 0},
1734 {2, 3},
1735 {5, 7},
1736 {0, 0}
1737 }
1738 },
1739 {0, 1, 2, 0, /* 0xee */
1740 {{1, 3},
1741 {5, 7},
1742 {0, 0},
1743 {0, 0}
1744 }
1745 },
1746 {1, 1, 2, 0, /* 0xef */
1747 {{0, 3},
1748 {5, 7},
1749 {0, 0},
1750 {0, 0}
1751 }
1752 },
1753 {0, 1, 1, 0, /* 0xf0 */
1754 {{4, 7},
1755 {0, 0},
1756 {0, 0},
1757 {0, 0}
1758 }
1759 },
1760 {1, 1, 2, 0, /* 0xf1 */
1761 {{0, 0},
1762 {4, 7},
1763 {0, 0},
1764 {0, 0}
1765 }
1766 },
1767 {0, 1, 2, 0, /* 0xf2 */
1768 {{1, 1},
1769 {4, 7},
1770 {0, 0},
1771 {0, 0}
1772 }
1773 },
1774 {1, 1, 2, 0, /* 0xf3 */
1775 {{0, 1},
1776 {4, 7},
1777 {0, 0},
1778 {0, 0}
1779 }
1780 },
1781 {0, 1, 2, 0, /* 0xf4 */
1782 {{2, 2},
1783 {4, 7},
1784 {0, 0},
1785 {0, 0}
1786 }
1787 },
1788 {1, 1, 3, 0, /* 0xf5 */
1789 {{0, 0},
1790 {2, 2},
1791 {4, 7},
1792 {0, 0}
1793 }
1794 },
1795 {0, 1, 2, 0, /* 0xf6 */
1796 {{1, 2},
1797 {4, 7},
1798 {0, 0},
1799 {0, 0}
1800 }
1801 },
1802 {1, 1, 2, 0, /* 0xf7 */
1803 {{0, 2},
1804 {4, 7},
1805 {0, 0},
1806 {0, 0}
1807 }
1808 },
1809 {0, 1, 1, 0, /* 0xf8 */
1810 {{3, 7},
1811 {0, 0},
1812 {0, 0},
1813 {0, 0}
1814 }
1815 },
1816 {1, 1, 2, 0, /* 0xf9 */
1817 {{0, 0},
1818 {3, 7},
1819 {0, 0},
1820 {0, 0}
1821 }
1822 },
1823 {0, 1, 2, 0, /* 0xfa */
1824 {{1, 1},
1825 {3, 7},
1826 {0, 0},
1827 {0, 0}
1828 }
1829 },
1830 {1, 1, 2, 0, /* 0xfb */
1831 {{0, 1},
1832 {3, 7},
1833 {0, 0},
1834 {0, 0}
1835 }
1836 },
1837 {0, 1, 1, 0, /* 0xfc */
1838 {{2, 7},
1839 {0, 0},
1840 {0, 0},
1841 {0, 0}
1842 }
1843 },
1844 {1, 1, 2, 0, /* 0xfd */
1845 {{0, 0},
1846 {2, 7},
1847 {0, 0},
1848 {0, 0}
1849 }
1850 },
1851 {0, 1, 1, 0, /* 0xfe */
1852 {{1, 7},
1853 {0, 0},
1854 {0, 0},
1855 {0, 0}
1856 }
1857 },
1858 {1, 1, 1, 0, /* 0xff */
1859 {{0, 7},
1860 {0, 0},
1861 {0, 0},
1862 {0, 0}
1863 }
1864 }
1865 };
1866
1867
1868 int
sctp_is_address_in_scope(struct sctp_ifa * ifa,struct sctp_scoping * scope,int do_update)1869 sctp_is_address_in_scope(struct sctp_ifa *ifa,
1870 struct sctp_scoping *scope,
1871 int do_update)
1872 {
1873 if ((scope->loopback_scope == 0) &&
1874 (ifa->ifn_p) && SCTP_IFN_IS_IFT_LOOP(ifa->ifn_p)) {
1875 /*
1876 * skip loopback if not in scope *
1877 */
1878 return (0);
1879 }
1880 switch (ifa->address.sa.sa_family) {
1881 #ifdef INET
1882 case AF_INET:
1883 if (scope->ipv4_addr_legal) {
1884 struct sockaddr_in *sin;
1885
1886 sin = &ifa->address.sin;
1887 if (sin->sin_addr.s_addr == 0) {
1888 /* not in scope , unspecified */
1889 return (0);
1890 }
1891 if ((scope->ipv4_local_scope == 0) &&
1892 (IN4_ISPRIVATE_ADDRESS(&sin->sin_addr))) {
1893 /* private address not in scope */
1894 return (0);
1895 }
1896 } else {
1897 return (0);
1898 }
1899 break;
1900 #endif
1901 #ifdef INET6
1902 case AF_INET6:
1903 if (scope->ipv6_addr_legal) {
1904 struct sockaddr_in6 *sin6;
1905
1906 /*
1907 * Must update the flags, bummer, which means any
1908 * IFA locks must now be applied HERE <->
1909 */
1910 if (do_update) {
1911 sctp_gather_internal_ifa_flags(ifa);
1912 }
1913 if (ifa->localifa_flags & SCTP_ADDR_IFA_UNUSEABLE) {
1914 return (0);
1915 }
1916 /* ok to use deprecated addresses? */
1917 sin6 = &ifa->address.sin6;
1918 if (IN6_IS_ADDR_UNSPECIFIED(&sin6->sin6_addr)) {
1919 /* skip unspecifed addresses */
1920 return (0);
1921 }
1922 if ( /* (local_scope == 0) && */
1923 (IN6_IS_ADDR_LINKLOCAL(&sin6->sin6_addr))) {
1924 return (0);
1925 }
1926 if ((scope->site_scope == 0) &&
1927 (IN6_IS_ADDR_SITELOCAL(&sin6->sin6_addr))) {
1928 return (0);
1929 }
1930 } else {
1931 return (0);
1932 }
1933 break;
1934 #endif
1935 default:
1936 return (0);
1937 }
1938 return (1);
1939 }
1940
1941 static struct mbuf *
sctp_add_addr_to_mbuf(struct mbuf * m,struct sctp_ifa * ifa,uint16_t * len)1942 sctp_add_addr_to_mbuf(struct mbuf *m, struct sctp_ifa *ifa, uint16_t *len)
1943 {
1944 #if defined(INET) || defined(INET6)
1945 struct sctp_paramhdr *paramh;
1946 struct mbuf *mret;
1947 uint16_t plen;
1948 #endif
1949
1950 switch (ifa->address.sa.sa_family) {
1951 #ifdef INET
1952 case AF_INET:
1953 plen = (uint16_t)sizeof(struct sctp_ipv4addr_param);
1954 break;
1955 #endif
1956 #ifdef INET6
1957 case AF_INET6:
1958 plen = (uint16_t)sizeof(struct sctp_ipv6addr_param);
1959 break;
1960 #endif
1961 default:
1962 return (m);
1963 }
1964 #if defined(INET) || defined(INET6)
1965 if (M_TRAILINGSPACE(m) >= plen) {
1966 /* easy side we just drop it on the end */
1967 paramh = (struct sctp_paramhdr *)(SCTP_BUF_AT(m, SCTP_BUF_LEN(m)));
1968 mret = m;
1969 } else {
1970 /* Need more space */
1971 mret = m;
1972 while (SCTP_BUF_NEXT(mret) != NULL) {
1973 mret = SCTP_BUF_NEXT(mret);
1974 }
1975 SCTP_BUF_NEXT(mret) = sctp_get_mbuf_for_msg(plen, 0, M_NOWAIT, 1, MT_DATA);
1976 if (SCTP_BUF_NEXT(mret) == NULL) {
1977 /* We are hosed, can't add more addresses */
1978 return (m);
1979 }
1980 mret = SCTP_BUF_NEXT(mret);
1981 paramh = mtod(mret, struct sctp_paramhdr *);
1982 }
1983 /* now add the parameter */
1984 switch (ifa->address.sa.sa_family) {
1985 #ifdef INET
1986 case AF_INET:
1987 {
1988 struct sctp_ipv4addr_param *ipv4p;
1989 struct sockaddr_in *sin;
1990
1991 sin = &ifa->address.sin;
1992 ipv4p = (struct sctp_ipv4addr_param *)paramh;
1993 paramh->param_type = htons(SCTP_IPV4_ADDRESS);
1994 paramh->param_length = htons(plen);
1995 ipv4p->addr = sin->sin_addr.s_addr;
1996 SCTP_BUF_LEN(mret) += plen;
1997 break;
1998 }
1999 #endif
2000 #ifdef INET6
2001 case AF_INET6:
2002 {
2003 struct sctp_ipv6addr_param *ipv6p;
2004 struct sockaddr_in6 *sin6;
2005
2006 sin6 = &ifa->address.sin6;
2007 ipv6p = (struct sctp_ipv6addr_param *)paramh;
2008 paramh->param_type = htons(SCTP_IPV6_ADDRESS);
2009 paramh->param_length = htons(plen);
2010 memcpy(ipv6p->addr, &sin6->sin6_addr,
2011 sizeof(ipv6p->addr));
2012 /* clear embedded scope in the address */
2013 in6_clearscope((struct in6_addr *)ipv6p->addr);
2014 SCTP_BUF_LEN(mret) += plen;
2015 break;
2016 }
2017 #endif
2018 default:
2019 return (m);
2020 }
2021 if (len != NULL) {
2022 *len += plen;
2023 }
2024 return (mret);
2025 #endif
2026 }
2027
2028
2029 struct mbuf *
sctp_add_addresses_to_i_ia(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_scoping * scope,struct mbuf * m_at,int cnt_inits_to,uint16_t * padding_len,uint16_t * chunk_len)2030 sctp_add_addresses_to_i_ia(struct sctp_inpcb *inp, struct sctp_tcb *stcb,
2031 struct sctp_scoping *scope,
2032 struct mbuf *m_at, int cnt_inits_to,
2033 uint16_t *padding_len, uint16_t *chunk_len)
2034 {
2035 struct sctp_vrf *vrf = NULL;
2036 int cnt, limit_out = 0, total_count;
2037 uint32_t vrf_id;
2038
2039 vrf_id = inp->def_vrf_id;
2040 SCTP_IPI_ADDR_RLOCK();
2041 vrf = sctp_find_vrf(vrf_id);
2042 if (vrf == NULL) {
2043 SCTP_IPI_ADDR_RUNLOCK();
2044 return (m_at);
2045 }
2046 if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) {
2047 struct sctp_ifa *sctp_ifap;
2048 struct sctp_ifn *sctp_ifnp;
2049
2050 cnt = cnt_inits_to;
2051 if (vrf->total_ifa_count > SCTP_COUNT_LIMIT) {
2052 limit_out = 1;
2053 cnt = SCTP_ADDRESS_LIMIT;
2054 goto skip_count;
2055 }
2056 LIST_FOREACH(sctp_ifnp, &vrf->ifnlist, next_ifn) {
2057 if ((scope->loopback_scope == 0) &&
2058 SCTP_IFN_IS_IFT_LOOP(sctp_ifnp)) {
2059 /*
2060 * Skip loopback devices if loopback_scope
2061 * not set
2062 */
2063 continue;
2064 }
2065 LIST_FOREACH(sctp_ifap, &sctp_ifnp->ifalist, next_ifa) {
2066 #ifdef INET
2067 if ((sctp_ifap->address.sa.sa_family == AF_INET) &&
2068 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2069 &sctp_ifap->address.sin.sin_addr) != 0)) {
2070 continue;
2071 }
2072 #endif
2073 #ifdef INET6
2074 if ((sctp_ifap->address.sa.sa_family == AF_INET6) &&
2075 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2076 &sctp_ifap->address.sin6.sin6_addr) != 0)) {
2077 continue;
2078 }
2079 #endif
2080 if (sctp_is_addr_restricted(stcb, sctp_ifap)) {
2081 continue;
2082 }
2083 if (sctp_is_address_in_scope(sctp_ifap, scope, 1) == 0) {
2084 continue;
2085 }
2086 cnt++;
2087 if (cnt > SCTP_ADDRESS_LIMIT) {
2088 break;
2089 }
2090 }
2091 if (cnt > SCTP_ADDRESS_LIMIT) {
2092 break;
2093 }
2094 }
2095 skip_count:
2096 if (cnt > 1) {
2097 total_count = 0;
2098 LIST_FOREACH(sctp_ifnp, &vrf->ifnlist, next_ifn) {
2099 cnt = 0;
2100 if ((scope->loopback_scope == 0) &&
2101 SCTP_IFN_IS_IFT_LOOP(sctp_ifnp)) {
2102 /*
2103 * Skip loopback devices if
2104 * loopback_scope not set
2105 */
2106 continue;
2107 }
2108 LIST_FOREACH(sctp_ifap, &sctp_ifnp->ifalist, next_ifa) {
2109 #ifdef INET
2110 if ((sctp_ifap->address.sa.sa_family == AF_INET) &&
2111 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2112 &sctp_ifap->address.sin.sin_addr) != 0)) {
2113 continue;
2114 }
2115 #endif
2116 #ifdef INET6
2117 if ((sctp_ifap->address.sa.sa_family == AF_INET6) &&
2118 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2119 &sctp_ifap->address.sin6.sin6_addr) != 0)) {
2120 continue;
2121 }
2122 #endif
2123 if (sctp_is_addr_restricted(stcb, sctp_ifap)) {
2124 continue;
2125 }
2126 if (sctp_is_address_in_scope(sctp_ifap,
2127 scope, 0) == 0) {
2128 continue;
2129 }
2130 if ((chunk_len != NULL) &&
2131 (padding_len != NULL) &&
2132 (*padding_len > 0)) {
2133 memset(mtod(m_at, caddr_t)+*chunk_len, 0, *padding_len);
2134 SCTP_BUF_LEN(m_at) += *padding_len;
2135 *chunk_len += *padding_len;
2136 *padding_len = 0;
2137 }
2138 m_at = sctp_add_addr_to_mbuf(m_at, sctp_ifap, chunk_len);
2139 if (limit_out) {
2140 cnt++;
2141 total_count++;
2142 if (cnt >= 2) {
2143 /*
2144 * two from each
2145 * address
2146 */
2147 break;
2148 }
2149 if (total_count > SCTP_ADDRESS_LIMIT) {
2150 /* No more addresses */
2151 break;
2152 }
2153 }
2154 }
2155 }
2156 }
2157 } else {
2158 struct sctp_laddr *laddr;
2159
2160 cnt = cnt_inits_to;
2161 /* First, how many ? */
2162 LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) {
2163 if (laddr->ifa == NULL) {
2164 continue;
2165 }
2166 if (laddr->ifa->localifa_flags & SCTP_BEING_DELETED)
2167 /*
2168 * Address being deleted by the system, dont
2169 * list.
2170 */
2171 continue;
2172 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2173 /*
2174 * Address being deleted on this ep don't
2175 * list.
2176 */
2177 continue;
2178 }
2179 if (sctp_is_address_in_scope(laddr->ifa,
2180 scope, 1) == 0) {
2181 continue;
2182 }
2183 cnt++;
2184 }
2185 /*
2186 * To get through a NAT we only list addresses if we have
2187 * more than one. That way if you just bind a single address
2188 * we let the source of the init dictate our address.
2189 */
2190 if (cnt > 1) {
2191 cnt = cnt_inits_to;
2192 LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) {
2193 if (laddr->ifa == NULL) {
2194 continue;
2195 }
2196 if (laddr->ifa->localifa_flags & SCTP_BEING_DELETED) {
2197 continue;
2198 }
2199 if (sctp_is_address_in_scope(laddr->ifa,
2200 scope, 0) == 0) {
2201 continue;
2202 }
2203 if ((chunk_len != NULL) &&
2204 (padding_len != NULL) &&
2205 (*padding_len > 0)) {
2206 memset(mtod(m_at, caddr_t)+*chunk_len, 0, *padding_len);
2207 SCTP_BUF_LEN(m_at) += *padding_len;
2208 *chunk_len += *padding_len;
2209 *padding_len = 0;
2210 }
2211 m_at = sctp_add_addr_to_mbuf(m_at, laddr->ifa, chunk_len);
2212 cnt++;
2213 if (cnt >= SCTP_ADDRESS_LIMIT) {
2214 break;
2215 }
2216 }
2217 }
2218 }
2219 SCTP_IPI_ADDR_RUNLOCK();
2220 return (m_at);
2221 }
2222
2223 static struct sctp_ifa *
sctp_is_ifa_addr_preferred(struct sctp_ifa * ifa,uint8_t dest_is_loop,uint8_t dest_is_priv,sa_family_t fam)2224 sctp_is_ifa_addr_preferred(struct sctp_ifa *ifa,
2225 uint8_t dest_is_loop,
2226 uint8_t dest_is_priv,
2227 sa_family_t fam)
2228 {
2229 uint8_t dest_is_global = 0;
2230
2231 /* dest_is_priv is true if destination is a private address */
2232 /* dest_is_loop is true if destination is a loopback addresses */
2233
2234 /**
2235 * Here we determine if its a preferred address. A preferred address
2236 * means it is the same scope or higher scope then the destination.
2237 * L = loopback, P = private, G = global
2238 * -----------------------------------------
2239 * src | dest | result
2240 * ----------------------------------------
2241 * L | L | yes
2242 * -----------------------------------------
2243 * P | L | yes-v4 no-v6
2244 * -----------------------------------------
2245 * G | L | yes-v4 no-v6
2246 * -----------------------------------------
2247 * L | P | no
2248 * -----------------------------------------
2249 * P | P | yes
2250 * -----------------------------------------
2251 * G | P | no
2252 * -----------------------------------------
2253 * L | G | no
2254 * -----------------------------------------
2255 * P | G | no
2256 * -----------------------------------------
2257 * G | G | yes
2258 * -----------------------------------------
2259 */
2260
2261 if (ifa->address.sa.sa_family != fam) {
2262 /* forget mis-matched family */
2263 return (NULL);
2264 }
2265 if ((dest_is_priv == 0) && (dest_is_loop == 0)) {
2266 dest_is_global = 1;
2267 }
2268 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Is destination preferred:");
2269 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &ifa->address.sa);
2270 /* Ok the address may be ok */
2271 #ifdef INET6
2272 if (fam == AF_INET6) {
2273 /* ok to use deprecated addresses? no lets not! */
2274 if (ifa->localifa_flags & SCTP_ADDR_IFA_UNUSEABLE) {
2275 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:1\n");
2276 return (NULL);
2277 }
2278 if (ifa->src_is_priv && !ifa->src_is_loop) {
2279 if (dest_is_loop) {
2280 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:2\n");
2281 return (NULL);
2282 }
2283 }
2284 if (ifa->src_is_glob) {
2285 if (dest_is_loop) {
2286 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:3\n");
2287 return (NULL);
2288 }
2289 }
2290 }
2291 #endif
2292 /*
2293 * Now that we know what is what, implement or table this could in
2294 * theory be done slicker (it used to be), but this is
2295 * straightforward and easier to validate :-)
2296 */
2297 SCTPDBG(SCTP_DEBUG_OUTPUT3, "src_loop:%d src_priv:%d src_glob:%d\n",
2298 ifa->src_is_loop, ifa->src_is_priv, ifa->src_is_glob);
2299 SCTPDBG(SCTP_DEBUG_OUTPUT3, "dest_loop:%d dest_priv:%d dest_glob:%d\n",
2300 dest_is_loop, dest_is_priv, dest_is_global);
2301
2302 if ((ifa->src_is_loop) && (dest_is_priv)) {
2303 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:4\n");
2304 return (NULL);
2305 }
2306 if ((ifa->src_is_glob) && (dest_is_priv)) {
2307 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:5\n");
2308 return (NULL);
2309 }
2310 if ((ifa->src_is_loop) && (dest_is_global)) {
2311 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:6\n");
2312 return (NULL);
2313 }
2314 if ((ifa->src_is_priv) && (dest_is_global)) {
2315 SCTPDBG(SCTP_DEBUG_OUTPUT3, "NO:7\n");
2316 return (NULL);
2317 }
2318 SCTPDBG(SCTP_DEBUG_OUTPUT3, "YES\n");
2319 /* its a preferred address */
2320 return (ifa);
2321 }
2322
2323 static struct sctp_ifa *
sctp_is_ifa_addr_acceptable(struct sctp_ifa * ifa,uint8_t dest_is_loop,uint8_t dest_is_priv,sa_family_t fam)2324 sctp_is_ifa_addr_acceptable(struct sctp_ifa *ifa,
2325 uint8_t dest_is_loop,
2326 uint8_t dest_is_priv,
2327 sa_family_t fam)
2328 {
2329 uint8_t dest_is_global = 0;
2330
2331 /**
2332 * Here we determine if its a acceptable address. A acceptable
2333 * address means it is the same scope or higher scope but we can
2334 * allow for NAT which means its ok to have a global dest and a
2335 * private src.
2336 *
2337 * L = loopback, P = private, G = global
2338 * -----------------------------------------
2339 * src | dest | result
2340 * -----------------------------------------
2341 * L | L | yes
2342 * -----------------------------------------
2343 * P | L | yes-v4 no-v6
2344 * -----------------------------------------
2345 * G | L | yes
2346 * -----------------------------------------
2347 * L | P | no
2348 * -----------------------------------------
2349 * P | P | yes
2350 * -----------------------------------------
2351 * G | P | yes - May not work
2352 * -----------------------------------------
2353 * L | G | no
2354 * -----------------------------------------
2355 * P | G | yes - May not work
2356 * -----------------------------------------
2357 * G | G | yes
2358 * -----------------------------------------
2359 */
2360
2361 if (ifa->address.sa.sa_family != fam) {
2362 /* forget non matching family */
2363 SCTPDBG(SCTP_DEBUG_OUTPUT3, "ifa_fam:%d fam:%d\n",
2364 ifa->address.sa.sa_family, fam);
2365 return (NULL);
2366 }
2367 /* Ok the address may be ok */
2368 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT3, &ifa->address.sa);
2369 SCTPDBG(SCTP_DEBUG_OUTPUT3, "dst_is_loop:%d dest_is_priv:%d\n",
2370 dest_is_loop, dest_is_priv);
2371 if ((dest_is_loop == 0) && (dest_is_priv == 0)) {
2372 dest_is_global = 1;
2373 }
2374 #ifdef INET6
2375 if (fam == AF_INET6) {
2376 /* ok to use deprecated addresses? */
2377 if (ifa->localifa_flags & SCTP_ADDR_IFA_UNUSEABLE) {
2378 return (NULL);
2379 }
2380 if (ifa->src_is_priv) {
2381 /* Special case, linklocal to loop */
2382 if (dest_is_loop)
2383 return (NULL);
2384 }
2385 }
2386 #endif
2387 /*
2388 * Now that we know what is what, implement our table. This could in
2389 * theory be done slicker (it used to be), but this is
2390 * straightforward and easier to validate :-)
2391 */
2392 SCTPDBG(SCTP_DEBUG_OUTPUT3, "ifa->src_is_loop:%d dest_is_priv:%d\n",
2393 ifa->src_is_loop,
2394 dest_is_priv);
2395 if ((ifa->src_is_loop == 1) && (dest_is_priv)) {
2396 return (NULL);
2397 }
2398 SCTPDBG(SCTP_DEBUG_OUTPUT3, "ifa->src_is_loop:%d dest_is_glob:%d\n",
2399 ifa->src_is_loop,
2400 dest_is_global);
2401 if ((ifa->src_is_loop == 1) && (dest_is_global)) {
2402 return (NULL);
2403 }
2404 SCTPDBG(SCTP_DEBUG_OUTPUT3, "address is acceptable\n");
2405 /* its an acceptable address */
2406 return (ifa);
2407 }
2408
2409 int
sctp_is_addr_restricted(struct sctp_tcb * stcb,struct sctp_ifa * ifa)2410 sctp_is_addr_restricted(struct sctp_tcb *stcb, struct sctp_ifa *ifa)
2411 {
2412 struct sctp_laddr *laddr;
2413
2414 if (stcb == NULL) {
2415 /* There are no restrictions, no TCB :-) */
2416 return (0);
2417 }
2418 LIST_FOREACH(laddr, &stcb->asoc.sctp_restricted_addrs, sctp_nxt_addr) {
2419 if (laddr->ifa == NULL) {
2420 SCTPDBG(SCTP_DEBUG_OUTPUT1, "%s: NULL ifa\n",
2421 __func__);
2422 continue;
2423 }
2424 if (laddr->ifa == ifa) {
2425 /* Yes it is on the list */
2426 return (1);
2427 }
2428 }
2429 return (0);
2430 }
2431
2432
2433 int
sctp_is_addr_in_ep(struct sctp_inpcb * inp,struct sctp_ifa * ifa)2434 sctp_is_addr_in_ep(struct sctp_inpcb *inp, struct sctp_ifa *ifa)
2435 {
2436 struct sctp_laddr *laddr;
2437
2438 if (ifa == NULL)
2439 return (0);
2440 LIST_FOREACH(laddr, &inp->sctp_addr_list, sctp_nxt_addr) {
2441 if (laddr->ifa == NULL) {
2442 SCTPDBG(SCTP_DEBUG_OUTPUT1, "%s: NULL ifa\n",
2443 __func__);
2444 continue;
2445 }
2446 if ((laddr->ifa == ifa) && laddr->action == 0)
2447 /* same pointer */
2448 return (1);
2449 }
2450 return (0);
2451 }
2452
2453
2454
2455 static struct sctp_ifa *
sctp_choose_boundspecific_inp(struct sctp_inpcb * inp,sctp_route_t * ro,uint32_t vrf_id,int non_asoc_addr_ok,uint8_t dest_is_priv,uint8_t dest_is_loop,sa_family_t fam)2456 sctp_choose_boundspecific_inp(struct sctp_inpcb *inp,
2457 sctp_route_t *ro,
2458 uint32_t vrf_id,
2459 int non_asoc_addr_ok,
2460 uint8_t dest_is_priv,
2461 uint8_t dest_is_loop,
2462 sa_family_t fam)
2463 {
2464 struct sctp_laddr *laddr, *starting_point;
2465 void *ifn;
2466 int resettotop = 0;
2467 struct sctp_ifn *sctp_ifn;
2468 struct sctp_ifa *sctp_ifa, *sifa;
2469 struct sctp_vrf *vrf;
2470 uint32_t ifn_index;
2471
2472 vrf = sctp_find_vrf(vrf_id);
2473 if (vrf == NULL)
2474 return (NULL);
2475
2476 ifn = SCTP_GET_IFN_VOID_FROM_ROUTE(ro);
2477 ifn_index = SCTP_GET_IF_INDEX_FROM_ROUTE(ro);
2478 sctp_ifn = sctp_find_ifn(ifn, ifn_index);
2479 /*
2480 * first question, is the ifn we will emit on in our list, if so, we
2481 * want such an address. Note that we first looked for a preferred
2482 * address.
2483 */
2484 if (sctp_ifn) {
2485 /* is a preferred one on the interface we route out? */
2486 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
2487 #ifdef INET
2488 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
2489 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2490 &sctp_ifa->address.sin.sin_addr) != 0)) {
2491 continue;
2492 }
2493 #endif
2494 #ifdef INET6
2495 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
2496 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2497 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
2498 continue;
2499 }
2500 #endif
2501 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
2502 (non_asoc_addr_ok == 0))
2503 continue;
2504 sifa = sctp_is_ifa_addr_preferred(sctp_ifa,
2505 dest_is_loop,
2506 dest_is_priv, fam);
2507 if (sifa == NULL)
2508 continue;
2509 if (sctp_is_addr_in_ep(inp, sifa)) {
2510 atomic_add_int(&sifa->refcount, 1);
2511 return (sifa);
2512 }
2513 }
2514 }
2515 /*
2516 * ok, now we now need to find one on the list of the addresses. We
2517 * can't get one on the emitting interface so let's find first a
2518 * preferred one. If not that an acceptable one otherwise... we
2519 * return NULL.
2520 */
2521 starting_point = inp->next_addr_touse;
2522 once_again:
2523 if (inp->next_addr_touse == NULL) {
2524 inp->next_addr_touse = LIST_FIRST(&inp->sctp_addr_list);
2525 resettotop = 1;
2526 }
2527 for (laddr = inp->next_addr_touse; laddr;
2528 laddr = LIST_NEXT(laddr, sctp_nxt_addr)) {
2529 if (laddr->ifa == NULL) {
2530 /* address has been removed */
2531 continue;
2532 }
2533 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2534 /* address is being deleted */
2535 continue;
2536 }
2537 sifa = sctp_is_ifa_addr_preferred(laddr->ifa, dest_is_loop,
2538 dest_is_priv, fam);
2539 if (sifa == NULL)
2540 continue;
2541 atomic_add_int(&sifa->refcount, 1);
2542 return (sifa);
2543 }
2544 if (resettotop == 0) {
2545 inp->next_addr_touse = NULL;
2546 goto once_again;
2547 }
2548
2549 inp->next_addr_touse = starting_point;
2550 resettotop = 0;
2551 once_again_too:
2552 if (inp->next_addr_touse == NULL) {
2553 inp->next_addr_touse = LIST_FIRST(&inp->sctp_addr_list);
2554 resettotop = 1;
2555 }
2556
2557 /* ok, what about an acceptable address in the inp */
2558 for (laddr = inp->next_addr_touse; laddr;
2559 laddr = LIST_NEXT(laddr, sctp_nxt_addr)) {
2560 if (laddr->ifa == NULL) {
2561 /* address has been removed */
2562 continue;
2563 }
2564 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2565 /* address is being deleted */
2566 continue;
2567 }
2568 sifa = sctp_is_ifa_addr_acceptable(laddr->ifa, dest_is_loop,
2569 dest_is_priv, fam);
2570 if (sifa == NULL)
2571 continue;
2572 atomic_add_int(&sifa->refcount, 1);
2573 return (sifa);
2574 }
2575 if (resettotop == 0) {
2576 inp->next_addr_touse = NULL;
2577 goto once_again_too;
2578 }
2579
2580 /*
2581 * no address bound can be a source for the destination we are in
2582 * trouble
2583 */
2584 return (NULL);
2585 }
2586
2587
2588
2589 static struct sctp_ifa *
sctp_choose_boundspecific_stcb(struct sctp_inpcb * inp,struct sctp_tcb * stcb,sctp_route_t * ro,uint32_t vrf_id,uint8_t dest_is_priv,uint8_t dest_is_loop,int non_asoc_addr_ok,sa_family_t fam)2590 sctp_choose_boundspecific_stcb(struct sctp_inpcb *inp,
2591 struct sctp_tcb *stcb,
2592 sctp_route_t *ro,
2593 uint32_t vrf_id,
2594 uint8_t dest_is_priv,
2595 uint8_t dest_is_loop,
2596 int non_asoc_addr_ok,
2597 sa_family_t fam)
2598 {
2599 struct sctp_laddr *laddr, *starting_point;
2600 void *ifn;
2601 struct sctp_ifn *sctp_ifn;
2602 struct sctp_ifa *sctp_ifa, *sifa;
2603 uint8_t start_at_beginning = 0;
2604 struct sctp_vrf *vrf;
2605 uint32_t ifn_index;
2606
2607 /*
2608 * first question, is the ifn we will emit on in our list, if so, we
2609 * want that one.
2610 */
2611 vrf = sctp_find_vrf(vrf_id);
2612 if (vrf == NULL)
2613 return (NULL);
2614
2615 ifn = SCTP_GET_IFN_VOID_FROM_ROUTE(ro);
2616 ifn_index = SCTP_GET_IF_INDEX_FROM_ROUTE(ro);
2617 sctp_ifn = sctp_find_ifn(ifn, ifn_index);
2618
2619 /*
2620 * first question, is the ifn we will emit on in our list? If so,
2621 * we want that one. First we look for a preferred. Second, we go
2622 * for an acceptable.
2623 */
2624 if (sctp_ifn) {
2625 /* first try for a preferred address on the ep */
2626 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
2627 #ifdef INET
2628 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
2629 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2630 &sctp_ifa->address.sin.sin_addr) != 0)) {
2631 continue;
2632 }
2633 #endif
2634 #ifdef INET6
2635 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
2636 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2637 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
2638 continue;
2639 }
2640 #endif
2641 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) && (non_asoc_addr_ok == 0))
2642 continue;
2643 if (sctp_is_addr_in_ep(inp, sctp_ifa)) {
2644 sifa = sctp_is_ifa_addr_preferred(sctp_ifa, dest_is_loop, dest_is_priv, fam);
2645 if (sifa == NULL)
2646 continue;
2647 if (((non_asoc_addr_ok == 0) &&
2648 (sctp_is_addr_restricted(stcb, sifa))) ||
2649 (non_asoc_addr_ok &&
2650 (sctp_is_addr_restricted(stcb, sifa)) &&
2651 (!sctp_is_addr_pending(stcb, sifa)))) {
2652 /* on the no-no list */
2653 continue;
2654 }
2655 atomic_add_int(&sifa->refcount, 1);
2656 return (sifa);
2657 }
2658 }
2659 /* next try for an acceptable address on the ep */
2660 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
2661 #ifdef INET
2662 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
2663 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2664 &sctp_ifa->address.sin.sin_addr) != 0)) {
2665 continue;
2666 }
2667 #endif
2668 #ifdef INET6
2669 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
2670 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2671 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
2672 continue;
2673 }
2674 #endif
2675 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) && (non_asoc_addr_ok == 0))
2676 continue;
2677 if (sctp_is_addr_in_ep(inp, sctp_ifa)) {
2678 sifa = sctp_is_ifa_addr_acceptable(sctp_ifa, dest_is_loop, dest_is_priv, fam);
2679 if (sifa == NULL)
2680 continue;
2681 if (((non_asoc_addr_ok == 0) &&
2682 (sctp_is_addr_restricted(stcb, sifa))) ||
2683 (non_asoc_addr_ok &&
2684 (sctp_is_addr_restricted(stcb, sifa)) &&
2685 (!sctp_is_addr_pending(stcb, sifa)))) {
2686 /* on the no-no list */
2687 continue;
2688 }
2689 atomic_add_int(&sifa->refcount, 1);
2690 return (sifa);
2691 }
2692 }
2693
2694 }
2695 /*
2696 * if we can't find one like that then we must look at all addresses
2697 * bound to pick one at first preferable then secondly acceptable.
2698 */
2699 starting_point = stcb->asoc.last_used_address;
2700 sctp_from_the_top:
2701 if (stcb->asoc.last_used_address == NULL) {
2702 start_at_beginning = 1;
2703 stcb->asoc.last_used_address = LIST_FIRST(&inp->sctp_addr_list);
2704 }
2705 /* search beginning with the last used address */
2706 for (laddr = stcb->asoc.last_used_address; laddr;
2707 laddr = LIST_NEXT(laddr, sctp_nxt_addr)) {
2708 if (laddr->ifa == NULL) {
2709 /* address has been removed */
2710 continue;
2711 }
2712 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2713 /* address is being deleted */
2714 continue;
2715 }
2716 sifa = sctp_is_ifa_addr_preferred(laddr->ifa, dest_is_loop, dest_is_priv, fam);
2717 if (sifa == NULL)
2718 continue;
2719 if (((non_asoc_addr_ok == 0) &&
2720 (sctp_is_addr_restricted(stcb, sifa))) ||
2721 (non_asoc_addr_ok &&
2722 (sctp_is_addr_restricted(stcb, sifa)) &&
2723 (!sctp_is_addr_pending(stcb, sifa)))) {
2724 /* on the no-no list */
2725 continue;
2726 }
2727 stcb->asoc.last_used_address = laddr;
2728 atomic_add_int(&sifa->refcount, 1);
2729 return (sifa);
2730 }
2731 if (start_at_beginning == 0) {
2732 stcb->asoc.last_used_address = NULL;
2733 goto sctp_from_the_top;
2734 }
2735 /* now try for any higher scope than the destination */
2736 stcb->asoc.last_used_address = starting_point;
2737 start_at_beginning = 0;
2738 sctp_from_the_top2:
2739 if (stcb->asoc.last_used_address == NULL) {
2740 start_at_beginning = 1;
2741 stcb->asoc.last_used_address = LIST_FIRST(&inp->sctp_addr_list);
2742 }
2743 /* search beginning with the last used address */
2744 for (laddr = stcb->asoc.last_used_address; laddr;
2745 laddr = LIST_NEXT(laddr, sctp_nxt_addr)) {
2746 if (laddr->ifa == NULL) {
2747 /* address has been removed */
2748 continue;
2749 }
2750 if (laddr->action == SCTP_DEL_IP_ADDRESS) {
2751 /* address is being deleted */
2752 continue;
2753 }
2754 sifa = sctp_is_ifa_addr_acceptable(laddr->ifa, dest_is_loop,
2755 dest_is_priv, fam);
2756 if (sifa == NULL)
2757 continue;
2758 if (((non_asoc_addr_ok == 0) &&
2759 (sctp_is_addr_restricted(stcb, sifa))) ||
2760 (non_asoc_addr_ok &&
2761 (sctp_is_addr_restricted(stcb, sifa)) &&
2762 (!sctp_is_addr_pending(stcb, sifa)))) {
2763 /* on the no-no list */
2764 continue;
2765 }
2766 stcb->asoc.last_used_address = laddr;
2767 atomic_add_int(&sifa->refcount, 1);
2768 return (sifa);
2769 }
2770 if (start_at_beginning == 0) {
2771 stcb->asoc.last_used_address = NULL;
2772 goto sctp_from_the_top2;
2773 }
2774 return (NULL);
2775 }
2776
2777 static struct sctp_ifa *
sctp_select_nth_preferred_addr_from_ifn_boundall(struct sctp_ifn * ifn,struct sctp_inpcb * inp,struct sctp_tcb * stcb,int non_asoc_addr_ok,uint8_t dest_is_loop,uint8_t dest_is_priv,int addr_wanted,sa_family_t fam,sctp_route_t * ro)2778 sctp_select_nth_preferred_addr_from_ifn_boundall(struct sctp_ifn *ifn,
2779 struct sctp_inpcb *inp,
2780 struct sctp_tcb *stcb,
2781 int non_asoc_addr_ok,
2782 uint8_t dest_is_loop,
2783 uint8_t dest_is_priv,
2784 int addr_wanted,
2785 sa_family_t fam,
2786 sctp_route_t *ro)
2787 {
2788 struct sctp_ifa *ifa, *sifa;
2789 int num_eligible_addr = 0;
2790 #ifdef INET6
2791 struct sockaddr_in6 sin6, lsa6;
2792
2793 if (fam == AF_INET6) {
2794 memcpy(&sin6, &ro->ro_dst, sizeof(struct sockaddr_in6));
2795 (void)sa6_recoverscope(&sin6);
2796 }
2797 #endif /* INET6 */
2798 LIST_FOREACH(ifa, &ifn->ifalist, next_ifa) {
2799 #ifdef INET
2800 if ((ifa->address.sa.sa_family == AF_INET) &&
2801 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2802 &ifa->address.sin.sin_addr) != 0)) {
2803 continue;
2804 }
2805 #endif
2806 #ifdef INET6
2807 if ((ifa->address.sa.sa_family == AF_INET6) &&
2808 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2809 &ifa->address.sin6.sin6_addr) != 0)) {
2810 continue;
2811 }
2812 #endif
2813 if ((ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
2814 (non_asoc_addr_ok == 0))
2815 continue;
2816 sifa = sctp_is_ifa_addr_preferred(ifa, dest_is_loop,
2817 dest_is_priv, fam);
2818 if (sifa == NULL)
2819 continue;
2820 #ifdef INET6
2821 if (fam == AF_INET6 &&
2822 dest_is_loop &&
2823 sifa->src_is_loop && sifa->src_is_priv) {
2824 /*
2825 * don't allow fe80::1 to be a src on loop ::1, we
2826 * don't list it to the peer so we will get an
2827 * abort.
2828 */
2829 continue;
2830 }
2831 if (fam == AF_INET6 &&
2832 IN6_IS_ADDR_LINKLOCAL(&sifa->address.sin6.sin6_addr) &&
2833 IN6_IS_ADDR_LINKLOCAL(&sin6.sin6_addr)) {
2834 /*
2835 * link-local <-> link-local must belong to the same
2836 * scope.
2837 */
2838 memcpy(&lsa6, &sifa->address.sin6, sizeof(struct sockaddr_in6));
2839 (void)sa6_recoverscope(&lsa6);
2840 if (sin6.sin6_scope_id != lsa6.sin6_scope_id) {
2841 continue;
2842 }
2843 }
2844 #endif /* INET6 */
2845
2846 /*
2847 * Check if the IPv6 address matches to next-hop. In the
2848 * mobile case, old IPv6 address may be not deleted from the
2849 * interface. Then, the interface has previous and new
2850 * addresses. We should use one corresponding to the
2851 * next-hop. (by micchie)
2852 */
2853 #ifdef INET6
2854 if (stcb && fam == AF_INET6 &&
2855 sctp_is_mobility_feature_on(stcb->sctp_ep, SCTP_MOBILITY_BASE)) {
2856 if (sctp_v6src_match_nexthop(&sifa->address.sin6, ro)
2857 == 0) {
2858 continue;
2859 }
2860 }
2861 #endif
2862 #ifdef INET
2863 /* Avoid topologically incorrect IPv4 address */
2864 if (stcb && fam == AF_INET &&
2865 sctp_is_mobility_feature_on(stcb->sctp_ep, SCTP_MOBILITY_BASE)) {
2866 if (sctp_v4src_match_nexthop(sifa, ro) == 0) {
2867 continue;
2868 }
2869 }
2870 #endif
2871 if (stcb) {
2872 if (sctp_is_address_in_scope(ifa, &stcb->asoc.scope, 0) == 0) {
2873 continue;
2874 }
2875 if (((non_asoc_addr_ok == 0) &&
2876 (sctp_is_addr_restricted(stcb, sifa))) ||
2877 (non_asoc_addr_ok &&
2878 (sctp_is_addr_restricted(stcb, sifa)) &&
2879 (!sctp_is_addr_pending(stcb, sifa)))) {
2880 /*
2881 * It is restricted for some reason..
2882 * probably not yet added.
2883 */
2884 continue;
2885 }
2886 }
2887 if (num_eligible_addr >= addr_wanted) {
2888 return (sifa);
2889 }
2890 num_eligible_addr++;
2891 }
2892 return (NULL);
2893 }
2894
2895
2896 static int
sctp_count_num_preferred_boundall(struct sctp_ifn * ifn,struct sctp_inpcb * inp,struct sctp_tcb * stcb,int non_asoc_addr_ok,uint8_t dest_is_loop,uint8_t dest_is_priv,sa_family_t fam)2897 sctp_count_num_preferred_boundall(struct sctp_ifn *ifn,
2898 struct sctp_inpcb *inp,
2899 struct sctp_tcb *stcb,
2900 int non_asoc_addr_ok,
2901 uint8_t dest_is_loop,
2902 uint8_t dest_is_priv,
2903 sa_family_t fam)
2904 {
2905 struct sctp_ifa *ifa, *sifa;
2906 int num_eligible_addr = 0;
2907
2908 LIST_FOREACH(ifa, &ifn->ifalist, next_ifa) {
2909 #ifdef INET
2910 if ((ifa->address.sa.sa_family == AF_INET) &&
2911 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
2912 &ifa->address.sin.sin_addr) != 0)) {
2913 continue;
2914 }
2915 #endif
2916 #ifdef INET6
2917 if ((ifa->address.sa.sa_family == AF_INET6) &&
2918 (stcb != NULL) &&
2919 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
2920 &ifa->address.sin6.sin6_addr) != 0)) {
2921 continue;
2922 }
2923 #endif
2924 if ((ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
2925 (non_asoc_addr_ok == 0)) {
2926 continue;
2927 }
2928 sifa = sctp_is_ifa_addr_preferred(ifa, dest_is_loop,
2929 dest_is_priv, fam);
2930 if (sifa == NULL) {
2931 continue;
2932 }
2933 if (stcb) {
2934 if (sctp_is_address_in_scope(ifa, &stcb->asoc.scope, 0) == 0) {
2935 continue;
2936 }
2937 if (((non_asoc_addr_ok == 0) &&
2938 (sctp_is_addr_restricted(stcb, sifa))) ||
2939 (non_asoc_addr_ok &&
2940 (sctp_is_addr_restricted(stcb, sifa)) &&
2941 (!sctp_is_addr_pending(stcb, sifa)))) {
2942 /*
2943 * It is restricted for some reason..
2944 * probably not yet added.
2945 */
2946 continue;
2947 }
2948 }
2949 num_eligible_addr++;
2950 }
2951 return (num_eligible_addr);
2952 }
2953
2954 static struct sctp_ifa *
sctp_choose_boundall(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_nets * net,sctp_route_t * ro,uint32_t vrf_id,uint8_t dest_is_priv,uint8_t dest_is_loop,int non_asoc_addr_ok,sa_family_t fam)2955 sctp_choose_boundall(struct sctp_inpcb *inp,
2956 struct sctp_tcb *stcb,
2957 struct sctp_nets *net,
2958 sctp_route_t *ro,
2959 uint32_t vrf_id,
2960 uint8_t dest_is_priv,
2961 uint8_t dest_is_loop,
2962 int non_asoc_addr_ok,
2963 sa_family_t fam)
2964 {
2965 int cur_addr_num = 0, num_preferred = 0;
2966 void *ifn;
2967 struct sctp_ifn *sctp_ifn, *looked_at = NULL, *emit_ifn;
2968 struct sctp_ifa *sctp_ifa, *sifa;
2969 uint32_t ifn_index;
2970 struct sctp_vrf *vrf;
2971 #ifdef INET
2972 int retried = 0;
2973 #endif
2974
2975 /*-
2976 * For boundall we can use any address in the association.
2977 * If non_asoc_addr_ok is set we can use any address (at least in
2978 * theory). So we look for preferred addresses first. If we find one,
2979 * we use it. Otherwise we next try to get an address on the
2980 * interface, which we should be able to do (unless non_asoc_addr_ok
2981 * is false and we are routed out that way). In these cases where we
2982 * can't use the address of the interface we go through all the
2983 * ifn's looking for an address we can use and fill that in. Punting
2984 * means we send back address 0, which will probably cause problems
2985 * actually since then IP will fill in the address of the route ifn,
2986 * which means we probably already rejected it.. i.e. here comes an
2987 * abort :-<.
2988 */
2989 vrf = sctp_find_vrf(vrf_id);
2990 if (vrf == NULL)
2991 return (NULL);
2992
2993 ifn = SCTP_GET_IFN_VOID_FROM_ROUTE(ro);
2994 ifn_index = SCTP_GET_IF_INDEX_FROM_ROUTE(ro);
2995 SCTPDBG(SCTP_DEBUG_OUTPUT2, "ifn from route:%p ifn_index:%d\n", ifn, ifn_index);
2996 emit_ifn = looked_at = sctp_ifn = sctp_find_ifn(ifn, ifn_index);
2997 if (sctp_ifn == NULL) {
2998 /* ?? We don't have this guy ?? */
2999 SCTPDBG(SCTP_DEBUG_OUTPUT2, "No ifn emit interface?\n");
3000 goto bound_all_plan_b;
3001 }
3002 SCTPDBG(SCTP_DEBUG_OUTPUT2, "ifn_index:%d name:%s is emit interface\n",
3003 ifn_index, sctp_ifn->ifn_name);
3004
3005 if (net) {
3006 cur_addr_num = net->indx_of_eligible_next_to_use;
3007 }
3008 num_preferred = sctp_count_num_preferred_boundall(sctp_ifn,
3009 inp, stcb,
3010 non_asoc_addr_ok,
3011 dest_is_loop,
3012 dest_is_priv, fam);
3013 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Found %d preferred source addresses for intf:%s\n",
3014 num_preferred, sctp_ifn->ifn_name);
3015 if (num_preferred == 0) {
3016 /*
3017 * no eligible addresses, we must use some other interface
3018 * address if we can find one.
3019 */
3020 goto bound_all_plan_b;
3021 }
3022 /*
3023 * Ok we have num_eligible_addr set with how many we can use, this
3024 * may vary from call to call due to addresses being deprecated
3025 * etc..
3026 */
3027 if (cur_addr_num >= num_preferred) {
3028 cur_addr_num = 0;
3029 }
3030 /*
3031 * select the nth address from the list (where cur_addr_num is the
3032 * nth) and 0 is the first one, 1 is the second one etc...
3033 */
3034 SCTPDBG(SCTP_DEBUG_OUTPUT2, "cur_addr_num:%d\n", cur_addr_num);
3035
3036 sctp_ifa = sctp_select_nth_preferred_addr_from_ifn_boundall(sctp_ifn, inp, stcb, non_asoc_addr_ok, dest_is_loop,
3037 dest_is_priv, cur_addr_num, fam, ro);
3038
3039 /* if sctp_ifa is NULL something changed??, fall to plan b. */
3040 if (sctp_ifa) {
3041 atomic_add_int(&sctp_ifa->refcount, 1);
3042 if (net) {
3043 /* save off where the next one we will want */
3044 net->indx_of_eligible_next_to_use = cur_addr_num + 1;
3045 }
3046 return (sctp_ifa);
3047 }
3048 /*
3049 * plan_b: Look at all interfaces and find a preferred address. If
3050 * no preferred fall through to plan_c.
3051 */
3052 bound_all_plan_b:
3053 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Trying Plan B\n");
3054 LIST_FOREACH(sctp_ifn, &vrf->ifnlist, next_ifn) {
3055 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Examine interface %s\n",
3056 sctp_ifn->ifn_name);
3057 if (dest_is_loop == 0 && SCTP_IFN_IS_IFT_LOOP(sctp_ifn)) {
3058 /* wrong base scope */
3059 SCTPDBG(SCTP_DEBUG_OUTPUT2, "skip\n");
3060 continue;
3061 }
3062 if ((sctp_ifn == looked_at) && looked_at) {
3063 /* already looked at this guy */
3064 SCTPDBG(SCTP_DEBUG_OUTPUT2, "already seen\n");
3065 continue;
3066 }
3067 num_preferred = sctp_count_num_preferred_boundall(sctp_ifn, inp, stcb, non_asoc_addr_ok,
3068 dest_is_loop, dest_is_priv, fam);
3069 SCTPDBG(SCTP_DEBUG_OUTPUT2,
3070 "Found ifn:%p %d preferred source addresses\n",
3071 ifn, num_preferred);
3072 if (num_preferred == 0) {
3073 /* None on this interface. */
3074 SCTPDBG(SCTP_DEBUG_OUTPUT2, "No preferred -- skipping to next\n");
3075 continue;
3076 }
3077 SCTPDBG(SCTP_DEBUG_OUTPUT2,
3078 "num preferred:%d on interface:%p cur_addr_num:%d\n",
3079 num_preferred, (void *)sctp_ifn, cur_addr_num);
3080
3081 /*
3082 * Ok we have num_eligible_addr set with how many we can
3083 * use, this may vary from call to call due to addresses
3084 * being deprecated etc..
3085 */
3086 if (cur_addr_num >= num_preferred) {
3087 cur_addr_num = 0;
3088 }
3089 sifa = sctp_select_nth_preferred_addr_from_ifn_boundall(sctp_ifn, inp, stcb, non_asoc_addr_ok, dest_is_loop,
3090 dest_is_priv, cur_addr_num, fam, ro);
3091 if (sifa == NULL)
3092 continue;
3093 if (net) {
3094 net->indx_of_eligible_next_to_use = cur_addr_num + 1;
3095 SCTPDBG(SCTP_DEBUG_OUTPUT2, "we selected %d\n",
3096 cur_addr_num);
3097 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Source:");
3098 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &sifa->address.sa);
3099 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Dest:");
3100 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &net->ro._l_addr.sa);
3101 }
3102 atomic_add_int(&sifa->refcount, 1);
3103 return (sifa);
3104 }
3105 #ifdef INET
3106 again_with_private_addresses_allowed:
3107 #endif
3108 /* plan_c: do we have an acceptable address on the emit interface */
3109 sifa = NULL;
3110 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Trying Plan C: find acceptable on interface\n");
3111 if (emit_ifn == NULL) {
3112 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Jump to Plan D - no emit_ifn\n");
3113 goto plan_d;
3114 }
3115 LIST_FOREACH(sctp_ifa, &emit_ifn->ifalist, next_ifa) {
3116 SCTPDBG(SCTP_DEBUG_OUTPUT2, "ifa:%p\n", (void *)sctp_ifa);
3117 #ifdef INET
3118 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
3119 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
3120 &sctp_ifa->address.sin.sin_addr) != 0)) {
3121 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Jailed\n");
3122 continue;
3123 }
3124 #endif
3125 #ifdef INET6
3126 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
3127 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
3128 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
3129 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Jailed\n");
3130 continue;
3131 }
3132 #endif
3133 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
3134 (non_asoc_addr_ok == 0)) {
3135 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Defer\n");
3136 continue;
3137 }
3138 sifa = sctp_is_ifa_addr_acceptable(sctp_ifa, dest_is_loop,
3139 dest_is_priv, fam);
3140 if (sifa == NULL) {
3141 SCTPDBG(SCTP_DEBUG_OUTPUT2, "IFA not acceptable\n");
3142 continue;
3143 }
3144 if (stcb) {
3145 if (sctp_is_address_in_scope(sifa, &stcb->asoc.scope, 0) == 0) {
3146 SCTPDBG(SCTP_DEBUG_OUTPUT2, "NOT in scope\n");
3147 sifa = NULL;
3148 continue;
3149 }
3150 if (((non_asoc_addr_ok == 0) &&
3151 (sctp_is_addr_restricted(stcb, sifa))) ||
3152 (non_asoc_addr_ok &&
3153 (sctp_is_addr_restricted(stcb, sifa)) &&
3154 (!sctp_is_addr_pending(stcb, sifa)))) {
3155 /*
3156 * It is restricted for some reason..
3157 * probably not yet added.
3158 */
3159 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Its restricted\n");
3160 sifa = NULL;
3161 continue;
3162 }
3163 }
3164 atomic_add_int(&sifa->refcount, 1);
3165 goto out;
3166 }
3167 plan_d:
3168 /*
3169 * plan_d: We are in trouble. No preferred address on the emit
3170 * interface. And not even a preferred address on all interfaces. Go
3171 * out and see if we can find an acceptable address somewhere
3172 * amongst all interfaces.
3173 */
3174 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Trying Plan D looked_at is %p\n", (void *)looked_at);
3175 LIST_FOREACH(sctp_ifn, &vrf->ifnlist, next_ifn) {
3176 if (dest_is_loop == 0 && SCTP_IFN_IS_IFT_LOOP(sctp_ifn)) {
3177 /* wrong base scope */
3178 continue;
3179 }
3180 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
3181 #ifdef INET
3182 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
3183 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
3184 &sctp_ifa->address.sin.sin_addr) != 0)) {
3185 continue;
3186 }
3187 #endif
3188 #ifdef INET6
3189 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
3190 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
3191 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
3192 continue;
3193 }
3194 #endif
3195 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
3196 (non_asoc_addr_ok == 0))
3197 continue;
3198 sifa = sctp_is_ifa_addr_acceptable(sctp_ifa,
3199 dest_is_loop,
3200 dest_is_priv, fam);
3201 if (sifa == NULL)
3202 continue;
3203 if (stcb) {
3204 if (sctp_is_address_in_scope(sifa, &stcb->asoc.scope, 0) == 0) {
3205 sifa = NULL;
3206 continue;
3207 }
3208 if (((non_asoc_addr_ok == 0) &&
3209 (sctp_is_addr_restricted(stcb, sifa))) ||
3210 (non_asoc_addr_ok &&
3211 (sctp_is_addr_restricted(stcb, sifa)) &&
3212 (!sctp_is_addr_pending(stcb, sifa)))) {
3213 /*
3214 * It is restricted for some
3215 * reason.. probably not yet added.
3216 */
3217 sifa = NULL;
3218 continue;
3219 }
3220 }
3221 goto out;
3222 }
3223 }
3224 #ifdef INET
3225 if (stcb) {
3226 if ((retried == 0) && (stcb->asoc.scope.ipv4_local_scope == 0)) {
3227 stcb->asoc.scope.ipv4_local_scope = 1;
3228 retried = 1;
3229 goto again_with_private_addresses_allowed;
3230 } else if (retried == 1) {
3231 stcb->asoc.scope.ipv4_local_scope = 0;
3232 }
3233 }
3234 #endif
3235 out:
3236 #ifdef INET
3237 if (sifa) {
3238 if (retried == 1) {
3239 LIST_FOREACH(sctp_ifn, &vrf->ifnlist, next_ifn) {
3240 if (dest_is_loop == 0 && SCTP_IFN_IS_IFT_LOOP(sctp_ifn)) {
3241 /* wrong base scope */
3242 continue;
3243 }
3244 LIST_FOREACH(sctp_ifa, &sctp_ifn->ifalist, next_ifa) {
3245 struct sctp_ifa *tmp_sifa;
3246
3247 #ifdef INET
3248 if ((sctp_ifa->address.sa.sa_family == AF_INET) &&
3249 (prison_check_ip4(inp->ip_inp.inp.inp_cred,
3250 &sctp_ifa->address.sin.sin_addr) != 0)) {
3251 continue;
3252 }
3253 #endif
3254 #ifdef INET6
3255 if ((sctp_ifa->address.sa.sa_family == AF_INET6) &&
3256 (prison_check_ip6(inp->ip_inp.inp.inp_cred,
3257 &sctp_ifa->address.sin6.sin6_addr) != 0)) {
3258 continue;
3259 }
3260 #endif
3261 if ((sctp_ifa->localifa_flags & SCTP_ADDR_DEFER_USE) &&
3262 (non_asoc_addr_ok == 0))
3263 continue;
3264 tmp_sifa = sctp_is_ifa_addr_acceptable(sctp_ifa,
3265 dest_is_loop,
3266 dest_is_priv, fam);
3267 if (tmp_sifa == NULL) {
3268 continue;
3269 }
3270 if (tmp_sifa == sifa) {
3271 continue;
3272 }
3273 if (stcb) {
3274 if (sctp_is_address_in_scope(tmp_sifa,
3275 &stcb->asoc.scope, 0) == 0) {
3276 continue;
3277 }
3278 if (((non_asoc_addr_ok == 0) &&
3279 (sctp_is_addr_restricted(stcb, tmp_sifa))) ||
3280 (non_asoc_addr_ok &&
3281 (sctp_is_addr_restricted(stcb, tmp_sifa)) &&
3282 (!sctp_is_addr_pending(stcb, tmp_sifa)))) {
3283 /*
3284 * It is restricted
3285 * for some reason..
3286 * probably not yet
3287 * added.
3288 */
3289 continue;
3290 }
3291 }
3292 if ((tmp_sifa->address.sin.sin_family == AF_INET) &&
3293 (IN4_ISPRIVATE_ADDRESS(&(tmp_sifa->address.sin.sin_addr)))) {
3294 sctp_add_local_addr_restricted(stcb, tmp_sifa);
3295 }
3296 }
3297 }
3298 }
3299 atomic_add_int(&sifa->refcount, 1);
3300 }
3301 #endif
3302 return (sifa);
3303 }
3304
3305
3306
3307 /* tcb may be NULL */
3308 struct sctp_ifa *
sctp_source_address_selection(struct sctp_inpcb * inp,struct sctp_tcb * stcb,sctp_route_t * ro,struct sctp_nets * net,int non_asoc_addr_ok,uint32_t vrf_id)3309 sctp_source_address_selection(struct sctp_inpcb *inp,
3310 struct sctp_tcb *stcb,
3311 sctp_route_t *ro,
3312 struct sctp_nets *net,
3313 int non_asoc_addr_ok, uint32_t vrf_id)
3314 {
3315 struct sctp_ifa *answer;
3316 uint8_t dest_is_priv, dest_is_loop;
3317 sa_family_t fam;
3318 #ifdef INET
3319 struct sockaddr_in *to = (struct sockaddr_in *)&ro->ro_dst;
3320 #endif
3321 #ifdef INET6
3322 struct sockaddr_in6 *to6 = (struct sockaddr_in6 *)&ro->ro_dst;
3323 #endif
3324
3325 /**
3326 * Rules:
3327 * - Find the route if needed, cache if I can.
3328 * - Look at interface address in route, Is it in the bound list. If so we
3329 * have the best source.
3330 * - If not we must rotate amongst the addresses.
3331 *
3332 * Cavets and issues
3333 *
3334 * Do we need to pay attention to scope. We can have a private address
3335 * or a global address we are sourcing or sending to. So if we draw
3336 * it out
3337 * zzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzz
3338 * For V4
3339 * ------------------------------------------
3340 * source * dest * result
3341 * -----------------------------------------
3342 * <a> Private * Global * NAT
3343 * -----------------------------------------
3344 * <b> Private * Private * No problem
3345 * -----------------------------------------
3346 * <c> Global * Private * Huh, How will this work?
3347 * -----------------------------------------
3348 * <d> Global * Global * No Problem
3349 *------------------------------------------
3350 * zzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzz
3351 * For V6
3352 *------------------------------------------
3353 * source * dest * result
3354 * -----------------------------------------
3355 * <a> Linklocal * Global *
3356 * -----------------------------------------
3357 * <b> Linklocal * Linklocal * No problem
3358 * -----------------------------------------
3359 * <c> Global * Linklocal * Huh, How will this work?
3360 * -----------------------------------------
3361 * <d> Global * Global * No Problem
3362 *------------------------------------------
3363 * zzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzzz
3364 *
3365 * And then we add to that what happens if there are multiple addresses
3366 * assigned to an interface. Remember the ifa on a ifn is a linked
3367 * list of addresses. So one interface can have more than one IP
3368 * address. What happens if we have both a private and a global
3369 * address? Do we then use context of destination to sort out which
3370 * one is best? And what about NAT's sending P->G may get you a NAT
3371 * translation, or should you select the G thats on the interface in
3372 * preference.
3373 *
3374 * Decisions:
3375 *
3376 * - count the number of addresses on the interface.
3377 * - if it is one, no problem except case <c>.
3378 * For <a> we will assume a NAT out there.
3379 * - if there are more than one, then we need to worry about scope P
3380 * or G. We should prefer G -> G and P -> P if possible.
3381 * Then as a secondary fall back to mixed types G->P being a last
3382 * ditch one.
3383 * - The above all works for bound all, but bound specific we need to
3384 * use the same concept but instead only consider the bound
3385 * addresses. If the bound set is NOT assigned to the interface then
3386 * we must use rotation amongst the bound addresses..
3387 */
3388 if (ro->ro_rt == NULL) {
3389 /*
3390 * Need a route to cache.
3391 */
3392 SCTP_RTALLOC(ro, vrf_id, inp->fibnum);
3393 }
3394 if (ro->ro_rt == NULL) {
3395 return (NULL);
3396 }
3397 fam = ro->ro_dst.sa_family;
3398 dest_is_priv = dest_is_loop = 0;
3399 /* Setup our scopes for the destination */
3400 switch (fam) {
3401 #ifdef INET
3402 case AF_INET:
3403 /* Scope based on outbound address */
3404 if (IN4_ISLOOPBACK_ADDRESS(&to->sin_addr)) {
3405 dest_is_loop = 1;
3406 if (net != NULL) {
3407 /* mark it as local */
3408 net->addr_is_local = 1;
3409 }
3410 } else if ((IN4_ISPRIVATE_ADDRESS(&to->sin_addr))) {
3411 dest_is_priv = 1;
3412 }
3413 break;
3414 #endif
3415 #ifdef INET6
3416 case AF_INET6:
3417 /* Scope based on outbound address */
3418 if (IN6_IS_ADDR_LOOPBACK(&to6->sin6_addr) ||
3419 SCTP_ROUTE_IS_REAL_LOOP(ro)) {
3420 /*
3421 * If the address is a loopback address, which
3422 * consists of "::1" OR "fe80::1%lo0", we are
3423 * loopback scope. But we don't use dest_is_priv
3424 * (link local addresses).
3425 */
3426 dest_is_loop = 1;
3427 if (net != NULL) {
3428 /* mark it as local */
3429 net->addr_is_local = 1;
3430 }
3431 } else if (IN6_IS_ADDR_LINKLOCAL(&to6->sin6_addr)) {
3432 dest_is_priv = 1;
3433 }
3434 break;
3435 #endif
3436 }
3437 SCTPDBG(SCTP_DEBUG_OUTPUT2, "Select source addr for:");
3438 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)&ro->ro_dst);
3439 SCTP_IPI_ADDR_RLOCK();
3440 if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUNDALL) {
3441 /*
3442 * Bound all case
3443 */
3444 answer = sctp_choose_boundall(inp, stcb, net, ro, vrf_id,
3445 dest_is_priv, dest_is_loop,
3446 non_asoc_addr_ok, fam);
3447 SCTP_IPI_ADDR_RUNLOCK();
3448 return (answer);
3449 }
3450 /*
3451 * Subset bound case
3452 */
3453 if (stcb) {
3454 answer = sctp_choose_boundspecific_stcb(inp, stcb, ro,
3455 vrf_id, dest_is_priv,
3456 dest_is_loop,
3457 non_asoc_addr_ok, fam);
3458 } else {
3459 answer = sctp_choose_boundspecific_inp(inp, ro, vrf_id,
3460 non_asoc_addr_ok,
3461 dest_is_priv,
3462 dest_is_loop, fam);
3463 }
3464 SCTP_IPI_ADDR_RUNLOCK();
3465 return (answer);
3466 }
3467
3468 static int
sctp_find_cmsg(int c_type,void * data,struct mbuf * control,size_t cpsize)3469 sctp_find_cmsg(int c_type, void *data, struct mbuf *control, size_t cpsize)
3470 {
3471 struct cmsghdr cmh;
3472 struct sctp_sndinfo sndinfo;
3473 struct sctp_prinfo prinfo;
3474 struct sctp_authinfo authinfo;
3475 int tot_len, rem_len, cmsg_data_len, cmsg_data_off, off;
3476 int found;
3477
3478 /*
3479 * Independent of how many mbufs, find the c_type inside the control
3480 * structure and copy out the data.
3481 */
3482 found = 0;
3483 tot_len = SCTP_BUF_LEN(control);
3484 for (off = 0; off < tot_len; off += CMSG_ALIGN(cmh.cmsg_len)) {
3485 rem_len = tot_len - off;
3486 if (rem_len < (int)CMSG_ALIGN(sizeof(cmh))) {
3487 /* There is not enough room for one more. */
3488 return (found);
3489 }
3490 m_copydata(control, off, sizeof(cmh), (caddr_t)&cmh);
3491 if (cmh.cmsg_len < CMSG_ALIGN(sizeof(cmh))) {
3492 /* We dont't have a complete CMSG header. */
3493 return (found);
3494 }
3495 if ((cmh.cmsg_len > INT_MAX) || ((int)cmh.cmsg_len > rem_len)) {
3496 /* We don't have the complete CMSG. */
3497 return (found);
3498 }
3499 cmsg_data_len = (int)cmh.cmsg_len - CMSG_ALIGN(sizeof(cmh));
3500 cmsg_data_off = off + CMSG_ALIGN(sizeof(cmh));
3501 if ((cmh.cmsg_level == IPPROTO_SCTP) &&
3502 ((c_type == cmh.cmsg_type) ||
3503 ((c_type == SCTP_SNDRCV) &&
3504 ((cmh.cmsg_type == SCTP_SNDINFO) ||
3505 (cmh.cmsg_type == SCTP_PRINFO) ||
3506 (cmh.cmsg_type == SCTP_AUTHINFO))))) {
3507 if (c_type == cmh.cmsg_type) {
3508 if (cpsize > INT_MAX) {
3509 return (found);
3510 }
3511 if (cmsg_data_len < (int)cpsize) {
3512 return (found);
3513 }
3514 /* It is exactly what we want. Copy it out. */
3515 m_copydata(control, cmsg_data_off, (int)cpsize, (caddr_t)data);
3516 return (1);
3517 } else {
3518 struct sctp_sndrcvinfo *sndrcvinfo;
3519
3520 sndrcvinfo = (struct sctp_sndrcvinfo *)data;
3521 if (found == 0) {
3522 if (cpsize < sizeof(struct sctp_sndrcvinfo)) {
3523 return (found);
3524 }
3525 memset(sndrcvinfo, 0, sizeof(struct sctp_sndrcvinfo));
3526 }
3527 switch (cmh.cmsg_type) {
3528 case SCTP_SNDINFO:
3529 if (cmsg_data_len < (int)sizeof(struct sctp_sndinfo)) {
3530 return (found);
3531 }
3532 m_copydata(control, cmsg_data_off, sizeof(struct sctp_sndinfo), (caddr_t)&sndinfo);
3533 sndrcvinfo->sinfo_stream = sndinfo.snd_sid;
3534 sndrcvinfo->sinfo_flags = sndinfo.snd_flags;
3535 sndrcvinfo->sinfo_ppid = sndinfo.snd_ppid;
3536 sndrcvinfo->sinfo_context = sndinfo.snd_context;
3537 sndrcvinfo->sinfo_assoc_id = sndinfo.snd_assoc_id;
3538 break;
3539 case SCTP_PRINFO:
3540 if (cmsg_data_len < (int)sizeof(struct sctp_prinfo)) {
3541 return (found);
3542 }
3543 m_copydata(control, cmsg_data_off, sizeof(struct sctp_prinfo), (caddr_t)&prinfo);
3544 if (prinfo.pr_policy != SCTP_PR_SCTP_NONE) {
3545 sndrcvinfo->sinfo_timetolive = prinfo.pr_value;
3546 } else {
3547 sndrcvinfo->sinfo_timetolive = 0;
3548 }
3549 sndrcvinfo->sinfo_flags |= prinfo.pr_policy;
3550 break;
3551 case SCTP_AUTHINFO:
3552 if (cmsg_data_len < (int)sizeof(struct sctp_authinfo)) {
3553 return (found);
3554 }
3555 m_copydata(control, cmsg_data_off, sizeof(struct sctp_authinfo), (caddr_t)&authinfo);
3556 sndrcvinfo->sinfo_keynumber_valid = 1;
3557 sndrcvinfo->sinfo_keynumber = authinfo.auth_keynumber;
3558 break;
3559 default:
3560 return (found);
3561 }
3562 found = 1;
3563 }
3564 }
3565 }
3566 return (found);
3567 }
3568
3569 static int
sctp_process_cmsgs_for_init(struct sctp_tcb * stcb,struct mbuf * control,int * error)3570 sctp_process_cmsgs_for_init(struct sctp_tcb *stcb, struct mbuf *control, int *error)
3571 {
3572 struct cmsghdr cmh;
3573 struct sctp_initmsg initmsg;
3574 #ifdef INET
3575 struct sockaddr_in sin;
3576 #endif
3577 #ifdef INET6
3578 struct sockaddr_in6 sin6;
3579 #endif
3580 int tot_len, rem_len, cmsg_data_len, cmsg_data_off, off;
3581
3582 tot_len = SCTP_BUF_LEN(control);
3583 for (off = 0; off < tot_len; off += CMSG_ALIGN(cmh.cmsg_len)) {
3584 rem_len = tot_len - off;
3585 if (rem_len < (int)CMSG_ALIGN(sizeof(cmh))) {
3586 /* There is not enough room for one more. */
3587 *error = EINVAL;
3588 return (1);
3589 }
3590 m_copydata(control, off, sizeof(cmh), (caddr_t)&cmh);
3591 if (cmh.cmsg_len < CMSG_ALIGN(sizeof(cmh))) {
3592 /* We dont't have a complete CMSG header. */
3593 *error = EINVAL;
3594 return (1);
3595 }
3596 if ((cmh.cmsg_len > INT_MAX) || ((int)cmh.cmsg_len > rem_len)) {
3597 /* We don't have the complete CMSG. */
3598 *error = EINVAL;
3599 return (1);
3600 }
3601 cmsg_data_len = (int)cmh.cmsg_len - CMSG_ALIGN(sizeof(cmh));
3602 cmsg_data_off = off + CMSG_ALIGN(sizeof(cmh));
3603 if (cmh.cmsg_level == IPPROTO_SCTP) {
3604 switch (cmh.cmsg_type) {
3605 case SCTP_INIT:
3606 if (cmsg_data_len < (int)sizeof(struct sctp_initmsg)) {
3607 *error = EINVAL;
3608 return (1);
3609 }
3610 m_copydata(control, cmsg_data_off, sizeof(struct sctp_initmsg), (caddr_t)&initmsg);
3611 if (initmsg.sinit_max_attempts)
3612 stcb->asoc.max_init_times = initmsg.sinit_max_attempts;
3613 if (initmsg.sinit_num_ostreams)
3614 stcb->asoc.pre_open_streams = initmsg.sinit_num_ostreams;
3615 if (initmsg.sinit_max_instreams)
3616 stcb->asoc.max_inbound_streams = initmsg.sinit_max_instreams;
3617 if (initmsg.sinit_max_init_timeo)
3618 stcb->asoc.initial_init_rto_max = initmsg.sinit_max_init_timeo;
3619 if (stcb->asoc.streamoutcnt < stcb->asoc.pre_open_streams) {
3620 struct sctp_stream_out *tmp_str;
3621 unsigned int i;
3622 #if defined(SCTP_DETAILED_STR_STATS)
3623 int j;
3624 #endif
3625
3626 /* Default is NOT correct */
3627 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Ok, default:%d pre_open:%d\n",
3628 stcb->asoc.streamoutcnt, stcb->asoc.pre_open_streams);
3629 SCTP_TCB_UNLOCK(stcb);
3630 SCTP_MALLOC(tmp_str,
3631 struct sctp_stream_out *,
3632 (stcb->asoc.pre_open_streams * sizeof(struct sctp_stream_out)),
3633 SCTP_M_STRMO);
3634 SCTP_TCB_LOCK(stcb);
3635 if (tmp_str != NULL) {
3636 SCTP_FREE(stcb->asoc.strmout, SCTP_M_STRMO);
3637 stcb->asoc.strmout = tmp_str;
3638 stcb->asoc.strm_realoutsize = stcb->asoc.streamoutcnt = stcb->asoc.pre_open_streams;
3639 } else {
3640 stcb->asoc.pre_open_streams = stcb->asoc.streamoutcnt;
3641 }
3642 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
3643 TAILQ_INIT(&stcb->asoc.strmout[i].outqueue);
3644 stcb->asoc.strmout[i].chunks_on_queues = 0;
3645 stcb->asoc.strmout[i].next_mid_ordered = 0;
3646 stcb->asoc.strmout[i].next_mid_unordered = 0;
3647 #if defined(SCTP_DETAILED_STR_STATS)
3648 for (j = 0; j < SCTP_PR_SCTP_MAX + 1; j++) {
3649 stcb->asoc.strmout[i].abandoned_sent[j] = 0;
3650 stcb->asoc.strmout[i].abandoned_unsent[j] = 0;
3651 }
3652 #else
3653 stcb->asoc.strmout[i].abandoned_sent[0] = 0;
3654 stcb->asoc.strmout[i].abandoned_unsent[0] = 0;
3655 #endif
3656 stcb->asoc.strmout[i].sid = i;
3657 stcb->asoc.strmout[i].last_msg_incomplete = 0;
3658 stcb->asoc.strmout[i].state = SCTP_STREAM_OPENING;
3659 stcb->asoc.ss_functions.sctp_ss_init_stream(stcb, &stcb->asoc.strmout[i], NULL);
3660 }
3661 }
3662 break;
3663 #ifdef INET
3664 case SCTP_DSTADDRV4:
3665 if (cmsg_data_len < (int)sizeof(struct in_addr)) {
3666 *error = EINVAL;
3667 return (1);
3668 }
3669 memset(&sin, 0, sizeof(struct sockaddr_in));
3670 sin.sin_family = AF_INET;
3671 sin.sin_len = sizeof(struct sockaddr_in);
3672 sin.sin_port = stcb->rport;
3673 m_copydata(control, cmsg_data_off, sizeof(struct in_addr), (caddr_t)&sin.sin_addr);
3674 if ((sin.sin_addr.s_addr == INADDR_ANY) ||
3675 (sin.sin_addr.s_addr == INADDR_BROADCAST) ||
3676 IN_MULTICAST(ntohl(sin.sin_addr.s_addr))) {
3677 *error = EINVAL;
3678 return (1);
3679 }
3680 if (sctp_add_remote_addr(stcb, (struct sockaddr *)&sin, NULL, stcb->asoc.port,
3681 SCTP_DONOT_SETSCOPE, SCTP_ADDR_IS_CONFIRMED)) {
3682 *error = ENOBUFS;
3683 return (1);
3684 }
3685 break;
3686 #endif
3687 #ifdef INET6
3688 case SCTP_DSTADDRV6:
3689 if (cmsg_data_len < (int)sizeof(struct in6_addr)) {
3690 *error = EINVAL;
3691 return (1);
3692 }
3693 memset(&sin6, 0, sizeof(struct sockaddr_in6));
3694 sin6.sin6_family = AF_INET6;
3695 sin6.sin6_len = sizeof(struct sockaddr_in6);
3696 sin6.sin6_port = stcb->rport;
3697 m_copydata(control, cmsg_data_off, sizeof(struct in6_addr), (caddr_t)&sin6.sin6_addr);
3698 if (IN6_IS_ADDR_UNSPECIFIED(&sin6.sin6_addr) ||
3699 IN6_IS_ADDR_MULTICAST(&sin6.sin6_addr)) {
3700 *error = EINVAL;
3701 return (1);
3702 }
3703 #ifdef INET
3704 if (IN6_IS_ADDR_V4MAPPED(&sin6.sin6_addr)) {
3705 in6_sin6_2_sin(&sin, &sin6);
3706 if ((sin.sin_addr.s_addr == INADDR_ANY) ||
3707 (sin.sin_addr.s_addr == INADDR_BROADCAST) ||
3708 IN_MULTICAST(ntohl(sin.sin_addr.s_addr))) {
3709 *error = EINVAL;
3710 return (1);
3711 }
3712 if (sctp_add_remote_addr(stcb, (struct sockaddr *)&sin, NULL, stcb->asoc.port,
3713 SCTP_DONOT_SETSCOPE, SCTP_ADDR_IS_CONFIRMED)) {
3714 *error = ENOBUFS;
3715 return (1);
3716 }
3717 } else
3718 #endif
3719 if (sctp_add_remote_addr(stcb, (struct sockaddr *)&sin6, NULL, stcb->asoc.port,
3720 SCTP_DONOT_SETSCOPE, SCTP_ADDR_IS_CONFIRMED)) {
3721 *error = ENOBUFS;
3722 return (1);
3723 }
3724 break;
3725 #endif
3726 default:
3727 break;
3728 }
3729 }
3730 }
3731 return (0);
3732 }
3733
3734 #if defined(INET) || defined(INET6)
3735 static struct sctp_tcb *
sctp_findassociation_cmsgs(struct sctp_inpcb ** inp_p,uint16_t port,struct mbuf * control,struct sctp_nets ** net_p,int * error)3736 sctp_findassociation_cmsgs(struct sctp_inpcb **inp_p,
3737 uint16_t port,
3738 struct mbuf *control,
3739 struct sctp_nets **net_p,
3740 int *error)
3741 {
3742 struct cmsghdr cmh;
3743 struct sctp_tcb *stcb;
3744 struct sockaddr *addr;
3745 #ifdef INET
3746 struct sockaddr_in sin;
3747 #endif
3748 #ifdef INET6
3749 struct sockaddr_in6 sin6;
3750 #endif
3751 int tot_len, rem_len, cmsg_data_len, cmsg_data_off, off;
3752
3753 tot_len = SCTP_BUF_LEN(control);
3754 for (off = 0; off < tot_len; off += CMSG_ALIGN(cmh.cmsg_len)) {
3755 rem_len = tot_len - off;
3756 if (rem_len < (int)CMSG_ALIGN(sizeof(cmh))) {
3757 /* There is not enough room for one more. */
3758 *error = EINVAL;
3759 return (NULL);
3760 }
3761 m_copydata(control, off, sizeof(cmh), (caddr_t)&cmh);
3762 if (cmh.cmsg_len < CMSG_ALIGN(sizeof(cmh))) {
3763 /* We dont't have a complete CMSG header. */
3764 *error = EINVAL;
3765 return (NULL);
3766 }
3767 if ((cmh.cmsg_len > INT_MAX) || ((int)cmh.cmsg_len > rem_len)) {
3768 /* We don't have the complete CMSG. */
3769 *error = EINVAL;
3770 return (NULL);
3771 }
3772 cmsg_data_len = (int)cmh.cmsg_len - CMSG_ALIGN(sizeof(cmh));
3773 cmsg_data_off = off + CMSG_ALIGN(sizeof(cmh));
3774 if (cmh.cmsg_level == IPPROTO_SCTP) {
3775 switch (cmh.cmsg_type) {
3776 #ifdef INET
3777 case SCTP_DSTADDRV4:
3778 if (cmsg_data_len < (int)sizeof(struct in_addr)) {
3779 *error = EINVAL;
3780 return (NULL);
3781 }
3782 memset(&sin, 0, sizeof(struct sockaddr_in));
3783 sin.sin_family = AF_INET;
3784 sin.sin_len = sizeof(struct sockaddr_in);
3785 sin.sin_port = port;
3786 m_copydata(control, cmsg_data_off, sizeof(struct in_addr), (caddr_t)&sin.sin_addr);
3787 addr = (struct sockaddr *)&sin;
3788 break;
3789 #endif
3790 #ifdef INET6
3791 case SCTP_DSTADDRV6:
3792 if (cmsg_data_len < (int)sizeof(struct in6_addr)) {
3793 *error = EINVAL;
3794 return (NULL);
3795 }
3796 memset(&sin6, 0, sizeof(struct sockaddr_in6));
3797 sin6.sin6_family = AF_INET6;
3798 sin6.sin6_len = sizeof(struct sockaddr_in6);
3799 sin6.sin6_port = port;
3800 m_copydata(control, cmsg_data_off, sizeof(struct in6_addr), (caddr_t)&sin6.sin6_addr);
3801 #ifdef INET
3802 if (IN6_IS_ADDR_V4MAPPED(&sin6.sin6_addr)) {
3803 in6_sin6_2_sin(&sin, &sin6);
3804 addr = (struct sockaddr *)&sin;
3805 } else
3806 #endif
3807 addr = (struct sockaddr *)&sin6;
3808 break;
3809 #endif
3810 default:
3811 addr = NULL;
3812 break;
3813 }
3814 if (addr) {
3815 stcb = sctp_findassociation_ep_addr(inp_p, addr, net_p, NULL, NULL);
3816 if (stcb != NULL) {
3817 return (stcb);
3818 }
3819 }
3820 }
3821 }
3822 return (NULL);
3823 }
3824 #endif
3825
3826 static struct mbuf *
sctp_add_cookie(struct mbuf * init,int init_offset,struct mbuf * initack,int initack_offset,struct sctp_state_cookie * stc_in,uint8_t ** signature)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 uint16_t cookie_sz;
3834
3835 mret = sctp_get_mbuf_for_msg((sizeof(struct sctp_state_cookie) +
3836 sizeof(struct sctp_paramhdr)), 0,
3837 M_NOWAIT, 1, MT_DATA);
3838 if (mret == NULL) {
3839 return (NULL);
3840 }
3841 copy_init = SCTP_M_COPYM(init, init_offset, M_COPYALL, M_NOWAIT);
3842 if (copy_init == NULL) {
3843 sctp_m_freem(mret);
3844 return (NULL);
3845 }
3846 #ifdef SCTP_MBUF_LOGGING
3847 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
3848 sctp_log_mbc(copy_init, SCTP_MBUF_ICOPY);
3849 }
3850 #endif
3851 copy_initack = SCTP_M_COPYM(initack, initack_offset, M_COPYALL,
3852 M_NOWAIT);
3853 if (copy_initack == NULL) {
3854 sctp_m_freem(mret);
3855 sctp_m_freem(copy_init);
3856 return (NULL);
3857 }
3858 #ifdef SCTP_MBUF_LOGGING
3859 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
3860 sctp_log_mbc(copy_initack, SCTP_MBUF_ICOPY);
3861 }
3862 #endif
3863 /* easy side we just drop it on the end */
3864 ph = mtod(mret, struct sctp_paramhdr *);
3865 SCTP_BUF_LEN(mret) = sizeof(struct sctp_state_cookie) +
3866 sizeof(struct sctp_paramhdr);
3867 stc = (struct sctp_state_cookie *)((caddr_t)ph +
3868 sizeof(struct sctp_paramhdr));
3869 ph->param_type = htons(SCTP_STATE_COOKIE);
3870 ph->param_length = 0; /* fill in at the end */
3871 /* Fill in the stc cookie data */
3872 memcpy(stc, stc_in, sizeof(struct sctp_state_cookie));
3873
3874 /* tack the INIT and then the INIT-ACK onto the chain */
3875 cookie_sz = 0;
3876 for (m_at = mret; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
3877 cookie_sz += SCTP_BUF_LEN(m_at);
3878 if (SCTP_BUF_NEXT(m_at) == NULL) {
3879 SCTP_BUF_NEXT(m_at) = copy_init;
3880 break;
3881 }
3882 }
3883 for (m_at = copy_init; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
3884 cookie_sz += SCTP_BUF_LEN(m_at);
3885 if (SCTP_BUF_NEXT(m_at) == NULL) {
3886 SCTP_BUF_NEXT(m_at) = copy_initack;
3887 break;
3888 }
3889 }
3890 for (m_at = copy_initack; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
3891 cookie_sz += SCTP_BUF_LEN(m_at);
3892 if (SCTP_BUF_NEXT(m_at) == NULL) {
3893 break;
3894 }
3895 }
3896 sig = sctp_get_mbuf_for_msg(SCTP_SIGNATURE_SIZE, 0, M_NOWAIT, 1, MT_DATA);
3897 if (sig == NULL) {
3898 /* no space, so free the entire chain */
3899 sctp_m_freem(mret);
3900 return (NULL);
3901 }
3902 SCTP_BUF_NEXT(m_at) = sig;
3903 SCTP_BUF_LEN(sig) = SCTP_SIGNATURE_SIZE;
3904 cookie_sz += SCTP_SIGNATURE_SIZE;
3905 ph->param_length = htons(cookie_sz);
3906 *signature = (uint8_t *)mtod(sig, caddr_t);
3907 memset(*signature, 0, SCTP_SIGNATURE_SIZE);
3908 return (mret);
3909 }
3910
3911 static uint8_t
sctp_get_ect(struct sctp_tcb * stcb)3912 sctp_get_ect(struct sctp_tcb *stcb)
3913 {
3914 if ((stcb != NULL) && (stcb->asoc.ecn_supported == 1)) {
3915 return (SCTP_ECT0_BIT);
3916 } else {
3917 return (0);
3918 }
3919 }
3920
3921 #if defined(INET) || defined(INET6)
3922 static void
sctp_handle_no_route(struct sctp_tcb * stcb,struct sctp_nets * net,int so_locked)3923 sctp_handle_no_route(struct sctp_tcb *stcb,
3924 struct sctp_nets *net,
3925 int so_locked)
3926 {
3927 SCTPDBG(SCTP_DEBUG_OUTPUT1, "dropped packet - no valid source addr\n");
3928
3929 if (net) {
3930 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Destination was ");
3931 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT1, &net->ro._l_addr.sa);
3932 if (net->dest_state & SCTP_ADDR_CONFIRMED) {
3933 if ((net->dest_state & SCTP_ADDR_REACHABLE) && stcb) {
3934 SCTPDBG(SCTP_DEBUG_OUTPUT1, "no route takes interface %p down\n", (void *)net);
3935 sctp_ulp_notify(SCTP_NOTIFY_INTERFACE_DOWN,
3936 stcb, 0,
3937 (void *)net,
3938 so_locked);
3939 net->dest_state &= ~SCTP_ADDR_REACHABLE;
3940 net->dest_state &= ~SCTP_ADDR_PF;
3941 }
3942 }
3943 if (stcb) {
3944 if (net == stcb->asoc.primary_destination) {
3945 /* need a new primary */
3946 struct sctp_nets *alt;
3947
3948 alt = sctp_find_alternate_net(stcb, net, 0);
3949 if (alt != net) {
3950 if (stcb->asoc.alternate) {
3951 sctp_free_remote_addr(stcb->asoc.alternate);
3952 }
3953 stcb->asoc.alternate = alt;
3954 atomic_add_int(&stcb->asoc.alternate->ref_count, 1);
3955 if (net->ro._s_addr) {
3956 sctp_free_ifa(net->ro._s_addr);
3957 net->ro._s_addr = NULL;
3958 }
3959 net->src_addr_selected = 0;
3960 }
3961 }
3962 }
3963 }
3964 }
3965 #endif
3966
3967 static int
sctp_lowlevel_chunk_output(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_nets * net,struct sockaddr * to,struct mbuf * m,uint32_t auth_offset,struct sctp_auth_chunk * auth,uint16_t auth_keyid,int nofragment_flag,int ecn_ok,int out_of_asoc_ok,uint16_t src_port,uint16_t dest_port,uint32_t v_tag,uint16_t port,union sctp_sockstore * over_addr,uint8_t mflowtype,uint32_t mflowid,int so_locked)3968 sctp_lowlevel_chunk_output(struct sctp_inpcb *inp,
3969 struct sctp_tcb *stcb, /* may be NULL */
3970 struct sctp_nets *net,
3971 struct sockaddr *to,
3972 struct mbuf *m,
3973 uint32_t auth_offset,
3974 struct sctp_auth_chunk *auth,
3975 uint16_t auth_keyid,
3976 int nofragment_flag,
3977 int ecn_ok,
3978 int out_of_asoc_ok,
3979 uint16_t src_port,
3980 uint16_t dest_port,
3981 uint32_t v_tag,
3982 uint16_t port,
3983 union sctp_sockstore *over_addr,
3984 uint8_t mflowtype, uint32_t mflowid,
3985 int so_locked)
3986 {
3987 /* nofragment_flag to tell if IP_DF should be set (IPv4 only) */
3988 /**
3989 * Given a mbuf chain (via SCTP_BUF_NEXT()) that holds a packet header
3990 * WITH an SCTPHDR but no IP header, endpoint inp and sa structure:
3991 * - fill in the HMAC digest of any AUTH chunk in the packet.
3992 * - calculate and fill in the SCTP checksum.
3993 * - prepend an IP address header.
3994 * - if boundall use INADDR_ANY.
3995 * - if boundspecific do source address selection.
3996 * - set fragmentation option for ipV4.
3997 * - On return from IP output, check/adjust mtu size of output
3998 * interface and smallest_mtu size as well.
3999 */
4000 /* Will need ifdefs around this */
4001 struct mbuf *newm;
4002 struct sctphdr *sctphdr;
4003 int packet_length;
4004 int ret;
4005 #if defined(INET) || defined(INET6)
4006 uint32_t vrf_id;
4007 #endif
4008 #if defined(INET) || defined(INET6)
4009 struct mbuf *o_pak;
4010 sctp_route_t *ro = NULL;
4011 struct udphdr *udp = NULL;
4012 #endif
4013 uint8_t tos_value;
4014
4015 if ((net) && (net->dest_state & SCTP_ADDR_OUT_OF_SCOPE)) {
4016 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EFAULT);
4017 sctp_m_freem(m);
4018 return (EFAULT);
4019 }
4020 #if defined(INET) || defined(INET6)
4021 if (stcb) {
4022 vrf_id = stcb->asoc.vrf_id;
4023 } else {
4024 vrf_id = inp->def_vrf_id;
4025 }
4026 #endif
4027 /* fill in the HMAC digest for any AUTH chunk in the packet */
4028 if ((auth != NULL) && (stcb != NULL)) {
4029 sctp_fill_hmac_digest_m(m, auth_offset, auth, stcb, auth_keyid);
4030 }
4031
4032 if (net) {
4033 tos_value = net->dscp;
4034 } else if (stcb) {
4035 tos_value = stcb->asoc.default_dscp;
4036 } else {
4037 tos_value = inp->sctp_ep.default_dscp;
4038 }
4039
4040 switch (to->sa_family) {
4041 #ifdef INET
4042 case AF_INET:
4043 {
4044 struct ip *ip = NULL;
4045 sctp_route_t iproute;
4046 int len;
4047
4048 len = SCTP_MIN_V4_OVERHEAD;
4049 if (port) {
4050 len += sizeof(struct udphdr);
4051 }
4052 newm = sctp_get_mbuf_for_msg(len, 1, M_NOWAIT, 1, MT_DATA);
4053 if (newm == NULL) {
4054 sctp_m_freem(m);
4055 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4056 return (ENOMEM);
4057 }
4058 SCTP_ALIGN_TO_END(newm, len);
4059 SCTP_BUF_LEN(newm) = len;
4060 SCTP_BUF_NEXT(newm) = m;
4061 m = newm;
4062 if (net != NULL) {
4063 m->m_pkthdr.flowid = net->flowid;
4064 M_HASHTYPE_SET(m, net->flowtype);
4065 } else {
4066 m->m_pkthdr.flowid = mflowid;
4067 M_HASHTYPE_SET(m, mflowtype);
4068 }
4069 packet_length = sctp_calculate_len(m);
4070 ip = mtod(m, struct ip *);
4071 ip->ip_v = IPVERSION;
4072 ip->ip_hl = (sizeof(struct ip) >> 2);
4073 if (tos_value == 0) {
4074 /*
4075 * This means especially, that it is not set
4076 * at the SCTP layer. So use the value from
4077 * the IP layer.
4078 */
4079 tos_value = inp->ip_inp.inp.inp_ip_tos;
4080 }
4081 tos_value &= 0xfc;
4082 if (ecn_ok) {
4083 tos_value |= sctp_get_ect(stcb);
4084 }
4085 if ((nofragment_flag) && (port == 0)) {
4086 ip->ip_off = htons(IP_DF);
4087 } else {
4088 ip->ip_off = htons(0);
4089 }
4090 /* FreeBSD has a function for ip_id's */
4091 ip_fillid(ip);
4092
4093 ip->ip_ttl = inp->ip_inp.inp.inp_ip_ttl;
4094 ip->ip_len = htons(packet_length);
4095 ip->ip_tos = tos_value;
4096 if (port) {
4097 ip->ip_p = IPPROTO_UDP;
4098 } else {
4099 ip->ip_p = IPPROTO_SCTP;
4100 }
4101 ip->ip_sum = 0;
4102 if (net == NULL) {
4103 ro = &iproute;
4104 memset(&iproute, 0, sizeof(iproute));
4105 memcpy(&ro->ro_dst, to, to->sa_len);
4106 } else {
4107 ro = (sctp_route_t *)&net->ro;
4108 }
4109 /* Now the address selection part */
4110 ip->ip_dst.s_addr = ((struct sockaddr_in *)to)->sin_addr.s_addr;
4111
4112 /* call the routine to select the src address */
4113 if (net && out_of_asoc_ok == 0) {
4114 if (net->ro._s_addr && (net->ro._s_addr->localifa_flags & (SCTP_BEING_DELETED | SCTP_ADDR_IFA_UNUSEABLE))) {
4115 sctp_free_ifa(net->ro._s_addr);
4116 net->ro._s_addr = NULL;
4117 net->src_addr_selected = 0;
4118 if (ro->ro_rt) {
4119 RTFREE(ro->ro_rt);
4120 ro->ro_rt = NULL;
4121 }
4122 }
4123 if (net->src_addr_selected == 0) {
4124 /* Cache the source address */
4125 net->ro._s_addr = sctp_source_address_selection(inp, stcb,
4126 ro, net, 0,
4127 vrf_id);
4128 net->src_addr_selected = 1;
4129 }
4130 if (net->ro._s_addr == NULL) {
4131 /* No route to host */
4132 net->src_addr_selected = 0;
4133 sctp_handle_no_route(stcb, net, so_locked);
4134 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4135 sctp_m_freem(m);
4136 return (EHOSTUNREACH);
4137 }
4138 ip->ip_src = net->ro._s_addr->address.sin.sin_addr;
4139 } else {
4140 if (over_addr == NULL) {
4141 struct sctp_ifa *_lsrc;
4142
4143 _lsrc = sctp_source_address_selection(inp, stcb, ro,
4144 net,
4145 out_of_asoc_ok,
4146 vrf_id);
4147 if (_lsrc == NULL) {
4148 sctp_handle_no_route(stcb, net, so_locked);
4149 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4150 sctp_m_freem(m);
4151 return (EHOSTUNREACH);
4152 }
4153 ip->ip_src = _lsrc->address.sin.sin_addr;
4154 sctp_free_ifa(_lsrc);
4155 } else {
4156 ip->ip_src = over_addr->sin.sin_addr;
4157 SCTP_RTALLOC(ro, vrf_id, inp->fibnum);
4158 }
4159 }
4160 if (port) {
4161 if (htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port)) == 0) {
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 udp = (struct udphdr *)((caddr_t)ip + sizeof(struct ip));
4168 udp->uh_sport = htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port));
4169 udp->uh_dport = port;
4170 udp->uh_ulen = htons((uint16_t)(packet_length - sizeof(struct ip)));
4171 if (V_udp_cksum) {
4172 udp->uh_sum = in_pseudo(ip->ip_src.s_addr, ip->ip_dst.s_addr, udp->uh_ulen + htons(IPPROTO_UDP));
4173 } else {
4174 udp->uh_sum = 0;
4175 }
4176 sctphdr = (struct sctphdr *)((caddr_t)udp + sizeof(struct udphdr));
4177 } else {
4178 sctphdr = (struct sctphdr *)((caddr_t)ip + sizeof(struct ip));
4179 }
4180
4181 sctphdr->src_port = src_port;
4182 sctphdr->dest_port = dest_port;
4183 sctphdr->v_tag = v_tag;
4184 sctphdr->checksum = 0;
4185
4186 /*
4187 * If source address selection fails and we find no
4188 * route then the ip_output should fail as well with
4189 * a NO_ROUTE_TO_HOST type error. We probably should
4190 * catch that somewhere and abort the association
4191 * right away (assuming this is an INIT being sent).
4192 */
4193 if (ro->ro_rt == NULL) {
4194 /*
4195 * src addr selection failed to find a route
4196 * (or valid source addr), so we can't get
4197 * there from here (yet)!
4198 */
4199 sctp_handle_no_route(stcb, net, so_locked);
4200 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4201 sctp_m_freem(m);
4202 return (EHOSTUNREACH);
4203 }
4204 if (ro != &iproute) {
4205 memcpy(&iproute, ro, sizeof(*ro));
4206 }
4207 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Calling ipv4 output routine from low level src addr:%x\n",
4208 (uint32_t)(ntohl(ip->ip_src.s_addr)));
4209 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Destination is %x\n",
4210 (uint32_t)(ntohl(ip->ip_dst.s_addr)));
4211 SCTPDBG(SCTP_DEBUG_OUTPUT3, "RTP route is %p through\n",
4212 (void *)ro->ro_rt);
4213
4214 if (SCTP_GET_HEADER_FOR_OUTPUT(o_pak)) {
4215 /* failed to prepend data, give up */
4216 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4217 sctp_m_freem(m);
4218 return (ENOMEM);
4219 }
4220 SCTP_ATTACH_CHAIN(o_pak, m, packet_length);
4221 if (port) {
4222 sctphdr->checksum = sctp_calculate_cksum(m, sizeof(struct ip) + sizeof(struct udphdr));
4223 SCTP_STAT_INCR(sctps_sendswcrc);
4224 if (V_udp_cksum) {
4225 SCTP_ENABLE_UDP_CSUM(o_pak);
4226 }
4227 } else {
4228 m->m_pkthdr.csum_flags = CSUM_SCTP;
4229 m->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
4230 SCTP_STAT_INCR(sctps_sendhwcrc);
4231 }
4232 #ifdef SCTP_PACKET_LOGGING
4233 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING)
4234 sctp_packet_log(o_pak);
4235 #endif
4236 /* send it out. table id is taken from stcb */
4237 SCTP_PROBE5(send, NULL, stcb, ip, stcb, sctphdr);
4238 SCTP_IP_OUTPUT(ret, o_pak, ro, stcb, vrf_id);
4239 if (port) {
4240 UDPSTAT_INC(udps_opackets);
4241 }
4242 SCTP_STAT_INCR(sctps_sendpackets);
4243 SCTP_STAT_INCR_COUNTER64(sctps_outpackets);
4244 if (ret)
4245 SCTP_STAT_INCR(sctps_senderrors);
4246
4247 SCTPDBG(SCTP_DEBUG_OUTPUT3, "IP output returns %d\n", ret);
4248 if (net == NULL) {
4249 /* free tempy routes */
4250 RO_RTFREE(ro);
4251 } else {
4252 if ((ro->ro_rt != NULL) && (net->ro._s_addr) &&
4253 ((net->dest_state & SCTP_ADDR_NO_PMTUD) == 0)) {
4254 uint32_t mtu;
4255
4256 mtu = SCTP_GATHER_MTU_FROM_ROUTE(net->ro._s_addr, &net->ro._l_addr.sa, ro->ro_rt);
4257 if (mtu > 0) {
4258 if (net->port) {
4259 mtu -= sizeof(struct udphdr);
4260 }
4261 if (mtu < net->mtu) {
4262 if ((stcb != NULL) && (stcb->asoc.smallest_mtu > mtu)) {
4263 sctp_mtu_size_reset(inp, &stcb->asoc, mtu);
4264 }
4265 net->mtu = mtu;
4266 }
4267 }
4268 } else if (ro->ro_rt == NULL) {
4269 /* route was freed */
4270 if (net->ro._s_addr &&
4271 net->src_addr_selected) {
4272 sctp_free_ifa(net->ro._s_addr);
4273 net->ro._s_addr = NULL;
4274 }
4275 net->src_addr_selected = 0;
4276 }
4277 }
4278 return (ret);
4279 }
4280 #endif
4281 #ifdef INET6
4282 case AF_INET6:
4283 {
4284 uint32_t flowlabel, flowinfo;
4285 struct ip6_hdr *ip6h;
4286 struct route_in6 ip6route;
4287 struct ifnet *ifp;
4288 struct sockaddr_in6 *sin6, tmp, *lsa6, lsa6_tmp;
4289 int prev_scope = 0;
4290 struct sockaddr_in6 lsa6_storage;
4291 int error;
4292 u_short prev_port = 0;
4293 int len;
4294
4295 if (net) {
4296 flowlabel = net->flowlabel;
4297 } else if (stcb) {
4298 flowlabel = stcb->asoc.default_flowlabel;
4299 } else {
4300 flowlabel = inp->sctp_ep.default_flowlabel;
4301 }
4302 if (flowlabel == 0) {
4303 /*
4304 * This means especially, that it is not set
4305 * at the SCTP layer. So use the value from
4306 * the IP layer.
4307 */
4308 flowlabel = ntohl(((struct inpcb *)inp)->inp_flow);
4309 }
4310 flowlabel &= 0x000fffff;
4311 len = SCTP_MIN_OVERHEAD;
4312 if (port) {
4313 len += sizeof(struct udphdr);
4314 }
4315 newm = sctp_get_mbuf_for_msg(len, 1, M_NOWAIT, 1, MT_DATA);
4316 if (newm == NULL) {
4317 sctp_m_freem(m);
4318 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4319 return (ENOMEM);
4320 }
4321 SCTP_ALIGN_TO_END(newm, len);
4322 SCTP_BUF_LEN(newm) = len;
4323 SCTP_BUF_NEXT(newm) = m;
4324 m = newm;
4325 if (net != NULL) {
4326 m->m_pkthdr.flowid = net->flowid;
4327 M_HASHTYPE_SET(m, net->flowtype);
4328 } else {
4329 m->m_pkthdr.flowid = mflowid;
4330 M_HASHTYPE_SET(m, mflowtype);
4331 }
4332 packet_length = sctp_calculate_len(m);
4333
4334 ip6h = mtod(m, struct ip6_hdr *);
4335 /* protect *sin6 from overwrite */
4336 sin6 = (struct sockaddr_in6 *)to;
4337 tmp = *sin6;
4338 sin6 = &tmp;
4339
4340 /* KAME hack: embed scopeid */
4341 if (sa6_embedscope(sin6, MODULE_GLOBAL(ip6_use_defzone)) != 0) {
4342 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
4343 sctp_m_freem(m);
4344 return (EINVAL);
4345 }
4346 if (net == NULL) {
4347 memset(&ip6route, 0, sizeof(ip6route));
4348 ro = (sctp_route_t *)&ip6route;
4349 memcpy(&ro->ro_dst, sin6, sin6->sin6_len);
4350 } else {
4351 ro = (sctp_route_t *)&net->ro;
4352 }
4353 /*
4354 * We assume here that inp_flow is in host byte
4355 * order within the TCB!
4356 */
4357 if (tos_value == 0) {
4358 /*
4359 * This means especially, that it is not set
4360 * at the SCTP layer. So use the value from
4361 * the IP layer.
4362 */
4363 tos_value = (ntohl(((struct inpcb *)inp)->inp_flow) >> 20) & 0xff;
4364 }
4365 tos_value &= 0xfc;
4366 if (ecn_ok) {
4367 tos_value |= sctp_get_ect(stcb);
4368 }
4369 flowinfo = 0x06;
4370 flowinfo <<= 8;
4371 flowinfo |= tos_value;
4372 flowinfo <<= 20;
4373 flowinfo |= flowlabel;
4374 ip6h->ip6_flow = htonl(flowinfo);
4375 if (port) {
4376 ip6h->ip6_nxt = IPPROTO_UDP;
4377 } else {
4378 ip6h->ip6_nxt = IPPROTO_SCTP;
4379 }
4380 ip6h->ip6_plen = htons((uint16_t)(packet_length - sizeof(struct ip6_hdr)));
4381 ip6h->ip6_dst = sin6->sin6_addr;
4382
4383 /*
4384 * Add SRC address selection here: we can only reuse
4385 * to a limited degree the kame src-addr-sel, since
4386 * we can try their selection but it may not be
4387 * bound.
4388 */
4389 memset(&lsa6_tmp, 0, sizeof(lsa6_tmp));
4390 lsa6_tmp.sin6_family = AF_INET6;
4391 lsa6_tmp.sin6_len = sizeof(lsa6_tmp);
4392 lsa6 = &lsa6_tmp;
4393 if (net && out_of_asoc_ok == 0) {
4394 if (net->ro._s_addr && (net->ro._s_addr->localifa_flags & (SCTP_BEING_DELETED | SCTP_ADDR_IFA_UNUSEABLE))) {
4395 sctp_free_ifa(net->ro._s_addr);
4396 net->ro._s_addr = NULL;
4397 net->src_addr_selected = 0;
4398 if (ro->ro_rt) {
4399 RTFREE(ro->ro_rt);
4400 ro->ro_rt = NULL;
4401 }
4402 }
4403 if (net->src_addr_selected == 0) {
4404 sin6 = (struct sockaddr_in6 *)&net->ro._l_addr;
4405 /* KAME hack: embed scopeid */
4406 if (sa6_embedscope(sin6, MODULE_GLOBAL(ip6_use_defzone)) != 0) {
4407 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
4408 sctp_m_freem(m);
4409 return (EINVAL);
4410 }
4411 /* Cache the source address */
4412 net->ro._s_addr = sctp_source_address_selection(inp,
4413 stcb,
4414 ro,
4415 net,
4416 0,
4417 vrf_id);
4418 (void)sa6_recoverscope(sin6);
4419 net->src_addr_selected = 1;
4420 }
4421 if (net->ro._s_addr == NULL) {
4422 SCTPDBG(SCTP_DEBUG_OUTPUT3, "V6:No route to host\n");
4423 net->src_addr_selected = 0;
4424 sctp_handle_no_route(stcb, net, so_locked);
4425 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4426 sctp_m_freem(m);
4427 return (EHOSTUNREACH);
4428 }
4429 lsa6->sin6_addr = net->ro._s_addr->address.sin6.sin6_addr;
4430 } else {
4431 sin6 = (struct sockaddr_in6 *)&ro->ro_dst;
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 if (over_addr == NULL) {
4439 struct sctp_ifa *_lsrc;
4440
4441 _lsrc = sctp_source_address_selection(inp, stcb, ro,
4442 net,
4443 out_of_asoc_ok,
4444 vrf_id);
4445 if (_lsrc == NULL) {
4446 sctp_handle_no_route(stcb, net, so_locked);
4447 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4448 sctp_m_freem(m);
4449 return (EHOSTUNREACH);
4450 }
4451 lsa6->sin6_addr = _lsrc->address.sin6.sin6_addr;
4452 sctp_free_ifa(_lsrc);
4453 } else {
4454 lsa6->sin6_addr = over_addr->sin6.sin6_addr;
4455 SCTP_RTALLOC(ro, vrf_id, inp->fibnum);
4456 }
4457 (void)sa6_recoverscope(sin6);
4458 }
4459 lsa6->sin6_port = inp->sctp_lport;
4460
4461 if (ro->ro_rt == NULL) {
4462 /*
4463 * src addr selection failed to find a route
4464 * (or valid source addr), so we can't get
4465 * there from here!
4466 */
4467 sctp_handle_no_route(stcb, net, so_locked);
4468 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4469 sctp_m_freem(m);
4470 return (EHOSTUNREACH);
4471 }
4472 /*
4473 * XXX: sa6 may not have a valid sin6_scope_id in
4474 * the non-SCOPEDROUTING case.
4475 */
4476 memset(&lsa6_storage, 0, sizeof(lsa6_storage));
4477 lsa6_storage.sin6_family = AF_INET6;
4478 lsa6_storage.sin6_len = sizeof(lsa6_storage);
4479 lsa6_storage.sin6_addr = lsa6->sin6_addr;
4480 if ((error = sa6_recoverscope(&lsa6_storage)) != 0) {
4481 SCTPDBG(SCTP_DEBUG_OUTPUT3, "recover scope fails error %d\n", error);
4482 sctp_m_freem(m);
4483 return (error);
4484 }
4485 /* XXX */
4486 lsa6_storage.sin6_addr = lsa6->sin6_addr;
4487 lsa6_storage.sin6_port = inp->sctp_lport;
4488 lsa6 = &lsa6_storage;
4489 ip6h->ip6_src = lsa6->sin6_addr;
4490
4491 if (port) {
4492 if (htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port)) == 0) {
4493 sctp_handle_no_route(stcb, net, so_locked);
4494 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EHOSTUNREACH);
4495 sctp_m_freem(m);
4496 return (EHOSTUNREACH);
4497 }
4498 udp = (struct udphdr *)((caddr_t)ip6h + sizeof(struct ip6_hdr));
4499 udp->uh_sport = htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port));
4500 udp->uh_dport = port;
4501 udp->uh_ulen = htons((uint16_t)(packet_length - sizeof(struct ip6_hdr)));
4502 udp->uh_sum = 0;
4503 sctphdr = (struct sctphdr *)((caddr_t)udp + sizeof(struct udphdr));
4504 } else {
4505 sctphdr = (struct sctphdr *)((caddr_t)ip6h + sizeof(struct ip6_hdr));
4506 }
4507
4508 sctphdr->src_port = src_port;
4509 sctphdr->dest_port = dest_port;
4510 sctphdr->v_tag = v_tag;
4511 sctphdr->checksum = 0;
4512
4513 /*
4514 * We set the hop limit now since there is a good
4515 * chance that our ro pointer is now filled
4516 */
4517 ip6h->ip6_hlim = SCTP_GET_HLIM(inp, ro);
4518 ifp = SCTP_GET_IFN_VOID_FROM_ROUTE(ro);
4519
4520 #ifdef SCTP_DEBUG
4521 /* Copy to be sure something bad is not happening */
4522 sin6->sin6_addr = ip6h->ip6_dst;
4523 lsa6->sin6_addr = ip6h->ip6_src;
4524 #endif
4525
4526 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Calling ipv6 output routine from low level\n");
4527 SCTPDBG(SCTP_DEBUG_OUTPUT3, "src: ");
4528 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT3, (struct sockaddr *)lsa6);
4529 SCTPDBG(SCTP_DEBUG_OUTPUT3, "dst: ");
4530 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT3, (struct sockaddr *)sin6);
4531 if (net) {
4532 sin6 = (struct sockaddr_in6 *)&net->ro._l_addr;
4533 /*
4534 * preserve the port and scope for link
4535 * local send
4536 */
4537 prev_scope = sin6->sin6_scope_id;
4538 prev_port = sin6->sin6_port;
4539 }
4540
4541 if (SCTP_GET_HEADER_FOR_OUTPUT(o_pak)) {
4542 /* failed to prepend data, give up */
4543 sctp_m_freem(m);
4544 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
4545 return (ENOMEM);
4546 }
4547 SCTP_ATTACH_CHAIN(o_pak, m, packet_length);
4548 if (port) {
4549 sctphdr->checksum = sctp_calculate_cksum(m, sizeof(struct ip6_hdr) + sizeof(struct udphdr));
4550 SCTP_STAT_INCR(sctps_sendswcrc);
4551 if ((udp->uh_sum = in6_cksum(o_pak, IPPROTO_UDP, sizeof(struct ip6_hdr), packet_length - sizeof(struct ip6_hdr))) == 0) {
4552 udp->uh_sum = 0xffff;
4553 }
4554 } else {
4555 m->m_pkthdr.csum_flags = CSUM_SCTP_IPV6;
4556 m->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
4557 SCTP_STAT_INCR(sctps_sendhwcrc);
4558 }
4559 /* send it out. table id is taken from stcb */
4560 #ifdef SCTP_PACKET_LOGGING
4561 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING)
4562 sctp_packet_log(o_pak);
4563 #endif
4564 SCTP_PROBE5(send, NULL, stcb, ip6h, stcb, sctphdr);
4565 SCTP_IP6_OUTPUT(ret, o_pak, (struct route_in6 *)ro, &ifp, stcb, vrf_id);
4566 if (net) {
4567 /* for link local this must be done */
4568 sin6->sin6_scope_id = prev_scope;
4569 sin6->sin6_port = prev_port;
4570 }
4571 SCTPDBG(SCTP_DEBUG_OUTPUT3, "return from send is %d\n", ret);
4572 if (port) {
4573 UDPSTAT_INC(udps_opackets);
4574 }
4575 SCTP_STAT_INCR(sctps_sendpackets);
4576 SCTP_STAT_INCR_COUNTER64(sctps_outpackets);
4577 if (ret) {
4578 SCTP_STAT_INCR(sctps_senderrors);
4579 }
4580 if (net == NULL) {
4581 /* Now if we had a temp route free it */
4582 RO_RTFREE(ro);
4583 } else {
4584 /*
4585 * PMTU check versus smallest asoc MTU goes
4586 * here
4587 */
4588 if (ro->ro_rt == NULL) {
4589 /* Route was freed */
4590 if (net->ro._s_addr &&
4591 net->src_addr_selected) {
4592 sctp_free_ifa(net->ro._s_addr);
4593 net->ro._s_addr = NULL;
4594 }
4595 net->src_addr_selected = 0;
4596 }
4597 if ((ro->ro_rt != NULL) && (net->ro._s_addr) &&
4598 ((net->dest_state & SCTP_ADDR_NO_PMTUD) == 0)) {
4599 uint32_t mtu;
4600
4601 mtu = SCTP_GATHER_MTU_FROM_ROUTE(net->ro._s_addr, &net->ro._l_addr.sa, ro->ro_rt);
4602 if (mtu > 0) {
4603 if (net->port) {
4604 mtu -= sizeof(struct udphdr);
4605 }
4606 if (mtu < net->mtu) {
4607 if ((stcb != NULL) && (stcb->asoc.smallest_mtu > mtu)) {
4608 sctp_mtu_size_reset(inp, &stcb->asoc, mtu);
4609 }
4610 net->mtu = mtu;
4611 }
4612 }
4613 } else if (ifp) {
4614 if (ND_IFINFO(ifp)->linkmtu &&
4615 (stcb->asoc.smallest_mtu > ND_IFINFO(ifp)->linkmtu)) {
4616 sctp_mtu_size_reset(inp,
4617 &stcb->asoc,
4618 ND_IFINFO(ifp)->linkmtu);
4619 }
4620 }
4621 }
4622 return (ret);
4623 }
4624 #endif
4625 default:
4626 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Unknown protocol (TSNH) type %d\n",
4627 ((struct sockaddr *)to)->sa_family);
4628 sctp_m_freem(m);
4629 SCTP_LTRACE_ERR_RET_PKT(m, inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EFAULT);
4630 return (EFAULT);
4631 }
4632 }
4633
4634
4635 void
sctp_send_initiate(struct sctp_inpcb * inp,struct sctp_tcb * stcb,int so_locked)4636 sctp_send_initiate(struct sctp_inpcb *inp, struct sctp_tcb *stcb, int so_locked)
4637 {
4638 struct mbuf *m, *m_last;
4639 struct sctp_nets *net;
4640 struct sctp_init_chunk *init;
4641 struct sctp_supported_addr_param *sup_addr;
4642 struct sctp_adaptation_layer_indication *ali;
4643 struct sctp_supported_chunk_types_param *pr_supported;
4644 struct sctp_paramhdr *ph;
4645 int cnt_inits_to = 0;
4646 int error;
4647 uint16_t num_ext, chunk_len, padding_len, parameter_len;
4648
4649 /* INIT's always go to the primary (and usually ONLY address) */
4650 net = stcb->asoc.primary_destination;
4651 if (net == NULL) {
4652 net = TAILQ_FIRST(&stcb->asoc.nets);
4653 if (net == NULL) {
4654 /* TSNH */
4655 return;
4656 }
4657 /* we confirm any address we send an INIT to */
4658 net->dest_state &= ~SCTP_ADDR_UNCONFIRMED;
4659 (void)sctp_set_primary_addr(stcb, NULL, net);
4660 } else {
4661 /* we confirm any address we send an INIT to */
4662 net->dest_state &= ~SCTP_ADDR_UNCONFIRMED;
4663 }
4664 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT\n");
4665 #ifdef INET6
4666 if (net->ro._l_addr.sa.sa_family == AF_INET6) {
4667 /*
4668 * special hook, if we are sending to link local it will not
4669 * show up in our private address count.
4670 */
4671 if (IN6_IS_ADDR_LINKLOCAL(&net->ro._l_addr.sin6.sin6_addr))
4672 cnt_inits_to = 1;
4673 }
4674 #endif
4675 if (SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
4676 /* This case should not happen */
4677 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT - failed timer?\n");
4678 return;
4679 }
4680 /* start the INIT timer */
4681 sctp_timer_start(SCTP_TIMER_TYPE_INIT, inp, stcb, net);
4682
4683 m = sctp_get_mbuf_for_msg(MCLBYTES, 1, M_NOWAIT, 1, MT_DATA);
4684 if (m == NULL) {
4685 /* No memory, INIT timer will re-attempt. */
4686 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT - mbuf?\n");
4687 return;
4688 }
4689 chunk_len = (uint16_t)sizeof(struct sctp_init_chunk);
4690 padding_len = 0;
4691 /* Now lets put the chunk header in place */
4692 init = mtod(m, struct sctp_init_chunk *);
4693 /* now the chunk header */
4694 init->ch.chunk_type = SCTP_INITIATION;
4695 init->ch.chunk_flags = 0;
4696 /* fill in later from mbuf we build */
4697 init->ch.chunk_length = 0;
4698 /* place in my tag */
4699 init->init.initiate_tag = htonl(stcb->asoc.my_vtag);
4700 /* set up some of the credits. */
4701 init->init.a_rwnd = htonl(max(inp->sctp_socket ? SCTP_SB_LIMIT_RCV(inp->sctp_socket) : 0,
4702 SCTP_MINIMAL_RWND));
4703 init->init.num_outbound_streams = htons(stcb->asoc.pre_open_streams);
4704 init->init.num_inbound_streams = htons(stcb->asoc.max_inbound_streams);
4705 init->init.initial_tsn = htonl(stcb->asoc.init_seq_number);
4706
4707 /* Adaptation layer indication parameter */
4708 if (inp->sctp_ep.adaptation_layer_indicator_provided) {
4709 parameter_len = (uint16_t)sizeof(struct sctp_adaptation_layer_indication);
4710 ali = (struct sctp_adaptation_layer_indication *)(mtod(m, caddr_t)+chunk_len);
4711 ali->ph.param_type = htons(SCTP_ULP_ADAPTATION);
4712 ali->ph.param_length = htons(parameter_len);
4713 ali->indication = htonl(inp->sctp_ep.adaptation_layer_indicator);
4714 chunk_len += parameter_len;
4715 }
4716
4717 /* ECN parameter */
4718 if (stcb->asoc.ecn_supported == 1) {
4719 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4720 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
4721 ph->param_type = htons(SCTP_ECN_CAPABLE);
4722 ph->param_length = htons(parameter_len);
4723 chunk_len += parameter_len;
4724 }
4725
4726 /* PR-SCTP supported parameter */
4727 if (stcb->asoc.prsctp_supported == 1) {
4728 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4729 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
4730 ph->param_type = htons(SCTP_PRSCTP_SUPPORTED);
4731 ph->param_length = htons(parameter_len);
4732 chunk_len += parameter_len;
4733 }
4734
4735 /* Add NAT friendly parameter. */
4736 if (SCTP_BASE_SYSCTL(sctp_inits_include_nat_friendly)) {
4737 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4738 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
4739 ph->param_type = htons(SCTP_HAS_NAT_SUPPORT);
4740 ph->param_length = htons(parameter_len);
4741 chunk_len += parameter_len;
4742 }
4743
4744 /* And now tell the peer which extensions we support */
4745 num_ext = 0;
4746 pr_supported = (struct sctp_supported_chunk_types_param *)(mtod(m, caddr_t)+chunk_len);
4747 if (stcb->asoc.prsctp_supported == 1) {
4748 pr_supported->chunk_types[num_ext++] = SCTP_FORWARD_CUM_TSN;
4749 if (stcb->asoc.idata_supported) {
4750 pr_supported->chunk_types[num_ext++] = SCTP_IFORWARD_CUM_TSN;
4751 }
4752 }
4753 if (stcb->asoc.auth_supported == 1) {
4754 pr_supported->chunk_types[num_ext++] = SCTP_AUTHENTICATION;
4755 }
4756 if (stcb->asoc.asconf_supported == 1) {
4757 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF;
4758 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF_ACK;
4759 }
4760 if (stcb->asoc.reconfig_supported == 1) {
4761 pr_supported->chunk_types[num_ext++] = SCTP_STREAM_RESET;
4762 }
4763 if (stcb->asoc.idata_supported) {
4764 pr_supported->chunk_types[num_ext++] = SCTP_IDATA;
4765 }
4766 if (stcb->asoc.nrsack_supported == 1) {
4767 pr_supported->chunk_types[num_ext++] = SCTP_NR_SELECTIVE_ACK;
4768 }
4769 if (stcb->asoc.pktdrop_supported == 1) {
4770 pr_supported->chunk_types[num_ext++] = SCTP_PACKET_DROPPED;
4771 }
4772 if (num_ext > 0) {
4773 parameter_len = (uint16_t)sizeof(struct sctp_supported_chunk_types_param) + num_ext;
4774 pr_supported->ph.param_type = htons(SCTP_SUPPORTED_CHUNK_EXT);
4775 pr_supported->ph.param_length = htons(parameter_len);
4776 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4777 chunk_len += parameter_len;
4778 }
4779 /* add authentication parameters */
4780 if (stcb->asoc.auth_supported) {
4781 /* attach RANDOM parameter, if available */
4782 if (stcb->asoc.authinfo.random != NULL) {
4783 struct sctp_auth_random *randp;
4784
4785 if (padding_len > 0) {
4786 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4787 chunk_len += padding_len;
4788 padding_len = 0;
4789 }
4790 randp = (struct sctp_auth_random *)(mtod(m, caddr_t)+chunk_len);
4791 parameter_len = (uint16_t)sizeof(struct sctp_auth_random) + stcb->asoc.authinfo.random_len;
4792 /* random key already contains the header */
4793 memcpy(randp, stcb->asoc.authinfo.random->key, parameter_len);
4794 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4795 chunk_len += parameter_len;
4796 }
4797 /* add HMAC_ALGO parameter */
4798 if (stcb->asoc.local_hmacs != NULL) {
4799 struct sctp_auth_hmac_algo *hmacs;
4800
4801 if (padding_len > 0) {
4802 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4803 chunk_len += padding_len;
4804 padding_len = 0;
4805 }
4806 hmacs = (struct sctp_auth_hmac_algo *)(mtod(m, caddr_t)+chunk_len);
4807 parameter_len = (uint16_t)(sizeof(struct sctp_auth_hmac_algo) +
4808 stcb->asoc.local_hmacs->num_algo * sizeof(uint16_t));
4809 hmacs->ph.param_type = htons(SCTP_HMAC_LIST);
4810 hmacs->ph.param_length = htons(parameter_len);
4811 sctp_serialize_hmaclist(stcb->asoc.local_hmacs, (uint8_t *)hmacs->hmac_ids);
4812 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4813 chunk_len += parameter_len;
4814 }
4815 /* add CHUNKS parameter */
4816 if (stcb->asoc.local_auth_chunks != NULL) {
4817 struct sctp_auth_chunk_list *chunks;
4818
4819 if (padding_len > 0) {
4820 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4821 chunk_len += padding_len;
4822 padding_len = 0;
4823 }
4824 chunks = (struct sctp_auth_chunk_list *)(mtod(m, caddr_t)+chunk_len);
4825 parameter_len = (uint16_t)(sizeof(struct sctp_auth_chunk_list) +
4826 sctp_auth_get_chklist_size(stcb->asoc.local_auth_chunks));
4827 chunks->ph.param_type = htons(SCTP_CHUNK_LIST);
4828 chunks->ph.param_length = htons(parameter_len);
4829 sctp_serialize_auth_chunks(stcb->asoc.local_auth_chunks, chunks->chunk_types);
4830 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
4831 chunk_len += parameter_len;
4832 }
4833 }
4834
4835 /* now any cookie time extensions */
4836 if (stcb->asoc.cookie_preserve_req > 0) {
4837 struct sctp_cookie_perserve_param *cookie_preserve;
4838
4839 if (padding_len > 0) {
4840 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4841 chunk_len += padding_len;
4842 padding_len = 0;
4843 }
4844 parameter_len = (uint16_t)sizeof(struct sctp_cookie_perserve_param);
4845 cookie_preserve = (struct sctp_cookie_perserve_param *)(mtod(m, caddr_t)+chunk_len);
4846 cookie_preserve->ph.param_type = htons(SCTP_COOKIE_PRESERVE);
4847 cookie_preserve->ph.param_length = htons(parameter_len);
4848 cookie_preserve->time = htonl(stcb->asoc.cookie_preserve_req);
4849 stcb->asoc.cookie_preserve_req = 0;
4850 chunk_len += parameter_len;
4851 }
4852
4853 if (stcb->asoc.scope.ipv4_addr_legal || stcb->asoc.scope.ipv6_addr_legal) {
4854 uint8_t i;
4855
4856 if (padding_len > 0) {
4857 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
4858 chunk_len += padding_len;
4859 padding_len = 0;
4860 }
4861 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
4862 if (stcb->asoc.scope.ipv4_addr_legal) {
4863 parameter_len += (uint16_t)sizeof(uint16_t);
4864 }
4865 if (stcb->asoc.scope.ipv6_addr_legal) {
4866 parameter_len += (uint16_t)sizeof(uint16_t);
4867 }
4868 sup_addr = (struct sctp_supported_addr_param *)(mtod(m, caddr_t)+chunk_len);
4869 sup_addr->ph.param_type = htons(SCTP_SUPPORTED_ADDRTYPE);
4870 sup_addr->ph.param_length = htons(parameter_len);
4871 i = 0;
4872 if (stcb->asoc.scope.ipv4_addr_legal) {
4873 sup_addr->addr_type[i++] = htons(SCTP_IPV4_ADDRESS);
4874 }
4875 if (stcb->asoc.scope.ipv6_addr_legal) {
4876 sup_addr->addr_type[i++] = htons(SCTP_IPV6_ADDRESS);
4877 }
4878 padding_len = 4 - 2 * i;
4879 chunk_len += parameter_len;
4880 }
4881
4882 SCTP_BUF_LEN(m) = chunk_len;
4883 /* now the addresses */
4884 /*
4885 * To optimize this we could put the scoping stuff into a structure
4886 * and remove the individual uint8's from the assoc structure. Then
4887 * we could just sifa in the address within the stcb. But for now
4888 * this is a quick hack to get the address stuff teased apart.
4889 */
4890 m_last = sctp_add_addresses_to_i_ia(inp, stcb, &stcb->asoc.scope,
4891 m, cnt_inits_to,
4892 &padding_len, &chunk_len);
4893
4894 init->ch.chunk_length = htons(chunk_len);
4895 if (padding_len > 0) {
4896 if (sctp_add_pad_tombuf(m_last, padding_len) == NULL) {
4897 sctp_m_freem(m);
4898 return;
4899 }
4900 }
4901 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Sending INIT - calls lowlevel_output\n");
4902 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
4903 (struct sockaddr *)&net->ro._l_addr,
4904 m, 0, NULL, 0, 0, 0, 0,
4905 inp->sctp_lport, stcb->rport, htonl(0),
4906 net->port, NULL,
4907 0, 0,
4908 so_locked))) {
4909 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Gak send error %d\n", error);
4910 if (error == ENOBUFS) {
4911 stcb->asoc.ifp_had_enobuf = 1;
4912 SCTP_STAT_INCR(sctps_lowlevelerr);
4913 }
4914 } else {
4915 stcb->asoc.ifp_had_enobuf = 0;
4916 }
4917 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
4918 (void)SCTP_GETTIME_TIMEVAL(&net->last_sent_time);
4919 }
4920
4921 struct mbuf *
sctp_arethere_unrecognized_parameters(struct mbuf * in_initpkt,int param_offset,int * abort_processing,struct sctp_chunkhdr * cp,int * nat_friendly,int * cookie_found)4922 sctp_arethere_unrecognized_parameters(struct mbuf *in_initpkt,
4923 int param_offset, int *abort_processing,
4924 struct sctp_chunkhdr *cp,
4925 int *nat_friendly,
4926 int *cookie_found)
4927 {
4928 /*
4929 * Given a mbuf containing an INIT or INIT-ACK with the param_offset
4930 * being equal to the beginning of the params i.e. (iphlen +
4931 * sizeof(struct sctp_init_msg) parse through the parameters to the
4932 * end of the mbuf verifying that all parameters are known.
4933 *
4934 * For unknown parameters build and return a mbuf with
4935 * UNRECOGNIZED_PARAMETER errors. If the flags indicate to stop
4936 * processing this chunk stop, and set *abort_processing to 1.
4937 *
4938 * By having param_offset be pre-set to where parameters begin it is
4939 * hoped that this routine may be reused in the future by new
4940 * features.
4941 */
4942 struct sctp_paramhdr *phdr, params;
4943
4944 struct mbuf *mat, *m_tmp, *op_err, *op_err_last;
4945 int at, limit, pad_needed;
4946 uint16_t ptype, plen, padded_size;
4947
4948 *abort_processing = 0;
4949 if (cookie_found != NULL) {
4950 *cookie_found = 0;
4951 }
4952 mat = in_initpkt;
4953 limit = ntohs(cp->chunk_length) - sizeof(struct sctp_init_chunk);
4954 at = param_offset;
4955 op_err = NULL;
4956 op_err_last = NULL;
4957 pad_needed = 0;
4958 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Check for unrecognized param's\n");
4959 phdr = sctp_get_next_param(mat, at, ¶ms, sizeof(params));
4960 while ((phdr != NULL) && ((size_t)limit >= sizeof(struct sctp_paramhdr))) {
4961 ptype = ntohs(phdr->param_type);
4962 plen = ntohs(phdr->param_length);
4963 if ((plen > limit) || (plen < sizeof(struct sctp_paramhdr))) {
4964 /* wacked parameter */
4965 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error %d\n", plen);
4966 goto invalid_size;
4967 }
4968 limit -= SCTP_SIZE32(plen);
4969 /*-
4970 * All parameters for all chunks that we know/understand are
4971 * listed here. We process them other places and make
4972 * appropriate stop actions per the upper bits. However this
4973 * is the generic routine processor's can call to get back
4974 * an operr.. to either incorporate (init-ack) or send.
4975 */
4976 padded_size = SCTP_SIZE32(plen);
4977 switch (ptype) {
4978 /* Param's with variable size */
4979 case SCTP_HEARTBEAT_INFO:
4980 case SCTP_UNRECOG_PARAM:
4981 case SCTP_ERROR_CAUSE_IND:
4982 /* ok skip fwd */
4983 at += padded_size;
4984 break;
4985 case SCTP_STATE_COOKIE:
4986 if (cookie_found != NULL) {
4987 *cookie_found = 1;
4988 }
4989 at += padded_size;
4990 break;
4991 /* Param's with variable size within a range */
4992 case SCTP_CHUNK_LIST:
4993 case SCTP_SUPPORTED_CHUNK_EXT:
4994 if (padded_size > (sizeof(struct sctp_supported_chunk_types_param) + (sizeof(uint8_t) * SCTP_MAX_SUPPORTED_EXT))) {
4995 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error chklist %d\n", plen);
4996 goto invalid_size;
4997 }
4998 at += padded_size;
4999 break;
5000 case SCTP_SUPPORTED_ADDRTYPE:
5001 if (padded_size > SCTP_MAX_ADDR_PARAMS_SIZE) {
5002 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error supaddrtype %d\n", plen);
5003 goto invalid_size;
5004 }
5005 at += padded_size;
5006 break;
5007 case SCTP_RANDOM:
5008 if (padded_size > (sizeof(struct sctp_auth_random) + SCTP_RANDOM_MAX_SIZE)) {
5009 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error random %d\n", plen);
5010 goto invalid_size;
5011 }
5012 at += padded_size;
5013 break;
5014 case SCTP_SET_PRIM_ADDR:
5015 case SCTP_DEL_IP_ADDRESS:
5016 case SCTP_ADD_IP_ADDRESS:
5017 if ((padded_size != sizeof(struct sctp_asconf_addrv4_param)) &&
5018 (padded_size != sizeof(struct sctp_asconf_addr_param))) {
5019 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error setprim %d\n", plen);
5020 goto invalid_size;
5021 }
5022 at += padded_size;
5023 break;
5024 /* Param's with a fixed size */
5025 case SCTP_IPV4_ADDRESS:
5026 if (padded_size != sizeof(struct sctp_ipv4addr_param)) {
5027 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error ipv4 addr %d\n", plen);
5028 goto invalid_size;
5029 }
5030 at += padded_size;
5031 break;
5032 case SCTP_IPV6_ADDRESS:
5033 if (padded_size != sizeof(struct sctp_ipv6addr_param)) {
5034 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error ipv6 addr %d\n", plen);
5035 goto invalid_size;
5036 }
5037 at += padded_size;
5038 break;
5039 case SCTP_COOKIE_PRESERVE:
5040 if (padded_size != sizeof(struct sctp_cookie_perserve_param)) {
5041 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error cookie-preserve %d\n", plen);
5042 goto invalid_size;
5043 }
5044 at += padded_size;
5045 break;
5046 case SCTP_HAS_NAT_SUPPORT:
5047 *nat_friendly = 1;
5048 /* fall through */
5049 case SCTP_PRSCTP_SUPPORTED:
5050 if (padded_size != sizeof(struct sctp_paramhdr)) {
5051 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error prsctp/nat support %d\n", plen);
5052 goto invalid_size;
5053 }
5054 at += padded_size;
5055 break;
5056 case SCTP_ECN_CAPABLE:
5057 if (padded_size != sizeof(struct sctp_paramhdr)) {
5058 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error ecn %d\n", plen);
5059 goto invalid_size;
5060 }
5061 at += padded_size;
5062 break;
5063 case SCTP_ULP_ADAPTATION:
5064 if (padded_size != sizeof(struct sctp_adaptation_layer_indication)) {
5065 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error adapatation %d\n", plen);
5066 goto invalid_size;
5067 }
5068 at += padded_size;
5069 break;
5070 case SCTP_SUCCESS_REPORT:
5071 if (padded_size != sizeof(struct sctp_asconf_paramhdr)) {
5072 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Invalid size - error success %d\n", plen);
5073 goto invalid_size;
5074 }
5075 at += padded_size;
5076 break;
5077 case SCTP_HOSTNAME_ADDRESS:
5078 {
5079 /* Hostname parameters are deprecated. */
5080 struct sctp_gen_error_cause *cause;
5081 int l_len;
5082
5083 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Can't handle hostname addresses.. abort processing\n");
5084 *abort_processing = 1;
5085 sctp_m_freem(op_err);
5086 op_err = NULL;
5087 op_err_last = NULL;
5088 #ifdef INET6
5089 l_len = SCTP_MIN_OVERHEAD;
5090 #else
5091 l_len = SCTP_MIN_V4_OVERHEAD;
5092 #endif
5093 l_len += sizeof(struct sctp_chunkhdr);
5094 l_len += sizeof(struct sctp_gen_error_cause);
5095 op_err = sctp_get_mbuf_for_msg(l_len, 0, M_NOWAIT, 1, MT_DATA);
5096 if (op_err != NULL) {
5097 /*
5098 * Pre-reserve space for IP, SCTP,
5099 * and chunk header.
5100 */
5101 #ifdef INET6
5102 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip6_hdr));
5103 #else
5104 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip));
5105 #endif
5106 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctphdr));
5107 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctp_chunkhdr));
5108 SCTP_BUF_LEN(op_err) = sizeof(struct sctp_gen_error_cause);
5109 cause = mtod(op_err, struct sctp_gen_error_cause *);
5110 cause->code = htons(SCTP_CAUSE_UNRESOLVABLE_ADDR);
5111 cause->length = htons((uint16_t)(sizeof(struct sctp_gen_error_cause) + plen));
5112 SCTP_BUF_NEXT(op_err) = SCTP_M_COPYM(mat, at, plen, M_NOWAIT);
5113 if (SCTP_BUF_NEXT(op_err) == NULL) {
5114 sctp_m_freem(op_err);
5115 op_err = NULL;
5116 op_err_last = NULL;
5117 }
5118 }
5119 return (op_err);
5120 }
5121 default:
5122 /*
5123 * we do not recognize the parameter figure out what
5124 * we do.
5125 */
5126 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Hit default param %x\n", ptype);
5127 if ((ptype & 0x4000) == 0x4000) {
5128 /* Report bit is set?? */
5129 SCTPDBG(SCTP_DEBUG_OUTPUT1, "report op err\n");
5130 if (op_err == NULL) {
5131 int l_len;
5132
5133 /* Ok need to try to get an mbuf */
5134 #ifdef INET6
5135 l_len = SCTP_MIN_OVERHEAD;
5136 #else
5137 l_len = SCTP_MIN_V4_OVERHEAD;
5138 #endif
5139 l_len += sizeof(struct sctp_chunkhdr);
5140 l_len += sizeof(struct sctp_paramhdr);
5141 op_err = sctp_get_mbuf_for_msg(l_len, 0, M_NOWAIT, 1, MT_DATA);
5142 if (op_err) {
5143 SCTP_BUF_LEN(op_err) = 0;
5144 #ifdef INET6
5145 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip6_hdr));
5146 #else
5147 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip));
5148 #endif
5149 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctphdr));
5150 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctp_chunkhdr));
5151 op_err_last = op_err;
5152 }
5153 }
5154 if (op_err != NULL) {
5155 /* If we have space */
5156 struct sctp_paramhdr *param;
5157
5158 if (pad_needed > 0) {
5159 op_err_last = sctp_add_pad_tombuf(op_err_last, pad_needed);
5160 }
5161 if (op_err_last == NULL) {
5162 sctp_m_freem(op_err);
5163 op_err = NULL;
5164 op_err_last = NULL;
5165 goto more_processing;
5166 }
5167 if (M_TRAILINGSPACE(op_err_last) < (int)sizeof(struct sctp_paramhdr)) {
5168 m_tmp = sctp_get_mbuf_for_msg(sizeof(struct sctp_paramhdr), 0, M_NOWAIT, 1, MT_DATA);
5169 if (m_tmp == NULL) {
5170 sctp_m_freem(op_err);
5171 op_err = NULL;
5172 op_err_last = NULL;
5173 goto more_processing;
5174 }
5175 SCTP_BUF_LEN(m_tmp) = 0;
5176 SCTP_BUF_NEXT(m_tmp) = NULL;
5177 SCTP_BUF_NEXT(op_err_last) = m_tmp;
5178 op_err_last = m_tmp;
5179 }
5180 param = (struct sctp_paramhdr *)(mtod(op_err_last, caddr_t)+SCTP_BUF_LEN(op_err_last));
5181 param->param_type = htons(SCTP_UNRECOG_PARAM);
5182 param->param_length = htons((uint16_t)sizeof(struct sctp_paramhdr) + plen);
5183 SCTP_BUF_LEN(op_err_last) += sizeof(struct sctp_paramhdr);
5184 SCTP_BUF_NEXT(op_err_last) = SCTP_M_COPYM(mat, at, plen, M_NOWAIT);
5185 if (SCTP_BUF_NEXT(op_err_last) == NULL) {
5186 sctp_m_freem(op_err);
5187 op_err = NULL;
5188 op_err_last = NULL;
5189 goto more_processing;
5190 } else {
5191 while (SCTP_BUF_NEXT(op_err_last) != NULL) {
5192 op_err_last = SCTP_BUF_NEXT(op_err_last);
5193 }
5194 }
5195 if (plen % 4 != 0) {
5196 pad_needed = 4 - (plen % 4);
5197 } else {
5198 pad_needed = 0;
5199 }
5200 }
5201 }
5202 more_processing:
5203 if ((ptype & 0x8000) == 0x0000) {
5204 SCTPDBG(SCTP_DEBUG_OUTPUT1, "stop proc\n");
5205 return (op_err);
5206 } else {
5207 /* skip this chunk and continue processing */
5208 SCTPDBG(SCTP_DEBUG_OUTPUT1, "move on\n");
5209 at += SCTP_SIZE32(plen);
5210 }
5211 break;
5212
5213 }
5214 phdr = sctp_get_next_param(mat, at, ¶ms, sizeof(params));
5215 }
5216 return (op_err);
5217 invalid_size:
5218 SCTPDBG(SCTP_DEBUG_OUTPUT1, "abort flag set\n");
5219 *abort_processing = 1;
5220 sctp_m_freem(op_err);
5221 op_err = NULL;
5222 op_err_last = NULL;
5223 if (phdr != NULL) {
5224 struct sctp_paramhdr *param;
5225 int l_len;
5226 #ifdef INET6
5227 l_len = SCTP_MIN_OVERHEAD;
5228 #else
5229 l_len = SCTP_MIN_V4_OVERHEAD;
5230 #endif
5231 l_len += sizeof(struct sctp_chunkhdr);
5232 l_len += (2 * sizeof(struct sctp_paramhdr));
5233 op_err = sctp_get_mbuf_for_msg(l_len, 0, M_NOWAIT, 1, MT_DATA);
5234 if (op_err) {
5235 SCTP_BUF_LEN(op_err) = 0;
5236 #ifdef INET6
5237 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip6_hdr));
5238 #else
5239 SCTP_BUF_RESV_UF(op_err, sizeof(struct ip));
5240 #endif
5241 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctphdr));
5242 SCTP_BUF_RESV_UF(op_err, sizeof(struct sctp_chunkhdr));
5243 SCTP_BUF_LEN(op_err) = 2 * sizeof(struct sctp_paramhdr);
5244 param = mtod(op_err, struct sctp_paramhdr *);
5245 param->param_type = htons(SCTP_CAUSE_PROTOCOL_VIOLATION);
5246 param->param_length = htons(2 * sizeof(struct sctp_paramhdr));
5247 param++;
5248 param->param_type = htons(ptype);
5249 param->param_length = htons(plen);
5250 }
5251 }
5252 return (op_err);
5253 }
5254
5255 static int
sctp_are_there_new_addresses(struct sctp_association * asoc,struct mbuf * in_initpkt,int offset,struct sockaddr * src)5256 sctp_are_there_new_addresses(struct sctp_association *asoc,
5257 struct mbuf *in_initpkt, int offset, struct sockaddr *src)
5258 {
5259 /*
5260 * Given a INIT packet, look through the packet to verify that there
5261 * are NO new addresses. As we go through the parameters add reports
5262 * of any un-understood parameters that require an error. Also we
5263 * must return (1) to drop the packet if we see a un-understood
5264 * parameter that tells us to drop the chunk.
5265 */
5266 struct sockaddr *sa_touse;
5267 struct sockaddr *sa;
5268 struct sctp_paramhdr *phdr, params;
5269 uint16_t ptype, plen;
5270 uint8_t fnd;
5271 struct sctp_nets *net;
5272 int check_src;
5273 #ifdef INET
5274 struct sockaddr_in sin4, *sa4;
5275 #endif
5276 #ifdef INET6
5277 struct sockaddr_in6 sin6, *sa6;
5278 #endif
5279
5280 #ifdef INET
5281 memset(&sin4, 0, sizeof(sin4));
5282 sin4.sin_family = AF_INET;
5283 sin4.sin_len = sizeof(sin4);
5284 #endif
5285 #ifdef INET6
5286 memset(&sin6, 0, sizeof(sin6));
5287 sin6.sin6_family = AF_INET6;
5288 sin6.sin6_len = sizeof(sin6);
5289 #endif
5290 /* First what about the src address of the pkt ? */
5291 check_src = 0;
5292 switch (src->sa_family) {
5293 #ifdef INET
5294 case AF_INET:
5295 if (asoc->scope.ipv4_addr_legal) {
5296 check_src = 1;
5297 }
5298 break;
5299 #endif
5300 #ifdef INET6
5301 case AF_INET6:
5302 if (asoc->scope.ipv6_addr_legal) {
5303 check_src = 1;
5304 }
5305 break;
5306 #endif
5307 default:
5308 /* TSNH */
5309 break;
5310 }
5311 if (check_src) {
5312 fnd = 0;
5313 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5314 sa = (struct sockaddr *)&net->ro._l_addr;
5315 if (sa->sa_family == src->sa_family) {
5316 #ifdef INET
5317 if (sa->sa_family == AF_INET) {
5318 struct sockaddr_in *src4;
5319
5320 sa4 = (struct sockaddr_in *)sa;
5321 src4 = (struct sockaddr_in *)src;
5322 if (sa4->sin_addr.s_addr == src4->sin_addr.s_addr) {
5323 fnd = 1;
5324 break;
5325 }
5326 }
5327 #endif
5328 #ifdef INET6
5329 if (sa->sa_family == AF_INET6) {
5330 struct sockaddr_in6 *src6;
5331
5332 sa6 = (struct sockaddr_in6 *)sa;
5333 src6 = (struct sockaddr_in6 *)src;
5334 if (SCTP6_ARE_ADDR_EQUAL(sa6, src6)) {
5335 fnd = 1;
5336 break;
5337 }
5338 }
5339 #endif
5340 }
5341 }
5342 if (fnd == 0) {
5343 /* New address added! no need to look further. */
5344 return (1);
5345 }
5346 }
5347 /* Ok so far lets munge through the rest of the packet */
5348 offset += sizeof(struct sctp_init_chunk);
5349 phdr = sctp_get_next_param(in_initpkt, offset, ¶ms, sizeof(params));
5350 while (phdr) {
5351 sa_touse = NULL;
5352 ptype = ntohs(phdr->param_type);
5353 plen = ntohs(phdr->param_length);
5354 switch (ptype) {
5355 #ifdef INET
5356 case SCTP_IPV4_ADDRESS:
5357 {
5358 struct sctp_ipv4addr_param *p4, p4_buf;
5359
5360 if (plen != sizeof(struct sctp_ipv4addr_param)) {
5361 return (1);
5362 }
5363 phdr = sctp_get_next_param(in_initpkt, offset,
5364 (struct sctp_paramhdr *)&p4_buf, sizeof(p4_buf));
5365 if (phdr == NULL) {
5366 return (1);
5367 }
5368 if (asoc->scope.ipv4_addr_legal) {
5369 p4 = (struct sctp_ipv4addr_param *)phdr;
5370 sin4.sin_addr.s_addr = p4->addr;
5371 sa_touse = (struct sockaddr *)&sin4;
5372 }
5373 break;
5374 }
5375 #endif
5376 #ifdef INET6
5377 case SCTP_IPV6_ADDRESS:
5378 {
5379 struct sctp_ipv6addr_param *p6, p6_buf;
5380
5381 if (plen != sizeof(struct sctp_ipv6addr_param)) {
5382 return (1);
5383 }
5384 phdr = sctp_get_next_param(in_initpkt, offset,
5385 (struct sctp_paramhdr *)&p6_buf, sizeof(p6_buf));
5386 if (phdr == NULL) {
5387 return (1);
5388 }
5389 if (asoc->scope.ipv6_addr_legal) {
5390 p6 = (struct sctp_ipv6addr_param *)phdr;
5391 memcpy((caddr_t)&sin6.sin6_addr, p6->addr,
5392 sizeof(p6->addr));
5393 sa_touse = (struct sockaddr *)&sin6;
5394 }
5395 break;
5396 }
5397 #endif
5398 default:
5399 sa_touse = NULL;
5400 break;
5401 }
5402 if (sa_touse) {
5403 /* ok, sa_touse points to one to check */
5404 fnd = 0;
5405 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
5406 sa = (struct sockaddr *)&net->ro._l_addr;
5407 if (sa->sa_family != sa_touse->sa_family) {
5408 continue;
5409 }
5410 #ifdef INET
5411 if (sa->sa_family == AF_INET) {
5412 sa4 = (struct sockaddr_in *)sa;
5413 if (sa4->sin_addr.s_addr ==
5414 sin4.sin_addr.s_addr) {
5415 fnd = 1;
5416 break;
5417 }
5418 }
5419 #endif
5420 #ifdef INET6
5421 if (sa->sa_family == AF_INET6) {
5422 sa6 = (struct sockaddr_in6 *)sa;
5423 if (SCTP6_ARE_ADDR_EQUAL(
5424 sa6, &sin6)) {
5425 fnd = 1;
5426 break;
5427 }
5428 }
5429 #endif
5430 }
5431 if (!fnd) {
5432 /* New addr added! no need to look further */
5433 return (1);
5434 }
5435 }
5436 offset += SCTP_SIZE32(plen);
5437 phdr = sctp_get_next_param(in_initpkt, offset, ¶ms, sizeof(params));
5438 }
5439 return (0);
5440 }
5441
5442 /*
5443 * Given a MBUF chain that was sent into us containing an INIT. Build a
5444 * INIT-ACK with COOKIE and send back. We assume that the in_initpkt has done
5445 * a pullup to include IPv6/4header, SCTP header and initial part of INIT
5446 * message (i.e. the struct sctp_init_msg).
5447 */
5448 void
sctp_send_initiate_ack(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_nets * src_net,struct mbuf * init_pkt,int iphlen,int offset,struct sockaddr * src,struct sockaddr * dst,struct sctphdr * sh,struct sctp_init_chunk * init_chk,uint8_t mflowtype,uint32_t mflowid,uint32_t vrf_id,uint16_t port)5449 sctp_send_initiate_ack(struct sctp_inpcb *inp, struct sctp_tcb *stcb,
5450 struct sctp_nets *src_net, struct mbuf *init_pkt,
5451 int iphlen, int offset,
5452 struct sockaddr *src, struct sockaddr *dst,
5453 struct sctphdr *sh, struct sctp_init_chunk *init_chk,
5454 uint8_t mflowtype, uint32_t mflowid,
5455 uint32_t vrf_id, uint16_t port)
5456 {
5457 struct sctp_association *asoc;
5458 struct mbuf *m, *m_tmp, *m_last, *m_cookie, *op_err;
5459 struct sctp_init_ack_chunk *initack;
5460 struct sctp_adaptation_layer_indication *ali;
5461 struct sctp_supported_chunk_types_param *pr_supported;
5462 struct sctp_paramhdr *ph;
5463 union sctp_sockstore *over_addr;
5464 struct sctp_scoping scp;
5465 struct timeval now;
5466 #ifdef INET
5467 struct sockaddr_in *dst4 = (struct sockaddr_in *)dst;
5468 struct sockaddr_in *src4 = (struct sockaddr_in *)src;
5469 struct sockaddr_in *sin;
5470 #endif
5471 #ifdef INET6
5472 struct sockaddr_in6 *dst6 = (struct sockaddr_in6 *)dst;
5473 struct sockaddr_in6 *src6 = (struct sockaddr_in6 *)src;
5474 struct sockaddr_in6 *sin6;
5475 #endif
5476 struct sockaddr *to;
5477 struct sctp_state_cookie stc;
5478 struct sctp_nets *net = NULL;
5479 uint8_t *signature = NULL;
5480 int cnt_inits_to = 0;
5481 uint16_t his_limit, i_want;
5482 int abort_flag;
5483 int nat_friendly = 0;
5484 int error;
5485 struct socket *so;
5486 uint16_t num_ext, chunk_len, padding_len, parameter_len;
5487
5488 if (stcb) {
5489 asoc = &stcb->asoc;
5490 } else {
5491 asoc = NULL;
5492 }
5493 if ((asoc != NULL) &&
5494 (SCTP_GET_STATE(stcb) != SCTP_STATE_COOKIE_WAIT)) {
5495 if (sctp_are_there_new_addresses(asoc, init_pkt, offset, src)) {
5496 /*
5497 * new addresses, out of here in non-cookie-wait
5498 * states
5499 *
5500 * Send an ABORT, without the new address error
5501 * cause. This looks no different than if no
5502 * listener was present.
5503 */
5504 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
5505 "Address added");
5506 sctp_send_abort(init_pkt, iphlen, src, dst, sh, 0, op_err,
5507 mflowtype, mflowid, inp->fibnum,
5508 vrf_id, port);
5509 return;
5510 }
5511 if (src_net != NULL && (src_net->port != port)) {
5512 /*
5513 * change of remote encapsulation port, out of here
5514 * in non-cookie-wait states
5515 *
5516 * Send an ABORT, without an specific error cause.
5517 * This looks no different than if no listener was
5518 * present.
5519 */
5520 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
5521 "Remote encapsulation port changed");
5522 sctp_send_abort(init_pkt, iphlen, src, dst, sh, 0, op_err,
5523 mflowtype, mflowid, inp->fibnum,
5524 vrf_id, port);
5525 return;
5526 }
5527 }
5528 abort_flag = 0;
5529 op_err = sctp_arethere_unrecognized_parameters(init_pkt,
5530 (offset + sizeof(struct sctp_init_chunk)),
5531 &abort_flag,
5532 (struct sctp_chunkhdr *)init_chk,
5533 &nat_friendly, NULL);
5534 if (abort_flag) {
5535 do_a_abort:
5536 if (op_err == NULL) {
5537 char msg[SCTP_DIAG_INFO_LEN];
5538
5539 SCTP_SNPRINTF(msg, sizeof(msg), "%s:%d at %s", __FILE__, __LINE__, __func__);
5540 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
5541 msg);
5542 }
5543 sctp_send_abort(init_pkt, iphlen, src, dst, sh,
5544 init_chk->init.initiate_tag, op_err,
5545 mflowtype, mflowid, inp->fibnum,
5546 vrf_id, port);
5547 return;
5548 }
5549 m = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
5550 if (m == NULL) {
5551 /* No memory, INIT timer will re-attempt. */
5552 sctp_m_freem(op_err);
5553 return;
5554 }
5555 chunk_len = (uint16_t)sizeof(struct sctp_init_ack_chunk);
5556 padding_len = 0;
5557
5558 /*
5559 * We might not overwrite the identification[] completely and on
5560 * some platforms time_entered will contain some padding. Therefore
5561 * zero out the cookie to avoid putting uninitialized memory on the
5562 * wire.
5563 */
5564 memset(&stc, 0, sizeof(struct sctp_state_cookie));
5565
5566 /* the time I built cookie */
5567 (void)SCTP_GETTIME_TIMEVAL(&now);
5568 stc.time_entered.tv_sec = now.tv_sec;
5569 stc.time_entered.tv_usec = now.tv_usec;
5570
5571 /* populate any tie tags */
5572 if (asoc != NULL) {
5573 /* unlock before tag selections */
5574 stc.tie_tag_my_vtag = asoc->my_vtag_nonce;
5575 stc.tie_tag_peer_vtag = asoc->peer_vtag_nonce;
5576 stc.cookie_life = asoc->cookie_life;
5577 net = asoc->primary_destination;
5578 } else {
5579 stc.tie_tag_my_vtag = 0;
5580 stc.tie_tag_peer_vtag = 0;
5581 /* life I will award this cookie */
5582 stc.cookie_life = inp->sctp_ep.def_cookie_life;
5583 }
5584
5585 /* copy in the ports for later check */
5586 stc.myport = sh->dest_port;
5587 stc.peerport = sh->src_port;
5588
5589 /*
5590 * If we wanted to honor cookie life extensions, we would add to
5591 * stc.cookie_life. For now we should NOT honor any extension
5592 */
5593 stc.site_scope = stc.local_scope = stc.loopback_scope = 0;
5594 if (inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
5595 stc.ipv6_addr_legal = 1;
5596 if (SCTP_IPV6_V6ONLY(inp)) {
5597 stc.ipv4_addr_legal = 0;
5598 } else {
5599 stc.ipv4_addr_legal = 1;
5600 }
5601 } else {
5602 stc.ipv6_addr_legal = 0;
5603 stc.ipv4_addr_legal = 1;
5604 }
5605 stc.ipv4_scope = 0;
5606 if (net == NULL) {
5607 to = src;
5608 switch (dst->sa_family) {
5609 #ifdef INET
5610 case AF_INET:
5611 {
5612 /* lookup address */
5613 stc.address[0] = src4->sin_addr.s_addr;
5614 stc.address[1] = 0;
5615 stc.address[2] = 0;
5616 stc.address[3] = 0;
5617 stc.addr_type = SCTP_IPV4_ADDRESS;
5618 /* local from address */
5619 stc.laddress[0] = dst4->sin_addr.s_addr;
5620 stc.laddress[1] = 0;
5621 stc.laddress[2] = 0;
5622 stc.laddress[3] = 0;
5623 stc.laddr_type = SCTP_IPV4_ADDRESS;
5624 /* scope_id is only for v6 */
5625 stc.scope_id = 0;
5626 if ((IN4_ISPRIVATE_ADDRESS(&src4->sin_addr)) ||
5627 (IN4_ISPRIVATE_ADDRESS(&dst4->sin_addr))) {
5628 stc.ipv4_scope = 1;
5629 }
5630 /* Must use the address in this case */
5631 if (sctp_is_address_on_local_host(src, vrf_id)) {
5632 stc.loopback_scope = 1;
5633 stc.ipv4_scope = 1;
5634 stc.site_scope = 1;
5635 stc.local_scope = 0;
5636 }
5637 break;
5638 }
5639 #endif
5640 #ifdef INET6
5641 case AF_INET6:
5642 {
5643 stc.addr_type = SCTP_IPV6_ADDRESS;
5644 memcpy(&stc.address, &src6->sin6_addr, sizeof(struct in6_addr));
5645 stc.scope_id = ntohs(in6_getscope(&src6->sin6_addr));
5646 if (sctp_is_address_on_local_host(src, vrf_id)) {
5647 stc.loopback_scope = 1;
5648 stc.local_scope = 0;
5649 stc.site_scope = 1;
5650 stc.ipv4_scope = 1;
5651 } else if (IN6_IS_ADDR_LINKLOCAL(&src6->sin6_addr) ||
5652 IN6_IS_ADDR_LINKLOCAL(&dst6->sin6_addr)) {
5653 /*
5654 * If the new destination or source
5655 * is a LINK_LOCAL we must have
5656 * common both site and local scope.
5657 * Don't set local scope though
5658 * since we must depend on the
5659 * source to be added implicitly. We
5660 * cannot assure just because we
5661 * share one link that all links are
5662 * common.
5663 */
5664 stc.local_scope = 0;
5665 stc.site_scope = 1;
5666 stc.ipv4_scope = 1;
5667 /*
5668 * we start counting for the private
5669 * address stuff at 1. since the
5670 * link local we source from won't
5671 * show up in our scoped count.
5672 */
5673 cnt_inits_to = 1;
5674 /*
5675 * pull out the scope_id from
5676 * incoming pkt
5677 */
5678 } else if (IN6_IS_ADDR_SITELOCAL(&src6->sin6_addr) ||
5679 IN6_IS_ADDR_SITELOCAL(&dst6->sin6_addr)) {
5680 /*
5681 * If the new destination or source
5682 * is SITE_LOCAL then we must have
5683 * site scope in common.
5684 */
5685 stc.site_scope = 1;
5686 }
5687 memcpy(&stc.laddress, &dst6->sin6_addr, sizeof(struct in6_addr));
5688 stc.laddr_type = SCTP_IPV6_ADDRESS;
5689 break;
5690 }
5691 #endif
5692 default:
5693 /* TSNH */
5694 goto do_a_abort;
5695 break;
5696 }
5697 } else {
5698 /* set the scope per the existing tcb */
5699
5700 #ifdef INET6
5701 struct sctp_nets *lnet;
5702 #endif
5703
5704 stc.loopback_scope = asoc->scope.loopback_scope;
5705 stc.ipv4_scope = asoc->scope.ipv4_local_scope;
5706 stc.site_scope = asoc->scope.site_scope;
5707 stc.local_scope = asoc->scope.local_scope;
5708 #ifdef INET6
5709 /* Why do we not consider IPv4 LL addresses? */
5710 TAILQ_FOREACH(lnet, &asoc->nets, sctp_next) {
5711 if (lnet->ro._l_addr.sin6.sin6_family == AF_INET6) {
5712 if (IN6_IS_ADDR_LINKLOCAL(&lnet->ro._l_addr.sin6.sin6_addr)) {
5713 /*
5714 * if we have a LL address, start
5715 * counting at 1.
5716 */
5717 cnt_inits_to = 1;
5718 }
5719 }
5720 }
5721 #endif
5722 /* use the net pointer */
5723 to = (struct sockaddr *)&net->ro._l_addr;
5724 switch (to->sa_family) {
5725 #ifdef INET
5726 case AF_INET:
5727 sin = (struct sockaddr_in *)to;
5728 stc.address[0] = sin->sin_addr.s_addr;
5729 stc.address[1] = 0;
5730 stc.address[2] = 0;
5731 stc.address[3] = 0;
5732 stc.addr_type = SCTP_IPV4_ADDRESS;
5733 if (net->src_addr_selected == 0) {
5734 /*
5735 * strange case here, the INIT should have
5736 * did the selection.
5737 */
5738 net->ro._s_addr = sctp_source_address_selection(inp,
5739 stcb, (sctp_route_t *)&net->ro,
5740 net, 0, vrf_id);
5741 if (net->ro._s_addr == NULL) {
5742 sctp_m_freem(op_err);
5743 sctp_m_freem(m);
5744 return;
5745 }
5746
5747 net->src_addr_selected = 1;
5748
5749 }
5750 stc.laddress[0] = net->ro._s_addr->address.sin.sin_addr.s_addr;
5751 stc.laddress[1] = 0;
5752 stc.laddress[2] = 0;
5753 stc.laddress[3] = 0;
5754 stc.laddr_type = SCTP_IPV4_ADDRESS;
5755 /* scope_id is only for v6 */
5756 stc.scope_id = 0;
5757 break;
5758 #endif
5759 #ifdef INET6
5760 case AF_INET6:
5761 sin6 = (struct sockaddr_in6 *)to;
5762 memcpy(&stc.address, &sin6->sin6_addr,
5763 sizeof(struct in6_addr));
5764 stc.addr_type = SCTP_IPV6_ADDRESS;
5765 stc.scope_id = sin6->sin6_scope_id;
5766 if (net->src_addr_selected == 0) {
5767 /*
5768 * strange case here, the INIT should have
5769 * done the selection.
5770 */
5771 net->ro._s_addr = sctp_source_address_selection(inp,
5772 stcb, (sctp_route_t *)&net->ro,
5773 net, 0, vrf_id);
5774 if (net->ro._s_addr == NULL) {
5775 sctp_m_freem(op_err);
5776 sctp_m_freem(m);
5777 return;
5778 }
5779
5780 net->src_addr_selected = 1;
5781 }
5782 memcpy(&stc.laddress, &net->ro._s_addr->address.sin6.sin6_addr,
5783 sizeof(struct in6_addr));
5784 stc.laddr_type = SCTP_IPV6_ADDRESS;
5785 break;
5786 #endif
5787 }
5788 }
5789 /* Now lets put the SCTP header in place */
5790 initack = mtod(m, struct sctp_init_ack_chunk *);
5791 /* Save it off for quick ref */
5792 stc.peers_vtag = ntohl(init_chk->init.initiate_tag);
5793 /* who are we */
5794 memcpy(stc.identification, SCTP_VERSION_STRING,
5795 min(strlen(SCTP_VERSION_STRING), sizeof(stc.identification)));
5796 memset(stc.reserved, 0, SCTP_RESERVE_SPACE);
5797 /* now the chunk header */
5798 initack->ch.chunk_type = SCTP_INITIATION_ACK;
5799 initack->ch.chunk_flags = 0;
5800 /* fill in later from mbuf we build */
5801 initack->ch.chunk_length = 0;
5802 /* place in my tag */
5803 if ((asoc != NULL) &&
5804 ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT) ||
5805 (SCTP_GET_STATE(stcb) == SCTP_STATE_INUSE) ||
5806 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED))) {
5807 /* re-use the v-tags and init-seq here */
5808 initack->init.initiate_tag = htonl(asoc->my_vtag);
5809 initack->init.initial_tsn = htonl(asoc->init_seq_number);
5810 } else {
5811 uint32_t vtag, itsn;
5812
5813 if (asoc) {
5814 atomic_add_int(&asoc->refcnt, 1);
5815 SCTP_TCB_UNLOCK(stcb);
5816 new_tag:
5817 vtag = sctp_select_a_tag(inp, inp->sctp_lport, sh->src_port, 1);
5818 if ((asoc->peer_supports_nat) && (vtag == asoc->my_vtag)) {
5819 /*
5820 * Got a duplicate vtag on some guy behind a
5821 * nat make sure we don't use it.
5822 */
5823 goto new_tag;
5824 }
5825 initack->init.initiate_tag = htonl(vtag);
5826 /* get a TSN to use too */
5827 itsn = sctp_select_initial_TSN(&inp->sctp_ep);
5828 initack->init.initial_tsn = htonl(itsn);
5829 SCTP_TCB_LOCK(stcb);
5830 atomic_add_int(&asoc->refcnt, -1);
5831 } else {
5832 SCTP_INP_INCR_REF(inp);
5833 SCTP_INP_RUNLOCK(inp);
5834 vtag = sctp_select_a_tag(inp, inp->sctp_lport, sh->src_port, 1);
5835 initack->init.initiate_tag = htonl(vtag);
5836 /* get a TSN to use too */
5837 initack->init.initial_tsn = htonl(sctp_select_initial_TSN(&inp->sctp_ep));
5838 SCTP_INP_RLOCK(inp);
5839 SCTP_INP_DECR_REF(inp);
5840 }
5841 }
5842 /* save away my tag to */
5843 stc.my_vtag = initack->init.initiate_tag;
5844
5845 /* set up some of the credits. */
5846 so = inp->sctp_socket;
5847 if (so == NULL) {
5848 /* memory problem */
5849 sctp_m_freem(op_err);
5850 sctp_m_freem(m);
5851 return;
5852 } else {
5853 initack->init.a_rwnd = htonl(max(SCTP_SB_LIMIT_RCV(so), SCTP_MINIMAL_RWND));
5854 }
5855 /* set what I want */
5856 his_limit = ntohs(init_chk->init.num_inbound_streams);
5857 /* choose what I want */
5858 if (asoc != NULL) {
5859 if (asoc->streamoutcnt > asoc->pre_open_streams) {
5860 i_want = asoc->streamoutcnt;
5861 } else {
5862 i_want = asoc->pre_open_streams;
5863 }
5864 } else {
5865 i_want = inp->sctp_ep.pre_open_stream_count;
5866 }
5867 if (his_limit < i_want) {
5868 /* I Want more :< */
5869 initack->init.num_outbound_streams = init_chk->init.num_inbound_streams;
5870 } else {
5871 /* I can have what I want :> */
5872 initack->init.num_outbound_streams = htons(i_want);
5873 }
5874 /* tell him his limit. */
5875 initack->init.num_inbound_streams =
5876 htons(inp->sctp_ep.max_open_streams_intome);
5877
5878 /* adaptation layer indication parameter */
5879 if (inp->sctp_ep.adaptation_layer_indicator_provided) {
5880 parameter_len = (uint16_t)sizeof(struct sctp_adaptation_layer_indication);
5881 ali = (struct sctp_adaptation_layer_indication *)(mtod(m, caddr_t)+chunk_len);
5882 ali->ph.param_type = htons(SCTP_ULP_ADAPTATION);
5883 ali->ph.param_length = htons(parameter_len);
5884 ali->indication = htonl(inp->sctp_ep.adaptation_layer_indicator);
5885 chunk_len += parameter_len;
5886 }
5887
5888 /* ECN parameter */
5889 if (((asoc != NULL) && (asoc->ecn_supported == 1)) ||
5890 ((asoc == NULL) && (inp->ecn_supported == 1))) {
5891 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
5892 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
5893 ph->param_type = htons(SCTP_ECN_CAPABLE);
5894 ph->param_length = htons(parameter_len);
5895 chunk_len += parameter_len;
5896 }
5897
5898 /* PR-SCTP supported parameter */
5899 if (((asoc != NULL) && (asoc->prsctp_supported == 1)) ||
5900 ((asoc == NULL) && (inp->prsctp_supported == 1))) {
5901 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
5902 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
5903 ph->param_type = htons(SCTP_PRSCTP_SUPPORTED);
5904 ph->param_length = htons(parameter_len);
5905 chunk_len += parameter_len;
5906 }
5907
5908 /* Add NAT friendly parameter */
5909 if (nat_friendly) {
5910 parameter_len = (uint16_t)sizeof(struct sctp_paramhdr);
5911 ph = (struct sctp_paramhdr *)(mtod(m, caddr_t)+chunk_len);
5912 ph->param_type = htons(SCTP_HAS_NAT_SUPPORT);
5913 ph->param_length = htons(parameter_len);
5914 chunk_len += parameter_len;
5915 }
5916
5917 /* And now tell the peer which extensions we support */
5918 num_ext = 0;
5919 pr_supported = (struct sctp_supported_chunk_types_param *)(mtod(m, caddr_t)+chunk_len);
5920 if (((asoc != NULL) && (asoc->prsctp_supported == 1)) ||
5921 ((asoc == NULL) && (inp->prsctp_supported == 1))) {
5922 pr_supported->chunk_types[num_ext++] = SCTP_FORWARD_CUM_TSN;
5923 if (((asoc != NULL) && (asoc->idata_supported == 1)) ||
5924 ((asoc == NULL) && (inp->idata_supported == 1))) {
5925 pr_supported->chunk_types[num_ext++] = SCTP_IFORWARD_CUM_TSN;
5926 }
5927 }
5928 if (((asoc != NULL) && (asoc->auth_supported == 1)) ||
5929 ((asoc == NULL) && (inp->auth_supported == 1))) {
5930 pr_supported->chunk_types[num_ext++] = SCTP_AUTHENTICATION;
5931 }
5932 if (((asoc != NULL) && (asoc->asconf_supported == 1)) ||
5933 ((asoc == NULL) && (inp->asconf_supported == 1))) {
5934 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF;
5935 pr_supported->chunk_types[num_ext++] = SCTP_ASCONF_ACK;
5936 }
5937 if (((asoc != NULL) && (asoc->reconfig_supported == 1)) ||
5938 ((asoc == NULL) && (inp->reconfig_supported == 1))) {
5939 pr_supported->chunk_types[num_ext++] = SCTP_STREAM_RESET;
5940 }
5941 if (((asoc != NULL) && (asoc->idata_supported == 1)) ||
5942 ((asoc == NULL) && (inp->idata_supported == 1))) {
5943 pr_supported->chunk_types[num_ext++] = SCTP_IDATA;
5944 }
5945 if (((asoc != NULL) && (asoc->nrsack_supported == 1)) ||
5946 ((asoc == NULL) && (inp->nrsack_supported == 1))) {
5947 pr_supported->chunk_types[num_ext++] = SCTP_NR_SELECTIVE_ACK;
5948 }
5949 if (((asoc != NULL) && (asoc->pktdrop_supported == 1)) ||
5950 ((asoc == NULL) && (inp->pktdrop_supported == 1))) {
5951 pr_supported->chunk_types[num_ext++] = SCTP_PACKET_DROPPED;
5952 }
5953 if (num_ext > 0) {
5954 parameter_len = (uint16_t)sizeof(struct sctp_supported_chunk_types_param) + num_ext;
5955 pr_supported->ph.param_type = htons(SCTP_SUPPORTED_CHUNK_EXT);
5956 pr_supported->ph.param_length = htons(parameter_len);
5957 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
5958 chunk_len += parameter_len;
5959 }
5960
5961 /* add authentication parameters */
5962 if (((asoc != NULL) && (asoc->auth_supported == 1)) ||
5963 ((asoc == NULL) && (inp->auth_supported == 1))) {
5964 struct sctp_auth_random *randp;
5965 struct sctp_auth_hmac_algo *hmacs;
5966 struct sctp_auth_chunk_list *chunks;
5967
5968 if (padding_len > 0) {
5969 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
5970 chunk_len += padding_len;
5971 padding_len = 0;
5972 }
5973 /* generate and add RANDOM parameter */
5974 randp = (struct sctp_auth_random *)(mtod(m, caddr_t)+chunk_len);
5975 parameter_len = (uint16_t)sizeof(struct sctp_auth_random) +
5976 SCTP_AUTH_RANDOM_SIZE_DEFAULT;
5977 randp->ph.param_type = htons(SCTP_RANDOM);
5978 randp->ph.param_length = htons(parameter_len);
5979 SCTP_READ_RANDOM(randp->random_data, SCTP_AUTH_RANDOM_SIZE_DEFAULT);
5980 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
5981 chunk_len += parameter_len;
5982
5983 if (padding_len > 0) {
5984 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
5985 chunk_len += padding_len;
5986 padding_len = 0;
5987 }
5988 /* add HMAC_ALGO parameter */
5989 hmacs = (struct sctp_auth_hmac_algo *)(mtod(m, caddr_t)+chunk_len);
5990 parameter_len = (uint16_t)sizeof(struct sctp_auth_hmac_algo) +
5991 sctp_serialize_hmaclist(inp->sctp_ep.local_hmacs,
5992 (uint8_t *)hmacs->hmac_ids);
5993 hmacs->ph.param_type = htons(SCTP_HMAC_LIST);
5994 hmacs->ph.param_length = htons(parameter_len);
5995 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
5996 chunk_len += parameter_len;
5997
5998 if (padding_len > 0) {
5999 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
6000 chunk_len += padding_len;
6001 padding_len = 0;
6002 }
6003 /* add CHUNKS parameter */
6004 chunks = (struct sctp_auth_chunk_list *)(mtod(m, caddr_t)+chunk_len);
6005 parameter_len = (uint16_t)sizeof(struct sctp_auth_chunk_list) +
6006 sctp_serialize_auth_chunks(inp->sctp_ep.local_auth_chunks,
6007 chunks->chunk_types);
6008 chunks->ph.param_type = htons(SCTP_CHUNK_LIST);
6009 chunks->ph.param_length = htons(parameter_len);
6010 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6011 chunk_len += parameter_len;
6012 }
6013 SCTP_BUF_LEN(m) = chunk_len;
6014 m_last = m;
6015 /* now the addresses */
6016 /*
6017 * To optimize this we could put the scoping stuff into a structure
6018 * and remove the individual uint8's from the stc structure. Then we
6019 * could just sifa in the address within the stc.. but for now this
6020 * is a quick hack to get the address stuff teased apart.
6021 */
6022 scp.ipv4_addr_legal = stc.ipv4_addr_legal;
6023 scp.ipv6_addr_legal = stc.ipv6_addr_legal;
6024 scp.loopback_scope = stc.loopback_scope;
6025 scp.ipv4_local_scope = stc.ipv4_scope;
6026 scp.local_scope = stc.local_scope;
6027 scp.site_scope = stc.site_scope;
6028 m_last = sctp_add_addresses_to_i_ia(inp, stcb, &scp, m_last,
6029 cnt_inits_to,
6030 &padding_len, &chunk_len);
6031 /* padding_len can only be positive, if no addresses have been added */
6032 if (padding_len > 0) {
6033 memset(mtod(m, caddr_t)+chunk_len, 0, padding_len);
6034 chunk_len += padding_len;
6035 SCTP_BUF_LEN(m) += padding_len;
6036 padding_len = 0;
6037 }
6038
6039 /* tack on the operational error if present */
6040 if (op_err) {
6041 parameter_len = 0;
6042 for (m_tmp = op_err; m_tmp != NULL; m_tmp = SCTP_BUF_NEXT(m_tmp)) {
6043 parameter_len += SCTP_BUF_LEN(m_tmp);
6044 }
6045 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6046 SCTP_BUF_NEXT(m_last) = op_err;
6047 while (SCTP_BUF_NEXT(m_last) != NULL) {
6048 m_last = SCTP_BUF_NEXT(m_last);
6049 }
6050 chunk_len += parameter_len;
6051 }
6052 if (padding_len > 0) {
6053 m_last = sctp_add_pad_tombuf(m_last, padding_len);
6054 if (m_last == NULL) {
6055 /* Houston we have a problem, no space */
6056 sctp_m_freem(m);
6057 return;
6058 }
6059 chunk_len += padding_len;
6060 padding_len = 0;
6061 }
6062 /* Now we must build a cookie */
6063 m_cookie = sctp_add_cookie(init_pkt, offset, m, 0, &stc, &signature);
6064 if (m_cookie == NULL) {
6065 /* memory problem */
6066 sctp_m_freem(m);
6067 return;
6068 }
6069 /* Now append the cookie to the end and update the space/size */
6070 SCTP_BUF_NEXT(m_last) = m_cookie;
6071 parameter_len = 0;
6072 for (m_tmp = m_cookie; m_tmp != NULL; m_tmp = SCTP_BUF_NEXT(m_tmp)) {
6073 parameter_len += SCTP_BUF_LEN(m_tmp);
6074 if (SCTP_BUF_NEXT(m_tmp) == NULL) {
6075 m_last = m_tmp;
6076 }
6077 }
6078 padding_len = SCTP_SIZE32(parameter_len) - parameter_len;
6079 chunk_len += parameter_len;
6080
6081 /*
6082 * Place in the size, but we don't include the last pad (if any) in
6083 * the INIT-ACK.
6084 */
6085 initack->ch.chunk_length = htons(chunk_len);
6086
6087 /*
6088 * Time to sign the cookie, we don't sign over the cookie signature
6089 * though thus we set trailer.
6090 */
6091 (void)sctp_hmac_m(SCTP_HMAC,
6092 (uint8_t *)inp->sctp_ep.secret_key[(int)(inp->sctp_ep.current_secret_number)],
6093 SCTP_SECRET_SIZE, m_cookie, sizeof(struct sctp_paramhdr),
6094 (uint8_t *)signature, SCTP_SIGNATURE_SIZE);
6095 /*
6096 * We sifa 0 here to NOT set IP_DF if its IPv4, we ignore the return
6097 * here since the timer will drive a retranmission.
6098 */
6099 if (padding_len > 0) {
6100 if (sctp_add_pad_tombuf(m_last, padding_len) == NULL) {
6101 sctp_m_freem(m);
6102 return;
6103 }
6104 }
6105 if (stc.loopback_scope) {
6106 over_addr = (union sctp_sockstore *)dst;
6107 } else {
6108 over_addr = NULL;
6109 }
6110
6111 if ((error = sctp_lowlevel_chunk_output(inp, NULL, NULL, to, m, 0, NULL, 0, 0,
6112 0, 0,
6113 inp->sctp_lport, sh->src_port, init_chk->init.initiate_tag,
6114 port, over_addr,
6115 mflowtype, mflowid,
6116 SCTP_SO_NOT_LOCKED))) {
6117 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Gak send error %d\n", error);
6118 if (error == ENOBUFS) {
6119 if (asoc != NULL) {
6120 asoc->ifp_had_enobuf = 1;
6121 }
6122 SCTP_STAT_INCR(sctps_lowlevelerr);
6123 }
6124 } else {
6125 if (asoc != NULL) {
6126 asoc->ifp_had_enobuf = 0;
6127 }
6128 }
6129 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
6130 }
6131
6132
6133 static void
sctp_prune_prsctp(struct sctp_tcb * stcb,struct sctp_association * asoc,struct sctp_sndrcvinfo * srcv,int dataout)6134 sctp_prune_prsctp(struct sctp_tcb *stcb,
6135 struct sctp_association *asoc,
6136 struct sctp_sndrcvinfo *srcv,
6137 int dataout)
6138 {
6139 int freed_spc = 0;
6140 struct sctp_tmit_chunk *chk, *nchk;
6141
6142 SCTP_TCB_LOCK_ASSERT(stcb);
6143 if ((asoc->prsctp_supported) &&
6144 (asoc->sent_queue_cnt_removeable > 0)) {
6145 TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) {
6146 /*
6147 * Look for chunks marked with the PR_SCTP flag AND
6148 * the buffer space flag. If the one being sent is
6149 * equal or greater priority then purge the old one
6150 * and free some space.
6151 */
6152 if (PR_SCTP_BUF_ENABLED(chk->flags)) {
6153 /*
6154 * This one is PR-SCTP AND buffer space
6155 * limited type
6156 */
6157 if (chk->rec.data.timetodrop.tv_sec > (long)srcv->sinfo_timetolive) {
6158 /*
6159 * Lower numbers equates to higher
6160 * priority so if the one we are
6161 * looking at has a larger
6162 * priority we want to drop the data
6163 * and NOT retransmit it.
6164 */
6165 if (chk->data) {
6166 /*
6167 * We release the book_size
6168 * if the mbuf is here
6169 */
6170 int ret_spc;
6171 uint8_t sent;
6172
6173 if (chk->sent > SCTP_DATAGRAM_UNSENT)
6174 sent = 1;
6175 else
6176 sent = 0;
6177 ret_spc = sctp_release_pr_sctp_chunk(stcb, chk,
6178 sent,
6179 SCTP_SO_LOCKED);
6180 freed_spc += ret_spc;
6181 if (freed_spc >= dataout) {
6182 return;
6183 }
6184 } /* if chunk was present */
6185 } /* if of sufficient priority */
6186 } /* if chunk has enabled */
6187 } /* tailqforeach */
6188
6189 TAILQ_FOREACH_SAFE(chk, &asoc->send_queue, sctp_next, nchk) {
6190 /* Here we must move to the sent queue and mark */
6191 if (PR_SCTP_BUF_ENABLED(chk->flags)) {
6192 if (chk->rec.data.timetodrop.tv_sec > (long)srcv->sinfo_timetolive) {
6193 if (chk->data) {
6194 /*
6195 * We release the book_size
6196 * if the mbuf is here
6197 */
6198 int ret_spc;
6199
6200 ret_spc = sctp_release_pr_sctp_chunk(stcb, chk,
6201 0, SCTP_SO_LOCKED);
6202
6203 freed_spc += ret_spc;
6204 if (freed_spc >= dataout) {
6205 return;
6206 }
6207 } /* end if chk->data */
6208 } /* end if right class */
6209 } /* end if chk pr-sctp */
6210 } /* tailqforeachsafe (chk) */
6211 } /* if enabled in asoc */
6212 }
6213
6214 int
sctp_get_frag_point(struct sctp_tcb * stcb,struct sctp_association * asoc)6215 sctp_get_frag_point(struct sctp_tcb *stcb,
6216 struct sctp_association *asoc)
6217 {
6218 int siz, ovh;
6219
6220 /*
6221 * For endpoints that have both v6 and v4 addresses we must reserve
6222 * room for the ipv6 header, for those that are only dealing with V4
6223 * we use a larger frag point.
6224 */
6225 if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
6226 ovh = SCTP_MIN_OVERHEAD;
6227 } else {
6228 ovh = SCTP_MIN_V4_OVERHEAD;
6229 }
6230 ovh += SCTP_DATA_CHUNK_OVERHEAD(stcb);
6231 if (stcb->asoc.sctp_frag_point > asoc->smallest_mtu)
6232 siz = asoc->smallest_mtu - ovh;
6233 else
6234 siz = (stcb->asoc.sctp_frag_point - ovh);
6235 /*
6236 * if (siz > (MCLBYTES-sizeof(struct sctp_data_chunk))) {
6237 */
6238 /* A data chunk MUST fit in a cluster */
6239 /* siz = (MCLBYTES - sizeof(struct sctp_data_chunk)); */
6240 /* } */
6241
6242 /* adjust for an AUTH chunk if DATA requires auth */
6243 if (sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks))
6244 siz -= sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
6245
6246 if (siz % 4) {
6247 /* make it an even word boundary please */
6248 siz -= (siz % 4);
6249 }
6250 return (siz);
6251 }
6252
6253 static void
sctp_set_prsctp_policy(struct sctp_stream_queue_pending * sp)6254 sctp_set_prsctp_policy(struct sctp_stream_queue_pending *sp)
6255 {
6256 /*
6257 * We assume that the user wants PR_SCTP_TTL if the user provides a
6258 * positive lifetime but does not specify any PR_SCTP policy.
6259 */
6260 if (PR_SCTP_ENABLED(sp->sinfo_flags)) {
6261 sp->act_flags |= PR_SCTP_POLICY(sp->sinfo_flags);
6262 } else if (sp->timetolive > 0) {
6263 sp->sinfo_flags |= SCTP_PR_SCTP_TTL;
6264 sp->act_flags |= PR_SCTP_POLICY(sp->sinfo_flags);
6265 } else {
6266 return;
6267 }
6268 switch (PR_SCTP_POLICY(sp->sinfo_flags)) {
6269 case CHUNK_FLAGS_PR_SCTP_BUF:
6270 /*
6271 * Time to live is a priority stored in tv_sec when doing
6272 * the buffer drop thing.
6273 */
6274 sp->ts.tv_sec = sp->timetolive;
6275 sp->ts.tv_usec = 0;
6276 break;
6277 case CHUNK_FLAGS_PR_SCTP_TTL:
6278 {
6279 struct timeval tv;
6280
6281 (void)SCTP_GETTIME_TIMEVAL(&sp->ts);
6282 tv.tv_sec = sp->timetolive / 1000;
6283 tv.tv_usec = (sp->timetolive * 1000) % 1000000;
6284 /*
6285 * TODO sctp_constants.h needs alternative time
6286 * macros when _KERNEL is undefined.
6287 */
6288 timevaladd(&sp->ts, &tv);
6289 }
6290 break;
6291 case CHUNK_FLAGS_PR_SCTP_RTX:
6292 /*
6293 * Time to live is a the number or retransmissions stored in
6294 * tv_sec.
6295 */
6296 sp->ts.tv_sec = sp->timetolive;
6297 sp->ts.tv_usec = 0;
6298 break;
6299 default:
6300 SCTPDBG(SCTP_DEBUG_USRREQ1,
6301 "Unknown PR_SCTP policy %u.\n",
6302 PR_SCTP_POLICY(sp->sinfo_flags));
6303 break;
6304 }
6305 }
6306
6307 static int
sctp_msg_append(struct sctp_tcb * stcb,struct sctp_nets * net,struct mbuf * m,struct sctp_sndrcvinfo * srcv,int hold_stcb_lock)6308 sctp_msg_append(struct sctp_tcb *stcb,
6309 struct sctp_nets *net,
6310 struct mbuf *m,
6311 struct sctp_sndrcvinfo *srcv, int hold_stcb_lock)
6312 {
6313 int error = 0;
6314 struct mbuf *at;
6315 struct sctp_stream_queue_pending *sp = NULL;
6316 struct sctp_stream_out *strm;
6317
6318 /*
6319 * Given an mbuf chain, put it into the association send queue and
6320 * place it on the wheel
6321 */
6322 if (srcv->sinfo_stream >= stcb->asoc.streamoutcnt) {
6323 /* Invalid stream number */
6324 SCTP_LTRACE_ERR_RET_PKT(m, NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
6325 error = EINVAL;
6326 goto out_now;
6327 }
6328 if ((stcb->asoc.stream_locked) &&
6329 (stcb->asoc.stream_locked_on != srcv->sinfo_stream)) {
6330 SCTP_LTRACE_ERR_RET_PKT(m, NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
6331 error = EINVAL;
6332 goto out_now;
6333 }
6334 strm = &stcb->asoc.strmout[srcv->sinfo_stream];
6335 /* Now can we send this? */
6336 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_SENT) ||
6337 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_ACK_SENT) ||
6338 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
6339 (stcb->asoc.state & SCTP_STATE_SHUTDOWN_PENDING)) {
6340 /* got data while shutting down */
6341 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
6342 error = ECONNRESET;
6343 goto out_now;
6344 }
6345 sctp_alloc_a_strmoq(stcb, sp);
6346 if (sp == NULL) {
6347 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
6348 error = ENOMEM;
6349 goto out_now;
6350 }
6351 sp->sinfo_flags = srcv->sinfo_flags;
6352 sp->timetolive = srcv->sinfo_timetolive;
6353 sp->ppid = srcv->sinfo_ppid;
6354 sp->context = srcv->sinfo_context;
6355 sp->fsn = 0;
6356 if (sp->sinfo_flags & SCTP_ADDR_OVER) {
6357 sp->net = net;
6358 atomic_add_int(&sp->net->ref_count, 1);
6359 } else {
6360 sp->net = NULL;
6361 }
6362 (void)SCTP_GETTIME_TIMEVAL(&sp->ts);
6363 sp->sid = srcv->sinfo_stream;
6364 sp->msg_is_complete = 1;
6365 sp->sender_all_done = 1;
6366 sp->some_taken = 0;
6367 sp->data = m;
6368 sp->tail_mbuf = NULL;
6369 sctp_set_prsctp_policy(sp);
6370 /*
6371 * We could in theory (for sendall) sifa the length in, but we would
6372 * still have to hunt through the chain since we need to setup the
6373 * tail_mbuf
6374 */
6375 sp->length = 0;
6376 for (at = m; at; at = SCTP_BUF_NEXT(at)) {
6377 if (SCTP_BUF_NEXT(at) == NULL)
6378 sp->tail_mbuf = at;
6379 sp->length += SCTP_BUF_LEN(at);
6380 }
6381 if (srcv->sinfo_keynumber_valid) {
6382 sp->auth_keyid = srcv->sinfo_keynumber;
6383 } else {
6384 sp->auth_keyid = stcb->asoc.authinfo.active_keyid;
6385 }
6386 if (sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks)) {
6387 sctp_auth_key_acquire(stcb, sp->auth_keyid);
6388 sp->holds_key_ref = 1;
6389 }
6390 if (hold_stcb_lock == 0) {
6391 SCTP_TCB_SEND_LOCK(stcb);
6392 }
6393 sctp_snd_sb_alloc(stcb, sp->length);
6394 atomic_add_int(&stcb->asoc.stream_queue_cnt, 1);
6395 TAILQ_INSERT_TAIL(&strm->outqueue, sp, next);
6396 stcb->asoc.ss_functions.sctp_ss_add_to_stream(stcb, &stcb->asoc, strm, sp, 1);
6397 m = NULL;
6398 if (hold_stcb_lock == 0) {
6399 SCTP_TCB_SEND_UNLOCK(stcb);
6400 }
6401 out_now:
6402 if (m) {
6403 sctp_m_freem(m);
6404 }
6405 return (error);
6406 }
6407
6408
6409 static struct mbuf *
sctp_copy_mbufchain(struct mbuf * clonechain,struct mbuf * outchain,struct mbuf ** endofchain,int can_take_mbuf,int sizeofcpy,uint8_t copy_by_ref)6410 sctp_copy_mbufchain(struct mbuf *clonechain,
6411 struct mbuf *outchain,
6412 struct mbuf **endofchain,
6413 int can_take_mbuf,
6414 int sizeofcpy,
6415 uint8_t copy_by_ref)
6416 {
6417 struct mbuf *m;
6418 struct mbuf *appendchain;
6419 caddr_t cp;
6420 int len;
6421
6422 if (endofchain == NULL) {
6423 /* error */
6424 error_out:
6425 if (outchain)
6426 sctp_m_freem(outchain);
6427 return (NULL);
6428 }
6429 if (can_take_mbuf) {
6430 appendchain = clonechain;
6431 } else {
6432 if (!copy_by_ref &&
6433 (sizeofcpy <= (int)((((SCTP_BASE_SYSCTL(sctp_mbuf_threshold_count) - 1) * MLEN) + MHLEN)))) {
6434 /* Its not in a cluster */
6435 if (*endofchain == NULL) {
6436 /* lets get a mbuf cluster */
6437 if (outchain == NULL) {
6438 /* This is the general case */
6439 new_mbuf:
6440 outchain = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_HEADER);
6441 if (outchain == NULL) {
6442 goto error_out;
6443 }
6444 SCTP_BUF_LEN(outchain) = 0;
6445 *endofchain = outchain;
6446 /* get the prepend space */
6447 SCTP_BUF_RESV_UF(outchain, (SCTP_FIRST_MBUF_RESV + 4));
6448 } else {
6449 /*
6450 * We really should not get a NULL
6451 * in endofchain
6452 */
6453 /* find end */
6454 m = outchain;
6455 while (m) {
6456 if (SCTP_BUF_NEXT(m) == NULL) {
6457 *endofchain = m;
6458 break;
6459 }
6460 m = SCTP_BUF_NEXT(m);
6461 }
6462 /* sanity */
6463 if (*endofchain == NULL) {
6464 /*
6465 * huh, TSNH XXX maybe we
6466 * should panic
6467 */
6468 sctp_m_freem(outchain);
6469 goto new_mbuf;
6470 }
6471 }
6472 /* get the new end of length */
6473 len = (int)M_TRAILINGSPACE(*endofchain);
6474 } else {
6475 /* how much is left at the end? */
6476 len = (int)M_TRAILINGSPACE(*endofchain);
6477 }
6478 /* Find the end of the data, for appending */
6479 cp = (mtod((*endofchain), caddr_t)+SCTP_BUF_LEN((*endofchain)));
6480
6481 /* Now lets copy it out */
6482 if (len >= sizeofcpy) {
6483 /* It all fits, copy it in */
6484 m_copydata(clonechain, 0, sizeofcpy, cp);
6485 SCTP_BUF_LEN((*endofchain)) += sizeofcpy;
6486 } else {
6487 /* fill up the end of the chain */
6488 if (len > 0) {
6489 m_copydata(clonechain, 0, len, cp);
6490 SCTP_BUF_LEN((*endofchain)) += len;
6491 /* now we need another one */
6492 sizeofcpy -= len;
6493 }
6494 m = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_HEADER);
6495 if (m == NULL) {
6496 /* We failed */
6497 goto error_out;
6498 }
6499 SCTP_BUF_NEXT((*endofchain)) = m;
6500 *endofchain = m;
6501 cp = mtod((*endofchain), caddr_t);
6502 m_copydata(clonechain, len, sizeofcpy, cp);
6503 SCTP_BUF_LEN((*endofchain)) += sizeofcpy;
6504 }
6505 return (outchain);
6506 } else {
6507 /* copy the old fashion way */
6508 appendchain = SCTP_M_COPYM(clonechain, 0, M_COPYALL, M_NOWAIT);
6509 #ifdef SCTP_MBUF_LOGGING
6510 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
6511 sctp_log_mbc(appendchain, SCTP_MBUF_ICOPY);
6512 }
6513 #endif
6514 }
6515 }
6516 if (appendchain == NULL) {
6517 /* error */
6518 if (outchain)
6519 sctp_m_freem(outchain);
6520 return (NULL);
6521 }
6522 if (outchain) {
6523 /* tack on to the end */
6524 if (*endofchain != NULL) {
6525 SCTP_BUF_NEXT(((*endofchain))) = appendchain;
6526 } else {
6527 m = outchain;
6528 while (m) {
6529 if (SCTP_BUF_NEXT(m) == NULL) {
6530 SCTP_BUF_NEXT(m) = appendchain;
6531 break;
6532 }
6533 m = SCTP_BUF_NEXT(m);
6534 }
6535 }
6536 /*
6537 * save off the end and update the end-chain position
6538 */
6539 m = appendchain;
6540 while (m) {
6541 if (SCTP_BUF_NEXT(m) == NULL) {
6542 *endofchain = m;
6543 break;
6544 }
6545 m = SCTP_BUF_NEXT(m);
6546 }
6547 return (outchain);
6548 } else {
6549 /* save off the end and update the end-chain position */
6550 m = appendchain;
6551 while (m) {
6552 if (SCTP_BUF_NEXT(m) == NULL) {
6553 *endofchain = m;
6554 break;
6555 }
6556 m = SCTP_BUF_NEXT(m);
6557 }
6558 return (appendchain);
6559 }
6560 }
6561
6562 static int
6563 sctp_med_chunk_output(struct sctp_inpcb *inp,
6564 struct sctp_tcb *stcb,
6565 struct sctp_association *asoc,
6566 int *num_out,
6567 int *reason_code,
6568 int control_only, int from_where,
6569 struct timeval *now, int *now_filled, int frag_point, int so_locked);
6570
6571 static void
sctp_sendall_iterator(struct sctp_inpcb * inp,struct sctp_tcb * stcb,void * ptr,uint32_t val SCTP_UNUSED)6572 sctp_sendall_iterator(struct sctp_inpcb *inp, struct sctp_tcb *stcb, void *ptr,
6573 uint32_t val SCTP_UNUSED)
6574 {
6575 struct sctp_copy_all *ca;
6576 struct mbuf *m;
6577 int ret = 0;
6578 int added_control = 0;
6579 int un_sent, do_chunk_output = 1;
6580 struct sctp_association *asoc;
6581 struct sctp_nets *net;
6582
6583 ca = (struct sctp_copy_all *)ptr;
6584 if (ca->m == NULL) {
6585 return;
6586 }
6587 if (ca->inp != inp) {
6588 /* TSNH */
6589 return;
6590 }
6591 if (ca->sndlen > 0) {
6592 m = SCTP_M_COPYM(ca->m, 0, M_COPYALL, M_NOWAIT);
6593 if (m == NULL) {
6594 /* can't copy so we are done */
6595 ca->cnt_failed++;
6596 return;
6597 }
6598 #ifdef SCTP_MBUF_LOGGING
6599 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
6600 sctp_log_mbc(m, SCTP_MBUF_ICOPY);
6601 }
6602 #endif
6603 } else {
6604 m = NULL;
6605 }
6606 SCTP_TCB_LOCK_ASSERT(stcb);
6607 if (stcb->asoc.alternate) {
6608 net = stcb->asoc.alternate;
6609 } else {
6610 net = stcb->asoc.primary_destination;
6611 }
6612 if (ca->sndrcv.sinfo_flags & SCTP_ABORT) {
6613 /* Abort this assoc with m as the user defined reason */
6614 if (m != NULL) {
6615 SCTP_BUF_PREPEND(m, sizeof(struct sctp_paramhdr), M_NOWAIT);
6616 } else {
6617 m = sctp_get_mbuf_for_msg(sizeof(struct sctp_paramhdr),
6618 0, M_NOWAIT, 1, MT_DATA);
6619 SCTP_BUF_LEN(m) = sizeof(struct sctp_paramhdr);
6620 }
6621 if (m != NULL) {
6622 struct sctp_paramhdr *ph;
6623
6624 ph = mtod(m, struct sctp_paramhdr *);
6625 ph->param_type = htons(SCTP_CAUSE_USER_INITIATED_ABT);
6626 ph->param_length = htons((uint16_t)(sizeof(struct sctp_paramhdr) + ca->sndlen));
6627 }
6628 /*
6629 * We add one here to keep the assoc from dis-appearing on
6630 * us.
6631 */
6632 atomic_add_int(&stcb->asoc.refcnt, 1);
6633 sctp_abort_an_association(inp, stcb, m, SCTP_SO_NOT_LOCKED);
6634 /*
6635 * sctp_abort_an_association calls sctp_free_asoc() free
6636 * association will NOT free it since we incremented the
6637 * refcnt .. we do this to prevent it being freed and things
6638 * getting tricky since we could end up (from free_asoc)
6639 * calling inpcb_free which would get a recursive lock call
6640 * to the iterator lock.. But as a consequence of that the
6641 * stcb will return to us un-locked.. since free_asoc
6642 * returns with either no TCB or the TCB unlocked, we must
6643 * relock.. to unlock in the iterator timer :-0
6644 */
6645 SCTP_TCB_LOCK(stcb);
6646 atomic_add_int(&stcb->asoc.refcnt, -1);
6647 goto no_chunk_output;
6648 } else {
6649 if (m) {
6650 ret = sctp_msg_append(stcb, net, m,
6651 &ca->sndrcv, 1);
6652 }
6653 asoc = &stcb->asoc;
6654 if (ca->sndrcv.sinfo_flags & SCTP_EOF) {
6655 /* shutdown this assoc */
6656 if (TAILQ_EMPTY(&asoc->send_queue) &&
6657 TAILQ_EMPTY(&asoc->sent_queue) &&
6658 sctp_is_there_unsent_data(stcb, SCTP_SO_NOT_LOCKED) == 0) {
6659 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
6660 goto abort_anyway;
6661 }
6662 /*
6663 * there is nothing queued to send, so I'm
6664 * done...
6665 */
6666 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
6667 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
6668 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
6669 /*
6670 * only send SHUTDOWN the first time
6671 * through
6672 */
6673 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
6674 SCTP_STAT_DECR_GAUGE32(sctps_currestab);
6675 }
6676 SCTP_SET_STATE(stcb, SCTP_STATE_SHUTDOWN_SENT);
6677 sctp_stop_timers_for_shutdown(stcb);
6678 sctp_send_shutdown(stcb, net);
6679 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN, stcb->sctp_ep, stcb,
6680 net);
6681 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
6682 NULL);
6683 added_control = 1;
6684 do_chunk_output = 0;
6685 }
6686 } else {
6687 /*
6688 * we still got (or just got) data to send,
6689 * so set SHUTDOWN_PENDING
6690 */
6691 /*
6692 * XXX sockets draft says that SCTP_EOF
6693 * should be sent with no data. currently,
6694 * we will allow user data to be sent first
6695 * and move to SHUTDOWN-PENDING
6696 */
6697 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
6698 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
6699 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
6700 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
6701 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_PARTIAL_MSG_LEFT);
6702 }
6703 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_SHUTDOWN_PENDING);
6704 if (TAILQ_EMPTY(&asoc->send_queue) &&
6705 TAILQ_EMPTY(&asoc->sent_queue) &&
6706 (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT)) {
6707 struct mbuf *op_err;
6708 char msg[SCTP_DIAG_INFO_LEN];
6709
6710 abort_anyway:
6711 SCTP_SNPRINTF(msg, sizeof(msg),
6712 "%s:%d at %s", __FILE__, __LINE__, __func__);
6713 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
6714 msg);
6715 atomic_add_int(&stcb->asoc.refcnt, 1);
6716 sctp_abort_an_association(stcb->sctp_ep, stcb,
6717 op_err, SCTP_SO_NOT_LOCKED);
6718 atomic_add_int(&stcb->asoc.refcnt, -1);
6719 goto no_chunk_output;
6720 }
6721 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
6722 NULL);
6723 }
6724 }
6725
6726 }
6727 }
6728 un_sent = ((stcb->asoc.total_output_queue_size - stcb->asoc.total_flight) +
6729 (stcb->asoc.stream_queue_cnt * SCTP_DATA_CHUNK_OVERHEAD(stcb)));
6730
6731 if ((sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY)) &&
6732 (stcb->asoc.total_flight > 0) &&
6733 (un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD))) {
6734 do_chunk_output = 0;
6735 }
6736 if (do_chunk_output)
6737 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_NOT_LOCKED);
6738 else if (added_control) {
6739 int num_out, reason, now_filled = 0;
6740 struct timeval now;
6741 int frag_point;
6742
6743 frag_point = sctp_get_frag_point(stcb, &stcb->asoc);
6744 (void)sctp_med_chunk_output(inp, stcb, &stcb->asoc, &num_out,
6745 &reason, 1, 1, &now, &now_filled, frag_point, SCTP_SO_NOT_LOCKED);
6746 }
6747 no_chunk_output:
6748 if (ret) {
6749 ca->cnt_failed++;
6750 } else {
6751 ca->cnt_sent++;
6752 }
6753 }
6754
6755 static void
sctp_sendall_completes(void * ptr,uint32_t val SCTP_UNUSED)6756 sctp_sendall_completes(void *ptr, uint32_t val SCTP_UNUSED)
6757 {
6758 struct sctp_copy_all *ca;
6759
6760 ca = (struct sctp_copy_all *)ptr;
6761 /*
6762 * Do a notify here? Kacheong suggests that the notify be done at
6763 * the send time.. so you would push up a notification if any send
6764 * failed. Don't know if this is feasible since the only failures we
6765 * have is "memory" related and if you cannot get an mbuf to send
6766 * the data you surely can't get an mbuf to send up to notify the
6767 * user you can't send the data :->
6768 */
6769
6770 /* now free everything */
6771 if (ca->inp) {
6772 /* Lets clear the flag to allow others to run. */
6773 ca->inp->sctp_flags &= ~SCTP_PCB_FLAGS_SND_ITERATOR_UP;
6774 }
6775 sctp_m_freem(ca->m);
6776 SCTP_FREE(ca, SCTP_M_COPYAL);
6777 }
6778
6779 static struct mbuf *
sctp_copy_out_all(struct uio * uio,ssize_t len)6780 sctp_copy_out_all(struct uio *uio, ssize_t len)
6781 {
6782 struct mbuf *ret, *at;
6783 ssize_t left, willcpy, cancpy, error;
6784
6785 ret = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_WAITOK, 1, MT_DATA);
6786 if (ret == NULL) {
6787 /* TSNH */
6788 return (NULL);
6789 }
6790 left = len;
6791 SCTP_BUF_LEN(ret) = 0;
6792 /* save space for the data chunk header */
6793 cancpy = (int)M_TRAILINGSPACE(ret);
6794 willcpy = min(cancpy, left);
6795 at = ret;
6796 while (left > 0) {
6797 /* Align data to the end */
6798 error = uiomove(mtod(at, caddr_t), (int)willcpy, uio);
6799 if (error) {
6800 err_out_now:
6801 sctp_m_freem(at);
6802 return (NULL);
6803 }
6804 SCTP_BUF_LEN(at) = (int)willcpy;
6805 SCTP_BUF_NEXT_PKT(at) = SCTP_BUF_NEXT(at) = 0;
6806 left -= willcpy;
6807 if (left > 0) {
6808 SCTP_BUF_NEXT(at) = sctp_get_mbuf_for_msg((unsigned int)left, 0, M_WAITOK, 1, MT_DATA);
6809 if (SCTP_BUF_NEXT(at) == NULL) {
6810 goto err_out_now;
6811 }
6812 at = SCTP_BUF_NEXT(at);
6813 SCTP_BUF_LEN(at) = 0;
6814 cancpy = (int)M_TRAILINGSPACE(at);
6815 willcpy = min(cancpy, left);
6816 }
6817 }
6818 return (ret);
6819 }
6820
6821 static int
sctp_sendall(struct sctp_inpcb * inp,struct uio * uio,struct mbuf * m,struct sctp_sndrcvinfo * srcv)6822 sctp_sendall(struct sctp_inpcb *inp, struct uio *uio, struct mbuf *m,
6823 struct sctp_sndrcvinfo *srcv)
6824 {
6825 int ret;
6826 struct sctp_copy_all *ca;
6827
6828 if (inp->sctp_flags & SCTP_PCB_FLAGS_SND_ITERATOR_UP) {
6829 /* There is another. */
6830 return (EBUSY);
6831 }
6832 if (uio->uio_resid > (ssize_t)SCTP_BASE_SYSCTL(sctp_sendall_limit)) {
6833 /* You must not be larger than the limit! */
6834 return (EMSGSIZE);
6835 }
6836 SCTP_MALLOC(ca, struct sctp_copy_all *, sizeof(struct sctp_copy_all),
6837 SCTP_M_COPYAL);
6838 if (ca == NULL) {
6839 sctp_m_freem(m);
6840 SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
6841 return (ENOMEM);
6842 }
6843 memset(ca, 0, sizeof(struct sctp_copy_all));
6844
6845 ca->inp = inp;
6846 if (srcv) {
6847 memcpy(&ca->sndrcv, srcv, sizeof(struct sctp_nonpad_sndrcvinfo));
6848 }
6849 /*
6850 * take off the sendall flag, it would be bad if we failed to do
6851 * this :-0
6852 */
6853 ca->sndrcv.sinfo_flags &= ~SCTP_SENDALL;
6854 /* get length and mbuf chain */
6855 if (uio) {
6856 ca->sndlen = uio->uio_resid;
6857 ca->m = sctp_copy_out_all(uio, ca->sndlen);
6858 if (ca->m == NULL) {
6859 SCTP_FREE(ca, SCTP_M_COPYAL);
6860 SCTP_LTRACE_ERR_RET(inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
6861 return (ENOMEM);
6862 }
6863 } else {
6864 /* Gather the length of the send */
6865 struct mbuf *mat;
6866
6867 ca->sndlen = 0;
6868 for (mat = m; mat; mat = SCTP_BUF_NEXT(mat)) {
6869 ca->sndlen += SCTP_BUF_LEN(mat);
6870 }
6871 }
6872 inp->sctp_flags |= SCTP_PCB_FLAGS_SND_ITERATOR_UP;
6873 ret = sctp_initiate_iterator(NULL, sctp_sendall_iterator, NULL,
6874 SCTP_PCB_ANY_FLAGS, SCTP_PCB_ANY_FEATURES,
6875 SCTP_ASOC_ANY_STATE,
6876 (void *)ca, 0,
6877 sctp_sendall_completes, inp, 1);
6878 if (ret) {
6879 inp->sctp_flags &= ~SCTP_PCB_FLAGS_SND_ITERATOR_UP;
6880 SCTP_FREE(ca, SCTP_M_COPYAL);
6881 SCTP_LTRACE_ERR_RET_PKT(m, inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EFAULT);
6882 return (EFAULT);
6883 }
6884 return (0);
6885 }
6886
6887
6888 void
sctp_toss_old_cookies(struct sctp_tcb * stcb,struct sctp_association * asoc)6889 sctp_toss_old_cookies(struct sctp_tcb *stcb, struct sctp_association *asoc)
6890 {
6891 struct sctp_tmit_chunk *chk, *nchk;
6892
6893 TAILQ_FOREACH_SAFE(chk, &asoc->control_send_queue, sctp_next, nchk) {
6894 if (chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) {
6895 TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next);
6896 asoc->ctrl_queue_cnt--;
6897 if (chk->data) {
6898 sctp_m_freem(chk->data);
6899 chk->data = NULL;
6900 }
6901 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
6902 }
6903 }
6904 }
6905
6906 void
sctp_toss_old_asconf(struct sctp_tcb * stcb)6907 sctp_toss_old_asconf(struct sctp_tcb *stcb)
6908 {
6909 struct sctp_association *asoc;
6910 struct sctp_tmit_chunk *chk, *nchk;
6911 struct sctp_asconf_chunk *acp;
6912
6913 asoc = &stcb->asoc;
6914 TAILQ_FOREACH_SAFE(chk, &asoc->asconf_send_queue, sctp_next, nchk) {
6915 /* find SCTP_ASCONF chunk in queue */
6916 if (chk->rec.chunk_id.id == SCTP_ASCONF) {
6917 if (chk->data) {
6918 acp = mtod(chk->data, struct sctp_asconf_chunk *);
6919 if (SCTP_TSN_GT(ntohl(acp->serial_number), asoc->asconf_seq_out_acked)) {
6920 /* Not Acked yet */
6921 break;
6922 }
6923 }
6924 TAILQ_REMOVE(&asoc->asconf_send_queue, chk, sctp_next);
6925 asoc->ctrl_queue_cnt--;
6926 if (chk->data) {
6927 sctp_m_freem(chk->data);
6928 chk->data = NULL;
6929 }
6930 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
6931 }
6932 }
6933 }
6934
6935
6936 static void
sctp_clean_up_datalist(struct sctp_tcb * stcb,struct sctp_association * asoc,struct sctp_tmit_chunk ** data_list,int bundle_at,struct sctp_nets * net)6937 sctp_clean_up_datalist(struct sctp_tcb *stcb,
6938 struct sctp_association *asoc,
6939 struct sctp_tmit_chunk **data_list,
6940 int bundle_at,
6941 struct sctp_nets *net)
6942 {
6943 int i;
6944 struct sctp_tmit_chunk *tp1;
6945
6946 for (i = 0; i < bundle_at; i++) {
6947 /* off of the send queue */
6948 TAILQ_REMOVE(&asoc->send_queue, data_list[i], sctp_next);
6949 asoc->send_queue_cnt--;
6950 if (i > 0) {
6951 /*
6952 * Any chunk NOT 0 you zap the time chunk 0 gets
6953 * zapped or set based on if a RTO measurment is
6954 * needed.
6955 */
6956 data_list[i]->do_rtt = 0;
6957 }
6958 /* record time */
6959 data_list[i]->sent_rcv_time = net->last_sent_time;
6960 data_list[i]->rec.data.cwnd_at_send = net->cwnd;
6961 data_list[i]->rec.data.fast_retran_tsn = data_list[i]->rec.data.tsn;
6962 if (data_list[i]->whoTo == NULL) {
6963 data_list[i]->whoTo = net;
6964 atomic_add_int(&net->ref_count, 1);
6965 }
6966 /* on to the sent queue */
6967 tp1 = TAILQ_LAST(&asoc->sent_queue, sctpchunk_listhead);
6968 if ((tp1) && SCTP_TSN_GT(tp1->rec.data.tsn, data_list[i]->rec.data.tsn)) {
6969 struct sctp_tmit_chunk *tpp;
6970
6971 /* need to move back */
6972 back_up_more:
6973 tpp = TAILQ_PREV(tp1, sctpchunk_listhead, sctp_next);
6974 if (tpp == NULL) {
6975 TAILQ_INSERT_BEFORE(tp1, data_list[i], sctp_next);
6976 goto all_done;
6977 }
6978 tp1 = tpp;
6979 if (SCTP_TSN_GT(tp1->rec.data.tsn, data_list[i]->rec.data.tsn)) {
6980 goto back_up_more;
6981 }
6982 TAILQ_INSERT_AFTER(&asoc->sent_queue, tp1, data_list[i], sctp_next);
6983 } else {
6984 TAILQ_INSERT_TAIL(&asoc->sent_queue,
6985 data_list[i],
6986 sctp_next);
6987 }
6988 all_done:
6989 /* This does not lower until the cum-ack passes it */
6990 asoc->sent_queue_cnt++;
6991 if ((asoc->peers_rwnd <= 0) &&
6992 (asoc->total_flight == 0) &&
6993 (bundle_at == 1)) {
6994 /* Mark the chunk as being a window probe */
6995 SCTP_STAT_INCR(sctps_windowprobed);
6996 }
6997 #ifdef SCTP_AUDITING_ENABLED
6998 sctp_audit_log(0xC2, 3);
6999 #endif
7000 data_list[i]->sent = SCTP_DATAGRAM_SENT;
7001 data_list[i]->snd_count = 1;
7002 data_list[i]->rec.data.chunk_was_revoked = 0;
7003 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
7004 sctp_misc_ints(SCTP_FLIGHT_LOG_UP,
7005 data_list[i]->whoTo->flight_size,
7006 data_list[i]->book_size,
7007 (uint32_t)(uintptr_t)data_list[i]->whoTo,
7008 data_list[i]->rec.data.tsn);
7009 }
7010 sctp_flight_size_increase(data_list[i]);
7011 sctp_total_flight_increase(stcb, data_list[i]);
7012 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_RWND_ENABLE) {
7013 sctp_log_rwnd(SCTP_DECREASE_PEER_RWND,
7014 asoc->peers_rwnd, data_list[i]->send_size, SCTP_BASE_SYSCTL(sctp_peer_chunk_oh));
7015 }
7016 asoc->peers_rwnd = sctp_sbspace_sub(asoc->peers_rwnd,
7017 (uint32_t)(data_list[i]->send_size + SCTP_BASE_SYSCTL(sctp_peer_chunk_oh)));
7018 if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
7019 /* SWS sender side engages */
7020 asoc->peers_rwnd = 0;
7021 }
7022 }
7023 if (asoc->cc_functions.sctp_cwnd_update_packet_transmitted) {
7024 (*asoc->cc_functions.sctp_cwnd_update_packet_transmitted) (stcb, net);
7025 }
7026 }
7027
7028 static void
sctp_clean_up_ctl(struct sctp_tcb * stcb,struct sctp_association * asoc,int so_locked)7029 sctp_clean_up_ctl(struct sctp_tcb *stcb, struct sctp_association *asoc, int so_locked)
7030 {
7031 struct sctp_tmit_chunk *chk, *nchk;
7032
7033 TAILQ_FOREACH_SAFE(chk, &asoc->control_send_queue, sctp_next, nchk) {
7034 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
7035 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK) || /* EY */
7036 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_REQUEST) ||
7037 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_ACK) ||
7038 (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) ||
7039 (chk->rec.chunk_id.id == SCTP_SHUTDOWN) ||
7040 (chk->rec.chunk_id.id == SCTP_SHUTDOWN_ACK) ||
7041 (chk->rec.chunk_id.id == SCTP_OPERATION_ERROR) ||
7042 (chk->rec.chunk_id.id == SCTP_PACKET_DROPPED) ||
7043 (chk->rec.chunk_id.id == SCTP_COOKIE_ACK) ||
7044 (chk->rec.chunk_id.id == SCTP_ECN_CWR) ||
7045 (chk->rec.chunk_id.id == SCTP_ASCONF_ACK)) {
7046 /* Stray chunks must be cleaned up */
7047 clean_up_anyway:
7048 TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next);
7049 asoc->ctrl_queue_cnt--;
7050 if (chk->data) {
7051 sctp_m_freem(chk->data);
7052 chk->data = NULL;
7053 }
7054 if (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) {
7055 asoc->fwd_tsn_cnt--;
7056 }
7057 sctp_free_a_chunk(stcb, chk, so_locked);
7058 } else if (chk->rec.chunk_id.id == SCTP_STREAM_RESET) {
7059 /* special handling, we must look into the param */
7060 if (chk != asoc->str_reset) {
7061 goto clean_up_anyway;
7062 }
7063 }
7064 }
7065 }
7066
7067 static uint32_t
sctp_can_we_split_this(struct sctp_tcb * stcb,uint32_t length,uint32_t space_left,uint32_t frag_point,int eeor_on)7068 sctp_can_we_split_this(struct sctp_tcb *stcb, uint32_t length,
7069 uint32_t space_left, uint32_t frag_point, int eeor_on)
7070 {
7071 /*
7072 * Make a decision on if I should split a msg into multiple parts.
7073 * This is only asked of incomplete messages.
7074 */
7075 if (eeor_on) {
7076 /*
7077 * If we are doing EEOR we need to always send it if its the
7078 * entire thing, since it might be all the guy is putting in
7079 * the hopper.
7080 */
7081 if (space_left >= length) {
7082 /*-
7083 * If we have data outstanding,
7084 * we get another chance when the sack
7085 * arrives to transmit - wait for more data
7086 */
7087 if (stcb->asoc.total_flight == 0) {
7088 /*
7089 * If nothing is in flight, we zero the
7090 * packet counter.
7091 */
7092 return (length);
7093 }
7094 return (0);
7095
7096 } else {
7097 /* You can fill the rest */
7098 return (space_left);
7099 }
7100 }
7101 /*-
7102 * For those strange folk that make the send buffer
7103 * smaller than our fragmentation point, we can't
7104 * get a full msg in so we have to allow splitting.
7105 */
7106 if (SCTP_SB_LIMIT_SND(stcb->sctp_socket) < frag_point) {
7107 return (length);
7108 }
7109 if ((length <= space_left) ||
7110 ((length - space_left) < SCTP_BASE_SYSCTL(sctp_min_residual))) {
7111 /* Sub-optimial residual don't split in non-eeor mode. */
7112 return (0);
7113 }
7114 /*
7115 * If we reach here length is larger than the space_left. Do we wish
7116 * to split it for the sake of packet putting together?
7117 */
7118 if (space_left >= min(SCTP_BASE_SYSCTL(sctp_min_split_point), frag_point)) {
7119 /* Its ok to split it */
7120 return (min(space_left, frag_point));
7121 }
7122 /* Nope, can't split */
7123 return (0);
7124 }
7125
7126 static uint32_t
sctp_move_to_outqueue(struct sctp_tcb * stcb,struct sctp_stream_out * strq,uint32_t space_left,uint32_t frag_point,int * giveup,int eeor_mode,int * bail,int so_locked)7127 sctp_move_to_outqueue(struct sctp_tcb *stcb,
7128 struct sctp_stream_out *strq,
7129 uint32_t space_left,
7130 uint32_t frag_point,
7131 int *giveup,
7132 int eeor_mode,
7133 int *bail,
7134 int so_locked)
7135 {
7136 /* Move from the stream to the send_queue keeping track of the total */
7137 struct sctp_association *asoc;
7138 struct sctp_stream_queue_pending *sp;
7139 struct sctp_tmit_chunk *chk;
7140 struct sctp_data_chunk *dchkh = NULL;
7141 struct sctp_idata_chunk *ndchkh = NULL;
7142 uint32_t to_move, length;
7143 int leading;
7144 uint8_t rcv_flags = 0;
7145 uint8_t some_taken;
7146 uint8_t send_lock_up = 0;
7147
7148 SCTP_TCB_LOCK_ASSERT(stcb);
7149 asoc = &stcb->asoc;
7150 one_more_time:
7151 /* sa_ignore FREED_MEMORY */
7152 sp = TAILQ_FIRST(&strq->outqueue);
7153 if (sp == NULL) {
7154 if (send_lock_up == 0) {
7155 SCTP_TCB_SEND_LOCK(stcb);
7156 send_lock_up = 1;
7157 }
7158 sp = TAILQ_FIRST(&strq->outqueue);
7159 if (sp) {
7160 goto one_more_time;
7161 }
7162 if ((sctp_is_feature_on(stcb->sctp_ep, SCTP_PCB_FLAGS_EXPLICIT_EOR) == 0) &&
7163 (stcb->asoc.idata_supported == 0) &&
7164 (strq->last_msg_incomplete)) {
7165 SCTP_PRINTF("Huh? Stream:%d lm_in_c=%d but queue is NULL\n",
7166 strq->sid,
7167 strq->last_msg_incomplete);
7168 strq->last_msg_incomplete = 0;
7169 }
7170 to_move = 0;
7171 if (send_lock_up) {
7172 SCTP_TCB_SEND_UNLOCK(stcb);
7173 send_lock_up = 0;
7174 }
7175 goto out_of;
7176 }
7177 if ((sp->msg_is_complete) && (sp->length == 0)) {
7178 if (sp->sender_all_done) {
7179 /*
7180 * We are doing deferred cleanup. Last time through
7181 * when we took all the data the sender_all_done was
7182 * not set.
7183 */
7184 if ((sp->put_last_out == 0) && (sp->discard_rest == 0)) {
7185 SCTP_PRINTF("Gak, put out entire msg with NO end!-1\n");
7186 SCTP_PRINTF("sender_done:%d len:%d msg_comp:%d put_last_out:%d send_lock:%d\n",
7187 sp->sender_all_done,
7188 sp->length,
7189 sp->msg_is_complete,
7190 sp->put_last_out,
7191 send_lock_up);
7192 }
7193 if ((TAILQ_NEXT(sp, next) == NULL) && (send_lock_up == 0)) {
7194 SCTP_TCB_SEND_LOCK(stcb);
7195 send_lock_up = 1;
7196 }
7197 atomic_subtract_int(&asoc->stream_queue_cnt, 1);
7198 TAILQ_REMOVE(&strq->outqueue, sp, next);
7199 stcb->asoc.ss_functions.sctp_ss_remove_from_stream(stcb, asoc, strq, sp, send_lock_up);
7200 if ((strq->state == SCTP_STREAM_RESET_PENDING) &&
7201 (strq->chunks_on_queues == 0) &&
7202 TAILQ_EMPTY(&strq->outqueue)) {
7203 stcb->asoc.trigger_reset = 1;
7204 }
7205 if (sp->net) {
7206 sctp_free_remote_addr(sp->net);
7207 sp->net = NULL;
7208 }
7209 if (sp->data) {
7210 sctp_m_freem(sp->data);
7211 sp->data = NULL;
7212 }
7213 sctp_free_a_strmoq(stcb, sp, so_locked);
7214 /* we can't be locked to it */
7215 if (send_lock_up) {
7216 SCTP_TCB_SEND_UNLOCK(stcb);
7217 send_lock_up = 0;
7218 }
7219 /* back to get the next msg */
7220 goto one_more_time;
7221 } else {
7222 /*
7223 * sender just finished this but still holds a
7224 * reference
7225 */
7226 *giveup = 1;
7227 to_move = 0;
7228 goto out_of;
7229 }
7230 } else {
7231 /* is there some to get */
7232 if (sp->length == 0) {
7233 /* no */
7234 *giveup = 1;
7235 to_move = 0;
7236 goto out_of;
7237 } else if (sp->discard_rest) {
7238 if (send_lock_up == 0) {
7239 SCTP_TCB_SEND_LOCK(stcb);
7240 send_lock_up = 1;
7241 }
7242 /* Whack down the size */
7243 atomic_subtract_int(&stcb->asoc.total_output_queue_size, sp->length);
7244 if ((stcb->sctp_socket != NULL) &&
7245 ((stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) ||
7246 (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL))) {
7247 atomic_subtract_int(&stcb->sctp_socket->so_snd.sb_cc, sp->length);
7248 }
7249 if (sp->data) {
7250 sctp_m_freem(sp->data);
7251 sp->data = NULL;
7252 sp->tail_mbuf = NULL;
7253 }
7254 sp->length = 0;
7255 sp->some_taken = 1;
7256 *giveup = 1;
7257 to_move = 0;
7258 goto out_of;
7259 }
7260 }
7261 some_taken = sp->some_taken;
7262 re_look:
7263 length = sp->length;
7264 if (sp->msg_is_complete) {
7265 /* The message is complete */
7266 to_move = min(length, frag_point);
7267 if (to_move == length) {
7268 /* All of it fits in the MTU */
7269 if (sp->some_taken) {
7270 rcv_flags |= SCTP_DATA_LAST_FRAG;
7271 } else {
7272 rcv_flags |= SCTP_DATA_NOT_FRAG;
7273 }
7274 sp->put_last_out = 1;
7275 if (sp->sinfo_flags & SCTP_SACK_IMMEDIATELY) {
7276 rcv_flags |= SCTP_DATA_SACK_IMMEDIATELY;
7277 }
7278 } else {
7279 /* Not all of it fits, we fragment */
7280 if (sp->some_taken == 0) {
7281 rcv_flags |= SCTP_DATA_FIRST_FRAG;
7282 }
7283 sp->some_taken = 1;
7284 }
7285 } else {
7286 to_move = sctp_can_we_split_this(stcb, length, space_left, frag_point, eeor_mode);
7287 if (to_move) {
7288 /*-
7289 * We use a snapshot of length in case it
7290 * is expanding during the compare.
7291 */
7292 uint32_t llen;
7293
7294 llen = length;
7295 if (to_move >= llen) {
7296 to_move = llen;
7297 if (send_lock_up == 0) {
7298 /*-
7299 * We are taking all of an incomplete msg
7300 * thus we need a send lock.
7301 */
7302 SCTP_TCB_SEND_LOCK(stcb);
7303 send_lock_up = 1;
7304 if (sp->msg_is_complete) {
7305 /*
7306 * the sender finished the
7307 * msg
7308 */
7309 goto re_look;
7310 }
7311 }
7312 }
7313 if (sp->some_taken == 0) {
7314 rcv_flags |= SCTP_DATA_FIRST_FRAG;
7315 sp->some_taken = 1;
7316 }
7317 } else {
7318 /* Nothing to take. */
7319 *giveup = 1;
7320 to_move = 0;
7321 goto out_of;
7322 }
7323 }
7324
7325 /* If we reach here, we can copy out a chunk */
7326 sctp_alloc_a_chunk(stcb, chk);
7327 if (chk == NULL) {
7328 /* No chunk memory */
7329 *giveup = 1;
7330 to_move = 0;
7331 goto out_of;
7332 }
7333 /*
7334 * Setup for unordered if needed by looking at the user sent info
7335 * flags.
7336 */
7337 if (sp->sinfo_flags & SCTP_UNORDERED) {
7338 rcv_flags |= SCTP_DATA_UNORDERED;
7339 }
7340 if (SCTP_BASE_SYSCTL(sctp_enable_sack_immediately) &&
7341 (sp->sinfo_flags & SCTP_EOF) == SCTP_EOF) {
7342 rcv_flags |= SCTP_DATA_SACK_IMMEDIATELY;
7343 }
7344 /* clear out the chunk before setting up */
7345 memset(chk, 0, sizeof(*chk));
7346 chk->rec.data.rcv_flags = rcv_flags;
7347
7348 if (to_move >= length) {
7349 /* we think we can steal the whole thing */
7350 if ((sp->sender_all_done == 0) && (send_lock_up == 0)) {
7351 SCTP_TCB_SEND_LOCK(stcb);
7352 send_lock_up = 1;
7353 }
7354 if (to_move < sp->length) {
7355 /* bail, it changed */
7356 goto dont_do_it;
7357 }
7358 chk->data = sp->data;
7359 chk->last_mbuf = sp->tail_mbuf;
7360 /* register the stealing */
7361 sp->data = sp->tail_mbuf = NULL;
7362 } else {
7363 struct mbuf *m;
7364
7365 dont_do_it:
7366 chk->data = SCTP_M_COPYM(sp->data, 0, to_move, M_NOWAIT);
7367 chk->last_mbuf = NULL;
7368 if (chk->data == NULL) {
7369 sp->some_taken = some_taken;
7370 sctp_free_a_chunk(stcb, chk, so_locked);
7371 *bail = 1;
7372 to_move = 0;
7373 goto out_of;
7374 }
7375 #ifdef SCTP_MBUF_LOGGING
7376 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
7377 sctp_log_mbc(chk->data, SCTP_MBUF_ICOPY);
7378 }
7379 #endif
7380 /* Pull off the data */
7381 m_adj(sp->data, to_move);
7382 /* Now lets work our way down and compact it */
7383 m = sp->data;
7384 while (m && (SCTP_BUF_LEN(m) == 0)) {
7385 sp->data = SCTP_BUF_NEXT(m);
7386 SCTP_BUF_NEXT(m) = NULL;
7387 if (sp->tail_mbuf == m) {
7388 /*-
7389 * Freeing tail? TSNH since
7390 * we supposedly were taking less
7391 * than the sp->length.
7392 */
7393 #ifdef INVARIANTS
7394 panic("Huh, freing tail? - TSNH");
7395 #else
7396 SCTP_PRINTF("Huh, freeing tail? - TSNH\n");
7397 sp->tail_mbuf = sp->data = NULL;
7398 sp->length = 0;
7399 #endif
7400
7401 }
7402 sctp_m_free(m);
7403 m = sp->data;
7404 }
7405 }
7406 if (SCTP_BUF_IS_EXTENDED(chk->data)) {
7407 chk->copy_by_ref = 1;
7408 } else {
7409 chk->copy_by_ref = 0;
7410 }
7411 /*
7412 * get last_mbuf and counts of mb usage This is ugly but hopefully
7413 * its only one mbuf.
7414 */
7415 if (chk->last_mbuf == NULL) {
7416 chk->last_mbuf = chk->data;
7417 while (SCTP_BUF_NEXT(chk->last_mbuf) != NULL) {
7418 chk->last_mbuf = SCTP_BUF_NEXT(chk->last_mbuf);
7419 }
7420 }
7421
7422 if (to_move > length) {
7423 /*- This should not happen either
7424 * since we always lower to_move to the size
7425 * of sp->length if its larger.
7426 */
7427 #ifdef INVARIANTS
7428 panic("Huh, how can to_move be larger?");
7429 #else
7430 SCTP_PRINTF("Huh, how can to_move be larger?\n");
7431 sp->length = 0;
7432 #endif
7433 } else {
7434 atomic_subtract_int(&sp->length, to_move);
7435 }
7436 leading = SCTP_DATA_CHUNK_OVERHEAD(stcb);
7437 if (M_LEADINGSPACE(chk->data) < leading) {
7438 /* Not enough room for a chunk header, get some */
7439 struct mbuf *m;
7440
7441 m = sctp_get_mbuf_for_msg(1, 0, M_NOWAIT, 1, MT_DATA);
7442 if (m == NULL) {
7443 /*
7444 * we're in trouble here. _PREPEND below will free
7445 * all the data if there is no leading space, so we
7446 * must put the data back and restore.
7447 */
7448 if (send_lock_up == 0) {
7449 SCTP_TCB_SEND_LOCK(stcb);
7450 send_lock_up = 1;
7451 }
7452 if (sp->data == NULL) {
7453 /* unsteal the data */
7454 sp->data = chk->data;
7455 sp->tail_mbuf = chk->last_mbuf;
7456 } else {
7457 struct mbuf *m_tmp;
7458
7459 /* reassemble the data */
7460 m_tmp = sp->data;
7461 sp->data = chk->data;
7462 SCTP_BUF_NEXT(chk->last_mbuf) = m_tmp;
7463 }
7464 sp->some_taken = some_taken;
7465 atomic_add_int(&sp->length, to_move);
7466 chk->data = NULL;
7467 *bail = 1;
7468 sctp_free_a_chunk(stcb, chk, so_locked);
7469 to_move = 0;
7470 goto out_of;
7471 } else {
7472 SCTP_BUF_LEN(m) = 0;
7473 SCTP_BUF_NEXT(m) = chk->data;
7474 chk->data = m;
7475 M_ALIGN(chk->data, 4);
7476 }
7477 }
7478 SCTP_BUF_PREPEND(chk->data, SCTP_DATA_CHUNK_OVERHEAD(stcb), M_NOWAIT);
7479 if (chk->data == NULL) {
7480 /* HELP, TSNH since we assured it would not above? */
7481 #ifdef INVARIANTS
7482 panic("prepend fails HELP?");
7483 #else
7484 SCTP_PRINTF("prepend fails HELP?\n");
7485 sctp_free_a_chunk(stcb, chk, so_locked);
7486 #endif
7487 *bail = 1;
7488 to_move = 0;
7489 goto out_of;
7490 }
7491 sctp_snd_sb_alloc(stcb, SCTP_DATA_CHUNK_OVERHEAD(stcb));
7492 chk->book_size = chk->send_size = (uint16_t)(to_move + SCTP_DATA_CHUNK_OVERHEAD(stcb));
7493 chk->book_size_scale = 0;
7494 chk->sent = SCTP_DATAGRAM_UNSENT;
7495
7496 chk->flags = 0;
7497 chk->asoc = &stcb->asoc;
7498 chk->pad_inplace = 0;
7499 chk->no_fr_allowed = 0;
7500 if (stcb->asoc.idata_supported == 0) {
7501 if (rcv_flags & SCTP_DATA_UNORDERED) {
7502 /* Just use 0. The receiver ignores the values. */
7503 chk->rec.data.mid = 0;
7504 } else {
7505 chk->rec.data.mid = strq->next_mid_ordered;
7506 if (rcv_flags & SCTP_DATA_LAST_FRAG) {
7507 strq->next_mid_ordered++;
7508 }
7509 }
7510 } else {
7511 if (rcv_flags & SCTP_DATA_UNORDERED) {
7512 chk->rec.data.mid = strq->next_mid_unordered;
7513 if (rcv_flags & SCTP_DATA_LAST_FRAG) {
7514 strq->next_mid_unordered++;
7515 }
7516 } else {
7517 chk->rec.data.mid = strq->next_mid_ordered;
7518 if (rcv_flags & SCTP_DATA_LAST_FRAG) {
7519 strq->next_mid_ordered++;
7520 }
7521 }
7522 }
7523 chk->rec.data.sid = sp->sid;
7524 chk->rec.data.ppid = sp->ppid;
7525 chk->rec.data.context = sp->context;
7526 chk->rec.data.doing_fast_retransmit = 0;
7527
7528 chk->rec.data.timetodrop = sp->ts;
7529 chk->flags = sp->act_flags;
7530
7531 if (sp->net) {
7532 chk->whoTo = sp->net;
7533 atomic_add_int(&chk->whoTo->ref_count, 1);
7534 } else
7535 chk->whoTo = NULL;
7536
7537 if (sp->holds_key_ref) {
7538 chk->auth_keyid = sp->auth_keyid;
7539 sctp_auth_key_acquire(stcb, chk->auth_keyid);
7540 chk->holds_key_ref = 1;
7541 }
7542 chk->rec.data.tsn = atomic_fetchadd_int(&asoc->sending_seq, 1);
7543 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_AT_SEND_2_OUTQ) {
7544 sctp_misc_ints(SCTP_STRMOUT_LOG_SEND,
7545 (uint32_t)(uintptr_t)stcb, sp->length,
7546 (uint32_t)((chk->rec.data.sid << 16) | (0x0000ffff & chk->rec.data.mid)),
7547 chk->rec.data.tsn);
7548 }
7549 if (stcb->asoc.idata_supported == 0) {
7550 dchkh = mtod(chk->data, struct sctp_data_chunk *);
7551 } else {
7552 ndchkh = mtod(chk->data, struct sctp_idata_chunk *);
7553 }
7554 /*
7555 * Put the rest of the things in place now. Size was done earlier in
7556 * previous loop prior to padding.
7557 */
7558
7559 #ifdef SCTP_ASOCLOG_OF_TSNS
7560 SCTP_TCB_LOCK_ASSERT(stcb);
7561 if (asoc->tsn_out_at >= SCTP_TSN_LOG_SIZE) {
7562 asoc->tsn_out_at = 0;
7563 asoc->tsn_out_wrapped = 1;
7564 }
7565 asoc->out_tsnlog[asoc->tsn_out_at].tsn = chk->rec.data.tsn;
7566 asoc->out_tsnlog[asoc->tsn_out_at].strm = chk->rec.data.sid;
7567 asoc->out_tsnlog[asoc->tsn_out_at].seq = chk->rec.data.mid;
7568 asoc->out_tsnlog[asoc->tsn_out_at].sz = chk->send_size;
7569 asoc->out_tsnlog[asoc->tsn_out_at].flgs = chk->rec.data.rcv_flags;
7570 asoc->out_tsnlog[asoc->tsn_out_at].stcb = (void *)stcb;
7571 asoc->out_tsnlog[asoc->tsn_out_at].in_pos = asoc->tsn_out_at;
7572 asoc->out_tsnlog[asoc->tsn_out_at].in_out = 2;
7573 asoc->tsn_out_at++;
7574 #endif
7575 if (stcb->asoc.idata_supported == 0) {
7576 dchkh->ch.chunk_type = SCTP_DATA;
7577 dchkh->ch.chunk_flags = chk->rec.data.rcv_flags;
7578 dchkh->dp.tsn = htonl(chk->rec.data.tsn);
7579 dchkh->dp.sid = htons(strq->sid);
7580 dchkh->dp.ssn = htons((uint16_t)chk->rec.data.mid);
7581 dchkh->dp.ppid = chk->rec.data.ppid;
7582 dchkh->ch.chunk_length = htons(chk->send_size);
7583 } else {
7584 ndchkh->ch.chunk_type = SCTP_IDATA;
7585 ndchkh->ch.chunk_flags = chk->rec.data.rcv_flags;
7586 ndchkh->dp.tsn = htonl(chk->rec.data.tsn);
7587 ndchkh->dp.sid = htons(strq->sid);
7588 ndchkh->dp.reserved = htons(0);
7589 ndchkh->dp.mid = htonl(chk->rec.data.mid);
7590 if (sp->fsn == 0)
7591 ndchkh->dp.ppid_fsn.ppid = chk->rec.data.ppid;
7592 else
7593 ndchkh->dp.ppid_fsn.fsn = htonl(sp->fsn);
7594 sp->fsn++;
7595 ndchkh->ch.chunk_length = htons(chk->send_size);
7596 }
7597 /* Now advance the chk->send_size by the actual pad needed. */
7598 if (chk->send_size < SCTP_SIZE32(chk->book_size)) {
7599 /* need a pad */
7600 struct mbuf *lm;
7601 int pads;
7602
7603 pads = SCTP_SIZE32(chk->book_size) - chk->send_size;
7604 lm = sctp_pad_lastmbuf(chk->data, pads, chk->last_mbuf);
7605 if (lm != NULL) {
7606 chk->last_mbuf = lm;
7607 chk->pad_inplace = 1;
7608 }
7609 chk->send_size += pads;
7610 }
7611 if (PR_SCTP_ENABLED(chk->flags)) {
7612 asoc->pr_sctp_cnt++;
7613 }
7614 if (sp->msg_is_complete && (sp->length == 0) && (sp->sender_all_done)) {
7615 /* All done pull and kill the message */
7616 if (sp->put_last_out == 0) {
7617 SCTP_PRINTF("Gak, put out entire msg with NO end!-2\n");
7618 SCTP_PRINTF("sender_done:%d len:%d msg_comp:%d put_last_out:%d send_lock:%d\n",
7619 sp->sender_all_done,
7620 sp->length,
7621 sp->msg_is_complete,
7622 sp->put_last_out,
7623 send_lock_up);
7624 }
7625 if ((send_lock_up == 0) && (TAILQ_NEXT(sp, next) == NULL)) {
7626 SCTP_TCB_SEND_LOCK(stcb);
7627 send_lock_up = 1;
7628 }
7629 atomic_subtract_int(&asoc->stream_queue_cnt, 1);
7630 TAILQ_REMOVE(&strq->outqueue, sp, next);
7631 stcb->asoc.ss_functions.sctp_ss_remove_from_stream(stcb, asoc, strq, sp, send_lock_up);
7632 if ((strq->state == SCTP_STREAM_RESET_PENDING) &&
7633 (strq->chunks_on_queues == 0) &&
7634 TAILQ_EMPTY(&strq->outqueue)) {
7635 stcb->asoc.trigger_reset = 1;
7636 }
7637 if (sp->net) {
7638 sctp_free_remote_addr(sp->net);
7639 sp->net = NULL;
7640 }
7641 if (sp->data) {
7642 sctp_m_freem(sp->data);
7643 sp->data = NULL;
7644 }
7645 sctp_free_a_strmoq(stcb, sp, so_locked);
7646 }
7647 asoc->chunks_on_out_queue++;
7648 strq->chunks_on_queues++;
7649 TAILQ_INSERT_TAIL(&asoc->send_queue, chk, sctp_next);
7650 asoc->send_queue_cnt++;
7651 out_of:
7652 if (send_lock_up) {
7653 SCTP_TCB_SEND_UNLOCK(stcb);
7654 }
7655 return (to_move);
7656 }
7657
7658
7659 static void
sctp_fill_outqueue(struct sctp_tcb * stcb,struct sctp_nets * net,int frag_point,int eeor_mode,int * quit_now,int so_locked)7660 sctp_fill_outqueue(struct sctp_tcb *stcb,
7661 struct sctp_nets *net, int frag_point, int eeor_mode, int *quit_now, int so_locked)
7662 {
7663 struct sctp_association *asoc;
7664 struct sctp_stream_out *strq;
7665 uint32_t space_left, moved, total_moved;
7666 int bail, giveup;
7667
7668 SCTP_TCB_LOCK_ASSERT(stcb);
7669 asoc = &stcb->asoc;
7670 total_moved = 0;
7671 switch (net->ro._l_addr.sa.sa_family) {
7672 #ifdef INET
7673 case AF_INET:
7674 space_left = net->mtu - SCTP_MIN_V4_OVERHEAD;
7675 break;
7676 #endif
7677 #ifdef INET6
7678 case AF_INET6:
7679 space_left = net->mtu - SCTP_MIN_OVERHEAD;
7680 break;
7681 #endif
7682 default:
7683 /* TSNH */
7684 space_left = net->mtu;
7685 break;
7686 }
7687 /* Need an allowance for the data chunk header too */
7688 space_left -= SCTP_DATA_CHUNK_OVERHEAD(stcb);
7689
7690 /* must make even word boundary */
7691 space_left &= 0xfffffffc;
7692 strq = stcb->asoc.ss_functions.sctp_ss_select_stream(stcb, net, asoc);
7693 giveup = 0;
7694 bail = 0;
7695 while ((space_left > 0) && (strq != NULL)) {
7696 moved = sctp_move_to_outqueue(stcb, strq, space_left, frag_point,
7697 &giveup, eeor_mode, &bail, so_locked);
7698 stcb->asoc.ss_functions.sctp_ss_scheduled(stcb, net, asoc, strq, moved);
7699 if ((giveup != 0) || (bail != 0)) {
7700 break;
7701 }
7702 strq = stcb->asoc.ss_functions.sctp_ss_select_stream(stcb, net, asoc);
7703 total_moved += moved;
7704 if (space_left >= moved) {
7705 space_left -= moved;
7706 } else {
7707 space_left = 0;
7708 }
7709 if (space_left >= SCTP_DATA_CHUNK_OVERHEAD(stcb)) {
7710 space_left -= SCTP_DATA_CHUNK_OVERHEAD(stcb);
7711 } else {
7712 space_left = 0;
7713 }
7714 space_left &= 0xfffffffc;
7715 }
7716 if (bail != 0)
7717 *quit_now = 1;
7718
7719 stcb->asoc.ss_functions.sctp_ss_packet_done(stcb, net, asoc);
7720
7721 if (total_moved == 0) {
7722 if ((stcb->asoc.sctp_cmt_on_off == 0) &&
7723 (net == stcb->asoc.primary_destination)) {
7724 /* ran dry for primary network net */
7725 SCTP_STAT_INCR(sctps_primary_randry);
7726 } else if (stcb->asoc.sctp_cmt_on_off > 0) {
7727 /* ran dry with CMT on */
7728 SCTP_STAT_INCR(sctps_cmt_randry);
7729 }
7730 }
7731 }
7732
7733 void
sctp_fix_ecn_echo(struct sctp_association * asoc)7734 sctp_fix_ecn_echo(struct sctp_association *asoc)
7735 {
7736 struct sctp_tmit_chunk *chk;
7737
7738 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
7739 if (chk->rec.chunk_id.id == SCTP_ECN_ECHO) {
7740 chk->sent = SCTP_DATAGRAM_UNSENT;
7741 }
7742 }
7743 }
7744
7745 void
sctp_move_chunks_from_net(struct sctp_tcb * stcb,struct sctp_nets * net)7746 sctp_move_chunks_from_net(struct sctp_tcb *stcb, struct sctp_nets *net)
7747 {
7748 struct sctp_association *asoc;
7749 struct sctp_tmit_chunk *chk;
7750 struct sctp_stream_queue_pending *sp;
7751 unsigned int i;
7752
7753 if (net == NULL) {
7754 return;
7755 }
7756 asoc = &stcb->asoc;
7757 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
7758 TAILQ_FOREACH(sp, &stcb->asoc.strmout[i].outqueue, next) {
7759 if (sp->net == net) {
7760 sctp_free_remote_addr(sp->net);
7761 sp->net = NULL;
7762 }
7763 }
7764 }
7765 TAILQ_FOREACH(chk, &asoc->send_queue, sctp_next) {
7766 if (chk->whoTo == net) {
7767 sctp_free_remote_addr(chk->whoTo);
7768 chk->whoTo = NULL;
7769 }
7770 }
7771 }
7772
7773 int
sctp_med_chunk_output(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_association * asoc,int * num_out,int * reason_code,int control_only,int from_where,struct timeval * now,int * now_filled,int frag_point,int so_locked)7774 sctp_med_chunk_output(struct sctp_inpcb *inp,
7775 struct sctp_tcb *stcb,
7776 struct sctp_association *asoc,
7777 int *num_out,
7778 int *reason_code,
7779 int control_only, int from_where,
7780 struct timeval *now, int *now_filled, int frag_point, int so_locked)
7781 {
7782 /**
7783 * Ok this is the generic chunk service queue. we must do the
7784 * following:
7785 * - Service the stream queue that is next, moving any
7786 * message (note I must get a complete message i.e. FIRST/MIDDLE and
7787 * LAST to the out queue in one pass) and assigning TSN's. This
7788 * only applys though if the peer does not support NDATA. For NDATA
7789 * chunks its ok to not send the entire message ;-)
7790 * - Check to see if the cwnd/rwnd allows any output, if so we go ahead and
7791 * fomulate and send the low level chunks. Making sure to combine
7792 * any control in the control chunk queue also.
7793 */
7794 struct sctp_nets *net, *start_at, *sack_goes_to = NULL, *old_start_at = NULL;
7795 struct mbuf *outchain, *endoutchain;
7796 struct sctp_tmit_chunk *chk, *nchk;
7797
7798 /* temp arrays for unlinking */
7799 struct sctp_tmit_chunk *data_list[SCTP_MAX_DATA_BUNDLING];
7800 int no_fragmentflg, error;
7801 unsigned int max_rwnd_per_dest, max_send_per_dest;
7802 int one_chunk, hbflag, skip_data_for_this_net;
7803 int asconf, cookie, no_out_cnt;
7804 int bundle_at, ctl_cnt, no_data_chunks, eeor_mode;
7805 unsigned int mtu, r_mtu, omtu, mx_mtu, to_out;
7806 int tsns_sent = 0;
7807 uint32_t auth_offset;
7808 struct sctp_auth_chunk *auth;
7809 uint16_t auth_keyid;
7810 int override_ok = 1;
7811 int skip_fill_up = 0;
7812 int data_auth_reqd = 0;
7813
7814 /*
7815 * JRS 5/14/07 - Add flag for whether a heartbeat is sent to the
7816 * destination.
7817 */
7818 int quit_now = 0;
7819
7820 *num_out = 0;
7821 *reason_code = 0;
7822 auth_keyid = stcb->asoc.authinfo.active_keyid;
7823 if ((asoc->state & SCTP_STATE_SHUTDOWN_PENDING) ||
7824 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
7825 (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXPLICIT_EOR))) {
7826 eeor_mode = 1;
7827 } else {
7828 eeor_mode = 0;
7829 }
7830 ctl_cnt = no_out_cnt = asconf = cookie = 0;
7831 /*
7832 * First lets prime the pump. For each destination, if there is room
7833 * in the flight size, attempt to pull an MTU's worth out of the
7834 * stream queues into the general send_queue
7835 */
7836 #ifdef SCTP_AUDITING_ENABLED
7837 sctp_audit_log(0xC2, 2);
7838 #endif
7839 SCTP_TCB_LOCK_ASSERT(stcb);
7840 hbflag = 0;
7841 if (control_only)
7842 no_data_chunks = 1;
7843 else
7844 no_data_chunks = 0;
7845
7846 /* Nothing to possible to send? */
7847 if ((TAILQ_EMPTY(&asoc->control_send_queue) ||
7848 (asoc->ctrl_queue_cnt == stcb->asoc.ecn_echo_cnt_onq)) &&
7849 TAILQ_EMPTY(&asoc->asconf_send_queue) &&
7850 TAILQ_EMPTY(&asoc->send_queue) &&
7851 sctp_is_there_unsent_data(stcb, so_locked) == 0) {
7852 nothing_to_send:
7853 *reason_code = 9;
7854 return (0);
7855 }
7856 if (asoc->peers_rwnd == 0) {
7857 /* No room in peers rwnd */
7858 *reason_code = 1;
7859 if (asoc->total_flight > 0) {
7860 /* we are allowed one chunk in flight */
7861 no_data_chunks = 1;
7862 }
7863 }
7864 if (stcb->asoc.ecn_echo_cnt_onq) {
7865 /* Record where a sack goes, if any */
7866 if (no_data_chunks &&
7867 (asoc->ctrl_queue_cnt == stcb->asoc.ecn_echo_cnt_onq)) {
7868 /* Nothing but ECNe to send - we don't do that */
7869 goto nothing_to_send;
7870 }
7871 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
7872 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
7873 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK)) {
7874 sack_goes_to = chk->whoTo;
7875 break;
7876 }
7877 }
7878 }
7879 max_rwnd_per_dest = ((asoc->peers_rwnd + asoc->total_flight) / asoc->numnets);
7880 if (stcb->sctp_socket)
7881 max_send_per_dest = SCTP_SB_LIMIT_SND(stcb->sctp_socket) / asoc->numnets;
7882 else
7883 max_send_per_dest = 0;
7884 if (no_data_chunks == 0) {
7885 /* How many non-directed chunks are there? */
7886 TAILQ_FOREACH(chk, &asoc->send_queue, sctp_next) {
7887 if (chk->whoTo == NULL) {
7888 /*
7889 * We already have non-directed chunks on
7890 * the queue, no need to do a fill-up.
7891 */
7892 skip_fill_up = 1;
7893 break;
7894 }
7895 }
7896
7897 }
7898 if ((no_data_chunks == 0) &&
7899 (skip_fill_up == 0) &&
7900 (!stcb->asoc.ss_functions.sctp_ss_is_empty(stcb, asoc))) {
7901 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
7902 /*
7903 * This for loop we are in takes in each net, if
7904 * its's got space in cwnd and has data sent to it
7905 * (when CMT is off) then it calls
7906 * sctp_fill_outqueue for the net. This gets data on
7907 * the send queue for that network.
7908 *
7909 * In sctp_fill_outqueue TSN's are assigned and data
7910 * is copied out of the stream buffers. Note mostly
7911 * copy by reference (we hope).
7912 */
7913 net->window_probe = 0;
7914 if ((net != stcb->asoc.alternate) &&
7915 ((net->dest_state & SCTP_ADDR_PF) ||
7916 (!(net->dest_state & SCTP_ADDR_REACHABLE)) ||
7917 (net->dest_state & SCTP_ADDR_UNCONFIRMED))) {
7918 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
7919 sctp_log_cwnd(stcb, net, 1,
7920 SCTP_CWND_LOG_FILL_OUTQ_CALLED);
7921 }
7922 continue;
7923 }
7924 if ((stcb->asoc.cc_functions.sctp_cwnd_new_transmission_begins) &&
7925 (net->flight_size == 0)) {
7926 (*stcb->asoc.cc_functions.sctp_cwnd_new_transmission_begins) (stcb, net);
7927 }
7928 if (net->flight_size >= net->cwnd) {
7929 /* skip this network, no room - can't fill */
7930 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
7931 sctp_log_cwnd(stcb, net, 3,
7932 SCTP_CWND_LOG_FILL_OUTQ_CALLED);
7933 }
7934 continue;
7935 }
7936 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
7937 sctp_log_cwnd(stcb, net, 4, SCTP_CWND_LOG_FILL_OUTQ_CALLED);
7938 }
7939 sctp_fill_outqueue(stcb, net, frag_point, eeor_mode, &quit_now, so_locked);
7940 if (quit_now) {
7941 /* memory alloc failure */
7942 no_data_chunks = 1;
7943 break;
7944 }
7945 }
7946 }
7947 /* now service each destination and send out what we can for it */
7948 /* Nothing to send? */
7949 if (TAILQ_EMPTY(&asoc->control_send_queue) &&
7950 TAILQ_EMPTY(&asoc->asconf_send_queue) &&
7951 TAILQ_EMPTY(&asoc->send_queue)) {
7952 *reason_code = 8;
7953 return (0);
7954 }
7955
7956 if (asoc->sctp_cmt_on_off > 0) {
7957 /* get the last start point */
7958 start_at = asoc->last_net_cmt_send_started;
7959 if (start_at == NULL) {
7960 /* null so to beginning */
7961 start_at = TAILQ_FIRST(&asoc->nets);
7962 } else {
7963 start_at = TAILQ_NEXT(asoc->last_net_cmt_send_started, sctp_next);
7964 if (start_at == NULL) {
7965 start_at = TAILQ_FIRST(&asoc->nets);
7966 }
7967 }
7968 asoc->last_net_cmt_send_started = start_at;
7969 } else {
7970 start_at = TAILQ_FIRST(&asoc->nets);
7971 }
7972 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
7973 if (chk->whoTo == NULL) {
7974 if (asoc->alternate) {
7975 chk->whoTo = asoc->alternate;
7976 } else {
7977 chk->whoTo = asoc->primary_destination;
7978 }
7979 atomic_add_int(&chk->whoTo->ref_count, 1);
7980 }
7981 }
7982 old_start_at = NULL;
7983 again_one_more_time:
7984 for (net = start_at; net != NULL; net = TAILQ_NEXT(net, sctp_next)) {
7985 /* how much can we send? */
7986 /* SCTPDBG("Examine for sending net:%x\n", (uint32_t)net); */
7987 if (old_start_at && (old_start_at == net)) {
7988 /* through list ocmpletely. */
7989 break;
7990 }
7991 tsns_sent = 0xa;
7992 if (TAILQ_EMPTY(&asoc->control_send_queue) &&
7993 TAILQ_EMPTY(&asoc->asconf_send_queue) &&
7994 (net->flight_size >= net->cwnd)) {
7995 /*
7996 * Nothing on control or asconf and flight is full,
7997 * we can skip even in the CMT case.
7998 */
7999 continue;
8000 }
8001 bundle_at = 0;
8002 endoutchain = outchain = NULL;
8003 auth = NULL;
8004 auth_offset = 0;
8005 no_fragmentflg = 1;
8006 one_chunk = 0;
8007 if (net->dest_state & SCTP_ADDR_UNCONFIRMED) {
8008 skip_data_for_this_net = 1;
8009 } else {
8010 skip_data_for_this_net = 0;
8011 }
8012 switch (((struct sockaddr *)&net->ro._l_addr)->sa_family) {
8013 #ifdef INET
8014 case AF_INET:
8015 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8016 break;
8017 #endif
8018 #ifdef INET6
8019 case AF_INET6:
8020 mtu = net->mtu - SCTP_MIN_OVERHEAD;
8021 break;
8022 #endif
8023 default:
8024 /* TSNH */
8025 mtu = net->mtu;
8026 break;
8027 }
8028 mx_mtu = mtu;
8029 to_out = 0;
8030 if (mtu > asoc->peers_rwnd) {
8031 if (asoc->total_flight > 0) {
8032 /* We have a packet in flight somewhere */
8033 r_mtu = asoc->peers_rwnd;
8034 } else {
8035 /* We are always allowed to send one MTU out */
8036 one_chunk = 1;
8037 r_mtu = mtu;
8038 }
8039 } else {
8040 r_mtu = mtu;
8041 }
8042 error = 0;
8043 /************************/
8044 /* ASCONF transmission */
8045 /************************/
8046 /* Now first lets go through the asconf queue */
8047 TAILQ_FOREACH_SAFE(chk, &asoc->asconf_send_queue, sctp_next, nchk) {
8048 if (chk->rec.chunk_id.id != SCTP_ASCONF) {
8049 continue;
8050 }
8051 if (chk->whoTo == NULL) {
8052 if (asoc->alternate == NULL) {
8053 if (asoc->primary_destination != net) {
8054 break;
8055 }
8056 } else {
8057 if (asoc->alternate != net) {
8058 break;
8059 }
8060 }
8061 } else {
8062 if (chk->whoTo != net) {
8063 break;
8064 }
8065 }
8066 if (chk->data == NULL) {
8067 break;
8068 }
8069 if (chk->sent != SCTP_DATAGRAM_UNSENT &&
8070 chk->sent != SCTP_DATAGRAM_RESEND) {
8071 break;
8072 }
8073 /*
8074 * if no AUTH is yet included and this chunk
8075 * requires it, make sure to account for it. We
8076 * don't apply the size until the AUTH chunk is
8077 * actually added below in case there is no room for
8078 * this chunk. NOTE: we overload the use of "omtu"
8079 * here
8080 */
8081 if ((auth == NULL) &&
8082 sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8083 stcb->asoc.peer_auth_chunks)) {
8084 omtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
8085 } else
8086 omtu = 0;
8087 /* Here we do NOT factor the r_mtu */
8088 if ((chk->send_size < (int)(mtu - omtu)) ||
8089 (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) {
8090 /*
8091 * We probably should glom the mbuf chain
8092 * from the chk->data for control but the
8093 * problem is it becomes yet one more level
8094 * of tracking to do if for some reason
8095 * output fails. Then I have got to
8096 * reconstruct the merged control chain.. el
8097 * yucko.. for now we take the easy way and
8098 * do the copy
8099 */
8100 /*
8101 * Add an AUTH chunk, if chunk requires it
8102 * save the offset into the chain for AUTH
8103 */
8104 if ((auth == NULL) &&
8105 (sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8106 stcb->asoc.peer_auth_chunks))) {
8107 outchain = sctp_add_auth_chunk(outchain,
8108 &endoutchain,
8109 &auth,
8110 &auth_offset,
8111 stcb,
8112 chk->rec.chunk_id.id);
8113 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8114 }
8115 outchain = sctp_copy_mbufchain(chk->data, outchain, &endoutchain,
8116 (int)chk->rec.chunk_id.can_take_data,
8117 chk->send_size, chk->copy_by_ref);
8118 if (outchain == NULL) {
8119 *reason_code = 8;
8120 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
8121 return (ENOMEM);
8122 }
8123 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8124 /* update our MTU size */
8125 if (mtu > (chk->send_size + omtu))
8126 mtu -= (chk->send_size + omtu);
8127 else
8128 mtu = 0;
8129 to_out += (chk->send_size + omtu);
8130 /* Do clear IP_DF ? */
8131 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
8132 no_fragmentflg = 0;
8133 }
8134 if (chk->rec.chunk_id.can_take_data)
8135 chk->data = NULL;
8136 /*
8137 * set hb flag since we can use these for
8138 * RTO
8139 */
8140 hbflag = 1;
8141 asconf = 1;
8142 /*
8143 * should sysctl this: don't bundle data
8144 * with ASCONF since it requires AUTH
8145 */
8146 no_data_chunks = 1;
8147 chk->sent = SCTP_DATAGRAM_SENT;
8148 if (chk->whoTo == NULL) {
8149 chk->whoTo = net;
8150 atomic_add_int(&net->ref_count, 1);
8151 }
8152 chk->snd_count++;
8153 if (mtu == 0) {
8154 /*
8155 * Ok we are out of room but we can
8156 * output without effecting the
8157 * flight size since this little guy
8158 * is a control only packet.
8159 */
8160 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, net);
8161 /*
8162 * do NOT clear the asconf flag as
8163 * it is used to do appropriate
8164 * source address selection.
8165 */
8166 if (*now_filled == 0) {
8167 (void)SCTP_GETTIME_TIMEVAL(now);
8168 *now_filled = 1;
8169 }
8170 net->last_sent_time = *now;
8171 hbflag = 0;
8172 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
8173 (struct sockaddr *)&net->ro._l_addr,
8174 outchain, auth_offset, auth,
8175 stcb->asoc.authinfo.active_keyid,
8176 no_fragmentflg, 0, asconf,
8177 inp->sctp_lport, stcb->rport,
8178 htonl(stcb->asoc.peer_vtag),
8179 net->port, NULL,
8180 0, 0,
8181 so_locked))) {
8182 /*
8183 * error, we could not
8184 * output
8185 */
8186 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
8187 if (from_where == 0) {
8188 SCTP_STAT_INCR(sctps_lowlevelerrusr);
8189 }
8190 if (error == ENOBUFS) {
8191 asoc->ifp_had_enobuf = 1;
8192 SCTP_STAT_INCR(sctps_lowlevelerr);
8193 }
8194 /* error, could not output */
8195 if (error == EHOSTUNREACH) {
8196 /*
8197 * Destination went
8198 * unreachable
8199 * during this send
8200 */
8201 sctp_move_chunks_from_net(stcb, net);
8202 }
8203 *reason_code = 7;
8204 break;
8205 } else {
8206 asoc->ifp_had_enobuf = 0;
8207 }
8208 /*
8209 * increase the number we sent, if a
8210 * cookie is sent we don't tell them
8211 * any was sent out.
8212 */
8213 outchain = endoutchain = NULL;
8214 auth = NULL;
8215 auth_offset = 0;
8216 if (!no_out_cnt)
8217 *num_out += ctl_cnt;
8218 /* recalc a clean slate and setup */
8219 switch (net->ro._l_addr.sa.sa_family) {
8220 #ifdef INET
8221 case AF_INET:
8222 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8223 break;
8224 #endif
8225 #ifdef INET6
8226 case AF_INET6:
8227 mtu = net->mtu - SCTP_MIN_OVERHEAD;
8228 break;
8229 #endif
8230 default:
8231 /* TSNH */
8232 mtu = net->mtu;
8233 break;
8234 }
8235 to_out = 0;
8236 no_fragmentflg = 1;
8237 }
8238 }
8239 }
8240 if (error != 0) {
8241 /* try next net */
8242 continue;
8243 }
8244 /************************/
8245 /* Control transmission */
8246 /************************/
8247 /* Now first lets go through the control queue */
8248 TAILQ_FOREACH_SAFE(chk, &asoc->control_send_queue, sctp_next, nchk) {
8249 if ((sack_goes_to) &&
8250 (chk->rec.chunk_id.id == SCTP_ECN_ECHO) &&
8251 (chk->whoTo != sack_goes_to)) {
8252 /*
8253 * if we have a sack in queue, and we are
8254 * looking at an ecn echo that is NOT queued
8255 * to where the sack is going..
8256 */
8257 if (chk->whoTo == net) {
8258 /*
8259 * Don't transmit it to where its
8260 * going (current net)
8261 */
8262 continue;
8263 } else if (sack_goes_to == net) {
8264 /*
8265 * But do transmit it to this
8266 * address
8267 */
8268 goto skip_net_check;
8269 }
8270 }
8271 if (chk->whoTo == NULL) {
8272 if (asoc->alternate == NULL) {
8273 if (asoc->primary_destination != net) {
8274 continue;
8275 }
8276 } else {
8277 if (asoc->alternate != net) {
8278 continue;
8279 }
8280 }
8281 } else {
8282 if (chk->whoTo != net) {
8283 continue;
8284 }
8285 }
8286 skip_net_check:
8287 if (chk->data == NULL) {
8288 continue;
8289 }
8290 if (chk->sent != SCTP_DATAGRAM_UNSENT) {
8291 /*
8292 * It must be unsent. Cookies and ASCONF's
8293 * hang around but there timers will force
8294 * when marked for resend.
8295 */
8296 continue;
8297 }
8298 /*
8299 * if no AUTH is yet included and this chunk
8300 * requires it, make sure to account for it. We
8301 * don't apply the size until the AUTH chunk is
8302 * actually added below in case there is no room for
8303 * this chunk. NOTE: we overload the use of "omtu"
8304 * here
8305 */
8306 if ((auth == NULL) &&
8307 sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8308 stcb->asoc.peer_auth_chunks)) {
8309 omtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
8310 } else
8311 omtu = 0;
8312 /* Here we do NOT factor the r_mtu */
8313 if ((chk->send_size <= (int)(mtu - omtu)) ||
8314 (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) {
8315 /*
8316 * We probably should glom the mbuf chain
8317 * from the chk->data for control but the
8318 * problem is it becomes yet one more level
8319 * of tracking to do if for some reason
8320 * output fails. Then I have got to
8321 * reconstruct the merged control chain.. el
8322 * yucko.. for now we take the easy way and
8323 * do the copy
8324 */
8325 /*
8326 * Add an AUTH chunk, if chunk requires it
8327 * save the offset into the chain for AUTH
8328 */
8329 if ((auth == NULL) &&
8330 (sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
8331 stcb->asoc.peer_auth_chunks))) {
8332 outchain = sctp_add_auth_chunk(outchain,
8333 &endoutchain,
8334 &auth,
8335 &auth_offset,
8336 stcb,
8337 chk->rec.chunk_id.id);
8338 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8339 }
8340 outchain = sctp_copy_mbufchain(chk->data, outchain, &endoutchain,
8341 (int)chk->rec.chunk_id.can_take_data,
8342 chk->send_size, chk->copy_by_ref);
8343 if (outchain == NULL) {
8344 *reason_code = 8;
8345 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
8346 return (ENOMEM);
8347 }
8348 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8349 /* update our MTU size */
8350 if (mtu > (chk->send_size + omtu))
8351 mtu -= (chk->send_size + omtu);
8352 else
8353 mtu = 0;
8354 to_out += (chk->send_size + omtu);
8355 /* Do clear IP_DF ? */
8356 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
8357 no_fragmentflg = 0;
8358 }
8359 if (chk->rec.chunk_id.can_take_data)
8360 chk->data = NULL;
8361 /* Mark things to be removed, if needed */
8362 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
8363 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK) || /* EY */
8364 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_REQUEST) ||
8365 (chk->rec.chunk_id.id == SCTP_HEARTBEAT_ACK) ||
8366 (chk->rec.chunk_id.id == SCTP_SHUTDOWN) ||
8367 (chk->rec.chunk_id.id == SCTP_SHUTDOWN_ACK) ||
8368 (chk->rec.chunk_id.id == SCTP_OPERATION_ERROR) ||
8369 (chk->rec.chunk_id.id == SCTP_COOKIE_ACK) ||
8370 (chk->rec.chunk_id.id == SCTP_ECN_CWR) ||
8371 (chk->rec.chunk_id.id == SCTP_PACKET_DROPPED) ||
8372 (chk->rec.chunk_id.id == SCTP_ASCONF_ACK)) {
8373 if (chk->rec.chunk_id.id == SCTP_HEARTBEAT_REQUEST) {
8374 hbflag = 1;
8375 }
8376 /* remove these chunks at the end */
8377 if ((chk->rec.chunk_id.id == SCTP_SELECTIVE_ACK) ||
8378 (chk->rec.chunk_id.id == SCTP_NR_SELECTIVE_ACK)) {
8379 /* turn off the timer */
8380 if (SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
8381 sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
8382 inp, stcb, NULL,
8383 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_1);
8384 }
8385 }
8386 ctl_cnt++;
8387 } else {
8388 /*
8389 * Other chunks, since they have
8390 * timers running (i.e. COOKIE) we
8391 * just "trust" that it gets sent or
8392 * retransmitted.
8393 */
8394 ctl_cnt++;
8395 if (chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) {
8396 cookie = 1;
8397 no_out_cnt = 1;
8398 } else if (chk->rec.chunk_id.id == SCTP_ECN_ECHO) {
8399 /*
8400 * Increment ecne send count
8401 * here this means we may be
8402 * over-zealous in our
8403 * counting if the send
8404 * fails, but its the best
8405 * place to do it (we used
8406 * to do it in the queue of
8407 * the chunk, but that did
8408 * not tell how many times
8409 * it was sent.
8410 */
8411 SCTP_STAT_INCR(sctps_sendecne);
8412 }
8413 chk->sent = SCTP_DATAGRAM_SENT;
8414 if (chk->whoTo == NULL) {
8415 chk->whoTo = net;
8416 atomic_add_int(&net->ref_count, 1);
8417 }
8418 chk->snd_count++;
8419 }
8420 if (mtu == 0) {
8421 /*
8422 * Ok we are out of room but we can
8423 * output without effecting the
8424 * flight size since this little guy
8425 * is a control only packet.
8426 */
8427 if (asconf) {
8428 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, net);
8429 /*
8430 * do NOT clear the asconf
8431 * flag as it is used to do
8432 * appropriate source
8433 * address selection.
8434 */
8435 }
8436 if (cookie) {
8437 sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, net);
8438 cookie = 0;
8439 }
8440 /* Only HB or ASCONF advances time */
8441 if (hbflag) {
8442 if (*now_filled == 0) {
8443 (void)SCTP_GETTIME_TIMEVAL(now);
8444 *now_filled = 1;
8445 }
8446 net->last_sent_time = *now;
8447 hbflag = 0;
8448 }
8449 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
8450 (struct sockaddr *)&net->ro._l_addr,
8451 outchain,
8452 auth_offset, auth,
8453 stcb->asoc.authinfo.active_keyid,
8454 no_fragmentflg, 0, asconf,
8455 inp->sctp_lport, stcb->rport,
8456 htonl(stcb->asoc.peer_vtag),
8457 net->port, NULL,
8458 0, 0,
8459 so_locked))) {
8460 /*
8461 * error, we could not
8462 * output
8463 */
8464 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
8465 if (from_where == 0) {
8466 SCTP_STAT_INCR(sctps_lowlevelerrusr);
8467 }
8468 if (error == ENOBUFS) {
8469 asoc->ifp_had_enobuf = 1;
8470 SCTP_STAT_INCR(sctps_lowlevelerr);
8471 }
8472 if (error == EHOSTUNREACH) {
8473 /*
8474 * Destination went
8475 * unreachable
8476 * during this send
8477 */
8478 sctp_move_chunks_from_net(stcb, net);
8479 }
8480 *reason_code = 7;
8481 break;
8482 } else {
8483 asoc->ifp_had_enobuf = 0;
8484 }
8485 /*
8486 * increase the number we sent, if a
8487 * cookie is sent we don't tell them
8488 * any was sent out.
8489 */
8490 outchain = endoutchain = NULL;
8491 auth = NULL;
8492 auth_offset = 0;
8493 if (!no_out_cnt)
8494 *num_out += ctl_cnt;
8495 /* recalc a clean slate and setup */
8496 switch (net->ro._l_addr.sa.sa_family) {
8497 #ifdef INET
8498 case AF_INET:
8499 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8500 break;
8501 #endif
8502 #ifdef INET6
8503 case AF_INET6:
8504 mtu = net->mtu - SCTP_MIN_OVERHEAD;
8505 break;
8506 #endif
8507 default:
8508 /* TSNH */
8509 mtu = net->mtu;
8510 break;
8511 }
8512 to_out = 0;
8513 no_fragmentflg = 1;
8514 }
8515 }
8516 }
8517 if (error != 0) {
8518 /* try next net */
8519 continue;
8520 }
8521 /* JRI: if dest is in PF state, do not send data to it */
8522 if ((asoc->sctp_cmt_on_off > 0) &&
8523 (net != stcb->asoc.alternate) &&
8524 (net->dest_state & SCTP_ADDR_PF)) {
8525 goto no_data_fill;
8526 }
8527 if (net->flight_size >= net->cwnd) {
8528 goto no_data_fill;
8529 }
8530 if ((asoc->sctp_cmt_on_off > 0) &&
8531 (SCTP_BASE_SYSCTL(sctp_buffer_splitting) & SCTP_RECV_BUFFER_SPLITTING) &&
8532 (net->flight_size > max_rwnd_per_dest)) {
8533 goto no_data_fill;
8534 }
8535 /*
8536 * We need a specific accounting for the usage of the send
8537 * buffer. We also need to check the number of messages per
8538 * net. For now, this is better than nothing and it disabled
8539 * by default...
8540 */
8541 if ((asoc->sctp_cmt_on_off > 0) &&
8542 (SCTP_BASE_SYSCTL(sctp_buffer_splitting) & SCTP_SEND_BUFFER_SPLITTING) &&
8543 (max_send_per_dest > 0) &&
8544 (net->flight_size > max_send_per_dest)) {
8545 goto no_data_fill;
8546 }
8547 /*********************/
8548 /* Data transmission */
8549 /*********************/
8550 /*
8551 * if AUTH for DATA is required and no AUTH has been added
8552 * yet, account for this in the mtu now... if no data can be
8553 * bundled, this adjustment won't matter anyways since the
8554 * packet will be going out...
8555 */
8556 data_auth_reqd = sctp_auth_is_required_chunk(SCTP_DATA,
8557 stcb->asoc.peer_auth_chunks);
8558 if (data_auth_reqd && (auth == NULL)) {
8559 mtu -= sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
8560 }
8561 /* now lets add any data within the MTU constraints */
8562 switch (((struct sockaddr *)&net->ro._l_addr)->sa_family) {
8563 #ifdef INET
8564 case AF_INET:
8565 if (net->mtu > SCTP_MIN_V4_OVERHEAD)
8566 omtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
8567 else
8568 omtu = 0;
8569 break;
8570 #endif
8571 #ifdef INET6
8572 case AF_INET6:
8573 if (net->mtu > SCTP_MIN_OVERHEAD)
8574 omtu = net->mtu - SCTP_MIN_OVERHEAD;
8575 else
8576 omtu = 0;
8577 break;
8578 #endif
8579 default:
8580 /* TSNH */
8581 omtu = 0;
8582 break;
8583 }
8584 if ((((SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) ||
8585 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED)) &&
8586 (skip_data_for_this_net == 0)) ||
8587 (cookie)) {
8588 TAILQ_FOREACH_SAFE(chk, &asoc->send_queue, sctp_next, nchk) {
8589 if (no_data_chunks) {
8590 /* let only control go out */
8591 *reason_code = 1;
8592 break;
8593 }
8594 if (net->flight_size >= net->cwnd) {
8595 /* skip this net, no room for data */
8596 *reason_code = 2;
8597 break;
8598 }
8599 if ((chk->whoTo != NULL) &&
8600 (chk->whoTo != net)) {
8601 /* Don't send the chunk on this net */
8602 continue;
8603 }
8604
8605 if (asoc->sctp_cmt_on_off == 0) {
8606 if ((asoc->alternate) &&
8607 (asoc->alternate != net) &&
8608 (chk->whoTo == NULL)) {
8609 continue;
8610 } else if ((net != asoc->primary_destination) &&
8611 (asoc->alternate == NULL) &&
8612 (chk->whoTo == NULL)) {
8613 continue;
8614 }
8615 }
8616 if ((chk->send_size > omtu) && ((chk->flags & CHUNK_FLAGS_FRAGMENT_OK) == 0)) {
8617 /*-
8618 * strange, we have a chunk that is
8619 * to big for its destination and
8620 * yet no fragment ok flag.
8621 * Something went wrong when the
8622 * PMTU changed...we did not mark
8623 * this chunk for some reason?? I
8624 * will fix it here by letting IP
8625 * fragment it for now and printing
8626 * a warning. This really should not
8627 * happen ...
8628 */
8629 SCTP_PRINTF("Warning chunk of %d bytes > mtu:%d and yet PMTU disc missed\n",
8630 chk->send_size, mtu);
8631 chk->flags |= CHUNK_FLAGS_FRAGMENT_OK;
8632 }
8633 if (SCTP_BASE_SYSCTL(sctp_enable_sack_immediately) &&
8634 (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) {
8635 struct sctp_data_chunk *dchkh;
8636
8637 dchkh = mtod(chk->data, struct sctp_data_chunk *);
8638 dchkh->ch.chunk_flags |= SCTP_DATA_SACK_IMMEDIATELY;
8639 }
8640 if (((chk->send_size <= mtu) && (chk->send_size <= r_mtu)) ||
8641 ((chk->flags & CHUNK_FLAGS_FRAGMENT_OK) && (chk->send_size <= asoc->peers_rwnd))) {
8642 /* ok we will add this one */
8643
8644 /*
8645 * Add an AUTH chunk, if chunk
8646 * requires it, save the offset into
8647 * the chain for AUTH
8648 */
8649 if (data_auth_reqd) {
8650 if (auth == NULL) {
8651 outchain = sctp_add_auth_chunk(outchain,
8652 &endoutchain,
8653 &auth,
8654 &auth_offset,
8655 stcb,
8656 SCTP_DATA);
8657 auth_keyid = chk->auth_keyid;
8658 override_ok = 0;
8659 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
8660 } else if (override_ok) {
8661 /*
8662 * use this data's
8663 * keyid
8664 */
8665 auth_keyid = chk->auth_keyid;
8666 override_ok = 0;
8667 } else if (auth_keyid != chk->auth_keyid) {
8668 /*
8669 * different keyid,
8670 * so done bundling
8671 */
8672 break;
8673 }
8674 }
8675 outchain = sctp_copy_mbufchain(chk->data, outchain, &endoutchain, 0,
8676 chk->send_size, chk->copy_by_ref);
8677 if (outchain == NULL) {
8678 SCTPDBG(SCTP_DEBUG_OUTPUT3, "No memory?\n");
8679 if (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
8680 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
8681 }
8682 *reason_code = 3;
8683 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
8684 return (ENOMEM);
8685 }
8686 /* upate our MTU size */
8687 /* Do clear IP_DF ? */
8688 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
8689 no_fragmentflg = 0;
8690 }
8691 /* unsigned subtraction of mtu */
8692 if (mtu > chk->send_size)
8693 mtu -= chk->send_size;
8694 else
8695 mtu = 0;
8696 /* unsigned subtraction of r_mtu */
8697 if (r_mtu > chk->send_size)
8698 r_mtu -= chk->send_size;
8699 else
8700 r_mtu = 0;
8701
8702 to_out += chk->send_size;
8703 if ((to_out > mx_mtu) && no_fragmentflg) {
8704 #ifdef INVARIANTS
8705 panic("Exceeding mtu of %d out size is %d", mx_mtu, to_out);
8706 #else
8707 SCTP_PRINTF("Exceeding mtu of %d out size is %d\n",
8708 mx_mtu, to_out);
8709 #endif
8710 }
8711 chk->window_probe = 0;
8712 data_list[bundle_at++] = chk;
8713 if (bundle_at >= SCTP_MAX_DATA_BUNDLING) {
8714 break;
8715 }
8716 if (chk->sent == SCTP_DATAGRAM_UNSENT) {
8717 if ((chk->rec.data.rcv_flags & SCTP_DATA_UNORDERED) == 0) {
8718 SCTP_STAT_INCR_COUNTER64(sctps_outorderchunks);
8719 } else {
8720 SCTP_STAT_INCR_COUNTER64(sctps_outunorderchunks);
8721 }
8722 if (((chk->rec.data.rcv_flags & SCTP_DATA_LAST_FRAG) == SCTP_DATA_LAST_FRAG) &&
8723 ((chk->rec.data.rcv_flags & SCTP_DATA_FIRST_FRAG) == 0))
8724 /*
8725 * Count number of
8726 * user msg's that
8727 * were fragmented
8728 * we do this by
8729 * counting when we
8730 * see a LAST
8731 * fragment only.
8732 */
8733 SCTP_STAT_INCR_COUNTER64(sctps_fragusrmsgs);
8734 }
8735 if ((mtu == 0) || (r_mtu == 0) || (one_chunk)) {
8736 if ((one_chunk) && (stcb->asoc.total_flight == 0)) {
8737 data_list[0]->window_probe = 1;
8738 net->window_probe = 1;
8739 }
8740 break;
8741 }
8742 } else {
8743 /*
8744 * Must be sent in order of the
8745 * TSN's (on a network)
8746 */
8747 break;
8748 }
8749 } /* for (chunk gather loop for this net) */
8750 } /* if asoc.state OPEN */
8751 no_data_fill:
8752 /* Is there something to send for this destination? */
8753 if (outchain) {
8754 /* We may need to start a control timer or two */
8755 if (asconf) {
8756 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp,
8757 stcb, net);
8758 /*
8759 * do NOT clear the asconf flag as it is
8760 * used to do appropriate source address
8761 * selection.
8762 */
8763 }
8764 if (cookie) {
8765 sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, net);
8766 cookie = 0;
8767 }
8768 /* must start a send timer if data is being sent */
8769 if (bundle_at && (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer))) {
8770 /*
8771 * no timer running on this destination
8772 * restart it.
8773 */
8774 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
8775 }
8776 if (bundle_at || hbflag) {
8777 /* For data/asconf and hb set time */
8778 if (*now_filled == 0) {
8779 (void)SCTP_GETTIME_TIMEVAL(now);
8780 *now_filled = 1;
8781 }
8782 net->last_sent_time = *now;
8783 }
8784 /* Now send it, if there is anything to send :> */
8785 if ((error = sctp_lowlevel_chunk_output(inp,
8786 stcb,
8787 net,
8788 (struct sockaddr *)&net->ro._l_addr,
8789 outchain,
8790 auth_offset,
8791 auth,
8792 auth_keyid,
8793 no_fragmentflg,
8794 bundle_at,
8795 asconf,
8796 inp->sctp_lport, stcb->rport,
8797 htonl(stcb->asoc.peer_vtag),
8798 net->port, NULL,
8799 0, 0,
8800 so_locked))) {
8801 /* error, we could not output */
8802 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
8803 if (from_where == 0) {
8804 SCTP_STAT_INCR(sctps_lowlevelerrusr);
8805 }
8806 if (error == ENOBUFS) {
8807 asoc->ifp_had_enobuf = 1;
8808 SCTP_STAT_INCR(sctps_lowlevelerr);
8809 }
8810 if (error == EHOSTUNREACH) {
8811 /*
8812 * Destination went unreachable
8813 * during this send
8814 */
8815 sctp_move_chunks_from_net(stcb, net);
8816 }
8817 *reason_code = 6;
8818 /*-
8819 * I add this line to be paranoid. As far as
8820 * I can tell the continue, takes us back to
8821 * the top of the for, but just to make sure
8822 * I will reset these again here.
8823 */
8824 ctl_cnt = 0;
8825 continue; /* This takes us back to the
8826 * for() for the nets. */
8827 } else {
8828 asoc->ifp_had_enobuf = 0;
8829 }
8830 endoutchain = NULL;
8831 auth = NULL;
8832 auth_offset = 0;
8833 if (!no_out_cnt) {
8834 *num_out += (ctl_cnt + bundle_at);
8835 }
8836 if (bundle_at) {
8837 /* setup for a RTO measurement */
8838 tsns_sent = data_list[0]->rec.data.tsn;
8839 /* fill time if not already filled */
8840 if (*now_filled == 0) {
8841 (void)SCTP_GETTIME_TIMEVAL(&asoc->time_last_sent);
8842 *now_filled = 1;
8843 *now = asoc->time_last_sent;
8844 } else {
8845 asoc->time_last_sent = *now;
8846 }
8847 if (net->rto_needed) {
8848 data_list[0]->do_rtt = 1;
8849 net->rto_needed = 0;
8850 }
8851 SCTP_STAT_INCR_BY(sctps_senddata, bundle_at);
8852 sctp_clean_up_datalist(stcb, asoc, data_list, bundle_at, net);
8853 }
8854 if (one_chunk) {
8855 break;
8856 }
8857 }
8858 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
8859 sctp_log_cwnd(stcb, net, tsns_sent, SCTP_CWND_LOG_FROM_SEND);
8860 }
8861 }
8862 if (old_start_at == NULL) {
8863 old_start_at = start_at;
8864 start_at = TAILQ_FIRST(&asoc->nets);
8865 if (old_start_at)
8866 goto again_one_more_time;
8867 }
8868
8869 /*
8870 * At the end there should be no NON timed chunks hanging on this
8871 * queue.
8872 */
8873 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
8874 sctp_log_cwnd(stcb, net, *num_out, SCTP_CWND_LOG_FROM_SEND);
8875 }
8876 if ((*num_out == 0) && (*reason_code == 0)) {
8877 *reason_code = 4;
8878 } else {
8879 *reason_code = 5;
8880 }
8881 sctp_clean_up_ctl(stcb, asoc, so_locked);
8882 return (0);
8883 }
8884
8885 void
sctp_queue_op_err(struct sctp_tcb * stcb,struct mbuf * op_err)8886 sctp_queue_op_err(struct sctp_tcb *stcb, struct mbuf *op_err)
8887 {
8888 /*-
8889 * Prepend a OPERATIONAL_ERROR chunk header and put on the end of
8890 * the control chunk queue.
8891 */
8892 struct sctp_chunkhdr *hdr;
8893 struct sctp_tmit_chunk *chk;
8894 struct mbuf *mat, *last_mbuf;
8895 uint32_t chunk_length;
8896 uint16_t padding_length;
8897
8898 SCTP_TCB_LOCK_ASSERT(stcb);
8899 SCTP_BUF_PREPEND(op_err, sizeof(struct sctp_chunkhdr), M_NOWAIT);
8900 if (op_err == NULL) {
8901 return;
8902 }
8903 last_mbuf = NULL;
8904 chunk_length = 0;
8905 for (mat = op_err; mat != NULL; mat = SCTP_BUF_NEXT(mat)) {
8906 chunk_length += SCTP_BUF_LEN(mat);
8907 if (SCTP_BUF_NEXT(mat) == NULL) {
8908 last_mbuf = mat;
8909 }
8910 }
8911 if (chunk_length > SCTP_MAX_CHUNK_LENGTH) {
8912 sctp_m_freem(op_err);
8913 return;
8914 }
8915 padding_length = chunk_length % 4;
8916 if (padding_length != 0) {
8917 padding_length = 4 - padding_length;
8918 }
8919 if (padding_length != 0) {
8920 if (sctp_add_pad_tombuf(last_mbuf, padding_length) == NULL) {
8921 sctp_m_freem(op_err);
8922 return;
8923 }
8924 }
8925 sctp_alloc_a_chunk(stcb, chk);
8926 if (chk == NULL) {
8927 /* no memory */
8928 sctp_m_freem(op_err);
8929 return;
8930 }
8931 chk->copy_by_ref = 0;
8932 chk->rec.chunk_id.id = SCTP_OPERATION_ERROR;
8933 chk->rec.chunk_id.can_take_data = 0;
8934 chk->flags = 0;
8935 chk->send_size = (uint16_t)chunk_length;
8936 chk->sent = SCTP_DATAGRAM_UNSENT;
8937 chk->snd_count = 0;
8938 chk->asoc = &stcb->asoc;
8939 chk->data = op_err;
8940 chk->whoTo = NULL;
8941 hdr = mtod(op_err, struct sctp_chunkhdr *);
8942 hdr->chunk_type = SCTP_OPERATION_ERROR;
8943 hdr->chunk_flags = 0;
8944 hdr->chunk_length = htons(chk->send_size);
8945 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
8946 chk->asoc->ctrl_queue_cnt++;
8947 }
8948
8949 int
sctp_send_cookie_echo(struct mbuf * m,int offset,int limit,struct sctp_tcb * stcb,struct sctp_nets * net)8950 sctp_send_cookie_echo(struct mbuf *m,
8951 int offset, int limit,
8952 struct sctp_tcb *stcb,
8953 struct sctp_nets *net)
8954 {
8955 /*-
8956 * pull out the cookie and put it at the front of the control chunk
8957 * queue.
8958 */
8959 int at;
8960 struct mbuf *cookie;
8961 struct sctp_paramhdr param, *phdr;
8962 struct sctp_chunkhdr *hdr;
8963 struct sctp_tmit_chunk *chk;
8964 uint16_t ptype, plen;
8965
8966 SCTP_TCB_LOCK_ASSERT(stcb);
8967 /* First find the cookie in the param area */
8968 cookie = NULL;
8969 at = offset + sizeof(struct sctp_init_chunk);
8970 for (;;) {
8971 phdr = sctp_get_next_param(m, at, ¶m, sizeof(param));
8972 if (phdr == NULL) {
8973 return (-3);
8974 }
8975 ptype = ntohs(phdr->param_type);
8976 plen = ntohs(phdr->param_length);
8977 if (plen < sizeof(struct sctp_paramhdr)) {
8978 return (-6);
8979 }
8980 if (ptype == SCTP_STATE_COOKIE) {
8981 int pad;
8982
8983 /* found the cookie */
8984 if (at + plen > limit) {
8985 return (-7);
8986 }
8987 cookie = SCTP_M_COPYM(m, at, plen, M_NOWAIT);
8988 if (cookie == NULL) {
8989 /* No memory */
8990 return (-2);
8991 }
8992 if ((pad = (plen % 4)) > 0) {
8993 pad = 4 - pad;
8994 }
8995 if (pad > 0) {
8996 if (sctp_pad_lastmbuf(cookie, pad, NULL) == NULL) {
8997 return (-8);
8998 }
8999 }
9000 #ifdef SCTP_MBUF_LOGGING
9001 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
9002 sctp_log_mbc(cookie, SCTP_MBUF_ICOPY);
9003 }
9004 #endif
9005 break;
9006 }
9007 at += SCTP_SIZE32(plen);
9008 }
9009 /* ok, we got the cookie lets change it into a cookie echo chunk */
9010 /* first the change from param to cookie */
9011 hdr = mtod(cookie, struct sctp_chunkhdr *);
9012 hdr->chunk_type = SCTP_COOKIE_ECHO;
9013 hdr->chunk_flags = 0;
9014 /* get the chunk stuff now and place it in the FRONT of the queue */
9015 sctp_alloc_a_chunk(stcb, chk);
9016 if (chk == NULL) {
9017 /* no memory */
9018 sctp_m_freem(cookie);
9019 return (-5);
9020 }
9021 chk->copy_by_ref = 0;
9022 chk->rec.chunk_id.id = SCTP_COOKIE_ECHO;
9023 chk->rec.chunk_id.can_take_data = 0;
9024 chk->flags = CHUNK_FLAGS_FRAGMENT_OK;
9025 chk->send_size = SCTP_SIZE32(plen);
9026 chk->sent = SCTP_DATAGRAM_UNSENT;
9027 chk->snd_count = 0;
9028 chk->asoc = &stcb->asoc;
9029 chk->data = cookie;
9030 chk->whoTo = net;
9031 atomic_add_int(&chk->whoTo->ref_count, 1);
9032 TAILQ_INSERT_HEAD(&chk->asoc->control_send_queue, chk, sctp_next);
9033 chk->asoc->ctrl_queue_cnt++;
9034 return (0);
9035 }
9036
9037 void
sctp_send_heartbeat_ack(struct sctp_tcb * stcb,struct mbuf * m,int offset,int chk_length,struct sctp_nets * net)9038 sctp_send_heartbeat_ack(struct sctp_tcb *stcb,
9039 struct mbuf *m,
9040 int offset,
9041 int chk_length,
9042 struct sctp_nets *net)
9043 {
9044 /*
9045 * take a HB request and make it into a HB ack and send it.
9046 */
9047 struct mbuf *outchain;
9048 struct sctp_chunkhdr *chdr;
9049 struct sctp_tmit_chunk *chk;
9050
9051 if (net == NULL)
9052 /* must have a net pointer */
9053 return;
9054
9055 outchain = SCTP_M_COPYM(m, offset, chk_length, M_NOWAIT);
9056 if (outchain == NULL) {
9057 /* gak out of memory */
9058 return;
9059 }
9060 #ifdef SCTP_MBUF_LOGGING
9061 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
9062 sctp_log_mbc(outchain, SCTP_MBUF_ICOPY);
9063 }
9064 #endif
9065 chdr = mtod(outchain, struct sctp_chunkhdr *);
9066 chdr->chunk_type = SCTP_HEARTBEAT_ACK;
9067 chdr->chunk_flags = 0;
9068 if (chk_length % 4 != 0) {
9069 sctp_pad_lastmbuf(outchain, 4 - (chk_length % 4), NULL);
9070 }
9071 sctp_alloc_a_chunk(stcb, chk);
9072 if (chk == NULL) {
9073 /* no memory */
9074 sctp_m_freem(outchain);
9075 return;
9076 }
9077 chk->copy_by_ref = 0;
9078 chk->rec.chunk_id.id = SCTP_HEARTBEAT_ACK;
9079 chk->rec.chunk_id.can_take_data = 1;
9080 chk->flags = 0;
9081 chk->send_size = chk_length;
9082 chk->sent = SCTP_DATAGRAM_UNSENT;
9083 chk->snd_count = 0;
9084 chk->asoc = &stcb->asoc;
9085 chk->data = outchain;
9086 chk->whoTo = net;
9087 atomic_add_int(&chk->whoTo->ref_count, 1);
9088 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9089 chk->asoc->ctrl_queue_cnt++;
9090 }
9091
9092 void
sctp_send_cookie_ack(struct sctp_tcb * stcb)9093 sctp_send_cookie_ack(struct sctp_tcb *stcb)
9094 {
9095 /* formulate and queue a cookie-ack back to sender */
9096 struct mbuf *cookie_ack;
9097 struct sctp_chunkhdr *hdr;
9098 struct sctp_tmit_chunk *chk;
9099
9100 SCTP_TCB_LOCK_ASSERT(stcb);
9101
9102 cookie_ack = sctp_get_mbuf_for_msg(sizeof(struct sctp_chunkhdr), 0, M_NOWAIT, 1, MT_HEADER);
9103 if (cookie_ack == NULL) {
9104 /* no mbuf's */
9105 return;
9106 }
9107 SCTP_BUF_RESV_UF(cookie_ack, SCTP_MIN_OVERHEAD);
9108 sctp_alloc_a_chunk(stcb, chk);
9109 if (chk == NULL) {
9110 /* no memory */
9111 sctp_m_freem(cookie_ack);
9112 return;
9113 }
9114 chk->copy_by_ref = 0;
9115 chk->rec.chunk_id.id = SCTP_COOKIE_ACK;
9116 chk->rec.chunk_id.can_take_data = 1;
9117 chk->flags = 0;
9118 chk->send_size = sizeof(struct sctp_chunkhdr);
9119 chk->sent = SCTP_DATAGRAM_UNSENT;
9120 chk->snd_count = 0;
9121 chk->asoc = &stcb->asoc;
9122 chk->data = cookie_ack;
9123 if (chk->asoc->last_control_chunk_from != NULL) {
9124 chk->whoTo = chk->asoc->last_control_chunk_from;
9125 atomic_add_int(&chk->whoTo->ref_count, 1);
9126 } else {
9127 chk->whoTo = NULL;
9128 }
9129 hdr = mtod(cookie_ack, struct sctp_chunkhdr *);
9130 hdr->chunk_type = SCTP_COOKIE_ACK;
9131 hdr->chunk_flags = 0;
9132 hdr->chunk_length = htons(chk->send_size);
9133 SCTP_BUF_LEN(cookie_ack) = chk->send_size;
9134 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9135 chk->asoc->ctrl_queue_cnt++;
9136 return;
9137 }
9138
9139
9140 void
sctp_send_shutdown_ack(struct sctp_tcb * stcb,struct sctp_nets * net)9141 sctp_send_shutdown_ack(struct sctp_tcb *stcb, struct sctp_nets *net)
9142 {
9143 /* formulate and queue a SHUTDOWN-ACK back to the sender */
9144 struct mbuf *m_shutdown_ack;
9145 struct sctp_shutdown_ack_chunk *ack_cp;
9146 struct sctp_tmit_chunk *chk;
9147
9148 m_shutdown_ack = sctp_get_mbuf_for_msg(sizeof(struct sctp_shutdown_ack_chunk), 0, M_NOWAIT, 1, MT_HEADER);
9149 if (m_shutdown_ack == NULL) {
9150 /* no mbuf's */
9151 return;
9152 }
9153 SCTP_BUF_RESV_UF(m_shutdown_ack, SCTP_MIN_OVERHEAD);
9154 sctp_alloc_a_chunk(stcb, chk);
9155 if (chk == NULL) {
9156 /* no memory */
9157 sctp_m_freem(m_shutdown_ack);
9158 return;
9159 }
9160 chk->copy_by_ref = 0;
9161 chk->rec.chunk_id.id = SCTP_SHUTDOWN_ACK;
9162 chk->rec.chunk_id.can_take_data = 1;
9163 chk->flags = 0;
9164 chk->send_size = sizeof(struct sctp_chunkhdr);
9165 chk->sent = SCTP_DATAGRAM_UNSENT;
9166 chk->snd_count = 0;
9167 chk->asoc = &stcb->asoc;
9168 chk->data = m_shutdown_ack;
9169 chk->whoTo = net;
9170 if (chk->whoTo) {
9171 atomic_add_int(&chk->whoTo->ref_count, 1);
9172 }
9173 ack_cp = mtod(m_shutdown_ack, struct sctp_shutdown_ack_chunk *);
9174 ack_cp->ch.chunk_type = SCTP_SHUTDOWN_ACK;
9175 ack_cp->ch.chunk_flags = 0;
9176 ack_cp->ch.chunk_length = htons(chk->send_size);
9177 SCTP_BUF_LEN(m_shutdown_ack) = chk->send_size;
9178 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9179 chk->asoc->ctrl_queue_cnt++;
9180 return;
9181 }
9182
9183 void
sctp_send_shutdown(struct sctp_tcb * stcb,struct sctp_nets * net)9184 sctp_send_shutdown(struct sctp_tcb *stcb, struct sctp_nets *net)
9185 {
9186 /* formulate and queue a SHUTDOWN to the sender */
9187 struct mbuf *m_shutdown;
9188 struct sctp_shutdown_chunk *shutdown_cp;
9189 struct sctp_tmit_chunk *chk;
9190
9191 TAILQ_FOREACH(chk, &stcb->asoc.control_send_queue, sctp_next) {
9192 if (chk->rec.chunk_id.id == SCTP_SHUTDOWN) {
9193 /* We already have a SHUTDOWN queued. Reuse it. */
9194 if (chk->whoTo) {
9195 sctp_free_remote_addr(chk->whoTo);
9196 chk->whoTo = NULL;
9197 }
9198 break;
9199 }
9200 }
9201 if (chk == NULL) {
9202 m_shutdown = sctp_get_mbuf_for_msg(sizeof(struct sctp_shutdown_chunk), 0, M_NOWAIT, 1, MT_HEADER);
9203 if (m_shutdown == NULL) {
9204 /* no mbuf's */
9205 return;
9206 }
9207 SCTP_BUF_RESV_UF(m_shutdown, SCTP_MIN_OVERHEAD);
9208 sctp_alloc_a_chunk(stcb, chk);
9209 if (chk == NULL) {
9210 /* no memory */
9211 sctp_m_freem(m_shutdown);
9212 return;
9213 }
9214 chk->copy_by_ref = 0;
9215 chk->rec.chunk_id.id = SCTP_SHUTDOWN;
9216 chk->rec.chunk_id.can_take_data = 1;
9217 chk->flags = 0;
9218 chk->send_size = sizeof(struct sctp_shutdown_chunk);
9219 chk->sent = SCTP_DATAGRAM_UNSENT;
9220 chk->snd_count = 0;
9221 chk->asoc = &stcb->asoc;
9222 chk->data = m_shutdown;
9223 chk->whoTo = net;
9224 if (chk->whoTo) {
9225 atomic_add_int(&chk->whoTo->ref_count, 1);
9226 }
9227 shutdown_cp = mtod(m_shutdown, struct sctp_shutdown_chunk *);
9228 shutdown_cp->ch.chunk_type = SCTP_SHUTDOWN;
9229 shutdown_cp->ch.chunk_flags = 0;
9230 shutdown_cp->ch.chunk_length = htons(chk->send_size);
9231 shutdown_cp->cumulative_tsn_ack = htonl(stcb->asoc.cumulative_tsn);
9232 SCTP_BUF_LEN(m_shutdown) = chk->send_size;
9233 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9234 chk->asoc->ctrl_queue_cnt++;
9235 } else {
9236 TAILQ_REMOVE(&stcb->asoc.control_send_queue, chk, sctp_next);
9237 chk->whoTo = net;
9238 if (chk->whoTo) {
9239 atomic_add_int(&chk->whoTo->ref_count, 1);
9240 }
9241 shutdown_cp = mtod(chk->data, struct sctp_shutdown_chunk *);
9242 shutdown_cp->cumulative_tsn_ack = htonl(stcb->asoc.cumulative_tsn);
9243 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
9244 }
9245 return;
9246 }
9247
9248 void
sctp_send_asconf(struct sctp_tcb * stcb,struct sctp_nets * net,int addr_locked)9249 sctp_send_asconf(struct sctp_tcb *stcb, struct sctp_nets *net, int addr_locked)
9250 {
9251 /*
9252 * formulate and queue an ASCONF to the peer. ASCONF parameters
9253 * should be queued on the assoc queue.
9254 */
9255 struct sctp_tmit_chunk *chk;
9256 struct mbuf *m_asconf;
9257 int len;
9258
9259 SCTP_TCB_LOCK_ASSERT(stcb);
9260
9261 if ((!TAILQ_EMPTY(&stcb->asoc.asconf_send_queue)) &&
9262 (!sctp_is_feature_on(stcb->sctp_ep, SCTP_PCB_FLAGS_MULTIPLE_ASCONFS))) {
9263 /* can't send a new one if there is one in flight already */
9264 return;
9265 }
9266
9267 /* compose an ASCONF chunk, maximum length is PMTU */
9268 m_asconf = sctp_compose_asconf(stcb, &len, addr_locked);
9269 if (m_asconf == NULL) {
9270 return;
9271 }
9272
9273 sctp_alloc_a_chunk(stcb, chk);
9274 if (chk == NULL) {
9275 /* no memory */
9276 sctp_m_freem(m_asconf);
9277 return;
9278 }
9279
9280 chk->copy_by_ref = 0;
9281 chk->rec.chunk_id.id = SCTP_ASCONF;
9282 chk->rec.chunk_id.can_take_data = 0;
9283 chk->flags = CHUNK_FLAGS_FRAGMENT_OK;
9284 chk->data = m_asconf;
9285 chk->send_size = len;
9286 chk->sent = SCTP_DATAGRAM_UNSENT;
9287 chk->snd_count = 0;
9288 chk->asoc = &stcb->asoc;
9289 chk->whoTo = net;
9290 if (chk->whoTo) {
9291 atomic_add_int(&chk->whoTo->ref_count, 1);
9292 }
9293 TAILQ_INSERT_TAIL(&chk->asoc->asconf_send_queue, chk, sctp_next);
9294 chk->asoc->ctrl_queue_cnt++;
9295 return;
9296 }
9297
9298 void
sctp_send_asconf_ack(struct sctp_tcb * stcb)9299 sctp_send_asconf_ack(struct sctp_tcb *stcb)
9300 {
9301 /*
9302 * formulate and queue a asconf-ack back to sender. the asconf-ack
9303 * must be stored in the tcb.
9304 */
9305 struct sctp_tmit_chunk *chk;
9306 struct sctp_asconf_ack *ack, *latest_ack;
9307 struct mbuf *m_ack;
9308 struct sctp_nets *net = NULL;
9309
9310 SCTP_TCB_LOCK_ASSERT(stcb);
9311 /* Get the latest ASCONF-ACK */
9312 latest_ack = TAILQ_LAST(&stcb->asoc.asconf_ack_sent, sctp_asconf_ackhead);
9313 if (latest_ack == NULL) {
9314 return;
9315 }
9316 if (latest_ack->last_sent_to != NULL &&
9317 latest_ack->last_sent_to == stcb->asoc.last_control_chunk_from) {
9318 /* we're doing a retransmission */
9319 net = sctp_find_alternate_net(stcb, stcb->asoc.last_control_chunk_from, 0);
9320 if (net == NULL) {
9321 /* no alternate */
9322 if (stcb->asoc.last_control_chunk_from == NULL) {
9323 if (stcb->asoc.alternate) {
9324 net = stcb->asoc.alternate;
9325 } else {
9326 net = stcb->asoc.primary_destination;
9327 }
9328 } else {
9329 net = stcb->asoc.last_control_chunk_from;
9330 }
9331 }
9332 } else {
9333 /* normal case */
9334 if (stcb->asoc.last_control_chunk_from == NULL) {
9335 if (stcb->asoc.alternate) {
9336 net = stcb->asoc.alternate;
9337 } else {
9338 net = stcb->asoc.primary_destination;
9339 }
9340 } else {
9341 net = stcb->asoc.last_control_chunk_from;
9342 }
9343 }
9344 latest_ack->last_sent_to = net;
9345
9346 TAILQ_FOREACH(ack, &stcb->asoc.asconf_ack_sent, next) {
9347 if (ack->data == NULL) {
9348 continue;
9349 }
9350
9351 /* copy the asconf_ack */
9352 m_ack = SCTP_M_COPYM(ack->data, 0, M_COPYALL, M_NOWAIT);
9353 if (m_ack == NULL) {
9354 /* couldn't copy it */
9355 return;
9356 }
9357 #ifdef SCTP_MBUF_LOGGING
9358 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_MBUF_LOGGING_ENABLE) {
9359 sctp_log_mbc(m_ack, SCTP_MBUF_ICOPY);
9360 }
9361 #endif
9362
9363 sctp_alloc_a_chunk(stcb, chk);
9364 if (chk == NULL) {
9365 /* no memory */
9366 if (m_ack)
9367 sctp_m_freem(m_ack);
9368 return;
9369 }
9370 chk->copy_by_ref = 0;
9371 chk->rec.chunk_id.id = SCTP_ASCONF_ACK;
9372 chk->rec.chunk_id.can_take_data = 1;
9373 chk->flags = CHUNK_FLAGS_FRAGMENT_OK;
9374 chk->whoTo = net;
9375 if (chk->whoTo) {
9376 atomic_add_int(&chk->whoTo->ref_count, 1);
9377 }
9378 chk->data = m_ack;
9379 chk->send_size = ack->len;
9380 chk->sent = SCTP_DATAGRAM_UNSENT;
9381 chk->snd_count = 0;
9382 chk->asoc = &stcb->asoc;
9383
9384 TAILQ_INSERT_TAIL(&chk->asoc->control_send_queue, chk, sctp_next);
9385 chk->asoc->ctrl_queue_cnt++;
9386 }
9387 return;
9388 }
9389
9390
9391 static int
sctp_chunk_retransmission(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_association * asoc,int * cnt_out,struct timeval * now,int * now_filled,int * fr_done,int so_locked)9392 sctp_chunk_retransmission(struct sctp_inpcb *inp,
9393 struct sctp_tcb *stcb,
9394 struct sctp_association *asoc,
9395 int *cnt_out, struct timeval *now, int *now_filled, int *fr_done, int so_locked)
9396 {
9397 /*-
9398 * send out one MTU of retransmission. If fast_retransmit is
9399 * happening we ignore the cwnd. Otherwise we obey the cwnd and
9400 * rwnd. For a Cookie or Asconf in the control chunk queue we
9401 * retransmit them by themselves.
9402 *
9403 * For data chunks we will pick out the lowest TSN's in the sent_queue
9404 * marked for resend and bundle them all together (up to a MTU of
9405 * destination). The address to send to should have been
9406 * selected/changed where the retransmission was marked (i.e. in FR
9407 * or t3-timeout routines).
9408 */
9409 struct sctp_tmit_chunk *data_list[SCTP_MAX_DATA_BUNDLING];
9410 struct sctp_tmit_chunk *chk, *fwd;
9411 struct mbuf *m, *endofchain;
9412 struct sctp_nets *net = NULL;
9413 uint32_t tsns_sent = 0;
9414 int no_fragmentflg, bundle_at;
9415 unsigned int mtu;
9416 int error, i, one_chunk, fwd_tsn, ctl_cnt, tmr_started;
9417 struct sctp_auth_chunk *auth = NULL;
9418 uint32_t auth_offset = 0;
9419 uint16_t auth_keyid;
9420 int override_ok = 1;
9421 int data_auth_reqd = 0;
9422 uint32_t dmtu = 0;
9423
9424 SCTP_TCB_LOCK_ASSERT(stcb);
9425 tmr_started = ctl_cnt = 0;
9426 no_fragmentflg = 1;
9427 fwd_tsn = 0;
9428 *cnt_out = 0;
9429 fwd = NULL;
9430 endofchain = m = NULL;
9431 auth_keyid = stcb->asoc.authinfo.active_keyid;
9432 #ifdef SCTP_AUDITING_ENABLED
9433 sctp_audit_log(0xC3, 1);
9434 #endif
9435 if ((TAILQ_EMPTY(&asoc->sent_queue)) &&
9436 (TAILQ_EMPTY(&asoc->control_send_queue))) {
9437 SCTPDBG(SCTP_DEBUG_OUTPUT1, "SCTP hits empty queue with cnt set to %d?\n",
9438 asoc->sent_queue_retran_cnt);
9439 asoc->sent_queue_cnt = 0;
9440 asoc->sent_queue_cnt_removeable = 0;
9441 /* send back 0/0 so we enter normal transmission */
9442 *cnt_out = 0;
9443 return (0);
9444 }
9445 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
9446 if ((chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) ||
9447 (chk->rec.chunk_id.id == SCTP_STREAM_RESET) ||
9448 (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN)) {
9449 if (chk->sent != SCTP_DATAGRAM_RESEND) {
9450 continue;
9451 }
9452 if (chk->rec.chunk_id.id == SCTP_STREAM_RESET) {
9453 if (chk != asoc->str_reset) {
9454 /*
9455 * not eligible for retran if its
9456 * not ours
9457 */
9458 continue;
9459 }
9460 }
9461 ctl_cnt++;
9462 if (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) {
9463 fwd_tsn = 1;
9464 }
9465 /*
9466 * Add an AUTH chunk, if chunk requires it save the
9467 * offset into the chain for AUTH
9468 */
9469 if ((auth == NULL) &&
9470 (sctp_auth_is_required_chunk(chk->rec.chunk_id.id,
9471 stcb->asoc.peer_auth_chunks))) {
9472 m = sctp_add_auth_chunk(m, &endofchain,
9473 &auth, &auth_offset,
9474 stcb,
9475 chk->rec.chunk_id.id);
9476 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
9477 }
9478 m = sctp_copy_mbufchain(chk->data, m, &endofchain, 0, chk->send_size, chk->copy_by_ref);
9479 break;
9480 }
9481 }
9482 one_chunk = 0;
9483 /* do we have control chunks to retransmit? */
9484 if (m != NULL) {
9485 /* Start a timer no matter if we succeed or fail */
9486 if (chk->rec.chunk_id.id == SCTP_COOKIE_ECHO) {
9487 sctp_timer_start(SCTP_TIMER_TYPE_COOKIE, inp, stcb, chk->whoTo);
9488 } else if (chk->rec.chunk_id.id == SCTP_ASCONF)
9489 sctp_timer_start(SCTP_TIMER_TYPE_ASCONF, inp, stcb, chk->whoTo);
9490 chk->snd_count++; /* update our count */
9491 if ((error = sctp_lowlevel_chunk_output(inp, stcb, chk->whoTo,
9492 (struct sockaddr *)&chk->whoTo->ro._l_addr, m,
9493 auth_offset, auth, stcb->asoc.authinfo.active_keyid,
9494 no_fragmentflg, 0, 0,
9495 inp->sctp_lport, stcb->rport, htonl(stcb->asoc.peer_vtag),
9496 chk->whoTo->port, NULL,
9497 0, 0,
9498 so_locked))) {
9499 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
9500 if (error == ENOBUFS) {
9501 asoc->ifp_had_enobuf = 1;
9502 SCTP_STAT_INCR(sctps_lowlevelerr);
9503 }
9504 return (error);
9505 } else {
9506 asoc->ifp_had_enobuf = 0;
9507 }
9508 endofchain = NULL;
9509 auth = NULL;
9510 auth_offset = 0;
9511 /*
9512 * We don't want to mark the net->sent time here since this
9513 * we use this for HB and retrans cannot measure RTT
9514 */
9515 /* (void)SCTP_GETTIME_TIMEVAL(&chk->whoTo->last_sent_time); */
9516 *cnt_out += 1;
9517 chk->sent = SCTP_DATAGRAM_SENT;
9518 sctp_ucount_decr(stcb->asoc.sent_queue_retran_cnt);
9519 if (fwd_tsn == 0) {
9520 return (0);
9521 } else {
9522 /* Clean up the fwd-tsn list */
9523 sctp_clean_up_ctl(stcb, asoc, so_locked);
9524 return (0);
9525 }
9526 }
9527 /*
9528 * Ok, it is just data retransmission we need to do or that and a
9529 * fwd-tsn with it all.
9530 */
9531 if (TAILQ_EMPTY(&asoc->sent_queue)) {
9532 return (SCTP_RETRAN_DONE);
9533 }
9534 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED) ||
9535 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT)) {
9536 /* not yet open, resend the cookie and that is it */
9537 return (1);
9538 }
9539 #ifdef SCTP_AUDITING_ENABLED
9540 sctp_auditing(20, inp, stcb, NULL);
9541 #endif
9542 data_auth_reqd = sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks);
9543 TAILQ_FOREACH(chk, &asoc->sent_queue, sctp_next) {
9544 if (chk->sent != SCTP_DATAGRAM_RESEND) {
9545 /* No, not sent to this net or not ready for rtx */
9546 continue;
9547 }
9548 if (chk->data == NULL) {
9549 SCTP_PRINTF("TSN:%x chk->snd_count:%d chk->sent:%d can't retran - no data\n",
9550 chk->rec.data.tsn, chk->snd_count, chk->sent);
9551 continue;
9552 }
9553 if ((SCTP_BASE_SYSCTL(sctp_max_retran_chunk)) &&
9554 (chk->snd_count >= SCTP_BASE_SYSCTL(sctp_max_retran_chunk))) {
9555 struct mbuf *op_err;
9556 char msg[SCTP_DIAG_INFO_LEN];
9557
9558 SCTP_SNPRINTF(msg, sizeof(msg), "TSN %8.8x retransmitted %d times, giving up",
9559 chk->rec.data.tsn, chk->snd_count);
9560 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
9561 msg);
9562 atomic_add_int(&stcb->asoc.refcnt, 1);
9563 sctp_abort_an_association(stcb->sctp_ep, stcb, op_err,
9564 so_locked);
9565 SCTP_TCB_LOCK(stcb);
9566 atomic_subtract_int(&stcb->asoc.refcnt, 1);
9567 return (SCTP_RETRAN_EXIT);
9568 }
9569 /* pick up the net */
9570 net = chk->whoTo;
9571 switch (net->ro._l_addr.sa.sa_family) {
9572 #ifdef INET
9573 case AF_INET:
9574 mtu = net->mtu - SCTP_MIN_V4_OVERHEAD;
9575 break;
9576 #endif
9577 #ifdef INET6
9578 case AF_INET6:
9579 mtu = net->mtu - SCTP_MIN_OVERHEAD;
9580 break;
9581 #endif
9582 default:
9583 /* TSNH */
9584 mtu = net->mtu;
9585 break;
9586 }
9587
9588 if ((asoc->peers_rwnd < mtu) && (asoc->total_flight > 0)) {
9589 /* No room in peers rwnd */
9590 uint32_t tsn;
9591
9592 tsn = asoc->last_acked_seq + 1;
9593 if (tsn == chk->rec.data.tsn) {
9594 /*
9595 * we make a special exception for this
9596 * case. The peer has no rwnd but is missing
9597 * the lowest chunk.. which is probably what
9598 * is holding up the rwnd.
9599 */
9600 goto one_chunk_around;
9601 }
9602 return (1);
9603 }
9604 one_chunk_around:
9605 if (asoc->peers_rwnd < mtu) {
9606 one_chunk = 1;
9607 if ((asoc->peers_rwnd == 0) &&
9608 (asoc->total_flight == 0)) {
9609 chk->window_probe = 1;
9610 chk->whoTo->window_probe = 1;
9611 }
9612 }
9613 #ifdef SCTP_AUDITING_ENABLED
9614 sctp_audit_log(0xC3, 2);
9615 #endif
9616 bundle_at = 0;
9617 m = NULL;
9618 net->fast_retran_ip = 0;
9619 if (chk->rec.data.doing_fast_retransmit == 0) {
9620 /*
9621 * if no FR in progress skip destination that have
9622 * flight_size > cwnd.
9623 */
9624 if (net->flight_size >= net->cwnd) {
9625 continue;
9626 }
9627 } else {
9628 /*
9629 * Mark the destination net to have FR recovery
9630 * limits put on it.
9631 */
9632 *fr_done = 1;
9633 net->fast_retran_ip = 1;
9634 }
9635
9636 /*
9637 * if no AUTH is yet included and this chunk requires it,
9638 * make sure to account for it. We don't apply the size
9639 * until the AUTH chunk is actually added below in case
9640 * there is no room for this chunk.
9641 */
9642 if (data_auth_reqd && (auth == NULL)) {
9643 dmtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
9644 } else
9645 dmtu = 0;
9646
9647 if ((chk->send_size <= (mtu - dmtu)) ||
9648 (chk->flags & CHUNK_FLAGS_FRAGMENT_OK)) {
9649 /* ok we will add this one */
9650 if (data_auth_reqd) {
9651 if (auth == NULL) {
9652 m = sctp_add_auth_chunk(m,
9653 &endofchain,
9654 &auth,
9655 &auth_offset,
9656 stcb,
9657 SCTP_DATA);
9658 auth_keyid = chk->auth_keyid;
9659 override_ok = 0;
9660 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
9661 } else if (override_ok) {
9662 auth_keyid = chk->auth_keyid;
9663 override_ok = 0;
9664 } else if (chk->auth_keyid != auth_keyid) {
9665 /* different keyid, so done bundling */
9666 break;
9667 }
9668 }
9669 m = sctp_copy_mbufchain(chk->data, m, &endofchain, 0, chk->send_size, chk->copy_by_ref);
9670 if (m == NULL) {
9671 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
9672 return (ENOMEM);
9673 }
9674 /* Do clear IP_DF ? */
9675 if (chk->flags & CHUNK_FLAGS_FRAGMENT_OK) {
9676 no_fragmentflg = 0;
9677 }
9678 /* upate our MTU size */
9679 if (mtu > (chk->send_size + dmtu))
9680 mtu -= (chk->send_size + dmtu);
9681 else
9682 mtu = 0;
9683 data_list[bundle_at++] = chk;
9684 if (one_chunk && (asoc->total_flight <= 0)) {
9685 SCTP_STAT_INCR(sctps_windowprobed);
9686 }
9687 }
9688 if (one_chunk == 0) {
9689 /*
9690 * now are there anymore forward from chk to pick
9691 * up?
9692 */
9693 for (fwd = TAILQ_NEXT(chk, sctp_next); fwd != NULL; fwd = TAILQ_NEXT(fwd, sctp_next)) {
9694 if (fwd->sent != SCTP_DATAGRAM_RESEND) {
9695 /* Nope, not for retran */
9696 continue;
9697 }
9698 if (fwd->whoTo != net) {
9699 /* Nope, not the net in question */
9700 continue;
9701 }
9702 if (data_auth_reqd && (auth == NULL)) {
9703 dmtu = sctp_get_auth_chunk_len(stcb->asoc.peer_hmac_id);
9704 } else
9705 dmtu = 0;
9706 if (fwd->send_size <= (mtu - dmtu)) {
9707 if (data_auth_reqd) {
9708 if (auth == NULL) {
9709 m = sctp_add_auth_chunk(m,
9710 &endofchain,
9711 &auth,
9712 &auth_offset,
9713 stcb,
9714 SCTP_DATA);
9715 auth_keyid = fwd->auth_keyid;
9716 override_ok = 0;
9717 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
9718 } else if (override_ok) {
9719 auth_keyid = fwd->auth_keyid;
9720 override_ok = 0;
9721 } else if (fwd->auth_keyid != auth_keyid) {
9722 /*
9723 * different keyid,
9724 * so done bundling
9725 */
9726 break;
9727 }
9728 }
9729 m = sctp_copy_mbufchain(fwd->data, m, &endofchain, 0, fwd->send_size, fwd->copy_by_ref);
9730 if (m == NULL) {
9731 SCTP_LTRACE_ERR_RET(inp, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
9732 return (ENOMEM);
9733 }
9734 /* Do clear IP_DF ? */
9735 if (fwd->flags & CHUNK_FLAGS_FRAGMENT_OK) {
9736 no_fragmentflg = 0;
9737 }
9738 /* upate our MTU size */
9739 if (mtu > (fwd->send_size + dmtu))
9740 mtu -= (fwd->send_size + dmtu);
9741 else
9742 mtu = 0;
9743 data_list[bundle_at++] = fwd;
9744 if (bundle_at >= SCTP_MAX_DATA_BUNDLING) {
9745 break;
9746 }
9747 } else {
9748 /* can't fit so we are done */
9749 break;
9750 }
9751 }
9752 }
9753 /* Is there something to send for this destination? */
9754 if (m) {
9755 /*
9756 * No matter if we fail/or succeed we should start a
9757 * timer. A failure is like a lost IP packet :-)
9758 */
9759 if (!SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
9760 /*
9761 * no timer running on this destination
9762 * restart it.
9763 */
9764 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
9765 tmr_started = 1;
9766 }
9767 /* Now lets send it, if there is anything to send :> */
9768 if ((error = sctp_lowlevel_chunk_output(inp, stcb, net,
9769 (struct sockaddr *)&net->ro._l_addr, m,
9770 auth_offset, auth, auth_keyid,
9771 no_fragmentflg, 0, 0,
9772 inp->sctp_lport, stcb->rport, htonl(stcb->asoc.peer_vtag),
9773 net->port, NULL,
9774 0, 0,
9775 so_locked))) {
9776 /* error, we could not output */
9777 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
9778 if (error == ENOBUFS) {
9779 asoc->ifp_had_enobuf = 1;
9780 SCTP_STAT_INCR(sctps_lowlevelerr);
9781 }
9782 return (error);
9783 } else {
9784 asoc->ifp_had_enobuf = 0;
9785 }
9786 endofchain = NULL;
9787 auth = NULL;
9788 auth_offset = 0;
9789 /* For HB's */
9790 /*
9791 * We don't want to mark the net->sent time here
9792 * since this we use this for HB and retrans cannot
9793 * measure RTT
9794 */
9795 /* (void)SCTP_GETTIME_TIMEVAL(&net->last_sent_time); */
9796
9797 /* For auto-close */
9798 if (*now_filled == 0) {
9799 (void)SCTP_GETTIME_TIMEVAL(&asoc->time_last_sent);
9800 *now = asoc->time_last_sent;
9801 *now_filled = 1;
9802 } else {
9803 asoc->time_last_sent = *now;
9804 }
9805 *cnt_out += bundle_at;
9806 #ifdef SCTP_AUDITING_ENABLED
9807 sctp_audit_log(0xC4, bundle_at);
9808 #endif
9809 if (bundle_at) {
9810 tsns_sent = data_list[0]->rec.data.tsn;
9811 }
9812 for (i = 0; i < bundle_at; i++) {
9813 SCTP_STAT_INCR(sctps_sendretransdata);
9814 data_list[i]->sent = SCTP_DATAGRAM_SENT;
9815 /*
9816 * When we have a revoked data, and we
9817 * retransmit it, then we clear the revoked
9818 * flag since this flag dictates if we
9819 * subtracted from the fs
9820 */
9821 if (data_list[i]->rec.data.chunk_was_revoked) {
9822 /* Deflate the cwnd */
9823 data_list[i]->whoTo->cwnd -= data_list[i]->book_size;
9824 data_list[i]->rec.data.chunk_was_revoked = 0;
9825 }
9826 data_list[i]->snd_count++;
9827 sctp_ucount_decr(asoc->sent_queue_retran_cnt);
9828 /* record the time */
9829 data_list[i]->sent_rcv_time = asoc->time_last_sent;
9830 if (data_list[i]->book_size_scale) {
9831 /*
9832 * need to double the book size on
9833 * this one
9834 */
9835 data_list[i]->book_size_scale = 0;
9836 /*
9837 * Since we double the booksize, we
9838 * must also double the output queue
9839 * size, since this get shrunk when
9840 * we free by this amount.
9841 */
9842 atomic_add_int(&((asoc)->total_output_queue_size), data_list[i]->book_size);
9843 data_list[i]->book_size *= 2;
9844
9845 } else {
9846 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_RWND_ENABLE) {
9847 sctp_log_rwnd(SCTP_DECREASE_PEER_RWND,
9848 asoc->peers_rwnd, data_list[i]->send_size, SCTP_BASE_SYSCTL(sctp_peer_chunk_oh));
9849 }
9850 asoc->peers_rwnd = sctp_sbspace_sub(asoc->peers_rwnd,
9851 (uint32_t)(data_list[i]->send_size +
9852 SCTP_BASE_SYSCTL(sctp_peer_chunk_oh)));
9853 }
9854 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_FLIGHT_LOGGING_ENABLE) {
9855 sctp_misc_ints(SCTP_FLIGHT_LOG_UP_RSND,
9856 data_list[i]->whoTo->flight_size,
9857 data_list[i]->book_size,
9858 (uint32_t)(uintptr_t)data_list[i]->whoTo,
9859 data_list[i]->rec.data.tsn);
9860 }
9861 sctp_flight_size_increase(data_list[i]);
9862 sctp_total_flight_increase(stcb, data_list[i]);
9863 if (asoc->peers_rwnd < stcb->sctp_ep->sctp_ep.sctp_sws_sender) {
9864 /* SWS sender side engages */
9865 asoc->peers_rwnd = 0;
9866 }
9867 if ((i == 0) &&
9868 (data_list[i]->rec.data.doing_fast_retransmit)) {
9869 SCTP_STAT_INCR(sctps_sendfastretrans);
9870 if ((data_list[i] == TAILQ_FIRST(&asoc->sent_queue)) &&
9871 (tmr_started == 0)) {
9872 /*-
9873 * ok we just fast-retrans'd
9874 * the lowest TSN, i.e the
9875 * first on the list. In
9876 * this case we want to give
9877 * some more time to get a
9878 * SACK back without a
9879 * t3-expiring.
9880 */
9881 sctp_timer_stop(SCTP_TIMER_TYPE_SEND, inp, stcb, net,
9882 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_2);
9883 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, net);
9884 }
9885 }
9886 }
9887 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
9888 sctp_log_cwnd(stcb, net, tsns_sent, SCTP_CWND_LOG_FROM_RESEND);
9889 }
9890 #ifdef SCTP_AUDITING_ENABLED
9891 sctp_auditing(21, inp, stcb, NULL);
9892 #endif
9893 } else {
9894 /* None will fit */
9895 return (1);
9896 }
9897 if (asoc->sent_queue_retran_cnt <= 0) {
9898 /* all done we have no more to retran */
9899 asoc->sent_queue_retran_cnt = 0;
9900 break;
9901 }
9902 if (one_chunk) {
9903 /* No more room in rwnd */
9904 return (1);
9905 }
9906 /* stop the for loop here. we sent out a packet */
9907 break;
9908 }
9909 return (0);
9910 }
9911
9912 static void
sctp_timer_validation(struct sctp_inpcb * inp,struct sctp_tcb * stcb,struct sctp_association * asoc)9913 sctp_timer_validation(struct sctp_inpcb *inp,
9914 struct sctp_tcb *stcb,
9915 struct sctp_association *asoc)
9916 {
9917 struct sctp_nets *net;
9918
9919 /* Validate that a timer is running somewhere */
9920 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
9921 if (SCTP_OS_TIMER_PENDING(&net->rxt_timer.timer)) {
9922 /* Here is a timer */
9923 return;
9924 }
9925 }
9926 SCTP_TCB_LOCK_ASSERT(stcb);
9927 /* Gak, we did not have a timer somewhere */
9928 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Deadlock avoided starting timer on a dest at retran\n");
9929 if (asoc->alternate) {
9930 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, asoc->alternate);
9931 } else {
9932 sctp_timer_start(SCTP_TIMER_TYPE_SEND, inp, stcb, asoc->primary_destination);
9933 }
9934 return;
9935 }
9936
9937 void
sctp_chunk_output(struct sctp_inpcb * inp,struct sctp_tcb * stcb,int from_where,int so_locked)9938 sctp_chunk_output(struct sctp_inpcb *inp,
9939 struct sctp_tcb *stcb,
9940 int from_where,
9941 int so_locked)
9942 {
9943 /*-
9944 * Ok this is the generic chunk service queue. we must do the
9945 * following:
9946 * - See if there are retransmits pending, if so we must
9947 * do these first.
9948 * - Service the stream queue that is next, moving any
9949 * message (note I must get a complete message i.e.
9950 * FIRST/MIDDLE and LAST to the out queue in one pass) and assigning
9951 * TSN's
9952 * - Check to see if the cwnd/rwnd allows any output, if so we
9953 * go ahead and fomulate and send the low level chunks. Making sure
9954 * to combine any control in the control chunk queue also.
9955 */
9956 struct sctp_association *asoc;
9957 struct sctp_nets *net;
9958 int error = 0, num_out, tot_out = 0, ret = 0, reason_code;
9959 unsigned int burst_cnt = 0;
9960 struct timeval now;
9961 int now_filled = 0;
9962 int nagle_on;
9963 int frag_point = sctp_get_frag_point(stcb, &stcb->asoc);
9964 int un_sent = 0;
9965 int fr_done;
9966 unsigned int tot_frs = 0;
9967
9968 asoc = &stcb->asoc;
9969 do_it_again:
9970 /* The Nagle algorithm is only applied when handling a send call. */
9971 if (from_where == SCTP_OUTPUT_FROM_USR_SEND) {
9972 if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_NODELAY)) {
9973 nagle_on = 0;
9974 } else {
9975 nagle_on = 1;
9976 }
9977 } else {
9978 nagle_on = 0;
9979 }
9980 SCTP_TCB_LOCK_ASSERT(stcb);
9981
9982 un_sent = (stcb->asoc.total_output_queue_size - stcb->asoc.total_flight);
9983
9984 if ((un_sent <= 0) &&
9985 (TAILQ_EMPTY(&asoc->control_send_queue)) &&
9986 (TAILQ_EMPTY(&asoc->asconf_send_queue)) &&
9987 (asoc->sent_queue_retran_cnt == 0) &&
9988 (asoc->trigger_reset == 0)) {
9989 /* Nothing to do unless there is something to be sent left */
9990 return;
9991 }
9992 /*
9993 * Do we have something to send, data or control AND a sack timer
9994 * running, if so piggy-back the sack.
9995 */
9996 if (SCTP_OS_TIMER_PENDING(&stcb->asoc.dack_timer.timer)) {
9997 sctp_send_sack(stcb, so_locked);
9998 sctp_timer_stop(SCTP_TIMER_TYPE_RECV, stcb->sctp_ep, stcb, NULL,
9999 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_3);
10000 }
10001 while (asoc->sent_queue_retran_cnt) {
10002 /*-
10003 * Ok, it is retransmission time only, we send out only ONE
10004 * packet with a single call off to the retran code.
10005 */
10006 if (from_where == SCTP_OUTPUT_FROM_COOKIE_ACK) {
10007 /*-
10008 * Special hook for handling cookiess discarded
10009 * by peer that carried data. Send cookie-ack only
10010 * and then the next call with get the retran's.
10011 */
10012 (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1,
10013 from_where,
10014 &now, &now_filled, frag_point, so_locked);
10015 return;
10016 } else if (from_where != SCTP_OUTPUT_FROM_HB_TMR) {
10017 /* if its not from a HB then do it */
10018 fr_done = 0;
10019 ret = sctp_chunk_retransmission(inp, stcb, asoc, &num_out, &now, &now_filled, &fr_done, so_locked);
10020 if (fr_done) {
10021 tot_frs++;
10022 }
10023 } else {
10024 /*
10025 * its from any other place, we don't allow retran
10026 * output (only control)
10027 */
10028 ret = 1;
10029 }
10030 if (ret > 0) {
10031 /* Can't send anymore */
10032 /*-
10033 * now lets push out control by calling med-level
10034 * output once. this assures that we WILL send HB's
10035 * if queued too.
10036 */
10037 (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1,
10038 from_where,
10039 &now, &now_filled, frag_point, so_locked);
10040 #ifdef SCTP_AUDITING_ENABLED
10041 sctp_auditing(8, inp, stcb, NULL);
10042 #endif
10043 sctp_timer_validation(inp, stcb, asoc);
10044 return;
10045 }
10046 if (ret < 0) {
10047 /*-
10048 * The count was off.. retran is not happening so do
10049 * the normal retransmission.
10050 */
10051 #ifdef SCTP_AUDITING_ENABLED
10052 sctp_auditing(9, inp, stcb, NULL);
10053 #endif
10054 if (ret == SCTP_RETRAN_EXIT) {
10055 return;
10056 }
10057 break;
10058 }
10059 if (from_where == SCTP_OUTPUT_FROM_T3) {
10060 /* Only one transmission allowed out of a timeout */
10061 #ifdef SCTP_AUDITING_ENABLED
10062 sctp_auditing(10, inp, stcb, NULL);
10063 #endif
10064 /* Push out any control */
10065 (void)sctp_med_chunk_output(inp, stcb, asoc, &num_out, &reason_code, 1, from_where,
10066 &now, &now_filled, frag_point, so_locked);
10067 return;
10068 }
10069 if ((asoc->fr_max_burst > 0) && (tot_frs >= asoc->fr_max_burst)) {
10070 /* Hit FR burst limit */
10071 return;
10072 }
10073 if ((num_out == 0) && (ret == 0)) {
10074 /* No more retrans to send */
10075 break;
10076 }
10077 }
10078 #ifdef SCTP_AUDITING_ENABLED
10079 sctp_auditing(12, inp, stcb, NULL);
10080 #endif
10081 /* Check for bad destinations, if they exist move chunks around. */
10082 TAILQ_FOREACH(net, &asoc->nets, sctp_next) {
10083 if (!(net->dest_state & SCTP_ADDR_REACHABLE)) {
10084 /*-
10085 * if possible move things off of this address we
10086 * still may send below due to the dormant state but
10087 * we try to find an alternate address to send to
10088 * and if we have one we move all queued data on the
10089 * out wheel to this alternate address.
10090 */
10091 if (net->ref_count > 1)
10092 sctp_move_chunks_from_net(stcb, net);
10093 } else {
10094 /*-
10095 * if ((asoc->sat_network) || (net->addr_is_local))
10096 * { burst_limit = asoc->max_burst *
10097 * SCTP_SAT_NETWORK_BURST_INCR; }
10098 */
10099 if (asoc->max_burst > 0) {
10100 if (SCTP_BASE_SYSCTL(sctp_use_cwnd_based_maxburst)) {
10101 if ((net->flight_size + (asoc->max_burst * net->mtu)) < net->cwnd) {
10102 /*
10103 * JRS - Use the congestion
10104 * control given in the
10105 * congestion control module
10106 */
10107 asoc->cc_functions.sctp_cwnd_update_after_output(stcb, net, asoc->max_burst);
10108 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_MAXBURST_ENABLE) {
10109 sctp_log_maxburst(stcb, net, 0, asoc->max_burst, SCTP_MAX_BURST_APPLIED);
10110 }
10111 SCTP_STAT_INCR(sctps_maxburstqueued);
10112 }
10113 net->fast_retran_ip = 0;
10114 } else {
10115 if (net->flight_size == 0) {
10116 /*
10117 * Should be decaying the
10118 * cwnd here
10119 */
10120 ;
10121 }
10122 }
10123 }
10124 }
10125
10126 }
10127 burst_cnt = 0;
10128 do {
10129 error = sctp_med_chunk_output(inp, stcb, asoc, &num_out,
10130 &reason_code, 0, from_where,
10131 &now, &now_filled, frag_point, so_locked);
10132 if (error) {
10133 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Error %d was returned from med-c-op\n", error);
10134 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_MAXBURST_ENABLE) {
10135 sctp_log_maxburst(stcb, asoc->primary_destination, error, burst_cnt, SCTP_MAX_BURST_ERROR_STOP);
10136 }
10137 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
10138 sctp_log_cwnd(stcb, NULL, error, SCTP_SEND_NOW_COMPLETES);
10139 sctp_log_cwnd(stcb, NULL, 0xdeadbeef, SCTP_SEND_NOW_COMPLETES);
10140 }
10141 break;
10142 }
10143 SCTPDBG(SCTP_DEBUG_OUTPUT3, "m-c-o put out %d\n", num_out);
10144
10145 tot_out += num_out;
10146 burst_cnt++;
10147 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
10148 sctp_log_cwnd(stcb, NULL, num_out, SCTP_SEND_NOW_COMPLETES);
10149 if (num_out == 0) {
10150 sctp_log_cwnd(stcb, NULL, reason_code, SCTP_SEND_NOW_COMPLETES);
10151 }
10152 }
10153 if (nagle_on) {
10154 /*
10155 * When the Nagle algorithm is used, look at how
10156 * much is unsent, then if its smaller than an MTU
10157 * and we have data in flight we stop, except if we
10158 * are handling a fragmented user message.
10159 */
10160 un_sent = stcb->asoc.total_output_queue_size - stcb->asoc.total_flight;
10161 if ((un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD)) &&
10162 (stcb->asoc.total_flight > 0)) {
10163 /* && sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXPLICIT_EOR))) {*/
10164 break;
10165 }
10166 }
10167 if (TAILQ_EMPTY(&asoc->control_send_queue) &&
10168 TAILQ_EMPTY(&asoc->send_queue) &&
10169 sctp_is_there_unsent_data(stcb, so_locked) == 0) {
10170 /* Nothing left to send */
10171 break;
10172 }
10173 if ((stcb->asoc.total_output_queue_size - stcb->asoc.total_flight) <= 0) {
10174 /* Nothing left to send */
10175 break;
10176 }
10177 } while (num_out &&
10178 ((asoc->max_burst == 0) ||
10179 SCTP_BASE_SYSCTL(sctp_use_cwnd_based_maxburst) ||
10180 (burst_cnt < asoc->max_burst)));
10181
10182 if (SCTP_BASE_SYSCTL(sctp_use_cwnd_based_maxburst) == 0) {
10183 if ((asoc->max_burst > 0) && (burst_cnt >= asoc->max_burst)) {
10184 SCTP_STAT_INCR(sctps_maxburstqueued);
10185 asoc->burst_limit_applied = 1;
10186 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_MAXBURST_ENABLE) {
10187 sctp_log_maxburst(stcb, asoc->primary_destination, 0, burst_cnt, SCTP_MAX_BURST_APPLIED);
10188 }
10189 } else {
10190 asoc->burst_limit_applied = 0;
10191 }
10192 }
10193 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_CWND_LOGGING_ENABLE) {
10194 sctp_log_cwnd(stcb, NULL, tot_out, SCTP_SEND_NOW_COMPLETES);
10195 }
10196 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Ok, we have put out %d chunks\n",
10197 tot_out);
10198
10199 /*-
10200 * Now we need to clean up the control chunk chain if a ECNE is on
10201 * it. It must be marked as UNSENT again so next call will continue
10202 * to send it until such time that we get a CWR, to remove it.
10203 */
10204 if (stcb->asoc.ecn_echo_cnt_onq)
10205 sctp_fix_ecn_echo(asoc);
10206
10207 if (stcb->asoc.trigger_reset) {
10208 if (sctp_send_stream_reset_out_if_possible(stcb, so_locked) == 0) {
10209 goto do_it_again;
10210 }
10211 }
10212 return;
10213 }
10214
10215
10216 int
sctp_output(struct sctp_inpcb * inp,struct mbuf * m,struct sockaddr * addr,struct mbuf * control,struct thread * p,int flags)10217 sctp_output(
10218 struct sctp_inpcb *inp,
10219 struct mbuf *m,
10220 struct sockaddr *addr,
10221 struct mbuf *control,
10222 struct thread *p,
10223 int flags)
10224 {
10225 if (inp == NULL) {
10226 SCTP_LTRACE_ERR_RET_PKT(m, inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
10227 return (EINVAL);
10228 }
10229
10230 if (inp->sctp_socket == NULL) {
10231 SCTP_LTRACE_ERR_RET_PKT(m, inp, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
10232 return (EINVAL);
10233 }
10234 return (sctp_sosend(inp->sctp_socket,
10235 addr,
10236 (struct uio *)NULL,
10237 m,
10238 control,
10239 flags, p
10240 ));
10241 }
10242
10243 void
send_forward_tsn(struct sctp_tcb * stcb,struct sctp_association * asoc)10244 send_forward_tsn(struct sctp_tcb *stcb,
10245 struct sctp_association *asoc)
10246 {
10247 struct sctp_tmit_chunk *chk, *at, *tp1, *last;
10248 struct sctp_forward_tsn_chunk *fwdtsn;
10249 struct sctp_strseq *strseq;
10250 struct sctp_strseq_mid *strseq_m;
10251 uint32_t advance_peer_ack_point;
10252 unsigned int cnt_of_space, i, ovh;
10253 unsigned int space_needed;
10254 unsigned int cnt_of_skipped = 0;
10255
10256 SCTP_TCB_LOCK_ASSERT(stcb);
10257 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
10258 if (chk->rec.chunk_id.id == SCTP_FORWARD_CUM_TSN) {
10259 /* mark it to unsent */
10260 chk->sent = SCTP_DATAGRAM_UNSENT;
10261 chk->snd_count = 0;
10262 /* Do we correct its output location? */
10263 if (chk->whoTo) {
10264 sctp_free_remote_addr(chk->whoTo);
10265 chk->whoTo = NULL;
10266 }
10267 goto sctp_fill_in_rest;
10268 }
10269 }
10270 /* Ok if we reach here we must build one */
10271 sctp_alloc_a_chunk(stcb, chk);
10272 if (chk == NULL) {
10273 return;
10274 }
10275 asoc->fwd_tsn_cnt++;
10276 chk->copy_by_ref = 0;
10277 /*
10278 * We don't do the old thing here since this is used not for on-wire
10279 * but to tell if we are sending a fwd-tsn by the stack during
10280 * output. And if its a IFORWARD or a FORWARD it is a fwd-tsn.
10281 */
10282 chk->rec.chunk_id.id = SCTP_FORWARD_CUM_TSN;
10283 chk->rec.chunk_id.can_take_data = 0;
10284 chk->flags = 0;
10285 chk->asoc = asoc;
10286 chk->whoTo = NULL;
10287 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
10288 if (chk->data == NULL) {
10289 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
10290 return;
10291 }
10292 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
10293 chk->sent = SCTP_DATAGRAM_UNSENT;
10294 chk->snd_count = 0;
10295 TAILQ_INSERT_TAIL(&asoc->control_send_queue, chk, sctp_next);
10296 asoc->ctrl_queue_cnt++;
10297 sctp_fill_in_rest:
10298 /*-
10299 * Here we go through and fill out the part that deals with
10300 * stream/seq of the ones we skip.
10301 */
10302 SCTP_BUF_LEN(chk->data) = 0;
10303 TAILQ_FOREACH(at, &asoc->sent_queue, sctp_next) {
10304 if ((at->sent != SCTP_FORWARD_TSN_SKIP) &&
10305 (at->sent != SCTP_DATAGRAM_NR_ACKED)) {
10306 /* no more to look at */
10307 break;
10308 }
10309 if (!asoc->idata_supported && (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED)) {
10310 /* We don't report these */
10311 continue;
10312 }
10313 cnt_of_skipped++;
10314 }
10315 if (asoc->idata_supported) {
10316 space_needed = (sizeof(struct sctp_forward_tsn_chunk) +
10317 (cnt_of_skipped * sizeof(struct sctp_strseq_mid)));
10318 } else {
10319 space_needed = (sizeof(struct sctp_forward_tsn_chunk) +
10320 (cnt_of_skipped * sizeof(struct sctp_strseq)));
10321 }
10322 cnt_of_space = (unsigned int)M_TRAILINGSPACE(chk->data);
10323
10324 if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) {
10325 ovh = SCTP_MIN_OVERHEAD;
10326 } else {
10327 ovh = SCTP_MIN_V4_OVERHEAD;
10328 }
10329 if (cnt_of_space > (asoc->smallest_mtu - ovh)) {
10330 /* trim to a mtu size */
10331 cnt_of_space = asoc->smallest_mtu - ovh;
10332 }
10333 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
10334 sctp_misc_ints(SCTP_FWD_TSN_CHECK,
10335 0xff, 0, cnt_of_skipped,
10336 asoc->advanced_peer_ack_point);
10337 }
10338 advance_peer_ack_point = asoc->advanced_peer_ack_point;
10339 if (cnt_of_space < space_needed) {
10340 /*-
10341 * ok we must trim down the chunk by lowering the
10342 * advance peer ack point.
10343 */
10344 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
10345 sctp_misc_ints(SCTP_FWD_TSN_CHECK,
10346 0xff, 0xff, cnt_of_space,
10347 space_needed);
10348 }
10349 cnt_of_skipped = cnt_of_space - sizeof(struct sctp_forward_tsn_chunk);
10350 if (asoc->idata_supported) {
10351 cnt_of_skipped /= sizeof(struct sctp_strseq_mid);
10352 } else {
10353 cnt_of_skipped /= sizeof(struct sctp_strseq);
10354 }
10355 /*-
10356 * Go through and find the TSN that will be the one
10357 * we report.
10358 */
10359 at = TAILQ_FIRST(&asoc->sent_queue);
10360 if (at != NULL) {
10361 for (i = 0; i < cnt_of_skipped; i++) {
10362 tp1 = TAILQ_NEXT(at, sctp_next);
10363 if (tp1 == NULL) {
10364 break;
10365 }
10366 at = tp1;
10367 }
10368 }
10369 if (at && SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LOG_TRY_ADVANCE) {
10370 sctp_misc_ints(SCTP_FWD_TSN_CHECK,
10371 0xff, cnt_of_skipped, at->rec.data.tsn,
10372 asoc->advanced_peer_ack_point);
10373 }
10374 last = at;
10375 /*-
10376 * last now points to last one I can report, update
10377 * peer ack point
10378 */
10379 if (last) {
10380 advance_peer_ack_point = last->rec.data.tsn;
10381 }
10382 if (asoc->idata_supported) {
10383 space_needed = sizeof(struct sctp_forward_tsn_chunk) +
10384 cnt_of_skipped * sizeof(struct sctp_strseq_mid);
10385 } else {
10386 space_needed = sizeof(struct sctp_forward_tsn_chunk) +
10387 cnt_of_skipped * sizeof(struct sctp_strseq);
10388 }
10389 }
10390 chk->send_size = space_needed;
10391 /* Setup the chunk */
10392 fwdtsn = mtod(chk->data, struct sctp_forward_tsn_chunk *);
10393 fwdtsn->ch.chunk_length = htons(chk->send_size);
10394 fwdtsn->ch.chunk_flags = 0;
10395 if (asoc->idata_supported) {
10396 fwdtsn->ch.chunk_type = SCTP_IFORWARD_CUM_TSN;
10397 } else {
10398 fwdtsn->ch.chunk_type = SCTP_FORWARD_CUM_TSN;
10399 }
10400 fwdtsn->new_cumulative_tsn = htonl(advance_peer_ack_point);
10401 SCTP_BUF_LEN(chk->data) = chk->send_size;
10402 fwdtsn++;
10403 /*-
10404 * Move pointer to after the fwdtsn and transfer to the
10405 * strseq pointer.
10406 */
10407 if (asoc->idata_supported) {
10408 strseq_m = (struct sctp_strseq_mid *)fwdtsn;
10409 strseq = NULL;
10410 } else {
10411 strseq = (struct sctp_strseq *)fwdtsn;
10412 strseq_m = NULL;
10413 }
10414 /*-
10415 * Now populate the strseq list. This is done blindly
10416 * without pulling out duplicate stream info. This is
10417 * inefficient but won't harm the process since the peer will
10418 * look at these in sequence and will thus release anything.
10419 * It could mean we exceed the PMTU and chop off some that
10420 * we could have included.. but this is unlikely (aka 1432/4
10421 * would mean 300+ stream seq's would have to be reported in
10422 * one FWD-TSN. With a bit of work we can later FIX this to
10423 * optimize and pull out duplicates.. but it does add more
10424 * overhead. So for now... not!
10425 */
10426 i = 0;
10427 TAILQ_FOREACH(at, &asoc->sent_queue, sctp_next) {
10428 if (i >= cnt_of_skipped) {
10429 break;
10430 }
10431 if (!asoc->idata_supported && (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED)) {
10432 /* We don't report these */
10433 continue;
10434 }
10435 if (at->rec.data.tsn == advance_peer_ack_point) {
10436 at->rec.data.fwd_tsn_cnt = 0;
10437 }
10438 if (asoc->idata_supported) {
10439 strseq_m->sid = htons(at->rec.data.sid);
10440 if (at->rec.data.rcv_flags & SCTP_DATA_UNORDERED) {
10441 strseq_m->flags = htons(PR_SCTP_UNORDERED_FLAG);
10442 } else {
10443 strseq_m->flags = 0;
10444 }
10445 strseq_m->mid = htonl(at->rec.data.mid);
10446 strseq_m++;
10447 } else {
10448 strseq->sid = htons(at->rec.data.sid);
10449 strseq->ssn = htons((uint16_t)at->rec.data.mid);
10450 strseq++;
10451 }
10452 i++;
10453 }
10454 return;
10455 }
10456
10457 void
sctp_send_sack(struct sctp_tcb * stcb,int so_locked)10458 sctp_send_sack(struct sctp_tcb *stcb, int so_locked)
10459 {
10460 /*-
10461 * Queue up a SACK or NR-SACK in the control queue.
10462 * We must first check to see if a SACK or NR-SACK is
10463 * somehow on the control queue.
10464 * If so, we will take and and remove the old one.
10465 */
10466 struct sctp_association *asoc;
10467 struct sctp_tmit_chunk *chk, *a_chk;
10468 struct sctp_sack_chunk *sack;
10469 struct sctp_nr_sack_chunk *nr_sack;
10470 struct sctp_gap_ack_block *gap_descriptor;
10471 const struct sack_track *selector;
10472 int mergeable = 0;
10473 int offset;
10474 caddr_t limit;
10475 uint32_t *dup;
10476 int limit_reached = 0;
10477 unsigned int i, siz, j;
10478 unsigned int num_gap_blocks = 0, num_nr_gap_blocks = 0, space;
10479 int num_dups = 0;
10480 int space_req;
10481 uint32_t highest_tsn;
10482 uint8_t flags;
10483 uint8_t type;
10484 uint8_t tsn_map;
10485
10486 if (stcb->asoc.nrsack_supported == 1) {
10487 type = SCTP_NR_SELECTIVE_ACK;
10488 } else {
10489 type = SCTP_SELECTIVE_ACK;
10490 }
10491 a_chk = NULL;
10492 asoc = &stcb->asoc;
10493 SCTP_TCB_LOCK_ASSERT(stcb);
10494 if (asoc->last_data_chunk_from == NULL) {
10495 /* Hmm we never received anything */
10496 return;
10497 }
10498 sctp_slide_mapping_arrays(stcb);
10499 sctp_set_rwnd(stcb, asoc);
10500 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
10501 if (chk->rec.chunk_id.id == type) {
10502 /* Hmm, found a sack already on queue, remove it */
10503 TAILQ_REMOVE(&asoc->control_send_queue, chk, sctp_next);
10504 asoc->ctrl_queue_cnt--;
10505 a_chk = chk;
10506 if (a_chk->data) {
10507 sctp_m_freem(a_chk->data);
10508 a_chk->data = NULL;
10509 }
10510 if (a_chk->whoTo) {
10511 sctp_free_remote_addr(a_chk->whoTo);
10512 a_chk->whoTo = NULL;
10513 }
10514 break;
10515 }
10516 }
10517 if (a_chk == NULL) {
10518 sctp_alloc_a_chunk(stcb, a_chk);
10519 if (a_chk == NULL) {
10520 /* No memory so we drop the idea, and set a timer */
10521 if (stcb->asoc.delayed_ack) {
10522 sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
10523 stcb->sctp_ep, stcb, NULL,
10524 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_4);
10525 sctp_timer_start(SCTP_TIMER_TYPE_RECV,
10526 stcb->sctp_ep, stcb, NULL);
10527 } else {
10528 stcb->asoc.send_sack = 1;
10529 }
10530 return;
10531 }
10532 a_chk->copy_by_ref = 0;
10533 a_chk->rec.chunk_id.id = type;
10534 a_chk->rec.chunk_id.can_take_data = 1;
10535 }
10536 /* Clear our pkt counts */
10537 asoc->data_pkts_seen = 0;
10538
10539 a_chk->flags = 0;
10540 a_chk->asoc = asoc;
10541 a_chk->snd_count = 0;
10542 a_chk->send_size = 0; /* fill in later */
10543 a_chk->sent = SCTP_DATAGRAM_UNSENT;
10544 a_chk->whoTo = NULL;
10545
10546 if (!(asoc->last_data_chunk_from->dest_state & SCTP_ADDR_REACHABLE)) {
10547 /*-
10548 * Ok, the destination for the SACK is unreachable, lets see if
10549 * we can select an alternate to asoc->last_data_chunk_from
10550 */
10551 a_chk->whoTo = sctp_find_alternate_net(stcb, asoc->last_data_chunk_from, 0);
10552 if (a_chk->whoTo == NULL) {
10553 /* Nope, no alternate */
10554 a_chk->whoTo = asoc->last_data_chunk_from;
10555 }
10556 } else {
10557 a_chk->whoTo = asoc->last_data_chunk_from;
10558 }
10559 if (a_chk->whoTo) {
10560 atomic_add_int(&a_chk->whoTo->ref_count, 1);
10561 }
10562 if (SCTP_TSN_GT(asoc->highest_tsn_inside_map, asoc->highest_tsn_inside_nr_map)) {
10563 highest_tsn = asoc->highest_tsn_inside_map;
10564 } else {
10565 highest_tsn = asoc->highest_tsn_inside_nr_map;
10566 }
10567 if (highest_tsn == asoc->cumulative_tsn) {
10568 /* no gaps */
10569 if (type == SCTP_SELECTIVE_ACK) {
10570 space_req = sizeof(struct sctp_sack_chunk);
10571 } else {
10572 space_req = sizeof(struct sctp_nr_sack_chunk);
10573 }
10574 } else {
10575 /* gaps get a cluster */
10576 space_req = MCLBYTES;
10577 }
10578 /* Ok now lets formulate a MBUF with our sack */
10579 a_chk->data = sctp_get_mbuf_for_msg(space_req, 0, M_NOWAIT, 1, MT_DATA);
10580 if ((a_chk->data == NULL) ||
10581 (a_chk->whoTo == NULL)) {
10582 /* rats, no mbuf memory */
10583 if (a_chk->data) {
10584 /* was a problem with the destination */
10585 sctp_m_freem(a_chk->data);
10586 a_chk->data = NULL;
10587 }
10588 sctp_free_a_chunk(stcb, a_chk, so_locked);
10589 /* sa_ignore NO_NULL_CHK */
10590 if (stcb->asoc.delayed_ack) {
10591 sctp_timer_stop(SCTP_TIMER_TYPE_RECV,
10592 stcb->sctp_ep, stcb, NULL,
10593 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_5);
10594 sctp_timer_start(SCTP_TIMER_TYPE_RECV,
10595 stcb->sctp_ep, stcb, NULL);
10596 } else {
10597 stcb->asoc.send_sack = 1;
10598 }
10599 return;
10600 }
10601 /* ok, lets go through and fill it in */
10602 SCTP_BUF_RESV_UF(a_chk->data, SCTP_MIN_OVERHEAD);
10603 space = (unsigned int)M_TRAILINGSPACE(a_chk->data);
10604 if (space > (a_chk->whoTo->mtu - SCTP_MIN_OVERHEAD)) {
10605 space = (a_chk->whoTo->mtu - SCTP_MIN_OVERHEAD);
10606 }
10607 limit = mtod(a_chk->data, caddr_t);
10608 limit += space;
10609
10610 flags = 0;
10611
10612 if ((asoc->sctp_cmt_on_off > 0) &&
10613 SCTP_BASE_SYSCTL(sctp_cmt_use_dac)) {
10614 /*-
10615 * CMT DAC algorithm: If 2 (i.e., 0x10) packets have been
10616 * received, then set high bit to 1, else 0. Reset
10617 * pkts_rcvd.
10618 */
10619 flags |= (asoc->cmt_dac_pkts_rcvd << 6);
10620 asoc->cmt_dac_pkts_rcvd = 0;
10621 }
10622 #ifdef SCTP_ASOCLOG_OF_TSNS
10623 stcb->asoc.cumack_logsnt[stcb->asoc.cumack_log_atsnt] = asoc->cumulative_tsn;
10624 stcb->asoc.cumack_log_atsnt++;
10625 if (stcb->asoc.cumack_log_atsnt >= SCTP_TSN_LOG_SIZE) {
10626 stcb->asoc.cumack_log_atsnt = 0;
10627 }
10628 #endif
10629 /* reset the readers interpretation */
10630 stcb->freed_by_sorcv_sincelast = 0;
10631
10632 if (type == SCTP_SELECTIVE_ACK) {
10633 sack = mtod(a_chk->data, struct sctp_sack_chunk *);
10634 nr_sack = NULL;
10635 gap_descriptor = (struct sctp_gap_ack_block *)((caddr_t)sack + sizeof(struct sctp_sack_chunk));
10636 if (highest_tsn > asoc->mapping_array_base_tsn) {
10637 siz = (((highest_tsn - asoc->mapping_array_base_tsn) + 1) + 7) / 8;
10638 } else {
10639 siz = (((MAX_TSN - asoc->mapping_array_base_tsn) + 1) + highest_tsn + 7) / 8;
10640 }
10641 } else {
10642 sack = NULL;
10643 nr_sack = mtod(a_chk->data, struct sctp_nr_sack_chunk *);
10644 gap_descriptor = (struct sctp_gap_ack_block *)((caddr_t)nr_sack + sizeof(struct sctp_nr_sack_chunk));
10645 if (asoc->highest_tsn_inside_map > asoc->mapping_array_base_tsn) {
10646 siz = (((asoc->highest_tsn_inside_map - asoc->mapping_array_base_tsn) + 1) + 7) / 8;
10647 } else {
10648 siz = (((MAX_TSN - asoc->mapping_array_base_tsn) + 1) + asoc->highest_tsn_inside_map + 7) / 8;
10649 }
10650 }
10651
10652 if (SCTP_TSN_GT(asoc->mapping_array_base_tsn, asoc->cumulative_tsn)) {
10653 offset = 1;
10654 } else {
10655 offset = asoc->mapping_array_base_tsn - asoc->cumulative_tsn;
10656 }
10657 if (((type == SCTP_SELECTIVE_ACK) &&
10658 SCTP_TSN_GT(highest_tsn, asoc->cumulative_tsn)) ||
10659 ((type == SCTP_NR_SELECTIVE_ACK) &&
10660 SCTP_TSN_GT(asoc->highest_tsn_inside_map, asoc->cumulative_tsn))) {
10661 /* we have a gap .. maybe */
10662 for (i = 0; i < siz; i++) {
10663 tsn_map = asoc->mapping_array[i];
10664 if (type == SCTP_SELECTIVE_ACK) {
10665 tsn_map |= asoc->nr_mapping_array[i];
10666 }
10667 if (i == 0) {
10668 /*
10669 * Clear all bits corresponding to TSNs
10670 * smaller or equal to the cumulative TSN.
10671 */
10672 tsn_map &= (~0U << (1 - offset));
10673 }
10674 selector = &sack_array[tsn_map];
10675 if (mergeable && selector->right_edge) {
10676 /*
10677 * Backup, left and right edges were ok to
10678 * merge.
10679 */
10680 num_gap_blocks--;
10681 gap_descriptor--;
10682 }
10683 if (selector->num_entries == 0)
10684 mergeable = 0;
10685 else {
10686 for (j = 0; j < selector->num_entries; j++) {
10687 if (mergeable && selector->right_edge) {
10688 /*
10689 * do a merge by NOT setting
10690 * the left side
10691 */
10692 mergeable = 0;
10693 } else {
10694 /*
10695 * no merge, set the left
10696 * side
10697 */
10698 mergeable = 0;
10699 gap_descriptor->start = htons((selector->gaps[j].start + offset));
10700 }
10701 gap_descriptor->end = htons((selector->gaps[j].end + offset));
10702 num_gap_blocks++;
10703 gap_descriptor++;
10704 if (((caddr_t)gap_descriptor + sizeof(struct sctp_gap_ack_block)) > limit) {
10705 /* no more room */
10706 limit_reached = 1;
10707 break;
10708 }
10709 }
10710 if (selector->left_edge) {
10711 mergeable = 1;
10712 }
10713 }
10714 if (limit_reached) {
10715 /* Reached the limit stop */
10716 break;
10717 }
10718 offset += 8;
10719 }
10720 }
10721 if ((type == SCTP_NR_SELECTIVE_ACK) &&
10722 (limit_reached == 0)) {
10723
10724 mergeable = 0;
10725
10726 if (asoc->highest_tsn_inside_nr_map > asoc->mapping_array_base_tsn) {
10727 siz = (((asoc->highest_tsn_inside_nr_map - asoc->mapping_array_base_tsn) + 1) + 7) / 8;
10728 } else {
10729 siz = (((MAX_TSN - asoc->mapping_array_base_tsn) + 1) + asoc->highest_tsn_inside_nr_map + 7) / 8;
10730 }
10731
10732 if (SCTP_TSN_GT(asoc->mapping_array_base_tsn, asoc->cumulative_tsn)) {
10733 offset = 1;
10734 } else {
10735 offset = asoc->mapping_array_base_tsn - asoc->cumulative_tsn;
10736 }
10737 if (SCTP_TSN_GT(asoc->highest_tsn_inside_nr_map, asoc->cumulative_tsn)) {
10738 /* we have a gap .. maybe */
10739 for (i = 0; i < siz; i++) {
10740 tsn_map = asoc->nr_mapping_array[i];
10741 if (i == 0) {
10742 /*
10743 * Clear all bits corresponding to
10744 * TSNs smaller or equal to the
10745 * cumulative TSN.
10746 */
10747 tsn_map &= (~0U << (1 - offset));
10748 }
10749 selector = &sack_array[tsn_map];
10750 if (mergeable && selector->right_edge) {
10751 /*
10752 * Backup, left and right edges were
10753 * ok to merge.
10754 */
10755 num_nr_gap_blocks--;
10756 gap_descriptor--;
10757 }
10758 if (selector->num_entries == 0)
10759 mergeable = 0;
10760 else {
10761 for (j = 0; j < selector->num_entries; j++) {
10762 if (mergeable && selector->right_edge) {
10763 /*
10764 * do a merge by NOT
10765 * setting the left
10766 * side
10767 */
10768 mergeable = 0;
10769 } else {
10770 /*
10771 * no merge, set the
10772 * left side
10773 */
10774 mergeable = 0;
10775 gap_descriptor->start = htons((selector->gaps[j].start + offset));
10776 }
10777 gap_descriptor->end = htons((selector->gaps[j].end + offset));
10778 num_nr_gap_blocks++;
10779 gap_descriptor++;
10780 if (((caddr_t)gap_descriptor + sizeof(struct sctp_gap_ack_block)) > limit) {
10781 /* no more room */
10782 limit_reached = 1;
10783 break;
10784 }
10785 }
10786 if (selector->left_edge) {
10787 mergeable = 1;
10788 }
10789 }
10790 if (limit_reached) {
10791 /* Reached the limit stop */
10792 break;
10793 }
10794 offset += 8;
10795 }
10796 }
10797 }
10798 /* now we must add any dups we are going to report. */
10799 if ((limit_reached == 0) && (asoc->numduptsns)) {
10800 dup = (uint32_t *)gap_descriptor;
10801 for (i = 0; i < asoc->numduptsns; i++) {
10802 *dup = htonl(asoc->dup_tsns[i]);
10803 dup++;
10804 num_dups++;
10805 if (((caddr_t)dup + sizeof(uint32_t)) > limit) {
10806 /* no more room */
10807 break;
10808 }
10809 }
10810 asoc->numduptsns = 0;
10811 }
10812 /*
10813 * now that the chunk is prepared queue it to the control chunk
10814 * queue.
10815 */
10816 if (type == SCTP_SELECTIVE_ACK) {
10817 a_chk->send_size = (uint16_t)(sizeof(struct sctp_sack_chunk) +
10818 (num_gap_blocks + num_nr_gap_blocks) * sizeof(struct sctp_gap_ack_block) +
10819 num_dups * sizeof(int32_t));
10820 SCTP_BUF_LEN(a_chk->data) = a_chk->send_size;
10821 sack->sack.cum_tsn_ack = htonl(asoc->cumulative_tsn);
10822 sack->sack.a_rwnd = htonl(asoc->my_rwnd);
10823 sack->sack.num_gap_ack_blks = htons(num_gap_blocks);
10824 sack->sack.num_dup_tsns = htons(num_dups);
10825 sack->ch.chunk_type = type;
10826 sack->ch.chunk_flags = flags;
10827 sack->ch.chunk_length = htons(a_chk->send_size);
10828 } else {
10829 a_chk->send_size = (uint16_t)(sizeof(struct sctp_nr_sack_chunk) +
10830 (num_gap_blocks + num_nr_gap_blocks) * sizeof(struct sctp_gap_ack_block) +
10831 num_dups * sizeof(int32_t));
10832 SCTP_BUF_LEN(a_chk->data) = a_chk->send_size;
10833 nr_sack->nr_sack.cum_tsn_ack = htonl(asoc->cumulative_tsn);
10834 nr_sack->nr_sack.a_rwnd = htonl(asoc->my_rwnd);
10835 nr_sack->nr_sack.num_gap_ack_blks = htons(num_gap_blocks);
10836 nr_sack->nr_sack.num_nr_gap_ack_blks = htons(num_nr_gap_blocks);
10837 nr_sack->nr_sack.num_dup_tsns = htons(num_dups);
10838 nr_sack->nr_sack.reserved = 0;
10839 nr_sack->ch.chunk_type = type;
10840 nr_sack->ch.chunk_flags = flags;
10841 nr_sack->ch.chunk_length = htons(a_chk->send_size);
10842 }
10843 TAILQ_INSERT_TAIL(&asoc->control_send_queue, a_chk, sctp_next);
10844 asoc->my_last_reported_rwnd = asoc->my_rwnd;
10845 asoc->ctrl_queue_cnt++;
10846 asoc->send_sack = 0;
10847 SCTP_STAT_INCR(sctps_sendsacks);
10848 return;
10849 }
10850
10851 void
sctp_send_abort_tcb(struct sctp_tcb * stcb,struct mbuf * operr,int so_locked)10852 sctp_send_abort_tcb(struct sctp_tcb *stcb, struct mbuf *operr, int so_locked)
10853 {
10854 struct mbuf *m_abort, *m, *m_last;
10855 struct mbuf *m_out, *m_end = NULL;
10856 struct sctp_abort_chunk *abort;
10857 struct sctp_auth_chunk *auth = NULL;
10858 struct sctp_nets *net;
10859 uint32_t vtag;
10860 uint32_t auth_offset = 0;
10861 int error;
10862 uint16_t cause_len, chunk_len, padding_len;
10863
10864 SCTP_TCB_LOCK_ASSERT(stcb);
10865 /*-
10866 * Add an AUTH chunk, if chunk requires it and save the offset into
10867 * the chain for AUTH
10868 */
10869 if (sctp_auth_is_required_chunk(SCTP_ABORT_ASSOCIATION,
10870 stcb->asoc.peer_auth_chunks)) {
10871 m_out = sctp_add_auth_chunk(NULL, &m_end, &auth, &auth_offset,
10872 stcb, SCTP_ABORT_ASSOCIATION);
10873 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
10874 } else {
10875 m_out = NULL;
10876 }
10877 m_abort = sctp_get_mbuf_for_msg(sizeof(struct sctp_abort_chunk), 0, M_NOWAIT, 1, MT_HEADER);
10878 if (m_abort == NULL) {
10879 if (m_out) {
10880 sctp_m_freem(m_out);
10881 }
10882 if (operr) {
10883 sctp_m_freem(operr);
10884 }
10885 return;
10886 }
10887 /* link in any error */
10888 SCTP_BUF_NEXT(m_abort) = operr;
10889 cause_len = 0;
10890 m_last = NULL;
10891 for (m = operr; m; m = SCTP_BUF_NEXT(m)) {
10892 cause_len += (uint16_t)SCTP_BUF_LEN(m);
10893 if (SCTP_BUF_NEXT(m) == NULL) {
10894 m_last = m;
10895 }
10896 }
10897 SCTP_BUF_LEN(m_abort) = sizeof(struct sctp_abort_chunk);
10898 chunk_len = (uint16_t)sizeof(struct sctp_abort_chunk) + cause_len;
10899 padding_len = SCTP_SIZE32(chunk_len) - chunk_len;
10900 if (m_out == NULL) {
10901 /* NO Auth chunk prepended, so reserve space in front */
10902 SCTP_BUF_RESV_UF(m_abort, SCTP_MIN_OVERHEAD);
10903 m_out = m_abort;
10904 } else {
10905 /* Put AUTH chunk at the front of the chain */
10906 SCTP_BUF_NEXT(m_end) = m_abort;
10907 }
10908 if (stcb->asoc.alternate) {
10909 net = stcb->asoc.alternate;
10910 } else {
10911 net = stcb->asoc.primary_destination;
10912 }
10913 /* Fill in the ABORT chunk header. */
10914 abort = mtod(m_abort, struct sctp_abort_chunk *);
10915 abort->ch.chunk_type = SCTP_ABORT_ASSOCIATION;
10916 if (stcb->asoc.peer_vtag == 0) {
10917 /* This happens iff the assoc is in COOKIE-WAIT state. */
10918 vtag = stcb->asoc.my_vtag;
10919 abort->ch.chunk_flags = SCTP_HAD_NO_TCB;
10920 } else {
10921 vtag = stcb->asoc.peer_vtag;
10922 abort->ch.chunk_flags = 0;
10923 }
10924 abort->ch.chunk_length = htons(chunk_len);
10925 /* Add padding, if necessary. */
10926 if (padding_len > 0) {
10927 if ((m_last == NULL) ||
10928 (sctp_add_pad_tombuf(m_last, padding_len) == NULL)) {
10929 sctp_m_freem(m_out);
10930 return;
10931 }
10932 }
10933 if ((error = sctp_lowlevel_chunk_output(stcb->sctp_ep, stcb, net,
10934 (struct sockaddr *)&net->ro._l_addr,
10935 m_out, auth_offset, auth, stcb->asoc.authinfo.active_keyid, 1, 0, 0,
10936 stcb->sctp_ep->sctp_lport, stcb->rport, htonl(vtag),
10937 stcb->asoc.primary_destination->port, NULL,
10938 0, 0,
10939 so_locked))) {
10940 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
10941 if (error == ENOBUFS) {
10942 stcb->asoc.ifp_had_enobuf = 1;
10943 SCTP_STAT_INCR(sctps_lowlevelerr);
10944 }
10945 } else {
10946 stcb->asoc.ifp_had_enobuf = 0;
10947 }
10948 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
10949 }
10950
10951 void
sctp_send_shutdown_complete(struct sctp_tcb * stcb,struct sctp_nets * net,int reflect_vtag)10952 sctp_send_shutdown_complete(struct sctp_tcb *stcb,
10953 struct sctp_nets *net,
10954 int reflect_vtag)
10955 {
10956 /* formulate and SEND a SHUTDOWN-COMPLETE */
10957 struct mbuf *m_shutdown_comp;
10958 struct sctp_shutdown_complete_chunk *shutdown_complete;
10959 uint32_t vtag;
10960 int error;
10961 uint8_t flags;
10962
10963 m_shutdown_comp = sctp_get_mbuf_for_msg(sizeof(struct sctp_chunkhdr), 0, M_NOWAIT, 1, MT_HEADER);
10964 if (m_shutdown_comp == NULL) {
10965 /* no mbuf's */
10966 return;
10967 }
10968 if (reflect_vtag) {
10969 flags = SCTP_HAD_NO_TCB;
10970 vtag = stcb->asoc.my_vtag;
10971 } else {
10972 flags = 0;
10973 vtag = stcb->asoc.peer_vtag;
10974 }
10975 shutdown_complete = mtod(m_shutdown_comp, struct sctp_shutdown_complete_chunk *);
10976 shutdown_complete->ch.chunk_type = SCTP_SHUTDOWN_COMPLETE;
10977 shutdown_complete->ch.chunk_flags = flags;
10978 shutdown_complete->ch.chunk_length = htons(sizeof(struct sctp_shutdown_complete_chunk));
10979 SCTP_BUF_LEN(m_shutdown_comp) = sizeof(struct sctp_shutdown_complete_chunk);
10980 if ((error = sctp_lowlevel_chunk_output(stcb->sctp_ep, stcb, net,
10981 (struct sockaddr *)&net->ro._l_addr,
10982 m_shutdown_comp, 0, NULL, 0, 1, 0, 0,
10983 stcb->sctp_ep->sctp_lport, stcb->rport,
10984 htonl(vtag),
10985 net->port, NULL,
10986 0, 0,
10987 SCTP_SO_NOT_LOCKED))) {
10988 SCTPDBG(SCTP_DEBUG_OUTPUT3, "Gak send error %d\n", error);
10989 if (error == ENOBUFS) {
10990 stcb->asoc.ifp_had_enobuf = 1;
10991 SCTP_STAT_INCR(sctps_lowlevelerr);
10992 }
10993 } else {
10994 stcb->asoc.ifp_had_enobuf = 0;
10995 }
10996 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
10997 return;
10998 }
10999
11000 static void
sctp_send_resp_msg(struct sockaddr * src,struct sockaddr * dst,struct sctphdr * sh,uint32_t vtag,uint8_t type,struct mbuf * cause,uint8_t mflowtype,uint32_t mflowid,uint16_t fibnum,uint32_t vrf_id,uint16_t port)11001 sctp_send_resp_msg(struct sockaddr *src, struct sockaddr *dst,
11002 struct sctphdr *sh, uint32_t vtag,
11003 uint8_t type, struct mbuf *cause,
11004 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
11005 uint32_t vrf_id, uint16_t port)
11006 {
11007 struct mbuf *o_pak;
11008 struct mbuf *mout;
11009 struct sctphdr *shout;
11010 struct sctp_chunkhdr *ch;
11011 #if defined(INET) || defined(INET6)
11012 struct udphdr *udp;
11013 #endif
11014 int ret, len, cause_len, padding_len;
11015 #ifdef INET
11016 struct sockaddr_in *src_sin, *dst_sin;
11017 struct ip *ip;
11018 #endif
11019 #ifdef INET6
11020 struct sockaddr_in6 *src_sin6, *dst_sin6;
11021 struct ip6_hdr *ip6;
11022 #endif
11023
11024 /* Compute the length of the cause and add final padding. */
11025 cause_len = 0;
11026 if (cause != NULL) {
11027 struct mbuf *m_at, *m_last = NULL;
11028
11029 for (m_at = cause; m_at; m_at = SCTP_BUF_NEXT(m_at)) {
11030 if (SCTP_BUF_NEXT(m_at) == NULL)
11031 m_last = m_at;
11032 cause_len += SCTP_BUF_LEN(m_at);
11033 }
11034 padding_len = cause_len % 4;
11035 if (padding_len != 0) {
11036 padding_len = 4 - padding_len;
11037 }
11038 if (padding_len != 0) {
11039 if (sctp_add_pad_tombuf(m_last, padding_len) == NULL) {
11040 sctp_m_freem(cause);
11041 return;
11042 }
11043 }
11044 } else {
11045 padding_len = 0;
11046 }
11047 /* Get an mbuf for the header. */
11048 len = sizeof(struct sctphdr) + sizeof(struct sctp_chunkhdr);
11049 switch (dst->sa_family) {
11050 #ifdef INET
11051 case AF_INET:
11052 len += sizeof(struct ip);
11053 break;
11054 #endif
11055 #ifdef INET6
11056 case AF_INET6:
11057 len += sizeof(struct ip6_hdr);
11058 break;
11059 #endif
11060 default:
11061 break;
11062 }
11063 #if defined(INET) || defined(INET6)
11064 if (port) {
11065 len += sizeof(struct udphdr);
11066 }
11067 #endif
11068 mout = sctp_get_mbuf_for_msg(len + max_linkhdr, 1, M_NOWAIT, 1, MT_DATA);
11069 if (mout == NULL) {
11070 if (cause) {
11071 sctp_m_freem(cause);
11072 }
11073 return;
11074 }
11075 SCTP_BUF_RESV_UF(mout, max_linkhdr);
11076 SCTP_BUF_LEN(mout) = len;
11077 SCTP_BUF_NEXT(mout) = cause;
11078 M_SETFIB(mout, fibnum);
11079 mout->m_pkthdr.flowid = mflowid;
11080 M_HASHTYPE_SET(mout, mflowtype);
11081 #ifdef INET
11082 ip = NULL;
11083 #endif
11084 #ifdef INET6
11085 ip6 = NULL;
11086 #endif
11087 switch (dst->sa_family) {
11088 #ifdef INET
11089 case AF_INET:
11090 src_sin = (struct sockaddr_in *)src;
11091 dst_sin = (struct sockaddr_in *)dst;
11092 ip = mtod(mout, struct ip *);
11093 ip->ip_v = IPVERSION;
11094 ip->ip_hl = (sizeof(struct ip) >> 2);
11095 ip->ip_tos = 0;
11096 ip->ip_off = htons(IP_DF);
11097 ip_fillid(ip);
11098 ip->ip_ttl = MODULE_GLOBAL(ip_defttl);
11099 if (port) {
11100 ip->ip_p = IPPROTO_UDP;
11101 } else {
11102 ip->ip_p = IPPROTO_SCTP;
11103 }
11104 ip->ip_src.s_addr = dst_sin->sin_addr.s_addr;
11105 ip->ip_dst.s_addr = src_sin->sin_addr.s_addr;
11106 ip->ip_sum = 0;
11107 len = sizeof(struct ip);
11108 shout = (struct sctphdr *)((caddr_t)ip + len);
11109 break;
11110 #endif
11111 #ifdef INET6
11112 case AF_INET6:
11113 src_sin6 = (struct sockaddr_in6 *)src;
11114 dst_sin6 = (struct sockaddr_in6 *)dst;
11115 ip6 = mtod(mout, struct ip6_hdr *);
11116 ip6->ip6_flow = htonl(0x60000000);
11117 if (V_ip6_auto_flowlabel) {
11118 ip6->ip6_flow |= (htonl(ip6_randomflowlabel()) & IPV6_FLOWLABEL_MASK);
11119 }
11120 ip6->ip6_hlim = MODULE_GLOBAL(ip6_defhlim);
11121 if (port) {
11122 ip6->ip6_nxt = IPPROTO_UDP;
11123 } else {
11124 ip6->ip6_nxt = IPPROTO_SCTP;
11125 }
11126 ip6->ip6_src = dst_sin6->sin6_addr;
11127 ip6->ip6_dst = src_sin6->sin6_addr;
11128 len = sizeof(struct ip6_hdr);
11129 shout = (struct sctphdr *)((caddr_t)ip6 + len);
11130 break;
11131 #endif
11132 default:
11133 len = 0;
11134 shout = mtod(mout, struct sctphdr *);
11135 break;
11136 }
11137 #if defined(INET) || defined(INET6)
11138 if (port) {
11139 if (htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port)) == 0) {
11140 sctp_m_freem(mout);
11141 return;
11142 }
11143 udp = (struct udphdr *)shout;
11144 udp->uh_sport = htons(SCTP_BASE_SYSCTL(sctp_udp_tunneling_port));
11145 udp->uh_dport = port;
11146 udp->uh_sum = 0;
11147 udp->uh_ulen = htons((uint16_t)(sizeof(struct udphdr) +
11148 sizeof(struct sctphdr) +
11149 sizeof(struct sctp_chunkhdr) +
11150 cause_len + padding_len));
11151 len += sizeof(struct udphdr);
11152 shout = (struct sctphdr *)((caddr_t)shout + sizeof(struct udphdr));
11153 } else {
11154 udp = NULL;
11155 }
11156 #endif
11157 shout->src_port = sh->dest_port;
11158 shout->dest_port = sh->src_port;
11159 shout->checksum = 0;
11160 if (vtag) {
11161 shout->v_tag = htonl(vtag);
11162 } else {
11163 shout->v_tag = sh->v_tag;
11164 }
11165 len += sizeof(struct sctphdr);
11166 ch = (struct sctp_chunkhdr *)((caddr_t)shout + sizeof(struct sctphdr));
11167 ch->chunk_type = type;
11168 if (vtag) {
11169 ch->chunk_flags = 0;
11170 } else {
11171 ch->chunk_flags = SCTP_HAD_NO_TCB;
11172 }
11173 ch->chunk_length = htons((uint16_t)(sizeof(struct sctp_chunkhdr) + cause_len));
11174 len += sizeof(struct sctp_chunkhdr);
11175 len += cause_len + padding_len;
11176
11177 if (SCTP_GET_HEADER_FOR_OUTPUT(o_pak)) {
11178 sctp_m_freem(mout);
11179 return;
11180 }
11181 SCTP_ATTACH_CHAIN(o_pak, mout, len);
11182 switch (dst->sa_family) {
11183 #ifdef INET
11184 case AF_INET:
11185 if (port) {
11186 if (V_udp_cksum) {
11187 udp->uh_sum = in_pseudo(ip->ip_src.s_addr, ip->ip_dst.s_addr, udp->uh_ulen + htons(IPPROTO_UDP));
11188 } else {
11189 udp->uh_sum = 0;
11190 }
11191 }
11192 ip->ip_len = htons(len);
11193 if (port) {
11194 shout->checksum = sctp_calculate_cksum(mout, sizeof(struct ip) + sizeof(struct udphdr));
11195 SCTP_STAT_INCR(sctps_sendswcrc);
11196 if (V_udp_cksum) {
11197 SCTP_ENABLE_UDP_CSUM(o_pak);
11198 }
11199 } else {
11200 mout->m_pkthdr.csum_flags = CSUM_SCTP;
11201 mout->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
11202 SCTP_STAT_INCR(sctps_sendhwcrc);
11203 }
11204 #ifdef SCTP_PACKET_LOGGING
11205 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING) {
11206 sctp_packet_log(o_pak);
11207 }
11208 #endif
11209 SCTP_PROBE5(send, NULL, NULL, ip, NULL, shout);
11210 SCTP_IP_OUTPUT(ret, o_pak, NULL, NULL, vrf_id);
11211 break;
11212 #endif
11213 #ifdef INET6
11214 case AF_INET6:
11215 ip6->ip6_plen = htons((uint16_t)(len - sizeof(struct ip6_hdr)));
11216 if (port) {
11217 shout->checksum = sctp_calculate_cksum(mout, sizeof(struct ip6_hdr) + sizeof(struct udphdr));
11218 SCTP_STAT_INCR(sctps_sendswcrc);
11219 if ((udp->uh_sum = in6_cksum(o_pak, IPPROTO_UDP, sizeof(struct ip6_hdr), len - sizeof(struct ip6_hdr))) == 0) {
11220 udp->uh_sum = 0xffff;
11221 }
11222 } else {
11223 mout->m_pkthdr.csum_flags = CSUM_SCTP_IPV6;
11224 mout->m_pkthdr.csum_data = offsetof(struct sctphdr, checksum);
11225 SCTP_STAT_INCR(sctps_sendhwcrc);
11226 }
11227 #ifdef SCTP_PACKET_LOGGING
11228 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_LAST_PACKET_TRACING) {
11229 sctp_packet_log(o_pak);
11230 }
11231 #endif
11232 SCTP_PROBE5(send, NULL, NULL, ip6, NULL, shout);
11233 SCTP_IP6_OUTPUT(ret, o_pak, NULL, NULL, NULL, vrf_id);
11234 break;
11235 #endif
11236 default:
11237 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Unknown protocol (TSNH) type %d\n",
11238 dst->sa_family);
11239 sctp_m_freem(mout);
11240 SCTP_LTRACE_ERR_RET_PKT(mout, NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EFAULT);
11241 return;
11242 }
11243 SCTPDBG(SCTP_DEBUG_OUTPUT3, "return from send is %d\n", ret);
11244 if (port) {
11245 UDPSTAT_INC(udps_opackets);
11246 }
11247 SCTP_STAT_INCR(sctps_sendpackets);
11248 SCTP_STAT_INCR_COUNTER64(sctps_outpackets);
11249 SCTP_STAT_INCR_COUNTER64(sctps_outcontrolchunks);
11250 if (ret) {
11251 SCTP_STAT_INCR(sctps_senderrors);
11252 }
11253 return;
11254 }
11255
11256 void
sctp_send_shutdown_complete2(struct sockaddr * src,struct sockaddr * dst,struct sctphdr * sh,uint8_t mflowtype,uint32_t mflowid,uint16_t fibnum,uint32_t vrf_id,uint16_t port)11257 sctp_send_shutdown_complete2(struct sockaddr *src, struct sockaddr *dst,
11258 struct sctphdr *sh,
11259 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
11260 uint32_t vrf_id, uint16_t port)
11261 {
11262 sctp_send_resp_msg(src, dst, sh, 0, SCTP_SHUTDOWN_COMPLETE, NULL,
11263 mflowtype, mflowid, fibnum,
11264 vrf_id, port);
11265 }
11266
11267 void
sctp_send_hb(struct sctp_tcb * stcb,struct sctp_nets * net,int so_locked)11268 sctp_send_hb(struct sctp_tcb *stcb, struct sctp_nets *net, int so_locked)
11269 {
11270 struct sctp_tmit_chunk *chk;
11271 struct sctp_heartbeat_chunk *hb;
11272 struct timeval now;
11273
11274 SCTP_TCB_LOCK_ASSERT(stcb);
11275 if (net == NULL) {
11276 return;
11277 }
11278 (void)SCTP_GETTIME_TIMEVAL(&now);
11279 switch (net->ro._l_addr.sa.sa_family) {
11280 #ifdef INET
11281 case AF_INET:
11282 break;
11283 #endif
11284 #ifdef INET6
11285 case AF_INET6:
11286 break;
11287 #endif
11288 default:
11289 return;
11290 }
11291 sctp_alloc_a_chunk(stcb, chk);
11292 if (chk == NULL) {
11293 SCTPDBG(SCTP_DEBUG_OUTPUT4, "Gak, can't get a chunk for hb\n");
11294 return;
11295 }
11296
11297 chk->copy_by_ref = 0;
11298 chk->rec.chunk_id.id = SCTP_HEARTBEAT_REQUEST;
11299 chk->rec.chunk_id.can_take_data = 1;
11300 chk->flags = 0;
11301 chk->asoc = &stcb->asoc;
11302 chk->send_size = sizeof(struct sctp_heartbeat_chunk);
11303
11304 chk->data = sctp_get_mbuf_for_msg(chk->send_size, 0, M_NOWAIT, 1, MT_HEADER);
11305 if (chk->data == NULL) {
11306 sctp_free_a_chunk(stcb, chk, so_locked);
11307 return;
11308 }
11309 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11310 SCTP_BUF_LEN(chk->data) = chk->send_size;
11311 chk->sent = SCTP_DATAGRAM_UNSENT;
11312 chk->snd_count = 0;
11313 chk->whoTo = net;
11314 atomic_add_int(&chk->whoTo->ref_count, 1);
11315 /* Now we have a mbuf that we can fill in with the details */
11316 hb = mtod(chk->data, struct sctp_heartbeat_chunk *);
11317 memset(hb, 0, sizeof(struct sctp_heartbeat_chunk));
11318 /* fill out chunk header */
11319 hb->ch.chunk_type = SCTP_HEARTBEAT_REQUEST;
11320 hb->ch.chunk_flags = 0;
11321 hb->ch.chunk_length = htons(chk->send_size);
11322 /* Fill out hb parameter */
11323 hb->heartbeat.hb_info.ph.param_type = htons(SCTP_HEARTBEAT_INFO);
11324 hb->heartbeat.hb_info.ph.param_length = htons(sizeof(struct sctp_heartbeat_info_param));
11325 hb->heartbeat.hb_info.time_value_1 = now.tv_sec;
11326 hb->heartbeat.hb_info.time_value_2 = now.tv_usec;
11327 /* Did our user request this one, put it in */
11328 hb->heartbeat.hb_info.addr_family = (uint8_t)net->ro._l_addr.sa.sa_family;
11329 hb->heartbeat.hb_info.addr_len = net->ro._l_addr.sa.sa_len;
11330 if (net->dest_state & SCTP_ADDR_UNCONFIRMED) {
11331 /*
11332 * we only take from the entropy pool if the address is not
11333 * confirmed.
11334 */
11335 net->heartbeat_random1 = hb->heartbeat.hb_info.random_value1 = sctp_select_initial_TSN(&stcb->sctp_ep->sctp_ep);
11336 net->heartbeat_random2 = hb->heartbeat.hb_info.random_value2 = sctp_select_initial_TSN(&stcb->sctp_ep->sctp_ep);
11337 } else {
11338 net->heartbeat_random1 = hb->heartbeat.hb_info.random_value1 = 0;
11339 net->heartbeat_random2 = hb->heartbeat.hb_info.random_value2 = 0;
11340 }
11341 switch (net->ro._l_addr.sa.sa_family) {
11342 #ifdef INET
11343 case AF_INET:
11344 memcpy(hb->heartbeat.hb_info.address,
11345 &net->ro._l_addr.sin.sin_addr,
11346 sizeof(net->ro._l_addr.sin.sin_addr));
11347 break;
11348 #endif
11349 #ifdef INET6
11350 case AF_INET6:
11351 memcpy(hb->heartbeat.hb_info.address,
11352 &net->ro._l_addr.sin6.sin6_addr,
11353 sizeof(net->ro._l_addr.sin6.sin6_addr));
11354 break;
11355 #endif
11356 default:
11357 if (chk->data) {
11358 sctp_m_freem(chk->data);
11359 chk->data = NULL;
11360 }
11361 sctp_free_a_chunk(stcb, chk, so_locked);
11362 return;
11363 break;
11364 }
11365 net->hb_responded = 0;
11366 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
11367 stcb->asoc.ctrl_queue_cnt++;
11368 SCTP_STAT_INCR(sctps_sendheartbeat);
11369 return;
11370 }
11371
11372 void
sctp_send_ecn_echo(struct sctp_tcb * stcb,struct sctp_nets * net,uint32_t high_tsn)11373 sctp_send_ecn_echo(struct sctp_tcb *stcb, struct sctp_nets *net,
11374 uint32_t high_tsn)
11375 {
11376 struct sctp_association *asoc;
11377 struct sctp_ecne_chunk *ecne;
11378 struct sctp_tmit_chunk *chk;
11379
11380 if (net == NULL) {
11381 return;
11382 }
11383 asoc = &stcb->asoc;
11384 SCTP_TCB_LOCK_ASSERT(stcb);
11385 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
11386 if ((chk->rec.chunk_id.id == SCTP_ECN_ECHO) && (net == chk->whoTo)) {
11387 /* found a previous ECN_ECHO update it if needed */
11388 uint32_t cnt, ctsn;
11389
11390 ecne = mtod(chk->data, struct sctp_ecne_chunk *);
11391 ctsn = ntohl(ecne->tsn);
11392 if (SCTP_TSN_GT(high_tsn, ctsn)) {
11393 ecne->tsn = htonl(high_tsn);
11394 SCTP_STAT_INCR(sctps_queue_upd_ecne);
11395 }
11396 cnt = ntohl(ecne->num_pkts_since_cwr);
11397 cnt++;
11398 ecne->num_pkts_since_cwr = htonl(cnt);
11399 return;
11400 }
11401 }
11402 /* nope could not find one to update so we must build one */
11403 sctp_alloc_a_chunk(stcb, chk);
11404 if (chk == NULL) {
11405 return;
11406 }
11407 SCTP_STAT_INCR(sctps_queue_upd_ecne);
11408 chk->copy_by_ref = 0;
11409 chk->rec.chunk_id.id = SCTP_ECN_ECHO;
11410 chk->rec.chunk_id.can_take_data = 0;
11411 chk->flags = 0;
11412 chk->asoc = &stcb->asoc;
11413 chk->send_size = sizeof(struct sctp_ecne_chunk);
11414 chk->data = sctp_get_mbuf_for_msg(chk->send_size, 0, M_NOWAIT, 1, MT_HEADER);
11415 if (chk->data == NULL) {
11416 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11417 return;
11418 }
11419 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11420 SCTP_BUF_LEN(chk->data) = chk->send_size;
11421 chk->sent = SCTP_DATAGRAM_UNSENT;
11422 chk->snd_count = 0;
11423 chk->whoTo = net;
11424 atomic_add_int(&chk->whoTo->ref_count, 1);
11425
11426 stcb->asoc.ecn_echo_cnt_onq++;
11427 ecne = mtod(chk->data, struct sctp_ecne_chunk *);
11428 ecne->ch.chunk_type = SCTP_ECN_ECHO;
11429 ecne->ch.chunk_flags = 0;
11430 ecne->ch.chunk_length = htons(sizeof(struct sctp_ecne_chunk));
11431 ecne->tsn = htonl(high_tsn);
11432 ecne->num_pkts_since_cwr = htonl(1);
11433 TAILQ_INSERT_HEAD(&stcb->asoc.control_send_queue, chk, sctp_next);
11434 asoc->ctrl_queue_cnt++;
11435 }
11436
11437 void
sctp_send_packet_dropped(struct sctp_tcb * stcb,struct sctp_nets * net,struct mbuf * m,int len,int iphlen,int bad_crc)11438 sctp_send_packet_dropped(struct sctp_tcb *stcb, struct sctp_nets *net,
11439 struct mbuf *m, int len, int iphlen, int bad_crc)
11440 {
11441 struct sctp_association *asoc;
11442 struct sctp_pktdrop_chunk *drp;
11443 struct sctp_tmit_chunk *chk;
11444 uint8_t *datap;
11445 int was_trunc = 0;
11446 int fullsz = 0;
11447 long spc;
11448 int offset;
11449 struct sctp_chunkhdr *ch, chunk_buf;
11450 unsigned int chk_length;
11451
11452 if (!stcb) {
11453 return;
11454 }
11455 asoc = &stcb->asoc;
11456 SCTP_TCB_LOCK_ASSERT(stcb);
11457 if (asoc->pktdrop_supported == 0) {
11458 /*-
11459 * peer must declare support before I send one.
11460 */
11461 return;
11462 }
11463 if (stcb->sctp_socket == NULL) {
11464 return;
11465 }
11466 sctp_alloc_a_chunk(stcb, chk);
11467 if (chk == NULL) {
11468 return;
11469 }
11470 chk->copy_by_ref = 0;
11471 chk->rec.chunk_id.id = SCTP_PACKET_DROPPED;
11472 chk->rec.chunk_id.can_take_data = 1;
11473 chk->flags = 0;
11474 len -= iphlen;
11475 chk->send_size = len;
11476 /* Validate that we do not have an ABORT in here. */
11477 offset = iphlen + sizeof(struct sctphdr);
11478 ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, offset,
11479 sizeof(*ch), (uint8_t *)&chunk_buf);
11480 while (ch != NULL) {
11481 chk_length = ntohs(ch->chunk_length);
11482 if (chk_length < sizeof(*ch)) {
11483 /* break to abort land */
11484 break;
11485 }
11486 switch (ch->chunk_type) {
11487 case SCTP_PACKET_DROPPED:
11488 case SCTP_ABORT_ASSOCIATION:
11489 case SCTP_INITIATION_ACK:
11490 /**
11491 * We don't respond with an PKT-DROP to an ABORT
11492 * or PKT-DROP. We also do not respond to an
11493 * INIT-ACK, because we can't know if the initiation
11494 * tag is correct or not.
11495 */
11496 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11497 return;
11498 default:
11499 break;
11500 }
11501 offset += SCTP_SIZE32(chk_length);
11502 ch = (struct sctp_chunkhdr *)sctp_m_getptr(m, offset,
11503 sizeof(*ch), (uint8_t *)&chunk_buf);
11504 }
11505
11506 if ((len + SCTP_MAX_OVERHEAD + sizeof(struct sctp_pktdrop_chunk)) >
11507 min(stcb->asoc.smallest_mtu, MCLBYTES)) {
11508 /*
11509 * only send 1 mtu worth, trim off the excess on the end.
11510 */
11511 fullsz = len;
11512 len = min(stcb->asoc.smallest_mtu, MCLBYTES) - SCTP_MAX_OVERHEAD;
11513 was_trunc = 1;
11514 }
11515 chk->asoc = &stcb->asoc;
11516 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
11517 if (chk->data == NULL) {
11518 jump_out:
11519 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11520 return;
11521 }
11522 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11523 drp = mtod(chk->data, struct sctp_pktdrop_chunk *);
11524 if (drp == NULL) {
11525 sctp_m_freem(chk->data);
11526 chk->data = NULL;
11527 goto jump_out;
11528 }
11529 chk->book_size = SCTP_SIZE32((chk->send_size + sizeof(struct sctp_pktdrop_chunk) +
11530 sizeof(struct sctphdr) + SCTP_MED_OVERHEAD));
11531 chk->book_size_scale = 0;
11532 if (was_trunc) {
11533 drp->ch.chunk_flags = SCTP_PACKET_TRUNCATED;
11534 drp->trunc_len = htons(fullsz);
11535 /*
11536 * Len is already adjusted to size minus overhead above take
11537 * out the pkt_drop chunk itself from it.
11538 */
11539 chk->send_size = (uint16_t)(len - sizeof(struct sctp_pktdrop_chunk));
11540 len = chk->send_size;
11541 } else {
11542 /* no truncation needed */
11543 drp->ch.chunk_flags = 0;
11544 drp->trunc_len = htons(0);
11545 }
11546 if (bad_crc) {
11547 drp->ch.chunk_flags |= SCTP_BADCRC;
11548 }
11549 chk->send_size += sizeof(struct sctp_pktdrop_chunk);
11550 SCTP_BUF_LEN(chk->data) = chk->send_size;
11551 chk->sent = SCTP_DATAGRAM_UNSENT;
11552 chk->snd_count = 0;
11553 if (net) {
11554 /* we should hit here */
11555 chk->whoTo = net;
11556 atomic_add_int(&chk->whoTo->ref_count, 1);
11557 } else {
11558 chk->whoTo = NULL;
11559 }
11560 drp->ch.chunk_type = SCTP_PACKET_DROPPED;
11561 drp->ch.chunk_length = htons(chk->send_size);
11562 spc = SCTP_SB_LIMIT_RCV(stcb->sctp_socket);
11563 if (spc < 0) {
11564 spc = 0;
11565 }
11566 drp->bottle_bw = htonl(spc);
11567 if (asoc->my_rwnd) {
11568 drp->current_onq = htonl(asoc->size_on_reasm_queue +
11569 asoc->size_on_all_streams +
11570 asoc->my_rwnd_control_len +
11571 stcb->sctp_socket->so_rcv.sb_cc);
11572 } else {
11573 /*-
11574 * If my rwnd is 0, possibly from mbuf depletion as well as
11575 * space used, tell the peer there is NO space aka onq == bw
11576 */
11577 drp->current_onq = htonl(spc);
11578 }
11579 drp->reserved = 0;
11580 datap = drp->data;
11581 m_copydata(m, iphlen, len, (caddr_t)datap);
11582 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
11583 asoc->ctrl_queue_cnt++;
11584 }
11585
11586 void
sctp_send_cwr(struct sctp_tcb * stcb,struct sctp_nets * net,uint32_t high_tsn,uint8_t override)11587 sctp_send_cwr(struct sctp_tcb *stcb, struct sctp_nets *net, uint32_t high_tsn, uint8_t override)
11588 {
11589 struct sctp_association *asoc;
11590 struct sctp_cwr_chunk *cwr;
11591 struct sctp_tmit_chunk *chk;
11592
11593 SCTP_TCB_LOCK_ASSERT(stcb);
11594 if (net == NULL) {
11595 return;
11596 }
11597 asoc = &stcb->asoc;
11598 TAILQ_FOREACH(chk, &asoc->control_send_queue, sctp_next) {
11599 if ((chk->rec.chunk_id.id == SCTP_ECN_CWR) && (net == chk->whoTo)) {
11600 /*
11601 * found a previous CWR queued to same destination
11602 * update it if needed
11603 */
11604 uint32_t ctsn;
11605
11606 cwr = mtod(chk->data, struct sctp_cwr_chunk *);
11607 ctsn = ntohl(cwr->tsn);
11608 if (SCTP_TSN_GT(high_tsn, ctsn)) {
11609 cwr->tsn = htonl(high_tsn);
11610 }
11611 if (override & SCTP_CWR_REDUCE_OVERRIDE) {
11612 /* Make sure override is carried */
11613 cwr->ch.chunk_flags |= SCTP_CWR_REDUCE_OVERRIDE;
11614 }
11615 return;
11616 }
11617 }
11618 sctp_alloc_a_chunk(stcb, chk);
11619 if (chk == NULL) {
11620 return;
11621 }
11622 chk->copy_by_ref = 0;
11623 chk->rec.chunk_id.id = SCTP_ECN_CWR;
11624 chk->rec.chunk_id.can_take_data = 1;
11625 chk->flags = 0;
11626 chk->asoc = &stcb->asoc;
11627 chk->send_size = sizeof(struct sctp_cwr_chunk);
11628 chk->data = sctp_get_mbuf_for_msg(chk->send_size, 0, M_NOWAIT, 1, MT_HEADER);
11629 if (chk->data == NULL) {
11630 sctp_free_a_chunk(stcb, chk, SCTP_SO_NOT_LOCKED);
11631 return;
11632 }
11633 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11634 SCTP_BUF_LEN(chk->data) = chk->send_size;
11635 chk->sent = SCTP_DATAGRAM_UNSENT;
11636 chk->snd_count = 0;
11637 chk->whoTo = net;
11638 atomic_add_int(&chk->whoTo->ref_count, 1);
11639 cwr = mtod(chk->data, struct sctp_cwr_chunk *);
11640 cwr->ch.chunk_type = SCTP_ECN_CWR;
11641 cwr->ch.chunk_flags = override;
11642 cwr->ch.chunk_length = htons(sizeof(struct sctp_cwr_chunk));
11643 cwr->tsn = htonl(high_tsn);
11644 TAILQ_INSERT_TAIL(&stcb->asoc.control_send_queue, chk, sctp_next);
11645 asoc->ctrl_queue_cnt++;
11646 }
11647
11648 static int
sctp_add_stream_reset_out(struct sctp_tcb * stcb,struct sctp_tmit_chunk * chk,uint32_t seq,uint32_t resp_seq,uint32_t last_sent)11649 sctp_add_stream_reset_out(struct sctp_tcb *stcb, struct sctp_tmit_chunk *chk,
11650 uint32_t seq, uint32_t resp_seq, uint32_t last_sent)
11651 {
11652 uint16_t len, old_len, i;
11653 struct sctp_stream_reset_out_request *req_out;
11654 struct sctp_chunkhdr *ch;
11655 int at;
11656 int number_entries = 0;
11657
11658 ch = mtod(chk->data, struct sctp_chunkhdr *);
11659 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11660 /* get to new offset for the param. */
11661 req_out = (struct sctp_stream_reset_out_request *)((caddr_t)ch + len);
11662 /* now how long will this param be? */
11663 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
11664 if ((stcb->asoc.strmout[i].state == SCTP_STREAM_RESET_PENDING) &&
11665 (stcb->asoc.strmout[i].chunks_on_queues == 0) &&
11666 TAILQ_EMPTY(&stcb->asoc.strmout[i].outqueue)) {
11667 number_entries++;
11668 }
11669 }
11670 if (number_entries == 0) {
11671 return (0);
11672 }
11673 if (number_entries == stcb->asoc.streamoutcnt) {
11674 number_entries = 0;
11675 }
11676 if (number_entries > SCTP_MAX_STREAMS_AT_ONCE_RESET) {
11677 number_entries = SCTP_MAX_STREAMS_AT_ONCE_RESET;
11678 }
11679 len = (uint16_t)(sizeof(struct sctp_stream_reset_out_request) + (sizeof(uint16_t) * number_entries));
11680 req_out->ph.param_type = htons(SCTP_STR_RESET_OUT_REQUEST);
11681 req_out->ph.param_length = htons(len);
11682 req_out->request_seq = htonl(seq);
11683 req_out->response_seq = htonl(resp_seq);
11684 req_out->send_reset_at_tsn = htonl(last_sent);
11685 at = 0;
11686 if (number_entries) {
11687 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
11688 if ((stcb->asoc.strmout[i].state == SCTP_STREAM_RESET_PENDING) &&
11689 (stcb->asoc.strmout[i].chunks_on_queues == 0) &&
11690 TAILQ_EMPTY(&stcb->asoc.strmout[i].outqueue)) {
11691 req_out->list_of_streams[at] = htons(i);
11692 at++;
11693 stcb->asoc.strmout[i].state = SCTP_STREAM_RESET_IN_FLIGHT;
11694 if (at >= number_entries) {
11695 break;
11696 }
11697 }
11698 }
11699 } else {
11700 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
11701 stcb->asoc.strmout[i].state = SCTP_STREAM_RESET_IN_FLIGHT;
11702 }
11703 }
11704 if (SCTP_SIZE32(len) > len) {
11705 /*-
11706 * Need to worry about the pad we may end up adding to the
11707 * end. This is easy since the struct is either aligned to 4
11708 * bytes or 2 bytes off.
11709 */
11710 req_out->list_of_streams[number_entries] = 0;
11711 }
11712 /* now fix the chunk length */
11713 ch->chunk_length = htons(len + old_len);
11714 chk->book_size = len + old_len;
11715 chk->book_size_scale = 0;
11716 chk->send_size = SCTP_SIZE32(chk->book_size);
11717 SCTP_BUF_LEN(chk->data) = chk->send_size;
11718 return (1);
11719 }
11720
11721 static void
sctp_add_stream_reset_in(struct sctp_tmit_chunk * chk,int number_entries,uint16_t * list,uint32_t seq)11722 sctp_add_stream_reset_in(struct sctp_tmit_chunk *chk,
11723 int number_entries, uint16_t *list,
11724 uint32_t seq)
11725 {
11726 uint16_t len, old_len, i;
11727 struct sctp_stream_reset_in_request *req_in;
11728 struct sctp_chunkhdr *ch;
11729
11730 ch = mtod(chk->data, struct sctp_chunkhdr *);
11731 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11732
11733 /* get to new offset for the param. */
11734 req_in = (struct sctp_stream_reset_in_request *)((caddr_t)ch + len);
11735 /* now how long will this param be? */
11736 len = (uint16_t)(sizeof(struct sctp_stream_reset_in_request) + (sizeof(uint16_t) * number_entries));
11737 req_in->ph.param_type = htons(SCTP_STR_RESET_IN_REQUEST);
11738 req_in->ph.param_length = htons(len);
11739 req_in->request_seq = htonl(seq);
11740 if (number_entries) {
11741 for (i = 0; i < number_entries; i++) {
11742 req_in->list_of_streams[i] = htons(list[i]);
11743 }
11744 }
11745 if (SCTP_SIZE32(len) > len) {
11746 /*-
11747 * Need to worry about the pad we may end up adding to the
11748 * end. This is easy since the struct is either aligned to 4
11749 * bytes or 2 bytes off.
11750 */
11751 req_in->list_of_streams[number_entries] = 0;
11752 }
11753 /* now fix the chunk length */
11754 ch->chunk_length = htons(len + old_len);
11755 chk->book_size = len + old_len;
11756 chk->book_size_scale = 0;
11757 chk->send_size = SCTP_SIZE32(chk->book_size);
11758 SCTP_BUF_LEN(chk->data) = chk->send_size;
11759 return;
11760 }
11761
11762 static void
sctp_add_stream_reset_tsn(struct sctp_tmit_chunk * chk,uint32_t seq)11763 sctp_add_stream_reset_tsn(struct sctp_tmit_chunk *chk,
11764 uint32_t seq)
11765 {
11766 uint16_t len, old_len;
11767 struct sctp_stream_reset_tsn_request *req_tsn;
11768 struct sctp_chunkhdr *ch;
11769
11770 ch = mtod(chk->data, struct sctp_chunkhdr *);
11771 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11772
11773 /* get to new offset for the param. */
11774 req_tsn = (struct sctp_stream_reset_tsn_request *)((caddr_t)ch + len);
11775 /* now how long will this param be? */
11776 len = sizeof(struct sctp_stream_reset_tsn_request);
11777 req_tsn->ph.param_type = htons(SCTP_STR_RESET_TSN_REQUEST);
11778 req_tsn->ph.param_length = htons(len);
11779 req_tsn->request_seq = htonl(seq);
11780
11781 /* now fix the chunk length */
11782 ch->chunk_length = htons(len + old_len);
11783 chk->send_size = len + old_len;
11784 chk->book_size = SCTP_SIZE32(chk->send_size);
11785 chk->book_size_scale = 0;
11786 SCTP_BUF_LEN(chk->data) = SCTP_SIZE32(chk->send_size);
11787 return;
11788 }
11789
11790 void
sctp_add_stream_reset_result(struct sctp_tmit_chunk * chk,uint32_t resp_seq,uint32_t result)11791 sctp_add_stream_reset_result(struct sctp_tmit_chunk *chk,
11792 uint32_t resp_seq, uint32_t result)
11793 {
11794 uint16_t len, old_len;
11795 struct sctp_stream_reset_response *resp;
11796 struct sctp_chunkhdr *ch;
11797
11798 ch = mtod(chk->data, struct sctp_chunkhdr *);
11799 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11800
11801 /* get to new offset for the param. */
11802 resp = (struct sctp_stream_reset_response *)((caddr_t)ch + len);
11803 /* now how long will this param be? */
11804 len = sizeof(struct sctp_stream_reset_response);
11805 resp->ph.param_type = htons(SCTP_STR_RESET_RESPONSE);
11806 resp->ph.param_length = htons(len);
11807 resp->response_seq = htonl(resp_seq);
11808 resp->result = ntohl(result);
11809
11810 /* now fix the chunk length */
11811 ch->chunk_length = htons(len + old_len);
11812 chk->book_size = len + old_len;
11813 chk->book_size_scale = 0;
11814 chk->send_size = SCTP_SIZE32(chk->book_size);
11815 SCTP_BUF_LEN(chk->data) = chk->send_size;
11816 return;
11817 }
11818
11819 void
sctp_send_deferred_reset_response(struct sctp_tcb * stcb,struct sctp_stream_reset_list * ent,int response)11820 sctp_send_deferred_reset_response(struct sctp_tcb *stcb,
11821 struct sctp_stream_reset_list *ent,
11822 int response)
11823 {
11824 struct sctp_association *asoc;
11825 struct sctp_tmit_chunk *chk;
11826 struct sctp_chunkhdr *ch;
11827
11828 asoc = &stcb->asoc;
11829
11830 /*
11831 * Reset our last reset action to the new one IP -> response
11832 * (PERFORMED probably). This assures that if we fail to send, a
11833 * retran from the peer will get the new response.
11834 */
11835 asoc->last_reset_action[0] = response;
11836 if (asoc->stream_reset_outstanding) {
11837 return;
11838 }
11839 sctp_alloc_a_chunk(stcb, chk);
11840 if (chk == NULL) {
11841 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
11842 return;
11843 }
11844 chk->copy_by_ref = 0;
11845 chk->rec.chunk_id.id = SCTP_STREAM_RESET;
11846 chk->rec.chunk_id.can_take_data = 0;
11847 chk->flags = 0;
11848 chk->asoc = &stcb->asoc;
11849 chk->book_size = sizeof(struct sctp_chunkhdr);
11850 chk->send_size = SCTP_SIZE32(chk->book_size);
11851 chk->book_size_scale = 0;
11852 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
11853 if (chk->data == NULL) {
11854 sctp_free_a_chunk(stcb, chk, SCTP_SO_LOCKED);
11855 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
11856 return;
11857 }
11858 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
11859 /* setup chunk parameters */
11860 chk->sent = SCTP_DATAGRAM_UNSENT;
11861 chk->snd_count = 0;
11862 if (stcb->asoc.alternate) {
11863 chk->whoTo = stcb->asoc.alternate;
11864 } else {
11865 chk->whoTo = stcb->asoc.primary_destination;
11866 }
11867 ch = mtod(chk->data, struct sctp_chunkhdr *);
11868 ch->chunk_type = SCTP_STREAM_RESET;
11869 ch->chunk_flags = 0;
11870 ch->chunk_length = htons(chk->book_size);
11871 atomic_add_int(&chk->whoTo->ref_count, 1);
11872 SCTP_BUF_LEN(chk->data) = chk->send_size;
11873 sctp_add_stream_reset_result(chk, ent->seq, response);
11874 /* insert the chunk for sending */
11875 TAILQ_INSERT_TAIL(&asoc->control_send_queue,
11876 chk,
11877 sctp_next);
11878 asoc->ctrl_queue_cnt++;
11879 }
11880
11881 void
sctp_add_stream_reset_result_tsn(struct sctp_tmit_chunk * chk,uint32_t resp_seq,uint32_t result,uint32_t send_una,uint32_t recv_next)11882 sctp_add_stream_reset_result_tsn(struct sctp_tmit_chunk *chk,
11883 uint32_t resp_seq, uint32_t result,
11884 uint32_t send_una, uint32_t recv_next)
11885 {
11886 uint16_t len, old_len;
11887 struct sctp_stream_reset_response_tsn *resp;
11888 struct sctp_chunkhdr *ch;
11889
11890 ch = mtod(chk->data, struct sctp_chunkhdr *);
11891 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11892
11893 /* get to new offset for the param. */
11894 resp = (struct sctp_stream_reset_response_tsn *)((caddr_t)ch + len);
11895 /* now how long will this param be? */
11896 len = sizeof(struct sctp_stream_reset_response_tsn);
11897 resp->ph.param_type = htons(SCTP_STR_RESET_RESPONSE);
11898 resp->ph.param_length = htons(len);
11899 resp->response_seq = htonl(resp_seq);
11900 resp->result = htonl(result);
11901 resp->senders_next_tsn = htonl(send_una);
11902 resp->receivers_next_tsn = htonl(recv_next);
11903
11904 /* now fix the chunk length */
11905 ch->chunk_length = htons(len + old_len);
11906 chk->book_size = len + old_len;
11907 chk->send_size = SCTP_SIZE32(chk->book_size);
11908 chk->book_size_scale = 0;
11909 SCTP_BUF_LEN(chk->data) = chk->send_size;
11910 return;
11911 }
11912
11913 static void
sctp_add_an_out_stream(struct sctp_tmit_chunk * chk,uint32_t seq,uint16_t adding)11914 sctp_add_an_out_stream(struct sctp_tmit_chunk *chk,
11915 uint32_t seq,
11916 uint16_t adding)
11917 {
11918 uint16_t len, old_len;
11919 struct sctp_chunkhdr *ch;
11920 struct sctp_stream_reset_add_strm *addstr;
11921
11922 ch = mtod(chk->data, struct sctp_chunkhdr *);
11923 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11924
11925 /* get to new offset for the param. */
11926 addstr = (struct sctp_stream_reset_add_strm *)((caddr_t)ch + len);
11927 /* now how long will this param be? */
11928 len = sizeof(struct sctp_stream_reset_add_strm);
11929
11930 /* Fill it out. */
11931 addstr->ph.param_type = htons(SCTP_STR_RESET_ADD_OUT_STREAMS);
11932 addstr->ph.param_length = htons(len);
11933 addstr->request_seq = htonl(seq);
11934 addstr->number_of_streams = htons(adding);
11935 addstr->reserved = 0;
11936
11937 /* now fix the chunk length */
11938 ch->chunk_length = htons(len + old_len);
11939 chk->send_size = len + old_len;
11940 chk->book_size = SCTP_SIZE32(chk->send_size);
11941 chk->book_size_scale = 0;
11942 SCTP_BUF_LEN(chk->data) = SCTP_SIZE32(chk->send_size);
11943 return;
11944 }
11945
11946 static void
sctp_add_an_in_stream(struct sctp_tmit_chunk * chk,uint32_t seq,uint16_t adding)11947 sctp_add_an_in_stream(struct sctp_tmit_chunk *chk,
11948 uint32_t seq,
11949 uint16_t adding)
11950 {
11951 uint16_t len, old_len;
11952 struct sctp_chunkhdr *ch;
11953 struct sctp_stream_reset_add_strm *addstr;
11954
11955 ch = mtod(chk->data, struct sctp_chunkhdr *);
11956 old_len = len = SCTP_SIZE32(ntohs(ch->chunk_length));
11957
11958 /* get to new offset for the param. */
11959 addstr = (struct sctp_stream_reset_add_strm *)((caddr_t)ch + len);
11960 /* now how long will this param be? */
11961 len = sizeof(struct sctp_stream_reset_add_strm);
11962 /* Fill it out. */
11963 addstr->ph.param_type = htons(SCTP_STR_RESET_ADD_IN_STREAMS);
11964 addstr->ph.param_length = htons(len);
11965 addstr->request_seq = htonl(seq);
11966 addstr->number_of_streams = htons(adding);
11967 addstr->reserved = 0;
11968
11969 /* now fix the chunk length */
11970 ch->chunk_length = htons(len + old_len);
11971 chk->send_size = len + old_len;
11972 chk->book_size = SCTP_SIZE32(chk->send_size);
11973 chk->book_size_scale = 0;
11974 SCTP_BUF_LEN(chk->data) = SCTP_SIZE32(chk->send_size);
11975 return;
11976 }
11977
11978 int
sctp_send_stream_reset_out_if_possible(struct sctp_tcb * stcb,int so_locked)11979 sctp_send_stream_reset_out_if_possible(struct sctp_tcb *stcb, int so_locked)
11980 {
11981 struct sctp_association *asoc;
11982 struct sctp_tmit_chunk *chk;
11983 struct sctp_chunkhdr *ch;
11984 uint32_t seq;
11985
11986 asoc = &stcb->asoc;
11987 asoc->trigger_reset = 0;
11988 if (asoc->stream_reset_outstanding) {
11989 return (EALREADY);
11990 }
11991 sctp_alloc_a_chunk(stcb, chk);
11992 if (chk == NULL) {
11993 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
11994 return (ENOMEM);
11995 }
11996 chk->copy_by_ref = 0;
11997 chk->rec.chunk_id.id = SCTP_STREAM_RESET;
11998 chk->rec.chunk_id.can_take_data = 0;
11999 chk->flags = 0;
12000 chk->asoc = &stcb->asoc;
12001 chk->book_size = sizeof(struct sctp_chunkhdr);
12002 chk->send_size = SCTP_SIZE32(chk->book_size);
12003 chk->book_size_scale = 0;
12004 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
12005 if (chk->data == NULL) {
12006 sctp_free_a_chunk(stcb, chk, so_locked);
12007 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12008 return (ENOMEM);
12009 }
12010 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
12011
12012 /* setup chunk parameters */
12013 chk->sent = SCTP_DATAGRAM_UNSENT;
12014 chk->snd_count = 0;
12015 if (stcb->asoc.alternate) {
12016 chk->whoTo = stcb->asoc.alternate;
12017 } else {
12018 chk->whoTo = stcb->asoc.primary_destination;
12019 }
12020 ch = mtod(chk->data, struct sctp_chunkhdr *);
12021 ch->chunk_type = SCTP_STREAM_RESET;
12022 ch->chunk_flags = 0;
12023 ch->chunk_length = htons(chk->book_size);
12024 atomic_add_int(&chk->whoTo->ref_count, 1);
12025 SCTP_BUF_LEN(chk->data) = chk->send_size;
12026 seq = stcb->asoc.str_reset_seq_out;
12027 if (sctp_add_stream_reset_out(stcb, chk, seq, (stcb->asoc.str_reset_seq_in - 1), (stcb->asoc.sending_seq - 1))) {
12028 seq++;
12029 asoc->stream_reset_outstanding++;
12030 } else {
12031 m_freem(chk->data);
12032 chk->data = NULL;
12033 sctp_free_a_chunk(stcb, chk, so_locked);
12034 return (ENOENT);
12035 }
12036 asoc->str_reset = chk;
12037 /* insert the chunk for sending */
12038 TAILQ_INSERT_TAIL(&asoc->control_send_queue,
12039 chk,
12040 sctp_next);
12041 asoc->ctrl_queue_cnt++;
12042
12043 if (stcb->asoc.send_sack) {
12044 sctp_send_sack(stcb, so_locked);
12045 }
12046 sctp_timer_start(SCTP_TIMER_TYPE_STRRESET, stcb->sctp_ep, stcb, chk->whoTo);
12047 return (0);
12048 }
12049
12050 int
sctp_send_str_reset_req(struct sctp_tcb * stcb,uint16_t number_entries,uint16_t * list,uint8_t send_in_req,uint8_t send_tsn_req,uint8_t add_stream,uint16_t adding_o,uint16_t adding_i,uint8_t peer_asked)12051 sctp_send_str_reset_req(struct sctp_tcb *stcb,
12052 uint16_t number_entries, uint16_t *list,
12053 uint8_t send_in_req,
12054 uint8_t send_tsn_req,
12055 uint8_t add_stream,
12056 uint16_t adding_o,
12057 uint16_t adding_i, uint8_t peer_asked)
12058 {
12059 struct sctp_association *asoc;
12060 struct sctp_tmit_chunk *chk;
12061 struct sctp_chunkhdr *ch;
12062 int can_send_out_req = 0;
12063 uint32_t seq;
12064
12065 asoc = &stcb->asoc;
12066 if (asoc->stream_reset_outstanding) {
12067 /*-
12068 * Already one pending, must get ACK back to clear the flag.
12069 */
12070 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EBUSY);
12071 return (EBUSY);
12072 }
12073 if ((send_in_req == 0) && (send_tsn_req == 0) &&
12074 (add_stream == 0)) {
12075 /* nothing to do */
12076 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12077 return (EINVAL);
12078 }
12079 if (send_tsn_req && send_in_req) {
12080 /* error, can't do that */
12081 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12082 return (EINVAL);
12083 } else if (send_in_req) {
12084 can_send_out_req = 1;
12085 }
12086 if (number_entries > (MCLBYTES -
12087 SCTP_MIN_OVERHEAD -
12088 sizeof(struct sctp_chunkhdr) -
12089 sizeof(struct sctp_stream_reset_out_request)) /
12090 sizeof(uint16_t)) {
12091 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12092 return (ENOMEM);
12093 }
12094 sctp_alloc_a_chunk(stcb, chk);
12095 if (chk == NULL) {
12096 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12097 return (ENOMEM);
12098 }
12099 chk->copy_by_ref = 0;
12100 chk->rec.chunk_id.id = SCTP_STREAM_RESET;
12101 chk->rec.chunk_id.can_take_data = 0;
12102 chk->flags = 0;
12103 chk->asoc = &stcb->asoc;
12104 chk->book_size = sizeof(struct sctp_chunkhdr);
12105 chk->send_size = SCTP_SIZE32(chk->book_size);
12106 chk->book_size_scale = 0;
12107 chk->data = sctp_get_mbuf_for_msg(MCLBYTES, 0, M_NOWAIT, 1, MT_DATA);
12108 if (chk->data == NULL) {
12109 sctp_free_a_chunk(stcb, chk, SCTP_SO_LOCKED);
12110 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12111 return (ENOMEM);
12112 }
12113 SCTP_BUF_RESV_UF(chk->data, SCTP_MIN_OVERHEAD);
12114
12115 /* setup chunk parameters */
12116 chk->sent = SCTP_DATAGRAM_UNSENT;
12117 chk->snd_count = 0;
12118 if (stcb->asoc.alternate) {
12119 chk->whoTo = stcb->asoc.alternate;
12120 } else {
12121 chk->whoTo = stcb->asoc.primary_destination;
12122 }
12123 atomic_add_int(&chk->whoTo->ref_count, 1);
12124 ch = mtod(chk->data, struct sctp_chunkhdr *);
12125 ch->chunk_type = SCTP_STREAM_RESET;
12126 ch->chunk_flags = 0;
12127 ch->chunk_length = htons(chk->book_size);
12128 SCTP_BUF_LEN(chk->data) = chk->send_size;
12129
12130 seq = stcb->asoc.str_reset_seq_out;
12131 if (can_send_out_req) {
12132 int ret;
12133
12134 ret = sctp_add_stream_reset_out(stcb, chk, seq, (stcb->asoc.str_reset_seq_in - 1), (stcb->asoc.sending_seq - 1));
12135 if (ret) {
12136 seq++;
12137 asoc->stream_reset_outstanding++;
12138 }
12139 }
12140 if ((add_stream & 1) &&
12141 ((stcb->asoc.strm_realoutsize - stcb->asoc.streamoutcnt) < adding_o)) {
12142 /* Need to allocate more */
12143 struct sctp_stream_out *oldstream;
12144 struct sctp_stream_queue_pending *sp, *nsp;
12145 int i;
12146 #if defined(SCTP_DETAILED_STR_STATS)
12147 int j;
12148 #endif
12149
12150 oldstream = stcb->asoc.strmout;
12151 /* get some more */
12152 SCTP_MALLOC(stcb->asoc.strmout, struct sctp_stream_out *,
12153 (stcb->asoc.streamoutcnt + adding_o) * sizeof(struct sctp_stream_out),
12154 SCTP_M_STRMO);
12155 if (stcb->asoc.strmout == NULL) {
12156 uint8_t x;
12157
12158 stcb->asoc.strmout = oldstream;
12159 /* Turn off the bit */
12160 x = add_stream & 0xfe;
12161 add_stream = x;
12162 goto skip_stuff;
12163 }
12164 /*
12165 * Ok now we proceed with copying the old out stuff and
12166 * initializing the new stuff.
12167 */
12168 SCTP_TCB_SEND_LOCK(stcb);
12169 stcb->asoc.ss_functions.sctp_ss_clear(stcb, &stcb->asoc, 0, 1);
12170 for (i = 0; i < stcb->asoc.streamoutcnt; i++) {
12171 TAILQ_INIT(&stcb->asoc.strmout[i].outqueue);
12172 stcb->asoc.strmout[i].chunks_on_queues = oldstream[i].chunks_on_queues;
12173 stcb->asoc.strmout[i].next_mid_ordered = oldstream[i].next_mid_ordered;
12174 stcb->asoc.strmout[i].next_mid_unordered = oldstream[i].next_mid_unordered;
12175 stcb->asoc.strmout[i].last_msg_incomplete = oldstream[i].last_msg_incomplete;
12176 stcb->asoc.strmout[i].sid = i;
12177 stcb->asoc.strmout[i].state = oldstream[i].state;
12178 /* FIX ME FIX ME */
12179 /*
12180 * This should be a SS_COPY operation FIX ME STREAM
12181 * SCHEDULER EXPERT
12182 */
12183 stcb->asoc.ss_functions.sctp_ss_init_stream(stcb, &stcb->asoc.strmout[i], &oldstream[i]);
12184 /* now anything on those queues? */
12185 TAILQ_FOREACH_SAFE(sp, &oldstream[i].outqueue, next, nsp) {
12186 TAILQ_REMOVE(&oldstream[i].outqueue, sp, next);
12187 TAILQ_INSERT_TAIL(&stcb->asoc.strmout[i].outqueue, sp, next);
12188 }
12189
12190 }
12191 /* now the new streams */
12192 stcb->asoc.ss_functions.sctp_ss_init(stcb, &stcb->asoc, 1);
12193 for (i = stcb->asoc.streamoutcnt; i < (stcb->asoc.streamoutcnt + adding_o); i++) {
12194 TAILQ_INIT(&stcb->asoc.strmout[i].outqueue);
12195 stcb->asoc.strmout[i].chunks_on_queues = 0;
12196 #if defined(SCTP_DETAILED_STR_STATS)
12197 for (j = 0; j < SCTP_PR_SCTP_MAX + 1; j++) {
12198 stcb->asoc.strmout[i].abandoned_sent[j] = 0;
12199 stcb->asoc.strmout[i].abandoned_unsent[j] = 0;
12200 }
12201 #else
12202 stcb->asoc.strmout[i].abandoned_sent[0] = 0;
12203 stcb->asoc.strmout[i].abandoned_unsent[0] = 0;
12204 #endif
12205 stcb->asoc.strmout[i].next_mid_ordered = 0;
12206 stcb->asoc.strmout[i].next_mid_unordered = 0;
12207 stcb->asoc.strmout[i].sid = i;
12208 stcb->asoc.strmout[i].last_msg_incomplete = 0;
12209 stcb->asoc.ss_functions.sctp_ss_init_stream(stcb, &stcb->asoc.strmout[i], NULL);
12210 stcb->asoc.strmout[i].state = SCTP_STREAM_CLOSED;
12211 }
12212 stcb->asoc.strm_realoutsize = stcb->asoc.streamoutcnt + adding_o;
12213 SCTP_FREE(oldstream, SCTP_M_STRMO);
12214 SCTP_TCB_SEND_UNLOCK(stcb);
12215 }
12216 skip_stuff:
12217 if ((add_stream & 1) && (adding_o > 0)) {
12218 asoc->strm_pending_add_size = adding_o;
12219 asoc->peer_req_out = peer_asked;
12220 sctp_add_an_out_stream(chk, seq, adding_o);
12221 seq++;
12222 asoc->stream_reset_outstanding++;
12223 }
12224 if ((add_stream & 2) && (adding_i > 0)) {
12225 sctp_add_an_in_stream(chk, seq, adding_i);
12226 seq++;
12227 asoc->stream_reset_outstanding++;
12228 }
12229 if (send_in_req) {
12230 sctp_add_stream_reset_in(chk, number_entries, list, seq);
12231 seq++;
12232 asoc->stream_reset_outstanding++;
12233 }
12234 if (send_tsn_req) {
12235 sctp_add_stream_reset_tsn(chk, seq);
12236 asoc->stream_reset_outstanding++;
12237 }
12238 asoc->str_reset = chk;
12239 /* insert the chunk for sending */
12240 TAILQ_INSERT_TAIL(&asoc->control_send_queue,
12241 chk,
12242 sctp_next);
12243 asoc->ctrl_queue_cnt++;
12244 if (stcb->asoc.send_sack) {
12245 sctp_send_sack(stcb, SCTP_SO_LOCKED);
12246 }
12247 sctp_timer_start(SCTP_TIMER_TYPE_STRRESET, stcb->sctp_ep, stcb, chk->whoTo);
12248 return (0);
12249 }
12250
12251 void
sctp_send_abort(struct mbuf * m,int iphlen,struct sockaddr * src,struct sockaddr * dst,struct sctphdr * sh,uint32_t vtag,struct mbuf * cause,uint8_t mflowtype,uint32_t mflowid,uint16_t fibnum,uint32_t vrf_id,uint16_t port)12252 sctp_send_abort(struct mbuf *m, int iphlen, struct sockaddr *src, struct sockaddr *dst,
12253 struct sctphdr *sh, uint32_t vtag, struct mbuf *cause,
12254 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
12255 uint32_t vrf_id, uint16_t port)
12256 {
12257 /* Don't respond to an ABORT with an ABORT. */
12258 if (sctp_is_there_an_abort_here(m, iphlen, &vtag)) {
12259 if (cause)
12260 sctp_m_freem(cause);
12261 return;
12262 }
12263 sctp_send_resp_msg(src, dst, sh, vtag, SCTP_ABORT_ASSOCIATION, cause,
12264 mflowtype, mflowid, fibnum,
12265 vrf_id, port);
12266 return;
12267 }
12268
12269 void
sctp_send_operr_to(struct sockaddr * src,struct sockaddr * dst,struct sctphdr * sh,uint32_t vtag,struct mbuf * cause,uint8_t mflowtype,uint32_t mflowid,uint16_t fibnum,uint32_t vrf_id,uint16_t port)12270 sctp_send_operr_to(struct sockaddr *src, struct sockaddr *dst,
12271 struct sctphdr *sh, uint32_t vtag, struct mbuf *cause,
12272 uint8_t mflowtype, uint32_t mflowid, uint16_t fibnum,
12273 uint32_t vrf_id, uint16_t port)
12274 {
12275 sctp_send_resp_msg(src, dst, sh, vtag, SCTP_OPERATION_ERROR, cause,
12276 mflowtype, mflowid, fibnum,
12277 vrf_id, port);
12278 return;
12279 }
12280
12281 static struct mbuf *
sctp_copy_resume(struct uio * uio,int max_send_len,int user_marks_eor,int * error,uint32_t * sndout,struct mbuf ** new_tail)12282 sctp_copy_resume(struct uio *uio,
12283 int max_send_len,
12284 int user_marks_eor,
12285 int *error,
12286 uint32_t *sndout,
12287 struct mbuf **new_tail)
12288 {
12289 struct mbuf *m;
12290
12291 m = m_uiotombuf(uio, M_WAITOK, max_send_len, 0,
12292 (M_PKTHDR | (user_marks_eor ? M_EOR : 0)));
12293 if (m == NULL) {
12294 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOBUFS);
12295 *error = ENOBUFS;
12296 } else {
12297 *sndout = m_length(m, NULL);
12298 *new_tail = m_last(m);
12299 }
12300 return (m);
12301 }
12302
12303 static int
sctp_copy_one(struct sctp_stream_queue_pending * sp,struct uio * uio,int resv_upfront)12304 sctp_copy_one(struct sctp_stream_queue_pending *sp,
12305 struct uio *uio,
12306 int resv_upfront)
12307 {
12308 sp->data = m_uiotombuf(uio, M_WAITOK, sp->length,
12309 resv_upfront, 0);
12310 if (sp->data == NULL) {
12311 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOBUFS);
12312 return (ENOBUFS);
12313 }
12314
12315 sp->tail_mbuf = m_last(sp->data);
12316 return (0);
12317 }
12318
12319
12320
12321 static struct sctp_stream_queue_pending *
sctp_copy_it_in(struct sctp_tcb * stcb,struct sctp_association * asoc,struct sctp_sndrcvinfo * srcv,struct uio * uio,struct sctp_nets * net,ssize_t max_send_len,int user_marks_eor,int * error)12322 sctp_copy_it_in(struct sctp_tcb *stcb,
12323 struct sctp_association *asoc,
12324 struct sctp_sndrcvinfo *srcv,
12325 struct uio *uio,
12326 struct sctp_nets *net,
12327 ssize_t max_send_len,
12328 int user_marks_eor,
12329 int *error)
12330 {
12331
12332 /*-
12333 * This routine must be very careful in its work. Protocol
12334 * processing is up and running so care must be taken to spl...()
12335 * when you need to do something that may effect the stcb/asoc. The
12336 * sb is locked however. When data is copied the protocol processing
12337 * should be enabled since this is a slower operation...
12338 */
12339 struct sctp_stream_queue_pending *sp = NULL;
12340 int resv_in_first;
12341
12342 *error = 0;
12343 /* Now can we send this? */
12344 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_SENT) ||
12345 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_ACK_SENT) ||
12346 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
12347 (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) {
12348 /* got data while shutting down */
12349 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
12350 *error = ECONNRESET;
12351 goto out_now;
12352 }
12353 sctp_alloc_a_strmoq(stcb, sp);
12354 if (sp == NULL) {
12355 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12356 *error = ENOMEM;
12357 goto out_now;
12358 }
12359 sp->act_flags = 0;
12360 sp->sender_all_done = 0;
12361 sp->sinfo_flags = srcv->sinfo_flags;
12362 sp->timetolive = srcv->sinfo_timetolive;
12363 sp->ppid = srcv->sinfo_ppid;
12364 sp->context = srcv->sinfo_context;
12365 sp->fsn = 0;
12366 (void)SCTP_GETTIME_TIMEVAL(&sp->ts);
12367
12368 sp->sid = srcv->sinfo_stream;
12369 sp->length = (uint32_t)min(uio->uio_resid, max_send_len);
12370 if ((sp->length == (uint32_t)uio->uio_resid) &&
12371 ((user_marks_eor == 0) ||
12372 (srcv->sinfo_flags & SCTP_EOF) ||
12373 (user_marks_eor && (srcv->sinfo_flags & SCTP_EOR)))) {
12374 sp->msg_is_complete = 1;
12375 } else {
12376 sp->msg_is_complete = 0;
12377 }
12378 sp->sender_all_done = 0;
12379 sp->some_taken = 0;
12380 sp->put_last_out = 0;
12381 resv_in_first = SCTP_DATA_CHUNK_OVERHEAD(stcb);
12382 sp->data = sp->tail_mbuf = NULL;
12383 if (sp->length == 0) {
12384 goto skip_copy;
12385 }
12386 if (srcv->sinfo_keynumber_valid) {
12387 sp->auth_keyid = srcv->sinfo_keynumber;
12388 } else {
12389 sp->auth_keyid = stcb->asoc.authinfo.active_keyid;
12390 }
12391 if (sctp_auth_is_required_chunk(SCTP_DATA, stcb->asoc.peer_auth_chunks)) {
12392 sctp_auth_key_acquire(stcb, sp->auth_keyid);
12393 sp->holds_key_ref = 1;
12394 }
12395 *error = sctp_copy_one(sp, uio, resv_in_first);
12396 skip_copy:
12397 if (*error) {
12398 sctp_free_a_strmoq(stcb, sp, SCTP_SO_LOCKED);
12399 sp = NULL;
12400 } else {
12401 if (sp->sinfo_flags & SCTP_ADDR_OVER) {
12402 sp->net = net;
12403 atomic_add_int(&sp->net->ref_count, 1);
12404 } else {
12405 sp->net = NULL;
12406 }
12407 sctp_set_prsctp_policy(sp);
12408 }
12409 out_now:
12410 return (sp);
12411 }
12412
12413
12414 int
sctp_sosend(struct socket * so,struct sockaddr * addr,struct uio * uio,struct mbuf * top,struct mbuf * control,int flags,struct thread * p)12415 sctp_sosend(struct socket *so,
12416 struct sockaddr *addr,
12417 struct uio *uio,
12418 struct mbuf *top,
12419 struct mbuf *control,
12420 int flags,
12421 struct thread *p
12422 )
12423 {
12424 int error, use_sndinfo = 0;
12425 struct sctp_sndrcvinfo sndrcvninfo;
12426 struct sockaddr *addr_to_use;
12427 #if defined(INET) && defined(INET6)
12428 struct sockaddr_in sin;
12429 #endif
12430
12431 if (control) {
12432 /* process cmsg snd/rcv info (maybe a assoc-id) */
12433 if (sctp_find_cmsg(SCTP_SNDRCV, (void *)&sndrcvninfo, control,
12434 sizeof(sndrcvninfo))) {
12435 /* got one */
12436 use_sndinfo = 1;
12437 }
12438 }
12439 addr_to_use = addr;
12440 #if defined(INET) && defined(INET6)
12441 if ((addr) && (addr->sa_family == AF_INET6)) {
12442 struct sockaddr_in6 *sin6;
12443
12444 sin6 = (struct sockaddr_in6 *)addr;
12445 if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) {
12446 in6_sin6_2_sin(&sin, sin6);
12447 addr_to_use = (struct sockaddr *)&sin;
12448 }
12449 }
12450 #endif
12451 error = sctp_lower_sosend(so, addr_to_use, uio, top,
12452 control,
12453 flags,
12454 use_sndinfo ? &sndrcvninfo : NULL
12455 ,p
12456 );
12457 return (error);
12458 }
12459
12460
12461 int
sctp_lower_sosend(struct socket * so,struct sockaddr * addr,struct uio * uio,struct mbuf * i_pak,struct mbuf * control,int flags,struct sctp_sndrcvinfo * srcv,struct thread * p)12462 sctp_lower_sosend(struct socket *so,
12463 struct sockaddr *addr,
12464 struct uio *uio,
12465 struct mbuf *i_pak,
12466 struct mbuf *control,
12467 int flags,
12468 struct sctp_sndrcvinfo *srcv
12469 ,
12470 struct thread *p
12471 )
12472 {
12473 ssize_t sndlen = 0, max_len, local_add_more;
12474 int error, len;
12475 struct mbuf *top = NULL;
12476 int queue_only = 0, queue_only_for_init = 0;
12477 int free_cnt_applied = 0;
12478 int un_sent;
12479 int now_filled = 0;
12480 unsigned int inqueue_bytes = 0;
12481 struct sctp_block_entry be;
12482 struct sctp_inpcb *inp;
12483 struct sctp_tcb *stcb = NULL;
12484 struct timeval now;
12485 struct sctp_nets *net;
12486 struct sctp_association *asoc;
12487 struct sctp_inpcb *t_inp;
12488 int user_marks_eor;
12489 int create_lock_applied = 0;
12490 int nagle_applies = 0;
12491 int some_on_control = 0;
12492 int got_all_of_the_send = 0;
12493 int hold_tcblock = 0;
12494 int non_blocking = 0;
12495 ssize_t local_soresv = 0;
12496 uint16_t port;
12497 uint16_t sinfo_flags;
12498 sctp_assoc_t sinfo_assoc_id;
12499
12500 error = 0;
12501 net = NULL;
12502 stcb = NULL;
12503 asoc = NULL;
12504
12505 t_inp = inp = (struct sctp_inpcb *)so->so_pcb;
12506 if (inp == NULL) {
12507 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12508 error = EINVAL;
12509 if (i_pak) {
12510 SCTP_RELEASE_PKT(i_pak);
12511 }
12512 return (error);
12513 }
12514 if ((uio == NULL) && (i_pak == NULL)) {
12515 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12516 return (EINVAL);
12517 }
12518 user_marks_eor = sctp_is_feature_on(inp, SCTP_PCB_FLAGS_EXPLICIT_EOR);
12519 atomic_add_int(&inp->total_sends, 1);
12520 if (uio) {
12521 if (uio->uio_resid < 0) {
12522 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12523 return (EINVAL);
12524 }
12525 sndlen = uio->uio_resid;
12526 } else {
12527 top = SCTP_HEADER_TO_CHAIN(i_pak);
12528 sndlen = SCTP_HEADER_LEN(i_pak);
12529 }
12530 SCTPDBG(SCTP_DEBUG_OUTPUT1, "Send called addr:%p send length %zd\n",
12531 (void *)addr,
12532 sndlen);
12533 if ((inp->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) &&
12534 SCTP_IS_LISTENING(inp)) {
12535 /* The listener can NOT send */
12536 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, ENOTCONN);
12537 error = ENOTCONN;
12538 goto out_unlocked;
12539 }
12540 /**
12541 * Pre-screen address, if one is given the sin-len
12542 * must be set correctly!
12543 */
12544 if (addr) {
12545 union sctp_sockstore *raddr = (union sctp_sockstore *)addr;
12546
12547 switch (raddr->sa.sa_family) {
12548 #ifdef INET
12549 case AF_INET:
12550 if (raddr->sin.sin_len != sizeof(struct sockaddr_in)) {
12551 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12552 error = EINVAL;
12553 goto out_unlocked;
12554 }
12555 port = raddr->sin.sin_port;
12556 break;
12557 #endif
12558 #ifdef INET6
12559 case AF_INET6:
12560 if (raddr->sin6.sin6_len != sizeof(struct sockaddr_in6)) {
12561 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12562 error = EINVAL;
12563 goto out_unlocked;
12564 }
12565 port = raddr->sin6.sin6_port;
12566 break;
12567 #endif
12568 default:
12569 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EAFNOSUPPORT);
12570 error = EAFNOSUPPORT;
12571 goto out_unlocked;
12572 }
12573 } else
12574 port = 0;
12575
12576 if (srcv) {
12577 sinfo_flags = srcv->sinfo_flags;
12578 sinfo_assoc_id = srcv->sinfo_assoc_id;
12579 if (INVALID_SINFO_FLAG(sinfo_flags) ||
12580 PR_SCTP_INVALID_POLICY(sinfo_flags)) {
12581 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12582 error = EINVAL;
12583 goto out_unlocked;
12584 }
12585 if (srcv->sinfo_flags)
12586 SCTP_STAT_INCR(sctps_sends_with_flags);
12587 } else {
12588 sinfo_flags = inp->def_send.sinfo_flags;
12589 sinfo_assoc_id = inp->def_send.sinfo_assoc_id;
12590 }
12591 if (flags & MSG_EOR) {
12592 sinfo_flags |= SCTP_EOR;
12593 }
12594 if (flags & MSG_EOF) {
12595 sinfo_flags |= SCTP_EOF;
12596 }
12597 if (sinfo_flags & SCTP_SENDALL) {
12598 /* its a sendall */
12599 error = sctp_sendall(inp, uio, top, srcv);
12600 top = NULL;
12601 goto out_unlocked;
12602 }
12603 if ((sinfo_flags & SCTP_ADDR_OVER) && (addr == NULL)) {
12604 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12605 error = EINVAL;
12606 goto out_unlocked;
12607 }
12608 /* now we must find the assoc */
12609 if ((inp->sctp_flags & SCTP_PCB_FLAGS_CONNECTED) ||
12610 (inp->sctp_flags & SCTP_PCB_FLAGS_IN_TCPPOOL)) {
12611 SCTP_INP_RLOCK(inp);
12612 stcb = LIST_FIRST(&inp->sctp_asoc_list);
12613 if (stcb) {
12614 SCTP_TCB_LOCK(stcb);
12615 hold_tcblock = 1;
12616 }
12617 SCTP_INP_RUNLOCK(inp);
12618 } else if (sinfo_assoc_id) {
12619 stcb = sctp_findassociation_ep_asocid(inp, sinfo_assoc_id, 1);
12620 if (stcb != NULL) {
12621 hold_tcblock = 1;
12622 }
12623 } else if (addr) {
12624 /*-
12625 * Since we did not use findep we must
12626 * increment it, and if we don't find a tcb
12627 * decrement it.
12628 */
12629 SCTP_INP_WLOCK(inp);
12630 SCTP_INP_INCR_REF(inp);
12631 SCTP_INP_WUNLOCK(inp);
12632 stcb = sctp_findassociation_ep_addr(&t_inp, addr, &net, NULL, NULL);
12633 if (stcb == NULL) {
12634 SCTP_INP_WLOCK(inp);
12635 SCTP_INP_DECR_REF(inp);
12636 SCTP_INP_WUNLOCK(inp);
12637 } else {
12638 hold_tcblock = 1;
12639 }
12640 }
12641 if ((stcb == NULL) && (addr)) {
12642 /* Possible implicit send? */
12643 SCTP_ASOC_CREATE_LOCK(inp);
12644 create_lock_applied = 1;
12645 if ((inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_GONE) ||
12646 (inp->sctp_flags & SCTP_PCB_FLAGS_SOCKET_ALLGONE)) {
12647 /* Should I really unlock ? */
12648 SCTP_LTRACE_ERR_RET(NULL, NULL, NULL, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12649 error = EINVAL;
12650 goto out_unlocked;
12651
12652 }
12653 if (((inp->sctp_flags & SCTP_PCB_FLAGS_BOUND_V6) == 0) &&
12654 (addr->sa_family == AF_INET6)) {
12655 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12656 error = EINVAL;
12657 goto out_unlocked;
12658 }
12659 SCTP_INP_WLOCK(inp);
12660 SCTP_INP_INCR_REF(inp);
12661 SCTP_INP_WUNLOCK(inp);
12662 /* With the lock applied look again */
12663 stcb = sctp_findassociation_ep_addr(&t_inp, addr, &net, NULL, NULL);
12664 #if defined(INET) || defined(INET6)
12665 if ((stcb == NULL) && (control != NULL) && (port > 0)) {
12666 stcb = sctp_findassociation_cmsgs(&t_inp, port, control, &net, &error);
12667 }
12668 #endif
12669 if (stcb == NULL) {
12670 SCTP_INP_WLOCK(inp);
12671 SCTP_INP_DECR_REF(inp);
12672 SCTP_INP_WUNLOCK(inp);
12673 } else {
12674 hold_tcblock = 1;
12675 }
12676 if (error) {
12677 goto out_unlocked;
12678 }
12679 if (t_inp != inp) {
12680 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOTCONN);
12681 error = ENOTCONN;
12682 goto out_unlocked;
12683 }
12684 }
12685 if (stcb == NULL) {
12686 if (addr == NULL) {
12687 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOENT);
12688 error = ENOENT;
12689 goto out_unlocked;
12690 } else {
12691 /* We must go ahead and start the INIT process */
12692 uint32_t vrf_id;
12693
12694 if ((sinfo_flags & SCTP_ABORT) ||
12695 ((sinfo_flags & SCTP_EOF) && (sndlen == 0))) {
12696 /*-
12697 * User asks to abort a non-existent assoc,
12698 * or EOF a non-existent assoc with no data
12699 */
12700 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOENT);
12701 error = ENOENT;
12702 goto out_unlocked;
12703 }
12704 /* get an asoc/stcb struct */
12705 vrf_id = inp->def_vrf_id;
12706 #ifdef INVARIANTS
12707 if (create_lock_applied == 0) {
12708 panic("Error, should hold create lock and I don't?");
12709 }
12710 #endif
12711 stcb = sctp_aloc_assoc(inp, addr, &error, 0, vrf_id,
12712 inp->sctp_ep.pre_open_stream_count,
12713 inp->sctp_ep.port,
12714 p,
12715 SCTP_INITIALIZE_AUTH_PARAMS);
12716 if (stcb == NULL) {
12717 /* Error is setup for us in the call */
12718 goto out_unlocked;
12719 }
12720 if (stcb->sctp_ep->sctp_flags & SCTP_PCB_FLAGS_TCPTYPE) {
12721 stcb->sctp_ep->sctp_flags |= SCTP_PCB_FLAGS_CONNECTED;
12722 /*
12723 * Set the connected flag so we can queue
12724 * data
12725 */
12726 soisconnecting(so);
12727 }
12728 hold_tcblock = 1;
12729 if (create_lock_applied) {
12730 SCTP_ASOC_CREATE_UNLOCK(inp);
12731 create_lock_applied = 0;
12732 } else {
12733 SCTP_PRINTF("Huh-3? create lock should have been on??\n");
12734 }
12735 /*
12736 * Turn on queue only flag to prevent data from
12737 * being sent
12738 */
12739 queue_only = 1;
12740 asoc = &stcb->asoc;
12741 SCTP_SET_STATE(stcb, SCTP_STATE_COOKIE_WAIT);
12742 (void)SCTP_GETTIME_TIMEVAL(&asoc->time_entered);
12743
12744 if (control) {
12745 if (sctp_process_cmsgs_for_init(stcb, control, &error)) {
12746 sctp_free_assoc(inp, stcb, SCTP_PCBFREE_FORCE,
12747 SCTP_FROM_SCTP_OUTPUT + SCTP_LOC_6);
12748 hold_tcblock = 0;
12749 stcb = NULL;
12750 goto out_unlocked;
12751 }
12752 }
12753 /* out with the INIT */
12754 queue_only_for_init = 1;
12755 /*-
12756 * we may want to dig in after this call and adjust the MTU
12757 * value. It defaulted to 1500 (constant) but the ro
12758 * structure may now have an update and thus we may need to
12759 * change it BEFORE we append the message.
12760 */
12761 }
12762 } else
12763 asoc = &stcb->asoc;
12764 if (srcv == NULL) {
12765 srcv = (struct sctp_sndrcvinfo *)&asoc->def_send;
12766 sinfo_flags = srcv->sinfo_flags;
12767 if (flags & MSG_EOR) {
12768 sinfo_flags |= SCTP_EOR;
12769 }
12770 if (flags & MSG_EOF) {
12771 sinfo_flags |= SCTP_EOF;
12772 }
12773 }
12774 if (sinfo_flags & SCTP_ADDR_OVER) {
12775 if (addr)
12776 net = sctp_findnet(stcb, addr);
12777 else
12778 net = NULL;
12779 if ((net == NULL) ||
12780 ((port != 0) && (port != stcb->rport))) {
12781 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12782 error = EINVAL;
12783 goto out_unlocked;
12784 }
12785 } else {
12786 if (stcb->asoc.alternate) {
12787 net = stcb->asoc.alternate;
12788 } else {
12789 net = stcb->asoc.primary_destination;
12790 }
12791 }
12792 atomic_add_int(&stcb->total_sends, 1);
12793 /* Keep the stcb from being freed under our feet */
12794 atomic_add_int(&asoc->refcnt, 1);
12795 free_cnt_applied = 1;
12796
12797 if (sctp_is_feature_on(inp, SCTP_PCB_FLAGS_NO_FRAGMENT)) {
12798 if (sndlen > (ssize_t)asoc->smallest_mtu) {
12799 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EMSGSIZE);
12800 error = EMSGSIZE;
12801 goto out_unlocked;
12802 }
12803 }
12804 if (SCTP_SO_IS_NBIO(so)
12805 || (flags & (MSG_NBIO | MSG_DONTWAIT)) != 0
12806 ) {
12807 non_blocking = 1;
12808 }
12809 /* would we block? */
12810 if (non_blocking) {
12811 ssize_t amount;
12812
12813 if (hold_tcblock == 0) {
12814 SCTP_TCB_LOCK(stcb);
12815 hold_tcblock = 1;
12816 }
12817 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
12818 if (user_marks_eor == 0) {
12819 amount = sndlen;
12820 } else {
12821 amount = 1;
12822 }
12823 if ((SCTP_SB_LIMIT_SND(so) < (amount + inqueue_bytes + stcb->asoc.sb_send_resv)) ||
12824 (stcb->asoc.chunks_on_out_queue >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue))) {
12825 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EWOULDBLOCK);
12826 if (sndlen > (ssize_t)SCTP_SB_LIMIT_SND(so))
12827 error = EMSGSIZE;
12828 else
12829 error = EWOULDBLOCK;
12830 goto out_unlocked;
12831 }
12832 stcb->asoc.sb_send_resv += (uint32_t)sndlen;
12833 SCTP_TCB_UNLOCK(stcb);
12834 hold_tcblock = 0;
12835 } else {
12836 atomic_add_int(&stcb->asoc.sb_send_resv, sndlen);
12837 }
12838 local_soresv = sndlen;
12839 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
12840 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
12841 error = ECONNRESET;
12842 goto out_unlocked;
12843 }
12844 if (create_lock_applied) {
12845 SCTP_ASOC_CREATE_UNLOCK(inp);
12846 create_lock_applied = 0;
12847 }
12848 /* Is the stream no. valid? */
12849 if (srcv->sinfo_stream >= asoc->streamoutcnt) {
12850 /* Invalid stream number */
12851 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12852 error = EINVAL;
12853 goto out_unlocked;
12854 }
12855 if ((asoc->strmout[srcv->sinfo_stream].state != SCTP_STREAM_OPEN) &&
12856 (asoc->strmout[srcv->sinfo_stream].state != SCTP_STREAM_OPENING)) {
12857 /*
12858 * Can't queue any data while stream reset is underway.
12859 */
12860 if (asoc->strmout[srcv->sinfo_stream].state > SCTP_STREAM_OPEN) {
12861 error = EAGAIN;
12862 } else {
12863 error = EINVAL;
12864 }
12865 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, error);
12866 goto out_unlocked;
12867 }
12868 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT) ||
12869 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED)) {
12870 queue_only = 1;
12871 }
12872 /* we are now done with all control */
12873 if (control) {
12874 sctp_m_freem(control);
12875 control = NULL;
12876 }
12877 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_SENT) ||
12878 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_RECEIVED) ||
12879 (SCTP_GET_STATE(stcb) == SCTP_STATE_SHUTDOWN_ACK_SENT) ||
12880 (asoc->state & SCTP_STATE_SHUTDOWN_PENDING)) {
12881 if (sinfo_flags & SCTP_ABORT) {
12882 ;
12883 } else {
12884 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
12885 error = ECONNRESET;
12886 goto out_unlocked;
12887 }
12888 }
12889 /* Ok, we will attempt a msgsnd :> */
12890 if (p) {
12891 p->td_ru.ru_msgsnd++;
12892 }
12893 /* Are we aborting? */
12894 if (sinfo_flags & SCTP_ABORT) {
12895 struct mbuf *mm;
12896 ssize_t tot_demand, tot_out = 0, max_out;
12897
12898 SCTP_STAT_INCR(sctps_sends_with_abort);
12899 if ((SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_WAIT) ||
12900 (SCTP_GET_STATE(stcb) == SCTP_STATE_COOKIE_ECHOED)) {
12901 /* It has to be up before we abort */
12902 /* how big is the user initiated abort? */
12903 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
12904 error = EINVAL;
12905 goto out;
12906 }
12907 if (hold_tcblock) {
12908 SCTP_TCB_UNLOCK(stcb);
12909 hold_tcblock = 0;
12910 }
12911 if (top) {
12912 struct mbuf *cntm = NULL;
12913
12914 mm = sctp_get_mbuf_for_msg(sizeof(struct sctp_paramhdr), 0, M_WAITOK, 1, MT_DATA);
12915 if (sndlen != 0) {
12916 for (cntm = top; cntm; cntm = SCTP_BUF_NEXT(cntm)) {
12917 tot_out += SCTP_BUF_LEN(cntm);
12918 }
12919 }
12920 } else {
12921 /* Must fit in a MTU */
12922 tot_out = sndlen;
12923 tot_demand = (tot_out + sizeof(struct sctp_paramhdr));
12924 if (tot_demand > SCTP_DEFAULT_ADD_MORE) {
12925 /* To big */
12926 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EMSGSIZE);
12927 error = EMSGSIZE;
12928 goto out;
12929 }
12930 mm = sctp_get_mbuf_for_msg((unsigned int)tot_demand, 0, M_WAITOK, 1, MT_DATA);
12931 }
12932 if (mm == NULL) {
12933 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, ENOMEM);
12934 error = ENOMEM;
12935 goto out;
12936 }
12937 max_out = asoc->smallest_mtu - sizeof(struct sctp_paramhdr);
12938 max_out -= sizeof(struct sctp_abort_msg);
12939 if (tot_out > max_out) {
12940 tot_out = max_out;
12941 }
12942 if (mm) {
12943 struct sctp_paramhdr *ph;
12944
12945 /* now move forward the data pointer */
12946 ph = mtod(mm, struct sctp_paramhdr *);
12947 ph->param_type = htons(SCTP_CAUSE_USER_INITIATED_ABT);
12948 ph->param_length = htons((uint16_t)(sizeof(struct sctp_paramhdr) + tot_out));
12949 ph++;
12950 SCTP_BUF_LEN(mm) = (int)(tot_out + sizeof(struct sctp_paramhdr));
12951 if (top == NULL) {
12952 error = uiomove((caddr_t)ph, (int)tot_out, uio);
12953 if (error) {
12954 /*-
12955 * Here if we can't get his data we
12956 * still abort we just don't get to
12957 * send the users note :-0
12958 */
12959 sctp_m_freem(mm);
12960 mm = NULL;
12961 }
12962 } else {
12963 if (sndlen != 0) {
12964 SCTP_BUF_NEXT(mm) = top;
12965 }
12966 }
12967 }
12968 if (hold_tcblock == 0) {
12969 SCTP_TCB_LOCK(stcb);
12970 }
12971 atomic_add_int(&stcb->asoc.refcnt, -1);
12972 free_cnt_applied = 0;
12973 /* release this lock, otherwise we hang on ourselves */
12974 sctp_abort_an_association(stcb->sctp_ep, stcb, mm, SCTP_SO_LOCKED);
12975 /* now relock the stcb so everything is sane */
12976 hold_tcblock = 0;
12977 stcb = NULL;
12978 /*
12979 * In this case top is already chained to mm avoid double
12980 * free, since we free it below if top != NULL and driver
12981 * would free it after sending the packet out
12982 */
12983 if (sndlen != 0) {
12984 top = NULL;
12985 }
12986 goto out_unlocked;
12987 }
12988 /* Calculate the maximum we can send */
12989 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
12990 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes) {
12991 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
12992 } else {
12993 max_len = 0;
12994 }
12995 if (hold_tcblock) {
12996 SCTP_TCB_UNLOCK(stcb);
12997 hold_tcblock = 0;
12998 }
12999 if (asoc->strmout == NULL) {
13000 /* huh? software error */
13001 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EFAULT);
13002 error = EFAULT;
13003 goto out_unlocked;
13004 }
13005
13006 /* Unless E_EOR mode is on, we must make a send FIT in one call. */
13007 if ((user_marks_eor == 0) &&
13008 (sndlen > (ssize_t)SCTP_SB_LIMIT_SND(stcb->sctp_socket))) {
13009 /* It will NEVER fit */
13010 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EMSGSIZE);
13011 error = EMSGSIZE;
13012 goto out_unlocked;
13013 }
13014 if ((uio == NULL) && user_marks_eor) {
13015 /*-
13016 * We do not support eeor mode for
13017 * sending with mbuf chains (like sendfile).
13018 */
13019 SCTP_LTRACE_ERR_RET(NULL, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
13020 error = EINVAL;
13021 goto out_unlocked;
13022 }
13023
13024 if (user_marks_eor) {
13025 local_add_more = (ssize_t)min(SCTP_SB_LIMIT_SND(so), SCTP_BASE_SYSCTL(sctp_add_more_threshold));
13026 } else {
13027 /*-
13028 * For non-eeor the whole message must fit in
13029 * the socket send buffer.
13030 */
13031 local_add_more = sndlen;
13032 }
13033 len = 0;
13034 if (non_blocking) {
13035 goto skip_preblock;
13036 }
13037 if (((max_len <= local_add_more) &&
13038 ((ssize_t)SCTP_SB_LIMIT_SND(so) >= local_add_more)) ||
13039 (max_len == 0) ||
13040 ((stcb->asoc.chunks_on_out_queue + stcb->asoc.stream_queue_cnt) >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue))) {
13041 /* No room right now ! */
13042 SOCKBUF_LOCK(&so->so_snd);
13043 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13044 while ((SCTP_SB_LIMIT_SND(so) < (inqueue_bytes + local_add_more)) ||
13045 ((stcb->asoc.stream_queue_cnt + stcb->asoc.chunks_on_out_queue) >= SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue))) {
13046 SCTPDBG(SCTP_DEBUG_OUTPUT1, "pre_block limit:%u <(inq:%d + %zd) || (%d+%d > %d)\n",
13047 (unsigned int)SCTP_SB_LIMIT_SND(so),
13048 inqueue_bytes,
13049 local_add_more,
13050 stcb->asoc.stream_queue_cnt,
13051 stcb->asoc.chunks_on_out_queue,
13052 SCTP_BASE_SYSCTL(sctp_max_chunks_on_queue));
13053 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13054 sctp_log_block(SCTP_BLOCK_LOG_INTO_BLKA, asoc, sndlen);
13055 }
13056 be.error = 0;
13057 stcb->block_entry = &be;
13058 error = sbwait(&so->so_snd);
13059 stcb->block_entry = NULL;
13060 if (error || so->so_error || be.error) {
13061 if (error == 0) {
13062 if (so->so_error)
13063 error = so->so_error;
13064 if (be.error) {
13065 error = be.error;
13066 }
13067 }
13068 SOCKBUF_UNLOCK(&so->so_snd);
13069 goto out_unlocked;
13070 }
13071 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13072 sctp_log_block(SCTP_BLOCK_LOG_OUTOF_BLK,
13073 asoc, stcb->asoc.total_output_queue_size);
13074 }
13075 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
13076 SOCKBUF_UNLOCK(&so->so_snd);
13077 goto out_unlocked;
13078 }
13079 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13080 }
13081 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes) {
13082 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13083 } else {
13084 max_len = 0;
13085 }
13086 SOCKBUF_UNLOCK(&so->so_snd);
13087 }
13088
13089 skip_preblock:
13090 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
13091 goto out_unlocked;
13092 }
13093 /*
13094 * sndlen covers for mbuf case uio_resid covers for the non-mbuf
13095 * case NOTE: uio will be null when top/mbuf is passed
13096 */
13097 if (sndlen == 0) {
13098 if (sinfo_flags & SCTP_EOF) {
13099 got_all_of_the_send = 1;
13100 goto dataless_eof;
13101 } else {
13102 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
13103 error = EINVAL;
13104 goto out;
13105 }
13106 }
13107 if (top == NULL) {
13108 struct sctp_stream_queue_pending *sp;
13109 struct sctp_stream_out *strm;
13110 uint32_t sndout;
13111
13112 SCTP_TCB_SEND_LOCK(stcb);
13113 if ((asoc->stream_locked) &&
13114 (asoc->stream_locked_on != srcv->sinfo_stream)) {
13115 SCTP_TCB_SEND_UNLOCK(stcb);
13116 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
13117 error = EINVAL;
13118 goto out;
13119 }
13120 strm = &stcb->asoc.strmout[srcv->sinfo_stream];
13121 if (strm->last_msg_incomplete == 0) {
13122 do_a_copy_in:
13123 SCTP_TCB_SEND_UNLOCK(stcb);
13124 sp = sctp_copy_it_in(stcb, asoc, srcv, uio, net, max_len, user_marks_eor, &error);
13125 if (error) {
13126 goto out;
13127 }
13128 SCTP_TCB_SEND_LOCK(stcb);
13129 if (sp->msg_is_complete) {
13130 strm->last_msg_incomplete = 0;
13131 asoc->stream_locked = 0;
13132 } else {
13133 /*
13134 * Just got locked to this guy in case of an
13135 * interrupt.
13136 */
13137 strm->last_msg_incomplete = 1;
13138 if (stcb->asoc.idata_supported == 0) {
13139 asoc->stream_locked = 1;
13140 asoc->stream_locked_on = srcv->sinfo_stream;
13141 }
13142 sp->sender_all_done = 0;
13143 }
13144 sctp_snd_sb_alloc(stcb, sp->length);
13145 atomic_add_int(&asoc->stream_queue_cnt, 1);
13146 if (sinfo_flags & SCTP_UNORDERED) {
13147 SCTP_STAT_INCR(sctps_sends_with_unord);
13148 }
13149 sp->processing = 1;
13150 TAILQ_INSERT_TAIL(&strm->outqueue, sp, next);
13151 stcb->asoc.ss_functions.sctp_ss_add_to_stream(stcb, asoc, strm, sp, 1);
13152 } else {
13153 sp = TAILQ_LAST(&strm->outqueue, sctp_streamhead);
13154 if (sp == NULL) {
13155 /* ???? Huh ??? last msg is gone */
13156 #ifdef INVARIANTS
13157 panic("Warning: Last msg marked incomplete, yet nothing left?");
13158 #else
13159 SCTP_PRINTF("Warning: Last msg marked incomplete, yet nothing left?\n");
13160 strm->last_msg_incomplete = 0;
13161 #endif
13162 goto do_a_copy_in;
13163
13164 }
13165 if (sp->processing) {
13166 SCTP_TCB_SEND_UNLOCK(stcb);
13167 SCTP_LTRACE_ERR_RET(inp, stcb, net, SCTP_FROM_SCTP_OUTPUT, EINVAL);
13168 error = EINVAL;
13169 goto out;
13170 } else {
13171 sp->processing = 1;
13172 }
13173 }
13174 SCTP_TCB_SEND_UNLOCK(stcb);
13175 while (uio->uio_resid > 0) {
13176 /* How much room do we have? */
13177 struct mbuf *new_tail, *mm;
13178
13179 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13180 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes)
13181 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13182 else
13183 max_len = 0;
13184
13185 if ((max_len > (ssize_t)SCTP_BASE_SYSCTL(sctp_add_more_threshold)) ||
13186 (max_len && (SCTP_SB_LIMIT_SND(so) < SCTP_BASE_SYSCTL(sctp_add_more_threshold))) ||
13187 (uio->uio_resid && (uio->uio_resid <= max_len))) {
13188 sndout = 0;
13189 new_tail = NULL;
13190 if (hold_tcblock) {
13191 SCTP_TCB_UNLOCK(stcb);
13192 hold_tcblock = 0;
13193 }
13194 mm = sctp_copy_resume(uio, (int)max_len, user_marks_eor, &error, &sndout, &new_tail);
13195 if ((mm == NULL) || error) {
13196 if (mm) {
13197 sctp_m_freem(mm);
13198 }
13199 SCTP_TCB_SEND_LOCK(stcb);
13200 if (sp != NULL) {
13201 sp->processing = 0;
13202 }
13203 SCTP_TCB_SEND_UNLOCK(stcb);
13204 goto out;
13205 }
13206 /* Update the mbuf and count */
13207 SCTP_TCB_SEND_LOCK(stcb);
13208 if ((stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) ||
13209 (stcb->asoc.state & SCTP_STATE_WAS_ABORTED)) {
13210 /*
13211 * we need to get out. Peer probably
13212 * aborted.
13213 */
13214 sctp_m_freem(mm);
13215 if (stcb->asoc.state & SCTP_STATE_WAS_ABORTED) {
13216 SCTP_LTRACE_ERR_RET(NULL, stcb, NULL, SCTP_FROM_SCTP_OUTPUT, ECONNRESET);
13217 error = ECONNRESET;
13218 }
13219 if (sp != NULL) {
13220 sp->processing = 0;
13221 }
13222 SCTP_TCB_SEND_UNLOCK(stcb);
13223 goto out;
13224 }
13225 if (sp->tail_mbuf) {
13226 /* tack it to the end */
13227 SCTP_BUF_NEXT(sp->tail_mbuf) = mm;
13228 sp->tail_mbuf = new_tail;
13229 } else {
13230 /* A stolen mbuf */
13231 sp->data = mm;
13232 sp->tail_mbuf = new_tail;
13233 }
13234 sctp_snd_sb_alloc(stcb, sndout);
13235 atomic_add_int(&sp->length, sndout);
13236 len += sndout;
13237 if (sinfo_flags & SCTP_SACK_IMMEDIATELY) {
13238 sp->sinfo_flags |= SCTP_SACK_IMMEDIATELY;
13239 }
13240
13241 /* Did we reach EOR? */
13242 if ((uio->uio_resid == 0) &&
13243 ((user_marks_eor == 0) ||
13244 (sinfo_flags & SCTP_EOF) ||
13245 (user_marks_eor && (sinfo_flags & SCTP_EOR)))) {
13246 sp->msg_is_complete = 1;
13247 } else {
13248 sp->msg_is_complete = 0;
13249 }
13250 SCTP_TCB_SEND_UNLOCK(stcb);
13251 }
13252 if (uio->uio_resid == 0) {
13253 /* got it all? */
13254 continue;
13255 }
13256 /* PR-SCTP? */
13257 if ((asoc->prsctp_supported) && (asoc->sent_queue_cnt_removeable > 0)) {
13258 /*
13259 * This is ugly but we must assure locking
13260 * order
13261 */
13262 if (hold_tcblock == 0) {
13263 SCTP_TCB_LOCK(stcb);
13264 hold_tcblock = 1;
13265 }
13266 sctp_prune_prsctp(stcb, asoc, srcv, (int)sndlen);
13267 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13268 if (SCTP_SB_LIMIT_SND(so) > inqueue_bytes)
13269 max_len = SCTP_SB_LIMIT_SND(so) - inqueue_bytes;
13270 else
13271 max_len = 0;
13272 if (max_len > 0) {
13273 continue;
13274 }
13275 SCTP_TCB_UNLOCK(stcb);
13276 hold_tcblock = 0;
13277 }
13278 /* wait for space now */
13279 if (non_blocking) {
13280 /* Non-blocking io in place out */
13281 SCTP_TCB_SEND_LOCK(stcb);
13282 if (sp != NULL) {
13283 sp->processing = 0;
13284 }
13285 SCTP_TCB_SEND_UNLOCK(stcb);
13286 goto skip_out_eof;
13287 }
13288 /* What about the INIT, send it maybe */
13289 if (queue_only_for_init) {
13290 if (hold_tcblock == 0) {
13291 SCTP_TCB_LOCK(stcb);
13292 hold_tcblock = 1;
13293 }
13294 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
13295 /* a collision took us forward? */
13296 queue_only = 0;
13297 } else {
13298 sctp_send_initiate(inp, stcb, SCTP_SO_LOCKED);
13299 SCTP_SET_STATE(stcb, SCTP_STATE_COOKIE_WAIT);
13300 queue_only = 1;
13301 }
13302 }
13303 if ((net->flight_size > net->cwnd) &&
13304 (asoc->sctp_cmt_on_off == 0)) {
13305 SCTP_STAT_INCR(sctps_send_cwnd_avoid);
13306 queue_only = 1;
13307 } else if (asoc->ifp_had_enobuf) {
13308 SCTP_STAT_INCR(sctps_ifnomemqueued);
13309 if (net->flight_size > (2 * net->mtu)) {
13310 queue_only = 1;
13311 }
13312 asoc->ifp_had_enobuf = 0;
13313 }
13314 un_sent = stcb->asoc.total_output_queue_size - stcb->asoc.total_flight;
13315 if ((sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY)) &&
13316 (stcb->asoc.total_flight > 0) &&
13317 (stcb->asoc.stream_queue_cnt < SCTP_MAX_DATA_BUNDLING) &&
13318 (un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD))) {
13319
13320 /*-
13321 * Ok, Nagle is set on and we have data outstanding.
13322 * Don't send anything and let SACKs drive out the
13323 * data unless we have a "full" segment to send.
13324 */
13325 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13326 sctp_log_nagle_event(stcb, SCTP_NAGLE_APPLIED);
13327 }
13328 SCTP_STAT_INCR(sctps_naglequeued);
13329 nagle_applies = 1;
13330 } else {
13331 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13332 if (sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY))
13333 sctp_log_nagle_event(stcb, SCTP_NAGLE_SKIPPED);
13334 }
13335 SCTP_STAT_INCR(sctps_naglesent);
13336 nagle_applies = 0;
13337 }
13338 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13339
13340 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, queue_only_for_init, queue_only,
13341 nagle_applies, un_sent);
13342 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, stcb->asoc.total_output_queue_size,
13343 stcb->asoc.total_flight,
13344 stcb->asoc.chunks_on_out_queue, stcb->asoc.total_flight_count);
13345 }
13346 if (queue_only_for_init)
13347 queue_only_for_init = 0;
13348 if ((queue_only == 0) && (nagle_applies == 0)) {
13349 /*-
13350 * need to start chunk output
13351 * before blocking.. note that if
13352 * a lock is already applied, then
13353 * the input via the net is happening
13354 * and I don't need to start output :-D
13355 */
13356 if (hold_tcblock == 0) {
13357 if (SCTP_TCB_TRYLOCK(stcb)) {
13358 hold_tcblock = 1;
13359 sctp_chunk_output(inp,
13360 stcb,
13361 SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13362 }
13363 } else {
13364 sctp_chunk_output(inp,
13365 stcb,
13366 SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13367 }
13368 }
13369 if (hold_tcblock == 1) {
13370 SCTP_TCB_UNLOCK(stcb);
13371 hold_tcblock = 0;
13372 }
13373 SOCKBUF_LOCK(&so->so_snd);
13374 /*-
13375 * This is a bit strange, but I think it will
13376 * work. The total_output_queue_size is locked and
13377 * protected by the TCB_LOCK, which we just released.
13378 * There is a race that can occur between releasing it
13379 * above, and me getting the socket lock, where sacks
13380 * come in but we have not put the SB_WAIT on the
13381 * so_snd buffer to get the wakeup. After the LOCK
13382 * is applied the sack_processing will also need to
13383 * LOCK the so->so_snd to do the actual sowwakeup(). So
13384 * once we have the socket buffer lock if we recheck the
13385 * size we KNOW we will get to sleep safely with the
13386 * wakeup flag in place.
13387 */
13388 inqueue_bytes = stcb->asoc.total_output_queue_size - (stcb->asoc.chunks_on_out_queue * SCTP_DATA_CHUNK_OVERHEAD(stcb));
13389 if (SCTP_SB_LIMIT_SND(so) <= (inqueue_bytes +
13390 min(SCTP_BASE_SYSCTL(sctp_add_more_threshold), SCTP_SB_LIMIT_SND(so)))) {
13391 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13392 sctp_log_block(SCTP_BLOCK_LOG_INTO_BLK,
13393 asoc, uio->uio_resid);
13394 }
13395 be.error = 0;
13396 stcb->block_entry = &be;
13397 error = sbwait(&so->so_snd);
13398 stcb->block_entry = NULL;
13399
13400 if (error || so->so_error || be.error) {
13401 if (error == 0) {
13402 if (so->so_error)
13403 error = so->so_error;
13404 if (be.error) {
13405 error = be.error;
13406 }
13407 }
13408 SOCKBUF_UNLOCK(&so->so_snd);
13409 SCTP_TCB_SEND_LOCK(stcb);
13410 if (sp != NULL) {
13411 sp->processing = 0;
13412 }
13413 SCTP_TCB_SEND_UNLOCK(stcb);
13414 goto out_unlocked;
13415 }
13416
13417 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13418 sctp_log_block(SCTP_BLOCK_LOG_OUTOF_BLK,
13419 asoc, stcb->asoc.total_output_queue_size);
13420 }
13421 }
13422 SOCKBUF_UNLOCK(&so->so_snd);
13423 SCTP_TCB_SEND_LOCK(stcb);
13424 if (stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) {
13425 if (sp != NULL) {
13426 sp->processing = 0;
13427 }
13428 SCTP_TCB_SEND_UNLOCK(stcb);
13429 goto out_unlocked;
13430 }
13431 SCTP_TCB_SEND_UNLOCK(stcb);
13432 }
13433 SCTP_TCB_SEND_LOCK(stcb);
13434 if ((stcb->asoc.state & SCTP_STATE_ABOUT_TO_BE_FREED) ||
13435 (stcb->asoc.state & SCTP_STATE_WAS_ABORTED)) {
13436 SCTP_TCB_SEND_UNLOCK(stcb);
13437 goto out_unlocked;
13438 }
13439 if (sp) {
13440 if (sp->msg_is_complete == 0) {
13441 strm->last_msg_incomplete = 1;
13442 if (stcb->asoc.idata_supported == 0) {
13443 asoc->stream_locked = 1;
13444 asoc->stream_locked_on = srcv->sinfo_stream;
13445 }
13446 } else {
13447 sp->sender_all_done = 1;
13448 strm->last_msg_incomplete = 0;
13449 asoc->stream_locked = 0;
13450 }
13451 sp->processing = 0;
13452 } else {
13453 SCTP_PRINTF("Huh no sp TSNH?\n");
13454 strm->last_msg_incomplete = 0;
13455 asoc->stream_locked = 0;
13456 }
13457 SCTP_TCB_SEND_UNLOCK(stcb);
13458 if (uio->uio_resid == 0) {
13459 got_all_of_the_send = 1;
13460 }
13461 } else {
13462 /* We send in a 0, since we do NOT have any locks */
13463 error = sctp_msg_append(stcb, net, top, srcv, 0);
13464 top = NULL;
13465 if (sinfo_flags & SCTP_EOF) {
13466 got_all_of_the_send = 1;
13467 }
13468 }
13469 if (error) {
13470 goto out;
13471 }
13472 dataless_eof:
13473 /* EOF thing ? */
13474 if ((sinfo_flags & SCTP_EOF) &&
13475 (got_all_of_the_send == 1)) {
13476 SCTP_STAT_INCR(sctps_sends_with_eof);
13477 error = 0;
13478 if (hold_tcblock == 0) {
13479 SCTP_TCB_LOCK(stcb);
13480 hold_tcblock = 1;
13481 }
13482 if (TAILQ_EMPTY(&asoc->send_queue) &&
13483 TAILQ_EMPTY(&asoc->sent_queue) &&
13484 sctp_is_there_unsent_data(stcb, SCTP_SO_LOCKED) == 0) {
13485 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
13486 goto abort_anyway;
13487 }
13488 /* there is nothing queued to send, so I'm done... */
13489 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
13490 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
13491 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
13492 struct sctp_nets *netp;
13493
13494 /* only send SHUTDOWN the first time through */
13495 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
13496 SCTP_STAT_DECR_GAUGE32(sctps_currestab);
13497 }
13498 SCTP_SET_STATE(stcb, SCTP_STATE_SHUTDOWN_SENT);
13499 sctp_stop_timers_for_shutdown(stcb);
13500 if (stcb->asoc.alternate) {
13501 netp = stcb->asoc.alternate;
13502 } else {
13503 netp = stcb->asoc.primary_destination;
13504 }
13505 sctp_send_shutdown(stcb, netp);
13506 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWN, stcb->sctp_ep, stcb,
13507 netp);
13508 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
13509 NULL);
13510 }
13511 } else {
13512 /*-
13513 * we still got (or just got) data to send, so set
13514 * SHUTDOWN_PENDING
13515 */
13516 /*-
13517 * XXX sockets draft says that SCTP_EOF should be
13518 * sent with no data. currently, we will allow user
13519 * data to be sent first and move to
13520 * SHUTDOWN-PENDING
13521 */
13522 if ((SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_SENT) &&
13523 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_RECEIVED) &&
13524 (SCTP_GET_STATE(stcb) != SCTP_STATE_SHUTDOWN_ACK_SENT)) {
13525 if (hold_tcblock == 0) {
13526 SCTP_TCB_LOCK(stcb);
13527 hold_tcblock = 1;
13528 }
13529 if ((*asoc->ss_functions.sctp_ss_is_user_msgs_incomplete) (stcb, asoc)) {
13530 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_PARTIAL_MSG_LEFT);
13531 }
13532 SCTP_ADD_SUBSTATE(stcb, SCTP_STATE_SHUTDOWN_PENDING);
13533 if (TAILQ_EMPTY(&asoc->send_queue) &&
13534 TAILQ_EMPTY(&asoc->sent_queue) &&
13535 (asoc->state & SCTP_STATE_PARTIAL_MSG_LEFT)) {
13536 struct mbuf *op_err;
13537 char msg[SCTP_DIAG_INFO_LEN];
13538
13539 abort_anyway:
13540 if (free_cnt_applied) {
13541 atomic_add_int(&stcb->asoc.refcnt, -1);
13542 free_cnt_applied = 0;
13543 }
13544 SCTP_SNPRINTF(msg, sizeof(msg),
13545 "%s:%d at %s", __FILE__, __LINE__, __func__);
13546 op_err = sctp_generate_cause(SCTP_BASE_SYSCTL(sctp_diag_info_code),
13547 msg);
13548 sctp_abort_an_association(stcb->sctp_ep, stcb,
13549 op_err, SCTP_SO_LOCKED);
13550 /*
13551 * now relock the stcb so everything
13552 * is sane
13553 */
13554 hold_tcblock = 0;
13555 stcb = NULL;
13556 goto out;
13557 }
13558 sctp_timer_start(SCTP_TIMER_TYPE_SHUTDOWNGUARD, stcb->sctp_ep, stcb,
13559 NULL);
13560 sctp_feature_off(inp, SCTP_PCB_FLAGS_NODELAY);
13561 }
13562 }
13563 }
13564 skip_out_eof:
13565 if (!TAILQ_EMPTY(&stcb->asoc.control_send_queue)) {
13566 some_on_control = 1;
13567 }
13568 if (queue_only_for_init) {
13569 if (hold_tcblock == 0) {
13570 SCTP_TCB_LOCK(stcb);
13571 hold_tcblock = 1;
13572 }
13573 if (SCTP_GET_STATE(stcb) == SCTP_STATE_OPEN) {
13574 /* a collision took us forward? */
13575 queue_only = 0;
13576 } else {
13577 sctp_send_initiate(inp, stcb, SCTP_SO_LOCKED);
13578 SCTP_SET_STATE(stcb, SCTP_STATE_COOKIE_WAIT);
13579 queue_only = 1;
13580 }
13581 }
13582 if ((net->flight_size > net->cwnd) &&
13583 (stcb->asoc.sctp_cmt_on_off == 0)) {
13584 SCTP_STAT_INCR(sctps_send_cwnd_avoid);
13585 queue_only = 1;
13586 } else if (asoc->ifp_had_enobuf) {
13587 SCTP_STAT_INCR(sctps_ifnomemqueued);
13588 if (net->flight_size > (2 * net->mtu)) {
13589 queue_only = 1;
13590 }
13591 asoc->ifp_had_enobuf = 0;
13592 }
13593 un_sent = stcb->asoc.total_output_queue_size - stcb->asoc.total_flight;
13594 if ((sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY)) &&
13595 (stcb->asoc.total_flight > 0) &&
13596 (stcb->asoc.stream_queue_cnt < SCTP_MAX_DATA_BUNDLING) &&
13597 (un_sent < (int)(stcb->asoc.smallest_mtu - SCTP_MIN_OVERHEAD))) {
13598 /*-
13599 * Ok, Nagle is set on and we have data outstanding.
13600 * Don't send anything and let SACKs drive out the
13601 * data unless wen have a "full" segment to send.
13602 */
13603 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13604 sctp_log_nagle_event(stcb, SCTP_NAGLE_APPLIED);
13605 }
13606 SCTP_STAT_INCR(sctps_naglequeued);
13607 nagle_applies = 1;
13608 } else {
13609 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_NAGLE_LOGGING_ENABLE) {
13610 if (sctp_is_feature_off(inp, SCTP_PCB_FLAGS_NODELAY))
13611 sctp_log_nagle_event(stcb, SCTP_NAGLE_SKIPPED);
13612 }
13613 SCTP_STAT_INCR(sctps_naglesent);
13614 nagle_applies = 0;
13615 }
13616 if (SCTP_BASE_SYSCTL(sctp_logging_level) & SCTP_BLK_LOGGING_ENABLE) {
13617 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, queue_only_for_init, queue_only,
13618 nagle_applies, un_sent);
13619 sctp_misc_ints(SCTP_CWNDLOG_PRESEND, stcb->asoc.total_output_queue_size,
13620 stcb->asoc.total_flight,
13621 stcb->asoc.chunks_on_out_queue, stcb->asoc.total_flight_count);
13622 }
13623 if ((queue_only == 0) && (nagle_applies == 0) && (stcb->asoc.peers_rwnd && un_sent)) {
13624 /* we can attempt to send too. */
13625 if (hold_tcblock == 0) {
13626 /*
13627 * If there is activity recv'ing sacks no need to
13628 * send
13629 */
13630 if (SCTP_TCB_TRYLOCK(stcb)) {
13631 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13632 hold_tcblock = 1;
13633 }
13634 } else {
13635 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13636 }
13637 } else if ((queue_only == 0) &&
13638 (stcb->asoc.peers_rwnd == 0) &&
13639 (stcb->asoc.total_flight == 0)) {
13640 /* We get to have a probe outstanding */
13641 if (hold_tcblock == 0) {
13642 hold_tcblock = 1;
13643 SCTP_TCB_LOCK(stcb);
13644 }
13645 sctp_chunk_output(inp, stcb, SCTP_OUTPUT_FROM_USR_SEND, SCTP_SO_LOCKED);
13646 } else if (some_on_control) {
13647 int num_out, reason, frag_point;
13648
13649 /* Here we do control only */
13650 if (hold_tcblock == 0) {
13651 hold_tcblock = 1;
13652 SCTP_TCB_LOCK(stcb);
13653 }
13654 frag_point = sctp_get_frag_point(stcb, &stcb->asoc);
13655 (void)sctp_med_chunk_output(inp, stcb, &stcb->asoc, &num_out,
13656 &reason, 1, 1, &now, &now_filled, frag_point, SCTP_SO_LOCKED);
13657 }
13658 SCTPDBG(SCTP_DEBUG_OUTPUT1, "USR Send complete qo:%d prw:%d unsent:%d tf:%d cooq:%d toqs:%d err:%d\n",
13659 queue_only, stcb->asoc.peers_rwnd, un_sent,
13660 stcb->asoc.total_flight, stcb->asoc.chunks_on_out_queue,
13661 stcb->asoc.total_output_queue_size, error);
13662
13663 out:
13664 out_unlocked:
13665
13666 if (local_soresv && stcb) {
13667 atomic_subtract_int(&stcb->asoc.sb_send_resv, sndlen);
13668 }
13669 if (create_lock_applied) {
13670 SCTP_ASOC_CREATE_UNLOCK(inp);
13671 }
13672 if ((stcb) && hold_tcblock) {
13673 SCTP_TCB_UNLOCK(stcb);
13674 }
13675 if (stcb && free_cnt_applied) {
13676 atomic_add_int(&stcb->asoc.refcnt, -1);
13677 }
13678 #ifdef INVARIANTS
13679 if (stcb) {
13680 if (mtx_owned(&stcb->tcb_mtx)) {
13681 panic("Leaving with tcb mtx owned?");
13682 }
13683 if (mtx_owned(&stcb->tcb_send_mtx)) {
13684 panic("Leaving with tcb send mtx owned?");
13685 }
13686 }
13687 #endif
13688 if (top) {
13689 sctp_m_freem(top);
13690 }
13691 if (control) {
13692 sctp_m_freem(control);
13693 }
13694 return (error);
13695 }
13696
13697
13698 /*
13699 * generate an AUTHentication chunk, if required
13700 */
13701 struct mbuf *
sctp_add_auth_chunk(struct mbuf * m,struct mbuf ** m_end,struct sctp_auth_chunk ** auth_ret,uint32_t * offset,struct sctp_tcb * stcb,uint8_t chunk)13702 sctp_add_auth_chunk(struct mbuf *m, struct mbuf **m_end,
13703 struct sctp_auth_chunk **auth_ret, uint32_t *offset,
13704 struct sctp_tcb *stcb, uint8_t chunk)
13705 {
13706 struct mbuf *m_auth;
13707 struct sctp_auth_chunk *auth;
13708 int chunk_len;
13709 struct mbuf *cn;
13710
13711 if ((m_end == NULL) || (auth_ret == NULL) || (offset == NULL) ||
13712 (stcb == NULL))
13713 return (m);
13714
13715 if (stcb->asoc.auth_supported == 0) {
13716 return (m);
13717 }
13718 /* does the requested chunk require auth? */
13719 if (!sctp_auth_is_required_chunk(chunk, stcb->asoc.peer_auth_chunks)) {
13720 return (m);
13721 }
13722 m_auth = sctp_get_mbuf_for_msg(sizeof(*auth), 0, M_NOWAIT, 1, MT_HEADER);
13723 if (m_auth == NULL) {
13724 /* no mbuf's */
13725 return (m);
13726 }
13727 /* reserve some space if this will be the first mbuf */
13728 if (m == NULL)
13729 SCTP_BUF_RESV_UF(m_auth, SCTP_MIN_OVERHEAD);
13730 /* fill in the AUTH chunk details */
13731 auth = mtod(m_auth, struct sctp_auth_chunk *);
13732 memset(auth, 0, sizeof(*auth));
13733 auth->ch.chunk_type = SCTP_AUTHENTICATION;
13734 auth->ch.chunk_flags = 0;
13735 chunk_len = sizeof(*auth) +
13736 sctp_get_hmac_digest_len(stcb->asoc.peer_hmac_id);
13737 auth->ch.chunk_length = htons(chunk_len);
13738 auth->hmac_id = htons(stcb->asoc.peer_hmac_id);
13739 /* key id and hmac digest will be computed and filled in upon send */
13740
13741 /* save the offset where the auth was inserted into the chain */
13742 *offset = 0;
13743 for (cn = m; cn; cn = SCTP_BUF_NEXT(cn)) {
13744 *offset += SCTP_BUF_LEN(cn);
13745 }
13746
13747 /* update length and return pointer to the auth chunk */
13748 SCTP_BUF_LEN(m_auth) = chunk_len;
13749 m = sctp_copy_mbufchain(m_auth, m, m_end, 1, chunk_len, 0);
13750 if (auth_ret != NULL)
13751 *auth_ret = auth;
13752
13753 return (m);
13754 }
13755
13756 #ifdef INET6
13757 int
sctp_v6src_match_nexthop(struct sockaddr_in6 * src6,sctp_route_t * ro)13758 sctp_v6src_match_nexthop(struct sockaddr_in6 *src6, sctp_route_t *ro)
13759 {
13760 struct nd_prefix *pfx = NULL;
13761 struct nd_pfxrouter *pfxrtr = NULL;
13762 struct sockaddr_in6 gw6;
13763
13764 if (ro == NULL || ro->ro_rt == NULL || src6->sin6_family != AF_INET6)
13765 return (0);
13766
13767 /* get prefix entry of address */
13768 ND6_RLOCK();
13769 LIST_FOREACH(pfx, &MODULE_GLOBAL(nd_prefix), ndpr_entry) {
13770 if (pfx->ndpr_stateflags & NDPRF_DETACHED)
13771 continue;
13772 if (IN6_ARE_MASKED_ADDR_EQUAL(&pfx->ndpr_prefix.sin6_addr,
13773 &src6->sin6_addr, &pfx->ndpr_mask))
13774 break;
13775 }
13776 /* no prefix entry in the prefix list */
13777 if (pfx == NULL) {
13778 ND6_RUNLOCK();
13779 SCTPDBG(SCTP_DEBUG_OUTPUT2, "No prefix entry for ");
13780 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)src6);
13781 return (0);
13782 }
13783
13784 SCTPDBG(SCTP_DEBUG_OUTPUT2, "v6src_match_nexthop(), Prefix entry is ");
13785 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)src6);
13786
13787 /* search installed gateway from prefix entry */
13788 LIST_FOREACH(pfxrtr, &pfx->ndpr_advrtrs, pfr_entry) {
13789 memset(&gw6, 0, sizeof(struct sockaddr_in6));
13790 gw6.sin6_family = AF_INET6;
13791 gw6.sin6_len = sizeof(struct sockaddr_in6);
13792 memcpy(&gw6.sin6_addr, &pfxrtr->router->rtaddr,
13793 sizeof(struct in6_addr));
13794 SCTPDBG(SCTP_DEBUG_OUTPUT2, "prefix router is ");
13795 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, (struct sockaddr *)&gw6);
13796 SCTPDBG(SCTP_DEBUG_OUTPUT2, "installed router is ");
13797 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, ro->ro_rt->rt_gateway);
13798 if (sctp_cmpaddr((struct sockaddr *)&gw6, ro->ro_rt->rt_gateway)) {
13799 ND6_RUNLOCK();
13800 SCTPDBG(SCTP_DEBUG_OUTPUT2, "pfxrouter is installed\n");
13801 return (1);
13802 }
13803 }
13804 ND6_RUNLOCK();
13805 SCTPDBG(SCTP_DEBUG_OUTPUT2, "pfxrouter is not installed\n");
13806 return (0);
13807 }
13808 #endif
13809
13810 int
sctp_v4src_match_nexthop(struct sctp_ifa * sifa,sctp_route_t * ro)13811 sctp_v4src_match_nexthop(struct sctp_ifa *sifa, sctp_route_t *ro)
13812 {
13813 #ifdef INET
13814 struct sockaddr_in *sin, *mask;
13815 struct ifaddr *ifa;
13816 struct in_addr srcnetaddr, gwnetaddr;
13817
13818 if (ro == NULL || ro->ro_rt == NULL ||
13819 sifa->address.sa.sa_family != AF_INET) {
13820 return (0);
13821 }
13822 ifa = (struct ifaddr *)sifa->ifa;
13823 mask = (struct sockaddr_in *)(ifa->ifa_netmask);
13824 sin = &sifa->address.sin;
13825 srcnetaddr.s_addr = (sin->sin_addr.s_addr & mask->sin_addr.s_addr);
13826 SCTPDBG(SCTP_DEBUG_OUTPUT1, "match_nexthop4: src address is ");
13827 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, &sifa->address.sa);
13828 SCTPDBG(SCTP_DEBUG_OUTPUT1, "network address is %x\n", srcnetaddr.s_addr);
13829
13830 sin = (struct sockaddr_in *)ro->ro_rt->rt_gateway;
13831 gwnetaddr.s_addr = (sin->sin_addr.s_addr & mask->sin_addr.s_addr);
13832 SCTPDBG(SCTP_DEBUG_OUTPUT1, "match_nexthop4: nexthop is ");
13833 SCTPDBG_ADDR(SCTP_DEBUG_OUTPUT2, ro->ro_rt->rt_gateway);
13834 SCTPDBG(SCTP_DEBUG_OUTPUT1, "network address is %x\n", gwnetaddr.s_addr);
13835 if (srcnetaddr.s_addr == gwnetaddr.s_addr) {
13836 return (1);
13837 }
13838 #endif
13839 return (0);
13840 }
13841