wr_nic: pps.c copied from wr-switch version 3.0

a62c8a8b · Alessandro Rubini · 62634130 · a62c8a8b
Commit a62c8a8b authored Sep 21, 2012 by Alessandro Rubini
Hide whitespace changes
Inline Side-by-side

Showing with 31 additions and 0 deletions

pps.c kernel/wr_nic/pps.c +31 -0

No files found.
--- a/kernel/wr_nic/pps.c
+++ b/kernel/wr_nic/pps.c
+/*
+ * Pulse per second management for White-Rabbit switch network interface
+ *
+ * Copyright (C) 2010 CERN (www.cern.ch)
+ * Author: Tomasz Wlostowski <tomasz.wlostowski@cern.ch>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+#include <linux/kernel.h>
+#include <linux/netdevice.h>
+#include <linux/sockios.h>
+#include <linux/net_tstamp.h>
+
+#include "wr-nic.h"
+
+void wrn_ppsg_read_time(struct wrn_dev *wrn, u32 *fine_counter, u32 *utc)
+{
+	u32 utc1, utc2, cnt;
+
+	utc1 = readl(&wrn->ppsg_regs->CNTR_UTCLO);
+	cnt = readl(&wrn->ppsg_regs->CNTR_NSEC);
+	utc2 = readl(&wrn->ppsg_regs->CNTR_UTCLO);
+
+	if (utc2 != utc1)
+		cnt = readl(&wrn->ppsg_regs->CNTR_NSEC);
+
+	*utc = utc2;
+	*fine_counter = cnt;
+}