Commit 593dd0fc authored by Dmitry Bezrukov's avatar Dmitry Bezrukov Committed by David S. Miller
Browse files

net: atlantic: move PTP TC initialization to a separate function



This patch moves the PTP TC initialization into a separate function.

Signed-off-by: default avatarDmitry Bezrukov <dbezrukov@marvell.com>
Co-developed-by: default avatarMark Starovoytov <mstarovoitov@marvell.com>
Signed-off-by: default avatarMark Starovoytov <mstarovoitov@marvell.com>
Signed-off-by: default avatarIgor Russkikh <irusskikh@marvell.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 8ce84271
Loading
Loading
Loading
Loading
+19 −12
Original line number Original line Diff line number Diff line
@@ -114,6 +114,21 @@ static int hw_atl_b0_set_fc(struct aq_hw_s *self, u32 fc, u32 tc)
	return 0;
	return 0;
}
}


static int hw_atl_b0_tc_ptp_set(struct aq_hw_s *self)
{
	/* Init TC2 for PTP_TX */
	hw_atl_tpb_tx_pkt_buff_size_per_tc_set(self, HW_ATL_B0_PTP_TXBUF_SIZE,
					       AQ_HW_PTP_TC);

	/* Init TC2 for PTP_RX */
	hw_atl_rpb_rx_pkt_buff_size_per_tc_set(self, HW_ATL_B0_PTP_RXBUF_SIZE,
					       AQ_HW_PTP_TC);
	/* No flow control for PTP */
	hw_atl_rpb_rx_xoff_en_per_tc_set(self, 0U, AQ_HW_PTP_TC);

	return aq_hw_err_from_flags(self);
}

static int hw_atl_b0_hw_qos_set(struct aq_hw_s *self)
static int hw_atl_b0_hw_qos_set(struct aq_hw_s *self)
{
{
	u32 tx_buff_size = HW_ATL_B0_TXBUF_MAX;
	u32 tx_buff_size = HW_ATL_B0_TXBUF_MAX;
@@ -121,6 +136,9 @@ static int hw_atl_b0_hw_qos_set(struct aq_hw_s *self)
	unsigned int i_priority = 0U;
	unsigned int i_priority = 0U;
	u32 tc = 0U;
	u32 tc = 0U;


	tx_buff_size -= HW_ATL_B0_PTP_TXBUF_SIZE;
	rx_buff_size -= HW_ATL_B0_PTP_RXBUF_SIZE;

	/* TPS Descriptor rate init */
	/* TPS Descriptor rate init */
	hw_atl_tps_tx_pkt_shed_desc_rate_curr_time_res_set(self, 0x0U);
	hw_atl_tps_tx_pkt_shed_desc_rate_curr_time_res_set(self, 0x0U);
	hw_atl_tps_tx_pkt_shed_desc_rate_lim_set(self, 0xA);
	hw_atl_tps_tx_pkt_shed_desc_rate_lim_set(self, 0xA);
@@ -139,8 +157,6 @@ static int hw_atl_b0_hw_qos_set(struct aq_hw_s *self)
	hw_atl_tps_tx_pkt_shed_desc_tc_weight_set(self, 0x1E, tc);
	hw_atl_tps_tx_pkt_shed_desc_tc_weight_set(self, 0x1E, tc);


	/* Tx buf size TC0 */
	/* Tx buf size TC0 */
	tx_buff_size -= HW_ATL_B0_PTP_TXBUF_SIZE;

	hw_atl_tpb_tx_pkt_buff_size_per_tc_set(self, tx_buff_size, tc);
	hw_atl_tpb_tx_pkt_buff_size_per_tc_set(self, tx_buff_size, tc);
	hw_atl_tpb_tx_buff_hi_threshold_per_tc_set(self,
	hw_atl_tpb_tx_buff_hi_threshold_per_tc_set(self,
						   (tx_buff_size *
						   (tx_buff_size *
@@ -150,13 +166,8 @@ static int hw_atl_b0_hw_qos_set(struct aq_hw_s *self)
						   (tx_buff_size *
						   (tx_buff_size *
						   (1024 / 32U) * 50U) /
						   (1024 / 32U) * 50U) /
						   100U, tc);
						   100U, tc);
	/* Init TC2 for PTP_TX */
	hw_atl_tpb_tx_pkt_buff_size_per_tc_set(self, HW_ATL_B0_PTP_TXBUF_SIZE,
					       AQ_HW_PTP_TC);


	/* QoS Rx buf size per TC */
	/* QoS Rx buf size per TC */
	rx_buff_size -= HW_ATL_B0_PTP_RXBUF_SIZE;

	hw_atl_rpb_rx_pkt_buff_size_per_tc_set(self, rx_buff_size, tc);
	hw_atl_rpb_rx_pkt_buff_size_per_tc_set(self, rx_buff_size, tc);
	hw_atl_rpb_rx_buff_hi_threshold_per_tc_set(self,
	hw_atl_rpb_rx_buff_hi_threshold_per_tc_set(self,
						   (rx_buff_size *
						   (rx_buff_size *
@@ -169,11 +180,7 @@ static int hw_atl_b0_hw_qos_set(struct aq_hw_s *self)


	hw_atl_b0_set_fc(self, self->aq_nic_cfg->fc.req, tc);
	hw_atl_b0_set_fc(self, self->aq_nic_cfg->fc.req, tc);


	/* Init TC2 for PTP_RX */
	hw_atl_b0_tc_ptp_set(self);
	hw_atl_rpb_rx_pkt_buff_size_per_tc_set(self, HW_ATL_B0_PTP_RXBUF_SIZE,
					       AQ_HW_PTP_TC);
	/* No flow control for PTP */
	hw_atl_rpb_rx_xoff_en_per_tc_set(self, 0U, AQ_HW_PTP_TC);


	/* QoS 802.1p priority -> TC mapping */
	/* QoS 802.1p priority -> TC mapping */
	for (i_priority = 8U; i_priority--;)
	for (i_priority = 8U; i_priority--;)