diff options
author | Maik Broemme | 2015-10-04 21:51:11 +0200 |
---|---|---|
committer | Maik Broemme | 2015-10-04 21:51:11 +0200 |
commit | 205e1524de216b894a99a525a9cd45f49a6d2119 (patch) | |
tree | d6683bbd43e65fe52c986a349662aff443c5c60b /dahdi-linux-2.10.1-yeastar.patch | |
parent | 126ae972e89a76accea7bcc79972ae8f72c17ab3 (diff) | |
download | aur-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.patch | 6269 |
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(®s, 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, ®s, sizeof(regs))) -+ return -EFAULT; -+ break; -+ case WCTDM_SET_REG: -+ if (copy_from_user(®op, (__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(®s, 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, ®s, sizeof(regs))) -+ return -EFAULT; -+ break; -+ case WCTDM_SET_REG: -+ if (copy_from_user(®op, (__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); |