|
@@ -64,6 +64,43 @@ static int pps_cdev_fasync(int fd, struct file *file, int on)
|
|
|
return fasync_helper(fd, file, on, &pps->async_queue);
|
|
|
}
|
|
|
|
|
|
+static int pps_cdev_pps_fetch(struct pps_device *pps, struct pps_fdata *fdata)
|
|
|
+{
|
|
|
+ unsigned int ev = pps->last_ev;
|
|
|
+ int err = 0;
|
|
|
+
|
|
|
+ /* Manage the timeout */
|
|
|
+ if (fdata->timeout.flags & PPS_TIME_INVALID)
|
|
|
+ err = wait_event_interruptible(pps->queue,
|
|
|
+ ev != pps->last_ev);
|
|
|
+ else {
|
|
|
+ unsigned long ticks;
|
|
|
+
|
|
|
+ dev_dbg(pps->dev, "timeout %lld.%09d\n",
|
|
|
+ (long long) fdata->timeout.sec,
|
|
|
+ fdata->timeout.nsec);
|
|
|
+ ticks = fdata->timeout.sec * HZ;
|
|
|
+ ticks += fdata->timeout.nsec / (NSEC_PER_SEC / HZ);
|
|
|
+
|
|
|
+ if (ticks != 0) {
|
|
|
+ err = wait_event_interruptible_timeout(
|
|
|
+ pps->queue,
|
|
|
+ ev != pps->last_ev,
|
|
|
+ ticks);
|
|
|
+ if (err == 0)
|
|
|
+ return -ETIMEDOUT;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ /* Check for pending signals */
|
|
|
+ if (err == -ERESTARTSYS) {
|
|
|
+ dev_dbg(pps->dev, "pending signal caught\n");
|
|
|
+ return -EINTR;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
static long pps_cdev_ioctl(struct file *file,
|
|
|
unsigned int cmd, unsigned long arg)
|
|
|
{
|
|
@@ -144,7 +181,6 @@ static long pps_cdev_ioctl(struct file *file,
|
|
|
|
|
|
case PPS_FETCH: {
|
|
|
struct pps_fdata fdata;
|
|
|
- unsigned int ev;
|
|
|
|
|
|
dev_dbg(pps->dev, "PPS_FETCH\n");
|
|
|
|
|
@@ -152,36 +188,9 @@ static long pps_cdev_ioctl(struct file *file,
|
|
|
if (err)
|
|
|
return -EFAULT;
|
|
|
|
|
|
- ev = pps->last_ev;
|
|
|
-
|
|
|
- /* Manage the timeout */
|
|
|
- if (fdata.timeout.flags & PPS_TIME_INVALID)
|
|
|
- err = wait_event_interruptible(pps->queue,
|
|
|
- ev != pps->last_ev);
|
|
|
- else {
|
|
|
- unsigned long ticks;
|
|
|
-
|
|
|
- dev_dbg(pps->dev, "timeout %lld.%09d\n",
|
|
|
- (long long) fdata.timeout.sec,
|
|
|
- fdata.timeout.nsec);
|
|
|
- ticks = fdata.timeout.sec * HZ;
|
|
|
- ticks += fdata.timeout.nsec / (NSEC_PER_SEC / HZ);
|
|
|
-
|
|
|
- if (ticks != 0) {
|
|
|
- err = wait_event_interruptible_timeout(
|
|
|
- pps->queue,
|
|
|
- ev != pps->last_ev,
|
|
|
- ticks);
|
|
|
- if (err == 0)
|
|
|
- return -ETIMEDOUT;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- /* Check for pending signals */
|
|
|
- if (err == -ERESTARTSYS) {
|
|
|
- dev_dbg(pps->dev, "pending signal caught\n");
|
|
|
- return -EINTR;
|
|
|
- }
|
|
|
+ err = pps_cdev_pps_fetch(pps, &fdata);
|
|
|
+ if (err)
|
|
|
+ return err;
|
|
|
|
|
|
/* Return the fetched timestamp */
|
|
|
spin_lock_irq(&pps->lock);
|
|
@@ -246,8 +255,47 @@ static long pps_cdev_ioctl(struct file *file,
|
|
|
static long pps_cdev_compat_ioctl(struct file *file,
|
|
|
unsigned int cmd, unsigned long arg)
|
|
|
{
|
|
|
+ struct pps_device *pps = file->private_data;
|
|
|
+ void __user *uarg = (void __user *) arg;
|
|
|
+
|
|
|
cmd = _IOC(_IOC_DIR(cmd), _IOC_TYPE(cmd), _IOC_NR(cmd), sizeof(void *));
|
|
|
|
|
|
+ if (cmd == PPS_FETCH) {
|
|
|
+ struct pps_fdata_compat compat;
|
|
|
+ struct pps_fdata fdata;
|
|
|
+ int err;
|
|
|
+
|
|
|
+ dev_dbg(pps->dev, "PPS_FETCH\n");
|
|
|
+
|
|
|
+ err = copy_from_user(&compat, uarg, sizeof(struct pps_fdata_compat));
|
|
|
+ if (err)
|
|
|
+ return -EFAULT;
|
|
|
+
|
|
|
+ memcpy(&fdata.timeout, &compat.timeout,
|
|
|
+ sizeof(struct pps_ktime_compat));
|
|
|
+
|
|
|
+ err = pps_cdev_pps_fetch(pps, &fdata);
|
|
|
+ if (err)
|
|
|
+ return err;
|
|
|
+
|
|
|
+ /* Return the fetched timestamp */
|
|
|
+ spin_lock_irq(&pps->lock);
|
|
|
+
|
|
|
+ compat.info.assert_sequence = pps->assert_sequence;
|
|
|
+ compat.info.clear_sequence = pps->clear_sequence;
|
|
|
+ compat.info.current_mode = pps->current_mode;
|
|
|
+
|
|
|
+ memcpy(&compat.info.assert_tu, &pps->assert_tu,
|
|
|
+ sizeof(struct pps_ktime_compat));
|
|
|
+ memcpy(&compat.info.clear_tu, &pps->clear_tu,
|
|
|
+ sizeof(struct pps_ktime_compat));
|
|
|
+
|
|
|
+ spin_unlock_irq(&pps->lock);
|
|
|
+
|
|
|
+ return copy_to_user(uarg, &compat,
|
|
|
+ sizeof(struct pps_fdata_compat)) ? -EFAULT : 0;
|
|
|
+ }
|
|
|
+
|
|
|
return pps_cdev_ioctl(file, cmd, arg);
|
|
|
}
|
|
|
#else
|