3  * PTP 1588 clock support
78 	struct ptp_clock *ptp = container_of(pc, struct ptp_clock, clock);  in ptp_clock_settime()  local
80 	if (ptp_clock_freerun(ptp)) {  in ptp_clock_settime()
81 		pr_err("ptp: physical clock is free running\n");  in ptp_clock_settime()
85 	return  ptp->info->settime64(ptp->info, tp);  in ptp_clock_settime()
90 	struct ptp_clock *ptp = container_of(pc, struct ptp_clock, clock);  in ptp_clock_gettime()  local
93 	if (ptp->info->gettimex64)  in ptp_clock_gettime()
94 		err = ptp->info->gettimex64(ptp->info, tp, NULL);  in ptp_clock_gettime()
96 		err = ptp->info->gettime64(ptp->info, tp);  in ptp_clock_gettime()
102 	struct ptp_clock *ptp = container_of(pc, struct ptp_clock, clock);  in ptp_clock_adjtime()  local
106 	if (ptp_clock_freerun(ptp)) {  in ptp_clock_adjtime()
107 		pr_err("ptp: physical clock is free running\n");  in ptp_clock_adjtime()
111 	ops = ptp->info;  in ptp_clock_adjtime()
138 		ptp->dialed_frequency = tx->freq;  in ptp_clock_adjtime()
149 		tx->freq = ptp->dialed_frequency;  in ptp_clock_adjtime()
170 	struct ptp_clock *ptp = container_of(dev, struct ptp_clock, dev);  in ptp_clock_release()  local
172 	ptp_cleanup_pin_groups(ptp);  in ptp_clock_release()
173 	kfree(ptp->vclock_index);  in ptp_clock_release()
174 	mutex_destroy(&ptp->tsevq_mux);  in ptp_clock_release()
175 	mutex_destroy(&ptp->pincfg_mux);  in ptp_clock_release()
176 	mutex_destroy(&ptp->n_vclocks_mux);  in ptp_clock_release()
177 	ida_free(&ptp_clocks_map, ptp->index);  in ptp_clock_release()
178 	kfree(ptp);  in ptp_clock_release()
191 	struct ptp_clock *ptp = container_of(work, struct ptp_clock,  in ptp_aux_kworker()  local
193 	struct ptp_clock_info *info = ptp->info;  in ptp_aux_kworker()
199 		kthread_queue_delayed_work(ptp->kworker, &ptp->aux_work, delay);  in ptp_aux_kworker()
207 	struct ptp_clock *ptp;  in ptp_clock_register()  local
216 	ptp = kzalloc(sizeof(struct ptp_clock), GFP_KERNEL);  in ptp_clock_register()
217 	if (ptp == NULL)  in ptp_clock_register()
226 	ptp->clock.ops = ptp_clock_ops;  in ptp_clock_register()
227 	ptp->info = info;  in ptp_clock_register()
228 	ptp->devid = MKDEV(major, index);  in ptp_clock_register()
229 	ptp->index = index;  in ptp_clock_register()
230 	spin_lock_init(&ptp->tsevq.lock);  in ptp_clock_register()
231 	mutex_init(&ptp->tsevq_mux);  in ptp_clock_register()
232 	mutex_init(&ptp->pincfg_mux);  in ptp_clock_register()
233 	mutex_init(&ptp->n_vclocks_mux);  in ptp_clock_register()
234 	init_waitqueue_head(&ptp->tsev_wq);  in ptp_clock_register()
236 	if (ptp->info->getcycles64 || ptp->info->getcyclesx64) {  in ptp_clock_register()
237 		ptp->has_cycles = true;  in ptp_clock_register()
238 		if (!ptp->info->getcycles64 && ptp->info->getcyclesx64)  in ptp_clock_register()
239 			ptp->info->getcycles64 = ptp_getcycles64;  in ptp_clock_register()
242 		ptp->info->getcycles64 = ptp_getcycles64;  in ptp_clock_register()
244 		if (ptp->info->gettimex64)  in ptp_clock_register()
245 			ptp->info->getcyclesx64 = ptp->info->gettimex64;  in ptp_clock_register()
247 		if (ptp->info->getcrosststamp)  in ptp_clock_register()
248 			ptp->info->getcrosscycles = ptp->info->getcrosststamp;  in ptp_clock_register()
251 	if (ptp->info->do_aux_work) {  in ptp_clock_register()
252 		kthread_init_delayed_work(&ptp->aux_work, ptp_aux_kworker);  in ptp_clock_register()
253 		ptp->kworker = kthread_create_worker(0, "ptp%d", ptp->index);  in ptp_clock_register()
254 		if (IS_ERR(ptp->kworker)) {  in ptp_clock_register()
255 			err = PTR_ERR(ptp->kworker);  in ptp_clock_register()
256 			pr_err("failed to create ptp aux_worker %d\n", err);  in ptp_clock_register()
261 	/* PTP virtual clock is being registered under physical clock */  in ptp_clock_register()
263 	    strcmp(parent->class->name, "ptp") == 0)  in ptp_clock_register()
264 		ptp->is_virtual_clock = true;  in ptp_clock_register()
266 	if (!ptp->is_virtual_clock) {  in ptp_clock_register()
267 		ptp->max_vclocks = PTP_DEFAULT_MAX_VCLOCKS;  in ptp_clock_register()
269 		size = sizeof(int) * ptp->max_vclocks;  in ptp_clock_register()
270 		ptp->vclock_index = kzalloc(size, GFP_KERNEL);  in ptp_clock_register()
271 		if (!ptp->vclock_index) {  in ptp_clock_register()
277 	err = ptp_populate_pin_groups(ptp);  in ptp_clock_register()
285 		snprintf(pps.name, PPS_MAX_NAME_LEN, "ptp%d", index);  in ptp_clock_register()
288 		ptp->pps_source = pps_register_source(&pps, PTP_PPS_DEFAULTS);  in ptp_clock_register()
289 		if (IS_ERR(ptp->pps_source)) {  in ptp_clock_register()
290 			err = PTR_ERR(ptp->pps_source);  in ptp_clock_register()
294 		ptp->pps_source->lookup_cookie = ptp;  in ptp_clock_register()
298 	device_initialize(&ptp->dev);  in ptp_clock_register()
299 	ptp->dev.devt = ptp->devid;  in ptp_clock_register()
300 	ptp->dev.class = ptp_class;  in ptp_clock_register()
301 	ptp->dev.parent = parent;  in ptp_clock_register()
302 	ptp->dev.groups = ptp->pin_attr_groups;  in ptp_clock_register()
303 	ptp->dev.release = ptp_clock_release;  in ptp_clock_register()
304 	dev_set_drvdata(&ptp->dev, ptp);  in ptp_clock_register()
305 	dev_set_name(&ptp->dev, "ptp%d", ptp->index);  in ptp_clock_register()
308 	err = posix_clock_register(&ptp->clock, &ptp->dev);  in ptp_clock_register()
310 		if (ptp->pps_source)  in ptp_clock_register()
311 			pps_unregister_source(ptp->pps_source);  in ptp_clock_register()
313 		if (ptp->kworker)  in ptp_clock_register()
314 			kthread_destroy_worker(ptp->kworker);  in ptp_clock_register()
316 		put_device(&ptp->dev);  in ptp_clock_register()
322 	return ptp;  in ptp_clock_register()
325 	ptp_cleanup_pin_groups(ptp);  in ptp_clock_register()
327 	kfree(ptp->vclock_index);  in ptp_clock_register()
329 	if (ptp->kworker)  in ptp_clock_register()
330 		kthread_destroy_worker(ptp->kworker);  in ptp_clock_register()
332 	mutex_destroy(&ptp->tsevq_mux);  in ptp_clock_register()
333 	mutex_destroy(&ptp->pincfg_mux);  in ptp_clock_register()
334 	mutex_destroy(&ptp->n_vclocks_mux);  in ptp_clock_register()
337 	kfree(ptp);  in ptp_clock_register()
345 	struct ptp_clock *ptp = dev_get_drvdata(dev);  in unregister_vclock()  local
347 	ptp_vclock_unregister(info_to_vclock(ptp->info));  in unregister_vclock()
351 int ptp_clock_unregister(struct ptp_clock *ptp)  in ptp_clock_unregister()  argument
353 	if (ptp_vclock_in_use(ptp)) {  in ptp_clock_unregister()
354 		device_for_each_child(&ptp->dev, NULL, unregister_vclock);  in ptp_clock_unregister()
357 	ptp->defunct = 1;  in ptp_clock_unregister()
358 	wake_up_interruptible(&ptp->tsev_wq);  in ptp_clock_unregister()
360 	if (ptp->kworker) {  in ptp_clock_unregister()
361 		kthread_cancel_delayed_work_sync(&ptp->aux_work);  in ptp_clock_unregister()
362 		kthread_destroy_worker(ptp->kworker);  in ptp_clock_unregister()
366 	if (ptp->pps_source)  in ptp_clock_unregister()
367 		pps_unregister_source(ptp->pps_source);  in ptp_clock_unregister()
369 	posix_clock_unregister(&ptp->clock);  in ptp_clock_unregister()
375 void ptp_clock_event(struct ptp_clock *ptp, struct ptp_clock_event *event)  in ptp_clock_event()  argument
385 		enqueue_external_timestamp(&ptp->tsevq, event);  in ptp_clock_event()
386 		wake_up_interruptible(&ptp->tsev_wq);  in ptp_clock_event()
391 		pps_event(ptp->pps_source, &evt, PTP_PPS_EVENT, NULL);  in ptp_clock_event()
395 		pps_event(ptp->pps_source, &event->pps_times,  in ptp_clock_event()
402 int ptp_clock_index(struct ptp_clock *ptp)  in ptp_clock_index()  argument
404 	return ptp->index;  in ptp_clock_index()
408 int ptp_find_pin(struct ptp_clock *ptp,  in ptp_find_pin()  argument
414 	for (i = 0; i < ptp->info->n_pins; i++) {  in ptp_find_pin()
415 		if (ptp->info->pin_config[i].func == func &&  in ptp_find_pin()
416 		    ptp->info->pin_config[i].chan == chan) {  in ptp_find_pin()
417 			pin = &ptp->info->pin_config[i];  in ptp_find_pin()
426 int ptp_find_pin_unlocked(struct ptp_clock *ptp,  in ptp_find_pin_unlocked()  argument
431 	mutex_lock(&ptp->pincfg_mux);  in ptp_find_pin_unlocked()
433 	result = ptp_find_pin(ptp, func, chan);  in ptp_find_pin_unlocked()
435 	mutex_unlock(&ptp->pincfg_mux);  in ptp_find_pin_unlocked()
441 int ptp_schedule_worker(struct ptp_clock *ptp, unsigned long delay)  in ptp_schedule_worker()  argument
443 	return kthread_mod_delayed_work(ptp->kworker, &ptp->aux_work, delay);  in ptp_schedule_worker()
447 void ptp_cancel_worker_sync(struct ptp_clock *ptp)  in ptp_cancel_worker_sync()  argument
449 	kthread_cancel_delayed_work_sync(&ptp->aux_work);  in ptp_cancel_worker_sync()
466 	ptp_class = class_create(THIS_MODULE, "ptp");  in ptp_init()
468 		pr_err("ptp: failed to allocate class\n");  in ptp_init()
472 	err = alloc_chrdev_region(&ptp_devt, 0, MINORMASK + 1, "ptp");  in ptp_init()
474 		pr_err("ptp: failed to allocate device region\n");  in ptp_init()
479 	pr_info("PTP clock support registered\n");  in ptp_init()
491 MODULE_DESCRIPTION("PTP clocks support");