From: Vincent Cheng <vincent.cheng...@renesas.com>

When enabling output using PTP_CLK_REQ_PEROUT, need to align the output
clock to the internal 1 PPS clock.

Signed-off-by: Vincent Cheng <vincent.cheng...@renesas.com>
Acked-by: Richard Cochran <richardcoch...@gmail.com>
---
 drivers/ptp/ptp_clockmatrix.c | 16 +++++++++++++---
 1 file changed, 13 insertions(+), 3 deletions(-)

diff --git a/drivers/ptp/ptp_clockmatrix.c b/drivers/ptp/ptp_clockmatrix.c
index 3de8411..a83ba4b 100644
--- a/drivers/ptp/ptp_clockmatrix.c
+++ b/drivers/ptp/ptp_clockmatrix.c
@@ -1401,13 +1401,23 @@ static int idtcm_perout_enable(struct idtcm_channel 
*channel,
                               bool enable,
                               struct ptp_perout_request *perout)
 {
+       struct idtcm *idtcm = channel->idtcm;
        unsigned int flags = perout->flags;
+       struct timespec64 ts = {0, 0};
+       int err;
 
        if (flags == PEROUT_ENABLE_OUTPUT_MASK)
-               return idtcm_output_mask_enable(channel, enable);
+               err = idtcm_output_mask_enable(channel, enable);
+       else
+               err = idtcm_output_enable(channel, enable, perout->index);
+
+       if (err) {
+               dev_err(&idtcm->client->dev, "Unable to set output enable");
+               return err;
+       }
 
-       /* Enable/disable individual output instead */
-       return idtcm_output_enable(channel, enable, perout->index);
+       /* Align output to internal 1 PPS */
+       return _idtcm_settime(channel, &ts, SCSR_TOD_WR_TYPE_SEL_DELTA_PLUS);
 }
 
 static int idtcm_get_pll_mode(struct idtcm_channel *channel,
-- 
2.7.4

Reply via email to