ethernet/engleder/tsnep_selftests.c

156 			    struct tc_taprio_qopt_offload *qopt, s64 ms)
159 	u64 base_time = ktime_to_ns(qopt->base_time);
164 	n = div64_u64(system_time - base_time, qopt->cycle_time);
166 	qopt->base_time = ktime_add_ns(qopt->base_time,
167 				       (n + 1) * qopt->cycle_time);
312 				struct tc_taprio_qopt_offload *qopt, s64 ms)
316 	retval = tsnep_tc_setup(adapter->netdev, TC_SETUP_QDISC_TAPRIO, qopt);
328 	struct tc_taprio_qopt_offload qopt;
331 	memset(&qopt, 0, sizeof(qopt));
332 	qopt.cmd = TAPRIO_CMD_DESTROY;
333 	retval = tsnep_tc_setup(adapter->netdev, TC_SETUP_QDISC_TAPRIO, &qopt);
341 		       struct tc_taprio_qopt_offload *qopt, s64 ms)
343 	if (!enable_check_taprio(adapter, qopt, ms))
354 	struct tc_taprio_qopt_offload *qopt;
357 	qopt = kzalloc(struct_size(qopt, entries, 255), GFP_KERNEL);
358 	if (!qopt)
361 		qopt->entries[i].command = TC_TAPRIO_CMD_SET_GATES;
363 	qopt->cmd = TAPRIO_CMD_REPLACE;
364 	qopt->base_time = ktime_set(0, 0);
365 	qopt->cycle_time = 1500000;
366 	qopt->cycle_time_extension = 0;
367 	qopt->entries[0].gate_mask = 0x02;
368 	qopt->entries[0].interval = 200000;
369 	qopt->entries[1].gate_mask = 0x03;
370 	qopt->entries[1].interval = 800000;
371 	qopt->entries[2].gate_mask = 0x07;
372 	qopt->entries[2].interval = 240000;
373 	qopt->entries[3].gate_mask = 0x01;
374 	qopt->entries[3].interval = 80000;
375 	qopt->entries[4].gate_mask = 0x04;
376 	qopt->entries[4].interval = 70000;
377 	qopt->entries[5].gate_mask = 0x06;
378 	qopt->entries[5].interval = 60000;
379 	qopt->entries[6].gate_mask = 0x0F;
380 	qopt->entries[6].interval = 50000;
381 	qopt->num_entries = 7;
382 	if (!run_taprio(adapter, qopt, 100))
385 	qopt->cmd = TAPRIO_CMD_REPLACE;
386 	qopt->base_time = ktime_set(0, 0);
387 	qopt->cycle_time = 411854;
388 	qopt->cycle_time_extension = 0;
389 	qopt->entries[0].gate_mask = 0x17;
390 	qopt->entries[0].interval = 23842;
391 	qopt->entries[1].gate_mask = 0x16;
392 	qopt->entries[1].interval = 13482;
393 	qopt->entries[2].gate_mask = 0x15;
394 	qopt->entries[2].interval = 49428;
395 	qopt->entries[3].gate_mask = 0x14;
396 	qopt->entries[3].interval = 38189;
397 	qopt->entries[4].gate_mask = 0x13;
398 	qopt->entries[4].interval = 92321;
399 	qopt->entries[5].gate_mask = 0x12;
400 	qopt->entries[5].interval = 71239;
401 	qopt->entries[6].gate_mask = 0x11;
402 	qopt->entries[6].interval = 69932;
403 	qopt->entries[7].gate_mask = 0x10;
404 	qopt->entries[7].interval = 53421;
405 	qopt->num_entries = 8;
406 	if (!run_taprio(adapter, qopt, 100))
409 	qopt->cmd = TAPRIO_CMD_REPLACE;
410 	qopt->base_time = ktime_set(0, 0);
411 	delay_base_time(adapter, qopt, 12);
412 	qopt->cycle_time = 125000;
413 	qopt->cycle_time_extension = 0;
414 	qopt->entries[0].gate_mask = 0x27;
415 	qopt->entries[0].interval = 15000;
416 	qopt->entries[1].gate_mask = 0x26;
417 	qopt->entries[1].interval = 15000;
418 	qopt->entries[2].gate_mask = 0x25;
419 	qopt->entries[2].interval = 12500;
420 	qopt->entries[3].gate_mask = 0x24;
421 	qopt->entries[3].interval = 17500;
422 	qopt->entries[4].gate_mask = 0x23;
423 	qopt->entries[4].interval = 10000;
424 	qopt->entries[5].gate_mask = 0x22;
425 	qopt->entries[5].interval = 11000;
426 	qopt->entries[6].gate_mask = 0x21;
427 	qopt->entries[6].interval = 9000;
428 	qopt->entries[7].gate_mask = 0x20;
429 	qopt->entries[7].interval = 10000;
430 	qopt->entries[8].gate_mask = 0x20;
431 	qopt->entries[8].interval = 12500;
432 	qopt->entries[9].gate_mask = 0x20;
433 	qopt->entries[9].interval = 12500;
434 	qopt->num_entries = 10;
435 	if (!run_taprio(adapter, qopt, 100))
438 	kfree(qopt);
444 	kfree(qopt);
451 	struct tc_taprio_qopt_offload *qopt;
454 	qopt = kzalloc(struct_size(qopt, entries, 255), GFP_KERNEL);
455 	if (!qopt)
458 		qopt->entries[i].command = TC_TAPRIO_CMD_SET_GATES;
460 	qopt->cmd = TAPRIO_CMD_REPLACE;
461 	qopt->base_time = ktime_set(0, 0);
462 	qopt->cycle_time = 100000;
463 	qopt->cycle_time_extension = 0;
464 	qopt->entries[0].gate_mask = 0x30;
465 	qopt->entries[0].interval = 20000;
466 	qopt->entries[1].gate_mask = 0x31;
467 	qopt->entries[1].interval = 80000;
468 	qopt->num_entries = 2;
469 	if (!enable_check_taprio(adapter, qopt, 100))
473 	if (!enable_check_taprio(adapter, qopt, 100))
475 	delay_base_time(adapter, qopt, 17);
476 	if (!enable_check_taprio(adapter, qopt, 100))
480 	qopt->base_time = ktime_set(0, 0);
481 	qopt->entries[0].gate_mask = 0x42;
482 	qopt->entries[1].gate_mask = 0x43;
483 	delay_base_time(adapter, qopt, 2);
484 	if (!enable_check_taprio(adapter, qopt, 100))
486 	qopt->base_time = ktime_set(0, 0);
487 	qopt->entries[0].gate_mask = 0x54;
488 	qopt->entries[0].interval = 33333;
489 	qopt->entries[1].gate_mask = 0x55;
490 	qopt->entries[1].interval = 66667;
491 	delay_base_time(adapter, qopt, 23);
492 	if (!enable_check_taprio(adapter, qopt, 100))
494 	qopt->base_time = ktime_set(0, 0);
495 	qopt->entries[0].gate_mask = 0x66;
496 	qopt->entries[0].interval = 50000;
497 	qopt->entries[1].gate_mask = 0x67;
498 	qopt->entries[1].interval = 25000;
499 	qopt->entries[2].gate_mask = 0x68;
500 	qopt->entries[2].interval = 25000;
501 	qopt->num_entries = 3;
502 	delay_base_time(adapter, qopt, 11);
503 	if (!enable_check_taprio(adapter, qopt, 100))
507 	qopt->base_time = ktime_set(0, 0);
508 	qopt->cycle_time = 200000;
509 	qopt->entries[0].gate_mask = 0x79;
510 	qopt->entries[0].interval = 50000;
511 	qopt->entries[1].gate_mask = 0x7A;
512 	qopt->entries[1].interval = 150000;
513 	qopt->num_entries = 2;
514 	delay_base_time(adapter, qopt, 11);
515 	if (!enable_check_taprio(adapter, qopt, 100))
517 	qopt->base_time = ktime_set(0, 0);
518 	qopt->cycle_time = 1000000;
519 	qopt->entries[0].gate_mask = 0x7B;
520 	qopt->entries[0].interval = 125000;
521 	qopt->entries[1].gate_mask = 0x7C;
522 	qopt->entries[1].interval = 250000;
523 	qopt->entries[2].gate_mask = 0x7D;
524 	qopt->entries[2].interval = 375000;
525 	qopt->entries[3].gate_mask = 0x7E;
526 	qopt->entries[3].interval = 250000;
527 	qopt->num_entries = 4;
528 	delay_base_time(adapter, qopt, 3);
529 	if (!enable_check_taprio(adapter, qopt, 100))
533 	qopt->base_time = ktime_set(0, 0);
534 	qopt->cycle_time = 333333;
535 	qopt->entries[0].gate_mask = 0x8F;
536 	qopt->entries[0].interval = 166666;
537 	qopt->entries[1].gate_mask = 0x80;
538 	qopt->entries[1].interval = 166667;
539 	qopt->num_entries = 2;
540 	delay_base_time(adapter, qopt, 11);
541 	if (!enable_check_taprio(adapter, qopt, 100))
543 	qopt->base_time = ktime_set(0, 0);
544 	qopt->cycle_time = 62500;
545 	qopt->entries[0].gate_mask = 0x81;
546 	qopt->entries[0].interval = 31250;
547 	qopt->entries[1].gate_mask = 0x82;
548 	qopt->entries[1].interval = 15625;
549 	qopt->entries[2].gate_mask = 0x83;
550 	qopt->entries[2].interval = 15625;
551 	qopt->num_entries = 3;
552 	delay_base_time(adapter, qopt, 1);
553 	if (!enable_check_taprio(adapter, qopt, 100))
557 	qopt->base_time = ktime_set(0, 0);
558 	qopt->cycle_time = 400000;
559 	qopt->entries[0].gate_mask = 0x84;
560 	qopt->entries[0].interval = 100000;
561 	qopt->entries[1].gate_mask = 0x85;
562 	qopt->entries[1].interval = 100000;
563 	qopt->entries[2].gate_mask = 0x86;
564 	qopt->entries[2].interval = 100000;
565 	qopt->entries[3].gate_mask = 0x87;
566 	qopt->entries[3].interval = 100000;
567 	qopt->num_entries = 4;
568 	delay_base_time(adapter, qopt, 7);
569 	if (!enable_check_taprio(adapter, qopt, 100))
571 	qopt->base_time = ktime_set(0, 0);
572 	qopt->cycle_time = 1700000;
573 	qopt->entries[0].gate_mask = 0x88;
574 	qopt->entries[0].interval = 200000;
575 	qopt->entries[1].gate_mask = 0x89;
576 	qopt->entries[1].interval = 300000;
577 	qopt->entries[2].gate_mask = 0x8A;
578 	qopt->entries[2].interval = 600000;
579 	qopt->entries[3].gate_mask = 0x8B;
580 	qopt->entries[3].interval = 100000;
581 	qopt->entries[4].gate_mask = 0x8C;
582 	qopt->entries[4].interval = 500000;
583 	qopt->num_entries = 5;
584 	delay_base_time(adapter, qopt, 6);
585 	if (!enable_check_taprio(adapter, qopt, 100))
591 	kfree(qopt);
597 	kfree(qopt);
604 	struct tc_taprio_qopt_offload *qopt;
607 	qopt = kzalloc(struct_size(qopt, entries, 255), GFP_KERNEL);
608 	if (!qopt)
611 		qopt->entries[i].command = TC_TAPRIO_CMD_SET_GATES;
613 	qopt->cmd = TAPRIO_CMD_REPLACE;
614 	qopt->base_time = ktime_set(0, 0);
615 	qopt->cycle_time = 100000;
616 	qopt->cycle_time_extension = 50000;
617 	qopt->entries[0].gate_mask = 0x90;
618 	qopt->entries[0].interval = 20000;
619 	qopt->entries[1].gate_mask = 0x91;
620 	qopt->entries[1].interval = 80000;
621 	qopt->num_entries = 2;
622 	if (!enable_check_taprio(adapter, qopt, 100))
626 	qopt->base_time = ktime_set(0, 50000);
627 	qopt->entries[0].gate_mask = 0x92;
628 	qopt->entries[0].interval = 33000;
629 	qopt->entries[1].gate_mask = 0x93;
630 	qopt->entries[1].interval = 67000;
631 	qopt->num_entries = 2;
632 	delay_base_time(adapter, qopt, 2);
633 	if (!enable_check_taprio(adapter, qopt, 100))
637 	qopt->base_time = ktime_set(0, 0);
638 	qopt->cycle_time = 1000000;
639 	qopt->cycle_time_extension = 700000;
640 	qopt->entries[0].gate_mask = 0x94;
641 	qopt->entries[0].interval = 400000;
642 	qopt->entries[1].gate_mask = 0x95;
643 	qopt->entries[1].interval = 600000;
644 	qopt->num_entries = 2;
645 	delay_base_time(adapter, qopt, 7);
646 	if (!enable_check_taprio(adapter, qopt, 100))
648 	qopt->base_time = ktime_set(0, 700000);
649 	qopt->cycle_time = 2000000;
650 	qopt->cycle_time_extension = 1900000;
651 	qopt->entries[0].gate_mask = 0x96;
652 	qopt->entries[0].interval = 400000;
653 	qopt->entries[1].gate_mask = 0x97;
654 	qopt->entries[1].interval = 1600000;
655 	qopt->num_entries = 2;
656 	delay_base_time(adapter, qopt, 9);
657 	if (!enable_check_taprio(adapter, qopt, 100))
661 	qopt->base_time = ktime_set(0, 0);
662 	qopt->cycle_time = 1500000;
663 	qopt->cycle_time_extension = 700000;
664 	qopt->entries[0].gate_mask = 0x98;
665 	qopt->entries[0].interval = 400000;
666 	qopt->entries[1].gate_mask = 0x99;
667 	qopt->entries[1].interval = 600000;
668 	qopt->entries[2].gate_mask = 0x9A;
669 	qopt->entries[2].interval = 500000;
670 	qopt->num_entries = 3;
671 	delay_base_time(adapter, qopt, 3);
672 	if (!enable_check_taprio(adapter, qopt, 100))
674 	qopt->base_time = ktime_set(0, 100000);
675 	qopt->cycle_time = 500000;
676 	qopt->cycle_time_extension = 300000;
677 	qopt->entries[0].gate_mask = 0x9B;
678 	qopt->entries[0].interval = 150000;
679 	qopt->entries[1].gate_mask = 0x9C;
680 	qopt->entries[1].interval = 350000;
681 	qopt->num_entries = 2;
682 	delay_base_time(adapter, qopt, 9);
683 	if (!enable_check_taprio(adapter, qopt, 100))
687 	qopt->base_time = ktime_set(0, 0);
688 	qopt->cycle_time = 1000000;
689 	qopt->cycle_time_extension = 700000;
690 	qopt->entries[0].gate_mask = 0xAD;
691 	qopt->entries[0].interval = 400000;
692 	qopt->entries[1].gate_mask = 0xAE;
693 	qopt->entries[1].interval = 300000;
694 	qopt->entries[2].gate_mask = 0xAF;
695 	qopt->entries[2].interval = 300000;
696 	qopt->num_entries = 3;
697 	if (!enable_check_taprio(adapter, qopt, 100))
699 	qopt->base_time = ktime_set(0, 0);
700 	qopt->cycle_time = 400000;
701 	qopt->cycle_time_extension = 100000;
702 	qopt->entries[0].gate_mask = 0xA0;
703 	qopt->entries[0].interval = 200000;
704 	qopt->entries[1].gate_mask = 0xA1;
705 	qopt->entries[1].interval = 200000;
706 	qopt->num_entries = 2;
707 	delay_base_time(adapter, qopt, 19);
708 	if (!enable_check_taprio(adapter, qopt, 100))
710 	qopt->base_time = ktime_set(0, 0);
711 	qopt->cycle_time = 500000;
712 	qopt->cycle_time_extension = 499999;
713 	qopt->entries[0].gate_mask = 0xB2;
714 	qopt->entries[0].interval = 100000;
715 	qopt->entries[1].gate_mask = 0xB3;
716 	qopt->entries[1].interval = 100000;
717 	qopt->entries[2].gate_mask = 0xB4;
718 	qopt->entries[2].interval = 100000;
719 	qopt->entries[3].gate_mask = 0xB5;
720 	qopt->entries[3].interval = 200000;
721 	qopt->num_entries = 4;
722 	delay_base_time(adapter, qopt, 19);
723 	if (!enable_check_taprio(adapter, qopt, 100))
725 	qopt->base_time = ktime_set(0, 0);
726 	qopt->cycle_time = 6000000;
727 	qopt->cycle_time_extension = 5999999;
728 	qopt->entries[0].gate_mask = 0xC6;
729 	qopt->entries[0].interval = 1000000;
730 	qopt->entries[1].gate_mask = 0xC7;
731 	qopt->entries[1].interval = 1000000;
732 	qopt->entries[2].gate_mask = 0xC8;
733 	qopt->entries[2].interval = 1000000;
734 	qopt->entries[3].gate_mask = 0xC9;
735 	qopt->entries[3].interval = 1500000;
736 	qopt->entries[4].gate_mask = 0xCA;
737 	qopt->entries[4].interval = 1500000;
738 	qopt->num_entries = 5;
739 	delay_base_time(adapter, qopt, 1);
740 	if (!enable_check_taprio(adapter, qopt, 100))
746 	kfree(qopt);
752 	kfree(qopt);