[zaptel-commits] trunk r1158 - in /trunk: ztdummy.c ztdummy.h

zaptel-commits at lists.digium.com zaptel-commits at lists.digium.com
Thu Jun 22 13:43:49 MST 2006


Author: tilghman
Date: Thu Jun 22 15:43:49 2006
New Revision: 1158

URL: http://svn.digium.com/view/zaptel?rev=1158&view=rev
Log:
Bug 6631 - Implement PLL-based technique for RTC-based ztdummy to minimize jitter (pcadach and softins)

Modified:
    trunk/ztdummy.c
    trunk/ztdummy.h

Modified: trunk/ztdummy.c
URL: http://svn.digium.com/view/zaptel/trunk/ztdummy.c?rev=1158&r1=1157&r2=1158&view=diff
==============================================================================
--- trunk/ztdummy.c (original)
+++ trunk/ztdummy.c Thu Jun 22 15:43:49 2006
@@ -78,30 +78,23 @@
 #include "ztdummy.h"
 
 
-#ifndef LINUX_VERSION_CODE
-#  include <linux/version.h>
-#endif
-
-#ifndef VERSION_CODE
-#  define VERSION_CODE(vers,rel,seq) ( ((vers)<<16) | ((rel)<<8) | (seq) )
-#endif
-
-
-#if LINUX_VERSION_CODE < VERSION_CODE(2,4,5)
-#  error "This kernel is too old: not supported by this file"
-#endif
-
 static struct ztdummy *ztd;
 
 static int debug = 0;
 
-#ifdef LINUX26
+#if defined(LINUX26) && defined(USE_RTC)
+static int rtc_rate = 0;
+static int current_rate = 0;
+static int taskletpending = 0;
+static struct tasklet_struct ztd_tlet;
+static void ztd_tasklet(unsigned long data);
+#endif
+
+#ifdef LINUX26
+#define ZAPTEL_RATE 1000
 #ifndef USE_RTC
 /* New 2.6 kernel timer stuff */
 static struct timer_list timer;
-#if HZ != 1000
-#warning This module will not be usable since the kernel HZ setting is not 1000 ticks per second.
-#endif
 #endif
 #else
 #if LINUX_VERSION_CODE < VERSION_CODE(2,4,5)
@@ -128,50 +121,77 @@
 
 #ifdef LINUX26
 #ifdef USE_RTC
