51 struct ptp_dte {  struct
97 static void dte_write_nco_delta(struct ptp_dte *ptp_dte, s64 delta)  in dte_write_nco_delta()  argument
101 	ns = dte_read_nco(ptp_dte->regs);  in dte_write_nco_delta()
105 		if (ptp_dte->ts_wrap_cnt) {  in dte_write_nco_delta()
107 			ptp_dte->ts_wrap_cnt--;  in dte_write_nco_delta()
114 			ptp_dte->ts_wrap_cnt++;  in dte_write_nco_delta()
119 	dte_write_nco(ptp_dte->regs, ns);  in dte_write_nco_delta()
121 	ptp_dte->ts_ovf_last = (ns >> DTE_NCO_TS_WRAP_LSHIFT) &  in dte_write_nco_delta()
125 static s64 dte_read_nco_with_ovf(struct ptp_dte *ptp_dte)  in dte_read_nco_with_ovf()  argument
130 	ns = dte_read_nco(ptp_dte->regs);  in dte_read_nco_with_ovf()
136 	if (ts_ovf < ptp_dte->ts_ovf_last)  in dte_read_nco_with_ovf()
137 		ptp_dte->ts_wrap_cnt++;  in dte_read_nco_with_ovf()
139 	ptp_dte->ts_ovf_last = ts_ovf;  in dte_read_nco_with_ovf()
142 	ns += (s64)(BIT_ULL(DTE_WRAP_AROUND_NSEC_SHIFT) * ptp_dte->ts_wrap_cnt);  in dte_read_nco_with_ovf()
151 	struct ptp_dte *ptp_dte = container_of(ptp, struct ptp_dte, caps);  in ptp_dte_adjfreq()  local
153 	if (abs(ppb) > ptp_dte->caps.max_adj) {  in ptp_dte_adjfreq()
154 		dev_err(ptp_dte->dev, "ppb adj too big\n");  in ptp_dte_adjfreq()
163 	spin_lock_irqsave(&ptp_dte->lock, flags);  in ptp_dte_adjfreq()
164 	writel(nco_incr, ptp_dte->regs + DTE_NCO_INC_REG);  in ptp_dte_adjfreq()
165 	spin_unlock_irqrestore(&ptp_dte->lock, flags);  in ptp_dte_adjfreq()
173 	struct ptp_dte *ptp_dte = container_of(ptp, struct ptp_dte, caps);  in ptp_dte_adjtime()  local
175 	spin_lock_irqsave(&ptp_dte->lock, flags);  in ptp_dte_adjtime()
176 	dte_write_nco_delta(ptp_dte, delta);  in ptp_dte_adjtime()
177 	spin_unlock_irqrestore(&ptp_dte->lock, flags);  in ptp_dte_adjtime()
185 	struct ptp_dte *ptp_dte = container_of(ptp, struct ptp_dte, caps);  in ptp_dte_gettime()  local
187 	spin_lock_irqsave(&ptp_dte->lock, flags);  in ptp_dte_gettime()
188 	*ts = ns_to_timespec64(dte_read_nco_with_ovf(ptp_dte));  in ptp_dte_gettime()
189 	spin_unlock_irqrestore(&ptp_dte->lock, flags);  in ptp_dte_gettime()
198 	struct ptp_dte *ptp_dte = container_of(ptp, struct ptp_dte, caps);  in ptp_dte_settime()  local
200 	spin_lock_irqsave(&ptp_dte->lock, flags);  in ptp_dte_settime()
203 	writel(0, ptp_dte->regs + DTE_NCO_INC_REG);  in ptp_dte_settime()
205 	dte_write_nco(ptp_dte->regs, timespec64_to_ns(ts));  in ptp_dte_settime()
208 	ptp_dte->ts_ovf_last = 0;  in ptp_dte_settime()
209 	ptp_dte->ts_wrap_cnt = 0;  in ptp_dte_settime()
212 	writel(DTE_NCO_INC_DEFAULT, ptp_dte->regs + DTE_NCO_INC_REG);  in ptp_dte_settime()
214 	spin_unlock_irqrestore(&ptp_dte->lock, flags);  in ptp_dte_settime()
241 	struct ptp_dte *ptp_dte;  in ptp_dte_probe()  local
244 	ptp_dte = devm_kzalloc(dev, sizeof(struct ptp_dte), GFP_KERNEL);  in ptp_dte_probe()
245 	if (!ptp_dte)  in ptp_dte_probe()
248 	ptp_dte->regs = devm_platform_ioremap_resource(pdev, 0);  in ptp_dte_probe()
249 	if (IS_ERR(ptp_dte->regs))  in ptp_dte_probe()
250 		return PTR_ERR(ptp_dte->regs);  in ptp_dte_probe()
252 	spin_lock_init(&ptp_dte->lock);  in ptp_dte_probe()
254 	ptp_dte->dev = dev;  in ptp_dte_probe()
255 	ptp_dte->caps = ptp_dte_caps;  in ptp_dte_probe()
256 	ptp_dte->ptp_clk = ptp_clock_register(&ptp_dte->caps, &pdev->dev);  in ptp_dte_probe()
257 	if (IS_ERR(ptp_dte->ptp_clk)) {  in ptp_dte_probe()
260 		return PTR_ERR(ptp_dte->ptp_clk);  in ptp_dte_probe()
263 	platform_set_drvdata(pdev, ptp_dte);  in ptp_dte_probe()
272 	struct ptp_dte *ptp_dte = platform_get_drvdata(pdev);  in ptp_dte_remove()  local
275 	ptp_clock_unregister(ptp_dte->ptp_clk);  in ptp_dte_remove()
278 		writel(0, ptp_dte->regs + (i * sizeof(u32)));  in ptp_dte_remove()
286 	struct ptp_dte *ptp_dte = dev_get_drvdata(dev);  in ptp_dte_suspend()  local
290 		ptp_dte->reg_val[i] =  in ptp_dte_suspend()
291 			readl(ptp_dte->regs + (i * sizeof(u32)));  in ptp_dte_suspend()
295 	writel(0, ptp_dte->regs + DTE_NCO_INC_REG);  in ptp_dte_suspend()
302 	struct ptp_dte *ptp_dte = dev_get_drvdata(dev);  in ptp_dte_resume()  local
307 			writel(ptp_dte->reg_val[i],  in ptp_dte_resume()
308 				(ptp_dte->regs + (i * sizeof(u32))));  in ptp_dte_resume()
310 			writel(((ptp_dte->reg_val[i] &  in ptp_dte_resume()
312 				(ptp_dte->regs + (i * sizeof(u32))));  in ptp_dte_resume()