Lines Matching full:ptp
3 * PTP 1588 clock support
80 struct ptp_clock *ptp = container_of(pc, struct ptp_clock, clock); in ptp_clock_settime() local
82 if (ptp_clock_freerun(ptp)) { in ptp_clock_settime()
83 pr_err("ptp: physical clock is free running\n"); in ptp_clock_settime()
87 return ptp->info->settime64(ptp->info, tp); in ptp_clock_settime()
92 struct ptp_clock *ptp = container_of(pc, struct ptp_clock, clock); in ptp_clock_gettime() local
95 if (ptp->info->gettimex64) in ptp_clock_gettime()
96 err = ptp->info->gettimex64(ptp->info, tp, NULL); in ptp_clock_gettime()
98 err = ptp->info->gettime64(ptp->info, tp); in ptp_clock_gettime()
104 struct ptp_clock *ptp = container_of(pc, struct ptp_clock, clock); in ptp_clock_adjtime() local
108 if (ptp_clock_freerun(ptp)) { in ptp_clock_adjtime()
109 pr_err("ptp: physical clock is free running\n"); in ptp_clock_adjtime()
113 ops = ptp->info; in ptp_clock_adjtime()
137 ptp->dialed_frequency = tx->freq; in ptp_clock_adjtime()
152 tx->freq = ptp->dialed_frequency; in ptp_clock_adjtime()
174 struct ptp_clock *ptp = container_of(dev, struct ptp_clock, dev); in ptp_clock_release() local
178 ptp_cleanup_pin_groups(ptp); in ptp_clock_release()
179 kfree(ptp->vclock_index); in ptp_clock_release()
180 mutex_destroy(&ptp->pincfg_mux); in ptp_clock_release()
181 mutex_destroy(&ptp->n_vclocks_mux); in ptp_clock_release()
183 spin_lock_irqsave(&ptp->tsevqs_lock, flags); in ptp_clock_release()
184 tsevq = list_first_entry(&ptp->tsevqs, struct timestamp_event_queue, in ptp_clock_release()
187 spin_unlock_irqrestore(&ptp->tsevqs_lock, flags); in ptp_clock_release()
190 debugfs_remove(ptp->debugfs_root); in ptp_clock_release()
191 ida_free(&ptp_clocks_map, ptp->index); in ptp_clock_release()
192 kfree(ptp); in ptp_clock_release()
205 struct ptp_clock *ptp = container_of(work, struct ptp_clock, in ptp_aux_kworker() local
207 struct ptp_clock_info *info = ptp->info; in ptp_aux_kworker()
213 kthread_queue_delayed_work(ptp->kworker, &ptp->aux_work, delay); in ptp_aux_kworker()
221 struct ptp_clock *ptp; in ptp_clock_register() local
232 ptp = kzalloc(sizeof(struct ptp_clock), GFP_KERNEL); in ptp_clock_register()
233 if (ptp == NULL) in ptp_clock_register()
242 ptp->clock.ops = ptp_clock_ops; in ptp_clock_register()
243 ptp->info = info; in ptp_clock_register()
244 ptp->devid = MKDEV(major, index); in ptp_clock_register()
245 ptp->index = index; in ptp_clock_register()
246 INIT_LIST_HEAD(&ptp->tsevqs); in ptp_clock_register()
250 list_add_tail(&queue->qlist, &ptp->tsevqs); in ptp_clock_register()
251 spin_lock_init(&ptp->tsevqs_lock); in ptp_clock_register()
257 mutex_init(&ptp->pincfg_mux); in ptp_clock_register()
258 mutex_init(&ptp->n_vclocks_mux); in ptp_clock_register()
259 init_waitqueue_head(&ptp->tsev_wq); in ptp_clock_register()
261 if (ptp->info->getcycles64 || ptp->info->getcyclesx64) { in ptp_clock_register()
262 ptp->has_cycles = true; in ptp_clock_register()
263 if (!ptp->info->getcycles64 && ptp->info->getcyclesx64) in ptp_clock_register()
264 ptp->info->getcycles64 = ptp_getcycles64; in ptp_clock_register()
267 ptp->info->getcycles64 = ptp_getcycles64; in ptp_clock_register()
269 if (ptp->info->gettimex64) in ptp_clock_register()
270 ptp->info->getcyclesx64 = ptp->info->gettimex64; in ptp_clock_register()
272 if (ptp->info->getcrosststamp) in ptp_clock_register()
273 ptp->info->getcrosscycles = ptp->info->getcrosststamp; in ptp_clock_register()
276 if (ptp->info->do_aux_work) { in ptp_clock_register()
277 kthread_init_delayed_work(&ptp->aux_work, ptp_aux_kworker); in ptp_clock_register()
278 ptp->kworker = kthread_create_worker(0, "ptp%d", ptp->index); in ptp_clock_register()
279 if (IS_ERR(ptp->kworker)) { in ptp_clock_register()
280 err = PTR_ERR(ptp->kworker); in ptp_clock_register()
281 pr_err("failed to create ptp aux_worker %d\n", err); in ptp_clock_register()
286 /* PTP virtual clock is being registered under physical clock */ in ptp_clock_register()
288 strcmp(parent->class->name, "ptp") == 0) in ptp_clock_register()
289 ptp->is_virtual_clock = true; in ptp_clock_register()
291 if (!ptp->is_virtual_clock) { in ptp_clock_register()
292 ptp->max_vclocks = PTP_DEFAULT_MAX_VCLOCKS; in ptp_clock_register()
294 size = sizeof(int) * ptp->max_vclocks; in ptp_clock_register()
295 ptp->vclock_index = kzalloc(size, GFP_KERNEL); in ptp_clock_register()
296 if (!ptp->vclock_index) { in ptp_clock_register()
302 err = ptp_populate_pin_groups(ptp); in ptp_clock_register()
310 snprintf(pps.name, PPS_MAX_NAME_LEN, "ptp%d", index); in ptp_clock_register()
313 ptp->pps_source = pps_register_source(&pps, PTP_PPS_DEFAULTS); in ptp_clock_register()
314 if (IS_ERR(ptp->pps_source)) { in ptp_clock_register()
315 err = PTR_ERR(ptp->pps_source); in ptp_clock_register()
319 ptp->pps_source->lookup_cookie = ptp; in ptp_clock_register()
323 device_initialize(&ptp->dev); in ptp_clock_register()
324 ptp->dev.devt = ptp->devid; in ptp_clock_register()
325 ptp->dev.class = ptp_class; in ptp_clock_register()
326 ptp->dev.parent = parent; in ptp_clock_register()
327 ptp->dev.groups = ptp->pin_attr_groups; in ptp_clock_register()
328 ptp->dev.release = ptp_clock_release; in ptp_clock_register()
329 dev_set_drvdata(&ptp->dev, ptp); in ptp_clock_register()
330 dev_set_name(&ptp->dev, "ptp%d", ptp->index); in ptp_clock_register()
333 err = posix_clock_register(&ptp->clock, &ptp->dev); in ptp_clock_register()
335 if (ptp->pps_source) in ptp_clock_register()
336 pps_unregister_source(ptp->pps_source); in ptp_clock_register()
338 if (ptp->kworker) in ptp_clock_register()
339 kthread_destroy_worker(ptp->kworker); in ptp_clock_register()
341 put_device(&ptp->dev); in ptp_clock_register()
348 snprintf(debugfsname, sizeof(debugfsname), "ptp%d", ptp->index); in ptp_clock_register()
349 ptp->debugfs_root = debugfs_create_dir(debugfsname, NULL); in ptp_clock_register()
351 return ptp; in ptp_clock_register()
354 ptp_cleanup_pin_groups(ptp); in ptp_clock_register()
356 kfree(ptp->vclock_index); in ptp_clock_register()
358 if (ptp->kworker) in ptp_clock_register()
359 kthread_destroy_worker(ptp->kworker); in ptp_clock_register()
361 mutex_destroy(&ptp->pincfg_mux); in ptp_clock_register()
362 mutex_destroy(&ptp->n_vclocks_mux); in ptp_clock_register()
370 kfree(ptp); in ptp_clock_register()
378 struct ptp_clock *ptp = dev_get_drvdata(dev); in unregister_vclock() local
380 ptp_vclock_unregister(info_to_vclock(ptp->info)); in unregister_vclock()
384 int ptp_clock_unregister(struct ptp_clock *ptp) in ptp_clock_unregister() argument
386 if (ptp_vclock_in_use(ptp)) { in ptp_clock_unregister()
387 device_for_each_child(&ptp->dev, NULL, unregister_vclock); in ptp_clock_unregister()
390 ptp->defunct = 1; in ptp_clock_unregister()
391 wake_up_interruptible(&ptp->tsev_wq); in ptp_clock_unregister()
393 if (ptp->kworker) { in ptp_clock_unregister()
394 kthread_cancel_delayed_work_sync(&ptp->aux_work); in ptp_clock_unregister()
395 kthread_destroy_worker(ptp->kworker); in ptp_clock_unregister()
399 if (ptp->pps_source) in ptp_clock_unregister()
400 pps_unregister_source(ptp->pps_source); in ptp_clock_unregister()
402 posix_clock_unregister(&ptp->clock); in ptp_clock_unregister()
408 void ptp_clock_event(struct ptp_clock *ptp, struct ptp_clock_event *event) in ptp_clock_event() argument
421 spin_lock_irqsave(&ptp->tsevqs_lock, flags); in ptp_clock_event()
422 list_for_each_entry(tsevq, &ptp->tsevqs, qlist) { in ptp_clock_event()
426 spin_unlock_irqrestore(&ptp->tsevqs_lock, flags); in ptp_clock_event()
427 wake_up_interruptible(&ptp->tsev_wq); in ptp_clock_event()
432 pps_event(ptp->pps_source, &evt, PTP_PPS_EVENT, NULL); in ptp_clock_event()
436 pps_event(ptp->pps_source, &event->pps_times, in ptp_clock_event()
443 int ptp_clock_index(struct ptp_clock *ptp) in ptp_clock_index() argument
445 return ptp->index; in ptp_clock_index()
449 int ptp_find_pin(struct ptp_clock *ptp, in ptp_find_pin() argument
455 for (i = 0; i < ptp->info->n_pins; i++) { in ptp_find_pin()
456 if (ptp->info->pin_config[i].func == func && in ptp_find_pin()
457 ptp->info->pin_config[i].chan == chan) { in ptp_find_pin()
458 pin = &ptp->info->pin_config[i]; in ptp_find_pin()
467 int ptp_find_pin_unlocked(struct ptp_clock *ptp, in ptp_find_pin_unlocked() argument
472 mutex_lock(&ptp->pincfg_mux); in ptp_find_pin_unlocked()
474 result = ptp_find_pin(ptp, func, chan); in ptp_find_pin_unlocked()
476 mutex_unlock(&ptp->pincfg_mux); in ptp_find_pin_unlocked()
482 int ptp_schedule_worker(struct ptp_clock *ptp, unsigned long delay) in ptp_schedule_worker() argument
484 return kthread_mod_delayed_work(ptp->kworker, &ptp->aux_work, delay); in ptp_schedule_worker()
488 void ptp_cancel_worker_sync(struct ptp_clock *ptp) in ptp_cancel_worker_sync() argument
490 kthread_cancel_delayed_work_sync(&ptp->aux_work); in ptp_cancel_worker_sync()
507 ptp_class = class_create("ptp"); in ptp_init()
509 pr_err("ptp: failed to allocate class\n"); in ptp_init()
513 err = alloc_chrdev_region(&ptp_devt, 0, MINORMASK + 1, "ptp"); in ptp_init()
515 pr_err("ptp: failed to allocate device region\n"); in ptp_init()
520 pr_info("PTP clock support registered\n"); in ptp_init()
532 MODULE_DESCRIPTION("PTP clocks support");