Improve wcte12xp and wctdm24xxp drivers' tolerance to host system latencies.

git-svn-id: http://svn.digium.com/svn/zaptel/branches/1.2@3534 5390a7c7-147a-4af0-8ec9-7488f05a26cb

1 files changed, 12 insertions, 5 deletions

diff --git a/wctdm24xxp/GpakCust.c b/wctdm24xxp/GpakCust.c
index c1940fb..e8e91c4 100644
--- a/wctdm24xxp/GpakCust.c
+++ b/wctdm24xxp/GpakCust.c
@@ -202,11 +202,18 @@ unsigned char wctdm_vpm150m_getpage(struct wctdm *wc)
 unsigned short wctdm_vpm150m_getreg(struct wctdm *wc, unsigned int len, unsigned int addr, unsigned short *data)
 {
 	unsigned short res;
-	wctdm_vpm150m_setpage(wc, addr >> 16);
-	if ((addr >> 16) != ((addr + len) >> 16))
-		printk("getreg: You found it!\n");
-	res = wctdm_vpm150m_getreg_full(wc, 0, len, addr & 0xffff, data);
-	return res;
+	unsigned short count=0;
+	unsigned short first_data=0;
+	do {
+		wctdm_vpm150m_setpage(wc, addr >> 16);
+		if ((addr >> 16) != ((addr + len) >> 16))
+			printk("getreg: You found it!\n");
+		if (count > 0) {
+			first_data = *data;
+		}
+		res = wctdm_vpm150m_getreg_full(wc, 0, len, addr & 0xffff, data);
+	} while(((0==count++) || (first_data != *data)) && (count < 100));
+ 	return res;
 }
 
 int wctdm_vpm150m_setreg(struct wctdm *wc, unsigned int len, unsigned int addr, unsigned short *data)