diff options
Diffstat (limited to 'dahdi-linux-2.10.1-yeastar.patch')
-rw-r--r-- | dahdi-linux-2.10.1-yeastar.patch | 6269 |
1 files changed, 6269 insertions, 0 deletions
diff --git a/dahdi-linux-2.10.1-yeastar.patch b/dahdi-linux-2.10.1-yeastar.patch new file mode 100644 index 000000000000..207b2bceda07 --- /dev/null +++ b/dahdi-linux-2.10.1-yeastar.patch @@ -0,0 +1,6269 @@ +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); |