+static void update_rtc_rate(struct ztdummy *ztd)
+{
+	if (((rtc_rate & (rtc_rate - 1)) != 0) || (rtc_rate > 8192) || (rtc_rate < 2)) {
+		printk("Invalid RTC rate %d specified\n", rtc_rate);
+		rtc_rate = current_rate;	/* Set default RTC rate */
+	}
+	if (!rtc_rate || (rtc_rate != current_rate)) {
+		rtc_control(&ztd->rtc_task, RTC_IRQP_SET, current_rate = (rtc_rate ? rtc_rate : 1024));	/* 1024 Hz */
+		printk("ztdummy: RTC rate is %d\n", rtc_rate);
+		ztd->counter = 0;
+	}
+}
+
+static void ztd_tasklet(unsigned long data)
+{
+	if (taskletpending)
+		update_rtc_rate((struct ztdummy *)ztd);
+	taskletpending = 0;
+}
+
 /* rtc_interrupt - called at 1024Hz from hook in RTC handler */
 static void ztdummy_rtc_interrupt(void *private_data)
 {
 	struct ztdummy *ztd = private_data;
-	unsigned int ticks;
-
-	atomic_inc(&ztd->ticks);
-	ticks = atomic_read(&ztd->ticks);
-	if (ticks == 42 || ticks == 85) {
-		/* skip it */
-	} else if (ticks >= 128) {
-		/* skip and restart count */
-		atomic_set(&ztd->ticks, 0);
-	} else {
-		/* zaptel timing - called in 125 of every 128 interrupts = 1000Hz */
+	unsigned long flags;
+
+	/* Is spinlock required here??? */
+	spin_lock_irqsave(&ztd->rtclock, flags);
+	ztd->counter += ZAPTEL_RATE;
+	while (ztd->counter >= current_rate) {
+		ztd->counter -= current_rate;
+		/* Update of RTC IRQ rate isn't possible from interrupt handler :( */
+		if (!taskletpending && (current_rate != rtc_rate)) {
+			taskletpending = 1;
+			tasklet_hi_schedule(&ztd_tlet);
+		}
 		zt_receive(&ztd->span);
 		zt_transmit(&ztd->span);
 	}
+	spin_unlock_irqrestore(&ztd->rtclock, flags);
 }
 #else
 /* use kernel system tick timer if PC architecture RTC is not available */
 static void ztdummy_timer(unsigned long param)
 {
-    zt_receive(&ztd->span);
-    zt_transmit(&ztd->span);
-    timer.expires = jiffies + 1;
-    add_timer(&timer);
+	timer.expires = jiffies + 1;
+	add_timer(&timer);
+
+	ztd->counter += ZAPTEL_RATE;
+	while (ztd->counter >= HZ) {
+		ztd->counter -= HZ;
+		zt_receive(&ztd->span);
+		zt_transmit(&ztd->span);
+	}
 }
 #endif
 #else
 static void ztdummy_interrupt(int irq, void *dev_id, struct pt_regs *regs)
 {
-    unsigned short status;
-    unsigned int io_addr = s->io_addr;
-
-    status = inw (io_addr + USBSTS);
-    if (status != 0)  {	/* interrupt from our USB port */
-        zt_receive(&ztd->span);
-        zt_transmit(&ztd->span);
-        if (monitor && (check_int==0)) {      /* for testing if interrupt gets triggered*/
-            check_int = 1;
-            printk("ztdummy: interrupt triggered \n");     
-        }   
-     }
+	unsigned short status;
+	unsigned int io_addr = s->io_addr;
+
+	status = inw (io_addr + USBSTS);
+	if (status != 0)  {	/* interrupt from our USB port */
+		zt_receive(&ztd->span);
+		zt_transmit(&ztd->span);
+		if (monitor && (check_int==0)) {      /* for testing if interrupt gets triggered*/
+			check_int = 1;
+			printk("ztdummy: interrupt triggered \n");     
+		}   
+	}
 	return;
 }
 #endif
@@ -199,92 +219,91 @@
 {
 #ifdef LINUX26
 #ifdef USE_RTC
-    int err;
-#endif
-#else
-    int irq;
+	int err;
+#endif
+#else
+	int irq;
 #ifdef DEFINE_SPINLOCK
-    DEFINE_SPINLOCK(mylock);
-#else
-    spinlock_t mylock = SPIN_LOCK_UNLOCKED;
+	DEFINE_SPINLOCK(mylock);
+#else
+	spinlock_t mylock = SPIN_LOCK_UNLOCKED;
 #endif
 	
-    if (uhci_devices==NULL){
-        printk ("ztdummy: Uhci_devices pointer error.\n");
-	    return -ENODEV;
-    }
-    s=*uhci_devices;     /* uhci device */
-    if (s==NULL){
-        printk ("ztdummy: No uhci_device found.\n");
-	    return -ENODEV;
-    }
-#endif
-
-#if defined(LINUX26) && !defined(USE_RTC)
-    if (HZ != 1000) {
-	    printk("ztdummy: This module requires the kernel HZ setting to be 1000 ticks per second\n");
-	    return -ENODEV;
-    }
-#endif /* defined(LINUX26) && !defined(USE_RTC) */
-
-    ztd = kmalloc(sizeof(struct ztdummy), GFP_KERNEL);
-    if (ztd == NULL) {
-	    printk("ztdummy: Unable to allocate memory\n");
-	    return -ENOMEM;
-    }
-
-    memset(ztd, 0x0, sizeof(struct ztdummy));
-
-    if (ztdummy_initialize(ztd)) {
-	printk("ztdummy: Unable to intialize zaptel driver\n");
-	kfree(ztd);
-	return -ENODEV;
-    }
-
-#ifdef LINUX26
-#ifdef USE_RTC
-    atomic_set(&ztd->ticks, 0);
-    ztd->rtc_task.func = ztdummy_rtc_interrupt;
-    ztd->rtc_task.private_data = ztd;
-    err = rtc_register(&ztd->rtc_task);
-    if (err < 0) {
-	printk("ztdummy: Unable to register zaptel rtc driver\n");
-        zt_unregister(&ztd->span);
-	kfree(ztd);
-	return err;
-    }
-    rtc_control(&ztd->rtc_task, RTC_IRQP_SET, 1024);	/* 1024 Hz */
-    rtc_control(&ztd->rtc_task, RTC_PIE_ON, 0);
-#else
-    init_timer(&timer);
-    timer.function = ztdummy_timer;
-    timer.expires = jiffies + 1;
-    add_timer(&timer);
-#endif
-#else
-    irq=s->irq;
-    spin_lock_irq(&mylock);
-    free_irq(s->irq, s);	/* remove uhci_interrupt temporaly */
-    if (request_irq (irq, ztdummy_interrupt, SA_SHIRQ, "ztdummy", ztd)) {
-    	spin_unlock_irq(&mylock);
+	if (uhci_devices==NULL) {
+		printk ("ztdummy: Uhci_devices pointer error.\n");
+		return -ENODEV;
+	}
+	s=*uhci_devices;	/* uhci device */
+	if (s==NULL) {
+		printk ("ztdummy: No uhci_device found.\n");
+		return -ENODEV;
+	}
+#endif
+
+	ztd = kmalloc(sizeof(struct ztdummy), GFP_KERNEL);
+	if (ztd == NULL) {
+		printk("ztdummy: Unable to allocate memory\n");
+		return -ENOMEM;
+	}
+
+	memset(ztd, 0x0, sizeof(struct ztdummy));
+
+	if (ztdummy_initialize(ztd)) {
+		printk("ztdummy: Unable to intialize zaptel driver\n");
+		kfree(ztd);
+		return -ENODEV;
+	}
+
+#ifdef LINUX26
+	ztd->counter = 0;
+#ifdef USE_RTC
+	ztd->rtclock = SPIN_LOCK_UNLOCKED;
+	ztd->rtc_task.func = ztdummy_rtc_interrupt;
+	ztd->rtc_task.private_data = ztd;
+	err = rtc_register(&ztd->rtc_task);
+	if (err < 0) {
+		printk("ztdummy: Unable to register zaptel rtc driver\n");
+		zt_unregister(&ztd->span);
+		kfree(ztd);
+		return err;
+	}
+	/* Set default RTC interrupt rate to 1024Hz */
+	if (!rtc_rate)
+		rtc_rate = 1024;
+	update_rtc_rate(ztd);
+	rtc_control(&ztd->rtc_task, RTC_PIE_ON, 0);
+	tasklet_init(&ztd_tlet, ztd_tasklet, 0);
+#else
+	init_timer(&timer);
+	timer.function = ztdummy_timer;
+	timer.expires = jiffies + 1;
+	add_timer(&timer);
+#endif
+#else
+	irq=s->irq;
+	spin_lock_irq(&mylock);
+	free_irq(s->irq, s);	/* remove uhci_interrupt temporaly */
+	if (request_irq (irq, ztdummy_interrupt, SA_SHIRQ, "ztdummy", ztd)) {
+		spin_unlock_irq(&mylock);
 		err("Our request_irq %d failed!",irq);
 		kfree(ztd);
 		return -EIO;
-    }		/* we add our handler first, to assure, that our handler gets called first */
-    if (request_irq (irq, uhci_interrupt, SA_SHIRQ, s->uhci_pci->driver->name, s)) {
-        spin_unlock_irq(&mylock);
+	}		/* we add our handler first, to assure, that our handler gets called first */
+	if (request_irq (irq, uhci_interrupt, SA_SHIRQ, s->uhci_pci->driver->name, s)) {
+		spin_unlock_irq(&mylock);
 		err("Original request_irq %d failed!",irq);
-    }
-    spin_unlock_irq(&mylock);
-    /* add td to usb host controller interrupt queue */
-    alloc_td(s, &td, 0);
-    fill_td(td, TD_CTRL_IOC, 0, 0);
-    insert_td_horizontal(s, s->int_chain[0], td);	/* use int_chain[0] to get 1ms interrupts */
+	}
+	spin_unlock_irq(&mylock);
+
+	/* add td to usb host controller interrupt queue */
+	alloc_td(s, &td, 0);
+	fill_td(td, TD_CTRL_IOC, 0, 0);
+	insert_td_horizontal(s, s->int_chain[0], td);	/* use int_chain[0] to get 1ms interrupts */
 #endif	
 
-    if (debug)
-        printk("ztdummy: init() finished\n");
-    return 0;
+	if (debug)
+		printk("ztdummy: init() finished\n");
+	return 0;
 }
 
 
@@ -292,28 +311,35 @@
 {
 #ifdef LINUX26
 #ifdef USE_RTC
-    rtc_control(&ztd->rtc_task, RTC_PIE_OFF, 0);
-    rtc_unregister(&ztd->rtc_task);
-#else
-    del_timer(&timer);
-#endif
-#else
-    free_irq(s->irq, ztd);  /* disable interrupts */
-#endif
-    zt_unregister(&ztd->span);
-    kfree(ztd);
+	if (taskletpending) {
+		tasklet_disable(&ztd_tlet);
+		tasklet_kill(&ztd_tlet);
+	}
+	rtc_control(&ztd->rtc_task, RTC_PIE_OFF, 0);
+	rtc_unregister(&ztd->rtc_task);
+#else
+	del_timer(&timer);
+#endif
+#else
+	free_irq(s->irq, ztd);  /* disable interrupts */
+#endif
+	zt_unregister(&ztd->span);
+	kfree(ztd);
 #ifndef LINUX26
 	unlink_td(s, td, 1);
 	delete_desc(s, td);
 #endif
-    if (debug)
-        printk("ztdummy: cleanup() finished\n");
+	if (debug)
+		printk("ztdummy: cleanup() finished\n");
 }
 
 
 
 #ifdef LINUX26
 module_param(debug, int, 0600);
+#ifdef USE_RTC
+module_param(rtc_rate, int, 0600);
+#endif
 #else
 MODULE_PARM(debug, "i");
 #endif

Modified: trunk/ztdummy.h
URL: http://svn.digium.com/view/zaptel/trunk/ztdummy.h?rev=1158&r1=1157&r2=1158&view=diff
==============================================================================
--- trunk/ztdummy.h (original)
+++ trunk/ztdummy.h Thu Jun 22 15:43:49 2006
@@ -33,8 +33,9 @@
 	struct zt_span span;
 	struct zt_chan chan;
 #ifdef LINUX26
+	unsigned int counter;
 #ifdef USE_RTC
-	atomic_t ticks;
+	spinlock_t rtclock;
 	rtc_task_t rtc_task;
 #endif
 #endif



More information about the zaptel-commits mailing list