diff options
Diffstat (limited to 'wcfxs.c')
-rwxr-xr-x | wcfxs.c | 672 |
1 files changed, 535 insertions, 137 deletions
@@ -33,6 +33,7 @@ #include <linux/pci.h> #include "proslic.h" +#include "wcfxs.h" static alpha indirect_regs[] = { @@ -49,11 +50,11 @@ static alpha indirect_regs[] = {10,"DTMF_COL_2ND_ARM",0x0202}, {11,"DTMF_PWR_MIN_TRES",0x00E5}, {12,"DTMF_OT_LIM_TRES",0x0A1C}, -{13,"OSC1_COEF",0x6D40}, -{14,"OSC1X",0x0470}, +{13,"OSC1_COEF",0x7B30}, +{14,"OSC1X",0x0063}, {15,"OSC1Y",0x0000}, -{16,"OSC2_COEF",0x4A80}, -{17,"OSC2X",0x0830}, +{16,"OSC2_COEF",0x7870}, +{17,"OSC2X",0x007D}, {18,"OSC2Y",0x0000}, {19,"RING_V_OFF",0x0000}, {20,"RING_OSC",0x7EF0}, @@ -70,17 +71,19 @@ static alpha indirect_regs[] = {29,"RING_TRIP_TRES",0x3600}, {30,"COMMON_MIN_TRES",0x1000}, {31,"COMMON_MAX_TRES",0x0200}, -{32,"PWR_ALARM_Q1Q2",0x0550}, +{32,"PWR_ALARM_Q1Q2",0x07C0}, {33,"PWR_ALARM_Q3Q4",0x2600}, {34,"PWR_ALARM_Q5Q6",0x1B80}, {35,"LOOP_CLOSURE_FILTER",0x8000}, {36,"RING_TRIP_FILTER",0x0320}, -{37,"TERM_LP_POLE_Q1Q2",0x0100}, +{37,"TERM_LP_POLE_Q1Q2",0x008C}, {38,"TERM_LP_POLE_Q3Q4",0x0100}, {39,"TERM_LP_POLE_Q5Q6",0x0010}, {40,"CM_BIAS_RINGING",0x0C00}, {41,"DCDC_MIN_V",0x0C00}, {42,"DCDC_XTRA",0x1000}, +{43,"LOOP_CLOSE_TRES_LOW",0x1000}, +{97,"RCV_FLTR", 0} }; #ifdef STANDALONE_ZAPATA @@ -111,6 +114,14 @@ static alpha indirect_regs[] = #define WC_SERCTL 0x2d #define WC_FSCDELAY 0x2f +#define WC_REGBASE 0xc0 + +#define WC_LEDS 0x0 +#define WC_TEST 0x1 +#define WC_CS 0x2 +#define WC_VER 0x3 +#define WC_SYNC 0x4 + #define BIT_CS (1 << 2) #define BIT_SCLK (1 << 3) #define BIT_SDI (1 << 4) @@ -125,11 +136,12 @@ static alpha indirect_regs[] = #define FLAG_DOUBLE_CLOCK (1 << 0) +#define NUM_CARDS 4 + struct wcfxs { struct pci_dev *dev; char *variety; struct zt_span span; - struct zt_chan chan; unsigned char ios; int usecount; int intcount; @@ -138,12 +150,15 @@ struct wcfxs { int flags; int freeregion; int alt; + int curcard; + int cards; + spinlock_t lock; /* Receive hook state and debouncing */ - int oldrxhook; - int debouncehook; - int lastrxhook; - int debounce; + int oldrxhook[NUM_CARDS]; + int debouncehook[NUM_CARDS]; + int lastrxhook[NUM_CARDS]; + int debounce[NUM_CARDS]; int idletxhookstate; /* IDLE changing hook state */ unsigned long ioaddr; @@ -151,6 +166,7 @@ struct wcfxs { dma_addr_t writedma; volatile int *writechunk; /* Double-word aligned write memory */ volatile int *readchunk; /* Double-word aligned read memory */ + struct zt_chan chans[NUM_CARDS]; }; @@ -159,7 +175,7 @@ struct wcfxs_desc { int flags; }; -static struct wcfxs_desc wcfxs = { "Wildcard Prototype", 0 }; +static struct wcfxs_desc wcfxs = { "Wildcard S400P Prototype", 0 }; static struct wcfxs *ifaces[WC_MAX_IFACES]; @@ -181,7 +197,13 @@ static inline void wcfxs_transmitprep(struct wcfxs *wc, unsigned char ints) for (x=0;x<ZT_CHUNKSIZE;x++) { /* Send a sample, as a 32-bit word */ - writechunk[x] = wc->chan.writechunk[x] << 24; + writechunk[x] = (wc->chans[0].writechunk[x] << 24); + if (wc->cards > 1) + writechunk[x] |= (wc->chans[1].writechunk[x] << 16); + if (wc->cards > 2) + writechunk[x] |= (wc->chans[2].writechunk[x] << 8); + if (wc->cards > 3) + writechunk[x] |= (wc->chans[3].writechunk[x]); } @@ -198,25 +220,37 @@ static inline void wcfxs_receiveprep(struct wcfxs *wc, unsigned char ints) /* Read is not at interrupt address. Valid data is available at normal offset */ readchunk = wc->readchunk; for (x=0;x<ZT_CHUNKSIZE;x++) { - wc->chan.readchunk[x] = (readchunk[x] >> 24) & 0xff; + wc->chans[0].readchunk[x] = (readchunk[x] >> 24) & 0xff; + if (wc->cards > 1) + wc->chans[1].readchunk[x] = (readchunk[x] >> 16) & 0xff; + if (wc->cards > 2) + wc->chans[2].readchunk[x] = (readchunk[x] >> 8) & 0xff; + if (wc->cards > 3) + wc->chans[3].readchunk[x] = (readchunk[x]) & 0xff; } zt_receive(&wc->span); } -static inline void wcfxs_check_hook(struct wcfxs *wc); +static inline void wcfxs_check_hook(struct wcfxs *wc, int card); static void wcfxs_interrupt(int irq, void *dev_id, struct pt_regs *regs) { struct wcfxs *wc = dev_id; unsigned char ints; + static int p=0; ints = inb(wc->ioaddr + WC_INTSTAT); outb(ints, wc->ioaddr + WC_INTSTAT); + if (!p) { + printk("Interrupt!\n"); + p++; + } if (!ints) return; + if (ints & 0x10) { printk("PCI Master abort\n"); return; @@ -226,12 +260,15 @@ static void wcfxs_interrupt(int irq, void *dev_id, struct pt_regs *regs) printk("PCI Target abort\n"); return; } + + if (ints & 0x0f) { wc->intcount++; - if (!(wc->intcount % 10)) - wcfxs_check_hook(wc); - if (ints & 3) wcfxs_transmitprep(wc, ints); + if ((wc->intcount % 10) < wc->cards) { + wcfxs_check_hook(wc, wc->intcount % 10); + } if (ints & 0xc) wcfxs_receiveprep(wc, ints); + if (ints & 3) wcfxs_transmitprep(wc, ints); } } @@ -295,85 +332,133 @@ static inline unsigned char read_8bits(struct wcfxs *wc) return res; } -static void wcfxs_setreg(struct wcfxs *wc, unsigned char reg, unsigned char value) +static void wcfxs_setcreg(struct wcfxs *wc, unsigned char reg, unsigned char val) { + outb(val, wc->ioaddr + WC_REGBASE + ((reg & 0xf) << 2)); +} + +static unsigned char wcfxs_getcreg(struct wcfxs *wc, unsigned char reg) +{ + return inb(wc->ioaddr + WC_REGBASE + ((reg & 0xf) << 2)); +} + +static inline void wcfxs_setcard(struct wcfxs *wc, int card) +{ + if (wc->curcard != card) { + wcfxs_setcreg(wc, WC_CS, (1 << card)); + wc->curcard = card; + } +} + +static void __wcfxs_setreg(struct wcfxs *wc, int card, unsigned char reg, unsigned char value) +{ + wcfxs_setcard(wc, card); write_8bits(wc, reg & 0x7f); write_8bits(wc, value); } -static unsigned char wcfxs_getreg(struct wcfxs *wc, unsigned char reg) +static void wcfxs_setreg(struct wcfxs *wc, int card, unsigned char reg, unsigned char value) +{ + long flags; + spin_lock_irqsave(&wc->lock, flags); + __wcfxs_setreg(wc, card, reg, value); + spin_unlock_irqrestore(&wc->lock, flags); +} + +static unsigned char __wcfxs_getreg(struct wcfxs *wc, int card, unsigned char reg) { + wcfxs_setcard(wc, card); write_8bits(wc, reg | 0x80); return read_8bits(wc); } -static int wait_access(struct wcfxs *wc) +static unsigned char wcfxs_getreg(struct wcfxs *wc, int card, unsigned char reg) { - unsigned char count, data; - count = 0; - #define MAX 60 + long flags; + unsigned char res; + spin_lock_irqsave(&wc->lock, flags); + res = __wcfxs_getreg(wc, card, reg); + spin_unlock_irqrestore(&wc->lock, flags); + return res; +} + +static int __wait_access(struct wcfxs *wc, int card) +{ + unsigned char data; + long origjiffies; + int count = 0; + + #define MAX 6000 /* attempts */ + origjiffies = jiffies; /* Wait for indirect access */ while (count++ < MAX) { - data = wcfxs_getreg(wc, I_STATUS); + data = __wcfxs_getreg(wc, card, I_STATUS); if (!data) return 0; } - if(count > (MAX-1)) printk(" ##### Loop error #####\n"); + if(count > (MAX-1)) printk(" ##### Loop error (%02x) #####\n", data); - return -1; + return 0; } -static int wcfxs_setreg_indirect(struct wcfxs *wc, unsigned char address, unsigned short data) +static int wcfxs_setreg_indirect(struct wcfxs *wc, int card, unsigned char address, unsigned short data) { - - if(!wait_access(wc)) - { - wcfxs_setreg(wc, IDA_LO,(unsigned char)(data & 0xFF)); - wcfxs_setreg(wc, IDA_HI,(unsigned char)((data & 0xFF00)>>8)); - wcfxs_setreg(wc, IAA,address); - return 0; - } - - return -1; + long flags; + int res = -1; + spin_lock_irqsave(&wc->lock, flags); + if(!__wait_access(wc, card)) { + __wcfxs_setreg(wc, card, IDA_LO,(unsigned char)(data & 0xFF)); + __wcfxs_setreg(wc, card, IDA_HI,(unsigned char)((data & 0xFF00)>>8)); + __wcfxs_setreg(wc, card, IAA,address); + res = 0; + }; + spin_unlock_irqrestore(&wc->lock, flags); + return res; } -static int wcfxs_getreg_indirect(struct wcfxs *wc, unsigned char address) +static int wcfxs_getreg_indirect(struct wcfxs *wc, int card, unsigned char address) { - if (!wait_access(wc)) { - wcfxs_setreg(wc, IAA, address); - if (!wait_access(wc)) { - unsigned char data1, data2; - data1 = wcfxs_getreg(wc, IDA_LO); - data2 = wcfxs_getreg(wc, IDA_HI); - return data1 | (data2 << 8); + long flags; + int res = -1; + char *p=NULL; + spin_lock_irqsave(&wc->lock, flags); + if (!__wait_access(wc, card)) { + __wcfxs_setreg(wc, card, IAA, address); + if (!__wait_access(wc, card)) { + unsigned char data1, data2; + data1 = __wcfxs_getreg(wc, card, IDA_LO); + data2 = __wcfxs_getreg(wc, card, IDA_HI); + res = data1 | (data2 << 8); + } else + p = "Failed to wait inside\n"; } else - printk("Failed to wait inside\n"); - } else - printk("failed to wait\n"); - - return -1; + p = "failed to wait\n"; + spin_unlock_irqrestore(&wc->lock, flags); + if (p) + printk(p); + return res; } -static int wcfxs_init_indirect_regs(struct wcfxs *wc) +static int wcfxs_init_indirect_regs(struct wcfxs *wc, int card) { unsigned char i; for (i=0; i<43; i++) { - if(wcfxs_setreg_indirect(wc, i,indirect_regs[i].initial)) + if(wcfxs_setreg_indirect(wc, card, i,indirect_regs[i].initial)) return -1; } return 0; } -static int wcfxs_verify_indirect_regs(struct wcfxs *wc) +static int wcfxs_verify_indirect_regs(struct wcfxs *wc, int card) { int passed = 1; unsigned short i, initial; @@ -381,7 +466,7 @@ static int wcfxs_verify_indirect_regs(struct wcfxs *wc) for (i=0; i<43; i++) { - if((j = wcfxs_getreg_indirect(wc, (unsigned char) i)) < 0) { + if((j = wcfxs_getreg_indirect(wc, card, (unsigned char) i)) < 0) { printk("Failed to read indirect register %d\n", i); return -1; } @@ -405,77 +490,293 @@ static int wcfxs_verify_indirect_regs(struct wcfxs *wc) return 0; } -static int wcfxs_calibrate(struct wcfxs *wc) -{ - unsigned char x; +static int wcfxs_proslic_insane(struct wcfxs *wc, int card) +{ + int blah; - wcfxs_setreg(wc, 92, 0xc8); - wcfxs_setreg(wc, 97, 0); - wcfxs_setreg(wc, 93, 0x19); - wcfxs_setreg(wc, 14, 0); - wcfxs_setreg(wc, 93, 0x99); + blah = wcfxs_getreg(wc, card, 0); + if (debug) + printk("ProSLIC on module %d, product %d, version %d\n", card, (blah & 0x30) >> 4, (blah & 0xf)); - x = wcfxs_getreg(wc, 93); - if (debug) - printk("DC Cal x=%x\n",x); - wcfxs_setreg(wc, 97, 0); - wcfxs_setreg(wc, CALIBR1, CALIBRATE_LINE); - x = wcfxs_getreg(wc, CALIBR1); - wcfxs_setreg(wc, LINE_STATE, ACTIVATE_LINE); + if ((blah & 0x30) >> 4) { + printk("ProSLIC on module %d is not a 3210.\n", card); + return -1; + } + if ((blah & 0xf) < 3) { + printk("ProSLIC 3210 version %d is too old\n", blah & 0xf); + return -1; + } + + blah = wcfxs_getreg(wc, card, 8); + if (blah != 0x2) { + printk("ProSLIC on module %d insane (1)\n", card); + return -1; + } + + blah = wcfxs_getreg(wc, card, 64); + if (blah != 0x0) { + printk("ProSLIC on module %d insane (2)\n", card); + return -1; + } + + blah = wcfxs_getreg(wc, card, 11); + if (blah != 0x33) { + printk("ProSLIC on module %d insane (3)\n", card); + return -1; + } + + /* Just be sure it's setup right. */ + wcfxs_setreg(wc, card, 30, 0); + if (debug) + printk("ProSLIC on module %d seems sane.\n", card); return 0; } -static int wcfxs_init_proslic(struct wcfxs *wc) +static int wcfxs_powerleak_test(struct wcfxs *wc, int card) { - int blah; + unsigned long origjiffies; + unsigned char vbat; - /* By default, always send on hook */ - wc->idletxhookstate = 2; + /* Turn off linefeed */ + wcfxs_setreg(wc, card, 64, 0); - /* Disable Auto Power Alarm Detect and other "features" */ - wcfxs_setreg(wc, 67, 0x0e); - blah = wcfxs_getreg(wc, 67); + /* Power down */ + wcfxs_setreg(wc, card, 14, 0x10); - if (wcfxs_init_indirect_regs(wc)) { - printk(KERN_INFO "Indirect Registers failed to initialize.\n"); - return -1; + /* Wait for one second */ + origjiffies = jiffies; + + while((vbat = wcfxs_getreg(wc, card, 82)) > 0x3) { + if ((jiffies - origjiffies) >= HZ) + break;; } - if (wcfxs_verify_indirect_regs(wc)) { - printk(KERN_INFO "Indirect Registers failed verification.\n"); - return -1; + + if (vbat < 0x04) { + printk("Excessive leakage detected on module %d: %d volts (%02x) after %d ms\n", card, + 376 * vbat / 1000, vbat, (int)((jiffies - origjiffies) * 1000 / HZ)); + return -1; + } else if (debug) { + printk("Post-leakage voltage: %d volts\n", 376 * vbat / 1000); } - if (wcfxs_calibrate(wc)) { - printk(KERN_INFO "ProSlic Died on Activation.\n"); - return -1; + return 0; +} + +static int wcfxs_powerup_proslic(struct wcfxs *wc, int card) +{ + unsigned char vbat; + unsigned long origjiffies; + + /* Set period of DC-DC converter to 1/64 khz */ + wcfxs_setreg(wc, card, 92, 0xff); + + /* Engage DC-DC converter */ + wcfxs_setreg(wc, card, 93, 0x19); + + /* Wait for VBat to powerup */ + origjiffies = jiffies; + + /* Disable powerdown */ + wcfxs_setreg(wc, card, 14, 0); + + while((vbat = wcfxs_getreg(wc, card, 82)) < 0xc0) { + /* Wait no more than 500ms */ + if ((jiffies - origjiffies) > HZ/2) { + break; + } + } + +#if 0 + printk("jiffies - origjiffies: %d\n", ((int)(jiffies - origjiffies))); +#endif + + if (vbat < 0xc0) { + printk("ProSLIC on module %d failed to powerup within %d ms\n", + card, (int)(((jiffies - origjiffies) * 1000 / HZ))); + return -1; + } else if (debug) { + printk("ProSLIC on module %d powered up to -%d volts (%02x) in %d ms\n", + card, vbat * 376 / 1000, vbat, (int)(((jiffies - origjiffies) * 1000 / HZ))); } - if (wcfxs_setreg_indirect(wc, 97, 0x0)) { // Stanley: for the bad recording fix + /* Perform DC-DC calibration */ + wcfxs_setreg(wc, card, 93, 0x80); + + origjiffies = jiffies; + while(0x80 & wcfxs_getreg(wc, card, 93)) { + if ((jiffies - origjiffies) > 2 * HZ) { + printk("Timeout waiting for DC-DC calibration on module %d\n", card); + return -1; + } + } + +#if 0 + /* Wait a full two seconds */ + while((jiffies - origjiffies) < 2 * HZ); + + /* Just check to be sure */ + vbat = wcfxs_getreg(wc, card, 82); + printk("ProSLIC on module %d powered up to -%d volts (%02x) in %d ms\n", + card, vbat * 376 / 1000, vbat, (int)(((jiffies - origjiffies) * 1000 / HZ))); +#endif + return 0; + +} + +static int wcfxs_calibrate(struct wcfxs *wc, int card) +{ + unsigned long origjiffies; + int x; + /* Perform all calibrations */ + wcfxs_setreg(wc, card, 97, 0x1f); + + /* Begin, no speedup */ + wcfxs_setreg(wc, card, 96, 0x5f); + + /* Wait for it to finish */ + origjiffies = jiffies; + while(wcfxs_getreg(wc, card, 96)) { + if ((jiffies - origjiffies) > 2 * HZ) { + printk("Timeout waiting for calibration of module %d\n", card); + return -1; + } + } + + if (debug) { + /* Print calibration parameters */ + printk("Calibration Vector Regs 98 - 107: \n"); + for (x=98;x<108;x++) { + printk("%d: %02x\n", x, wcfxs_getreg(wc, card, x)); + } + } + return 0; +} + +static int wcfxs_init_proslic(struct wcfxs *wc, int card) +{ + + unsigned short tmp[5]; + int x; + + /* By default, always send on hook */ + wc->idletxhookstate = 2; + + /* Sanity check the ProSLIC */ + if (wcfxs_proslic_insane(wc, card)) + return -1; + + if (wcfxs_init_indirect_regs(wc, card)) { + printk(KERN_INFO "Indirect Registers failed to initialize on module %d.\n", card); + return -1; + } + + /* Clear scratch pad area */ + wcfxs_setreg_indirect(wc, card, 97,0); + + /* Clear digital loopback */ + wcfxs_setreg(wc, card, 8, 0); + + /* Revision C optimization */ + wcfxs_setreg(wc, card, 108, 0xeb); + + /* Disable automatic VBat switching for safety to prevent + Q7 from accidently turning on and burning out. */ + wcfxs_setreg(wc, card, 67, 0x17); + + /* Turn off Q7 */ + wcfxs_setreg(wc, card, 66, 1); + + /* Flush ProSLIC digital filters by setting to clear, while + saving old values */ + for (x=0;x<5;x++) { + tmp[x] = wcfxs_getreg_indirect(wc, card, x + 35); + wcfxs_setreg_indirect(wc, card, x + 35, 0x8000); + } + + /* Power up the DC-DC converter */ + if (wcfxs_powerup_proslic(wc, card)) { + printk("Unable to do INITIAL ProSLIC powerup on module %d\n", card); + return -1; + } + + /* Check for power leaks */ + if (wcfxs_powerleak_test(wc, card)) { + printk("ProSLIC module %d failed leakage test. Check for short circuit\n", card); + return -1; + } + + /* Power up again */ + if (wcfxs_powerup_proslic(wc, card)) { + printk("Unable to do FINAL ProSLIC powerup on module %d\n", card); + return -1; + } + + /* Perform calibration */ + if (wcfxs_calibrate(wc, card)) { + printk("ProSlic died on Calibration.\n"); + return -1; + } + + /* Calibration complete, restore original values */ + for (x=0;x<5;x++) { + wcfxs_setreg_indirect(wc, card, x + 35, tmp[x]); + } + + if (wcfxs_verify_indirect_regs(wc, card)) { + printk(KERN_INFO "Indirect Registers failed verification.\n"); + return -1; + } + + +#if 0 + /* Disable Auto Power Alarm Detect and other "features" */ + wcfxs_setreg(wc, card, 67, 0x0e); + blah = wcfxs_getreg(wc, card, 67); +#endif + +#if 0 + if (wcfxs_setreg_indirect(wc, card, 97, 0x0)) { // Stanley: for the bad recording fix printk(KERN_INFO "ProSlic IndirectReg Died.\n"); return -1; } - wcfxs_setreg(wc, 1, 0x2a); - // U-Law GCI 8-bit interface - wcfxs_setreg(wc, 2, 0); // Tx Start count low byte 0 - wcfxs_setreg(wc, 3, 0); // Tx Start count high byte 0 - wcfxs_setreg(wc, 4, 0); // Rx Start count low byte 0 - wcfxs_setreg(wc, 5, 0); // Rx Start count high byte 0 - wcfxs_setreg(wc, 8, 0x0); // disable loopback - wcfxs_setreg(wc, 18, 0xff); // clear all interrupt - wcfxs_setreg(wc, 19, 0xff); - wcfxs_setreg(wc, 20, 0xff); - wcfxs_setreg(wc, 21, 0x00); // enable interrupt - wcfxs_setreg(wc, 22, 0x02); // Loop detection interrupt - wcfxs_setreg(wc, 23, 0x01); // DTMF detection interrupt - wcfxs_setreg(wc, 72, 0x20); +#endif + + wcfxs_setreg(wc, card, 1, 0x28); + // U-Law 8-bit interface + wcfxs_setreg(wc, card, 2, 0); // Tx Start count low byte 0 + wcfxs_setreg(wc, card, 3, 0); // Tx Start count high byte 0 + wcfxs_setreg(wc, card, 4, 0); // Rx Start count low byte 0 + wcfxs_setreg(wc, card, 5, 0); // Rx Start count high byte 0 + wcfxs_setreg(wc, card, 18, 0xff); // clear all interrupt + wcfxs_setreg(wc, card, 19, 0xff); + wcfxs_setreg(wc, card, 20, 0xff); + wcfxs_setreg(wc, card, 73, 0x04); + +#if 0 + wcfxs_setreg(wc, card, 21, 0x00); // enable interrupt + wcfxs_setreg(wc, card, 22, 0x02); // Loop detection interrupt + wcfxs_setreg(wc, card, 23, 0x01); // DTMF detection interrupt + wcfxs_setreg(wc, card, 72, 0x20); +#endif + +#if 0 + /* Enable loopback */ + wcfxs_setreg(wc, card, 8, 0x2); + wcfxs_setreg(wc, card, 14, 0x0); + wcfxs_setreg(wc, card, 64, 0x0); + wcfxs_setreg(wc, card, 1, 0x08); +#endif + + printk("Loopback: %02x\n", wcfxs_getreg(wc, card, 8)); + #ifdef BOOST_RINGER /* Beef up Ringing voltage to 89V */ - if (wcfxs_setreg_indirect(wc, 23, 0x1d1)) + if (wcfxs_setreg_indirect(wc, card, 23, 0x1d1)) return -1; #endif return 0; } -static inline void wcfxs_check_hook(struct wcfxs *wc) +static inline void wcfxs_check_hook(struct wcfxs *wc, int card) { char res; int hook; @@ -483,36 +784,76 @@ static inline void wcfxs_check_hook(struct wcfxs *wc) /* For some reason we have to debounce the hook detector. */ - res = wcfxs_getreg(wc, 68); + res = wcfxs_getreg(wc, card, 68); hook = (res & 1); - if (hook != wc->lastrxhook) { + if (hook != wc->lastrxhook[card]) { /* Reset the debounce */ - wc->debounce = 3; + wc->debounce[card] = 50; +#if 0 + printk("Resetting debounce card %d hook %d, %d\n", card, hook, wc->debounce[card]); +#endif } else { - if (wc->debounce > -1) - wc->debounce--; + if (wc->debounce[card] > -1) { + wc->debounce[card]--; +#if 0 + printk("Sustaining hook %d, %d\n", hook, wc->debounce[card]); +#endif + } + } + wc->lastrxhook[card] = hook; + if (!wc->debounce[card]) { +#if 0 + printk("Counted down debounce, newhook: %d...\n", hook); +#endif + wc->debouncehook[card] = hook; } - wc->lastrxhook = hook; - if (!wc->debounce) - wc->debouncehook = hook; - if (!wc->oldrxhook && wc->debouncehook) { + if (!wc->oldrxhook[card] && wc->debouncehook[card]) { /* Off hook */ if (debug) - printk("wcfxs: Going off hook\n"); - zt_hooksig(&wc->chan, ZT_RXSIG_OFFHOOK); - wc->oldrxhook = 1; + printk("wcfxs: Card %d Going off hook\n", card); + zt_hooksig(&wc->chans[card], ZT_RXSIG_OFFHOOK); + wc->oldrxhook[card] = 1; - } else if (wc->oldrxhook && !wc->debouncehook) { + } else if (wc->oldrxhook[card] && !wc->debouncehook[card]) { /* On hook */ if (debug) - printk("wcfxs: Going on hook\n"); - zt_hooksig(&wc->chan, ZT_RXSIG_ONHOOK); - wc->oldrxhook = 0; + printk("wcfxs: Card %d Going on hook\n", card); + zt_hooksig(&wc->chans[card], ZT_RXSIG_ONHOOK); + wc->oldrxhook[card] = 0; } } +static int wcfxs_ioctl(struct zt_chan *chan, unsigned int cmd, unsigned long data) +{ + struct wcfxs_stats stats; + struct wcfxs_regs regs; + struct wcfxs *wc = chan->pvt; + int x; + switch (cmd) { + case WCFXS_GET_STATS: + stats.tipvolt = wcfxs_getreg(wc, chan->chanpos - 1, 80) * -376; + stats.ringvolt = wcfxs_getreg(wc, chan->chanpos - 1, 81) * -376; + stats.batvolt = wcfxs_getreg(wc, chan->chanpos - 1, 82) * -376; + if (copy_to_user((struct wcfxs_stats *)data, &stats, sizeof(stats))) + return -EFAULT; + break; + case WCFXS_GET_REGS: + for (x=0;x<NUM_INDIRECT_REGS;x++) + regs.indirect[x] = wcfxs_getreg_indirect(wc, chan->chanpos -1, x); + for (x=0;x<NUM_REGS;x++) + regs.direct[x] = wcfxs_getreg(wc, chan->chanpos - 1, x); + if (copy_to_user((struct wcfxs_regs *)data, ®s, sizeof(regs))) + return -EFAULT; + break; + default: + return -ENOTTY; + } + return 0; + +} + static int wcfxs_open(struct zt_chan *chan) { struct wcfxs *wc = chan->pvt; @@ -566,29 +907,35 @@ static int wcfxs_hooksig(struct zt_chan *chan, zt_txsig_t txsig) if (debug) printk("Setting hook state to %d (%02x)\n", txsig, reg); - wcfxs_setreg(wc, 64, txhook); +#if 1 + wcfxs_setreg(wc, chan->chanpos - 1, 64, txhook); +#endif return 0; } static int wcfxs_initialize(struct wcfxs *wc) { + int x; /* Zapata stuff */ sprintf(wc->span.name, "WCFXS/%d", wc->pos); - sprintf(wc->span.desc, "%s Board %d\n", wc->variety, wc->pos + 1); + sprintf(wc->span.desc, "%s Board %d, %d modules\n", wc->variety, wc->pos + 1, wc->cards); wc->span.deflaw = ZT_LAW_MULAW; - sprintf(wc->chan.name, "WCFXS/%d/%d", wc->pos, 0); - wc->chan.sigcap = ZT_SIG_FXOKS | ZT_SIG_FXOLS | ZT_SIG_FXOGS; - wc->chan.chanpos = 1; - wc->span.chans = &wc->chan; - wc->span.channels = 1; + for (x=0;x<wc->cards;x++) { + sprintf(wc->chans[x].name, "WCFXS/%d/%d", wc->pos, x); + wc->chans[x].sigcap = ZT_SIG_FXOKS | ZT_SIG_FXOLS | ZT_SIG_FXOGS; + wc->chans[x].chanpos = x+1; + wc->chans[x].pvt = wc; + } + wc->span.chans = wc->chans; + wc->span.channels = wc->cards; wc->span.hooksig = wcfxs_hooksig; wc->span.open = wcfxs_open; wc->span.close = wcfxs_close; wc->span.flags = ZT_FLAG_RBS; + wc->span.ioctl = wcfxs_ioctl; init_waitqueue_head(&wc->span.maintq); wc->span.pvt = wc; - wc->chan.pvt = wc; if (zt_register(&wc->span, 0)) { printk("Unable to register span with zaptel\n"); return -1; @@ -600,6 +947,36 @@ static int wcfxs_hardware_init(struct wcfxs *wc) { /* Hardware stuff */ long oldjiffies; + unsigned char ver; + unsigned char x,y; + int failed; + + /* Check Freshmaker chip */ + ver = wcfxs_getcreg(wc, WC_VER); + failed = 0; + if (ver != 0x59) { + printk("Freshmaker version: %02x\n", ver); + for (x=0;x<254;x++) { + /* Test registers */ + wcfxs_setcreg(wc, WC_TEST, x); + y = wcfxs_getcreg(wc, WC_TEST); + if (x != y) { + printk("%02x != %02x\n", x, y); + failed++; + } + } + if (!failed) { + printk("Freshmaker passed register test\n"); + } else { + printk("Freshmaker failed register test\n"); + return -1; + } + /* Go to half-duty FSYNC */ + wcfxs_setcreg(wc, WC_SYNC, 1); + } else { + printk("No freshmaker chip\n"); + } + /* Reset PCI Interface chip and registers (and serial) */ outb(0x0e, wc->ioaddr + WC_CNTL); /* Setup our proper outputs for when we switch for our "serial" port */ @@ -607,12 +984,13 @@ static int wcfxs_hardware_init(struct wcfxs *wc) outb(wc->ios, wc->ioaddr + WC_AUXD); - /* Set all to outputs except AUX 5 and 0, which are inputs */ - outb(0xde, wc->ioaddr + WC_AUXC); + /* Set all to outputs except AUX 5, which is an input */ + outb(0xdf, wc->ioaddr + WC_AUXC); - /* Wait a sec */ + /* Wait 1/4 of a sec */ oldjiffies = jiffies; - while(jiffies - oldjiffies < 2); + while(jiffies - oldjiffies < (HZ / 4) + 1); + /* Back to normal, with automatic DMA wrap around */ outb(0x30 | 0x01, wc->ioaddr + WC_CNTL); @@ -620,10 +998,7 @@ static int wcfxs_hardware_init(struct wcfxs *wc) outb(inb(wc->ioaddr + WC_CNTL) & 0xf9, WC_CNTL); /* Configure serial port for MSB->LSB operation */ - if (wc->flags & FLAG_DOUBLE_CLOCK) - outb(0xc1, wc->ioaddr + WC_SERCTL); - else - outb(0xc0, wc->ioaddr + WC_SERCTL); + outb(0xc1, wc->ioaddr + WC_SERCTL); /* Delay FSC by 0 so it's properly aligned */ outb(0x0, wc->ioaddr + WC_FSCDELAY); @@ -639,7 +1014,18 @@ static int wcfxs_hardware_init(struct wcfxs *wc) /* Clear interrupts */ outb(0xff, wc->ioaddr + WC_INTSTAT); - return wcfxs_init_proslic(wc); + + /* Wait 1/4 of a second more */ + oldjiffies = jiffies; + while(jiffies - oldjiffies < (HZ / 4) + 1); + + for (x=0;x<wc->cards;x++) { + if (wcfxs_init_proslic(wc, x)) { + printk("Error initializing card %d\n", x); + return -1; + } + } + return 0; } static void wcfxs_enable_interrupts(struct wcfxs *wc) @@ -697,6 +1083,9 @@ static int __devinit wcfxs_init_one(struct pci_dev *pdev, const struct pci_devic if (wc) { ifaces[x] = wc; memset(wc, 0, sizeof(struct wcfxs)); + spin_lock_init(&wc->lock); + wc->curcard = -1; + wc->cards = 1; wc->ioaddr = pci_resource_start(pdev, 0); wc->dev = pdev; wc->pos = x; @@ -723,6 +1112,7 @@ static int __devinit wcfxs_init_one(struct pci_dev *pdev, const struct pci_devic printk("wcfxs: Unable to intialize FXS\n"); if (wc->freeregion) release_region(wc->ioaddr, 0xff); + pci_free_consistent(pdev, ZT_MAX_CHUNKSIZE * 2 * 2 * 2 * 4, (void *)wc->writechunk, wc->writedma); kfree(wc); return -EIO; } @@ -737,15 +1127,20 @@ static int __devinit wcfxs_init_one(struct pci_dev *pdev, const struct pci_devic printk("wcfxs: Unable to request IRQ %d\n", pdev->irq); if (wc->freeregion) release_region(wc->ioaddr, 0xff); + pci_free_consistent(pdev, ZT_MAX_CHUNKSIZE * 2 * 2 * 2 * 4, (void *)wc->writechunk, wc->writedma); + pci_set_drvdata(pdev, NULL); kfree(wc); return -EIO; } if (wcfxs_hardware_init(wc)) { + free_irq(pdev->irq, wc); zt_unregister(&wc->span); if (wc->freeregion) release_region(wc->ioaddr, 0xff); + pci_free_consistent(pdev, ZT_MAX_CHUNKSIZE * 2 * 2 * 2 * 4, (void *)wc->writechunk, wc->writedma); + pci_set_drvdata(pdev, NULL); kfree(wc); return -EIO; } @@ -757,7 +1152,7 @@ static int __devinit wcfxs_init_one(struct pci_dev *pdev, const struct pci_devic /* Start DMA */ wcfxs_start_dma(wc); - printk("Found a Wildcard FXS: %s\n", wc->variety); + printk("Found a Wildcard FXS: %s (%d modules)\n", wc->variety, wc->cards); res = 0; } else res = -ENOMEM; @@ -830,6 +1225,9 @@ static void __exit wcfxs_cleanup(void) MODULE_PARM(debug, "i"); MODULE_DESCRIPTION("Wildcard S100P Zaptel Driver"); MODULE_AUTHOR("Mark Spencer <markster@linux-support.net>"); +#ifdef MODULE_LICENSE +MODULE_LICENSE("GPL"); +#endif module_init(wcfxs_init); module_exit(wcfxs_cleanup); |