diff --git a/drivers/ptp/ptp_chardev.c b/drivers/ptp/ptp_chardev.c index 282cd7d24077..7a8a6b8a91f9 100644 --- a/drivers/ptp/ptp_chardev.c +++ b/drivers/ptp/ptp_chardev.c @@ -121,6 +121,7 @@ int ptp_open(struct posix_clock_context *pccontext, fmode_t fmode) spin_lock_init(&queue->lock); list_add_tail(&queue->qlist, &ptp->tsevqs); pccontext->private_clkdata = queue; + printk("%p, %p, %s\n", queue, &queue->qlist, __func__); /* Debugfs contents */ sprintf(debugfsname, "0x%p", queue); @@ -140,9 +141,11 @@ int ptp_release(struct posix_clock_context *pccontext) struct timestamp_event_queue *queue = pccontext->private_clkdata; unsigned long flags; - if (queue) { + pccontext->private_clkdata = NULL; + if (!IS_ERR_OR_NULL(queue)) { + struct list_head *ql = &queue->qlist; debugfs_remove(queue->debugfs_instance); - pccontext->private_clkdata = NULL; + printk("%p, %p, %p, %s\n", queue, ql, ql->prev, __func__); spin_lock_irqsave(&queue->lock, flags); list_del(&queue->qlist); spin_unlock_irqrestore(&queue->lock, flags); @@ -544,9 +547,13 @@ ssize_t ptp_read(struct posix_clock_context *pccontext, uint rdflags, cnt = cnt / sizeof(struct ptp_extts_event); + if (mutex_lock_interruptible(&ptp->tsevq_mux)) + return -ERESTARTSYS; + if (wait_event_interruptible(ptp->tsev_wq, ptp->defunct || queue_cnt(queue))) { - return -ERESTARTSYS; + result = -ERESTARTSYS; + goto exit; } if (ptp->defunct) { @@ -585,7 +592,6 @@ ssize_t ptp_read(struct posix_clock_context *pccontext, uint rdflags, free_event: kfree(event); exit: - if (result < 0) - ptp_release(pccontext); + mutex_unlock(&ptp->tsevq_mux); return result; } diff --git a/drivers/ptp/ptp_clock.c b/drivers/ptp/ptp_clock.c index 3d1b0a97301c..7930db6ec18d 100644 --- a/drivers/ptp/ptp_clock.c +++ b/drivers/ptp/ptp_clock.c @@ -176,6 +176,7 @@ static void ptp_clock_release(struct device *dev) ptp_cleanup_pin_groups(ptp); kfree(ptp->vclock_index); + mutex_destroy(&ptp->tsevq_mux); mutex_destroy(&ptp->pincfg_mux); mutex_destroy(&ptp->n_vclocks_mux); /* Delete first entry */ @@ -247,6 +248,7 @@ struct ptp_clock *ptp_clock_register(struct ptp_clock_info *info, if (!queue) goto no_memory_queue; list_add_tail(&queue->qlist, &ptp->tsevqs); + mutex_init(&ptp->tsevq_mux); queue->mask = bitmap_alloc(PTP_MAX_CHANNELS, GFP_KERNEL); if (!queue->mask) goto no_memory_bitmap; @@ -356,6 +358,7 @@ struct ptp_clock *ptp_clock_register(struct ptp_clock_info *info, if (ptp->kworker) kthread_destroy_worker(ptp->kworker); kworker_err: + mutex_destroy(&ptp->tsevq_mux); mutex_destroy(&ptp->pincfg_mux); mutex_destroy(&ptp->n_vclocks_mux); bitmap_free(queue->mask); diff --git a/drivers/ptp/ptp_private.h b/drivers/ptp/ptp_private.h index 52f87e394aa6..1525bd2059ba 100644 --- a/drivers/ptp/ptp_private.h +++ b/drivers/ptp/ptp_private.h @@ -44,6 +44,7 @@ struct ptp_clock { struct pps_device *pps_source; long dialed_frequency; /* remembers the frequency adjustment */ struct list_head tsevqs; /* timestamp fifo list */ + struct mutex tsevq_mux; /* one process at a time reading the fifo */ struct mutex pincfg_mux; /* protect concurrent info->pin_config access */ wait_queue_head_t tsev_wq; int defunct; /* tells readers to go away when clock is being removed */