Commit e7b0afb6 authored by Pavan Chebbi's avatar Pavan Chebbi Committed by David S. Miller
Browse files

bnxt_en: Implement .adjtime() for PTP RTC mode 



The adjusted time is set in the PHC in RTC mode.  We also need to
update the snapshots ptp->current_time and ptp->old_time when the
time is adjusted.

Cc: Richard Cochran <richardcochran@gmail.com>
Reviewed-by: default avatarSomnath Kotur <somnath.kotur@broadcom.com>
Signed-off-by: default avatarPavan Chebbi <pavan.chebbi@broadcom.com>
Signed-off-by: default avatarMichael Chan <michael.chan@broadcom.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 24ac1ecd

drivers/net/ethernet/broadcom/bnxt/bnxt_ptp.c

+36 −0
Original line number Diff line number Diff line
@@ -148,11 +148,47 @@ static int bnxt_ptp_gettimex(struct ptp_clock_info *ptp_info, 
	return 0;

}



/* Caller holds ptp_lock */

void bnxt_ptp_update_current_time(struct bnxt *bp)

{

	struct bnxt_ptp_cfg *ptp = bp->ptp_cfg;



	bnxt_refclk_read(ptp->bp, NULL, &ptp->current_time);

	WRITE_ONCE(ptp->old_time, ptp->current_time);

}



static int bnxt_ptp_adjphc(struct bnxt_ptp_cfg *ptp, s64 delta)

{

	struct hwrm_port_mac_cfg_input *req;

	int rc;



	rc = hwrm_req_init(ptp->bp, req, HWRM_PORT_MAC_CFG);

	if (rc)

		return rc;



	req->enables = cpu_to_le32(PORT_MAC_CFG_REQ_ENABLES_PTP_ADJ_PHASE);

	req->ptp_adj_phase = cpu_to_le64(delta);



	rc = hwrm_req_send(ptp->bp, req);

	if (rc) {

		netdev_err(ptp->bp->dev, "ptp adjphc failed. rc = %x\n", rc);

	} else {

		spin_lock_bh(&ptp->ptp_lock);

		bnxt_ptp_update_current_time(ptp->bp);

		spin_unlock_bh(&ptp->ptp_lock);

	}



	return rc;

}



static int bnxt_ptp_adjtime(struct ptp_clock_info *ptp_info, s64 delta)

{

	struct bnxt_ptp_cfg *ptp = container_of(ptp_info, struct bnxt_ptp_cfg,

						ptp_info);



	if (ptp->bp->fw_cap & BNXT_FW_CAP_PTP_RTC)

		return bnxt_ptp_adjphc(ptp, delta);



	spin_lock_bh(&ptp->ptp_lock);

	timecounter_adjtime(&ptp->tc, delta);

	spin_unlock_bh(&ptp->ptp_lock);

drivers/net/ethernet/broadcom/bnxt/bnxt_ptp.h

+1 −0
Original line number Diff line number Diff line
@@ -131,6 +131,7 @@ do { \ 
#endif



int bnxt_ptp_parse(struct sk_buff *skb, u16 *seq_id, u16 *hdr_off);

void bnxt_ptp_update_current_time(struct bnxt *bp);

void bnxt_ptp_pps_event(struct bnxt *bp, u32 data1, u32 data2);

void bnxt_ptp_reapply_pps(struct bnxt *bp);

int bnxt_hwtstamp_set(struct net_device *dev, struct ifreq *ifr);