diff options
Diffstat (limited to 'wctdm24xxp')
-rw-r--r-- | wctdm24xxp/GpakCust.c | 17 |
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) |