mips/mach-octeon/cvmx-pko.c

42 #include <mach/cvmx-pko3-queue.h>
258 	int queue;
264 	for (queue = 0; queue < CVMX_PKO_MAX_OUTPUT_QUEUES; queue++) {
267 		config1.s.qid7 = queue >> 7;
273 		config.s.queue = queue;
408  * @param base_queue First queue number to associate with this port.
410  * @param priority   Array of priority levels for each queue. Values are
426 	int queue;
440 		debug("%s: port=%d queue=%d-%d pri %#x %#x %#x %#x\n", __func__,
456 		debug("ERROR: %s: Invalid queue range port = %lld base=%llu numques=%lld\n",
465 		 * Validate the static queue priority setup and set
469 		for (queue = 0; queue < num_queues; queue++) {
470 			/* Find first queue of static priority */
471 			int p_queue = queue % 16;
475 				static_priority_base = queue;
476 			/* Find last queue of static priority */
481 			    queue)
482 				static_priority_end = queue - 1;
485 				 queue == num_queues - 1)
487 				static_priority_end = queue;
493 			 * queue 0.
496 			    (int)queue > static_priority_end &&
499 				debug("ERROR: %s: Static priority queues aren't contiguous or don't start at base queue. q: %d, eq: %d\n",
500 				      __func__, (int)queue, static_priority_end);
505 			debug("ERROR: %s: Static priority queues don't start at base queue. sq: %d\n",
513 	 * are either both -1, or are valid start/end queue numbers
518 	for (queue = 0; queue < num_queues; queue++) {
520 		int p_queue = queue % 16;
523 		config1.s.idx3 = queue >> 3;
524 		config1.s.qid7 = (base_queue + queue) >> 7;
527 		config.s.tail = queue == (num_queues - 1);
528 		config.s.index = queue;
530 		config.s.queue = base_queue + queue;
533 		config.s.static_q = (int)queue <= static_priority_end;
534 		config.s.s_tail = (int)queue == static_priority_end;
583 				CVMX_CMD_QUEUE_PKO(base_queue + queue),
600 					debug("ERROR: %s: Command queue initialization failed.\n",
607 				CVMX_CMD_QUEUE_PKO(base_queue + queue));
633 	int queue, pko_port;
651 	 * static queue priority validation
653 	for (queue = 0; queue < num_queues; queue++) {
654 		int p_queue = queue % 16;
658 			static_priority_base = queue;
662 		    queue)
663 			static_priority_end = queue - 1;
665 			 static_priority_end == -1 && queue == num_queues - 1)
667 				queue; /* all queues are static priority */
672 		 * queue 0.
675 		    (int)queue > static_priority_end &&
677 			debug("ERROR: %s: Static priority queues aren't contiguous or don't start at base queue. q: %d, eq: %d\n",
678 			      __func__, (int)queue, static_priority_end);
681 			debug("ERROR: %s: Static priority queues don't start at base queue. sq: %d\n",
688 	 * each queue
690 	for (queue = 0; queue < num_queues; queue++) {
691 		int p_queue = queue % 8;
694 		config.s.index = queue;
695 		config.s.qid = base_queue + queue;
697 		config.s.tail = (queue == (num_queues - 1));
698 		config.s.s_tail = (queue == static_priority_end);
700 		config.s.static_q = (queue <= static_priority_end);
752 				CVMX_CMD_QUEUE_PKO(base_queue + queue),
769 					debug("ERROR: %s: Command queue initialization failed.",
773 				debug(" pko_port%d base_queue%d num_queues%d queue%d.\n",
774 				      pko_port, base_queue, num_queues, queue);
778 				CVMX_CMD_QUEUE_PKO(base_queue + queue));