152 static u64 mvpp22_calc_frac_ppm(struct mvpp2_tai *tai, long abs_scaled_ppm)  in mvpp22_calc_frac_ppm()  argument
154 	u64 val = tai->period * abs_scaled_ppm >> 4;  in mvpp22_calc_frac_ppm()
159 static s32 mvpp22_calc_max_adj(struct mvpp2_tai *tai)  in mvpp22_calc_max_adj()  argument
166 	struct mvpp2_tai *tai = ptp_to_tai(ptp);  in mvpp22_tai_adjfine()  local
177 	val = mvpp22_calc_frac_ppm(tai, scaled_ppm);  in mvpp22_tai_adjfine()
195 	base = tai->base;  in mvpp22_tai_adjfine()
196 	spin_lock_irqsave(&tai->lock, flags);  in mvpp22_tai_adjfine()
200 	spin_unlock_irqrestore(&tai->lock, flags);  in mvpp22_tai_adjfine()
207 	struct mvpp2_tai *tai = ptp_to_tai(ptp);  in mvpp22_tai_adjtime()  local
226 	base = tai->base;  in mvpp22_tai_adjtime()
227 	spin_lock_irqsave(&tai->lock, flags);  in mvpp22_tai_adjtime()
230 	spin_unlock_irqrestore(&tai->lock, flags);  in mvpp22_tai_adjtime()
239 	struct mvpp2_tai *tai = ptp_to_tai(ptp);  in mvpp22_tai_gettimex64()  local
245 	base = tai->base;  in mvpp22_tai_gettimex64()
246 	spin_lock_irqsave(&tai->lock, flags);  in mvpp22_tai_gettimex64()
271 	spin_unlock_irqrestore(&tai->lock, flags);  in mvpp22_tai_gettimex64()
279 	struct mvpp2_tai *tai = ptp_to_tai(ptp);  in mvpp22_tai_settime64()  local
283 	base = tai->base;  in mvpp22_tai_settime64()
284 	spin_lock_irqsave(&tai->lock, flags);  in mvpp22_tai_settime64()
297 	spin_unlock_irqrestore(&tai->lock, flags);  in mvpp22_tai_settime64()
304 	struct mvpp2_tai *tai = ptp_to_tai(ptp);  in mvpp22_tai_aux_work()  local
306 	mvpp22_tai_gettimex64(ptp, &tai->stamp, NULL);  in mvpp22_tai_aux_work()
311 static void mvpp22_tai_set_step(struct mvpp2_tai *tai)  in mvpp22_tai_set_step()  argument
313 	void __iomem *base = tai->base;  in mvpp22_tai_set_step()
316 	nano = upper_32_bits(tai->period);  in mvpp22_tai_set_step()
317 	frac = lower_32_bits(tai->period);  in mvpp22_tai_set_step()
330 static void mvpp22_tai_init(struct mvpp2_tai *tai)  in mvpp22_tai_init()  argument
332 	void __iomem *base = tai->base;  in mvpp22_tai_init()
334 	mvpp22_tai_set_step(tai);  in mvpp22_tai_init()
340 int mvpp22_tai_ptp_clock_index(struct mvpp2_tai *tai)  in mvpp22_tai_ptp_clock_index()  argument
342 	return ptp_clock_index(tai->ptp_clock);  in mvpp22_tai_ptp_clock_index()
345 void mvpp22_tai_tstamp(struct mvpp2_tai *tai, u32 tstamp,  in mvpp22_tai_tstamp()  argument
355 	ts.tv_sec = READ_ONCE(tai->stamp.tv_sec);  in mvpp22_tai_tstamp()
371 void mvpp22_tai_start(struct mvpp2_tai *tai)  in mvpp22_tai_start()  argument
375 	delay = mvpp22_tai_aux_work(&tai->caps);  in mvpp22_tai_start()
377 	ptp_schedule_worker(tai->ptp_clock, delay);  in mvpp22_tai_start()
380 void mvpp22_tai_stop(struct mvpp2_tai *tai)  in mvpp22_tai_stop()  argument
382 	ptp_cancel_worker_sync(tai->ptp_clock);  in mvpp22_tai_stop()
387 	struct mvpp2_tai *tai = priv;  in mvpp22_tai_remove()  local
389 	if (!IS_ERR(tai->ptp_clock))  in mvpp22_tai_remove()
390 		ptp_clock_unregister(tai->ptp_clock);  in mvpp22_tai_remove()
395 	struct mvpp2_tai *tai;  in mvpp22_tai_probe()  local
398 	tai = devm_kzalloc(dev, sizeof(*tai), GFP_KERNEL);  in mvpp22_tai_probe()
399 	if (!tai)  in mvpp22_tai_probe()
402 	spin_lock_init(&tai->lock);  in mvpp22_tai_probe()
404 	tai->base = priv->iface_base;  in mvpp22_tai_probe()
433 	tai->period = 3ULL << 32;  in mvpp22_tai_probe()
435 	mvpp22_tai_init(tai);  in mvpp22_tai_probe()
437 	tai->caps.owner = THIS_MODULE;  in mvpp22_tai_probe()
438 	strscpy(tai->caps.name, "Marvell PP2.2", sizeof(tai->caps.name));  in mvpp22_tai_probe()
439 	tai->caps.max_adj = mvpp22_calc_max_adj(tai);  in mvpp22_tai_probe()
440 	tai->caps.adjfine = mvpp22_tai_adjfine;  in mvpp22_tai_probe()
441 	tai->caps.adjtime = mvpp22_tai_adjtime;  in mvpp22_tai_probe()
442 	tai->caps.gettimex64 = mvpp22_tai_gettimex64;  in mvpp22_tai_probe()
443 	tai->caps.settime64 = mvpp22_tai_settime64;  in mvpp22_tai_probe()
444 	tai->caps.do_aux_work = mvpp22_tai_aux_work;  in mvpp22_tai_probe()
446 	ret = devm_add_action(dev, mvpp22_tai_remove, tai);  in mvpp22_tai_probe()
450 	tai->ptp_clock = ptp_clock_register(&tai->caps, dev);  in mvpp22_tai_probe()
451 	if (IS_ERR(tai->ptp_clock))  in mvpp22_tai_probe()
452 		return PTR_ERR(tai->ptp_clock);  in mvpp22_tai_probe()
454 	priv->tai = tai;  in mvpp22_tai_probe()