Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 10f70e94 authored by Madalin Bucur's avatar Madalin Bucur Committed by David S. Miller
Browse files

dpaa_eth: add ethtool coalesce control 



Allow ethtool control of the DPAA QMan portal interrupt coalescing
settings.

Signed-off-by: default avatarMadalin Bucur <madalin.bucur@nxp.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 5c664ace

drivers/net/ethernet/freescale/dpaa/dpaa_ethtool.c

+71 −0
Original line number Diff line number Diff line
@@ -529,6 +529,75 @@ static int dpaa_get_ts_info(struct net_device *net_dev, 
	return 0;

}



static int dpaa_get_coalesce(struct net_device *dev,

			     struct ethtool_coalesce *c)

{

	struct qman_portal *portal;

	u32 period;

	u8 thresh;



	portal = qman_get_affine_portal(smp_processor_id());

	qman_portal_get_iperiod(portal, &period);

	qman_dqrr_get_ithresh(portal, &thresh);



	c->rx_coalesce_usecs = period;

	c->rx_max_coalesced_frames = thresh;

	c->use_adaptive_rx_coalesce = false;



	return 0;

}



static int dpaa_set_coalesce(struct net_device *dev,

			     struct ethtool_coalesce *c)

{

	const cpumask_t *cpus = qman_affine_cpus();

	bool needs_revert[NR_CPUS] = {false};

	struct qman_portal *portal;

	u32 period, prev_period;

	u8 thresh, prev_thresh;

	int cpu, res;



	if (c->use_adaptive_rx_coalesce)

		return -EINVAL;



	period = c->rx_coalesce_usecs;

	thresh = c->rx_max_coalesced_frames;



	/* save previous values */

	portal = qman_get_affine_portal(smp_processor_id());

	qman_portal_get_iperiod(portal, &prev_period);

	qman_dqrr_get_ithresh(portal, &prev_thresh);



	/* set new values */

	for_each_cpu(cpu, cpus) {

		portal = qman_get_affine_portal(cpu);

		res = qman_portal_set_iperiod(portal, period);

		if (res)

			goto revert_values;

		res = qman_dqrr_set_ithresh(portal, thresh);

		if (res) {

			qman_portal_set_iperiod(portal, prev_period);

			goto revert_values;

		}

		needs_revert[cpu] = true;

	}



	return 0;



revert_values:

	/* restore previous values */

	for_each_cpu(cpu, cpus) {

		if (!needs_revert[cpu])

			continue;

		portal = qman_get_affine_portal(cpu);

		/* previous values will not fail, ignore return value */

		qman_portal_set_iperiod(portal, prev_period);

		qman_dqrr_set_ithresh(portal, prev_thresh);

	}



	return res;

}



const struct ethtool_ops dpaa_ethtool_ops = {

	.get_drvinfo = dpaa_get_drvinfo,

	.get_msglevel = dpaa_get_msglevel,
@@ -545,4 +614,6 @@ const struct ethtool_ops dpaa_ethtool_ops = { 
	.get_rxnfc = dpaa_get_rxnfc,

	.set_rxnfc = dpaa_set_rxnfc,

	.get_ts_info = dpaa_get_ts_info,

	.get_coalesce = dpaa_get_coalesce,

	.set_coalesce = dpaa_set_coalesce,

};