drivers/net/ethernet/microchip/lan966x/lan966x_tbf.c

Source file repositories/reference/linux-study-clean/drivers/net/ethernet/microchip/lan966x/lan966x_tbf.c

File Facts

System
Linux kernel
Corpus path
drivers/net/ethernet/microchip/lan966x/lan966x_tbf.c
Extension
.c
Size
2001 bytes
Lines
86
Domain
Driver Families
Bucket
drivers/net
Inferred role
Driver Families: implementation source
Status
source implementation candidate

Why This File Exists

Repeatable hardware-adapter layer. Deep compatibility for every driver is out of scope; this atlas records patterns, probe lifecycles, bus glue, IRQ/DMA usage, and links back to core abstractions.

Dependency Surface

Detected Declarations

Annotated Snippet

// SPDX-License-Identifier: GPL-2.0+

#include "lan966x_main.h"

int lan966x_tbf_add(struct lan966x_port *port,
		    struct tc_tbf_qopt_offload *qopt)
{
	struct lan966x *lan966x = port->lan966x;
	bool root = qopt->parent == TC_H_ROOT;
	u32 queue = 0;
	u32 cir, cbs;
	u32 se_idx;

	if (!root) {
		queue = TC_H_MIN(qopt->parent) - 1;
		if (queue >= NUM_PRIO_QUEUES)
			return -EOPNOTSUPP;
	}

	if (root)
		se_idx = SE_IDX_PORT + port->chip_port;
	else
		se_idx = SE_IDX_QUEUE + port->chip_port * NUM_PRIO_QUEUES + queue;

	cir = div_u64(qopt->replace_params.rate.rate_bytes_ps, 1000) * 8;
	cbs = qopt->replace_params.max_size;

	/* Rate unit is 100 kbps */
	cir = DIV_ROUND_UP(cir, 100);
	/* Avoid using zero rate */
	cir = cir ?: 1;
	/* Burst unit is 4kB */
	cbs = DIV_ROUND_UP(cbs, 4096);
	/* Avoid using zero burst */
	cbs = cbs ?: 1;

	/* Check that actually the result can be written */
	if (cir > GENMASK(15, 0) ||
	    cbs > GENMASK(6, 0))
		return -EINVAL;

	lan_rmw(QSYS_SE_CFG_SE_AVB_ENA_SET(0) |
		QSYS_SE_CFG_SE_FRM_MODE_SET(1),
		QSYS_SE_CFG_SE_AVB_ENA |
		QSYS_SE_CFG_SE_FRM_MODE,
		lan966x, QSYS_SE_CFG(se_idx));

	lan_wr(QSYS_CIR_CFG_CIR_RATE_SET(cir) |
	       QSYS_CIR_CFG_CIR_BURST_SET(cbs),
	       lan966x, QSYS_CIR_CFG(se_idx));

	return 0;
}

int lan966x_tbf_del(struct lan966x_port *port,
		    struct tc_tbf_qopt_offload *qopt)
{
	struct lan966x *lan966x = port->lan966x;
	bool root = qopt->parent == TC_H_ROOT;
	u32 queue = 0;
	u32 se_idx;

	if (!root) {
		queue = TC_H_MIN(qopt->parent) - 1;
		if (queue >= NUM_PRIO_QUEUES)
			return -EOPNOTSUPP;
	}

	if (root)
		se_idx = SE_IDX_PORT + port->chip_port;
	else
		se_idx = SE_IDX_QUEUE + port->chip_port * NUM_PRIO_QUEUES + queue;

	lan_rmw(QSYS_SE_CFG_SE_AVB_ENA_SET(0) |
		QSYS_SE_CFG_SE_FRM_MODE_SET(0),
		QSYS_SE_CFG_SE_AVB_ENA |
		QSYS_SE_CFG_SE_FRM_MODE,
		lan966x, QSYS_SE_CFG(se_idx));

	lan_wr(QSYS_CIR_CFG_CIR_RATE_SET(0) |
	       QSYS_CIR_CFG_CIR_BURST_SET(0),
	       lan966x, QSYS_CIR_CFG(se_idx));

	return 0;
}

Annotation

Implementation Notes