From patchwork Tue Apr 27 09:14:25 2010 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Richard Cochran X-Patchwork-Id: 51040 X-Patchwork-Delegate: davem@davemloft.net Return-Path: X-Original-To: patchwork-incoming@ozlabs.org Delivered-To: patchwork-incoming@ozlabs.org Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by ozlabs.org (Postfix) with ESMTP id BFE08B7D67 for ; Tue, 27 Apr 2010 19:14:52 +1000 (EST) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1753111Ab0D0JOd (ORCPT ); Tue, 27 Apr 2010 05:14:33 -0400 Received: from mail-pz0-f204.google.com ([209.85.222.204]:44516 "EHLO mail-pz0-f204.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1752742Ab0D0JOc (ORCPT ); Tue, 27 Apr 2010 05:14:32 -0400 Received: by pzk42 with SMTP id 42so8674280pzk.4 for ; Tue, 27 Apr 2010 02:14:31 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=gamma; h=domainkey-signature:received:received:date:from:to:subject :message-id:mime-version:content-type:content-disposition:user-agent; bh=F33qzEetd7JK8uaC3IadvboAfOzVblDkj2ApwreqmkM=; b=mkz2sahxlrhi3jwXSmBKYzZjTIreisG3Fd+LKnHuY2PPfAURP8e655nd5h8snySsXo HmZp1HLDWtQR+5RuZsy4c6jQeOvbswGY8DAOvKsAMCQfv8y6VppHP0TnoxgWLfFbT8/F InfBBbgBEX6M7yrIRaHf1oejxco6idmXdqiXM= DomainKey-Signature: a=rsa-sha1; c=nofws; d=gmail.com; s=gamma; h=date:from:to:subject:message-id:mime-version:content-type :content-disposition:user-agent; b=iGdDQ5kDTiF5Tr6aeA0Ge2oz7K+hUaeXswVNzWOH9WiW8nRmRxrQzQuOjBOEa38BhI /4rwe6vqr4AewfmkI02J9cRIpZp7xudio1wRZEAZ670gF7fkcliBzsi3dzkUspJBL8SK TZC2LbDctn5MOhuz1PIZtGtkCKtuyhoV9tOS8= Received: by 10.141.4.17 with SMTP id g17mr1093688rvi.166.1272359671308; Tue, 27 Apr 2010 02:14:31 -0700 (PDT) Received: from riccoc20.at.omicron.at ([72.14.241.6]) by mx.google.com with ESMTPS id 21sm3399599ywh.10.2010.04.27.02.14.29 (version=TLSv1/SSLv3 cipher=RC4-MD5); Tue, 27 Apr 2010 02:14:30 -0700 (PDT) Date: Tue, 27 Apr 2010 11:14:25 +0200 From: Richard Cochran To: netdev@vger.kernel.org Subject: [PATCH 2/3] ptp: Added a clock that uses the Linux system time. Message-ID: <20100427091425.GA5110@riccoc20.at.omicron.at> MIME-Version: 1.0 Content-Disposition: inline User-Agent: Mutt/1.5.18 (2008-05-17) Sender: netdev-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: netdev@vger.kernel.org This PTP clock simply uses the NTP time adjustment system calls. The driver can be used in systems that lack a special hardware PTP clock. Signed-off-by: Richard Cochran --- drivers/ptp/Kconfig | 12 +++++ drivers/ptp/Makefile | 1 + drivers/ptp/ptp_linux.c | 119 +++++++++++++++++++++++++++++++++++++++++++++++ kernel/time/ntp.c | 2 + 4 files changed, 134 insertions(+), 0 deletions(-) create mode 100644 drivers/ptp/ptp_linux.c diff --git a/drivers/ptp/Kconfig b/drivers/ptp/Kconfig index 458d0fe..7113bef 100644 --- a/drivers/ptp/Kconfig +++ b/drivers/ptp/Kconfig @@ -23,4 +23,16 @@ config PTP_1588_CLOCK To compile this driver as a module, choose M here: the module will be called ptp_clock.ko. +config PTP_1588_CLOCK_LINUX + tristate "Linux system timer as PTP clock" + depends on PTP_1588_CLOCK + help + This driver adds support for using the standard Linux time + source as a PTP clock. This clock is only useful if your PTP + programs are using software time stamps for the PTP Ethernet + packets. + + To compile this driver as a module, choose M here: the module + will be called ptp_linux.ko. + endmenu diff --git a/drivers/ptp/Makefile b/drivers/ptp/Makefile index b86695c..1651d52 100644 --- a/drivers/ptp/Makefile +++ b/drivers/ptp/Makefile @@ -3,3 +3,4 @@ # obj-$(CONFIG_PTP_1588_CLOCK) += ptp_clock.o +obj-$(CONFIG_PTP_1588_CLOCK_LINUX) += ptp_linux.o diff --git a/drivers/ptp/ptp_linux.c b/drivers/ptp/ptp_linux.c new file mode 100644 index 0000000..0eaa6c3 --- /dev/null +++ b/drivers/ptp/ptp_linux.c @@ -0,0 +1,119 @@ +/* + * PTP 1588 clock using the Linux system clock + * + * Copyright (C) 2010 OMICRON electronics GmbH + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. + */ +#include +#include +#include +#include +#include +#include + +#include + +DEFINE_SPINLOCK(adjtime_lock); + +static int ptp_linux_adjfreq(void *priv, s32 delta) +{ + struct timex txc; + s64 tmp = delta; + int err; + txc.freq = div_s64(tmp<<16, 1000); + txc.modes = ADJ_FREQUENCY; + err = do_adjtimex(&txc); + return err < 0 ? err : 0; +} + +static int ptp_linux_adjtime(void *priv, struct timespec *ts) +{ + s64 delta; + ktime_t now; + struct timespec t2; + unsigned long flags; + int err; + + delta = 1000000000LL * ts->tv_sec + ts->tv_nsec; + + spin_lock_irqsave(&adjtime_lock, flags); + + now = ktime_get_real(); + + now = delta < 0 ? ktime_sub_ns(now,-delta) : ktime_add_ns(now,delta); + + t2 = ktime_to_timespec(now); + + err = do_settimeofday(&t2); + + spin_unlock_irqrestore(&adjtime_lock, flags); + + return err; +} + +static int ptp_linux_gettime(void *priv, struct timespec *ts) +{ + getnstimeofday(ts); + return 0; +} + +static int ptp_linux_settime(void *priv, struct timespec *ts) +{ + return do_settimeofday(ts); +} + +static int ptp_linux_enable(void *priv, struct ptp_clock_request rq, int on) +{ + /* We do not offer any ancillary features at all. */ + return -EINVAL; +} + +struct ptp_clock_info ptp_linux_caps = { + .owner = THIS_MODULE, + .name = "Linux timer", + .max_adj = 512000, + .n_alarm = 0, + .n_ext_ts = 0, + .n_per_out = 0, + .pps = 0, + .priv = NULL, + .adjfreq = ptp_linux_adjfreq, + .adjtime = ptp_linux_adjtime, + .gettime = ptp_linux_gettime, + .settime = ptp_linux_settime, + .enable = ptp_linux_enable, +}; + +/* module operations */ + +static void __exit ptp_linux_exit(void) +{ + ptp_clock_unregister(&ptp_linux_caps); +} + +static int __init ptp_linux_init(void) +{ + int err; + err = ptp_clock_register(&ptp_linux_caps); + return err; +} + +subsys_initcall(ptp_linux_init); +module_exit(ptp_linux_exit); + +MODULE_AUTHOR("Richard Cochran "); +MODULE_DESCRIPTION("PTP clock using the Linux system timer"); +MODULE_LICENSE("GPL"); diff --git a/kernel/time/ntp.c b/kernel/time/ntp.c index 7c0f180..efd1ff8 100644 --- a/kernel/time/ntp.c +++ b/kernel/time/ntp.c @@ -14,6 +14,7 @@ #include #include #include +#include /* * NTP timekeeping variables: @@ -535,6 +536,7 @@ int do_adjtimex(struct timex *txc) return result; } +EXPORT_SYMBOL(do_adjtimex); static int __init ntp_tick_adj_setup(char *str) {