summarylogtreecommitdiffstats
path: root/dahdi-linux-2.10.1-yeastar.patch
diff options
context:
space:
mode:
authorMaik Broemme2015-10-04 21:51:11 +0200
committerMaik Broemme2015-10-04 21:51:11 +0200
commit205e1524de216b894a99a525a9cd45f49a6d2119 (patch)
treed6683bbd43e65fe52c986a349662aff443c5c60b /dahdi-linux-2.10.1-yeastar.patch
parent126ae972e89a76accea7bcc79972ae8f72c17ab3 (diff)
downloadaur-205e1524de216b894a99a525a9cd45f49a6d2119.tar.gz
Removed no longer needed patches
Diffstat (limited to 'dahdi-linux-2.10.1-yeastar.patch')
-rw-r--r--dahdi-linux-2.10.1-yeastar.patch6269
1 files changed, 0 insertions, 6269 deletions
diff --git a/dahdi-linux-2.10.1-yeastar.patch b/dahdi-linux-2.10.1-yeastar.patch
deleted file mode 100644
index 207b2bceda07..000000000000
--- a/dahdi-linux-2.10.1-yeastar.patch
+++ /dev/null
@@ -1,6269 +0,0 @@
-diff -Nur dahdi-linux-2.10.0.1/drivers/dahdi/Kbuild dahdi-linux-2.10.0.1-yeastar/drivers/dahdi/Kbuild
---- dahdi-linux-2.10.0.1/drivers/dahdi/Kbuild 2014-09-22 20:40:19.000000000 +0200
-+++ dahdi-linux-2.10.0.1-yeastar/drivers/dahdi/Kbuild 2015-02-10 15:33:19.353714552 +0100
-@@ -14,6 +14,9 @@
- obj-$(DAHDI_BUILD_ALL)$(CONFIG_DAHDI_WCTE12XP) += wcte12xp/
- obj-$(DAHDI_BUILD_ALL)$(CONFIG_DAHDI_WCTE13XP) += wcte13xp.o
-
-+obj-$(DAHDI_BUILD_ALL)$(CONFIG_DAHDI_YSTDM8XX) += ystdm8xx.o
-+obj-$(DAHDI_BUILD_ALL)$(CONFIG_DAHDI_YSTDM16XX) += ystdm16xx.o
-+
- wcte13xp-objs := wcte13xp-base.o wcxb_spi.o wcxb.o wcxb_flash.o
- CFLAGS_wcte13xp-base.o += -I$(src)/oct612x -I$(src)/oct612x/include -I$(src)/oct612x/octdeviceapi -I$(src)/oct612x/octdeviceapi/oct6100api
- ifeq ($(HOTPLUG_FIRMWARE),yes)
-diff -Nur dahdi-linux-2.10.0.1/drivers/dahdi/Kconfig dahdi-linux-2.10.0.1-yeastar/drivers/dahdi/Kconfig
---- dahdi-linux-2.10.0.1/drivers/dahdi/Kconfig 2014-09-22 20:40:19.000000000 +0200
-+++ dahdi-linux-2.10.0.1-yeastar/drivers/dahdi/Kconfig 2015-02-10 15:33:19.353714552 +0100
-@@ -291,4 +291,28 @@
-
- If unsure, say Y.
-
-+config DAHDI_YSTDM8XX
-+
-+ tristate "Yeastar YSTDM8xx Support"
-+ depends on DAHDI && PCI
-+ default DAHDI
-+ ---help---
-+ This driver provides support for the Yeastar YSTDM8xx.
-+ To compile this driver as a module, choose M here: the
-+ module will be called ystdm8xx.
-+
-+ If unsure, say Y.
-+
-+config DAHDI_YSTDM16XX
-+
-+ tristate "Yeastar YSTDM16xx Support"
-+ depends on DAHDI && PCI
-+ default DAHDI
-+ ---help---
-+ This driver provides support for the Yeastar YSTDM16xx.
-+ To compile this driver as a module, choose M here: the
-+ module will be called ystdm16xx.
-+
-+ If unsure, say Y.
-+
- source "drivers/dahdi/xpp/Kconfig"
-diff -Nur dahdi-linux-2.10.0.1/drivers/dahdi/ystdm16xx.c dahdi-linux-2.10.0.1-yeastar/drivers/dahdi/ystdm16xx.c
---- dahdi-linux-2.10.0.1/drivers/dahdi/ystdm16xx.c 1970-01-01 01:00:00.000000000 +0100
-+++ dahdi-linux-2.10.0.1-yeastar/drivers/dahdi/ystdm16xx.c 2015-02-10 15:33:19.357047652 +0100
-@@ -0,0 +1,3151 @@
-+/*
-+ * Yeastar YSTDM16xx TDM FXS/FXO Interface Driver for Zapata Telephony interface
-+ *
-+ * Derived from wctdm.c written by Mark Spencer <markster@linux-support.net>
-+ * Matthew Fredrickson <creslin@linux-support.net>
-+ *
-+ * Copyright (C) 2006, Yeastar Technology Co.,Ltd. <support@yeastar.com>
-+ * Copyright (C) 2001, Linux Support Services, Inc.
-+ *
-+ * All rights reserved.
-+ *
-+ * 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 <linux/kernel.h>
-+#include <linux/errno.h>
-+#include <linux/module.h>
-+#include <linux/init.h>
-+#include <linux/pci.h>
-+#include <linux/interrupt.h>
-+#include <linux/moduleparam.h>
-+#include <linux/sched.h>
-+#include <linux/ioctl.h>
-+#include <asm/io.h>
-+#include "proslic.h"
-+/*
-+ * Define for audio vs. register based ring detection
-+ *
-+ */
-+//#define AUDIO_RINGCHECK
-+
-+/*
-+ Experimental max loop current limit for the proslic
-+ Loop current limit is from 20 mA to 41 mA in steps of 3
-+ (according to datasheet)
-+ So set the value below to:
-+ 0x00 : 20mA (default)
-+ 0x01 : 23mA
-+ 0x02 : 26mA
-+ 0x03 : 29mA
-+ 0x04 : 32mA
-+ 0x05 : 35mA
-+ 0x06 : 37mA
-+ 0x07 : 41mA
-+*/
-+static int loopcurrent = 20;
-+#define POLARITY_XOR (\
-+ (reversepolarity != 0) ^ (fxs->reversepolarity != 0) ^\
-+ (fxs->vmwi_lrev != 0) ^\
-+ ((fxs->vmwisetting.vmwi_type & DAHDI_VMWI_HVAC) != 0))
-+
-+static int reversepolarity = 0;
-+
-+static alpha indirect_regs[] =
-+{
-+{0,255,"DTMF_ROW_0_PEAK",0x55C2},
-+{1,255,"DTMF_ROW_1_PEAK",0x51E6},
-+{2,255,"DTMF_ROW2_PEAK",0x4B85},
-+{3,255,"DTMF_ROW3_PEAK",0x4937},
-+{4,255,"DTMF_COL1_PEAK",0x3333},
-+{5,255,"DTMF_FWD_TWIST",0x0202},
-+{6,255,"DTMF_RVS_TWIST",0x0202},
-+{7,255,"DTMF_ROW_RATIO_TRES",0x0198},
-+{8,255,"DTMF_COL_RATIO_TRES",0x0198},
-+{9,255,"DTMF_ROW_2ND_ARM",0x0611},
-+{10,255,"DTMF_COL_2ND_ARM",0x0202},
-+{11,255,"DTMF_PWR_MIN_TRES",0x00E5},
-+{12,255,"DTMF_OT_LIM_TRES",0x0A1C},
-+{13,0,"OSC1_COEF",0x7B30},
-+{14,1,"OSC1X",0x0063},
-+{15,2,"OSC1Y",0x0000},
-+{16,3,"OSC2_COEF",0x7870},
-+{17,4,"OSC2X",0x007D},
-+{18,5,"OSC2Y",0x0000},
-+{19,6,"RING_V_OFF",0x0000},
-+{20,7,"RING_OSC",0x7EF0},
-+{21,8,"RING_X",0x0160},
-+{22,9,"RING_Y",0x0000},
-+{23,255,"PULSE_ENVEL",0x2000},
-+{24,255,"PULSE_X",0x2000},
-+{25,255,"PULSE_Y",0x0000},
-+//{26,13,"RECV_DIGITAL_GAIN",0x4000}, // playback volume set lower
-+{26,13,"RECV_DIGITAL_GAIN",0x4000}, // playback volume set lower
-+{27,14,"XMIT_DIGITAL_GAIN",0x3000},
-+//{27,14,"XMIT_DIGITAL_GAIN",0x2000},
-+{28,15,"LOOP_CLOSE_TRES",0x1000},
-+{29,16,"RING_TRIP_TRES",0x3600},
-+{30,17,"COMMON_MIN_TRES",0x1000},
-+{31,18,"COMMON_MAX_TRES",0x0200},
-+{32,19,"PWR_ALARM_Q1Q2",0x07C0},
-+{33,20,"PWR_ALARM_Q3Q4",0x2600},
-+{34,21,"PWR_ALARM_Q5Q6",0x1B80},
-+{35,22,"LOOP_CLOSURE_FILTER",0x8000},
-+{36,23,"RING_TRIP_FILTER",0x0320},
-+{37,24,"TERM_LP_POLE_Q1Q2",0x008C},
-+{38,25,"TERM_LP_POLE_Q3Q4",0x0100},
-+{39,26,"TERM_LP_POLE_Q5Q6",0x0010},
-+{40,27,"CM_BIAS_RINGING",0x0C00},
-+{41,64,"DCDC_MIN_V",0x0C00},
-+{42,255,"DCDC_XTRA",0x1000},
-+{43,66,"LOOP_CLOSE_TRES_LOW",0x1000},
-+};
-+
-+#include <dahdi/kernel.h>
-+
-+#include "fxo_modes.h"
-+
-+
-+#define NUM_FXO_REGS 60
-+
-+#define WC_MAX_IFACES 128
-+
-+#define WC_CNTL 0x00
-+#define WC_OPER 0x01
-+#define WC_AUXC 0x02
-+#define WC_AUXD 0x03
-+#define WC_MASK0 0x04
-+#define WC_MASK1 0x05
-+#define WC_INTSTAT 0x06
-+#define WC_AUXR 0x07
-+
-+#define WC_DMAWS 0x08
-+#define WC_DMAWI 0x0c
-+#define WC_DMAWE 0x10
-+#define WC_DMARS 0x18
-+#define WC_DMARI 0x1c
-+#define WC_DMARE 0x20
-+
-+#define WC_AUXFUNC 0x2b
-+#define WC_SERCTL 0x2d
-+#define WC_FSCDELAY 0x2f
-+
-+#define WC_REGBASE 0xc0
-+
-+#define WC_SYNC 0x0
-+#define WC_TEST 0x1
-+#define WC_CS 0x2
-+#define WC_CS1 0x6
-+#define WC_VER 0x3
-+#define YS_SLC 0x4
-+#define YS_DCH 0x7
-+#define YS_E0H 0x8
-+
-+#define BIT_SYNC (1 << 0)
-+#define BIT_CS (1 << 2)
-+#define BIT_SCLK (1 << 3)
-+#define BIT_SDI (1 << 4)
-+#define BIT_SDO (1 << 5)
-+
-+#define FLAG_EMPTY 0
-+#define FLAG_WRITE 1
-+#define FLAG_READ 2
-+
-+/* the constants below control the 'debounce' periods enforced by the
-+ check_hook routines; these routines are called once every 4 interrupts
-+ (the interrupt cycles around the four modules), so the periods are
-+ specified in _4 millisecond_ increments
-+*/
-+#define DEFAULT_RING_DEBOUNCE 32 /* Ringer Debounce (32 ms) */
-+
-+#define POLARITY_DEBOUNCE 32 /* Polarity debounce (32 ms) */
-+
-+#define OHT_TIMER 6000 /* How long after RING to retain OHT */
-+
-+/* NEON MWI pulse width - Make larger for longer period time
-+ * For more information on NEON MWI generation using the proslic
-+ * refer to Silicon Labs App Note "AN33-SI321X NEON FLASHING"
-+ * RNGY = RNGY 1/2 * Period * 8000
-+ */
-+#define NEON_MWI_RNGY_PULSEWIDTH 0x3e8 /*=> period of 250 mS */
-+
-+#define FLAG_3215 (1 << 0)
-+
-+#define NUM_CARDS 16
-+
-+#define MAX_ALARMS 10
-+
-+#define MOD_TYPE_FXS 0
-+#define MOD_TYPE_FXO 1
-+
-+#define MINPEGTIME 10 * 8 /* 30 ms peak to peak gets us no more than 100 Hz */
-+#define PEGTIME 50 * 8 /* 50ms peak to peak gets us rings of 10 Hz or more */
-+#define PEGCOUNT 5 /* 5 cycles of pegging means RING */
-+
-+#define NUM_CAL_REGS 12
-+
-+struct calregs {
-+ unsigned char vals[NUM_CAL_REGS];
-+};
-+
-+enum proslic_power_warn {
-+ PROSLIC_POWER_UNKNOWN = 0,
-+ PROSLIC_POWER_ON,
-+ PROSLIC_POWER_WARNED,
-+};
-+
-+enum battery_state {
-+ BATTERY_UNKNOWN = 0,
-+ BATTERY_PRESENT,
-+ BATTERY_LOST,
-+};
-+
-+#define NUM_REGS 109
-+#define NUM_INDIRECT_REGS 105
-+
-+struct ystdm_stats {
-+ int tipvolt; /* TIP voltage (mV) */
-+ int ringvolt; /* RING voltage (mV) */
-+ int batvolt; /* VBAT voltage (mV) */
-+};
-+
-+struct ystdm_regs {
-+ unsigned char direct[NUM_REGS];
-+ unsigned short indirect[NUM_INDIRECT_REGS];
-+};
-+
-+struct ystdm_regop {
-+ int indirect;
-+ unsigned char reg;
-+ unsigned short val;
-+};
-+
-+struct ystdm_echo_coefs {
-+ unsigned char acim;
-+ unsigned char coef1;
-+ unsigned char coef2;
-+ unsigned char coef3;
-+ unsigned char coef4;
-+ unsigned char coef5;
-+ unsigned char coef6;
-+ unsigned char coef7;
-+ unsigned char coef8;
-+};
-+
-+#define WCTDM_GET_STATS _IOR (DAHDI_CODE, 60, struct ystdm_stats)
-+#define WCTDM_GET_REGS _IOR (DAHDI_CODE, 61, struct ystdm_regs)
-+#define WCTDM_SET_REG _IOW (DAHDI_CODE, 62, struct ystdm_regop)
-+#define WCTDM_SET_ECHOTUNE _IOW (DAHDI_CODE, 63, struct ystdm_echo_coefs)
-+
-+struct ystdm {
-+ struct pci_dev *dev;
-+ char *variety;
-+ struct dahdi_span span;
-+ struct dahdi_device *ddev;
-+ unsigned char ios;
-+ int usecount;
-+ unsigned int intcount;
-+ int dead;
-+ int pos;
-+ int flags[NUM_CARDS];
-+ int freeregion;
-+ int alt;
-+ int curcard;
-+ int cardflag; /* Bit-map of present cards */
-+ enum proslic_power_warn proslic_power;
-+ spinlock_t lock;
-+
-+ union {
-+ struct fxo {
-+#ifdef AUDIO_RINGCHECK
-+ unsigned int pegtimer;
-+ int pegcount;
-+ int peg;
-+ int ring;
-+#else
-+ int wasringing;
-+ int lastrdtx;
-+#endif
-+ int ringdebounce;
-+ int offhook;
-+ unsigned int battdebounce;
-+ unsigned int battalarm;
-+ enum battery_state battery;
-+ int lastpol;
-+ int polarity;
-+ int polaritydebounce;
-+ int readcid;
-+ unsigned int cidtimer;
-+ } fxo;
-+ struct fxs {
-+ int oldrxhook;
-+ int debouncehook;
-+ int lastrxhook;
-+ int debounce;
-+ int ohttimer;
-+ int idletxhookstate; /* IDLE changing hook state */
-+ int lasttxhook;
-+ int palarms;
-+ int reversepolarity; /* Reverse Line */
-+ int mwisendtype;
-+ struct dahdi_vmwi_info vmwisetting;
-+ int vmwi_active_messages;
-+ u32 vmwi_lrev:1; /* MWI Line Reversal*/
-+ u32 vmwi_hvdc:1; /* MWI High Voltage DC Idle line */
-+ u32 vmwi_hvac:1; /* MWI Neon High Voltage AC Idle line */
-+ u32 neonringing:1; /* Ring Generator is set for NEON */
-+ struct calregs calregs;
-+ } fxs;
-+ } mod[NUM_CARDS];
-+
-+ /* Receive hook state and debouncing */
-+ int modtype[NUM_CARDS];
-+ unsigned char reg0shadow[NUM_CARDS];
-+ unsigned char reg1shadow[NUM_CARDS];
-+
-+ unsigned long ioaddr;
-+ dma_addr_t readdma;
-+ dma_addr_t writedma;
-+ volatile unsigned int *writechunk; /* Double-word aligned write memory */
-+ volatile unsigned int *readchunk; /* Double-word aligned read memory */
-+ struct dahdi_chan _chans[NUM_CARDS];
-+ struct dahdi_chan *chans[NUM_CARDS];
-+};
-+
-+
-+struct ystdm_desc {
-+ char *name;
-+ int flags;
-+};
-+
-+static struct ystdm_desc ystdme = { "YSTDM16xx REV E", 0 };
-+static int acim2tiss[16] = { 0x0, 0x1, 0x4, 0x5, 0x7, 0x0, 0x0, 0x6, 0x0, 0x0, 0x0, 0x2, 0x0, 0x3 };
-+
-+static struct ystdm *ifaces[WC_MAX_IFACES];
-+
-+static void ystdm_release(struct ystdm *wc);
-+
-+static unsigned int fxovoltage;
-+static unsigned int battdebounce;
-+static unsigned int battalarm;
-+static unsigned int battthresh;
-+static int ringdebounce = DEFAULT_RING_DEBOUNCE;
-+/* times 4, because must be a multiple of 4ms: */
-+static int dialdebounce = 8 * 8;
-+static int fwringdetect = 0;
-+static int debug = 0;
-+static int robust = 0;
-+static int timingonly = 0;
-+static int lowpower = 0;
-+static int boostringer = 0;
-+static int fastringer = 0;
-+static int _opermode = 0;
-+static char *opermode = "FCC";
-+static int fxshonormode = 0;
-+static int alawoverride = 0;
-+static int dtmf = 0;
-+static int fastpickup = 0;
-+static int fxotxgain = 0;
-+static int fxorxgain = 0;
-+static int fxstxgain = 0;
-+static int fxsrxgain = 0;
-+
-+static int ystdm_init_proslic(struct ystdm *wc, int card, int fast , int manual, int sane);
-+static int ystdm_init_ring_generator_mode(struct ystdm *wc, int card);
-+static int ystdm_set_ring_generator_mode(struct ystdm *wc, int card, int mode);
-+
-+static inline void ystdm_transmitprep(struct ystdm *wc, unsigned char ints)
-+{
-+ volatile unsigned int *writechunk;
-+ int x;
-+ if (ints & 0x01)
-+ /* Write is at interrupt address. Start writing from normal offset */
-+ writechunk = wc->writechunk;
-+ else
-+ writechunk = wc->writechunk + DAHDI_CHUNKSIZE * (NUM_CARDS / 4);
-+ /* Calculate Transmission */
-+ dahdi_transmit(&wc->span);
-+
-+ for (x=0;x<DAHDI_CHUNKSIZE;x++) {
-+ /* Send a sample, as a 32-bit word */
-+ writechunk[4 * x] = 0;
-+ writechunk[4 * x + 1] = 0;
-+ writechunk[4 * x + 2] = 0;
-+ writechunk[4 * x + 3] = 0;
-+#ifdef __BIG_ENDIAN
-+ if (wc->cardflag & (1 << 15))
-+ writechunk[4 * x + 3] |= (wc->chans[15]->writechunk[x]);
-+ if (wc->cardflag & (1 << 14))
-+ writechunk[4 * x + 3] |= (wc->chans[14]->writechunk[x] << 8);
-+ if (wc->cardflag & (1 << 13))
-+ writechunk[4 * x + 3] |= (wc->chans[13]->writechunk[x] << 16);
-+ if (wc->cardflag & (1 << 12))
-+ writechunk[4 * x + 3] |= (wc->chans[12]->writechunk[x] << 24);
-+
-+ if (wc->cardflag & (1 << 11))
-+ writechunk[4 * x + 2] |= (wc->chans[11]->writechunk[x]);
-+ if (wc->cardflag & (1 << 10))
-+ writechunk[4 * x + 2] |= (wc->chans[10]->writechunk[x] << 8);
-+ if (wc->cardflag & (1 << 9))
-+ writechunk[4 * x + 2] |= (wc->chans[9]->writechunk[x] << 16);
-+ if (wc->cardflag & (1 << 8))
-+ writechunk[4 * x + 2] |= (wc->chans[8]->writechunk[x] << 24);
-+
-+ if (wc->cardflag & (1 << 7))
-+ writechunk[4 * x + 1] |= (wc->chans[7]->writechunk[x]);
-+ if (wc->cardflag & (1 << 6))
-+ writechunk[4 * x + 1] |= (wc->chans[6]->writechunk[x] << 8);
-+ if (wc->cardflag & (1 << 5))
-+ writechunk[4 * x + 1] |= (wc->chans[5]->writechunk[x] << 16);
-+ if (wc->cardflag & (1 << 4))
-+ writechunk[4 * x + 1] |= (wc->chans[4]->writechunk[x] << 24);
-+
-+ if (wc->cardflag & (1 << 3))
-+ writechunk[4 * x + 0] |= (wc->chans[3]->writechunk[x]);
-+ if (wc->cardflag & (1 << 2))
-+ writechunk[4 * x + 0] |= (wc->chans[2]->writechunk[x] << 8);
-+ if (wc->cardflag & (1 << 1))
-+ writechunk[4 * x + 0] |= (wc->chans[1]->writechunk[x] << 16);
-+ if (wc->cardflag & (1 << 0))
-+ writechunk[4 * x + 0] |= (wc->chans[0]->writechunk[x] << 24);
-+#else
-+ if (wc->cardflag & (1 << 15))
-+ writechunk[4 * x + 3] |= (wc->chans[15]->writechunk[x] << 24);
-+ if (wc->cardflag & (1 << 14))
-+ writechunk[4 * x + 3] |= (wc->chans[14]->writechunk[x] << 16);
-+ if (wc->cardflag & (1 << 13))
-+ writechunk[4 * x + 3] |= (wc->chans[13]->writechunk[x] << 8);
-+ if (wc->cardflag & (1 << 12))
-+ writechunk[4 * x + 3] |= (wc->chans[12]->writechunk[x]);
-+
-+ if (wc->cardflag & (1 << 11))
-+ writechunk[4 * x + 2] |= (wc->chans[11]->writechunk[x] << 24);
-+ if (wc->cardflag & (1 << 10))
-+ writechunk[4 * x + 2] |= (wc->chans[10]->writechunk[x] << 16);
-+ if (wc->cardflag & (1 << 9))
-+ writechunk[4 * x + 2] |= (wc->chans[9]->writechunk[x] << 8);
-+ if (wc->cardflag & (1 << 8))
-+ writechunk[4 * x + 2] |= (wc->chans[8]->writechunk[x]);
-+
-+ if (wc->cardflag & (1 << 7))
-+ writechunk[4 * x + 1] |= (wc->chans[7]->writechunk[x] << 24);
-+ if (wc->cardflag & (1 << 6))
-+ writechunk[4 * x + 1] |= (wc->chans[6]->writechunk[x] << 16);
-+ if (wc->cardflag & (1 << 5))
-+ writechunk[4 * x + 1] |= (wc->chans[5]->writechunk[x] << 8);
-+ if (wc->cardflag & (1 << 4))
-+ writechunk[4 * x + 1] |= (wc->chans[4]->writechunk[x]);
-+
-+ if (wc->cardflag & (1 << 3))
-+ writechunk[4 * x + 0] |= (wc->chans[3]->writechunk[x] << 24);
-+ if (wc->cardflag & (1 << 2))
-+ writechunk[4 * x + 0] |= (wc->chans[2]->writechunk[x] << 16);
-+ if (wc->cardflag & (1 << 1))
-+ writechunk[4 * x + 0] |= (wc->chans[1]->writechunk[x] << 8);
-+ if (wc->cardflag & (1 << 0))
-+ writechunk[4 * x + 0] |= (wc->chans[0]->writechunk[x]);
-+#endif
-+ }
-+
-+}
-+
-+#ifdef AUDIO_RINGCHECK
-+static inline void ring_check(struct ystdm *wc, int card)
-+{
-+ int x;
-+ short sample;
-+ if (wc->modtype[card] != MOD_TYPE_FXO)
-+ return;
-+ wc->mod[card].fxo.pegtimer += DAHDI_CHUNKSIZE;
-+ for (x=0;x<DAHDI_CHUNKSIZE;x++) {
-+ /* Look for pegging to indicate ringing */
-+ sample = DAHDI_XLAW(wc->chans[card]->readchunk[x], (wc->chans[card]));
-+ if ((sample > 10000) && (wc->mod[card].fxo.peg != 1)) {
-+ if (debug > 1) printk("High peg!\n");
-+ if ((wc->mod[card].fxo.pegtimer < PEGTIME) && (wc->mod[card].fxo.pegtimer > MINPEGTIME))
-+ wc->mod[card].fxo.pegcount++;
-+ wc->mod[card].fxo.pegtimer = 0;
-+ wc->mod[card].fxo.peg = 1;
-+ } else if ((sample < -10000) && (wc->mod[card].fxo.peg != -1)) {
-+ if (debug > 1) printk("Low peg!\n");
-+ if ((wc->mod[card].fxo.pegtimer < (PEGTIME >> 2)) && (wc->mod[card].fxo.pegtimer > (MINPEGTIME >> 2)))
-+ wc->mod[card].fxo.pegcount++;
-+ wc->mod[card].fxo.pegtimer = 0;
-+ wc->mod[card].fxo.peg = -1;
-+ }
-+ }
-+ if (wc->mod[card].fxo.pegtimer > PEGTIME) {
-+ /* Reset pegcount if our timer expires */
-+ wc->mod[card].fxo.pegcount = 0;
-+ }
-+ /* Decrement debouncer if appropriate */
-+ if (wc->mod[card].fxo.ringdebounce)
-+ wc->mod[card].fxo.ringdebounce--;
-+ if (!wc->mod[card].fxo.offhook && !wc->mod[card].fxo.ringdebounce) {
-+ if (!wc->mod[card].fxo.ring && (wc->mod[card].fxo.pegcount > PEGCOUNT)) {
-+ /* It's ringing */
-+ if (debug)
-+ printk("RING on %d/%d!\n", wc->span.spanno, card + 1);
-+ if (!wc->mod[card].fxo.offhook)
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_RING);
-+ wc->mod[card].fxo.ring = 1;
-+ wc->mod[card].fxo.readcid = 1;
-+ }
-+ if (wc->mod[card].fxo.ring && !wc->mod[card].fxo.pegcount) {
-+ /* No more ring */
-+ if (debug)
-+ printk("NO RING on %d/%d!\n", wc->span.spanno, card + 1);
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_OFFHOOK);
-+ wc->mod[card].fxo.ring = 0;
-+ wc->mod[card].fxo.cidtimer = wc->intcount;
-+ wc->mod[card].fxo.readcid = 0;
-+ }
-+ }
-+}
-+#endif
-+static inline void ystdm_dtmfcheck_fakepolarity(struct ystdm *wc, int card, int x)
-+{
-+ int sample;
-+ /* only look for sound on the line if dtmf flag is on, it is an fxo card and line is onhook */
-+ if (!dtmf || !(wc->cardflag & (1 << card)) || !(wc->modtype[card] == MOD_TYPE_FXO) || wc->mod[card].fxo.offhook )
-+ return;
-+
-+ /* don't look for noise if we're already processing it, or there is a ringing tone */
-+ if(!wc->mod[card].fxo.readcid && !wc->mod[card].fxo.wasringing &&
-+ wc->intcount > wc->mod[card].fxo.cidtimer + 400 ) {
-+ sample = DAHDI_XLAW(wc->chans[card]->readchunk[x], (wc->chans[card]));
-+ if (sample > 16000 || sample < -16000) {
-+ wc->mod[card].fxo.readcid = 1;
-+ wc->mod[card].fxo.cidtimer = wc->intcount;
-+ if (debug) printk("DTMF CLIP on %i\n",card+1);
-+ dahdi_qevent_lock(wc->chans[card], DAHDI_EVENT_POLARITY);
-+ }
-+ } else if(wc->mod[card].fxo.readcid && wc->intcount > wc->mod[card].fxo.cidtimer + 2000) {
-+ /* reset flags if it's been a while */
-+ wc->mod[card].fxo.cidtimer = wc->intcount;
-+ wc->mod[card].fxo.readcid = 0;
-+ }
-+}
-+static inline void ystdm_receiveprep(struct ystdm *wc, unsigned char ints)
-+{
-+ volatile unsigned int *readchunk;
-+ int x;
-+ int y;
-+
-+ if (ints & 0x08)
-+ readchunk = wc->readchunk + DAHDI_CHUNKSIZE * (NUM_CARDS / 4);
-+ else
-+ /* Read is at interrupt address. Valid data is available at normal offset */
-+ readchunk = wc->readchunk;
-+ for (x=0;x<DAHDI_CHUNKSIZE;x++) {
-+#ifdef __BIG_ENDIAN
-+ if (wc->cardflag & (1 << 15))
-+ wc->chans[15]->readchunk[x] = (readchunk[4 * x]) & 0xff;
-+ if (wc->cardflag & (1 << 14))
-+ wc->chans[14]->readchunk[x] = (readchunk[4 * x] >> 8) & 0xff;
-+ if (wc->cardflag & (1 << 13))
-+ wc->chans[13]->readchunk[x] = (readchunk[4 * x] >> 16) & 0xff;
-+ if (wc->cardflag & (1 << 12))
-+ wc->chans[12]->readchunk[x] = (readchunk[4 * x] >> 24) & 0xff;
-+
-+ if (wc->cardflag & (1 << 11))
-+ wc->chans[11]->readchunk[x] = (readchunk[4 * x + 3]) & 0xff;
-+ if (wc->cardflag & (1 << 10))
-+ wc->chans[10]->readchunk[x] = (readchunk[4 * x + 3] >> 8) & 0xff;
-+ if (wc->cardflag & (1 << 9))
-+ wc->chans[9]->readchunk[x] = (readchunk[4 * x + 3] >> 16) & 0xff;
-+ if (wc->cardflag & (1 << 8))
-+ wc->chans[8]->readchunk[x] = (readchunk[4 * x + 3] >> 24) & 0xff;
-+
-+ if (wc->cardflag & (1 << 7))
-+ wc->chans[7]->readchunk[x] = (readchunk[4 * x + 2]) & 0xff;
-+ if (wc->cardflag & (1 << 6))
-+ wc->chans[6]->readchunk[x] = (readchunk[4 * x + 2] >> 8) & 0xff;
-+ if (wc->cardflag & (1 << 5))
-+ wc->chans[5]->readchunk[x] = (readchunk[4 * x + 2] >> 16) & 0xff;
-+ if (wc->cardflag & (1 << 4))
-+ wc->chans[4]->readchunk[x] = (readchunk[4 * x + 2] >> 24) & 0xff;
-+
-+ if (wc->cardflag & (1 << 3))
-+ wc->chans[3]->readchunk[x] = (readchunk[4 * x + 1]) & 0xff;
-+ if (wc->cardflag & (1 << 2))
-+ wc->chans[2]->readchunk[x] = (readchunk[4 * x + 1] >> 8) & 0xff;
-+ if (wc->cardflag & (1 << 1))
-+ wc->chans[1]->readchunk[x] = (readchunk[4 * x + 1] >> 16) & 0xff;
-+ if (wc->cardflag & (1 << 0))
-+ wc->chans[0]->readchunk[x] = (readchunk[4 * x + 1] >> 24) & 0xff;
-+#else
-+ if (wc->cardflag & (1 << 15))
-+ wc->chans[15]->readchunk[x] = (readchunk[4 * x] >> 24) & 0xff;
-+ if (wc->cardflag & (1 << 14))
-+ wc->chans[14]->readchunk[x] = (readchunk[4 * x] >> 16) & 0xff;
-+ if (wc->cardflag & (1 << 13))
-+ wc->chans[13]->readchunk[x] = (readchunk[4 * x] >> 8) & 0xff;
-+ if (wc->cardflag & (1 << 12))
-+ wc->chans[12]->readchunk[x] = (readchunk[4 * x]) & 0xff;
-+
-+ if (wc->cardflag & (1 << 11))
-+ wc->chans[11]->readchunk[x] = (readchunk[4 * x + 3] >> 24) & 0xff;
-+ if (wc->cardflag & (1 << 10))
-+ wc->chans[10]->readchunk[x] = (readchunk[4 * x + 3] >> 16) & 0xff;
-+ if (wc->cardflag & (1 << 9))
-+ wc->chans[9]->readchunk[x] = (readchunk[4 * x + 3] >> 8) & 0xff;
-+ if (wc->cardflag & (1 << 8))
-+ wc->chans[8]->readchunk[x] = (readchunk[4 * x + 3]) & 0xff;
-+
-+ if (wc->cardflag & (1 << 7))
-+ wc->chans[7]->readchunk[x] = (readchunk[4 * x + 2] >> 24) & 0xff;
-+ if (wc->cardflag & (1 << 6))
-+ wc->chans[6]->readchunk[x] = (readchunk[4 * x + 2] >> 16) & 0xff;
-+ if (wc->cardflag & (1 << 5))
-+ wc->chans[5]->readchunk[x] = (readchunk[4 * x + 2] >> 8) & 0xff;
-+ if (wc->cardflag & (1 << 4))
-+ wc->chans[4]->readchunk[x] = (readchunk[4 * x + 2]) & 0xff;
-+
-+ if (wc->cardflag & (1 << 3))
-+ wc->chans[3]->readchunk[x] = (readchunk[4 * x + 1] >> 24) & 0xff;
-+ if (wc->cardflag & (1 << 2))
-+ wc->chans[2]->readchunk[x] = (readchunk[4 * x + 1] >> 16) & 0xff;
-+ if (wc->cardflag & (1 << 1))
-+ wc->chans[1]->readchunk[x] = (readchunk[4 * x + 1] >> 8) & 0xff;
-+ if (wc->cardflag & (1 << 0))
-+ wc->chans[0]->readchunk[x] = (readchunk[4 * x + 1]) & 0xff;
-+
-+#endif
-+ for(y = 0; y < NUM_CARDS; y ++)
-+ ystdm_dtmfcheck_fakepolarity(wc,y,x);
-+ }
-+#ifdef AUDIO_RINGCHECK
-+ for (x=0;x<wc->cards;x++)
-+ ring_check(wc, x);
-+#endif
-+ /* XXX We're wasting 8 taps. We should get closer :( */
-+ for (x = 0; x < NUM_CARDS; x++) {
-+ if (wc->cardflag & (1 << x))
-+ dahdi_ec_chunk(wc->chans[x], wc->chans[x]->readchunk, wc->chans[x]->writechunk);
-+ }
-+ dahdi_receive(&wc->span);
-+}
-+
-+static void ystdm_stop_dma(struct ystdm *wc);
-+static void ystdm_reset_tdm(struct ystdm *wc);
-+static void ystdm_restart_dma(struct ystdm *wc);
-+
-+static inline void __write_8bits(struct ystdm *wc, unsigned char bits)
-+{
-+/* Out BIT_CS --\________________________________/---- */
-+/* Out BIT_SCLK ---\_/-\_/-\_/-\_/-\_/-\_/-\_/-\_/------ */
-+/* Out BIT_SDI ---\___/---\___/---\___/---\___/-------- */
-+/* Data Bit 7 6 5 4 3 2 1 0 */
-+/* Data written 0 1 0 1 0 1 0 1 */
-+ /* Drop chip select */
-+ int x;
-+ wc->ios &= ~BIT_CS;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ for (x=0;x<8;x++) {
-+ /* Send out each bit, MSB first, drop SCLK as we do so */
-+ if (bits & 0x80)
-+ wc->ios |= BIT_SDI;
-+ else
-+ wc->ios &= ~BIT_SDI;
-+ wc->ios &= ~BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ /* Now raise SCLK high again and repeat */
-+ wc->ios |= BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ bits <<= 1;
-+ }
-+ /* Finally raise CS back high again */
-+ wc->ios |= BIT_CS;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+
-+}
-+
-+static inline void __reset_spi(struct ystdm *wc)
-+{
-+ /* Drop chip select and clock once and raise and clock once */
-+ wc->ios |= BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ wc->ios &= ~BIT_CS;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ wc->ios |= BIT_SDI;
-+ wc->ios &= ~BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ /* Now raise SCLK high again and repeat */
-+ wc->ios |= BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ /* Finally raise CS back high again */
-+ wc->ios |= BIT_CS;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ /* Clock again */
-+ wc->ios &= ~BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ /* Now raise SCLK high again and repeat */
-+ wc->ios |= BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+
-+}
-+
-+static inline unsigned char __read_8bits(struct ystdm *wc)
-+{
-+/* Out BIT_CS --\________________________________________/----*/
-+/* Out BIT_SCLK ---\_/--\_/--\_/--\_/--\_/--\_/--\_/--\_/-------*/
-+/* In BIT_SDO ????/1111\0000/1111\0000/1111\0000/1111\0000/???*/
-+/* Data bit 7 6 5 4 3 2 1 0 */
-+/* Data Read 1 0 1 0 1 0 1 0 */
-+
-+/* Note: Clock High time is 2x Low time, due to input read */
-+
-+ unsigned char res=0, c;
-+ int x;
-+ /* Drop chip select */
-+ wc->ios &= ~BIT_CS;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ for (x=0;x<8;x++) {
-+ res <<= 1;
-+ /* Drop SCLK */
-+ wc->ios &= ~BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ /* Now raise SCLK high again */
-+ wc->ios |= BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+
-+ /* Read back the value */
-+ c = inb(wc->ioaddr + WC_AUXR);
-+ if (c & BIT_SDO)
-+ res |= 1;
-+ }
-+ /* Finally raise CS back high again */
-+ wc->ios |= BIT_CS;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+
-+ /* And return our result */
-+ return res;
-+}
-+
-+static void __ystdm_setcreg(struct ystdm *wc, unsigned char reg, unsigned char val)
-+{
-+ outb(val, wc->ioaddr + WC_REGBASE + ((reg & 0xf) << 2));
-+}
-+
-+static unsigned char __ystdm_getcreg(struct ystdm *wc, unsigned char reg)
-+{
-+ return inb(wc->ioaddr + WC_REGBASE + ((reg & 0xf) << 2));
-+}
-+
-+static inline void __ystdm_setcard(struct ystdm *wc, int card)
-+{
-+ if (wc->curcard == card)
-+ return;
-+ if (card < NUM_CARDS/2) {
-+ __ystdm_setcreg(wc, WC_CS1, 0);
-+ __ystdm_setcreg(wc, WC_CS, (1 << card));
-+ } else {
-+ __ystdm_setcreg(wc, WC_CS, 0);
-+ __ystdm_setcreg(wc, WC_CS1, (1 << (card-8)));
-+ }
-+ wc->curcard = card;
-+}
-+
-+static void __ystdm_setreg(struct ystdm *wc, int card, unsigned char reg, unsigned char value)
-+{
-+ __ystdm_setcard(wc, card);
-+ if (wc->modtype[card] == MOD_TYPE_FXO) {
-+ __write_8bits(wc, 0x20);
-+ __write_8bits(wc, reg & 0x7f);
-+ } else {
-+ __write_8bits(wc, reg & 0x7f);
-+ }
-+ __write_8bits(wc, value);
-+}
-+
-+static void ystdm_setreg(struct ystdm *wc, int card, unsigned char reg, unsigned char value)
-+{
-+ unsigned long flags;
-+ spin_lock_irqsave(&wc->lock, flags);
-+ __ystdm_setreg(wc, card, reg, value);
-+ spin_unlock_irqrestore(&wc->lock, flags);
-+}
-+
-+static unsigned char __ystdm_getreg(struct ystdm *wc, int card, unsigned char reg)
-+{
-+ __ystdm_setcard(wc, card);
-+ if (wc->modtype[card] == MOD_TYPE_FXO) {
-+ __write_8bits(wc, 0x60);
-+ __write_8bits(wc, reg & 0x7f);
-+ } else {
-+ __write_8bits(wc, reg | 0x80);
-+ }
-+ return __read_8bits(wc);
-+}
-+
-+static inline void reset_spi(struct ystdm *wc, int card)
-+{
-+ unsigned long flags;
-+ spin_lock_irqsave(&wc->lock, flags);
-+ __ystdm_setcard(wc, card);
-+ __reset_spi(wc);
-+ __reset_spi(wc);
-+ spin_unlock_irqrestore(&wc->lock, flags);
-+}
-+
-+static unsigned char ystdm_getreg(struct ystdm *wc, int card, unsigned char reg)
-+{
-+ unsigned long flags;
-+ unsigned char res;
-+ spin_lock_irqsave(&wc->lock, flags);
-+ res = __ystdm_getreg(wc, card, reg);
-+ spin_unlock_irqrestore(&wc->lock, flags);
-+ return res;
-+}
-+
-+static int __wait_access(struct ystdm *wc, int card)
-+{
-+ unsigned char data = 0;
-+
-+ int count = 0;
-+
-+ #define MAX 6000 /* attempts */
-+
-+ /* Wait for indirect access */
-+ while (count++ < MAX)
-+ {
-+ data = __ystdm_getreg(wc, card, I_STATUS);
-+
-+ if (!data)
-+ return 0;
-+
-+ }
-+
-+ if(count > (MAX-1)) printk(" ##### Loop error (%02x) #####\n", data);
-+
-+ return 0;
-+}
-+
-+static unsigned char translate_3215(unsigned char address)
-+{
-+ int x;
-+ for (x=0;x<sizeof(indirect_regs)/sizeof(indirect_regs[0]);x++) {
-+ if (indirect_regs[x].address == address) {
-+ address = indirect_regs[x].altaddr;
-+ break;
-+ }
-+ }
-+ return address;
-+}
-+
-+static int ystdm_proslic_setreg_indirect(struct ystdm *wc, int card, unsigned char address, unsigned short data)
-+{
-+ unsigned long flags;
-+ int res = -1;
-+ /* Translate 3215 addresses */
-+ if (wc->flags[card] & FLAG_3215) {
-+ address = translate_3215(address);
-+ if (address == 255)
-+ return 0;
-+ }
-+ spin_lock_irqsave(&wc->lock, flags);
-+ if(!__wait_access(wc, card)) {
-+ __ystdm_setreg(wc, card, IDA_LO,(unsigned char)(data & 0xFF));
-+ __ystdm_setreg(wc, card, IDA_HI,(unsigned char)((data & 0xFF00)>>8));
-+ __ystdm_setreg(wc, card, IAA,address);
-+ res = 0;
-+ };
-+ spin_unlock_irqrestore(&wc->lock, flags);
-+ return res;
-+}
-+
-+static int ystdm_proslic_getreg_indirect(struct ystdm *wc, int card, unsigned char address)
-+{
-+ unsigned long flags;
-+ int res = -1;
-+ char *p=NULL;
-+ /* Translate 3215 addresses */
-+ if (wc->flags[card] & FLAG_3215) {
-+ address = translate_3215(address);
-+ if (address == 255)
-+ return 0;
-+ }
-+ spin_lock_irqsave(&wc->lock, flags);
-+ if (!__wait_access(wc, card)) {
-+ __ystdm_setreg(wc, card, IAA, address);
-+ if (!__wait_access(wc, card)) {
-+ unsigned char data1, data2;
-+ data1 = __ystdm_getreg(wc, card, IDA_LO);
-+ data2 = __ystdm_getreg(wc, card, IDA_HI);
-+ res = data1 | (data2 << 8);
-+ } else
-+ p = "Failed to wait inside\n";
-+ } else
-+ p = "failed to wait\n";
-+ spin_unlock_irqrestore(&wc->lock, flags);
-+ if (p)
-+ printk(p);
-+ return res;
-+}
-+
-+static int ystdm_proslic_init_indirect_regs(struct ystdm *wc, int card)
-+{
-+ unsigned char i;
-+
-+ for (i=0; i<sizeof(indirect_regs) / sizeof(indirect_regs[0]); i++)
-+ {
-+ if(ystdm_proslic_setreg_indirect(wc, card, indirect_regs[i].address,indirect_regs[i].initial))
-+ return -1;
-+ }
-+
-+ return 0;
-+}
-+
-+static int ystdm_proslic_verify_indirect_regs(struct ystdm *wc, int card)
-+{
-+ int passed = 1;
-+ unsigned short i, initial;
-+ int j;
-+
-+ for (i=0; i<sizeof(indirect_regs) / sizeof(indirect_regs[0]); i++)
-+ {
-+ if((j = ystdm_proslic_getreg_indirect(wc, card, (unsigned char) indirect_regs[i].address)) < 0) {
-+ printk("Failed to read indirect register %d\n", i);
-+ return -1;
-+ }
-+ initial= indirect_regs[i].initial;
-+
-+ if ( j != initial && (!(wc->flags[card] & FLAG_3215) || (indirect_regs[i].altaddr != 255)))
-+ {
-+ printk("!!!!!!! %s iREG %X = %X should be %X\n",
-+ indirect_regs[i].name,indirect_regs[i].address,j,initial );
-+ passed = 0;
-+ }
-+ }
-+
-+ if (passed) {
-+ if (debug)
-+ printk("Init Indirect Registers completed successfully.\n");
-+ } else {
-+ printk(" !!!!! Init Indirect Registers UNSUCCESSFULLY.\n");
-+ return -1;
-+ }
-+ return 0;
-+}
-+
-+static inline void ystdm_proslic_recheck_sanity(struct ystdm *wc, int card)
-+{
-+ struct fxs *const fxs = &wc->mod[card].fxs;
-+ int res;
-+ /* Check loopback */
-+ res = wc->reg1shadow[card];
-+ if (!res && (res != fxs->lasttxhook)) {
-+ res = ystdm_getreg(wc, card, 8);
-+ if (res) {
-+ printk(KERN_NOTICE "Ouch, part reset, quickly restoring reality (%d)\n", card);
-+ ystdm_init_proslic(wc, card, 1, 0, 1);
-+ } else {
-+ if (fxs->palarms++ < MAX_ALARMS) {
-+ printk(KERN_NOTICE "Power alarm on module %d, resetting!\n", card + 1);
-+ if (fxs->lasttxhook == SLIC_LF_RINGING)
-+ fxs->lasttxhook = SLIC_LF_ACTIVE_FWD;
-+ ystdm_setreg(wc, card, 64, fxs->lasttxhook);
-+ } else {
-+ if (fxs->palarms == MAX_ALARMS)
-+ printk(KERN_NOTICE "Too many power alarms on card %d, NOT resetting!\n", card + 1);
-+ }
-+ }
-+ }
-+}
-+
-+static inline void ystdm_voicedaa_check_hook(struct ystdm *wc, int card)
-+{
-+#define MS_PER_CHECK_HOOK 16
-+
-+#ifndef AUDIO_RINGCHECK
-+ unsigned char res;
-+#endif
-+ signed char b;
-+ int poopy = 0;
-+ struct fxo *fxo = &wc->mod[card].fxo;
-+
-+ /* Try to track issues that plague slot one FXO's */
-+ b = wc->reg0shadow[card];
-+ if ((b & 0x2) || !(b & 0x8)) {
-+ /* Not good -- don't look at anything else */
-+ if (debug)
-+ printk("Poopy (%02x) on card %d!\n", b, card + 1);
-+ poopy++;
-+ }
-+ b &= 0x9b;
-+ if (fxo->offhook) {
-+ if (b != 0x9)
-+ ystdm_setreg(wc, card, 5, 0x9);
-+ } else {
-+ if (b != 0x8)
-+ ystdm_setreg(wc, card, 5, 0x8);
-+ }
-+ if (poopy)
-+ return;
-+ if (!fxo->offhook) {
-+ if (fwringdetect) {
-+ res = wc->reg0shadow[card] & 0x60;
-+ if (fxo->ringdebounce--) {
-+ if (res && (res != fxo->lastrdtx) &&
-+ (fxo->battery == BATTERY_PRESENT)) {
-+ if (!fxo->wasringing) {
-+ fxo->wasringing = 1;
-+ if (debug)
-+ printk("RING on %d/%d!\n", wc->span.spanno, card + 1);
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_RING);
-+ }
-+ fxo->lastrdtx = res;
-+ fxo->ringdebounce = 10;
-+ } else if (!res) {
-+ if ((fxo->ringdebounce == 0) && fxo->wasringing) {
-+ fxo->wasringing = 0;
-+ if (debug)
-+ printk("NO RING on %d/%d!\n", wc->span.spanno, card + 1);
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_OFFHOOK);
-+ }
-+ }
-+ } else if (res && (fxo->battery == BATTERY_PRESENT)) {
-+ fxo->lastrdtx = res;
-+ fxo->ringdebounce = 10;
-+ }
-+ } else {
-+ res = wc->reg0shadow[card];
-+ if ((res & 0x60) && (fxo->battery == BATTERY_PRESENT)) {
-+ fxo->ringdebounce += (DAHDI_CHUNKSIZE * 16);
-+ if (fxo->ringdebounce >= DAHDI_CHUNKSIZE * ringdebounce) {
-+ if (!fxo->wasringing) {
-+ fxo->wasringing = 1;
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_RING);
-+ if (debug)
-+ printk("RING on %d/%d!\n", wc->span.spanno, card + 1);
-+ }
-+ fxo->ringdebounce = DAHDI_CHUNKSIZE * ringdebounce;
-+ }
-+ } else {
-+ fxo->ringdebounce -= DAHDI_CHUNKSIZE * 4;
-+ if (fxo->ringdebounce <= 0) {
-+ if (fxo->wasringing) {
-+ fxo->wasringing = 0;
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_OFFHOOK);
-+ if (debug)
-+ printk("NO RING on %d/%d!\n", wc->span.spanno, card + 1);
-+ }
-+ fxo->ringdebounce = 0;
-+ }
-+ }
-+ }
-+ }
-+
-+ b = wc->reg1shadow[card];
-+
-+ if (fxovoltage) {
-+ static int count = 0;
-+ if (!(count++ % 100)) {
-+ printk(KERN_DEBUG "Card %d: Voltage: %d Debounce %d\n", card + 1, b, fxo->battdebounce);
-+ }
-+ }
-+
-+ if (unlikely(DAHDI_RXSIG_INITIAL == wc->chans[card]->rxhooksig)) {
-+ /*
-+ * dahdi-base will set DAHDI_RXSIG_INITIAL after a
-+ * DAHDI_STARTUP or DAHDI_CHANCONFIG ioctl so that new events
-+ * will be queued on the channel with the current received
-+ * hook state. Channels that use robbed-bit signalling always
-+ * report the current received state via the dahdi_rbsbits
-+ * call. Since we only call dahdi_hooksig when we've detected
-+ * a change to report, let's forget our current state in order
-+ * to force us to report it again via dahdi_hooksig.
-+ *
-+ */
-+ fxo->battery = BATTERY_UNKNOWN;
-+ }
-+
-+if (DAHDI_RXSIG_INITIAL == wc->chans[card]->rxhooksig) {
-+ /* If we've been set to the initial state, let's reset the
-+ * battery state to unknown so that we will reset the
-+ * current state of the battery and call dahdi_hooksig. */
-+ fxo->battery = BATTERY_UNKNOWN;
-+ } /* add by David at 2009.09.10 */
-+
-+ if (abs(b) < battthresh) {
-+ /* possible existing states:
-+ battery lost, no debounce timer
-+ battery lost, debounce timer (going to battery present)
-+ battery present or unknown, no debounce timer
-+ battery present or unknown, debounce timer (going to battery lost)
-+ */
-+
-+ if (fxo->battery == BATTERY_LOST) {
-+ if (fxo->battdebounce) {
-+ /* we were going to BATTERY_PRESENT, but battery was lost again,
-+ so clear the debounce timer */
-+ fxo->battdebounce = 0;
-+ }
-+ } else {
-+ if (fxo->battdebounce) {
-+ /* going to BATTERY_LOST, see if we are there yet */
-+ if (--fxo->battdebounce == 0) {
-+ fxo->battery = BATTERY_LOST;
-+ if (debug)
-+ printk("NO BATTERY on %d/%d!\n", wc->span.spanno, card + 1);
-+#ifdef JAPAN
-+ if (!wc->ohdebounce && wc->offhook) {
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_ONHOOK);
-+ if (debug)
-+ printk("Signalled On Hook\n");
-+#ifdef ZERO_BATT_RING
-+ wc->onhook++;
-+#endif
-+ }
-+#else
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_ONHOOK);
-+ /* set the alarm timer, taking into account that part of its time
-+ period has already passed while debouncing occurred */
-+ fxo->battalarm = (battalarm - battdebounce) / MS_PER_CHECK_HOOK;
-+#endif
-+ }
-+ } else {
-+ /* start the debounce timer to verify that battery has been lost */
-+ fxo->battdebounce = battdebounce / MS_PER_CHECK_HOOK;
-+ }
-+ }
-+ } else {
-+ /* possible existing states:
-+ battery lost or unknown, no debounce timer
-+ battery lost or unknown, debounce timer (going to battery present)
-+ battery present, no debounce timer
-+ battery present, debounce timer (going to battery lost)
-+ */
-+
-+ if (fxo->battery == BATTERY_PRESENT) {
-+ if (fxo->battdebounce) {
-+ /* we were going to BATTERY_LOST, but battery appeared again,
-+ so clear the debounce timer */
-+ fxo->battdebounce = 0;
-+ }
-+ } else {
-+ if (fxo->battdebounce) {
-+ /* going to BATTERY_PRESENT, see if we are there yet */
-+ if (--fxo->battdebounce == 0) {
-+ fxo->battery = BATTERY_PRESENT;
-+ if (debug)
-+ printk("BATTERY on %d/%d (%s)!\n", wc->span.spanno, card + 1,
-+ (b < 0) ? "-" : "+");
-+#ifdef ZERO_BATT_RING
-+ if (wc->onhook) {
-+ wc->onhook = 0;
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_OFFHOOK);
-+ if (debug)
-+ printk("Signalled Off Hook\n");
-+ }
-+#else
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_OFFHOOK);
-+#endif
-+ /* set the alarm timer, taking into account that part of its time
-+ period has already passed while debouncing occurred */
-+ fxo->battalarm = (battalarm - battdebounce) / MS_PER_CHECK_HOOK;
-+ }
-+ } else {
-+ /* start the debounce timer to verify that battery has appeared */
-+ fxo->battdebounce = battdebounce / MS_PER_CHECK_HOOK;
-+ }
-+ }
-+ }
-+ if (fxo->lastpol >= 0) {
-+ if (b < 0) {
-+ fxo->lastpol = -1;
-+ fxo->polaritydebounce = POLARITY_DEBOUNCE / MS_PER_CHECK_HOOK;
-+ }
-+ }
-+ if (fxo->lastpol <= 0) {
-+ if (b > 0) {
-+ fxo->lastpol = 1;
-+ fxo->polaritydebounce = POLARITY_DEBOUNCE / MS_PER_CHECK_HOOK;
-+ }
-+ }
-+
-+ if (fxo->battalarm) {
-+ if (--fxo->battalarm == 0) {
-+ /* the alarm timer has expired, so update the battery alarm state
-+ for this channel */
-+ dahdi_alarm_channel(wc->chans[card], fxo->battery ? DAHDI_ALARM_NONE : DAHDI_ALARM_RED);
-+ }
-+ }
-+
-+ if (fxo->polaritydebounce) {
-+ if (--fxo->polaritydebounce == 0) {
-+ if (fxo->lastpol != fxo->polarity) {
-+ if (debug)
-+ printk("%lu Polarity reversed (%d -> %d)\n", jiffies,
-+ fxo->polarity,
-+ fxo->lastpol);
-+ if (fxo->polarity)
-+ dahdi_qevent_lock(wc->chans[card], DAHDI_EVENT_POLARITY);
-+ fxo->polarity = fxo->lastpol;
-+ }
-+ }
-+ }
-+#undef MS_PER_CHECK_HOOK
-+}
-+
-+static void ystdm_fxs_hooksig(struct ystdm *wc, const int card, enum dahdi_txsig txsig)
-+{
-+ struct fxs *const fxs = &wc->mod[card].fxs;
-+ switch (txsig) {
-+ case DAHDI_TXSIG_ONHOOK:
-+ switch (wc->span.chans[card]->sig) {
-+ case DAHDI_SIG_FXOKS:
-+ case DAHDI_SIG_FXOLS:
-+ /* Can't change Ring Generator during OHT */
-+ if (!fxs->ohttimer) {
-+ ystdm_set_ring_generator_mode(wc,
-+ card, fxs->vmwi_hvac);
-+ fxs->lasttxhook = fxs->vmwi_hvac ?
-+ SLIC_LF_RINGING :
-+ fxs->idletxhookstate;
-+ } else {
-+ fxs->lasttxhook = fxs->idletxhookstate;
-+ }
-+ break;
-+ case DAHDI_SIG_EM:
-+ fxs->lasttxhook = fxs->idletxhookstate;
-+ break;
-+ case DAHDI_SIG_FXOGS:
-+ fxs->lasttxhook = SLIC_LF_TIP_OPEN;
-+ break;
-+ }
-+ break;
-+ case DAHDI_TXSIG_OFFHOOK:
-+ switch (wc->span.chans[card]->sig) {
-+ case DAHDI_SIG_EM:
-+ fxs->lasttxhook = SLIC_LF_ACTIVE_REV;
-+ break;
-+ default:
-+ fxs->lasttxhook = fxs->idletxhookstate;
-+ break;
-+ }
-+ break;
-+ case DAHDI_TXSIG_START:
-+ /* Set ringer mode */
-+ ystdm_set_ring_generator_mode(wc, card, 0);
-+ fxs->lasttxhook = SLIC_LF_RINGING;
-+ break;
-+ case DAHDI_TXSIG_KEWL:
-+ fxs->lasttxhook = SLIC_LF_OPEN;
-+ break;
-+ default:
-+ printk(KERN_NOTICE "ystdm: Can't set tx state to %d\n", txsig);
-+ return;
-+ }
-+ if (debug) {
-+ printk(KERN_DEBUG
-+ "Setting FXS hook state to %d (%02x)\n",
-+ txsig, fxs->lasttxhook);
-+ }
-+ ystdm_setreg(wc, card, LINE_STATE, fxs->lasttxhook);
-+}
-+
-+static inline void ystdm_proslic_check_hook(struct ystdm *wc, int card)
-+{
-+ struct fxs *const fxs = &wc->mod[card].fxs;
-+ char res;
-+ int hook;
-+
-+ /* For some reason we have to debounce the
-+ hook detector. */
-+
-+ res = wc->reg0shadow[card];
-+ hook = (res & 1);
-+ if (hook != fxs->lastrxhook) {
-+ /* Reset the debounce (must be multiple of 4ms) */
-+ fxs->debounce = dialdebounce * 4;
-+#if 0
-+ printk(KERN_DEBUG "Resetting debounce card %d hook %d, %d\n",
-+ card, hook, fxs->debounce);
-+#endif
-+ } else {
-+ if (fxs->debounce > 0) {
-+ fxs->debounce -= 16 * DAHDI_CHUNKSIZE;
-+#if 0
-+ printk(KERN_DEBUG "Sustaining hook %d, %d\n",
-+ hook, fxs->debounce);
-+#endif
-+ if (!fxs->debounce) {
-+#if 0
-+ printk(KERN_DEBUG "Counted down debounce, newhook: %d...\n", hook);
-+#endif
-+ fxs->debouncehook = hook;
-+ }
-+ if (!fxs->oldrxhook && fxs->debouncehook) {
-+ /* Off hook */
-+#if 1
-+ if (debug)
-+#endif
-+ printk(KERN_DEBUG "ystdm: Card %d Going off hook\n", card);
-+
-+ switch (fxs->lasttxhook) {
-+ case SLIC_LF_RINGING:
-+ case SLIC_LF_OHTRAN_FWD:
-+ case SLIC_LF_OHTRAN_REV:
-+ /* just detected OffHook, during
-+ * Ringing or OnHookTransfer */
-+ fxs->idletxhookstate =
-+ POLARITY_XOR ?
-+ SLIC_LF_ACTIVE_REV :
-+ SLIC_LF_ACTIVE_FWD;
-+ break;
-+ }
-+
-+ ystdm_fxs_hooksig(wc, card, DAHDI_TXSIG_OFFHOOK);
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_OFFHOOK);
-+ if (robust)
-+ ystdm_init_proslic(wc, card, 1, 0, 1);
-+ fxs->oldrxhook = 1;
-+
-+ } else if (fxs->oldrxhook && !fxs->debouncehook) {
-+ /* On hook */
-+#if 1
-+ if (debug)
-+#endif
-+ printk(KERN_DEBUG "ystdm: Card %d Going on hook\n", card);
-+ ystdm_fxs_hooksig(wc, card, DAHDI_TXSIG_ONHOOK);
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_ONHOOK);
-+ fxs->oldrxhook = 0;
-+ }
-+ }
-+ }
-+ fxs->lastrxhook = hook;
-+}
-+
-+DAHDI_IRQ_HANDLER(ystdm_interrupt)
-+{
-+ struct ystdm *wc = dev_id;
-+ unsigned char ints;
-+ int x;
-+ int mode;
-+
-+ ints = inb(wc->ioaddr + WC_INTSTAT);
-+ outb(ints, wc->ioaddr + WC_INTSTAT);
-+
-+ if (!ints)
-+ return IRQ_NONE;
-+
-+ outb(ints, wc->ioaddr + WC_INTSTAT);
-+
-+ if (ints & 0x10) {
-+ /* Stop DMA, wait for watchdog */
-+ printk("TDM PCI Master abort\n");
-+ ystdm_stop_dma(wc);
-+
-+ return IRQ_RETVAL(1);
-+
-+ }
-+
-+ if (ints & 0x20) {
-+ printk("PCI Target abort\n");
-+ return IRQ_RETVAL(1);
-+ }
-+
-+ for (x=0;x<NUM_CARDS;x++) {
-+ if (wc->cardflag & (1 << x) &&
-+ (wc->modtype[x] == MOD_TYPE_FXS)) {
-+ struct fxs *const fxs = &wc->mod[x].fxs;
-+ if (fxs->lasttxhook == SLIC_LF_RINGING &&
-+ !fxs->neonringing) {
-+ /* RINGing, prepare for OHT */
-+ fxs->ohttimer = OHT_TIMER << 3;
-+
-+ /* logical XOR 3 variables
-+ module parameter 'reversepolarity', global reverse all FXS lines.
-+ ioctl channel variable fxs 'reversepolarity', Line Reversal Alert Signal if required.
-+ ioctl channel variable fxs 'vmwi_lrev', VMWI pending.
-+ */
-+
-+ /* OHT mode when idle */
-+ fxs->idletxhookstate = POLARITY_XOR ?
-+ SLIC_LF_OHTRAN_REV :
-+ SLIC_LF_OHTRAN_FWD;
-+ } else if (fxs->ohttimer) {
-+ /* check if still OnHook */
-+ if (!fxs->oldrxhook) {
-+ fxs->ohttimer -= DAHDI_CHUNKSIZE;
-+ if (!fxs->ohttimer) {
-+ fxs->idletxhookstate = POLARITY_XOR ? SLIC_LF_ACTIVE_REV : SLIC_LF_ACTIVE_FWD; /* Switch to Active, Rev or Fwd */
-+ /* if currently OHT */
-+ if ((fxs->lasttxhook == SLIC_LF_OHTRAN_FWD) || (fxs->lasttxhook == SLIC_LF_OHTRAN_REV)) {
-+ if (fxs->vmwi_hvac) {
-+ /* force idle polarity Forward if ringing */
-+ fxs->idletxhookstate = SLIC_LF_ACTIVE_FWD;
-+ /* Set ring generator for neon */
-+ ystdm_set_ring_generator_mode(wc, x, 1);
-+ fxs->lasttxhook = SLIC_LF_RINGING;
-+ } else {
-+ fxs->lasttxhook = fxs->idletxhookstate;
-+ }
-+ /* Apply the change as appropriate */
-+ ystdm_setreg(wc, x, LINE_STATE, fxs->lasttxhook);
-+ }
-+ }
-+ } else {
-+ fxs->ohttimer = 0;
-+ /* Switch to Active, Rev or Fwd */
-+ fxs->idletxhookstate = POLARITY_XOR ? SLIC_LF_ACTIVE_REV : SLIC_LF_ACTIVE_FWD;
-+ }
-+ }
-+ }
-+ }
-+
-+ if (ints & 0x0f) {
-+ wc->intcount++;
-+ x = wc->intcount & 0xf;
-+ mode = wc->intcount & 0x30;
-+ if (wc->cardflag & (1 << x)) {
-+ switch(mode) {
-+ case 0:
-+ /* Rest */
-+ break;
-+ case 16:
-+ /* Read first shadow reg */
-+ if (wc->modtype[x] == MOD_TYPE_FXS)
-+ wc->reg0shadow[x] = ystdm_getreg(wc, x, 68);
-+ else if (wc->modtype[x] == MOD_TYPE_FXO)
-+ wc->reg0shadow[x] = ystdm_getreg(wc, x, 5);
-+ break;
-+ case 32:
-+ /* Read second shadow reg */
-+ if (wc->modtype[x] == MOD_TYPE_FXS)
-+ wc->reg1shadow[x] = ystdm_getreg(wc, x, LINE_STATE);
-+ else if (wc->modtype[x] == MOD_TYPE_FXO)
-+ wc->reg1shadow[x] = ystdm_getreg(wc, x, 29);
-+ break;
-+ case 48:
-+ /* Perform processing */
-+ if (wc->modtype[x] == MOD_TYPE_FXS) {
-+ ystdm_proslic_check_hook(wc, x);
-+ if (!(wc->intcount & 0xf0)) {
-+ ystdm_proslic_recheck_sanity(wc, x);
-+ }
-+ } else if (wc->modtype[x] == MOD_TYPE_FXO) {
-+ ystdm_voicedaa_check_hook(wc, x);
-+ }
-+ break;
-+ }
-+ }
-+ if (!(wc->intcount % 10000)) {
-+ /* Accept an alarm once per 10 seconds */
-+ for (x=0;x<NUM_CARDS;x++)
-+ if (wc->modtype[x] == MOD_TYPE_FXS) {
-+ if (wc->mod[x].fxs.palarms)
-+ wc->mod[x].fxs.palarms--;
-+ }
-+ }
-+ ystdm_receiveprep(wc, ints);
-+ ystdm_transmitprep(wc, ints);
-+ }
-+ return IRQ_RETVAL(1);
-+
-+}
-+
-+static int ystdm_voicedaa_insane(struct ystdm *wc, int card)
-+{
-+ int blah;
-+ blah = ystdm_getreg(wc, card, 2);
-+ if (blah != 0x3)
-+ return -2;
-+ blah = ystdm_getreg(wc, card, 11);
-+ if (debug)
-+ printk("VoiceDAA System: %02x\n", blah & 0xf);
-+ return 0;
-+}
-+
-+static int ystdm_proslic_insane(struct ystdm *wc, int card)
-+{
-+ int blah,insane_report;
-+ insane_report=0;
-+
-+ blah = ystdm_getreg(wc, card, 0);
-+ if (debug)
-+ printk("ProSLIC on module %d, product %d, version %d\n", card, (blah & 0x30) >> 4, (blah & 0xf));
-+
-+#if 0
-+ if ((blah & 0x30) >> 4) {
-+ printk("ProSLIC on module %d is not a 3210.\n", card);
-+ return -1;
-+ }
-+#endif
-+ if (((blah & 0xf) == 0) || ((blah & 0xf) == 0xf)) {
-+ /* SLIC not loaded */
-+ return -1;
-+ }
-+ if ((blah & 0xf) < 2) {
-+ printk("ProSLIC 3210 version %d is too old\n", blah & 0xf);
-+ return -1;
-+ }
-+ if ((blah & 0xf) == 2) {
-+ /* ProSLIC 3215, not a 3210 */
-+ wc->flags[card] |= FLAG_3215;
-+ }
-+ blah = ystdm_getreg(wc, card, 8);
-+ if (blah != 0x2) {
-+ printk("ProSLIC on module %d insane (1) %d should be 2\n", card, blah);
-+ return -1;
-+ } else if ( insane_report)
-+ printk("ProSLIC on module %d Reg 8 Reads %d Expected is 0x2\n",card,blah);
-+
-+ blah = ystdm_getreg(wc, card, 64);
-+ if (blah != 0x0) {
-+ printk("ProSLIC on module %d insane (2)\n", card);
-+ return -1;
-+ } else if ( insane_report)
-+ printk("ProSLIC on module %d Reg 64 Reads %d Expected is 0x0\n",card,blah);
-+
-+ blah = ystdm_getreg(wc, card, 11);
-+ if (blah != 0x33) {
-+ printk("ProSLIC on module %d insane (3)\n", card);
-+ return -1;
-+ } else if ( insane_report)
-+ printk("ProSLIC on module %d Reg 11 Reads %d Expected is 0x33\n",card,blah);
-+
-+ /* Just be sure it's setup right. */
-+ ystdm_setreg(wc, card, 30, 0);
-+
-+ if (debug)
-+ printk("ProSLIC on module %d seems sane.\n", card);
-+ return 0;
-+}
-+
-+static int ystdm_proslic_powerleak_test(struct ystdm *wc, int card)
-+{
-+ unsigned long origjiffies;
-+ unsigned char vbat;
-+
-+ /* Turn off linefeed */
-+ ystdm_setreg(wc, card, 64, 0);
-+
-+ /* Power down */
-+ ystdm_setreg(wc, card, 14, 0x10);
-+
-+ /* Wait for one second */
-+ origjiffies = jiffies;
-+
-+ while((vbat = ystdm_getreg(wc, card, 82)) > 0x6) {
-+ if ((jiffies - origjiffies) >= (HZ/2))
-+ break;;
-+ }
-+
-+ if (vbat < 0x06) {
-+ 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);
-+ }
-+ return 0;
-+}
-+
-+static int ystdm_powerup_proslic(struct ystdm *wc, int card, int fast)
-+{
-+ unsigned char vbat;
-+ unsigned long origjiffies;
-+ int lim;
-+
-+ /* Set period of DC-DC converter to 1/64 khz */
-+ ystdm_setreg(wc, card, 92, 0xff /* was 0xff */);
-+
-+ /* Wait for VBat to powerup */
-+ origjiffies = jiffies;
-+
-+ /* Disable powerdown */
-+ ystdm_setreg(wc, card, 14, 0);
-+
-+ /* If fast, don't bother checking anymore */
-+ if (fast)
-+ return 0;
-+
-+ while((vbat = ystdm_getreg(wc, card, 82)) < 0xc0) {
-+ /* Wait no more than 500ms */
-+ if ((jiffies - origjiffies) > HZ/2) {
-+ break;
-+ }
-+ }
-+
-+ if (vbat < 0xc0) {
-+ if (wc->proslic_power == PROSLIC_POWER_UNKNOWN)
-+ printk("ProSLIC on module %d failed to powerup within %d ms (%d mV only)\n\n -- DID YOU REMEMBER TO PLUG IN THE HD POWER CABLE TO THE YSTDM16xx??\n",
-+ card, (int)(((jiffies - origjiffies) * 1000 / HZ)),
-+ vbat * 375);
-+ wc->proslic_power = PROSLIC_POWER_WARNED;
-+ 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)));
-+ }
-+ wc->proslic_power = PROSLIC_POWER_ON;
-+
-+ /* Proslic max allowed loop current, reg 71 LOOP_I_LIMIT */
-+ /* If out of range, just set it to the default value */
-+ lim = (loopcurrent - 20) / 3;
-+ if ( loopcurrent > 41 ) {
-+ lim = 0;
-+ if (debug)
-+ printk("Loop current out of range! Setting to default 20mA!\n");
-+ }
-+ else if (debug)
-+ printk("Loop current set to %dmA!\n",(lim*3)+20);
-+ ystdm_setreg(wc,card,LOOP_I_LIMIT,lim);
-+
-+ /* Engage DC-DC converter */
-+ ystdm_setreg(wc, card, 93, 0x19 /* was 0x19 */);
-+#if 0
-+ origjiffies = jiffies;
-+ while(0x80 & ystdm_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 = ystdm_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
-+#endif
-+ return 0;
-+
-+}
-+
-+static int ystdm_proslic_manual_calibrate(struct ystdm *wc, int card){
-+ unsigned long origjiffies;
-+ unsigned char i;
-+
-+ ystdm_setreg(wc, card, 21, 0);//(0) Disable all interupts in DR21
-+ ystdm_setreg(wc, card, 22, 0);//(0)Disable all interupts in DR21
-+ ystdm_setreg(wc, card, 23, 0);//(0)Disable all interupts in DR21
-+ ystdm_setreg(wc, card, 64, 0);//(0)
-+
-+ ystdm_setreg(wc, card, 97, 0x18); //(0x18)Calibrations without the ADC and DAC offset and without common mode calibration.
-+ ystdm_setreg(wc, card, 96, 0x47); //(0x47) Calibrate common mode and differential DAC mode DAC + ILIM
-+
-+ origjiffies=jiffies;
-+ while( ystdm_getreg(wc,card,96)!=0 ){
-+ if((jiffies-origjiffies)>80)
-+ return -1;
-+ }
-+//Initialized DR 98 and 99 to get consistant results.
-+// 98 and 99 are the results registers and the search should have same intial conditions.
-+
-+/*******************************The following is the manual gain mismatch calibration****************************/
-+/*******************************This is also available as a function *******************************************/
-+ // Delay 10ms
-+ origjiffies=jiffies;
-+ while((jiffies-origjiffies)<1);
-+ ystdm_proslic_setreg_indirect(wc, card, 88,0);
-+ ystdm_proslic_setreg_indirect(wc, card, 89,0);
-+ ystdm_proslic_setreg_indirect(wc, card, 90,0);
-+ ystdm_proslic_setreg_indirect(wc, card, 91,0);
-+ ystdm_proslic_setreg_indirect(wc, card, 92,0);
-+ ystdm_proslic_setreg_indirect(wc, card, 93,0);
-+
-+ ystdm_setreg(wc, card, 98, 0x10); // This is necessary if the calibration occurs other than at reset time
-+ ystdm_setreg(wc, card, 99, 0x10);
-+
-+ for ( i=0x1f; i>0; i--)
-+ {
-+ ystdm_setreg(wc, card, 98, i);
-+ origjiffies=jiffies;
-+ while((jiffies-origjiffies)<4);
-+ if((ystdm_getreg(wc, card, 88)) == 0)
-+ break;
-+ } // for
-+
-+ for ( i=0x1f; i>0; i--)
-+ {
-+ ystdm_setreg(wc, card, 99, i);
-+ origjiffies=jiffies;
-+ while((jiffies-origjiffies)<4);
-+ if((ystdm_getreg(wc, card, 89)) == 0)
-+ break;
-+ }//for
-+
-+/*******************************The preceding is the manual gain mismatch calibration****************************/
-+/**********************************The following is the longitudinal Balance Cal***********************************/
-+ ystdm_setreg(wc,card,64,1);
-+ while((jiffies-origjiffies)<10); // Sleep 100?
-+
-+ ystdm_setreg(wc, card, 64, 0);
-+ ystdm_setreg(wc, card, 23, 0x4); // enable interrupt for the balance Cal
-+ ystdm_setreg(wc, card, 97, 0x1); // this is a singular calibration bit for longitudinal calibration
-+ ystdm_setreg(wc, card, 96, 0x40);
-+
-+ ystdm_getreg(wc, card, 96); /* Read Reg 96 just cause */
-+
-+ ystdm_setreg(wc, card, 21, 0xFF);
-+ ystdm_setreg(wc, card, 22, 0xFF);
-+ ystdm_setreg(wc, card, 23, 0xFF);
-+
-+ /**The preceding is the longitudinal Balance Cal***/
-+ return(0);
-+
-+}
-+#if 1
-+static int ystdm_proslic_calibrate(struct ystdm *wc, int card)
-+{
-+ unsigned long origjiffies;
-+ int x;
-+ /* Perform all calibrations */
-+ ystdm_setreg(wc, card, 97, 0x1f);
-+
-+ /* Begin, no speedup */
-+ ystdm_setreg(wc, card, 96, 0x5f);
-+
-+ /* Wait for it to finish */
-+ origjiffies = jiffies;
-+ while(ystdm_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, ystdm_getreg(wc, card, x));
-+ }
-+ }
-+ return 0;
-+}
-+#endif
-+
-+static void wait_just_a_bit(int foo)
-+{
-+ long newjiffies;
-+ newjiffies = jiffies + foo;
-+ while(jiffies < newjiffies);
-+}
-+/*********************************************************************
-+ * Set the hwgain on the analog modules
-+ *
-+ * card = the card position for this module (0-23)
-+ * gain = gain in dB x10 (e.g. -3.5dB would be gain=-35)
-+ * tx = (0 for rx; 1 for tx)
-+ *
-+ *******************************************************************/
-+static int ystdm_set_hwgain(struct ystdm *wc, int card, __s32 gain, __u32 tx)
-+{
-+ if (!(wc->modtype[card] == MOD_TYPE_FXO)) {
-+ printk("Cannot adjust gain. Unsupported module type!\n");
-+ return -1;
-+ }
-+ if (tx) {
-+ if (debug)
-+ printk("setting FXO tx gain for card=%d to %d\n", card, gain);
-+ if (gain >= -150 && gain <= 0) {
-+ ystdm_setreg(wc, card, 38, 16 + (gain/-10));
-+ ystdm_setreg(wc, card, 40, 16 + (-gain%10));
-+ } else if (gain <= 120 && gain > 0) {
-+ ystdm_setreg(wc, card, 38, gain/10);
-+ ystdm_setreg(wc, card, 40, (gain%10));
-+ } else {
-+ printk("FXO tx gain is out of range (%d)\n", gain);
-+ return -1;
-+ }
-+ } else { /* rx */
-+ if (debug)
-+ printk("setting FXO rx gain for card=%d to %d\n", card, gain);
-+ if (gain >= -150 && gain <= 0) {
-+ ystdm_setreg(wc, card, 39, 16+ (gain/-10));
-+ ystdm_setreg(wc, card, 41, 16 + (-gain%10));
-+ } else if (gain <= 120 && gain > 0) {
-+ ystdm_setreg(wc, card, 39, gain/10);
-+ ystdm_setreg(wc, card, 41, (gain%10));
-+ } else {
-+ printk("FXO rx gain is out of range (%d)\n", gain);
-+ return -1;
-+ }
-+ }
-+
-+ return 0;
-+}
-+
-+
-+static int set_vmwi(struct ystdm * wc, int chan_idx)
-+{
-+ struct fxs *const fxs = &wc->mod[chan_idx].fxs;
-+ if (fxs->vmwi_active_messages) {
-+ fxs->vmwi_lrev =
-+ (fxs->vmwisetting.vmwi_type & DAHDI_VMWI_LREV) ? 1 : 0;
-+ fxs->vmwi_hvdc =
-+ (fxs->vmwisetting.vmwi_type & DAHDI_VMWI_HVDC) ? 1 : 0;
-+ fxs->vmwi_hvac =
-+ (fxs->vmwisetting.vmwi_type & DAHDI_VMWI_HVAC) ? 1 : 0;
-+ } else {
-+ fxs->vmwi_lrev = 0;
-+ fxs->vmwi_hvdc = 0;
-+ fxs->vmwi_hvac = 0;
-+ }
-+
-+ if (debug) {
-+ printk(KERN_DEBUG "Setting VMWI on channel %d, messages=%d, "
-+ "lrev=%d, hvdc=%d, hvac=%d\n",
-+ chan_idx,
-+ fxs->vmwi_active_messages,
-+ fxs->vmwi_lrev,
-+ fxs->vmwi_hvdc,
-+ fxs->vmwi_hvac
-+ );
-+ }
-+ if (fxs->vmwi_hvac) {
-+ /* Can't change ring generator while in On Hook Transfer mode*/
-+ if (!fxs->ohttimer) {
-+ if (POLARITY_XOR)
-+ fxs->idletxhookstate |= SLIC_LF_REVMASK;
-+ else
-+ fxs->idletxhookstate &= ~SLIC_LF_REVMASK;
-+ /* Set ring generator for neon */
-+ ystdm_set_ring_generator_mode(wc, chan_idx, 1);
-+ /* Activate ring to send neon pulses */
-+ fxs->lasttxhook = SLIC_LF_RINGING;
-+ ystdm_setreg(wc, chan_idx, LINE_STATE, fxs->lasttxhook);
-+ }
-+ } else {
-+ if (fxs->neonringing) {
-+ /* Set ring generator for normal ringer */
-+ ystdm_set_ring_generator_mode(wc, chan_idx, 0);
-+ /* ACTIVE, polarity determined later */
-+ fxs->lasttxhook = SLIC_LF_ACTIVE_FWD;
-+ } else if ((fxs->lasttxhook == SLIC_LF_RINGING) ||
-+ (fxs->lasttxhook == SLIC_LF_OPEN)) {
-+ /* Can't change polarity while ringing or when open,
-+ set idlehookstate instead */
-+ if (POLARITY_XOR)
-+ fxs->idletxhookstate |= SLIC_LF_REVMASK;
-+ else
-+ fxs->idletxhookstate &= ~SLIC_LF_REVMASK;
-+
-+ printk(KERN_DEBUG "Unable to change polarity on channel"
-+ "%d, lasttxhook=0x%X\n",
-+ chan_idx,
-+ fxs->lasttxhook
-+ );
-+ return 0;
-+ }
-+ if (POLARITY_XOR) {
-+ fxs->idletxhookstate |= SLIC_LF_REVMASK;
-+ fxs->lasttxhook |= SLIC_LF_REVMASK;
-+ } else {
-+ fxs->idletxhookstate &= ~SLIC_LF_REVMASK;
-+ fxs->lasttxhook &= ~SLIC_LF_REVMASK;
-+ }
-+ ystdm_setreg(wc, chan_idx, LINE_STATE, fxs->lasttxhook);
-+ }
-+ return 0;
-+}
-+
-+
-+static int ystdm_init_voicedaa(struct ystdm *wc, int card, int fast, int manual, int sane)
-+{
-+ unsigned char reg16=0, reg26=0, reg30=0, reg31=0;
-+ long newjiffies;
-+ wc->modtype[card] = MOD_TYPE_FXO;
-+ /* Sanity check the ProSLIC */
-+ reset_spi(wc, card);
-+ if (!sane && ystdm_voicedaa_insane(wc, card))
-+ return -2;
-+
-+ /* Software reset */
-+ ystdm_setreg(wc, card, 1, 0x80);
-+
-+ /* Wait just a bit */
-+ wait_just_a_bit(HZ/10);
-+
-+ /* Enable PCM, ulaw */
-+ if (alawoverride){
-+ ystdm_setreg(wc, card, 33, 0x20);
-+ } else {
-+ ystdm_setreg(wc, card, 33, 0x28);
-+ }
-+
-+ /* Set On-hook speed, Ringer impedence, and ringer threshold */
-+ reg16 |= (fxo_modes[_opermode].ohs << 6);
-+ reg16 |= (fxo_modes[_opermode].rz << 1);
-+ reg16 |= (fxo_modes[_opermode].rt);
-+ ystdm_setreg(wc, card, 16, reg16);
-+
-+ if(fwringdetect) {
-+ /* Enable ring detector full-wave rectifier mode */
-+ ystdm_setreg(wc, card, 18, 2);
-+ ystdm_setreg(wc, card, 24, 0);
-+ } else {
-+ /* Set to the device defaults */
-+ ystdm_setreg(wc, card, 18, 0);
-+ ystdm_setreg(wc, card, 24, 0x19);
-+ }
-+
-+ /* Set DC Termination:
-+ Tip/Ring voltage adjust, minimum operational current, current limitation */
-+ reg26 |= (fxo_modes[_opermode].dcv << 6);
-+ reg26 |= (fxo_modes[_opermode].mini << 4);
-+ reg26 |= (fxo_modes[_opermode].ilim << 1);
-+ ystdm_setreg(wc, card, 26, reg26);
-+
-+ /* Set AC Impedence */
-+ reg30 = (fxo_modes[_opermode].acim);
-+ ystdm_setreg(wc, card, 30, reg30);
-+
-+ /* Misc. DAA parameters */
-+ if (fastpickup)
-+ reg31 = 0xe3;
-+ else
-+ reg31 = 0xa3;
-+
-+ reg31 |= (fxo_modes[_opermode].ohs2 << 3);
-+ ystdm_setreg(wc, card, 31, reg31);
-+
-+ /* Set Transmit/Receive timeslot */
-+ if (card < NUM_CARDS/4) {
-+ ystdm_setreg(wc, card, 34, (3-card) * 8);
-+ ystdm_setreg(wc, card, 35, 0x00);
-+ ystdm_setreg(wc, card, 36, (3-card) * 8);
-+ ystdm_setreg(wc, card, 37, 0x00);
-+ } else if (card < NUM_CARDS/2) {
-+ ystdm_setreg(wc, card, 34, (15-card) * 8);
-+ ystdm_setreg(wc, card, 35, 0x00);
-+ ystdm_setreg(wc, card, 36, (15-card) * 8);
-+ ystdm_setreg(wc, card, 37, 0x00);
-+ } else if (card < (NUM_CARDS*3)/4) {
-+ ystdm_setreg(wc, card, 34, (27-card) * 8);
-+ ystdm_setreg(wc, card, 35, 0x00);
-+ ystdm_setreg(wc, card, 36, (27-card) * 8);
-+ ystdm_setreg(wc, card, 37, 0x00);
-+ } else {
-+ ystdm_setreg(wc, card, 34, (39-card) * 8);
-+ ystdm_setreg(wc, card, 35, 0x00);
-+ ystdm_setreg(wc, card, 36, (39-card) * 8);
-+ ystdm_setreg(wc, card, 37, 0x00);
-+ }
-+
-+ /* Enable ISO-Cap */
-+ ystdm_setreg(wc, card, 6, 0x00);
-+ if (fastpickup)
-+ ystdm_setreg(wc, card, 17, ystdm_getreg(wc, card, 17) | 0x20);
-+
-+ /* Wait 1000ms for ISO-cap to come up */
-+ newjiffies = jiffies;
-+ newjiffies += 2 * HZ;
-+ while((jiffies < newjiffies) && !(ystdm_getreg(wc, card, 11) & 0xf0))
-+ wait_just_a_bit(HZ/10);
-+
-+ if (!(ystdm_getreg(wc, card, 11) & 0xf0)) {
-+ printk("VoiceDAA did not bring up ISO link properly!\n");
-+ return -1;
-+ }
-+ if (debug)
-+ printk("ISO-Cap is now up, line side: %02x rev %02x\n",
-+ ystdm_getreg(wc, card, 11) >> 4,
-+ (ystdm_getreg(wc, card, 13) >> 2) & 0xf);
-+ /* Enable on-hook line monitor */
-+ ystdm_setreg(wc, card, 5, 0x08);
-+ /* Take values for fxotxgain and fxorxgain and apply them to module */
-+ if (fxotxgain)
-+ ystdm_set_hwgain(wc, card, fxotxgain, 1);
-+ else
-+ ystdm_set_hwgain(wc, card, 0, 1);
-+ if (fxorxgain)
-+ ystdm_set_hwgain(wc, card, fxorxgain, 0);
-+ else
-+ ystdm_set_hwgain(wc, card, 20, 0);
-+
-+ /* NZ -- crank the tx gain up by 7 dB */
-+ if (!strcmp(fxo_modes[_opermode].name, "NEWZEALAND")) {
-+ printk("Adjusting gain\n");
-+ ystdm_set_hwgain(wc, card, 7, 1);
-+
-+ }
-+ /* KR -- crank the rv gain up by 9 dB */
-+ if (!strcmp(fxo_modes[_opermode].name, "SOUTHKOREA")) {
-+ printk("Adjusting gain\n");
-+ ystdm_setreg(wc, card, 39, 0x9);
-+ }
-+ if(debug)
-+ printk("DEBUG fxotxgain:%i.%i fxorxgain:%i.%i\n", (ystdm_getreg(wc, card, 38)/16)?-(ystdm_getreg(wc, card, 38) - 16) : ystdm_getreg(wc, card, 38), (ystdm_getreg(wc, card, 40)/16)? -(ystdm_getreg(wc, card, 40) - 16):ystdm_getreg(wc, card, 40), (ystdm_getreg(wc, card, 39)/16)? -(ystdm_getreg(wc, card, 39) - 16) : ystdm_getreg(wc, card, 39),(ystdm_getreg(wc, card, 41)/16)?-(ystdm_getreg(wc, card, 41) - 16):ystdm_getreg(wc, card, 41));
-+
-+ return 0;
-+
-+}
-+
-+static int ystdm_init_proslic(struct ystdm *wc, int card, int fast, int manual, int sane)
-+{
-+
-+ unsigned short tmp[5];
-+ unsigned char r19,r9;
-+ int x;
-+ int fxsmode=0;
-+ struct fxs *const fxs = &wc->mod[card].fxs;
-+
-+ /* Sanity check the ProSLIC */
-+ if (!sane && ystdm_proslic_insane(wc, card))
-+ return -2;
-+
-+ /* default messages to none and method to FSK */
-+ memset(&fxs->vmwisetting, 0, sizeof(fxs->vmwisetting));
-+ fxs->vmwi_lrev = 0;
-+ fxs->vmwi_hvdc = 0;
-+ fxs->vmwi_hvac = 0;
-+
-+ /* By default, don't send on hook */
-+ if (!reversepolarity != !fxs->reversepolarity)
-+ fxs->idletxhookstate = SLIC_LF_ACTIVE_REV;
-+ else
-+ fxs->idletxhookstate = SLIC_LF_ACTIVE_FWD;
-+
-+ /* Sanity check the ProSLIC */
-+
-+ if (sane) {
-+ /* Make sure we turn off the DC->DC converter to prevent anything from blowing up */
-+ ystdm_setreg(wc, card, 14, 0x10);
-+ }
-+
-+ if (ystdm_proslic_init_indirect_regs(wc, card)) {
-+ printk(KERN_INFO "Indirect Registers failed to initialize on module %d.\n", card);
-+ return -1;
-+ }
-+
-+ /* Clear scratch pad area */
-+ ystdm_proslic_setreg_indirect(wc, card, 97,0);
-+
-+ /* Clear digital loopback */
-+ ystdm_setreg(wc, card, 8, 0);
-+
-+ /* Revision C optimization */
-+ ystdm_setreg(wc, card, 108, 0xeb);
-+
-+ /* Disable automatic VBat switching for safety to prevent
-+ Q7 from accidently turning on and burning out. */
-+ ystdm_setreg(wc, card, 67, 0x07);
-+
-+ /* Turn off Q7 */
-+ ystdm_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] = ystdm_proslic_getreg_indirect(wc, card, x + 35);
-+ ystdm_proslic_setreg_indirect(wc, card, x + 35, 0x8000);
-+ }
-+
-+ /* Power up the DC-DC converter */
-+ if (ystdm_powerup_proslic(wc, card, fast)) {
-+ printk("Unable to do INITIAL ProSLIC powerup on module %d\n", card);
-+ return -1;
-+ }
-+
-+ if (!fast) {
-+
-+ /* Check for power leaks */
-+ if (ystdm_proslic_powerleak_test(wc, card)) {
-+ printk("ProSLIC module %d failed leakage test. Check for short circuit\n", card);
-+ }
-+ /* Power up again */
-+ if (ystdm_powerup_proslic(wc, card, fast)) {
-+ printk("Unable to do FINAL ProSLIC powerup on module %d\n", card);
-+ return -1;
-+ }
-+#ifndef NO_CALIBRATION
-+ /* Perform calibration */
-+ if(manual) {
-+ if (ystdm_proslic_manual_calibrate(wc, card)) {
-+ //printk("Proslic failed on Manual Calibration\n");
-+ if (ystdm_proslic_manual_calibrate(wc, card)) {
-+ printk("Proslic Failed on Second Attempt to Calibrate Manually. (Try -DNO_CALIBRATION in Makefile)\n");
-+ return -1;
-+ }
-+ printk("Proslic Passed Manual Calibration on Second Attempt\n");
-+ }
-+ }
-+ else {
-+ if(ystdm_proslic_calibrate(wc, card)) {
-+ //printk("ProSlic died on Auto Calibration.\n");
-+ if (ystdm_proslic_calibrate(wc, card)) {
-+ printk("Proslic Failed on Second Attempt to Auto Calibrate\n");
-+ return -1;
-+ }
-+ printk("Proslic Passed Auto Calibration on Second Attempt\n");
-+ }
-+ }
-+ /* Perform DC-DC calibration */
-+ ystdm_setreg(wc, card, 93, 0x99);
-+ r19 = ystdm_getreg(wc, card, 107);
-+ if ((r19 < 0x2) || (r19 > 0xd)) {
-+ printk("DC-DC cal has a surprising direct 107 of 0x%02x!\n", r19);
-+ ystdm_setreg(wc, card, 107, 0x8);
-+ }
-+
-+ /* Save calibration vectors */
-+ for (x=0;x<NUM_CAL_REGS;x++)
-+ fxs->calregs.vals[x] = ystdm_getreg(wc, card, 96 + x);
-+#endif
-+
-+ } else {
-+ /* Restore calibration registers */
-+ for (x=0;x<NUM_CAL_REGS;x++)
-+ ystdm_setreg(wc, card, 96 + x, fxs->calregs.vals[x]);
-+ }
-+ /* Calibration complete, restore original values */
-+ for (x=0;x<5;x++) {
-+ ystdm_proslic_setreg_indirect(wc, card, x + 35, tmp[x]);
-+ }
-+
-+ if (ystdm_proslic_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" */
-+ ystdm_setreg(wc, card, 67, 0x0e);
-+ blah = ystdm_getreg(wc, card, 67);
-+#endif
-+
-+#if 0
-+ if (ystdm_proslic_setreg_indirect(wc, card, 97, 0x0)) { // Stanley: for the bad recording fix
-+ printk(KERN_INFO "ProSlic IndirectReg Died.\n");
-+ return -1;
-+ }
-+#endif
-+
-+ if (alawoverride)
-+ ystdm_setreg(wc, card, 1, 0x20);
-+ else
-+ ystdm_setreg(wc, card, 1, 0x28);
-+ // U-Law 8-bit interface
-+ if (card < NUM_CARDS/4) {
-+ ystdm_setreg(wc, card, 2, (3-card) * 8); // Tx Start count low byte 0
-+ ystdm_setreg(wc, card, 3, 0); // Tx Start count high byte 0
-+ ystdm_setreg(wc, card, 4, (3-card) * 8); // Rx Start count low byte 0
-+ ystdm_setreg(wc, card, 5, 0); // Rx Start count high byte 0
-+ } else if (card < NUM_CARDS/2) {
-+ ystdm_setreg(wc, card, 2, (15-card) * 8); // Tx Start count low byte 0
-+ ystdm_setreg(wc, card, 3, 0); // Tx Start count high byte 0
-+ ystdm_setreg(wc, card, 4, (15-card) * 8); // Rx Start count low byte 0
-+ ystdm_setreg(wc, card, 5, 0); // Rx Start count high byte 0
-+ } else if (card < (NUM_CARDS*3)/4) {
-+ ystdm_setreg(wc, card, 2, (27-card) * 8); // Tx Start count low byte 0
-+ ystdm_setreg(wc, card, 3, 0); // Tx Start count high byte 0
-+ ystdm_setreg(wc, card, 4, (27-card) * 8); // Rx Start count low byte 0
-+ ystdm_setreg(wc, card, 5, 0); // Rx Start count high byte 0
-+ } else {
-+ ystdm_setreg(wc, card, 2, (39-card) * 8); // Tx Start count low byte 0
-+ ystdm_setreg(wc, card, 3, 0); // Tx Start count high byte 0
-+ ystdm_setreg(wc, card, 4, (39-card) * 8); // Rx Start count low byte 0
-+ ystdm_setreg(wc, card, 5, 0); // Rx Start count high byte 0
-+ }
-+ ystdm_setreg(wc, card, 18, 0xff); // clear all interrupt
-+ ystdm_setreg(wc, card, 19, 0xff);
-+ ystdm_setreg(wc, card, 20, 0xff);
-+ ystdm_setreg(wc, card, 73, 0x04);
-+ if (fxshonormode) {
-+ fxsmode = acim2tiss[fxo_modes[_opermode].acim];
-+ ystdm_setreg(wc, card, 10, 0x08 | fxsmode);
-+ }
-+ if (lowpower)
-+ ystdm_setreg(wc, card, 72, 0x10);
-+
-+#if 0
-+ ystdm_setreg(wc, card, 21, 0x00); // enable interrupt
-+ ystdm_setreg(wc, card, 22, 0x02); // Loop detection interrupt
-+ ystdm_setreg(wc, card, 23, 0x01); // DTMF detection interrupt
-+#endif
-+
-+#if 0
-+ /* Enable loopback */
-+ ystdm_setreg(wc, card, 8, 0x2);
-+ ystdm_setreg(wc, card, 14, 0x0);
-+ ystdm_setreg(wc, card, 64, 0x0);
-+ ystdm_setreg(wc, card, 1, 0x08);
-+#endif
-+ if (ystdm_init_ring_generator_mode(wc, card)) {
-+ return -1;
-+ }
-+ if(fxstxgain || fxsrxgain) {
-+ r9 = ystdm_getreg(wc, card, 9);
-+ switch (fxstxgain) {
-+
-+ case 35:
-+ r9+=8;
-+ break;
-+ case -35:
-+ r9+=4;
-+ break;
-+ case 0:
-+ break;
-+ }
-+
-+ switch (fxsrxgain) {
-+
-+ case 35:
-+ r9+=2;
-+ break;
-+ case -35:
-+ r9+=1;
-+ break;
-+ case 0:
-+ break;
-+ }
-+ ystdm_setreg(wc,card,9,r9);
-+ }
-+
-+ if(debug)
-+ printk("DEBUG: fxstxgain:%s fxsrxgain:%s\n",((ystdm_getreg(wc, card, 9)/8) == 1)?"3.5":(((ystdm_getreg(wc,card,9)/4) == 1)?"-3.5":"0.0"),((ystdm_getreg(wc, card, 9)/2) == 1)?"3.5":((ystdm_getreg(wc,card,9)%2)?"-3.5":"0.0"));
-+
-+ fxs->lasttxhook = fxs->idletxhookstate;
-+ ystdm_setreg(wc, card, LINE_STATE, fxs->lasttxhook);
-+
-+ /* Analog Transmit Path Gain = 3.5dB; Analog Receive Path Gain = 3.5dB. */
-+ /* ystdm_setreg(wc, card, 9, 0x0a); */
-+ return 0;
-+}
-+
-+static int ystdm_ioctl(struct dahdi_chan *chan, unsigned int cmd, unsigned long data)
-+{
-+ struct ystdm_stats stats;
-+ struct ystdm_regs regs;
-+ struct ystdm_regop regop;
-+ struct ystdm_echo_coefs echoregs;
-+ struct dahdi_hwgain hwgain;
-+ struct ystdm *wc = chan->pvt;
-+ struct fxs *const fxs = &wc->mod[chan->chanpos - 1].fxs;
-+ int x;
-+ switch (cmd) {
-+ case DAHDI_ONHOOKTRANSFER:
-+ if (wc->modtype[chan->chanpos - 1] != MOD_TYPE_FXS)
-+ return -EINVAL;
-+ if (get_user(x, (__user int *) data))
-+ return -EFAULT;
-+ fxs->ohttimer = x << 3;
-+
-+ /* Active mode when idle */
-+ fxs->idletxhookstate = POLARITY_XOR ?
-+ SLIC_LF_ACTIVE_REV : SLIC_LF_ACTIVE_FWD;
-+ if (fxs->neonringing) {
-+ /* keep same Forward polarity */
-+ fxs->lasttxhook = SLIC_LF_OHTRAN_FWD;
-+ printk(KERN_INFO "ioctl: Start OnHookTrans, card %d\n",
-+ chan->chanpos - 1);
-+ ystdm_setreg(wc, chan->chanpos - 1,
-+ LINE_STATE, fxs->lasttxhook);
-+ } else if (fxs->lasttxhook == SLIC_LF_ACTIVE_FWD ||
-+ fxs->lasttxhook == SLIC_LF_ACTIVE_REV) {
-+ /* Apply the change if appropriate */
-+ fxs->lasttxhook = POLARITY_XOR ?
-+ SLIC_LF_OHTRAN_REV : SLIC_LF_OHTRAN_FWD;
-+ printk(KERN_INFO "ioctl: Start OnHookTrans, card %d\n",
-+ chan->chanpos - 1);
-+ ystdm_setreg(wc, chan->chanpos - 1,
-+ LINE_STATE, fxs->lasttxhook);
-+ }
-+ break;
-+ case DAHDI_SETPOLARITY:
-+ if (wc->modtype[chan->chanpos - 1] != MOD_TYPE_FXS)
-+ return -EINVAL;
-+ if (get_user(x, (__user int *) data))
-+ return -EFAULT;
-+ /* Can't change polarity while ringing or when open */
-+ if ((fxs->lasttxhook == SLIC_LF_RINGING) ||
-+ (fxs->lasttxhook == SLIC_LF_OPEN))
-+ return -EINVAL;
-+
-+ fxs->reversepolarity = x;
-+ if (POLARITY_XOR) {
-+ fxs->lasttxhook |= SLIC_LF_REVMASK;
-+ printk(KERN_INFO "ioctl: Reverse Polarity, card %d\n",
-+ chan->chanpos - 1);
-+ }
-+ else {
-+ fxs->lasttxhook &= ~SLIC_LF_REVMASK;
-+ printk(KERN_INFO "ioctl: Normal Polarity, card %d\n",
-+ chan->chanpos - 1);
-+ }
-+
-+ ystdm_setreg(wc, chan->chanpos - 1,
-+ LINE_STATE, fxs->lasttxhook);
-+ break;
-+ case DAHDI_VMWI_CONFIG:
-+ if (wc->modtype[chan->chanpos - 1] != MOD_TYPE_FXS)
-+ return -EINVAL;
-+ if (copy_from_user(&(fxs->vmwisetting), (__user void *) data,
-+ sizeof(fxs->vmwisetting)))
-+ return -EFAULT;
-+ set_vmwi(wc, chan->chanpos - 1);
-+ break;
-+ case DAHDI_VMWI:
-+ if (wc->modtype[chan->chanpos - 1] != MOD_TYPE_FXS)
-+ return -EINVAL;
-+ if (get_user(x, (__user int *) data))
-+ return -EFAULT;
-+ if (0 > x)
-+ return -EFAULT;
-+ fxs->vmwi_active_messages = x;
-+ set_vmwi(wc, chan->chanpos - 1);
-+ break;
-+ case WCTDM_GET_STATS:
-+ if (wc->modtype[chan->chanpos - 1] == MOD_TYPE_FXS) {
-+ stats.tipvolt = ystdm_getreg(wc, chan->chanpos - 1, 80) * -376;
-+ stats.ringvolt = ystdm_getreg(wc, chan->chanpos - 1, 81) * -376;
-+ stats.batvolt = ystdm_getreg(wc, chan->chanpos - 1, 82) * -376;
-+ } else if (wc->modtype[chan->chanpos - 1] == MOD_TYPE_FXO) {
-+ stats.tipvolt = (signed char)ystdm_getreg(wc, chan->chanpos - 1, 29) * 1000;
-+ stats.ringvolt = (signed char)ystdm_getreg(wc, chan->chanpos - 1, 29) * 1000;
-+ stats.batvolt = (signed char)ystdm_getreg(wc, chan->chanpos - 1, 29) * 1000;
-+ } else
-+ return -EINVAL;
-+ if (copy_to_user((__user void *)data, &stats, sizeof(stats)))
-+ return -EFAULT;
-+ break;
-+ case WCTDM_GET_REGS:
-+ if (wc->modtype[chan->chanpos - 1] == MOD_TYPE_FXS) {
-+ for (x=0;x<NUM_INDIRECT_REGS;x++)
-+ regs.indirect[x] = ystdm_proslic_getreg_indirect(wc, chan->chanpos -1, x);
-+ for (x=0;x<NUM_REGS;x++)
-+ regs.direct[x] = ystdm_getreg(wc, chan->chanpos - 1, x);
-+ } else {
-+ memset(&regs, 0, sizeof(regs));
-+ for (x=0;x<NUM_FXO_REGS;x++)
-+ regs.direct[x] = ystdm_getreg(wc, chan->chanpos - 1, x);
-+ }
-+ if (copy_to_user((__user void *)data, &regs, sizeof(regs)))
-+ return -EFAULT;
-+ break;
-+ case WCTDM_SET_REG:
-+ if (copy_from_user(&regop, (__user void *)data, sizeof(regop)))
-+ return -EFAULT;
-+ if (regop.indirect) {
-+ if (wc->modtype[chan->chanpos - 1] != MOD_TYPE_FXS)
-+ return -EINVAL;
-+ printk("Setting indirect %d to 0x%04x on %d\n", regop.reg, regop.val, chan->chanpos);
-+ ystdm_proslic_setreg_indirect(wc, chan->chanpos - 1, regop.reg, regop.val);
-+ } else {
-+ regop.val &= 0xff;
-+ printk("Setting direct %d to %04x on %d\n", regop.reg, regop.val, chan->chanpos);
-+ ystdm_setreg(wc, chan->chanpos - 1, regop.reg, regop.val);
-+ }
-+ break;
-+ case WCTDM_SET_ECHOTUNE:
-+ printk("-- Setting echo registers: \n");
-+ if (copy_from_user(&echoregs, (__user void *)data, sizeof(echoregs)))
-+ return -EFAULT;
-+
-+ if (wc->modtype[chan->chanpos - 1] == MOD_TYPE_FXO) {
-+ /* Set the ACIM register */
-+ ystdm_setreg(wc, chan->chanpos - 1, 30, echoregs.acim);
-+
-+ /* Set the digital echo canceller registers */
-+ ystdm_setreg(wc, chan->chanpos - 1, 45, echoregs.coef1);
-+ ystdm_setreg(wc, chan->chanpos - 1, 46, echoregs.coef2);
-+ ystdm_setreg(wc, chan->chanpos - 1, 47, echoregs.coef3);
-+ ystdm_setreg(wc, chan->chanpos - 1, 48, echoregs.coef4);
-+ ystdm_setreg(wc, chan->chanpos - 1, 49, echoregs.coef5);
-+ ystdm_setreg(wc, chan->chanpos - 1, 50, echoregs.coef6);
-+ ystdm_setreg(wc, chan->chanpos - 1, 51, echoregs.coef7);
-+ ystdm_setreg(wc, chan->chanpos - 1, 52, echoregs.coef8);
-+
-+ printk("-- Set echo registers successfully\n");
-+
-+ break;
-+ } else {
-+ return -EINVAL;
-+
-+ }
-+ break;
-+ case DAHDI_SET_HWGAIN:
-+ if (copy_from_user(&hwgain, (__user void *) data, sizeof(hwgain)))
-+ return -EFAULT;
-+
-+ ystdm_set_hwgain(wc, chan->chanpos-1, hwgain.newgain, hwgain.tx);
-+
-+ if (debug)
-+ printk("Setting hwgain on channel %d to %d for %s direction\n",
-+ chan->chanpos-1, hwgain.newgain, hwgain.tx ? "tx" : "rx");
-+ break;
-+
-+ default:
-+ return -ENOTTY;
-+ }
-+ return 0;
-+
-+}
-+
-+static int ystdm_open(struct dahdi_chan *chan)
-+{
-+ struct ystdm *wc = chan->pvt;
-+ if (!(wc->cardflag & (1 << (chan->chanpos - 1))))
-+ return -ENODEV;
-+ if (wc->dead)
-+ return -ENODEV;
-+ wc->usecount++;
-+ return 0;
-+}
-+
-+static inline struct ystdm *ystdm_from_span(struct dahdi_span *span)
-+{
-+ return container_of(span, struct ystdm, span);
-+}
-+
-+static int ystdm_watchdog(struct dahdi_span *span, int event)
-+{
-+ printk("TDM: Restarting DMA\n");
-+ ystdm_restart_dma(ystdm_from_span(span));
-+ return 0;
-+}
-+
-+static int ystdm_close(struct dahdi_chan *chan)
-+{
-+ struct ystdm *wc = chan->pvt;
-+ struct fxs *const fxs = &wc->mod[chan->chanpos - 1].fxs;
-+ wc->usecount--;
-+ if (wc->modtype[chan->chanpos - 1] == MOD_TYPE_FXS) {
-+ int idlehookstate;
-+ idlehookstate = POLARITY_XOR ?
-+ SLIC_LF_ACTIVE_REV :
-+ SLIC_LF_ACTIVE_FWD;
-+ fxs->idletxhookstate = idlehookstate;
-+ }
-+ /* If we're dead, release us now */
-+ if (!wc->usecount && wc->dead)
-+ ystdm_release(wc);
-+ return 0;
-+}
-+
-+static int ystdm_init_ring_generator_mode(struct ystdm *wc, int card)
-+{
-+ ystdm_setreg(wc, card, 34, 0x00); /* Ringing Osc. Control */
-+
-+ /* neon trapezoid timers */
-+ ystdm_setreg(wc, card, 48, 0xe0); /* Active Timer low byte */
-+ ystdm_setreg(wc, card, 49, 0x01); /* Active Timer high byte */
-+ ystdm_setreg(wc, card, 50, 0xF0); /* Inactive Timer low byte */
-+ ystdm_setreg(wc, card, 51, 0x05); /* Inactive Timer high byte */
-+
-+ ystdm_set_ring_generator_mode(wc, card, 0);
-+
-+ return 0;
-+}
-+
-+static int ystdm_set_ring_generator_mode(struct ystdm *wc, int card, int mode)
-+{
-+ int reg20, reg21, reg74; /* RCO, RNGX, VBATH */
-+ struct fxs *const fxs = &wc->mod[card].fxs;
-+
-+ fxs->neonringing = mode; /* track ring generator mode */
-+
-+ if (mode) { /* Neon */
-+ if (debug)
-+ printk(KERN_DEBUG "NEON ring on chan %d, "
-+ "lasttxhook was 0x%x\n", card, fxs->lasttxhook);
-+ /* Must be in FORWARD ACTIVE before setting ringer */
-+ fxs->lasttxhook = SLIC_LF_ACTIVE_FWD;
-+ ystdm_setreg(wc, card, LINE_STATE, fxs->lasttxhook);
-+
-+ ystdm_proslic_setreg_indirect(wc, card, 22,
-+ NEON_MWI_RNGY_PULSEWIDTH);
-+ ystdm_proslic_setreg_indirect(wc, card, 21,
-+ 0x7bef); /* RNGX (91.5Vpk) */
-+ ystdm_proslic_setreg_indirect(wc, card, 20,
-+ 0x009f); /* RCO (RNGX, t rise)*/
-+
-+ ystdm_setreg(wc, card, 34, 0x19); /* Ringing Osc. Control */
-+ ystdm_setreg(wc, card, 74, 0x3f); /* VBATH 94.5V */
-+ ystdm_proslic_setreg_indirect(wc, card, 29, 0x4600); /* RPTP */
-+ /* A write of 0x04 to register 64 will turn on the VM led */
-+ } else {
-+ ystdm_setreg(wc, card, 34, 0x00); /* Ringing Osc. Control */
-+ /* RNGY Initial Phase */
-+ ystdm_proslic_setreg_indirect(wc, card, 22, 0x0000);
-+ ystdm_proslic_setreg_indirect(wc, card, 29, 0x3600); /* RPTP */
-+ /* A write of 0x04 to register 64 will turn on the ringer */
-+
-+ if (fastringer) {
-+ /* Speed up Ringer */
-+ reg20 = 0x7e6d;
-+ reg74 = 0x32; /* Default */
-+ /* Beef up Ringing voltage to 89V */
-+ if (boostringer) {
-+ reg74 = 0x3f;
-+ reg21 = 0x0247; /* RNGX */
-+ if (debug)
-+ printk(KERN_DEBUG "Boosting fast ringer"
-+ " on chan %d (89V peak)\n",
-+ card);
-+ } else if (lowpower) {
-+ reg21 = 0x014b; /* RNGX */
-+ if (debug)
-+ printk(KERN_DEBUG "Reducing fast ring "
-+ "power on chan %d (50V peak)\n",
-+ card);
-+ } else if (fxshonormode &&
-+ fxo_modes[_opermode].ring_x) {
-+ reg21 = fxo_modes[_opermode].ring_x;
-+ if (debug)
-+ printk(KERN_DEBUG "fxshonormode: fast "
-+ "ring_x power on chan %d\n",
-+ card);
-+ } else {
-+ reg21 = 0x01b9;
-+ if (debug)
-+ printk(KERN_DEBUG "Speeding up ringer "
-+ "on chan %d (25Hz)\n",
-+ card);
-+ }
-+ /* VBATH */
-+ ystdm_setreg(wc, card, 74, reg74);
-+ /*RCO*/
-+ ystdm_proslic_setreg_indirect(wc, card, 20, reg20);
-+ /*RNGX*/
-+ ystdm_proslic_setreg_indirect(wc, card, 21, reg21);
-+
-+ } else {
-+ /* Ringer Speed */
-+ if (fxshonormode && fxo_modes[_opermode].ring_osc) {
-+ reg20 = fxo_modes[_opermode].ring_osc;
-+ if (debug)
-+ printk(KERN_DEBUG "fxshonormode: "
-+ "ring_osc speed on chan %d\n",
-+ card);
-+ } else {
-+ reg20 = 0x7ef0; /* Default */
-+ }
-+
-+ reg74 = 0x32; /* Default */
-+ /* Beef up Ringing voltage to 89V */
-+ if (boostringer) {
-+ reg74 = 0x3f;
-+ reg21 = 0x1d1;
-+ if (debug)
-+ printk(KERN_DEBUG "Boosting ringer on "
-+ "chan %d (89V peak)\n",
-+ card);
-+ } else if (lowpower) {
-+ reg21 = 0x108;
-+ if (debug)
-+ printk(KERN_DEBUG "Reducing ring power "
-+ "on chan %d (50V peak)\n",
-+ card);
-+ } else if (fxshonormode &&
-+ fxo_modes[_opermode].ring_x) {
-+ reg21 = fxo_modes[_opermode].ring_x;
-+ if (debug)
-+ printk(KERN_DEBUG "fxshonormode: ring_x"
-+ " power on chan %d\n",
-+ card);
-+ } else {
-+ reg21 = 0x160;
-+ if (debug)
-+ printk(KERN_DEBUG "Normal ring power on"
-+ " chan %d\n",
-+ card);
-+ }
-+ /* VBATH */
-+ ystdm_setreg(wc, card, 74, reg74);
-+ /* RCO */
-+ ystdm_proslic_setreg_indirect(wc, card, 20, reg20);
-+ /* RNGX */
-+ ystdm_proslic_setreg_indirect(wc, card, 21, reg21);
-+ }
-+ }
-+ return 0;
-+}
-+
-+static int ystdm_hooksig(struct dahdi_chan *chan, enum dahdi_txsig txsig)
-+{
-+ struct ystdm *wc = chan->pvt;
-+ int chan_entry = chan->chanpos - 1;
-+ if (wc->modtype[chan_entry] == MOD_TYPE_FXO) {
-+ /* XXX Enable hooksig for FXO XXX */
-+ switch(txsig) {
-+ case DAHDI_TXSIG_START:
-+ case DAHDI_TXSIG_OFFHOOK:
-+ wc->mod[chan_entry].fxo.offhook = 1;
-+ ystdm_setreg(wc, chan_entry, 5, 0x9);
-+ break;
-+ case DAHDI_TXSIG_ONHOOK:
-+ wc->mod[chan_entry].fxo.offhook = 0;
-+ ystdm_setreg(wc, chan_entry, 5, 0x8);
-+ break;
-+ default:
-+ printk("wcfxo: Can't set tx state to %d\n", txsig);
-+ }
-+ } else {
-+ ystdm_fxs_hooksig(wc, chan_entry, txsig);
-+ }
-+ return 0;
-+}
-+
-+static const struct dahdi_span_ops ystdm_span_ops = {
-+ .owner = THIS_MODULE,
-+ .hooksig = ystdm_hooksig,
-+ .open = ystdm_open,
-+ .close = ystdm_close,
-+ .ioctl = ystdm_ioctl,
-+ .watchdog = ystdm_watchdog,
-+};
-+
-+static int ystdm_initialize(struct ystdm *wc)
-+{
-+ int x;
-+
-+ wc->ddev = dahdi_create_device();
-+ if (!wc->ddev)
-+ return -ENOMEM;
-+
-+ /* Zapata stuff */
-+ sprintf(wc->span.name, "WCTDM/%d", wc->pos);
-+ snprintf(wc->span.desc, sizeof(wc->span.desc) - 1, "%s Board %d", wc->variety, wc->pos + 1);
-+ wc->ddev->location = kasprintf(GFP_KERNEL,
-+ "PCI Bus %02d Slot %02d",
-+ wc->dev->bus->number,
-+ PCI_SLOT(wc->dev->devfn) + 1);
-+ if (!wc->ddev->location) {
-+ dahdi_free_device(wc->ddev);
-+ wc->ddev = NULL;
-+ return -ENOMEM;
-+ }
-+
-+ wc->ddev->manufacturer = "YEASTAR";
-+ wc->ddev->devicetype = wc->variety;
-+
-+ if (alawoverride) {
-+ printk("ALAW override parameter detected. Device will be operating in ALAW\n");
-+ wc->span.deflaw = DAHDI_LAW_ALAW;
-+ } else {
-+ wc->span.deflaw = DAHDI_LAW_MULAW;
-+ }
-+ for (x = 0; x < NUM_CARDS; x++) {
-+ sprintf(wc->chans[x]->name, "WCTDM/%d/%d", wc->pos, x);
-+ wc->chans[x]->sigcap = DAHDI_SIG_FXOKS | DAHDI_SIG_FXOLS | DAHDI_SIG_FXOGS | DAHDI_SIG_SF | DAHDI_SIG_EM | DAHDI_SIG_CLEAR;
-+ wc->chans[x]->sigcap |= DAHDI_SIG_FXSKS | DAHDI_SIG_FXSLS | DAHDI_SIG_SF | DAHDI_SIG_CLEAR;
-+ wc->chans[x]->chanpos = x+1;
-+ wc->chans[x]->pvt = wc;
-+ }
-+
-+ wc->span.chans = wc->chans;
-+ wc->span.channels = NUM_CARDS;
-+ wc->span.flags = DAHDI_FLAG_RBS;
-+ wc->span.ops = &ystdm_span_ops;
-+
-+ list_add_tail(&wc->span.device_node, &wc->ddev->spans);
-+ if (dahdi_register_device(wc->ddev, &wc->dev->dev)) {
-+ printk(KERN_NOTICE "Unable to register span with DAHDI\n");
-+ kfree(wc->ddev->location);
-+ dahdi_free_device(wc->ddev);
-+ wc->ddev = NULL;
-+ return -1;
-+ }
-+ return 0;
-+}
-+
-+static void ystdm_post_initialize(struct ystdm *wc)
-+{
-+ int x;
-+ /* Finalize signalling */
-+ for (x = 0; x < NUM_CARDS; x++) {
-+ if (wc->cardflag & (1 << x)) {
-+ if (wc->modtype[x] == MOD_TYPE_FXO)
-+ wc->chans[x]->sigcap = DAHDI_SIG_FXSKS | DAHDI_SIG_FXSLS | DAHDI_SIG_SF | DAHDI_SIG_CLEAR;
-+ else
-+ wc->chans[x]->sigcap = DAHDI_SIG_FXOKS | DAHDI_SIG_FXOLS | DAHDI_SIG_FXOGS | DAHDI_SIG_SF | DAHDI_SIG_EM | DAHDI_SIG_CLEAR;
-+ } else if (!(wc->chans[x]->sigcap & DAHDI_SIG_BROKEN)) {
-+ wc->chans[x]->sigcap = 0;
-+ }
-+
-+ }
-+}
-+
-+static int ystdm_hardware_init(struct ystdm *wc)
-+{
-+ /* Hardware stuff */
-+ unsigned char ver;
-+ unsigned char x,y;
-+ unsigned char ol = 0, sl = 0;
-+ unsigned char ol2 = 0, sl2 = 0;
-+ int failed;
-+
-+ /* Signal Reset */
-+ outb(0x01, wc->ioaddr + WC_CNTL);
-+
-+ /* Check Freshmaker chip */
-+ x=inb(wc->ioaddr + WC_CNTL);
-+ ver = __ystdm_getcreg(wc, WC_VER);
-+ failed = 0;
-+ if (ver != 0x59) {
-+ printk("Freshmaker version: %02x\n", ver);
-+ for (x=0;x<255;x++) {
-+ /* Test registers */
-+ if (ver >= 0x70) {
-+ __ystdm_setcreg(wc, WC_CS, x);
-+ y = __ystdm_getcreg(wc, WC_CS);
-+ } else {
-+ __ystdm_setcreg(wc, WC_TEST, x);
-+ y = __ystdm_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;
-+ }
-+ } else {
-+ printk("No freshmaker chip\n");
-+ }
-+
-+ /* Reset PCI Interface chip and registers (and serial) */
-+ outb(0x06, wc->ioaddr + WC_CNTL);
-+ /* Setup our proper outputs for when we switch for our "serial" port */
-+ wc->ios = BIT_CS | BIT_SCLK | BIT_SDI | BIT_SYNC;
-+
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+
-+ /* Set all to outputs except AUX 5, which is an input */
-+ outb(0xdf, wc->ioaddr + WC_AUXC);
-+
-+ /* Wait 1/4 of a sec */
-+ wait_just_a_bit(HZ/4);
-+
-+ /* Back to normal, with automatic DMA wrap around */
-+ outb(0x30 | 0x01, wc->ioaddr + WC_CNTL);
-+
-+ /* Make sure serial port and DMA are out of reset */
-+ outb(inb(wc->ioaddr + WC_CNTL) & 0xf9, wc->ioaddr + WC_CNTL);
-+
-+ /* Configure serial port for MSB->LSB operation */
-+ outb(0xc1, wc->ioaddr + WC_SERCTL);
-+
-+ /* Delay FSC by 0 so it's properly aligned */
-+ outb(0x0, wc->ioaddr + WC_FSCDELAY);
-+
-+ /* Setup DMA Addresses */
-+ outl(wc->writedma, wc->ioaddr + WC_DMAWS); /* Write start */
-+ outl(wc->writedma + DAHDI_CHUNKSIZE * NUM_CARDS - 4, wc->ioaddr + WC_DMAWI); /* Middle (interrupt) */
-+ outl(wc->writedma + 2 * DAHDI_CHUNKSIZE * NUM_CARDS - 4, wc->ioaddr + WC_DMAWE); /* End */
-+
-+ outl(wc->readdma, wc->ioaddr + WC_DMARS); /* Read start */
-+ outl(wc->readdma + DAHDI_CHUNKSIZE * NUM_CARDS - 4, wc->ioaddr + WC_DMARI); /* Middle (interrupt) */
-+ outl(wc->readdma + 2 * DAHDI_CHUNKSIZE * NUM_CARDS - 4, wc->ioaddr + WC_DMARE); /* End */
-+
-+ /* Clear interrupts */
-+ outb(0xff, wc->ioaddr + WC_INTSTAT);
-+
-+ /* Wait 1/4 of a second more */
-+ wait_just_a_bit(HZ/4);
-+
-+ for (x = 0; x < NUM_CARDS; x++) {
-+ int sane=0,ret=0,readi=0;
-+#if 1
-+ /* Init with Auto Calibration */
-+ if (!(ret=ystdm_init_proslic(wc, x, 0, 0, sane))) {
-+ wc->cardflag |= (1 << x);
-+ if(x < 8)
-+ sl |= (1 << x);
-+ else
-+ sl2 |= (1 << (x - 8));
-+ if (debug) {
-+ readi = ystdm_getreg(wc,x,LOOP_I_LIMIT);
-+ printk("Proslic module %d loop current is %dmA\n",x,((readi*3)+20));
-+ }
-+ printk("Module %d: Installed -- AUTO FXS/DPO\n",x);
-+ } else {
-+ if(ret!=-2) {
-+ sane=1;
-+ /* Init with Manual Calibration */
-+ if (!ystdm_init_proslic(wc, x, 0, 1, sane)) {
-+ wc->cardflag |= (1 << x);
-+ if(x < 8)
-+ sl |= (1 << x);
-+ else
-+ sl2 |= (1 << (x - 8));
-+ if (debug) {
-+ readi = ystdm_getreg(wc,x,LOOP_I_LIMIT);
-+ printk("Proslic module %d loop current is %dmA\n",x,((readi*3)+20));
-+ }
-+ printk("Module %d: Installed -- MANUAL FXS\n",x);
-+ } else {
-+ printk("Module %d: FAILED FXS (%s)\n", x, fxshonormode ? fxo_modes[_opermode].name : "FCC");
-+ wc->chans[x]->sigcap = __DAHDI_SIG_FXO | DAHDI_SIG_BROKEN;
-+ }
-+ } else if (!(ret = ystdm_init_voicedaa(wc, x, 0, 0, sane))) {
-+ wc->cardflag |= (1 << x);
-+ if(x < 8)
-+ ol |= (1 << x);
-+ else
-+ ol2 |= (1 << (x - 8));
-+ printk("Module %d: Installed -- AUTO FXO (%s mode)\n",x, fxo_modes[_opermode].name);
-+ } else
-+ printk("Module %d: Not installed\n", x);
-+ }
-+#endif
-+ }
-+
-+ /* Return error if nothing initialized okay. */
-+ if (!wc->cardflag && !timingonly)
-+ return -1;
-+ if(ver == 0x88)
-+ __ystdm_setcreg(wc, WC_SYNC, wc->cardflag);
-+ else{
-+ __ystdm_setcreg(wc, WC_SYNC, sl);
-+ __ystdm_setcreg(wc, YS_SLC, ol);
-+ __ystdm_setcreg(wc, YS_DCH, sl2);
-+ __ystdm_setcreg(wc, YS_E0H, ol2);
-+ }
-+ return 0;
-+}
-+
-+static void ystdm_enable_interrupts(struct ystdm *wc)
-+{
-+ /* Enable interrupts (we care about all of them) */
-+ outb(0x3f, wc->ioaddr + WC_MASK0);
-+ /* No external interrupts */
-+ outb(0x00, wc->ioaddr + WC_MASK1);
-+}
-+
-+static void ystdm_restart_dma(struct ystdm *wc)
-+{
-+ /* Reset Master and TDM */
-+ outb(0x01, wc->ioaddr + WC_CNTL);
-+ outb(0x01, wc->ioaddr + WC_OPER);
-+}
-+
-+static void ystdm_start_dma(struct ystdm *wc)
-+{
-+ /* Reset Master and TDM */
-+ unsigned char x,y;
-+ outb(0x0f, wc->ioaddr + WC_CNTL);
-+ wc->ios &= ~BIT_SYNC;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ set_current_state(TASK_INTERRUPTIBLE);
-+ schedule_timeout(1);
-+ wc->ios |= BIT_SYNC;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ outb(0x01, wc->ioaddr + WC_CNTL);
-+ outb(0x01, wc->ioaddr + WC_OPER);
-+ y = __ystdm_getcreg(wc, WC_TEST);
-+ x = y | 0x01;
-+ __ystdm_setcreg(wc, WC_TEST, x);
-+}
-+
-+static void ystdm_stop_dma(struct ystdm *wc)
-+{
-+ unsigned char x,y;
-+ wc->ios &= ~BIT_SYNC;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ outb(0x00, wc->ioaddr + WC_OPER);
-+ y = __ystdm_getcreg(wc, WC_TEST);
-+ x = y & 0xFE;
-+ __ystdm_setcreg(wc, WC_TEST, x);
-+}
-+
-+static void ystdm_reset_tdm(struct ystdm *wc)
-+{
-+ /* Reset TDM */
-+ outb(0x0f, wc->ioaddr + WC_CNTL);
-+}
-+
-+static void ystdm_disable_interrupts(struct ystdm *wc)
-+{
-+ outb(0x00, wc->ioaddr + WC_MASK0);
-+ outb(0x00, wc->ioaddr + WC_MASK1);
-+}
-+
-+static int __devinit ystdm_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
-+{
-+ int res;
-+ struct ystdm *wc;
-+ struct ystdm_desc *d = (struct ystdm_desc *)ent->driver_data;
-+ int x;
-+ int y;
-+
-+
-+
-+ for (x=0;x<WC_MAX_IFACES;x++)
-+ if (!ifaces[x]) break;
-+ if (x >= WC_MAX_IFACES) {
-+ printk("Too many interfaces\n");
-+ return -EIO;
-+ }
-+
-+ if (pci_enable_device(pdev)) {
-+ res = -EIO;
-+ } else {
-+ wc = kmalloc(sizeof(struct ystdm), GFP_KERNEL);
-+ if (wc) {
-+ int cardcount = 0;
-+
-+ ifaces[x] = wc;
-+ memset(wc, 0, sizeof(struct ystdm));
-+ for (x=0; x < sizeof(wc->chans)/sizeof(wc->chans[0]); ++x) {
-+ wc->chans[x] = &wc->_chans[x];
-+ }
-+ spin_lock_init(&wc->lock);
-+ wc->curcard = -1;
-+ wc->ioaddr = pci_resource_start(pdev, 0);
-+ wc->dev = pdev;
-+ wc->pos = x;
-+ wc->variety = d->name;
-+ for (y=0;y<NUM_CARDS;y++)
-+ wc->flags[y] = d->flags;
-+ /* Keep track of whether we need to free the region */
-+ if (request_region(wc->ioaddr, 0xff, "ystdm"))
-+ wc->freeregion = 1;
-+
-+ /* Allocate enough memory for two zt chunks, receive and transmit. Each sample uses
-+ 32 bits. Allocate an extra set just for control too */
-+ wc->writechunk = pci_alloc_consistent(pdev, DAHDI_MAX_CHUNKSIZE * 2 * 2 * 2 * NUM_CARDS, &wc->writedma);
-+ if (!wc->writechunk) {
-+ printk("ystdm: Unable to allocate DMA-able memory\n");
-+ if (wc->freeregion)
-+ release_region(wc->ioaddr, 0xff);
-+ return -ENOMEM;
-+ }
-+
-+ wc->readchunk = wc->writechunk + 2 * DAHDI_MAX_CHUNKSIZE * (NUM_CARDS / 4); /* in doublewords */
-+ wc->readdma = wc->writedma + 2 * DAHDI_MAX_CHUNKSIZE * (NUM_CARDS / 1); /* in bytes */
-+
-+ if (ystdm_initialize(wc)) {
-+ printk("ystdm: Unable to intialize FXS\n");
-+ /* Set Reset Low */
-+ x=inb(wc->ioaddr + WC_CNTL);
-+ outb((~0x1)&x, wc->ioaddr + WC_CNTL);
-+ /* Free Resources */
-+ free_irq(pdev->irq, wc);
-+ if (wc->freeregion)
-+ release_region(wc->ioaddr, 0xff);
-+ pci_free_consistent(pdev, DAHDI_MAX_CHUNKSIZE * 2 * 2 * 2 * NUM_CARDS, (void *)wc->writechunk, wc->writedma);
-+ kfree(wc);
-+ return -EIO;
-+ }
-+
-+ /* Enable bus mastering */
-+ pci_set_master(pdev);
-+
-+ /* Keep track of which device we are */
-+ pci_set_drvdata(pdev, wc);
-+
-+ if (request_irq(pdev->irq, ystdm_interrupt, DAHDI_IRQ_SHARED, "ystdm", wc)) {
-+ printk("ystdm: Unable to request IRQ %d\n", pdev->irq);
-+ if (wc->freeregion)
-+ release_region(wc->ioaddr, 0xff);
-+ pci_free_consistent(pdev, DAHDI_MAX_CHUNKSIZE * 2 * 2 * 2 * NUM_CARDS, (void *)wc->writechunk, wc->writedma);
-+ pci_set_drvdata(pdev, NULL);
-+ kfree(wc);
-+ return -EIO;
-+ }
-+
-+
-+ if (ystdm_hardware_init(wc)) {
-+ unsigned char x;
-+
-+ /* Set Reset Low */
-+ x=inb(wc->ioaddr + WC_CNTL);
-+ outb((~0x1)&x, wc->ioaddr + WC_CNTL);
-+ /* Free Resources */
-+ free_irq(pdev->irq, wc);
-+ if (wc->freeregion)
-+ release_region(wc->ioaddr, 0xff);
-+ pci_free_consistent(pdev, DAHDI_MAX_CHUNKSIZE * 2 * 2 * 2 * NUM_CARDS, (void *)wc->writechunk, wc->writedma);
-+ pci_set_drvdata(pdev, NULL);
-+ dahdi_unregister_device(wc->ddev);
-+ kfree(wc->ddev->location);
-+ dahdi_free_device(wc->ddev);
-+ kfree(wc);
-+ return -EIO;
-+
-+ }
-+
-+ ystdm_post_initialize(wc);
-+
-+ /* Enable interrupts */
-+ ystdm_enable_interrupts(wc);
-+ /* Initialize Write/Buffers to all blank data */
-+ memset((void *)wc->writechunk,0,DAHDI_MAX_CHUNKSIZE * 2 * 2 * NUM_CARDS);
-+
-+ /* Start DMA */
-+ ystdm_start_dma(wc);
-+
-+ for (x = 0; x < NUM_CARDS; x++) {
-+ if (wc->cardflag & (1 << x))
-+ cardcount++;
-+ }
-+
-+ printk("Found a YSTDM16xx: %s (%d modules)\n", wc->variety, cardcount);
-+ res = 0;
-+ } else
-+ res = -ENOMEM;
-+ }
-+ return res;
-+}
-+
-+static void ystdm_release(struct ystdm *wc)
-+{
-+ dahdi_unregister_device(wc->ddev);
-+ if (wc->freeregion)
-+ release_region(wc->ioaddr, 0xff);
-+ kfree(wc->ddev->location);
-+ dahdi_free_device(wc->ddev);
-+ kfree(wc);
-+ printk("Freed a Wildcard\n");
-+}
-+
-+static void __devexit ystdm_remove_one(struct pci_dev *pdev)
-+{
-+ struct ystdm *wc = pci_get_drvdata(pdev);
-+ if (wc) {
-+
-+ /* Stop any DMA */
-+ ystdm_stop_dma(wc);
-+ ystdm_reset_tdm(wc);
-+
-+ /* In case hardware is still there */
-+ ystdm_disable_interrupts(wc);
-+
-+ /* Immediately free resources */
-+ pci_free_consistent(pdev, DAHDI_MAX_CHUNKSIZE * 2 * 2 * 2 * NUM_CARDS, (void *)wc->writechunk, wc->writedma);
-+ free_irq(pdev->irq, wc);
-+
-+ /* Reset PCI chip and registers */
-+ outb(0x0e, wc->ioaddr + WC_CNTL);
-+
-+ /* Release span, possibly delayed */
-+ if (!wc->usecount)
-+ ystdm_release(wc);
-+ else
-+ wc->dead = 1;
-+ }
-+}
-+
-+static DEFINE_PCI_DEVICE_TABLE(ystdm_pci_tbl) = {
-+ { 0xe159, 0x0001, 0x6151, PCI_ANY_ID, 0, 0, (unsigned long) &ystdme },
-+ { 0 }
-+};
-+
-+MODULE_DEVICE_TABLE(pci, ystdm_pci_tbl);
-+
-+static int ystdm_suspend(struct pci_dev *pdev, pm_message_t state)
-+{
-+ return -ENOSYS;
-+}
-+
-+static struct pci_driver ystdm_driver = {
-+ .name = "ystdm16xx",
-+ .probe = ystdm_init_one,
-+ .remove = __devexit_p(ystdm_remove_one),
-+ .suspend = ystdm_suspend,
-+ .id_table = ystdm_pci_tbl,
-+};
-+
-+static int __init ystdm_init(void)
-+{
-+ int res;
-+ int x;
-+
-+ for (x=0;x<(sizeof(fxo_modes) / sizeof(fxo_modes[0])); x++) {
-+ if (!strcmp(fxo_modes[x].name, opermode))
-+ break;
-+ }
-+ if (x < sizeof(fxo_modes) / sizeof(fxo_modes[0])) {
-+ _opermode = x;
-+ } else {
-+ printk("Invalid/unknown operating mode '%s' specified. Please choose one of:\n", opermode);
-+ for (x = 0; x < sizeof(fxo_modes) / sizeof(fxo_modes[0]); x++)
-+ printk(" %s\n", fxo_modes[x].name);
-+ printk("Note this option is CASE SENSITIVE!\n");
-+ return -ENODEV;
-+ }
-+ if (!strcmp(opermode, "AUSTRALIA")) {
-+ boostringer = 1;
-+ fxshonormode = 1;
-+ }
-+
-+ /* for the voicedaa_check_hook defaults, if the user has not overridden
-+ them by specifying them as module parameters, then get the values
-+ from the selected operating mode
-+ */
-+ if (battdebounce == 0) {
-+ battdebounce = fxo_modes[_opermode].battdebounce;
-+ }
-+ if (battalarm == 0) {
-+ battalarm = fxo_modes[_opermode].battalarm;
-+ }
-+ if (battthresh == 0) {
-+ battthresh = fxo_modes[_opermode].battthresh;
-+ }
-+
-+
-+ res = dahdi_pci_module(&ystdm_driver);
-+ if (res)
-+ return -ENODEV;
-+ return 0;
-+}
-+
-+static void __exit ystdm_cleanup(void)
-+{
-+ pci_unregister_driver(&ystdm_driver);
-+}
-+
-+module_param(debug, int, 0600);
-+module_param(fxovoltage, int, 0600);
-+module_param(loopcurrent, int, 0600);
-+module_param(reversepolarity, int, 0600);
-+module_param(robust, int, 0600);
-+module_param(opermode, charp, 0600);
-+module_param(timingonly, int, 0600);
-+module_param(lowpower, int, 0600);
-+module_param(boostringer, int, 0600);
-+module_param(fastringer, int, 0600);
-+module_param(fxshonormode, int, 0600);
-+module_param(battdebounce, uint, 0600);
-+module_param(battalarm, uint, 0600);
-+module_param(battthresh, uint, 0600);
-+module_param(ringdebounce, int, 0600);
-+module_param(dialdebounce, int, 0600);
-+module_param(fwringdetect, int, 0600);
-+module_param(alawoverride, int, 0600);
-+module_param(fastpickup, int, 0600);
-+module_param(fxotxgain, int, 0600);
-+module_param(fxorxgain, int, 0600);
-+module_param(fxstxgain, int, 0600);
-+module_param(fxsrxgain, int, 0600);
-+module_param(dtmf, int, 0600);
-+
-+MODULE_DESCRIPTION("YSTDM16xx Yeastar Driver");
-+MODULE_AUTHOR("yeastar <support@yeastar.com>");
-+MODULE_ALIAS("ystdm16xx");
-+#ifdef MODULE_LICENSE
-+MODULE_LICENSE("GPL v2");
-+#endif
-+
-+module_init(ystdm_init);
-+module_exit(ystdm_cleanup);
-diff -Nur dahdi-linux-2.10.0.1/drivers/dahdi/ystdm8xx.c dahdi-linux-2.10.0.1-yeastar/drivers/dahdi/ystdm8xx.c
---- dahdi-linux-2.10.0.1/drivers/dahdi/ystdm8xx.c 1970-01-01 01:00:00.000000000 +0100
-+++ dahdi-linux-2.10.0.1-yeastar/drivers/dahdi/ystdm8xx.c 2015-02-10 15:33:19.363713850 +0100
-@@ -0,0 +1,3065 @@
-+/*
-+ * Yeastar YSTDM8xx TDM FXS/FXO Interface Driver for Zapata Telephony interface
-+ *
-+ * Derived from wctdm.c written by Mark Spencer <markster@linux-support.net>
-+ * Matthew Fredrickson <creslin@linux-support.net>
-+ *
-+ * Copyright (C) 2006, Yeastar Technology Co.,Ltd. <support@yeastar.com>
-+ * Copyright (C) 2001, Linux Support Services, Inc.
-+ *
-+ * All rights reserved.
-+ *
-+ * 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 <linux/kernel.h>
-+#include <linux/errno.h>
-+#include <linux/module.h>
-+#include <linux/init.h>
-+
-+#include <linux/pci.h>
-+#include <linux/interrupt.h>
-+#include <linux/moduleparam.h>
-+#include <linux/sched.h>
-+#include <linux/ioctl.h>
-+#include <asm/io.h>
-+#include "proslic.h"
-+/*
-+ * Define for audio vs. register based ring detection
-+ *
-+ */
-+//#define AUDIO_RINGCHECK
-+
-+/*
-+ Experimental max loop current limit for the proslic
-+ Loop current limit is from 20 mA to 41 mA in steps of 3
-+ (according to datasheet)
-+ So set the value below to:
-+ 0x00 : 20mA (default)
-+ 0x01 : 23mA
-+ 0x02 : 26mA
-+ 0x03 : 29mA
-+ 0x04 : 32mA
-+ 0x05 : 35mA
-+ 0x06 : 37mA
-+ 0x07 : 41mA
-+*/
-+static int loopcurrent = 20;
-+#define POLARITY_XOR (\
-+ (reversepolarity != 0) ^ (fxs->reversepolarity != 0) ^\
-+ (fxs->vmwi_lrev != 0) ^\
-+ ((fxs->vmwisetting.vmwi_type & DAHDI_VMWI_HVAC) != 0))
-+
-+static int reversepolarity = 0;
-+
-+static alpha indirect_regs[] =
-+{
-+{0,255,"DTMF_ROW_0_PEAK",0x55C2},
-+{1,255,"DTMF_ROW_1_PEAK",0x51E6},
-+{2,255,"DTMF_ROW2_PEAK",0x4B85},
-+{3,255,"DTMF_ROW3_PEAK",0x4937},
-+{4,255,"DTMF_COL1_PEAK",0x3333},
-+{5,255,"DTMF_FWD_TWIST",0x0202},
-+{6,255,"DTMF_RVS_TWIST",0x0202},
-+{7,255,"DTMF_ROW_RATIO_TRES",0x0198},
-+{8,255,"DTMF_COL_RATIO_TRES",0x0198},
-+{9,255,"DTMF_ROW_2ND_ARM",0x0611},
-+{10,255,"DTMF_COL_2ND_ARM",0x0202},
-+{11,255,"DTMF_PWR_MIN_TRES",0x00E5},
-+{12,255,"DTMF_OT_LIM_TRES",0x0A1C},
-+{13,0,"OSC1_COEF",0x7B30},
-+{14,1,"OSC1X",0x0063},
-+{15,2,"OSC1Y",0x0000},
-+{16,3,"OSC2_COEF",0x7870},
-+{17,4,"OSC2X",0x007D},
-+{18,5,"OSC2Y",0x0000},
-+{19,6,"RING_V_OFF",0x0000},
-+{20,7,"RING_OSC",0x7EF0},
-+{21,8,"RING_X",0x0160},
-+{22,9,"RING_Y",0x0000},
-+{23,255,"PULSE_ENVEL",0x2000},
-+{24,255,"PULSE_X",0x2000},
-+{25,255,"PULSE_Y",0x0000},
-+//{26,13,"RECV_DIGITAL_GAIN",0x4000}, // playback volume set lower
-+{26,13,"RECV_DIGITAL_GAIN",0x4000}, // playback volume set lower
-+{27,14,"XMIT_DIGITAL_GAIN",0x3000},
-+//{27,14,"XMIT_DIGITAL_GAIN",0x2000},
-+{28,15,"LOOP_CLOSE_TRES",0x1000},
-+{29,16,"RING_TRIP_TRES",0x3600},
-+{30,17,"COMMON_MIN_TRES",0x1000},
-+{31,18,"COMMON_MAX_TRES",0x0200},
-+{32,19,"PWR_ALARM_Q1Q2",0x07C0},
-+{33,20,"PWR_ALARM_Q3Q4",0x2600},
-+{34,21,"PWR_ALARM_Q5Q6",0x1B80},
-+{35,22,"LOOP_CLOSURE_FILTER",0x8000},
-+{36,23,"RING_TRIP_FILTER",0x0320},
-+{37,24,"TERM_LP_POLE_Q1Q2",0x008C},
-+{38,25,"TERM_LP_POLE_Q3Q4",0x0100},
-+{39,26,"TERM_LP_POLE_Q5Q6",0x0010},
-+{40,27,"CM_BIAS_RINGING",0x0C00},
-+{41,64,"DCDC_MIN_V",0x0C00},
-+{42,255,"DCDC_XTRA",0x1000},
-+{43,66,"LOOP_CLOSE_TRES_LOW",0x1000},
-+};
-+
-+#include <dahdi/kernel.h>
-+
-+#include "fxo_modes.h"
-+
-+#define NUM_FXO_REGS 60
-+
-+#define WC_MAX_IFACES 128
-+
-+#define WC_CNTL 0x00
-+#define WC_OPER 0x01
-+#define WC_AUXC 0x02
-+#define WC_AUXD 0x03
-+#define WC_MASK0 0x04
-+#define WC_MASK1 0x05
-+#define WC_INTSTAT 0x06
-+#define WC_AUXR 0x07
-+
-+#define WC_DMAWS 0x08
-+#define WC_DMAWI 0x0c
-+#define WC_DMAWE 0x10
-+#define WC_DMARS 0x18
-+#define WC_DMARI 0x1c
-+#define WC_DMARE 0x20
-+
-+#define WC_AUXFUNC 0x2b
-+#define WC_SERCTL 0x2d
-+#define WC_FSCDELAY 0x2f
-+
-+#define WC_REGBASE 0xc0
-+
-+#define WC_SYNC 0x0
-+#define WC_TEST 0x1
-+#define WC_CS 0x2
-+#define WC_VER 0x3
-+#define YS_SLC 0x4
-+
-+#define BIT_SYNC (1 << 0)
-+#define BIT_CS (1 << 2)
-+#define BIT_SCLK (1 << 3)
-+#define BIT_SDI (1 << 4)
-+#define BIT_SDO (1 << 5)
-+
-+#define FLAG_EMPTY 0
-+#define FLAG_WRITE 1
-+#define FLAG_READ 2
-+
-+/* the constants below control the 'debounce' periods enforced by the
-+ check_hook routines; these routines are called once every 4 interrupts
-+ (the interrupt cycles around the four modules), so the periods are
-+ specified in _4 millisecond_ increments
-+*/
-+#define DEFAULT_RING_DEBOUNCE 64 /* Ringer Debounce (64 ms) */
-+
-+#define POLARITY_DEBOUNCE 64 /* Polarity debounce (64 ms) */
-+
-+#define OHT_TIMER 6000 /* How long after RING to retain OHT */
-+
-+/* NEON MWI pulse width - Make larger for longer period time
-+ * For more information on NEON MWI generation using the proslic
-+ * refer to Silicon Labs App Note "AN33-SI321X NEON FLASHING"
-+ * RNGY = RNGY 1/2 * Period * 8000
-+ */
-+#define NEON_MWI_RNGY_PULSEWIDTH 0x3e8 /*=> period of 250 mS */
-+
-+#define FLAG_3215 (1 << 0)
-+
-+#define NUM_CARDS 8
-+
-+#define MAX_ALARMS 10
-+
-+#define MOD_TYPE_FXS 0
-+#define MOD_TYPE_FXO 1
-+
-+#define MINPEGTIME 10 * 8 /* 30 ms peak to peak gets us no more than 100 Hz */
-+#define PEGTIME 50 * 8 /* 50ms peak to peak gets us rings of 10 Hz or more */
-+#define PEGCOUNT 5 /* 5 cycles of pegging means RING */
-+
-+#define NUM_CAL_REGS 12
-+
-+struct calregs {
-+ unsigned char vals[NUM_CAL_REGS];
-+};
-+
-+enum proslic_power_warn {
-+ PROSLIC_POWER_UNKNOWN = 0,
-+ PROSLIC_POWER_ON,
-+ PROSLIC_POWER_WARNED,
-+};
-+
-+enum battery_state {
-+ BATTERY_UNKNOWN = 0,
-+ BATTERY_PRESENT,
-+ BATTERY_LOST,
-+};
-+
-+#define NUM_REGS 109
-+#define NUM_INDIRECT_REGS 105
-+
-+struct ystdm_stats {
-+ int tipvolt; /* TIP voltage (mV) */
-+ int ringvolt; /* RING voltage (mV) */
-+ int batvolt; /* VBAT voltage (mV) */
-+};
-+
-+struct ystdm_regs {
-+ unsigned char direct[NUM_REGS];
-+ unsigned short indirect[NUM_INDIRECT_REGS];
-+};
-+
-+struct ystdm_regop {
-+ int indirect;
-+ unsigned char reg;
-+ unsigned short val;
-+};
-+
-+struct ystdm_echo_coefs {
-+ unsigned char acim;
-+ unsigned char coef1;
-+ unsigned char coef2;
-+ unsigned char coef3;
-+ unsigned char coef4;
-+ unsigned char coef5;
-+ unsigned char coef6;
-+ unsigned char coef7;
-+ unsigned char coef8;
-+};
-+
-+#define WCTDM_GET_STATS _IOR (DAHDI_CODE, 60, struct ystdm_stats)
-+#define WCTDM_GET_REGS _IOR (DAHDI_CODE, 61, struct ystdm_regs)
-+#define WCTDM_SET_REG _IOW (DAHDI_CODE, 62, struct ystdm_regop)
-+#define WCTDM_SET_ECHOTUNE _IOW (DAHDI_CODE, 63, struct ystdm_echo_coefs)
-+
-+struct ystdm {
-+ struct pci_dev *dev;
-+ char *variety;
-+ struct dahdi_span span;
-+ struct dahdi_device *ddev;
-+ unsigned char ios;
-+ int usecount;
-+ unsigned int intcount;
-+ int dead;
-+ int pos;
-+ int flags[NUM_CARDS];
-+ int freeregion;
-+ int alt;
-+ int curcard;
-+ int cardflag; /* Bit-map of present cards */
-+ enum proslic_power_warn proslic_power;
-+ spinlock_t lock;
-+
-+ union {
-+ struct fxo {
-+#ifdef AUDIO_RINGCHECK
-+ unsigned int pegtimer;
-+ int pegcount;
-+ int peg;
-+ int ring;
-+#else
-+ int wasringing;
-+ int lastrdtx;
-+#endif
-+ int ringdebounce;
-+ int offhook;
-+ unsigned int battdebounce;
-+ unsigned int battalarm;
-+ enum battery_state battery;
-+ int lastpol;
-+ int polarity;
-+ int polaritydebounce;
-+ int readcid;
-+ unsigned int cidtimer;
-+ } fxo;
-+ struct fxs {
-+ int oldrxhook;
-+ int debouncehook;
-+ int lastrxhook;
-+ int debounce;
-+ int ohttimer;
-+ int idletxhookstate; /* IDLE changing hook state */
-+ int lasttxhook;
-+ int palarms;
-+ int reversepolarity; /* Reverse Line */
-+ int mwisendtype;
-+ struct dahdi_vmwi_info vmwisetting;
-+ int vmwi_active_messages;
-+ u32 vmwi_lrev:1; /* MWI Line Reversal*/
-+ u32 vmwi_hvdc:1; /* MWI High Voltage DC Idle line */
-+ u32 vmwi_hvac:1; /* MWI Neon High Voltage AC Idle line */
-+ u32 neonringing:1; /* Ring Generator is set for NEON */
-+ struct calregs calregs;
-+ } fxs;
-+ } mod[NUM_CARDS];
-+
-+ /* Receive hook state and debouncing */
-+ int modtype[NUM_CARDS];
-+ unsigned char reg0shadow[NUM_CARDS];
-+ unsigned char reg1shadow[NUM_CARDS];
-+
-+ unsigned long ioaddr;
-+ dma_addr_t readdma;
-+ dma_addr_t writedma;
-+ volatile unsigned int *writechunk; /* Double-word aligned write memory */
-+ volatile unsigned int *readchunk; /* Double-word aligned read memory */
-+ struct dahdi_chan _chans[NUM_CARDS];
-+ struct dahdi_chan *chans[NUM_CARDS];
-+};
-+
-+
-+struct ystdm_desc {
-+ char *name;
-+ int flags;
-+};
-+
-+static struct ystdm_desc ystdme = { "YSTDM8xx REV E", 0 };
-+static int acim2tiss[16] = { 0x0, 0x1, 0x4, 0x5, 0x7, 0x0, 0x0, 0x6, 0x0, 0x0, 0x0, 0x2, 0x0, 0x3 };
-+
-+static struct ystdm *ifaces[WC_MAX_IFACES];
-+
-+static void ystdm_release(struct ystdm *wc);
-+
-+static unsigned int fxovoltage;
-+static unsigned int battdebounce;
-+static unsigned int battalarm;
-+static unsigned int battthresh;
-+static int ringdebounce = DEFAULT_RING_DEBOUNCE;
-+/* times 4, because must be a multiple of 4ms: */
-+static int dialdebounce = 8 * 8;
-+static int fwringdetect = 0;
-+static int debug = 0;
-+static int robust = 0;
-+static int timingonly = 0;
-+static int lowpower = 0;
-+static int boostringer = 0;
-+static int fastringer = 0;
-+static int _opermode = 0;
-+static char *opermode = "FCC";
-+static int fxshonormode = 0;
-+static int alawoverride = 0;
-+static int dtmf = 0;
-+static int fastpickup = 0;
-+static int fxotxgain = 0;
-+static int fxorxgain = 0;
-+static int fxstxgain = 0;
-+static int fxsrxgain = 0;
-+
-+static int ystdm_init_proslic(struct ystdm *wc, int card, int fast , int manual, int sane);
-+static int ystdm_init_ring_generator_mode(struct ystdm *wc, int card);
-+static int ystdm_set_ring_generator_mode(struct ystdm *wc, int card, int mode);
-+
-+static inline void ystdm_transmitprep(struct ystdm *wc, unsigned char ints)
-+{
-+ volatile unsigned int *writechunk;
-+ int x;
-+ if (ints & 0x01)
-+ /* Write is at interrupt address. Start writing from normal offset */
-+ writechunk = wc->writechunk;
-+ else
-+ writechunk = wc->writechunk + DAHDI_CHUNKSIZE * (NUM_CARDS / 4);
-+ /* Calculate Transmission */
-+ dahdi_transmit(&wc->span);
-+
-+ for (x=0;x<DAHDI_CHUNKSIZE;x++) {
-+ /* Send a sample, as a 32-bit word */
-+ writechunk[2 * x] = 0;
-+ writechunk[2 * x + 1] = 0;
-+#ifdef __BIG_ENDIAN
-+ if (wc->cardflag & (1 << 7))
-+ writechunk[2 * x] |= (wc->chans[7]->writechunk[x]);
-+ if (wc->cardflag & (1 << 6))
-+ writechunk[2 * x] |= (wc->chans[6]->writechunk[x] << 8);
-+ if (wc->cardflag & (1 << 5))
-+ writechunk[2 * x] |= (wc->chans[5]->writechunk[x] << 16);
-+ if (wc->cardflag & (1 << 4))
-+ writechunk[2 * x] |= (wc->chans[4]->writechunk[x] << 24);
-+
-+ if (wc->cardflag & (1 << 3))
-+ writechunk[2 * x + 1] |= (wc->chans[3]->writechunk[x]);
-+ if (wc->cardflag & (1 << 2))
-+ writechunk[2 * x + 1] |= (wc->chans[2]->writechunk[x] << 8);
-+ if (wc->cardflag & (1 << 1))
-+ writechunk[2 * x + 1] |= (wc->chans[1]->writechunk[x] << 16);
-+ if (wc->cardflag & (1 << 0))
-+ writechunk[2 * x + 1] |= (wc->chans[0]->writechunk[x] << 24);
-+#else
-+ if (wc->cardflag & (1 << 7))
-+ writechunk[2 * x] |= (wc->chans[7]->writechunk[x] << 24);
-+ if (wc->cardflag & (1 << 6))
-+ writechunk[2 * x] |= (wc->chans[6]->writechunk[x] << 16);
-+ if (wc->cardflag & (1 << 5))
-+ writechunk[2 * x] |= (wc->chans[5]->writechunk[x] << 8);
-+ if (wc->cardflag & (1 << 4))
-+ writechunk[2 * x] |= (wc->chans[4]->writechunk[x]);
-+
-+ if (wc->cardflag & (1 << 3))
-+ writechunk[2 * x + 1] |= (wc->chans[3]->writechunk[x] << 24);
-+ if (wc->cardflag & (1 << 2))
-+ writechunk[2 * x + 1] |= (wc->chans[2]->writechunk[x] << 16);
-+ if (wc->cardflag & (1 << 1))
-+ writechunk[2 * x + 1] |= (wc->chans[1]->writechunk[x] << 8);
-+ if (wc->cardflag & (1 << 0))
-+ writechunk[2 * x + 1] |= (wc->chans[0]->writechunk[x]);
-+#endif
-+ }
-+
-+}
-+
-+#ifdef AUDIO_RINGCHECK
-+static inline void ring_check(struct ystdm *wc, int card)
-+{
-+ int x;
-+ short sample;
-+ if (wc->modtype[card] != MOD_TYPE_FXO)
-+ return;< if (fxovoltage) {
-+< static int count = 0;
-+< if (!(count++ % 100)) {
-+< printk(KERN_DEBUG "Card %d: Voltage: %d Debounce %d\n", card + 1, b, fxo->battdebounce);
-+< }
-+< }
-+
-+ wc->mod[card].fxo.pegtimer += DAHDI_CHUNKSIZE;
-+ for (x=0;x<DAHDI_CHUNKSIZE;x++) {
-+ /* Look for pegging to indicate ringing */
-+ sample = DAHDI_XLAW(wc->chans[card]->readchunk[x], (wc->chans[card]));
-+ if ((sample > 10000) && (wc->mod[card].fxo.peg != 1)) {
-+ if (debug > 1) printk(KERN_DEBUG "High peg!\n");
-+ if ((wc->mod[card].fxo.pegtimer < PEGTIME) && (wc->mod[card].fxo.pegtimer > MINPEGTIME))
-+ wc->mod[card].fxo.pegcount++;
-+ wc->mod[card].fxo.pegtimer = 0;
-+ wc->mod[card].fxo.peg = 1;
-+ } else if ((sample < -10000) && (wc->mod[card].fxo.peg != -1)) {
-+ if (debug > 1) printk(KERN_DEBUG "Low peg!\n");
-+ if ((wc->mod[card].fxo.pegtimer < (PEGTIME >> 2)) && (wc->mod[card].fxo.pegtimer > (MINPEGTIME >> 2)))
-+ wc->mod[card].fxo.pegcount++;
-+ wc->mod[card].fxo.pegtimer = 0;
-+ wc->mod[card].fxo.peg = -1;
-+ }
-+ }
-+ if (wc->mod[card].fxo.pegtimer > PEGTIME) {
-+ /* Reset pegcount if our timer expires */
-+ wc->mod[card].fxo.pegcount = 0;
-+ }
-+ /* Decrement debouncer if appropriate */
-+ if (wc->mod[card].fxo.ringdebounce)
-+ wc->mod[card].fxo.ringdebounce--;
-+ if (!wc->mod[card].fxo.offhook && !wc->mod[card].fxo.ringdebounce) {
-+ if (!wc->mod[card].fxo.ring && (wc->mod[card].fxo.pegcount > PEGCOUNT)) {
-+ /* It's ringing */
-+ if (debug)
-+ printk(KERN_DEBUG "RING on %d/%d!\n", wc->span.spanno, card + 1);
-+ if (!wc->mod[card].fxo.offhook)
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_RING);
-+ wc->mod[card].fxo.ring = 1;
-+ wc->mod[card].fxo.readcid = 1;
-+ }
-+ if (wc->mod[card].fxo.ring && !wc->mod[card].fxo.pegcount) {
-+ /* No more ring */
-+ if (debug)
-+ printk(KERN_DEBUG "NO RING on %d/%d!\n", wc->span.spanno, card + 1);
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_OFFHOOK);
-+ wc->mod[card].fxo.ring = 0;
-+ wc->mod[card].fxo.cidtimer = wc->intcount;
-+ wc->mod[card].fxo.readcid = 0;
-+ }
-+ }
-+}
-+#endif
-+static inline void ystdm_dtmfcheck_fakepolarity(struct ystdm *wc, int card, int x)
-+{
-+ int sample;
-+ /* only look for sound on the line if dtmf flag is on, it is an fxo card and line is onhook */
-+ if (!dtmf || !(wc->cardflag & (1 << card)) || !(wc->modtype[card] == MOD_TYPE_FXO) || wc->mod[card].fxo.offhook )
-+ return;
-+
-+ /* don't look for noise if we're already processing it, or there is a ringing tone */
-+ if(!wc->mod[card].fxo.readcid && !wc->mod[card].fxo.wasringing &&
-+ wc->intcount > wc->mod[card].fxo.cidtimer + 400 ) {
-+ sample = DAHDI_XLAW(wc->chans[card]->readchunk[x], (wc->chans[card]));
-+ if (sample > 16000 || sample < -16000) {
-+ wc->mod[card].fxo.readcid = 1;
-+ wc->mod[card].fxo.cidtimer = wc->intcount;
-+ if (debug) printk("DTMF CLIP on %i\n",card+1);
-+ dahdi_qevent_lock(wc->chans[card], DAHDI_EVENT_POLARITY);
-+ }
-+ } else if(wc->mod[card].fxo.readcid && wc->intcount > wc->mod[card].fxo.cidtimer + 2000) {
-+ /* reset flags if it's been a while */
-+ wc->mod[card].fxo.cidtimer = wc->intcount;
-+ wc->mod[card].fxo.readcid = 0;
-+ }
-+}
-+static inline void ystdm_receiveprep(struct ystdm *wc, unsigned char ints)
-+{
-+ volatile unsigned int *readchunk;
-+ int x;
-+
-+ if (ints & 0x08)
-+ readchunk = wc->readchunk + DAHDI_CHUNKSIZE * (NUM_CARDS / 4);
-+ else
-+ /* Read is at interrupt address. Valid data is available at normal offset */
-+ readchunk = wc->readchunk;
-+ for (x=0;x<DAHDI_CHUNKSIZE;x++) {
-+#ifdef __BIG_ENDIAN
-+ if (wc->cardflag & (1 << 7))
-+ wc->chans[7]->readchunk[x] = (readchunk[2 * x + 1]) & 0xff;
-+ if (wc->cardflag & (1 << 6))
-+ wc->chans[6]->readchunk[x] = (readchunk[2 * x + 1] >> 8) & 0xff;
-+ if (wc->cardflag & (1 << 5))
-+ wc->chans[5]->readchunk[x] = (readchunk[2 * x + 1] >> 16) & 0xff;
-+ if (wc->cardflag & (1 << 4))
-+ wc->chans[4]->readchunk[x] = (readchunk[2 * x + 1] >> 24) & 0xff;
-+
-+ if (wc->cardflag & (1 << 3))
-+ wc->chans[3]->readchunk[x] = (readchunk[2 * x]) & 0xff;
-+ if (wc->cardflag & (1 << 2))
-+ wc->chans[2]->readchunk[x] = (readchunk[2 * x] >> 8) & 0xff;
-+ if (wc->cardflag & (1 << 1))
-+ wc->chans[1]->readchunk[x] = (readchunk[2 * x] >> 16) & 0xff;
-+ if (wc->cardflag & (1 << 0))
-+ wc->chans[0]->readchunk[x] = (readchunk[2 * x] >> 24) & 0xff;
-+#else
-+ if (wc->cardflag & (1 << 7))
-+ wc->chans[7]->readchunk[x] = (readchunk[2 * x + 1] >> 24) & 0xff;
-+ if (wc->cardflag & (1 << 6))
-+ wc->chans[6]->readchunk[x] = (readchunk[2 * x + 1] >> 16) & 0xff;
-+ if (wc->cardflag & (1 << 5))
-+ wc->chans[5]->readchunk[x] = (readchunk[2 * x + 1] >> 8) & 0xff;
-+ if (wc->cardflag & (1 << 4))
-+ wc->chans[4]->readchunk[x] = (readchunk[2 * x + 1]) & 0xff;
-+
-+ if (wc->cardflag & (1 << 3))
-+ wc->chans[3]->readchunk[x] = (readchunk[2 * x] >> 24) & 0xff;
-+ if (wc->cardflag & (1 << 2))
-+ wc->chans[2]->readchunk[x] = (readchunk[2 * x] >> 16) & 0xff;
-+ if (wc->cardflag & (1 << 1))
-+ wc->chans[1]->readchunk[x] = (readchunk[2 * x] >> 8) & 0xff;
-+ if (wc->cardflag & (1 << 0))
-+ wc->chans[0]->readchunk[x] = (readchunk[2 * x]) & 0xff;
-+#endif
-+
-+ /*ystdm_dtmfcheck_fakepolarity(wc,0,x);
-+ ystdm_dtmfcheck_fakepolarity(wc,1,x);
-+ ystdm_dtmfcheck_fakepolarity(wc,2,x);
-+ ystdm_dtmfcheck_fakepolarity(wc,3,x);
-+ ystdm_dtmfcheck_fakepolarity(wc,4,x);
-+ ystdm_dtmfcheck_fakepolarity(wc,5,x);
-+ ystdm_dtmfcheck_fakepolarity(wc,6,x);
-+ ystdm_dtmfcheck_fakepolarity(wc,7,x);*/
-+ }
-+#ifdef AUDIO_RINGCHECK
-+ for (x=0;x<wc->cards;x++)
-+ ring_check(wc, x);
-+#endif
-+ /* XXX We're wasting 8 taps. We should get closer :( */
-+ for (x = 0; x < NUM_CARDS; x++) {
-+ if (wc->cardflag & (1 << x))
-+ dahdi_ec_chunk(wc->chans[x], wc->chans[x]->readchunk, wc->chans[x]->writechunk);
-+ }
-+ dahdi_receive(&wc->span);
-+}
-+
-+static void ystdm_stop_dma(struct ystdm *wc);
-+static void ystdm_reset_tdm(struct ystdm *wc);
-+static void ystdm_restart_dma(struct ystdm *wc);
-+
-+static inline void __write_8bits(struct ystdm *wc, unsigned char bits)
-+{
-+/* Out BIT_CS --\________________________________/---- */
-+/* Out BIT_SCLK ---\_/-\_/-\_/-\_/-\_/-\_/-\_/-\_/------ */
-+/* Out BIT_SDI ---\___/---\___/---\___/---\___/-------- */
-+/* Data Bit 7 6 5 4 3 2 1 0 */
-+/* Data written 0 1 0 1 0 1 0 1 */
-+
-+ int x;
-+ /* Drop chip select */
-+ wc->ios &= ~BIT_CS;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ for (x=0;x<8;x++) {
-+ /* Send out each bit, MSB first, drop SCLK as we do so */
-+ if (bits & 0x80)
-+ wc->ios |= BIT_SDI;
-+ else
-+ wc->ios &= ~BIT_SDI;
-+ wc->ios &= ~BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ /* Now raise SCLK high again and repeat */
-+ wc->ios |= BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ bits <<= 1;
-+ }
-+ /* Finally raise CS back high again */
-+ wc->ios |= BIT_CS;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+
-+}
-+
-+static inline void __reset_spi(struct ystdm *wc)
-+{
-+ /* Drop chip select and clock once and raise and clock once */
-+ wc->ios |= BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ wc->ios &= ~BIT_CS;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ wc->ios |= BIT_SDI;
-+ wc->ios &= ~BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ /* Now raise SCLK high again and repeat */
-+ wc->ios |= BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ /* Finally raise CS back high again */
-+ wc->ios |= BIT_CS;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ /* Clock again */
-+ wc->ios &= ~BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ /* Now raise SCLK high again and repeat */
-+ wc->ios |= BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+
-+}
-+
-+static inline unsigned char __read_8bits(struct ystdm *wc)
-+{
-+/* Out BIT_CS --\________________________________________/----*/
-+/* Out BIT_SCLK ---\_/--\_/--\_/--\_/--\_/--\_/--\_/--\_/-------*/
-+/* In BIT_SDO ????/1111\0000/1111\0000/1111\0000/1111\0000/???*/
-+/* Data bit 7 6 5 4 3 2 1 0 */
-+/* Data Read 1 0 1 0 1 0 1 0 */
-+
-+/* Note: Clock High time is 2x Low time, due to input read */
-+
-+ unsigned char res=0, c;
-+ int x;
-+ /* Drop chip select */
-+ wc->ios &= ~BIT_CS;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ for (x=0;x<8;x++) {
-+ res <<= 1;
-+ /* Drop SCLK */
-+ wc->ios &= ~BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ /* Now raise SCLK high again */
-+ wc->ios |= BIT_SCLK;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+
-+ /* Read back the value */
-+ c = inb(wc->ioaddr + WC_AUXR);
-+ if (c & BIT_SDO)
-+ res |= 1;
-+ }
-+ /* Finally raise CS back high again */
-+ wc->ios |= BIT_CS;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+
-+ /* And return our result */
-+ return res;
-+}
-+
-+static void __ystdm_setcreg(struct ystdm *wc, unsigned char reg, unsigned char val)
-+{
-+ outb(val, wc->ioaddr + WC_REGBASE + ((reg & 0xf) << 2));
-+}
-+
-+static unsigned char __ystdm_getcreg(struct ystdm *wc, unsigned char reg)
-+{
-+ return inb(wc->ioaddr + WC_REGBASE + ((reg & 0xf) << 2));
-+}
-+
-+static inline void __ystdm_setcard(struct ystdm *wc, int card)
-+{
-+ if (wc->curcard != card) {
-+ __ystdm_setcreg(wc, WC_CS, (1 << card));
-+ wc->curcard = card;
-+ }
-+}
-+
-+static void __ystdm_setreg(struct ystdm *wc, int card, unsigned char reg, unsigned char value)
-+{
-+ __ystdm_setcard(wc, card);
-+ if (wc->modtype[card] == MOD_TYPE_FXO) {
-+ __write_8bits(wc, 0x20);
-+ __write_8bits(wc, reg & 0x7f);
-+ } else {
-+ __write_8bits(wc, reg & 0x7f);
-+ }
-+ __write_8bits(wc, value);
-+}
-+
-+static void ystdm_setreg(struct ystdm *wc, int card, unsigned char reg, unsigned char value)
-+{
-+ unsigned long flags;
-+ spin_lock_irqsave(&wc->lock, flags);
-+ __ystdm_setreg(wc, card, reg, value);
-+ spin_unlock_irqrestore(&wc->lock, flags);
-+}
-+
-+static unsigned char __ystdm_getreg(struct ystdm *wc, int card, unsigned char reg)
-+{
-+ __ystdm_setcard(wc, card);
-+ if (wc->modtype[card] == MOD_TYPE_FXO) {
-+ __write_8bits(wc, 0x60);
-+ __write_8bits(wc, reg & 0x7f);
-+ } else {
-+ __write_8bits(wc, reg | 0x80);
-+ }
-+ return __read_8bits(wc);
-+}
-+
-+static inline void reset_spi(struct ystdm *wc, int card)
-+{
-+ unsigned long flags;
-+ spin_lock_irqsave(&wc->lock, flags);
-+ __ystdm_setcard(wc, card);
-+ __reset_spi(wc);
-+ __reset_spi(wc);
-+ spin_unlock_irqrestore(&wc->lock, flags);
-+}
-+
-+static unsigned char ystdm_getreg(struct ystdm *wc, int card, unsigned char reg)
-+{
-+ unsigned long flags;
-+ unsigned char res;
-+ spin_lock_irqsave(&wc->lock, flags);
-+ res = __ystdm_getreg(wc, card, reg);
-+ spin_unlock_irqrestore(&wc->lock, flags);
-+ return res;
-+}
-+
-+static int __wait_access(struct ystdm *wc, int card)
-+{
-+ unsigned char data = 0;
-+
-+ int count = 0;
-+
-+ #define MAX 6000 /* attempts */
-+
-+
-+
-+ /* Wait for indirect access */
-+ while (count++ < MAX)
-+ {
-+ data = __ystdm_getreg(wc, card, I_STATUS);
-+
-+ if (!data)
-+ return 0;
-+
-+ }
-+
-+ if(count > (MAX-1)) printk(KERN_NOTICE " ##### Loop error (%02x) #####\n", data);
-+
-+ return 0;
-+}
-+
-+static unsigned char translate_3215(unsigned char address)
-+{
-+ int x;
-+ for (x=0;x<sizeof(indirect_regs)/sizeof(indirect_regs[0]);x++) {
-+ if (indirect_regs[x].address == address) {
-+ address = indirect_regs[x].altaddr;
-+ break;
-+ }
-+ }
-+ return address;
-+}
-+
-+static int ystdm_proslic_setreg_indirect(struct ystdm *wc, int card, unsigned char address, unsigned short data)
-+{
-+ unsigned long flags;
-+ int res = -1;
-+ /* Translate 3215 addresses */
-+ if (wc->flags[card] & FLAG_3215) {
-+ address = translate_3215(address);
-+ if (address == 255)
-+ return 0;
-+ }
-+ spin_lock_irqsave(&wc->lock, flags);
-+ if(!__wait_access(wc, card)) {
-+ __ystdm_setreg(wc, card, IDA_LO,(unsigned char)(data & 0xFF));
-+ __ystdm_setreg(wc, card, IDA_HI,(unsigned char)((data & 0xFF00)>>8));
-+ __ystdm_setreg(wc, card, IAA,address);
-+ res = 0;
-+ };
-+ spin_unlock_irqrestore(&wc->lock, flags);
-+ return res;
-+}
-+
-+static int ystdm_proslic_getreg_indirect(struct ystdm *wc, int card, unsigned char address)
-+{
-+ unsigned long flags;
-+ int res = -1;
-+ char *p=NULL;
-+ /* Translate 3215 addresses */
-+ if (wc->flags[card] & FLAG_3215) {
-+ address = translate_3215(address);
-+ if (address == 255)
-+ return 0;
-+ }
-+ spin_lock_irqsave(&wc->lock, flags);
-+ if (!__wait_access(wc, card)) {
-+ __ystdm_setreg(wc, card, IAA, address);
-+ if (!__wait_access(wc, card)) {
-+ unsigned char data1, data2;
-+ data1 = __ystdm_getreg(wc, card, IDA_LO);
-+ data2 = __ystdm_getreg(wc, card, IDA_HI);
-+ res = data1 | (data2 << 8);
-+ } else
-+ p = "Failed to wait inside\n";
-+ } else
-+ p = "failed to wait\n";
-+ spin_unlock_irqrestore(&wc->lock, flags);
-+ if (p)
-+ printk(KERN_NOTICE "%s", p);
-+ return res;
-+}
-+
-+static int ystdm_proslic_init_indirect_regs(struct ystdm *wc, int card)
-+{
-+ unsigned char i;
-+
-+ for (i=0; i<sizeof(indirect_regs) / sizeof(indirect_regs[0]); i++)
-+ {
-+ if(ystdm_proslic_setreg_indirect(wc, card, indirect_regs[i].address,indirect_regs[i].initial))
-+ return -1;
-+ }
-+
-+ return 0;
-+}
-+
-+static int ystdm_proslic_verify_indirect_regs(struct ystdm *wc, int card)
-+{
-+ int passed = 1;
-+ unsigned short i, initial;
-+ int j;
-+
-+ for (i=0; i<sizeof(indirect_regs) / sizeof(indirect_regs[0]); i++)
-+ {
-+ if((j = ystdm_proslic_getreg_indirect(wc, card, (unsigned char) indirect_regs[i].address)) < 0) {
-+ printk(KERN_NOTICE "Failed to read indirect register %d\n", i);
-+ return -1;
-+ }
-+ initial= indirect_regs[i].initial;
-+
-+ if ( j != initial && (!(wc->flags[card] & FLAG_3215) || (indirect_regs[i].altaddr != 255)))
-+ {
-+ printk(KERN_NOTICE "!!!!!!! %s iREG %X = %X should be %X\n",
-+ indirect_regs[i].name,indirect_regs[i].address,j,initial );
-+ passed = 0;
-+ }
-+ }
-+
-+ if (passed) {
-+ if (debug)
-+ printk(KERN_DEBUG "Init Indirect Registers completed successfully.\n");
-+ } else {
-+ printk(KERN_NOTICE " !!!!! Init Indirect Registers UNSUCCESSFULLY.\n");
-+ return -1;
-+ }
-+ return 0;
-+}
-+
-+static inline void ystdm_proslic_recheck_sanity(struct ystdm *wc, int card)
-+{
-+ struct fxs *const fxs = &wc->mod[card].fxs;
-+ int res;
-+ /* Check loopback */
-+ res = wc->reg1shadow[card];
-+ if (!res && (res != fxs->lasttxhook)) {
-+ res = ystdm_getreg(wc, card, 8);
-+ if (res) {
-+ printk(KERN_NOTICE "Ouch, part reset, quickly restoring reality (%d)\n", card);
-+ ystdm_init_proslic(wc, card, 1, 0, 1);
-+ } else {
-+ if (fxs->palarms++ < MAX_ALARMS) {
-+ printk(KERN_NOTICE "Power alarm on module %d, resetting!\n", card + 1);
-+ if (fxs->lasttxhook == SLIC_LF_RINGING)
-+ fxs->lasttxhook = SLIC_LF_ACTIVE_FWD;
-+ ystdm_setreg(wc, card, 64, fxs->lasttxhook);
-+ } else {
-+ if (fxs->palarms == MAX_ALARMS)
-+ printk(KERN_NOTICE "Too many power alarms on card %d, NOT resetting!\n", card + 1);
-+ }
-+ }
-+ }
-+}
-+
-+static inline void ystdm_voicedaa_check_hook(struct ystdm *wc, int card)
-+{
-+#define MS_PER_CHECK_HOOK 16
-+
-+#ifndef AUDIO_RINGCHECK
-+ unsigned char res;
-+#endif
-+ signed char b;
-+ int errors = 0;
-+ struct fxo *fxo = &wc->mod[card].fxo;
-+
-+ /* Try to track issues that plague slot one FXO's */
-+ b = wc->reg0shadow[card];
-+ if ((b & 0x2) || !(b & 0x8)) {
-+ /* Not good -- don't look at anything else */
-+ if (debug)
-+ printk(KERN_DEBUG "Error (%02x) on card %d!\n", b, card + 1);
-+ errors++;
-+ }
-+ b &= 0x9b;
-+ if (fxo->offhook) {
-+ if (b != 0x9)
-+ ystdm_setreg(wc, card, 5, 0x9);
-+ } else {
-+ if (b != 0x8)
-+ ystdm_setreg(wc, card, 5, 0x8);
-+ }
-+ if (errors)
-+ return;
-+ if (!fxo->offhook) {
-+ if (fwringdetect) {
-+ res = wc->reg0shadow[card] & 0x60;
-+ if (fxo->ringdebounce) {
-+ --fxo->ringdebounce;
-+ if (res && (res != fxo->lastrdtx) &&
-+ (fxo->battery == BATTERY_PRESENT)) {
-+ if (!fxo->wasringing) {
-+ fxo->wasringing = 1;
-+ if (debug)
-+ printk(KERN_DEBUG "RING on %d/%d!\n", wc->span.spanno, card + 1);
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_RING);
-+ }
-+ fxo->lastrdtx = res;
-+ fxo->ringdebounce = 10;
-+ } else if (!res) {
-+ if ((fxo->ringdebounce == 0) && fxo->wasringing) {
-+ fxo->wasringing = 0;
-+ if (debug)
-+ printk(KERN_DEBUG "NO RING on %d/%d!\n", wc->span.spanno, card + 1);
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_OFFHOOK);
-+ }
-+ }
-+ } else if (res && (fxo->battery == BATTERY_PRESENT)) {
-+ fxo->lastrdtx = res;
-+ fxo->ringdebounce = 10;
-+ }
-+ } else {
-+ res = wc->reg0shadow[card];
-+ if ((res & 0x60) && (fxo->battery == BATTERY_PRESENT)) {
-+ fxo->ringdebounce += (DAHDI_CHUNKSIZE * 16);
-+ if (fxo->ringdebounce >= DAHDI_CHUNKSIZE * ringdebounce) {
-+ if (!fxo->wasringing) {
-+ fxo->wasringing = 1;
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_RING);
-+ if (debug)
-+ printk(KERN_DEBUG "RING on %d/%d!\n", wc->span.spanno, card + 1);
-+ }
-+ fxo->ringdebounce = DAHDI_CHUNKSIZE * ringdebounce;
-+ }
-+ } else {
-+ fxo->ringdebounce -= DAHDI_CHUNKSIZE * 4;
-+ if (fxo->ringdebounce <= 0) {
-+ if (fxo->wasringing) {
-+ fxo->wasringing = 0;
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_OFFHOOK);
-+ if (debug)
-+ printk(KERN_DEBUG "NO RING on %d/%d!\n", wc->span.spanno, card + 1);
-+ }
-+ fxo->ringdebounce = 0;
-+ }
-+ }
-+ }
-+ }
-+
-+ b = wc->reg1shadow[card];
-+
-+ if (fxovoltage) {
-+ static int count = 0;
-+ if (!(count++ % 100)) {
-+ printk(KERN_DEBUG "Card %d: Voltage: %d Debounce %d\n", card + 1, b, fxo->battdebounce);
-+ }
-+ }
-+
-+ if (unlikely(DAHDI_RXSIG_INITIAL == wc->chans[card]->rxhooksig)) {
-+ /*
-+ * dahdi-base will set DAHDI_RXSIG_INITIAL after a
-+ * DAHDI_STARTUP or DAHDI_CHANCONFIG ioctl so that new events
-+ * will be queued on the channel with the current received
-+ * hook state. Channels that use robbed-bit signalling always
-+ * report the current received state via the dahdi_rbsbits
-+ * call. Since we only call dahdi_hooksig when we've detected
-+ * a change to report, let's forget our current state in order
-+ * to force us to report it again via dahdi_hooksig.
-+ *
-+ */
-+ fxo->battery = BATTERY_UNKNOWN;
-+ }
-+
-+if (DAHDI_RXSIG_INITIAL == wc->chans[card]->rxhooksig) {
-+ /* If we've been set to the initial state, let's reset the
-+ * battery state to unknown so that we will reset the
-+ * current state of the battery and call dahdi_hooksig. */
-+ fxo->battery = BATTERY_UNKNOWN;
-+ } /* add by David at 2009.09.10 */
-+
-+
-+ if (abs(b) < battthresh) {
-+ /* possible existing states:
-+ battery lost, no debounce timer
-+ battery lost, debounce timer (going to battery present)
-+ battery present or unknown, no debounce timer
-+ battery present or unknown, debounce timer (going to battery lost)
-+ */
-+
-+ if (fxo->battery == BATTERY_LOST) {
-+ if (fxo->battdebounce) {
-+ /* we were going to BATTERY_PRESENT, but battery was lost again,
-+ so clear the debounce timer */
-+ fxo->battdebounce = 0;
-+ }
-+ } else {
-+ if (fxo->battdebounce) {
-+ /* going to BATTERY_LOST, see if we are there yet */
-+ if (--fxo->battdebounce == 0) {
-+ fxo->battery = BATTERY_LOST;
-+ if (debug)
-+ printk(KERN_DEBUG "NO BATTERY on %d/%d!\n", wc->span.spanno, card + 1);
-+#ifdef JAPAN
-+ if (!wc->ohdebounce && wc->offhook) {
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_ONHOOK);
-+ if (debug)
-+ printk(KERN_DEBUG "Signalled On Hook\n");
-+ dahdi_alarm_channel(&wc->chans[card], DAHDI_ALARM_RED); //add by david
-+
-+#ifdef ZERO_BATT_RING
-+ wc->onhook++;
-+#endif
-+ }
-+#else
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_ONHOOK);
-+ dahdi_alarm_channel(wc->chans[card], DAHDI_ALARM_RED); //add by david
-+ /* set the alarm timer, taking into account that part of its time
-+ period has already passed while debouncing occurred */
-+ fxo->battalarm = (battalarm - battdebounce) / MS_PER_CHECK_HOOK;
-+#endif
-+ }
-+ } else {
-+ /* start the debounce timer to verify that battery has been lost */
-+ fxo->battdebounce = battdebounce / MS_PER_CHECK_HOOK;
-+ }
-+ }
-+ } else {
-+ /* possible existing states:
-+ battery lost or unknown, no debounce timer
-+ battery lost or unknown, debounce timer (going to battery present)
-+ battery present, no debounce timer
-+ battery present, debounce timer (going to battery lost)
-+ */
-+
-+ if (fxo->battery == BATTERY_PRESENT) {
-+ if (fxo->battdebounce) {
-+ /* we were going to BATTERY_LOST, but battery appeared again,
-+ so clear the debounce timer */
-+ fxo->battdebounce = 0;
-+ }
-+ } else {
-+ if (fxo->battdebounce) {
-+ /* going to BATTERY_PRESENT, see if we are there yet */
-+ if (--fxo->battdebounce == 0) {
-+ fxo->battery = BATTERY_PRESENT;
-+ if (debug)
-+ printk(KERN_DEBUG "BATTERY on %d/%d (%s)!\n", wc->span.spanno, card + 1,
-+ (b < 0) ? "-" : "+");
-+#ifdef ZERO_BATT_RING
-+ if (wc->onhook) {
-+ wc->onhook = 0;
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_OFFHOOK);
-+ if (debug)
-+ printk(KERN_DEBUG "Signalled Off Hook\n");
-+ }
-+#else
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_OFFHOOK);
-+ dahdi_alarm_channel(wc->chans[card], DAHDI_ALARM_NONE); //add by david
-+
-+#endif
-+ /* set the alarm timer, taking into account that part of its time
-+ period has already passed while debouncing occurred */
-+ fxo->battalarm = (battalarm - battdebounce) / MS_PER_CHECK_HOOK;
-+ }
-+ } else {
-+ /* start the debounce timer to verify that battery has appeared */
-+ fxo->battdebounce = battdebounce / MS_PER_CHECK_HOOK;
-+ }
-+ }
-+ }
-+
-+ if (fxo->lastpol >= 0) {
-+ if (b < 0) {
-+ fxo->lastpol = -1;
-+ fxo->polaritydebounce = POLARITY_DEBOUNCE / MS_PER_CHECK_HOOK;
-+ }
-+ }
-+ if (fxo->lastpol <= 0) {
-+ if (b > 0) {
-+ fxo->lastpol = 1;
-+ fxo->polaritydebounce = POLARITY_DEBOUNCE / MS_PER_CHECK_HOOK;
-+ }
-+ }
-+
-+
-+ if (fxo->battalarm) {
-+ if (--fxo->battalarm == 0) {
-+ /* the alarm timer has expired, so update the battery alarm state
-+ for this channel */
-+ dahdi_alarm_channel(wc->chans[card], fxo->battery== BATTERY_LOST ? DAHDI_ALARM_RED : DAHDI_ALARM_NONE);
-+ }
-+ }
-+
-+ if (fxo->polaritydebounce) {
-+ if (--fxo->polaritydebounce == 0) {
-+ if (fxo->lastpol != fxo->polarity) {
-+ if (debug)
-+ printk(KERN_DEBUG "%lu Polarity reversed (%d -> %d)\n", jiffies,
-+ fxo->polarity,
-+ fxo->lastpol);
-+ if (fxo->polarity)
-+ dahdi_qevent_lock(wc->chans[card], DAHDI_EVENT_POLARITY);
-+ fxo->polarity = fxo->lastpol;
-+ }
-+ }
-+ }
-+#undef MS_PER_CHECK_HOOK
-+}
-+
-+static void ystdm_fxs_hooksig(struct ystdm *wc, const int card, enum dahdi_txsig txsig)
-+{
-+ struct fxs *const fxs = &wc->mod[card].fxs;
-+ switch (txsig) {
-+ case DAHDI_TXSIG_ONHOOK:
-+ switch (wc->span.chans[card]->sig) {
-+ case DAHDI_SIG_FXOKS:
-+ case DAHDI_SIG_FXOLS:
-+ /* Can't change Ring Generator during OHT */
-+ if (!fxs->ohttimer) {
-+ ystdm_set_ring_generator_mode(wc,
-+ card, fxs->vmwi_hvac);
-+ fxs->lasttxhook = fxs->vmwi_hvac ?
-+ SLIC_LF_RINGING :
-+ fxs->idletxhookstate;
-+ } else {
-+ fxs->lasttxhook = fxs->idletxhookstate;
-+ }
-+ break;
-+ case DAHDI_SIG_EM:
-+ fxs->lasttxhook = fxs->idletxhookstate;
-+ break;
-+ case DAHDI_SIG_FXOGS:
-+ fxs->lasttxhook = SLIC_LF_TIP_OPEN;
-+ break;
-+ }
-+ break;
-+ case DAHDI_TXSIG_OFFHOOK:
-+ switch (wc->span.chans[card]->sig) {
-+ case DAHDI_SIG_EM:
-+ fxs->lasttxhook = SLIC_LF_ACTIVE_REV;
-+ break;
-+ default:
-+ fxs->lasttxhook = fxs->idletxhookstate;
-+ break;
-+ }
-+ break;
-+ case DAHDI_TXSIG_START:
-+ /* Set ringer mode */
-+ ystdm_set_ring_generator_mode(wc, card, 0);
-+ fxs->lasttxhook = SLIC_LF_RINGING;
-+ break;
-+ case DAHDI_TXSIG_KEWL:
-+ fxs->lasttxhook = SLIC_LF_OPEN;
-+ break;
-+ default:
-+ printk(KERN_NOTICE "ystdm: Can't set tx state to %d\n", txsig);
-+ return;
-+ }
-+ if (debug) {
-+ printk(KERN_DEBUG
-+ "Setting FXS hook state to %d (%02x)\n",
-+ txsig, fxs->lasttxhook);
-+ }
-+ ystdm_setreg(wc, card, LINE_STATE, fxs->lasttxhook);
-+}
-+
-+
-+static inline void ystdm_proslic_check_hook(struct ystdm *wc, int card)
-+{
-+ struct fxs *const fxs = &wc->mod[card].fxs;
-+ char res;
-+ int hook;
-+
-+ /* For some reason we have to debounce the
-+ hook detector. */
-+
-+ res = wc->reg0shadow[card];
-+ hook = (res & 1);
-+ if (hook != fxs->lastrxhook) {
-+ /* Reset the debounce (must be multiple of 4ms) */
-+ fxs->debounce = dialdebounce * 4;
-+#if 0
-+ printk(KERN_DEBUG "Resetting debounce card %d hook %d, %d\n",
-+ card, hook, fxs->debounce);
-+#endif
-+ } else {
-+ if (fxs->debounce > 0) {
-+ fxs->debounce -= 16 * DAHDI_CHUNKSIZE;
-+#if 0
-+ printk(KERN_DEBUG "Sustaining hook %d, %d\n",
-+ hook, fxs->debounce);
-+#endif
-+ if (!fxs->debounce) {
-+#if 0
-+ printk(KERN_DEBUG "Counted down debounce, newhook: %d...\n", hook);
-+#endif
-+ fxs->debouncehook = hook;
-+ }
-+ if (!fxs->oldrxhook && fxs->debouncehook) {
-+ /* Off hook */
-+#if 1
-+ if (debug)
-+#endif
-+ printk(KERN_DEBUG "ystdm: Card %d Going off hook\n", card);
-+
-+ switch (fxs->lasttxhook) {
-+ case SLIC_LF_RINGING:
-+ case SLIC_LF_OHTRAN_FWD:
-+ case SLIC_LF_OHTRAN_REV:
-+ /* just detected OffHook, during
-+ * Ringing or OnHookTransfer */
-+ fxs->idletxhookstate =
-+ POLARITY_XOR ?
-+ SLIC_LF_ACTIVE_REV :
-+ SLIC_LF_ACTIVE_FWD;
-+ break;
-+ }
-+
-+ ystdm_fxs_hooksig(wc, card, DAHDI_TXSIG_OFFHOOK);
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_OFFHOOK);
-+ if (robust)
-+ ystdm_init_proslic(wc, card, 1, 0, 1);
-+ fxs->oldrxhook = 1;
-+
-+ } else if (fxs->oldrxhook && !fxs->debouncehook) {
-+ /* On hook */
-+#if 1
-+ if (debug)
-+#endif
-+ printk(KERN_DEBUG "ystdm: Card %d Going on hook\n", card);
-+ ystdm_fxs_hooksig(wc, card, DAHDI_TXSIG_ONHOOK);
-+ dahdi_hooksig(wc->chans[card], DAHDI_RXSIG_ONHOOK);
-+ fxs->oldrxhook = 0;
-+ }
-+ }
-+ }
-+ fxs->lastrxhook = hook;
-+}
-+
-+DAHDI_IRQ_HANDLER(ystdm_interrupt)
-+{
-+ struct ystdm *wc = dev_id;
-+ unsigned char ints;
-+ int x;
-+ int mode;
-+
-+ ints = inb(wc->ioaddr + WC_INTSTAT);
-+ outb(ints, wc->ioaddr + WC_INTSTAT);
-+
-+ if (!ints)
-+ return IRQ_NONE;
-+
-+ outb(ints, wc->ioaddr + WC_INTSTAT);
-+
-+ if (ints & 0x10) {
-+ /* Stop DMA, wait for watchdog */
-+ printk(KERN_INFO "TDM PCI Master abort\n");
-+ ystdm_stop_dma(wc);
-+ return IRQ_RETVAL(1);
-+ }
-+
-+ if (ints & 0x20) {
-+ printk(KERN_INFO "PCI Target abort\n");
-+ return IRQ_RETVAL(1);
-+
-+ }
-+
-+ for (x=0;x<NUM_CARDS;x++) {
-+ if (wc->cardflag & (1 << x) &&
-+ (wc->modtype[x] == MOD_TYPE_FXS)) {
-+ struct fxs *const fxs = &wc->mod[x].fxs;
-+ if (fxs->lasttxhook == SLIC_LF_RINGING &&
-+ !fxs->neonringing) {
-+ /* RINGing, prepare for OHT */
-+ fxs->ohttimer = OHT_TIMER << 3;
-+
-+ /* logical XOR 3 variables
-+ module parameter 'reversepolarity', global reverse all FXS lines.
-+ ioctl channel variable fxs 'reversepolarity', Line Reversal Alert Signal if required.
-+ ioctl channel variable fxs 'vmwi_lrev', VMWI pending.
-+ */
-+
-+ /* OHT mode when idle */
-+ fxs->idletxhookstate = POLARITY_XOR ?
-+ SLIC_LF_OHTRAN_REV :
-+ SLIC_LF_OHTRAN_FWD;
-+ } else if (fxs->ohttimer) {
-+ /* check if still OnHook */
-+ if (!fxs->oldrxhook) {
-+ fxs->ohttimer -= DAHDI_CHUNKSIZE;
-+ if (!fxs->ohttimer) {
-+ fxs->idletxhookstate = POLARITY_XOR ? SLIC_LF_ACTIVE_REV : SLIC_LF_ACTIVE_FWD; /* Switch to Active, Rev or Fwd */
-+ /* if currently OHT */
-+ if ((fxs->lasttxhook == SLIC_LF_OHTRAN_FWD) || (fxs->lasttxhook == SLIC_LF_OHTRAN_REV)) {
-+ if (fxs->vmwi_hvac) {
-+ /* force idle polarity Forward if ringing */
-+ fxs->idletxhookstate = SLIC_LF_ACTIVE_FWD;
-+ /* Set ring generator for neon */
-+ ystdm_set_ring_generator_mode(wc, x, 1);
-+ fxs->lasttxhook = SLIC_LF_RINGING;
-+ } else {
-+ fxs->lasttxhook = fxs->idletxhookstate;
-+ }
-+ /* Apply the change as appropriate */
-+ ystdm_setreg(wc, x, LINE_STATE, fxs->lasttxhook);
-+ }
-+ }
-+ } else {
-+ fxs->ohttimer = 0;
-+ /* Switch to Active, Rev or Fwd */
-+ fxs->idletxhookstate = POLARITY_XOR ? SLIC_LF_ACTIVE_REV : SLIC_LF_ACTIVE_FWD;
-+ }
-+ }
-+ }
-+ }
-+
-+ if (ints & 0x0f) {
-+ wc->intcount++;
-+ x = wc->intcount & 0x7;
-+ mode = wc->intcount & 0x18;
-+ if (wc->cardflag & (1 << x)) {
-+ switch(mode) {
-+ case 0:
-+ /* Rest */
-+ break;
-+ case 8:
-+ /* Read first shadow reg */
-+ if (wc->modtype[x] == MOD_TYPE_FXS)
-+ wc->reg0shadow[x] = ystdm_getreg(wc, x, 68);
-+ else if (wc->modtype[x] == MOD_TYPE_FXO)
-+ wc->reg0shadow[x] = ystdm_getreg(wc, x, 5);
-+ break;
-+ case 16:
-+ /* Read second shadow reg */
-+ if (wc->modtype[x] == MOD_TYPE_FXS)
-+ wc->reg1shadow[x] = ystdm_getreg(wc, x, LINE_STATE);
-+ else if (wc->modtype[x] == MOD_TYPE_FXO)
-+ wc->reg1shadow[x] = ystdm_getreg(wc, x, 29);
-+ break;
-+ case 24:
-+ /* Perform processing */
-+ if (wc->modtype[x] == MOD_TYPE_FXS) {
-+ ystdm_proslic_check_hook(wc, x);
-+ if (!(wc->intcount & 0xf0)) {
-+ ystdm_proslic_recheck_sanity(wc, x);
-+ }
-+ } else if (wc->modtype[x] == MOD_TYPE_FXO) {
-+ ystdm_voicedaa_check_hook(wc, x);
-+ }
-+ break;
-+ }
-+ }
-+ if (!(wc->intcount % 10000)) {
-+ /* Accept an alarm once per 10 seconds */
-+ for (x=0;x<NUM_CARDS;x++)
-+ if (wc->modtype[x] == MOD_TYPE_FXS) {
-+ if (wc->mod[x].fxs.palarms)
-+ wc->mod[x].fxs.palarms--;
-+ }
-+ }
-+ ystdm_receiveprep(wc, ints);
-+ ystdm_transmitprep(wc, ints);
-+ }
-+
-+ return IRQ_RETVAL(1);
-+
-+}
-+
-+static int ystdm_voicedaa_insane(struct ystdm *wc, int card)
-+{
-+ int blah;
-+ blah = ystdm_getreg(wc, card, 2);
-+ if (blah != 0x3)
-+ return -2;
-+ blah = ystdm_getreg(wc, card, 11);
-+ if (debug)
-+ printk(KERN_DEBUG "VoiceDAA System: %02x\n", blah & 0xf);
-+ return 0;
-+}
-+
-+static int ystdm_proslic_insane(struct ystdm *wc, int card)
-+{
-+ int blah,insane_report;
-+ insane_report=0;
-+
-+ blah = ystdm_getreg(wc, card, 0);
-+ if (debug)
-+ printk(KERN_DEBUG "ProSLIC on module %d, product %d, version %d\n", card, (blah & 0x30) >> 4, (blah & 0xf));
-+
-+#if 0
-+ if ((blah & 0x30) >> 4) {
-+ printk(KERN_DEBUG "ProSLIC on module %d is not a 3210.\n", card);
-+ return -1;
-+ }
-+#endif
-+ if (((blah & 0xf) == 0) || ((blah & 0xf) == 0xf)) {
-+ /* SLIC not loaded */
-+ return -1;
-+ }
-+ if ((blah & 0xf) < 2) {
-+ printk(KERN_NOTICE "ProSLIC 3210 version %d is too old\n", blah & 0xf);
-+ return -1;
-+ }
-+ if ((blah & 0xf) == 2) {
-+ /* ProSLIC 3215, not a 3210 */
-+ wc->flags[card] |= FLAG_3215;
-+ }
-+ blah = ystdm_getreg(wc, card, 8);
-+ if (blah != 0x2) {
-+ printk(KERN_NOTICE "ProSLIC on module %d insane (1) %d should be 2\n", card, blah);
-+ return -1;
-+ } else if ( insane_report)
-+ printk(KERN_NOTICE "ProSLIC on module %d Reg 8 Reads %d Expected is 0x2\n",card,blah);
-+
-+ blah = ystdm_getreg(wc, card, 64);
-+ if (blah != 0x0) {
-+ printk(KERN_NOTICE "ProSLIC on module %d insane (2)\n", card);
-+ return -1;
-+ } else if ( insane_report)
-+ printk(KERN_NOTICE "ProSLIC on module %d Reg 64 Reads %d Expected is 0x0\n",card,blah);
-+
-+ blah = ystdm_getreg(wc, card, 11);
-+ if (blah != 0x33) {
-+ printk(KERN_NOTICE "ProSLIC on module %d insane (3)\n", card);
-+ return -1;
-+ } else if ( insane_report)
-+ printk(KERN_NOTICE "ProSLIC on module %d Reg 11 Reads %d Expected is 0x33\n",card,blah);
-+
-+ /* Just be sure it's setup right. */
-+ ystdm_setreg(wc, card, 30, 0);
-+
-+ if (debug)
-+ printk(KERN_DEBUG "ProSLIC on module %d seems sane.\n", card);
-+ return 0;
-+}
-+
-+static int ystdm_proslic_powerleak_test(struct ystdm *wc, int card)
-+{
-+ unsigned long origjiffies;
-+ unsigned char vbat;
-+
-+ /* Turn off linefeed */
-+ ystdm_setreg(wc, card, 64, 0);
-+
-+ /* Power down */
-+ ystdm_setreg(wc, card, 14, 0x10);
-+
-+ /* Wait for one second */
-+ origjiffies = jiffies;
-+
-+ while((vbat = ystdm_getreg(wc, card, 82)) > 0x6) {
-+ if ((jiffies - origjiffies) >= (HZ/2))
-+ break;;
-+ }
-+
-+ if (vbat < 0x06) {
-+ printk(KERN_NOTICE "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(KERN_NOTICE "Post-leakage voltage: %d volts\n", 376 * vbat / 1000);
-+ }
-+ return 0;
-+}
-+
-+static int ystdm_powerup_proslic(struct ystdm *wc, int card, int fast)
-+{
-+ unsigned char vbat;
-+ unsigned long origjiffies;
-+ int lim;
-+
-+ /* Set period of DC-DC converter to 1/64 khz */
-+ ystdm_setreg(wc, card, 92, 0xff /* was 0xff */);
-+
-+ /* Wait for VBat to powerup */
-+ origjiffies = jiffies;
-+
-+ /* Disable powerdown */
-+ ystdm_setreg(wc, card, 14, 0);
-+
-+ /* If fast, don't bother checking anymore */
-+ if (fast)
-+ return 0;
-+
-+ while((vbat = ystdm_getreg(wc, card, 82)) < 0xc0) {
-+ /* Wait no more than 500ms */
-+ if ((jiffies - origjiffies) > HZ/2) {
-+ break;
-+ }
-+ }
-+
-+ if (vbat < 0xc0) {
-+ if (wc->proslic_power == PROSLIC_POWER_UNKNOWN)
-+ printk(KERN_NOTICE "ProSLIC on module %d failed to powerup within %d ms (%d mV only)\n\n -- DID YOU REMEMBER TO PLUG IN THE HD POWER CABLE TO THE TDM400P??\n",
-+ card, (int)(((jiffies - origjiffies) * 1000 / HZ)),
-+ vbat * 375);
-+ wc->proslic_power = PROSLIC_POWER_WARNED;
-+ return -1;
-+ } else if (debug) {
-+ printk(KERN_DEBUG "ProSLIC on module %d powered up to -%d volts (%02x) in %d ms\n",
-+ card, vbat * 376 / 1000, vbat, (int)(((jiffies - origjiffies) * 1000 / HZ)));
-+ }
-+ wc->proslic_power = PROSLIC_POWER_ON;
-+
-+ /* Proslic max allowed loop current, reg 71 LOOP_I_LIMIT */
-+ /* If out of range, just set it to the default value */
-+ lim = (loopcurrent - 20) / 3;
-+ if ( loopcurrent > 41 ) {
-+ lim = 0;
-+ if (debug)
-+ printk(KERN_DEBUG "Loop current out of range! Setting to default 20mA!\n");
-+ }
-+ else if (debug)
-+ printk(KERN_DEBUG "Loop current set to %dmA!\n",(lim*3)+20);
-+ ystdm_setreg(wc,card,LOOP_I_LIMIT,lim);
-+
-+ /* Engage DC-DC converter */
-+ ystdm_setreg(wc, card, 93, 0x19 /* was 0x19 */);
-+#if 0
-+ origjiffies = jiffies;
-+ while(0x80 & ystdm_getreg(wc, card, 93)) {
-+ if ((jiffies - origjiffies) > 2 * HZ) {
-+ printk(KERN_DEBUG "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 = ystdm_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
-+#endif
-+ return 0;
-+
-+}
-+
-+static int ystdm_proslic_manual_calibrate(struct ystdm *wc, int card){
-+ unsigned long origjiffies;
-+ unsigned char i;
-+
-+ ystdm_setreg(wc, card, 21, 0);//(0) Disable all interupts in DR21
-+ ystdm_setreg(wc, card, 22, 0);//(0)Disable all interupts in DR21
-+ ystdm_setreg(wc, card, 23, 0);//(0)Disable all interupts in DR21
-+ ystdm_setreg(wc, card, 64, 0);//(0)
-+
-+ ystdm_setreg(wc, card, 97, 0x18); //(0x18)Calibrations without the ADC and DAC offset and without common mode calibration.
-+ ystdm_setreg(wc, card, 96, 0x47); //(0x47) Calibrate common mode and differential DAC mode DAC + ILIM
-+
-+ origjiffies=jiffies;
-+ while( ystdm_getreg(wc,card,96)!=0 ){
-+ if((jiffies-origjiffies)>80)
-+ return -1;
-+ }
-+//Initialized DR 98 and 99 to get consistant results.
-+// 98 and 99 are the results registers and the search should have same intial conditions.
-+
-+/*******************************The following is the manual gain mismatch calibration****************************/
-+/*******************************This is also available as a function *******************************************/
-+ // Delay 10ms
-+ origjiffies=jiffies;
-+ while((jiffies-origjiffies)<1);
-+ ystdm_proslic_setreg_indirect(wc, card, 88,0);
-+ ystdm_proslic_setreg_indirect(wc, card, 89,0);
-+ ystdm_proslic_setreg_indirect(wc, card, 90,0);
-+ ystdm_proslic_setreg_indirect(wc, card, 91,0);
-+ ystdm_proslic_setreg_indirect(wc, card, 92,0);
-+ ystdm_proslic_setreg_indirect(wc, card, 93,0);
-+
-+ ystdm_setreg(wc, card, 98, 0x10); // This is necessary if the calibration occurs other than at reset time
-+ ystdm_setreg(wc, card, 99, 0x10);
-+
-+ for ( i=0x1f; i>0; i--)
-+ {
-+ ystdm_setreg(wc, card, 98, i);
-+ origjiffies=jiffies;
-+ while((jiffies-origjiffies)<4);
-+ if((ystdm_getreg(wc, card, 88)) == 0)
-+ break;
-+ } // for
-+
-+ for ( i=0x1f; i>0; i--)
-+ {
-+ ystdm_setreg(wc, card, 99, i);
-+ origjiffies=jiffies;
-+ while((jiffies-origjiffies)<4);
-+ if((ystdm_getreg(wc, card, 89)) == 0)
-+ break;
-+ }//for
-+
-+/*******************************The preceding is the manual gain mismatch calibration****************************/
-+/**********************************The following is the longitudinal Balance Cal***********************************/
-+ ystdm_setreg(wc,card,64,1);
-+ while((jiffies-origjiffies)<10); // Sleep 100?
-+
-+ ystdm_setreg(wc, card, 64, 0);
-+ ystdm_setreg(wc, card, 23, 0x4); // enable interrupt for the balance Cal
-+ ystdm_setreg(wc, card, 97, 0x1); // this is a singular calibration bit for longitudinal calibration
-+ ystdm_setreg(wc, card, 96, 0x40);
-+
-+ ystdm_getreg(wc, card, 96); /* Read Reg 96 just cause */
-+
-+ ystdm_setreg(wc, card, 21, 0xFF);
-+ ystdm_setreg(wc, card, 22, 0xFF);
-+ ystdm_setreg(wc, card, 23, 0xFF);
-+
-+ /**The preceding is the longitudinal Balance Cal***/
-+ return(0);
-+
-+}
-+#if 1
-+static int ystdm_proslic_calibrate(struct ystdm *wc, int card)
-+{
-+ unsigned long origjiffies;
-+ int x;
-+ /* Perform all calibrations */
-+ ystdm_setreg(wc, card, 97, 0x1f);
-+
-+ /* Begin, no speedup */
-+ ystdm_setreg(wc, card, 96, 0x5f);
-+
-+ /* Wait for it to finish */
-+ origjiffies = jiffies;
-+ while(ystdm_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, ystdm_getreg(wc, card, x));
-+ }
-+ }
-+ return 0;
-+}
-+#endif
-+
-+static void wait_just_a_bit(int foo)
-+{
-+ long newjiffies;
-+ newjiffies = jiffies + foo;
-+ while(jiffies < newjiffies);
-+}
-+/*********************************************************************
-+ * Set the hwgain on the analog modules
-+ *
-+ * card = the card position for this module (0-23)
-+ * gain = gain in dB x10 (e.g. -3.5dB would be gain=-35)
-+ * tx = (0 for rx; 1 for tx)
-+ *
-+ *******************************************************************/
-+static int ystdm_set_hwgain(struct ystdm *wc, int card, __s32 gain, __u32 tx)
-+{
-+ if (!(wc->modtype[card] == MOD_TYPE_FXO)) {
-+ printk("Cannot adjust gain. Unsupported module type!\n");
-+ return -1;
-+ }
-+ if (tx) {
-+ if (debug)
-+ printk("setting FXO tx gain for card=%d to %d\n", card, gain);
-+ if (gain >= -150 && gain <= 0) {
-+ ystdm_setreg(wc, card, 38, 16 + (gain/-10));
-+ ystdm_setreg(wc, card, 40, 16 + (-gain%10));
-+ } else if (gain <= 120 && gain > 0) {
-+ ystdm_setreg(wc, card, 38, gain/10);
-+ ystdm_setreg(wc, card, 40, (gain%10));
-+ } else {
-+ printk("FXO tx gain is out of range (%d)\n", gain);
-+ return -1;
-+ }
-+ } else { /* rx */
-+ if (debug)
-+ printk("setting FXO rx gain for card=%d to %d\n", card, gain);
-+ if (gain >= -150 && gain <= 0) {
-+ ystdm_setreg(wc, card, 39, 16+ (gain/-10));
-+ ystdm_setreg(wc, card, 41, 16 + (-gain%10));
-+ } else if (gain <= 120 && gain > 0) {
-+ ystdm_setreg(wc, card, 39, gain/10);
-+ ystdm_setreg(wc, card, 41, (gain%10));
-+ } else {
-+ printk("FXO rx gain is out of range (%d)\n", gain);
-+ return -1;
-+ }
-+ }
-+
-+ return 0;
-+}
-+
-+
-+static int set_vmwi(struct ystdm * wc, int chan_idx)
-+{
-+ struct fxs *const fxs = &wc->mod[chan_idx].fxs;
-+ if (fxs->vmwi_active_messages) {
-+ fxs->vmwi_lrev =
-+ (fxs->vmwisetting.vmwi_type & DAHDI_VMWI_LREV) ? 1 : 0;
-+ fxs->vmwi_hvdc =
-+ (fxs->vmwisetting.vmwi_type & DAHDI_VMWI_HVDC) ? 1 : 0;
-+ fxs->vmwi_hvac =
-+ (fxs->vmwisetting.vmwi_type & DAHDI_VMWI_HVAC) ? 1 : 0;
-+ } else {
-+ fxs->vmwi_lrev = 0;
-+ fxs->vmwi_hvdc = 0;
-+ fxs->vmwi_hvac = 0;
-+ }
-+
-+ if (debug) {
-+ printk(KERN_DEBUG "Setting VMWI on channel %d, messages=%d, "
-+ "lrev=%d, hvdc=%d, hvac=%d\n",
-+ chan_idx,
-+ fxs->vmwi_active_messages,
-+ fxs->vmwi_lrev,
-+ fxs->vmwi_hvdc,
-+ fxs->vmwi_hvac
-+ );
-+ }
-+ if (fxs->vmwi_hvac) {
-+ /* Can't change ring generator while in On Hook Transfer mode*/
-+ if (!fxs->ohttimer) {
-+ if (POLARITY_XOR)
-+ fxs->idletxhookstate |= SLIC_LF_REVMASK;
-+ else
-+ fxs->idletxhookstate &= ~SLIC_LF_REVMASK;
-+ /* Set ring generator for neon */
-+ ystdm_set_ring_generator_mode(wc, chan_idx, 1);
-+ /* Activate ring to send neon pulses */
-+ fxs->lasttxhook = SLIC_LF_RINGING;
-+ ystdm_setreg(wc, chan_idx, LINE_STATE, fxs->lasttxhook);
-+ }
-+ } else {
-+ if (fxs->neonringing) {
-+ /* Set ring generator for normal ringer */
-+ ystdm_set_ring_generator_mode(wc, chan_idx, 0);
-+ /* ACTIVE, polarity determined later */
-+ fxs->lasttxhook = SLIC_LF_ACTIVE_FWD;
-+ } else if ((fxs->lasttxhook == SLIC_LF_RINGING) ||
-+ (fxs->lasttxhook == SLIC_LF_OPEN)) {
-+ /* Can't change polarity while ringing or when open,
-+ set idlehookstate instead */
-+ if (POLARITY_XOR)
-+ fxs->idletxhookstate |= SLIC_LF_REVMASK;
-+ else
-+ fxs->idletxhookstate &= ~SLIC_LF_REVMASK;
-+
-+ printk(KERN_DEBUG "Unable to change polarity on channel"
-+ "%d, lasttxhook=0x%X\n",
-+ chan_idx,
-+ fxs->lasttxhook
-+ );
-+ return 0;
-+ }
-+ if (POLARITY_XOR) {
-+ fxs->idletxhookstate |= SLIC_LF_REVMASK;
-+ fxs->lasttxhook |= SLIC_LF_REVMASK;
-+ } else {
-+ fxs->idletxhookstate &= ~SLIC_LF_REVMASK;
-+ fxs->lasttxhook &= ~SLIC_LF_REVMASK;
-+ }
-+ ystdm_setreg(wc, chan_idx, LINE_STATE, fxs->lasttxhook);
-+ }
-+ return 0;
-+}
-+
-+static int ystdm_init_voicedaa(struct ystdm *wc, int card, int fast, int manual, int sane)
-+{
-+ unsigned char reg16=0, reg26=0, reg30=0, reg31=0;
-+ long newjiffies;
-+ wc->modtype[card] = MOD_TYPE_FXO;
-+ /* Sanity check the ProSLIC */
-+ reset_spi(wc, card);
-+ if (!sane && ystdm_voicedaa_insane(wc, card))
-+ return -2;
-+
-+ /* Software reset */
-+ ystdm_setreg(wc, card, 1, 0x80);
-+
-+ /* Wait just a bit */
-+ wait_just_a_bit(HZ/10);
-+
-+ /* Enable PCM, ulaw */
-+ if (alawoverride){
-+ ystdm_setreg(wc, card, 33, 0x20);
-+ } else {
-+ ystdm_setreg(wc, card, 33, 0x28);
-+ }
-+
-+ /* Set On-hook speed, Ringer impedence, and ringer threshold */
-+ reg16 |= (fxo_modes[_opermode].ohs << 6);
-+ reg16 |= (fxo_modes[_opermode].rz << 1);
-+ reg16 |= (fxo_modes[_opermode].rt);
-+ ystdm_setreg(wc, card, 16, reg16);
-+
-+ if(fwringdetect) {
-+ /* Enable ring detector full-wave rectifier mode */
-+ ystdm_setreg(wc, card, 18, 2);
-+ ystdm_setreg(wc, card, 24, 0);
-+ } else {
-+ /* Set to the device defaults */
-+ ystdm_setreg(wc, card, 18, 0);
-+ ystdm_setreg(wc, card, 24, 0x19);
-+ }
-+
-+ /* Set DC Termination:
-+ Tip/Ring voltage adjust, minimum operational current, current limitation */
-+ reg26 |= (fxo_modes[_opermode].dcv << 6);
-+ reg26 |= (fxo_modes[_opermode].mini << 4);
-+ reg26 |= (fxo_modes[_opermode].ilim << 1);
-+ ystdm_setreg(wc, card, 26, reg26);
-+
-+ /* Set AC Impedence */
-+ reg30 = (fxo_modes[_opermode].acim);
-+ ystdm_setreg(wc, card, 30, reg30);
-+
-+ /* Misc. DAA parameters */
-+ if (fastpickup)
-+ reg31 = 0xe3;
-+ else
-+ reg31 = 0xa3;
-+
-+ reg31 |= (fxo_modes[_opermode].ohs2 << 3);
-+ ystdm_setreg(wc, card, 31, reg31);
-+
-+ /* Set Transmit/Receive timeslot */
-+ if (card < NUM_CARDS/2) {
-+ ystdm_setreg(wc, card, 34, (3-card) * 8);
-+ ystdm_setreg(wc, card, 35, 0x00);
-+ ystdm_setreg(wc, card, 36, (3-card) * 8);
-+ ystdm_setreg(wc, card, 37, 0x00);
-+ } else {
-+ ystdm_setreg(wc, card, 34, (3-(card-NUM_CARDS/2)+16) * 8);
-+ ystdm_setreg(wc, card, 35, 0x00);
-+ ystdm_setreg(wc, card, 36, (3-(card-NUM_CARDS/2)+16) * 8);
-+ ystdm_setreg(wc, card, 37, 0x00);
-+ }
-+
-+ /* Enable ISO-Cap */
-+ ystdm_setreg(wc, card, 6, 0x00);
-+ if (fastpickup)
-+ ystdm_setreg(wc, card, 17, ystdm_getreg(wc, card, 17) | 0x20);
-+
-+ /* Wait 1000ms for ISO-cap to come up */
-+ newjiffies = jiffies;
-+ newjiffies += 2 * HZ;
-+ while((jiffies < newjiffies) && !(ystdm_getreg(wc, card, 11) & 0xf0))
-+ wait_just_a_bit(HZ/10);
-+
-+ if (!(ystdm_getreg(wc, card, 11) & 0xf0)) {
-+ printk("VoiceDAA did not bring up ISO link properly!\n");
-+ return -1;
-+ }
-+ if (debug)
-+ printk("ISO-Cap is now up, line side: %02x rev %02x\n",
-+ ystdm_getreg(wc, card, 11) >> 4,
-+ (ystdm_getreg(wc, card, 13) >> 2) & 0xf);
-+ /* Enable on-hook line monitor */
-+ ystdm_setreg(wc, card, 5, 0x08);
-+ /* Take values for fxotxgain and fxorxgain and apply them to module */
-+ if (fxotxgain)
-+ ystdm_set_hwgain(wc, card, fxotxgain, 1);
-+ else
-+ ystdm_set_hwgain(wc, card, 0, 1);
-+ if (fxorxgain)
-+ ystdm_set_hwgain(wc, card, fxorxgain, 0);
-+ else
-+ ystdm_set_hwgain(wc, card, 20, 0);
-+
-+ /* NZ -- crank the tx gain up by 7 dB */
-+ if (!strcmp(fxo_modes[_opermode].name, "NEWZEALAND")) {
-+ printk("Adjusting gain\n");
-+ ystdm_set_hwgain(wc, card, 7, 1);
-+
-+ }
-+ /* KR -- crank the rv gain up by 9 dB */
-+ if (!strcmp(fxo_modes[_opermode].name, "SOUTHKOREA")) {
-+ printk("Adjusting gain\n");
-+ ystdm_setreg(wc, card, 39, 0x9);
-+ }
-+ if(debug)
-+ printk("DEBUG fxotxgain:%i.%i fxorxgain:%i.%i\n", (ystdm_getreg(wc, card, 38)/16)?-(ystdm_getreg(wc, card, 38) - 16) : ystdm_getreg(wc, card, 38), (ystdm_getreg(wc, card, 40)/16)? -(ystdm_getreg(wc, card, 40) - 16):ystdm_getreg(wc, card, 40), (ystdm_getreg(wc, card, 39)/16)? -(ystdm_getreg(wc, card, 39) - 16) : ystdm_getreg(wc, card, 39),(ystdm_getreg(wc, card, 41)/16)?-(ystdm_getreg(wc, card, 41) - 16):ystdm_getreg(wc, card, 41));
-+
-+ return 0;
-+
-+}
-+
-+static int ystdm_init_proslic(struct ystdm *wc, int card, int fast, int manual, int sane)
-+{
-+
-+ unsigned short tmp[5];
-+ unsigned char r19,r9;
-+ int x;
-+ int fxsmode=0;
-+ struct fxs *const fxs = &wc->mod[card].fxs;
-+
-+ /* Sanity check the ProSLIC */
-+ if (!sane && ystdm_proslic_insane(wc, card))
-+ return -2;
-+
-+ /* default messages to none and method to FSK */
-+ memset(&fxs->vmwisetting, 0, sizeof(fxs->vmwisetting));
-+ fxs->vmwi_lrev = 0;
-+ fxs->vmwi_hvdc = 0;
-+ fxs->vmwi_hvac = 0;
-+
-+ /* By default, don't send on hook */
-+ if (!reversepolarity != !fxs->reversepolarity)
-+ fxs->idletxhookstate = SLIC_LF_ACTIVE_REV;
-+ else
-+ fxs->idletxhookstate = SLIC_LF_ACTIVE_FWD;
-+
-+ /* Sanity check the ProSLIC */
-+ //if (!sane && ystdm_proslic_insane(wc, card))
-+ // return -2;
-+
-+ if (sane) {
-+ /* Make sure we turn off the DC->DC converter to prevent anything from blowing up */
-+ ystdm_setreg(wc, card, 14, 0x10);
-+ }
-+
-+ if (ystdm_proslic_init_indirect_regs(wc, card)) {
-+ printk(KERN_INFO "Indirect Registers failed to initialize on module %d.\n", card);
-+ return -1;
-+ }
-+
-+ /* Clear scratch pad area */
-+ ystdm_proslic_setreg_indirect(wc, card, 97,0);
-+
-+ /* Clear digital loopback */
-+ ystdm_setreg(wc, card, 8, 0);
-+
-+ /* Revision C optimization */
-+ ystdm_setreg(wc, card, 108, 0xeb);
-+
-+ /* Disable automatic VBat switching for safety to prevent
-+ Q7 from accidently turning on and burning out. */
-+ ystdm_setreg(wc, card, 67, 0x07);
-+
-+ /* Turn off Q7 */
-+ ystdm_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] = ystdm_proslic_getreg_indirect(wc, card, x + 35);
-+ ystdm_proslic_setreg_indirect(wc, card, x + 35, 0x8000);
-+ }
-+
-+ /* Power up the DC-DC converter */
-+ if (ystdm_powerup_proslic(wc, card, fast)) {
-+ printk("Unable to do INITIAL ProSLIC powerup on module %d\n", card);
-+ return -1;
-+ }
-+
-+ if (!fast) {
-+
-+ /* Check for power leaks */
-+ if (ystdm_proslic_powerleak_test(wc, card)) {
-+ printk("ProSLIC module %d failed leakage test. Check for short circuit\n", card);
-+ }
-+ /* Power up again */
-+ if (ystdm_powerup_proslic(wc, card, fast)) {
-+ printk("Unable to do FINAL ProSLIC powerup on module %d\n", card);
-+ return -1;
-+ }
-+#ifndef NO_CALIBRATION
-+ /* Perform calibration */
-+ if(manual) {
-+ if (ystdm_proslic_manual_calibrate(wc, card)) {
-+ //printk("Proslic failed on Manual Calibration\n");
-+ if (ystdm_proslic_manual_calibrate(wc, card)) {
-+ printk("Proslic Failed on Second Attempt to Calibrate Manually. (Try -DNO_CALIBRATION in Makefile)\n");
-+ return -1;
-+ }
-+ printk("Proslic Passed Manual Calibration on Second Attempt\n");
-+ }
-+ }
-+ else {
-+ if(ystdm_proslic_calibrate(wc, card)) {
-+ //printk("ProSlic died on Auto Calibration.\n");
-+ if (ystdm_proslic_calibrate(wc, card)) {
-+ printk("Proslic Failed on Second Attempt to Auto Calibrate\n");
-+ return -1;
-+ }
-+ printk("Proslic Passed Auto Calibration on Second Attempt\n");
-+ }
-+ }
-+ /* Perform DC-DC calibration */
-+ ystdm_setreg(wc, card, 93, 0x99);
-+ r19 = ystdm_getreg(wc, card, 107);
-+ if ((r19 < 0x2) || (r19 > 0xd)) {
-+ printk("DC-DC cal has a surprising direct 107 of 0x%02x!\n", r19);
-+ ystdm_setreg(wc, card, 107, 0x8);
-+ }
-+
-+ /* Save calibration vectors */
-+ for (x=0;x<NUM_CAL_REGS;x++)
-+ fxs->calregs.vals[x] = ystdm_getreg(wc, card, 96 + x);
-+#endif
-+
-+ } else {
-+ /* Restore calibration registers */
-+ for (x=0;x<NUM_CAL_REGS;x++)
-+ ystdm_setreg(wc, card, 96 + x, fxs->calregs.vals[x]);
-+ }
-+ /* Calibration complete, restore original values */
-+ for (x=0;x<5;x++) {
-+ ystdm_proslic_setreg_indirect(wc, card, x + 35, tmp[x]);
-+ }
-+
-+ if (ystdm_proslic_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" */
-+ ystdm_setreg(wc, card, 67, 0x0e);
-+ blah = ystdm_getreg(wc, card, 67);
-+#endif
-+
-+#if 0
-+ if (ystdm_proslic_setreg_indirect(wc, card, 97, 0x0)) { // Stanley: for the bad recording fix
-+ printk(KERN_INFO "ProSlic IndirectReg Died.\n");
-+ return -1;
-+ }
-+#endif
-+
-+ if (alawoverride)
-+ ystdm_setreg(wc, card, 1, 0x20);
-+ else
-+ ystdm_setreg(wc, card, 1, 0x28);
-+ // U-Law 8-bit interface
-+ if (card < NUM_CARDS/2) {
-+ ystdm_setreg(wc, card, 2, (3-card) * 8); // Tx Start count low byte 0
-+ ystdm_setreg(wc, card, 3, 0); // Tx Start count high byte 0
-+ ystdm_setreg(wc, card, 4, (3-card) * 8); // Rx Start count low byte 0
-+ ystdm_setreg(wc, card, 5, 0); // Rx Start count high byte 0
-+ } else {
-+ ystdm_setreg(wc, card, 2, (3-(card-NUM_CARDS/2)+16) * 8); // Tx Start count low byte 0
-+ ystdm_setreg(wc, card, 3, 0); // Tx Start count high byte 0
-+ ystdm_setreg(wc, card, 4, (3-(card-NUM_CARDS/2)+16) * 8); // Rx Start count low byte 0
-+ ystdm_setreg(wc, card, 5, 0); // Rx Start count high byte 0
-+ }
-+ ystdm_setreg(wc, card, 18, 0xff); // clear all interrupt
-+ ystdm_setreg(wc, card, 19, 0xff);
-+ ystdm_setreg(wc, card, 20, 0xff);
-+ ystdm_setreg(wc, card, 73, 0x04);
-+ if (fxshonormode) {
-+ fxsmode = acim2tiss[fxo_modes[_opermode].acim];
-+ ystdm_setreg(wc, card, 10, 0x08 | fxsmode);
-+ }
-+ if (lowpower)
-+ ystdm_setreg(wc, card, 72, 0x10);
-+
-+#if 0
-+ ystdm_setreg(wc, card, 21, 0x00); // enable interrupt
-+ ystdm_setreg(wc, card, 22, 0x02); // Loop detection interrupt
-+ ystdm_setreg(wc, card, 23, 0x01); // DTMF detection interrupt
-+#endif
-+
-+#if 0
-+ /* Enable loopback */
-+ ystdm_setreg(wc, card, 8, 0x2);
-+ ystdm_setreg(wc, card, 14, 0x0);
-+ ystdm_setreg(wc, card, 64, 0x0);
-+ ystdm_setreg(wc, card, 1, 0x08);
-+#endif
-+ if (ystdm_init_ring_generator_mode(wc, card)) {
-+ return -1;
-+ }
-+
-+ if(fxstxgain || fxsrxgain) {
-+ r9 = ystdm_getreg(wc, card, 9);
-+ switch (fxstxgain) {
-+
-+ case 35:
-+ r9+=8;
-+ break;
-+ case -35:
-+ r9+=4;
-+ break;
-+ case 0:
-+ break;
-+ }
-+
-+ switch (fxsrxgain) {
-+
-+ case 35:
-+ r9+=2;
-+ break;
-+ case -35:
-+ r9+=1;
-+ break;
-+ case 0:
-+ break;
-+ }
-+ ystdm_setreg(wc,card,9,r9);
-+ }
-+
-+ if(debug)
-+ printk("DEBUG: fxstxgain:%s fxsrxgain:%s\n",((ystdm_getreg(wc, card, 9)/8) == 1)?"3.5":(((ystdm_getreg(wc,card,9)/4) == 1)?"-3.5":"0.0"),((ystdm_getreg(wc, card, 9)/2) == 1)?"3.5":((ystdm_getreg(wc,card,9)%2)?"-3.5":"0.0"));
-+
-+ fxs->lasttxhook = fxs->idletxhookstate;
-+ ystdm_setreg(wc, card, LINE_STATE, fxs->lasttxhook);
-+
-+ /* Analog Transmit Path Gain = 3.5dB; Analog Receive Path Gain = 3.5dB. */
-+ /* ystdm_setreg(wc, card, 9, 0x0a); */
-+ return 0;
-+}
-+
-+static int ystdm_ioctl(struct dahdi_chan *chan, unsigned int cmd, unsigned long data)
-+{
-+ struct ystdm_stats stats;
-+ struct ystdm_regs regs;
-+ struct ystdm_regop regop;
-+ struct ystdm_echo_coefs echoregs;
-+ struct dahdi_hwgain hwgain;
-+ struct ystdm *wc = chan->pvt;
-+ struct fxs *const fxs = &wc->mod[chan->chanpos - 1].fxs;
-+ int x;
-+ switch (cmd) {
-+ case DAHDI_ONHOOKTRANSFER:
-+ if (wc->modtype[chan->chanpos - 1] != MOD_TYPE_FXS)
-+ return -EINVAL;
-+ if (get_user(x, (__user int *) data))
-+ return -EFAULT;
-+ fxs->ohttimer = x << 3;
-+
-+ /* Active mode when idle */
-+ fxs->idletxhookstate = POLARITY_XOR ?
-+ SLIC_LF_ACTIVE_REV : SLIC_LF_ACTIVE_FWD;
-+ if (fxs->neonringing) {
-+ /* keep same Forward polarity */
-+ fxs->lasttxhook = SLIC_LF_OHTRAN_FWD;
-+ printk(KERN_INFO "ioctl: Start OnHookTrans, card %d\n",
-+ chan->chanpos - 1);
-+ ystdm_setreg(wc, chan->chanpos - 1,
-+ LINE_STATE, fxs->lasttxhook);
-+ } else if (fxs->lasttxhook == SLIC_LF_ACTIVE_FWD ||
-+ fxs->lasttxhook == SLIC_LF_ACTIVE_REV) {
-+ /* Apply the change if appropriate */
-+ fxs->lasttxhook = POLARITY_XOR ?
-+ SLIC_LF_OHTRAN_REV : SLIC_LF_OHTRAN_FWD;
-+ printk(KERN_INFO "ioctl: Start OnHookTrans, card %d\n",
-+ chan->chanpos - 1);
-+ ystdm_setreg(wc, chan->chanpos - 1,
-+ LINE_STATE, fxs->lasttxhook);
-+ }
-+ break;
-+ case DAHDI_SETPOLARITY:
-+ if (wc->modtype[chan->chanpos - 1] != MOD_TYPE_FXS)
-+ return -EINVAL;
-+ if (get_user(x, (__user int *) data))
-+ return -EFAULT;
-+ /* Can't change polarity while ringing or when open */
-+ if ((fxs->lasttxhook == SLIC_LF_RINGING) ||
-+ (fxs->lasttxhook == SLIC_LF_OPEN))
-+ return -EINVAL;
-+
-+ fxs->reversepolarity = x;
-+ if (POLARITY_XOR) {
-+ fxs->lasttxhook |= SLIC_LF_REVMASK;
-+ printk(KERN_INFO "ioctl: Reverse Polarity, card %d\n",
-+ chan->chanpos - 1);
-+ }
-+ else {
-+ fxs->lasttxhook &= ~SLIC_LF_REVMASK;
-+ printk(KERN_INFO "ioctl: Normal Polarity, card %d\n",
-+ chan->chanpos - 1);
-+ }
-+
-+ ystdm_setreg(wc, chan->chanpos - 1,
-+ LINE_STATE, fxs->lasttxhook);
-+ break;
-+ case DAHDI_VMWI_CONFIG:
-+ if (wc->modtype[chan->chanpos - 1] != MOD_TYPE_FXS)
-+ return -EINVAL;
-+ if (copy_from_user(&(fxs->vmwisetting), (__user void *) data,
-+ sizeof(fxs->vmwisetting)))
-+ return -EFAULT;
-+ set_vmwi(wc, chan->chanpos - 1);
-+ break;
-+ case DAHDI_VMWI:
-+ if (wc->modtype[chan->chanpos - 1] != MOD_TYPE_FXS)
-+ return -EINVAL;
-+ if (get_user(x, (__user int *) data))
-+ return -EFAULT;
-+ if (0 > x)
-+ return -EFAULT;
-+ fxs->vmwi_active_messages = x;
-+ set_vmwi(wc, chan->chanpos - 1);
-+ break;
-+ case WCTDM_GET_STATS:
-+ if (wc->modtype[chan->chanpos - 1] == MOD_TYPE_FXS) {
-+ stats.tipvolt = ystdm_getreg(wc, chan->chanpos - 1, 80) * -376;
-+ stats.ringvolt = ystdm_getreg(wc, chan->chanpos - 1, 81) * -376;
-+ stats.batvolt = ystdm_getreg(wc, chan->chanpos - 1, 82) * -376;
-+ } else if (wc->modtype[chan->chanpos - 1] == MOD_TYPE_FXO) {
-+ stats.tipvolt = (signed char)ystdm_getreg(wc, chan->chanpos - 1, 29) * 1000;
-+ stats.ringvolt = (signed char)ystdm_getreg(wc, chan->chanpos - 1, 29) * 1000;
-+ stats.batvolt = (signed char)ystdm_getreg(wc, chan->chanpos - 1, 29) * 1000;
-+ } else
-+ return -EINVAL;
-+ if (copy_to_user((__user void *)data, &stats, sizeof(stats)))
-+ return -EFAULT;
-+ break;
-+ case WCTDM_GET_REGS:
-+ if (wc->modtype[chan->chanpos - 1] == MOD_TYPE_FXS) {
-+ for (x=0;x<NUM_INDIRECT_REGS;x++)
-+ regs.indirect[x] = ystdm_proslic_getreg_indirect(wc, chan->chanpos -1, x);
-+ for (x=0;x<NUM_REGS;x++)
-+ regs.direct[x] = ystdm_getreg(wc, chan->chanpos - 1, x);
-+ } else {
-+ memset(&regs, 0, sizeof(regs));
-+ for (x=0;x<NUM_FXO_REGS;x++)
-+ regs.direct[x] = ystdm_getreg(wc, chan->chanpos - 1, x);
-+ }
-+ if (copy_to_user((__user void *)data, &regs, sizeof(regs)))
-+ return -EFAULT;
-+ break;
-+ case WCTDM_SET_REG:
-+ if (copy_from_user(&regop, (__user void *)data, sizeof(regop)))
-+ return -EFAULT;
-+ if (regop.indirect) {
-+ if (wc->modtype[chan->chanpos - 1] != MOD_TYPE_FXS)
-+ return -EINVAL;
-+ printk("Setting indirect %d to 0x%04x on %d\n", regop.reg, regop.val, chan->chanpos);
-+ ystdm_proslic_setreg_indirect(wc, chan->chanpos - 1, regop.reg, regop.val);
-+ } else {
-+ regop.val &= 0xff;
-+ printk("Setting direct %d to %04x on %d\n", regop.reg, regop.val, chan->chanpos);
-+ ystdm_setreg(wc, chan->chanpos - 1, regop.reg, regop.val);
-+ }
-+ break;
-+ case WCTDM_SET_ECHOTUNE:
-+ printk("-- Setting echo registers: \n");
-+ if (copy_from_user(&echoregs, (__user void *)data, sizeof(echoregs)))
-+ return -EFAULT;
-+
-+ if (wc->modtype[chan->chanpos - 1] == MOD_TYPE_FXO) {
-+ /* Set the ACIM register */
-+ ystdm_setreg(wc, chan->chanpos - 1, 30, echoregs.acim);
-+
-+ /* Set the digital echo canceller registers */
-+ ystdm_setreg(wc, chan->chanpos - 1, 45, echoregs.coef1);
-+ ystdm_setreg(wc, chan->chanpos - 1, 46, echoregs.coef2);
-+ ystdm_setreg(wc, chan->chanpos - 1, 47, echoregs.coef3);
-+ ystdm_setreg(wc, chan->chanpos - 1, 48, echoregs.coef4);
-+ ystdm_setreg(wc, chan->chanpos - 1, 49, echoregs.coef5);
-+ ystdm_setreg(wc, chan->chanpos - 1, 50, echoregs.coef6);
-+ ystdm_setreg(wc, chan->chanpos - 1, 51, echoregs.coef7);
-+ ystdm_setreg(wc, chan->chanpos - 1, 52, echoregs.coef8);
-+
-+ printk("-- Set echo registers successfully\n");
-+
-+ break;
-+ } else {
-+ return -EINVAL;
-+
-+ }
-+ break;
-+ case DAHDI_SET_HWGAIN:
-+ if (copy_from_user(&hwgain, (__user void *) data, sizeof(hwgain)))
-+ return -EFAULT;
-+
-+ ystdm_set_hwgain(wc, chan->chanpos-1, hwgain.newgain, hwgain.tx);
-+
-+ if (debug)
-+ printk("Setting hwgain on channel %d to %d for %s direction\n",
-+ chan->chanpos-1, hwgain.newgain, hwgain.tx ? "tx" : "rx");
-+ break;
-+
-+ default:
-+ return -ENOTTY;
-+ }
-+ return 0;
-+
-+}
-+static int ystdm_open(struct dahdi_chan *chan)
-+{
-+ struct ystdm *wc = chan->pvt;
-+ if (!(wc->cardflag & (1 << (chan->chanpos - 1))))
-+ return -ENODEV;
-+ if (wc->dead)
-+ return -ENODEV;
-+ wc->usecount++;
-+ return 0;
-+}
-+
-+static inline struct ystdm *ystdm_from_span(struct dahdi_span *span)
-+{
-+ return container_of(span, struct ystdm, span);
-+}
-+
-+static int ystdm_watchdog(struct dahdi_span *span, int event)
-+{
-+ printk("TDM: Restarting DMA\n");
-+ ystdm_restart_dma(ystdm_from_span(span));
-+ return 0;
-+}
-+
-+static int ystdm_close(struct dahdi_chan *chan)
-+{
-+ struct ystdm *wc = chan->pvt;
-+ struct fxs *const fxs = &wc->mod[chan->chanpos - 1].fxs;
-+ wc->usecount--;
-+ if (wc->modtype[chan->chanpos - 1] == MOD_TYPE_FXS) {
-+ int idlehookstate;
-+ idlehookstate = POLARITY_XOR ?
-+ SLIC_LF_ACTIVE_REV :
-+ SLIC_LF_ACTIVE_FWD;
-+ fxs->idletxhookstate = idlehookstate;
-+ }
-+ /* If we're dead, release us now */
-+ if (!wc->usecount && wc->dead)
-+ ystdm_release(wc);
-+ return 0;
-+}
-+
-+static int ystdm_init_ring_generator_mode(struct ystdm *wc, int card)
-+{
-+ ystdm_setreg(wc, card, 34, 0x00); /* Ringing Osc. Control */
-+
-+ /* neon trapezoid timers */
-+ ystdm_setreg(wc, card, 48, 0xe0); /* Active Timer low byte */
-+ ystdm_setreg(wc, card, 49, 0x01); /* Active Timer high byte */
-+ ystdm_setreg(wc, card, 50, 0xF0); /* Inactive Timer low byte */
-+ ystdm_setreg(wc, card, 51, 0x05); /* Inactive Timer high byte */
-+
-+ ystdm_set_ring_generator_mode(wc, card, 0);
-+
-+ return 0;
-+}
-+
-+static int ystdm_set_ring_generator_mode(struct ystdm *wc, int card, int mode)
-+{
-+ int reg20, reg21, reg74; /* RCO, RNGX, VBATH */
-+ struct fxs *const fxs = &wc->mod[card].fxs;
-+
-+ fxs->neonringing = mode; /* track ring generator mode */
-+
-+ if (mode) { /* Neon */
-+ if (debug)
-+ printk(KERN_DEBUG "NEON ring on chan %d, "
-+ "lasttxhook was 0x%x\n", card, fxs->lasttxhook);
-+ /* Must be in FORWARD ACTIVE before setting ringer */
-+ fxs->lasttxhook = SLIC_LF_ACTIVE_FWD;
-+ ystdm_setreg(wc, card, LINE_STATE, fxs->lasttxhook);
-+
-+ ystdm_proslic_setreg_indirect(wc, card, 22,
-+ NEON_MWI_RNGY_PULSEWIDTH);
-+ ystdm_proslic_setreg_indirect(wc, card, 21,
-+ 0x7bef); /* RNGX (91.5Vpk) */
-+ ystdm_proslic_setreg_indirect(wc, card, 20,
-+ 0x009f); /* RCO (RNGX, t rise)*/
-+
-+ ystdm_setreg(wc, card, 34, 0x19); /* Ringing Osc. Control */
-+ ystdm_setreg(wc, card, 74, 0x3f); /* VBATH 94.5V */
-+ ystdm_proslic_setreg_indirect(wc, card, 29, 0x4600); /* RPTP */
-+ /* A write of 0x04 to register 64 will turn on the VM led */
-+ } else {
-+ ystdm_setreg(wc, card, 34, 0x00); /* Ringing Osc. Control */
-+ /* RNGY Initial Phase */
-+ ystdm_proslic_setreg_indirect(wc, card, 22, 0x0000);
-+ ystdm_proslic_setreg_indirect(wc, card, 29, 0x3600); /* RPTP */
-+ /* A write of 0x04 to register 64 will turn on the ringer */
-+
-+ if (fastringer) {
-+ /* Speed up Ringer */
-+ reg20 = 0x7e6d;
-+ reg74 = 0x32; /* Default */
-+ /* Beef up Ringing voltage to 89V */
-+ if (boostringer) {
-+ reg74 = 0x3f;
-+ reg21 = 0x0247; /* RNGX */
-+ if (debug)
-+ printk(KERN_DEBUG "Boosting fast ringer"
-+ " on chan %d (89V peak)\n",
-+ card);
-+ } else if (lowpower) {
-+ reg21 = 0x014b; /* RNGX */
-+ if (debug)
-+ printk(KERN_DEBUG "Reducing fast ring "
-+ "power on chan %d (50V peak)\n",
-+ card);
-+ } else if (fxshonormode &&
-+ fxo_modes[_opermode].ring_x) {
-+ reg21 = fxo_modes[_opermode].ring_x;
-+ if (debug)
-+ printk(KERN_DEBUG "fxshonormode: fast "
-+ "ring_x power on chan %d\n",
-+ card);
-+ } else {
-+ reg21 = 0x01b9;
-+ if (debug)
-+ printk(KERN_DEBUG "Speeding up ringer "
-+ "on chan %d (25Hz)\n",
-+ card);
-+ }
-+ /* VBATH */
-+ ystdm_setreg(wc, card, 74, reg74);
-+ /*RCO*/
-+ ystdm_proslic_setreg_indirect(wc, card, 20, reg20);
-+ /*RNGX*/
-+ ystdm_proslic_setreg_indirect(wc, card, 21, reg21);
-+
-+ } else {
-+ /* Ringer Speed */
-+ if (fxshonormode && fxo_modes[_opermode].ring_osc) {
-+ reg20 = fxo_modes[_opermode].ring_osc;
-+ if (debug)
-+ printk(KERN_DEBUG "fxshonormode: "
-+ "ring_osc speed on chan %d\n",
-+ card);
-+ } else {
-+ reg20 = 0x7ef0; /* Default */
-+ }
-+
-+ reg74 = 0x32; /* Default */
-+ /* Beef up Ringing voltage to 89V */
-+ if (boostringer) {
-+ reg74 = 0x3f;
-+ reg21 = 0x1d1;
-+ if (debug)
-+ printk(KERN_DEBUG "Boosting ringer on "
-+ "chan %d (89V peak)\n",
-+ card);
-+ } else if (lowpower) {
-+ reg21 = 0x108;
-+ if (debug)
-+ printk(KERN_DEBUG "Reducing ring power "
-+ "on chan %d (50V peak)\n",
-+ card);
-+ } else if (fxshonormode &&
-+ fxo_modes[_opermode].ring_x) {
-+ reg21 = fxo_modes[_opermode].ring_x;
-+ if (debug)
-+ printk(KERN_DEBUG "fxshonormode: ring_x"
-+ " power on chan %d\n",
-+ card);
-+ } else {
-+ reg21 = 0x160;
-+ if (debug)
-+ printk(KERN_DEBUG "Normal ring power on"
-+ " chan %d\n",
-+ card);
-+ }
-+ /* VBATH */
-+ ystdm_setreg(wc, card, 74, reg74);
-+ /* RCO */
-+ ystdm_proslic_setreg_indirect(wc, card, 20, reg20);
-+ /* RNGX */
-+ ystdm_proslic_setreg_indirect(wc, card, 21, reg21);
-+ }
-+ }
-+ return 0;
-+}
-+
-+static int ystdm_hooksig(struct dahdi_chan *chan, enum dahdi_txsig txsig)
-+{
-+ struct ystdm *wc = chan->pvt;
-+ int chan_entry = chan->chanpos - 1;
-+ if (wc->modtype[chan_entry] == MOD_TYPE_FXO) {
-+ /* XXX Enable hooksig for FXO XXX */
-+ switch(txsig) {
-+ case DAHDI_TXSIG_START:
-+ case DAHDI_TXSIG_OFFHOOK:
-+ wc->mod[chan_entry].fxo.offhook = 1;
-+ ystdm_setreg(wc, chan_entry, 5, 0x9);
-+ break;
-+ case DAHDI_TXSIG_ONHOOK:
-+ wc->mod[chan_entry].fxo.offhook = 0;
-+ ystdm_setreg(wc, chan_entry, 5, 0x8);
-+ break;
-+ default:
-+ printk("wcfxo: Can't set tx state to %d\n", txsig);
-+ }
-+ } else {
-+ ystdm_fxs_hooksig(wc, chan_entry, txsig);
-+ }
-+ return 0;
-+}
-+
-+static const struct dahdi_span_ops ystdm_span_ops = {
-+ .owner = THIS_MODULE,
-+ .hooksig = ystdm_hooksig,
-+ .open = ystdm_open,
-+ .close = ystdm_close,
-+ .ioctl = ystdm_ioctl,
-+ .watchdog = ystdm_watchdog,
-+};
-+
-+static int ystdm_initialize(struct ystdm *wc)
-+{
-+ int x;
-+
-+ wc->ddev = dahdi_create_device();
-+ if (!wc->ddev)
-+ return -ENOMEM;
-+
-+ /* Zapata stuff */
-+ sprintf(wc->span.name, "WCTDM/%d", wc->pos);
-+ snprintf(wc->span.desc, sizeof(wc->span.desc) - 1, "%s Board %d", wc->variety, wc->pos + 1);
-+ wc->ddev->location = kasprintf(GFP_KERNEL,
-+ "PCI Bus %02d Slot %02d",
-+ wc->dev->bus->number,
-+ PCI_SLOT(wc->dev->devfn) + 1);
-+ if (!wc->ddev->location) {
-+ dahdi_free_device(wc->ddev);
-+ wc->ddev = NULL;
-+ return -ENOMEM;
-+ }
-+
-+ wc->ddev->manufacturer = "YEASTAR";
-+ wc->ddev->devicetype = wc->variety;
-+
-+
-+ if (alawoverride) {
-+ printk("ALAW override parameter detected. Device will be operating in ALAW\n");
-+ wc->span.deflaw = DAHDI_LAW_ALAW;
-+ } else {
-+ wc->span.deflaw = DAHDI_LAW_MULAW;
-+ }
-+ for (x = 0; x < NUM_CARDS; x++) {
-+ sprintf(wc->chans[x]->name, "WCTDM/%d/%d", wc->pos, x);
-+ wc->chans[x]->sigcap = DAHDI_SIG_FXOKS | DAHDI_SIG_FXOLS | DAHDI_SIG_FXOGS | DAHDI_SIG_SF | DAHDI_SIG_EM | DAHDI_SIG_CLEAR;
-+ wc->chans[x]->sigcap |= DAHDI_SIG_FXSKS | DAHDI_SIG_FXSLS | DAHDI_SIG_SF | DAHDI_SIG_CLEAR;
-+ wc->chans[x]->chanpos = x+1;
-+ wc->chans[x]->pvt = wc;
-+ }
-+
-+ wc->span.chans = wc->chans;
-+ wc->span.channels = NUM_CARDS;
-+ wc->span.flags = DAHDI_FLAG_RBS;
-+ wc->span.ops = &ystdm_span_ops;
-+
-+ list_add_tail(&wc->span.device_node, &wc->ddev->spans);
-+ if (dahdi_register_device(wc->ddev, &wc->dev->dev)) {
-+ printk(KERN_NOTICE "Unable to register span with DAHDI\n");
-+ kfree(wc->ddev->location);
-+ dahdi_free_device(wc->ddev);
-+ wc->ddev = NULL;
-+ return -1;
-+ }
-+
-+ return 0;
-+}
-+
-+static void ystdm_post_initialize(struct ystdm *wc)
-+{
-+ int x;
-+ /* Finalize signalling */
-+ for (x = 0; x < NUM_CARDS; x++) {
-+ if (wc->cardflag & (1 << x)) {
-+ if (wc->modtype[x] == MOD_TYPE_FXO)
-+ wc->chans[x]->sigcap = DAHDI_SIG_FXSKS | DAHDI_SIG_FXSLS | DAHDI_SIG_SF | DAHDI_SIG_CLEAR;
-+ else
-+ wc->chans[x]->sigcap = DAHDI_SIG_FXOKS | DAHDI_SIG_FXOLS | DAHDI_SIG_FXOGS | DAHDI_SIG_SF | DAHDI_SIG_EM | DAHDI_SIG_CLEAR;
-+ } else if (!(wc->chans[x]->sigcap & DAHDI_SIG_BROKEN)) {
-+ wc->chans[x]->sigcap = 0;
-+ }
-+
-+ }
-+}
-+
-+static int ystdm_hardware_init(struct ystdm *wc)
-+{
-+ /* Hardware stuff */
-+ unsigned char ver;
-+ unsigned char x,y;
-+ unsigned char ol = 0, sl = 0;
-+ int failed;
-+
-+ /* Signal Reset */
-+ outb(0x01, wc->ioaddr + WC_CNTL);
-+
-+ /* Check Freshmaker chip */
-+ x=inb(wc->ioaddr + WC_CNTL);
-+ ver = __ystdm_getcreg(wc, WC_VER);
-+ failed = 0;
-+ if (ver != 0x59) {
-+ printk("Freshmaker version: %02x\n", ver);
-+ for (x=0;x<255;x++) {
-+ /* Test registers */
-+ if (ver >= 0x70) {
-+ __ystdm_setcreg(wc, WC_CS, x);
-+ y = __ystdm_getcreg(wc, WC_CS);
-+ } else {
-+ __ystdm_setcreg(wc, WC_TEST, x);
-+ y = __ystdm_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;
-+ }
-+ } else {
-+ printk("No freshmaker chip\n");
-+ }
-+
-+ /* Reset PCI Interface chip and registers (and serial) */
-+ outb(0x06, wc->ioaddr + WC_CNTL);
-+ /* Setup our proper outputs for when we switch for our "serial" port */
-+ wc->ios = BIT_CS | BIT_SCLK | BIT_SDI | BIT_SYNC;
-+
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+
-+ /* Set all to outputs except AUX 5, which is an input */
-+ outb(0xdf, wc->ioaddr + WC_AUXC);
-+
-+ /* Wait 1/4 of a sec */
-+ wait_just_a_bit(HZ/4);
-+
-+ /* Back to normal, with automatic DMA wrap around */
-+ outb(0x30 | 0x01, wc->ioaddr + WC_CNTL);
-+
-+ /* Make sure serial port and DMA are out of reset */
-+ outb(inb(wc->ioaddr + WC_CNTL) & 0xf9, wc->ioaddr + WC_CNTL);
-+
-+ /* Configure serial port for MSB->LSB operation */
-+ outb(0xc1, wc->ioaddr + WC_SERCTL);
-+
-+ /* Delay FSC by 0 so it's properly aligned */
-+ outb(0x0, wc->ioaddr + WC_FSCDELAY);
-+
-+ /* Setup DMA Addresses */
-+ outl(wc->writedma, wc->ioaddr + WC_DMAWS); /* Write start */
-+ outl(wc->writedma + DAHDI_CHUNKSIZE * NUM_CARDS - 4, wc->ioaddr + WC_DMAWI); /* Middle (interrupt) */
-+ outl(wc->writedma + 2 * DAHDI_CHUNKSIZE * NUM_CARDS - 4, wc->ioaddr + WC_DMAWE); /* End */
-+
-+ outl(wc->readdma, wc->ioaddr + WC_DMARS); /* Read start */
-+ outl(wc->readdma + DAHDI_CHUNKSIZE * NUM_CARDS - 4, wc->ioaddr + WC_DMARI); /* Middle (interrupt) */
-+ outl(wc->readdma + 2 * DAHDI_CHUNKSIZE * NUM_CARDS - 4, wc->ioaddr + WC_DMARE); /* End */
-+
-+ /* Clear interrupts */
-+ outb(0xff, wc->ioaddr + WC_INTSTAT);
-+
-+ /* Wait 1/4 of a second more */
-+ wait_just_a_bit(HZ/4);
-+
-+ for (x = 0; x < NUM_CARDS; x++) {
-+ int sane=0,ret=0,readi=0;
-+#if 1
-+ /* Init with Auto Calibration */
-+ if (!(ret=ystdm_init_proslic(wc, x, 0, 0, sane))) {
-+ wc->cardflag |= (1 << x);
-+ sl |= (1 << x);
-+ if (debug) {
-+ readi = ystdm_getreg(wc,x,LOOP_I_LIMIT);
-+ printk("Proslic module %d loop current is %dmA\n",x,
-+ ((readi*3)+20));
-+ }
-+ printk("Module %d: Installed -- AUTO FXS/DPO\n",x);
-+ } else {
-+ if(ret!=-2) {
-+ sane=1;
-+ /* Init with Manual Calibration */
-+ if (!ystdm_init_proslic(wc, x, 0, 1, sane)) {
-+ wc->cardflag |= (1 << x);
-+ sl |= (1 << x);
-+ if (debug) {
-+ readi = ystdm_getreg(wc,x,LOOP_I_LIMIT);
-+ printk("Proslic module %d loop current is %dmA\n",x,
-+ ((readi*3)+20));
-+ }
-+ printk("Module %d: Installed -- MANUAL FXS\n",x);
-+ } else {
-+ printk("Module %d: FAILED FXS (%s)\n", x, fxshonormode ? fxo_modes[_opermode].name : "FCC");
-+ wc->chans[x]->sigcap = __DAHDI_SIG_FXO | DAHDI_SIG_BROKEN;
-+ }
-+ } else if (!(ret = ystdm_init_voicedaa(wc, x, 0, 0, sane))) {
-+ wc->cardflag |= (1 << x);
-+ ol |= (1 << x);
-+ printk("Module %d: Installed -- AUTO FXO (%s mode)\n",x, fxo_modes[_opermode].name);
-+ } else
-+ printk("Module %d: Not installed\n", x);
-+ }
-+#endif
-+ }
-+
-+ /* Return error if nothing initialized okay. */
-+ if (!wc->cardflag && !timingonly)
-+ return -1;
-+ if(ver == 0x88)
-+ __ystdm_setcreg(wc, WC_SYNC, wc->cardflag);
-+ else{
-+ __ystdm_setcreg(wc, WC_SYNC, ol);
-+ __ystdm_setcreg(wc, YS_SLC, sl);
-+ }
-+ return 0;
-+}
-+
-+static void ystdm_enable_interrupts(struct ystdm *wc)
-+{
-+ /* Enable interrupts (we care about all of them) */
-+ outb(0x3f, wc->ioaddr + WC_MASK0);
-+ /* No external interrupts */
-+ outb(0x00, wc->ioaddr + WC_MASK1);
-+}
-+
-+static void ystdm_restart_dma(struct ystdm *wc)
-+{
-+ /* Reset Master and TDM */
-+ outb(0x01, wc->ioaddr + WC_CNTL);
-+ outb(0x01, wc->ioaddr + WC_OPER);
-+}
-+
-+static void ystdm_start_dma(struct ystdm *wc)
-+{
-+ /* Reset Master and TDM */
-+ unsigned char x,y;
-+ outb(0x0f, wc->ioaddr + WC_CNTL);
-+ wc->ios &= ~BIT_SYNC;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ set_current_state(TASK_INTERRUPTIBLE);
-+ schedule_timeout(1);
-+ wc->ios |= BIT_SYNC;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ outb(0x01, wc->ioaddr + WC_CNTL);
-+ outb(0x01, wc->ioaddr + WC_OPER);
-+ y = __ystdm_getcreg(wc, WC_TEST);
-+ x = y | 0x01;
-+ __ystdm_setcreg(wc, WC_TEST, x);
-+}
-+
-+static void ystdm_stop_dma(struct ystdm *wc)
-+{
-+ unsigned char x,y;
-+ wc->ios &= ~BIT_SYNC;
-+ outb(wc->ios, wc->ioaddr + WC_AUXD);
-+ outb(0x00, wc->ioaddr + WC_OPER);
-+ y = __ystdm_getcreg(wc, WC_TEST);
-+ x = y & 0xFE;
-+ __ystdm_setcreg(wc, WC_TEST, x);
-+}
-+
-+static void ystdm_reset_tdm(struct ystdm *wc)
-+{
-+ /* Reset TDM */
-+ outb(0x0f, wc->ioaddr + WC_CNTL);
-+}
-+
-+static void ystdm_disable_interrupts(struct ystdm *wc)
-+{
-+ outb(0x00, wc->ioaddr + WC_MASK0);
-+ outb(0x00, wc->ioaddr + WC_MASK1);
-+}
-+
-+static int __devinit ystdm_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
-+{
-+ int res;
-+ struct ystdm *wc;
-+ struct ystdm_desc *d = (struct ystdm_desc *)ent->driver_data;
-+ int x;
-+ int y;
-+
-+
-+
-+ for (x=0;x<WC_MAX_IFACES;x++)
-+ if (!ifaces[x]) break;
-+ if (x >= WC_MAX_IFACES) {
-+ printk("Too many interfaces\n");
-+ return -EIO;
-+ }
-+
-+ if (pci_enable_device(pdev)) {
-+ res = -EIO;
-+ } else {
-+ wc = kmalloc(sizeof(struct ystdm), GFP_KERNEL);
-+ if (wc) {
-+ int cardcount = 0;
-+
-+ ifaces[x] = wc;
-+ memset(wc, 0, sizeof(struct ystdm));
-+ for (x=0; x < sizeof(wc->chans)/sizeof(wc->chans[0]); ++x) {
-+ wc->chans[x] = &wc->_chans[x];
-+ }
-+ spin_lock_init(&wc->lock);
-+ wc->curcard = -1;
-+ wc->ioaddr = pci_resource_start(pdev, 0);
-+ wc->dev = pdev;
-+ wc->pos = x;
-+ wc->variety = d->name;
-+ for (y=0;y<NUM_CARDS;y++)
-+ wc->flags[y] = d->flags;
-+ /* Keep track of whether we need to free the region */
-+ if (request_region(wc->ioaddr, 0xff, "ystdm"))
-+ wc->freeregion = 1;
-+
-+ /* Allocate enough memory for two zt chunks, receive and transmit. Each sample uses
-+ 32 bits. Allocate an extra set just for control too */
-+ wc->writechunk = pci_alloc_consistent(pdev, DAHDI_MAX_CHUNKSIZE * 2 * 2 * 2 * NUM_CARDS, &wc->writedma);
-+ if (!wc->writechunk) {
-+ printk("ystdm: Unable to allocate DMA-able memory\n");
-+ if (wc->freeregion)
-+ release_region(wc->ioaddr, 0xff);
-+ return -ENOMEM;
-+ }
-+
-+ wc->readchunk = wc->writechunk + 2 * DAHDI_MAX_CHUNKSIZE * (NUM_CARDS / 4); /* in doublewords */
-+ wc->readdma = wc->writedma + 2 * DAHDI_MAX_CHUNKSIZE * (NUM_CARDS / 1); /* in bytes */
-+
-+ if (ystdm_initialize(wc)) {
-+ printk("ystdm: Unable to intialize FXS\n");
-+ /* Set Reset Low */
-+ x=inb(wc->ioaddr + WC_CNTL);
-+ outb((~0x1)&x, wc->ioaddr + WC_CNTL);
-+ /* Free Resources */
-+ free_irq(pdev->irq, wc);
-+ if (wc->freeregion)
-+ release_region(wc->ioaddr, 0xff);
-+ pci_free_consistent(pdev, DAHDI_MAX_CHUNKSIZE * 2 * 2 * 2 * NUM_CARDS, (void *)wc->writechunk, wc->writedma);
-+ kfree(wc);
-+ return -EIO;
-+ }
-+
-+ /* Enable bus mastering */
-+ pci_set_master(pdev);
-+
-+ /* Keep track of which device we are */
-+ pci_set_drvdata(pdev, wc);
-+
-+ if (request_irq(pdev->irq, ystdm_interrupt, DAHDI_IRQ_SHARED, "ystdm", wc)) {
-+ printk("ystdm: Unable to request IRQ %d\n", pdev->irq);
-+ if (wc->freeregion)
-+ release_region(wc->ioaddr, 0xff);
-+ pci_free_consistent(pdev, DAHDI_MAX_CHUNKSIZE * 2 * 2 * 2 * NUM_CARDS, (void *)wc->writechunk, wc->writedma);
-+ pci_set_drvdata(pdev, NULL);
-+ kfree(wc);
-+ return -EIO;
-+ }
-+
-+
-+ if (ystdm_hardware_init(wc)) {
-+ unsigned char x;
-+
-+ /* Set Reset Low */
-+ x=inb(wc->ioaddr + WC_CNTL);
-+ outb((~0x1)&x, wc->ioaddr + WC_CNTL);
-+ /* Free Resources */
-+ free_irq(pdev->irq, wc);
-+ if (wc->freeregion)
-+ release_region(wc->ioaddr, 0xff);
-+ pci_free_consistent(pdev, DAHDI_MAX_CHUNKSIZE * 2 * 2 * 2 * NUM_CARDS, (void *)wc->writechunk, wc->writedma);
-+ pci_set_drvdata(pdev, NULL);
-+ dahdi_unregister_device(wc->ddev);
-+ kfree(wc->ddev->location);
-+ dahdi_free_device(wc->ddev);
-+ kfree(wc);
-+ return -EIO;
-+
-+ }
-+
-+ ystdm_post_initialize(wc);
-+
-+ /* Enable interrupts */
-+ ystdm_enable_interrupts(wc);
-+ /* Initialize Write/Buffers to all blank data */
-+ memset((void *)wc->writechunk,0,DAHDI_MAX_CHUNKSIZE * 2 * 2 * NUM_CARDS);
-+
-+ /* Start DMA */
-+ ystdm_start_dma(wc);
-+
-+ for (x = 0; x < NUM_CARDS; x++) {
-+ if (wc->cardflag & (1 << x))
-+ cardcount++;
-+ }
-+
-+ printk("Found a YSTDM8xx: %s (%d modules)\n", wc->variety, cardcount);
-+ res = 0;
-+ } else
-+ res = -ENOMEM;
-+ }
-+ return res;
-+}
-+
-+static void ystdm_release(struct ystdm *wc)
-+{
-+ dahdi_unregister_device(wc->ddev);
-+ if (wc->freeregion)
-+ release_region(wc->ioaddr, 0xff);
-+
-+ kfree(wc->ddev->location);
-+ dahdi_free_device(wc->ddev);
-+
-+ kfree(wc);
-+ printk("Freed a Wildcard\n");
-+}
-+
-+static void __devexit ystdm_remove_one(struct pci_dev *pdev)
-+{
-+ struct ystdm *wc = pci_get_drvdata(pdev);
-+ if (wc) {
-+
-+ /* Stop any DMA */
-+ ystdm_stop_dma(wc);
-+ ystdm_reset_tdm(wc);
-+
-+ /* In case hardware is still there */
-+ ystdm_disable_interrupts(wc);
-+
-+ /* Immediately free resources */
-+ pci_free_consistent(pdev, DAHDI_MAX_CHUNKSIZE * 2 * 2 * 2 * NUM_CARDS, (void *)wc->writechunk, wc->writedma);
-+ free_irq(pdev->irq, wc);
-+
-+ /* Reset PCI chip and registers */
-+ outb(0x0e, wc->ioaddr + WC_CNTL);
-+
-+ /* Release span, possibly delayed */
-+ if (!wc->usecount)
-+ ystdm_release(wc);
-+ else
-+ wc->dead = 1;
-+ }
-+}
-+
-+static DEFINE_PCI_DEVICE_TABLE(ystdm_pci_tbl) = {
-+ { 0xe159, 0x0001, 0x2151, PCI_ANY_ID, 0, 0, (unsigned long) &ystdme },
-+ { 0 }
-+};
-+
-+MODULE_DEVICE_TABLE(pci, ystdm_pci_tbl);
-+
-+static int ystdm_suspend(struct pci_dev *pdev, pm_message_t state)
-+{
-+ return -ENOSYS;
-+}
-+
-+static struct pci_driver ystdm_driver = {
-+ .name = "ystdm8xx",
-+ .probe = ystdm_init_one,
-+ .remove = __devexit_p(ystdm_remove_one),
-+ .suspend = ystdm_suspend,
-+ .id_table = ystdm_pci_tbl,
-+};
-+
-+static int __init ystdm_init(void)
-+{
-+ int res;
-+ int x;
-+
-+ for (x=0;x<(sizeof(fxo_modes) / sizeof(fxo_modes[0])); x++) {
-+ if (!strcmp(fxo_modes[x].name, opermode))
-+ break;
-+ }
-+ if (x < sizeof(fxo_modes) / sizeof(fxo_modes[0])) {
-+ _opermode = x;
-+ } else {
-+ printk("Invalid/unknown operating mode '%s' specified. Please choose one of:\n", opermode);
-+ for (x = 0; x < sizeof(fxo_modes) / sizeof(fxo_modes[0]); x++)
-+ printk(" %s\n", fxo_modes[x].name);
-+ printk("Note this option is CASE SENSITIVE!\n");
-+ return -ENODEV;
-+ }
-+ if (!strcmp(opermode, "AUSTRALIA")) {
-+ boostringer = 1;
-+ fxshonormode = 1;
-+ }
-+
-+ /* for the voicedaa_check_hook defaults, if the user has not overridden
-+ them by specifying them as module parameters, then get the values
-+ from the selected operating mode
-+ */
-+ if (battdebounce == 0) {
-+ battdebounce = fxo_modes[_opermode].battdebounce;
-+ }
-+ if (battalarm == 0) {
-+ battalarm = fxo_modes[_opermode].battalarm;
-+ }
-+ if (battthresh == 0) {
-+ battthresh = fxo_modes[_opermode].battthresh;
-+ }
-+
-+
-+ res = dahdi_pci_module(&ystdm_driver);
-+ if (res)
-+ return -ENODEV;
-+ return 0;
-+}
-+
-+static void __exit ystdm_cleanup(void)
-+{
-+ pci_unregister_driver(&ystdm_driver);
-+}
-+
-+module_param(debug, int, 0600);
-+module_param(fxovoltage, int, 0600);
-+module_param(loopcurrent, int, 0600);
-+module_param(reversepolarity, int, 0600);
-+module_param(robust, int, 0600);
-+module_param(opermode, charp, 0600);
-+module_param(timingonly, int, 0600);
-+module_param(lowpower, int, 0600);
-+module_param(boostringer, int, 0600);
-+module_param(fastringer, int, 0600);
-+module_param(fxshonormode, int, 0600);
-+module_param(battdebounce, uint, 0600);
-+module_param(battalarm, uint, 0600);
-+module_param(battthresh, uint, 0600);
-+module_param(ringdebounce, int, 0600);
-+module_param(dialdebounce, int, 0600);
-+module_param(fwringdetect, int, 0600);
-+module_param(alawoverride, int, 0600);
-+module_param(fastpickup, int, 0600);
-+module_param(fxotxgain, int, 0600);
-+module_param(fxorxgain, int, 0600);
-+module_param(fxstxgain, int, 0600);
-+module_param(fxsrxgain, int, 0600);
-+module_param(dtmf, int, 0600);
-+
-+MODULE_DESCRIPTION("YSTDM8xx Yeastar Driver");
-+MODULE_AUTHOR("yeastar <support@yeastar.com>");
-+MODULE_ALIAS("ystdm8xx");
-+MODULE_LICENSE("GPL v2");
-+
-+module_init(ystdm_init);
-+module_exit(ystdm_cleanup);