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