dahdi-linux/drivers/dahdi/xpp/card_pri.c

/*
 * Written by Oron Peled <oron@actcom.co.il>
 * Copyright (C) 2004-2006, Xorcom
 *
 * Parts derived from Cologne demo driver for the chip.
 *
 * 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/init.h>
#include <linux/module.h>
#include <linux/fs.h>
#include <linux/delay.h>
#include "xpd.h"
#include "xproto.h"
#include "xpp_dahdi.h"
#include "card_pri.h"
#include "dahdi_debug.h"
#include "xbus-core.h"

static const char rcsid[] = "$Id$";

/* must be before dahdi_debug.h */
static DEF_PARM(int, debug, 0, 0644, "Print DBG statements");
static DEF_PARM(uint, poll_interval, 500, 0644,
		"Poll channel state interval in milliseconds (0 - disable)");

#define	PRI_LINES_BITMASK	BITMASK(31)
#define	PRI_SIGCAP	(		\
			DAHDI_SIG_EM		| \
			DAHDI_SIG_CLEAR		| \
			DAHDI_SIG_FXSLS		| \
			DAHDI_SIG_FXSGS		| \
			DAHDI_SIG_FXSKS		| \
			DAHDI_SIG_HARDHDLC	| \
			DAHDI_SIG_MTP2		| \
			DAHDI_SIG_FXOLS		| \
			DAHDI_SIG_FXOGS		| \
			DAHDI_SIG_FXOKS		| \
			DAHDI_SIG_CAS		| \
			DAHDI_SIG_EM_E1		| \
			DAHDI_SIG_DACS_RBS	\
			)

static bool is_sigtype_dchan(int sigtype)
{
	if ((sigtype & DAHDI_SIG_HDLCRAW) == DAHDI_SIG_HDLCRAW)
		return 1;
	if ((sigtype & DAHDI_SIG_HDLCFCS) == DAHDI_SIG_HDLCFCS)
		return 1;
	if ((sigtype & DAHDI_SIG_HARDHDLC) == DAHDI_SIG_HARDHDLC)
		return 1;
	return 0;
}

#define	MAX_SLAVES		4	/* we have MUX of 4 clocks */

#define	PRI_PORT(xpd)	((xpd)->addr.subunit)
#define	CHAN_PER_REGS(p)	(((p)->is_esf) ? 2 : 4)

/*---------------- PRI Protocol Commands ----------------------------------*/

static bool pri_packet_is_valid(xpacket_t *pack);
static void pri_packet_dump(const char *msg, xpacket_t *pack);
static int pri_startup(struct file *file, struct dahdi_span *span);
static int pri_shutdown(struct dahdi_span *span);
static int pri_rbsbits(struct dahdi_chan *chan, int bits);
static int pri_lineconfig(xpd_t *xpd, int lineconfig);
static void send_idlebits(xpd_t *xpd, bool saveold);
static int apply_pri_protocol(xpd_t *xpd);

#define	PROC_REGISTER_FNAME	"slics"

enum pri_protocol {
	PRI_PROTO_0 = 0,
	PRI_PROTO_E1 = 1,
	PRI_PROTO_T1 = 2,
	PRI_PROTO_J1 = 3
};

static const char *protocol_names[] = {
	[PRI_PROTO_0] = "??",	/* unknown */
	[PRI_PROTO_E1] = "E1",
	[PRI_PROTO_T1] = "T1",
	[PRI_PROTO_J1] = "J1"
};

static const char *pri_protocol_name(enum pri_protocol pri_protocol)
{
	return protocol_names[pri_protocol];
}

static enum pri_protocol pri_protocol_bystr(const char *spantype)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(protocol_names); i++) {
		if (strcasecmp(protocol_names[i], spantype) == 0)
			return i;
	}
	return PRI_PROTO_0;
}

static int pri_num_channels(enum pri_protocol pri_protocol)
{
	static int num_channels[] = {
		[PRI_PROTO_0] = 0,
		[PRI_PROTO_E1] = 31,
		[PRI_PROTO_T1] = 24,
		[PRI_PROTO_J1] = 0
	};
	return num_channels[pri_protocol];
}

static const char *type_name(enum pri_protocol pri_protocol)
{
	static const char *names[4] = {
		[PRI_PROTO_0] = "PRI-Unknown",
		[PRI_PROTO_E1] = "E1",
		[PRI_PROTO_T1] = "T1",
		[PRI_PROTO_J1] = "J1"
	};

	return names[pri_protocol];
}

static int pri_linecompat(enum pri_protocol pri_protocol)
{
	static const int linecompat[] = {
		[PRI_PROTO_0] = 0,
		[PRI_PROTO_E1] =
		    /* coding */
		    DAHDI_CONFIG_CCS | DAHDI_CONFIG_CRC4 |
		    /* framing */
		    DAHDI_CONFIG_AMI | DAHDI_CONFIG_HDB3,
		[PRI_PROTO_T1] =
		    /* coding */
		    DAHDI_CONFIG_D4 | DAHDI_CONFIG_ESF |
		    /* framing */
		    DAHDI_CONFIG_AMI | DAHDI_CONFIG_B8ZS,
		[PRI_PROTO_J1] = 0
	};

	DBG(GENERAL, "pri_linecompat: pri_protocol=%d\n", pri_protocol);
	return linecompat[pri_protocol];
}

#define	PRI_DCHAN_IDX(priv)	((priv)->dchan_num - 1)

enum pri_led_state {
	PRI_LED_OFF = 0x0,
	PRI_LED_ON = 0x1,
	/*
	 * We blink by software from driver, so that
	 * if the driver malfunction that blink would stop.
	 */
	// PRI_LED_BLINK_SLOW   = 0x2,  /* 1/2 a second blink cycle */
	// PRI_LED_BLINK_FAST   = 0x3   /* 1/4 a second blink cycle */
};

enum pri_led_selectors {
	BOTTOM_RED_LED = 0,
	BOTTOM_GREEN_LED = 1,
	TOP_RED_LED = 2,
	TOP_GREEN_LED = 3,
};

#define	NUM_LEDS	4

struct pri_leds {
	__u8 state:2;		/* enum pri_led_state */
	__u8 led_sel:2;		/* enum pri_led_selectors */
	__u8 reserved:4;
};

#define	REG_CCB1_T	0x2F	/* Clear Channel Register 1 */

#define	REG_FRS0	0x4C	/* Framer Receive Status Register 0 */
#define	REG_FRS0_T1_FSR	BIT(0)	/* T1 - Frame Search Restart Flag */
#define	REG_FRS0_LMFA	BIT(1)	/* Loss of Multiframe Alignment */
#define	REG_FRS0_E1_NMF	BIT(2)	/* E1 - No Multiframe Alignment Found */
#define	REG_FRS0_RRA	BIT(4)	/* Receive Remote Alarm: T1-YELLOW-Alarm */
#define	REG_FRS0_LFA	BIT(5)	/* Loss of Frame Alignment */
#define	REG_FRS0_AIS	BIT(6)	/* Alarm Indication Signal: T1-BLUE-Alarm */
#define	REG_FRS0_LOS	BIT(7)	/* Los Of Signal: T1-RED-Alarm */

#define	REG_FRS1	0x4D	/* Framer Receive Status Register 1 */

#define	REG_LIM0	0x36
/*
 * Master Mode, DCO-R circuitry is frequency synchronized
 * to the clock supplied by SYNC
 */
#define	REG_LIM0_MAS	BIT(0)
/*
 * Receive Termination Resistance Selection:
 * integrated resistor to create 75 Ohm termination (100 || 300 = 75)
 * 0 = 100 Ohm
 * 1 = 75 Ohm
 */
#define	REG_LIM0_RTRS	BIT(5)
#define	REG_LIM0_LL	BIT(1)	/* LL (Local Loopback) */

#define	REG_FMR0	0x1C
#define	REG_FMR0_E_RC0	BIT(4)	/* Receive Code - LSB */
#define	REG_FMR0_E_RC1	BIT(5)	/* Receive Code - MSB */
#define	REG_FMR0_E_XC0	BIT(6)	/* Transmit Code - LSB */
#define	REG_FMR0_E_XC1	BIT(7)	/* Transmit Code - MSB */

#define	REG_FMR1	0x1D
#define	REG_FMR1_XAIS	BIT(0)	/* Transmit AIS toward transmit end */
#define	REG_FMR1_SSD0	BIT(1)
#define	REG_FMR1_ECM	BIT(2)
#define	REG_FMR1_T_CRC	BIT(3)	/* Enable CRC6 */
#define	REG_FMR1_E_XFS	BIT(3)	/* Transmit Framing Select */
#define	REG_FMR1_PMOD	BIT(4)	/* E1 = 0, T1/J1 = 1 */
#define	REG_FMR1_EDL	BIT(5)
#define	REG_FMR1_AFR	BIT(6)

#define	REG_FMR2	0x1E
#define	REG_FMR2_E_ALMF	BIT(0)	/* Automatic Loss of Multiframe */
#define	REG_FMR2_T_EXZE	BIT(0)	/* Excessive Zeros Detection Enable */
#define	REG_FMR2_E_AXRA	BIT(1)	/* Automatic Transmit Remote Alarm */
#define	REG_FMR2_T_AXRA	BIT(1)	/* Automatic Transmit Remote Alarm */
#define	REG_FMR2_E_PLB	BIT(2)	/* Payload Loop-Back */
#define	REG_FMR2_E_RFS0	BIT(6)	/* Receive Framing Select - LSB */
#define	REG_FMR2_E_RFS1	BIT(7)	/* Receive Framing Select - MSB */
/* Select Synchronization/Resynchronization Procedure */
#define	REG_FMR2_T_SSP	BIT(5)
/* Multiple Candidates Synchronization Procedure */
#define	REG_FMR2_T_MCSP	BIT(6)
/* Automatic Force Resynchronization */
#define	REG_FMR2_T_AFRS	BIT(7)

#define	REG_FMR3	0x31
#define	REG_FMR3_EXTIW	BIT(0)	/* Extended CRC4 to Non-CRC4 Interworking */

#define	REG_FMR4	0x20
#define	REG_FMR4_FM0	BIT(0)
#define	REG_FMR4_FM1	BIT(1)
#define	REG_FMR4_AUTO	BIT(2)
#define	REG_FMR4_SSC0	BIT(3)
#define	REG_FMR4_SSC1	BIT(4)
#define	REG_FMR4_XRA	BIT(5)	/* Transmit Remote Alarm (Yellow Alarm) */
#define	REG_FMR4_TM	BIT(6)
#define	REG_FMR4_AIS3	BIT(7)

#define	REG_XSW_E	0x20
#define	REG_XSW_E_XY4	BIT(0)
#define	REG_XSW_E_XY3	BIT(1)
#define	REG_XSW_E_XY2	BIT(2)
#define	REG_XSW_E_XY1	BIT(3)
#define	REG_XSW_E_XY0	BIT(4)
#define	REG_XSW_E_XRA	BIT(5)	/* Transmit Remote Alarm (Yellow Alarm) */
#define	REG_XSW_E_XTM	BIT(6)
#define	REG_XSW_E_XSIS	BIT(7)

#define REG_XSP_E	0x21
#define REG_FMR5_T	0x21
/* Transmit Spare Bit For International Use (FAS Word)  */
#define	REG_XSP_E_XSIF	BIT(2)
#define	REG_FMR5_T_XTM	BIT(2)	/* Transmit Transparent Mode  */
/* Automatic Transmission of Submultiframe Status  */
#define	REG_XSP_E_AXS	BIT(3)
/* E-Bit Polarity, Si-bit position of every outgoing CRC multiframe  */
#define	REG_XSP_E_EBP	BIT(4)
#define	REG_XSP_E_CASEN	BIT(6)	/* CAS: Channel Associated Signaling Enable  */
#define	REG_FMR5_T_EIBR	BIT(6)	/* CAS: Enable Internal Bit Robbing Access   */

#define REG_XC0_T	0x22	/* Transmit Control 0 */
#define REG_XC0_BRIF	BIT(5)	/* Bit Robbing Idle Function */

#define REG_CMDR_E	0x02	/* Command Register */
#define REG_CMDR_RRES	BIT(6)	/* Receiver    reset */
#define REG_CMDR_XRES	BIT(4)	/* Transmitter reset */

#define	REG_RC0		0x24
#define	REG_RC0_SJR	BIT(7)	/* T1 = 0, J1 = 1 */

#define	REG_CMR1	0x44
#define	REG_CMR1_DRSS	(BIT(7) | BIT(6))
#define	REG_CMR1_RS	(BIT(5) | BIT(4))
#define	REG_CMR1_STF	BIT(2)

#define	REG_RS1_E	0x70	/* Receive CAS Register 1       */
#define	REG_RS2_E	0x71	/* Receive CAS Register 2       */
#define	REG_RS3_E	0x72	/* Receive CAS Register 3       */
#define	REG_RS4_E	0x73	/* Receive CAS Register 4       */
#define	REG_RS5_E	0x74	/* Receive CAS Register 5       */
#define	REG_RS6_E	0x75	/* Receive CAS Register 6       */
#define	REG_RS7_E	0x76	/* Receive CAS Register 7       */
#define	REG_RS8_E	0x77	/* Receive CAS Register 8       */
#define	REG_RS9_E	0x78	/* Receive CAS Register 9       */
#define	REG_RS10_E	0x79	/* Receive CAS Register 10      */
#define	REG_RS11_E	0x7A	/* Receive CAS Register 11      */
#define	REG_RS12_E	0x7B	/* Receive CAS Register 12      */
#define	REG_RS13_E	0x7C	/* Receive CAS Register 13      */
#define	REG_RS14_E	0x7D	/* Receive CAS Register 14      */
#define	REG_RS15_E	0x7E	/* Receive CAS Register 15      */
#define	REG_RS16_E	0x7F	/* Receive CAS Register 16      */

#define	REG_PC2		0x81	/* Port Configuration 2 */
#define	REG_PC3		0x82	/* Port Configuration 3 */
#define	REG_PC4		0x83	/* Port Configuration 4 */

#define	REG_XPM2	0x28	/* Transmit Pulse Mask 2 */

#define	VAL_PC_SYPR	0x00	/* Synchronous Pulse Receive (Input, low active) */
#define	VAL_PC_GPI	0x90	/* General purpose input */
#define	VAL_PC_GPOH	0x0A	/* General Purpose Output, high level */
#define	VAL_PC_GPOL	0x0B	/* General Purpose Output, low level */

#define	NUM_CAS_RS_E	(REG_RS16_E - REG_RS2_E + 1)
/* and of those, the ones used in T1: */
#define	NUM_CAS_RS_T	(REG_RS12_E - REG_RS1_E + 1)

struct PRI_priv_data {
	bool clock_source;
	enum pri_protocol pri_protocol;
	xpp_line_t rbslines;
	int deflaw;
	unsigned int dchan_num;
	bool initialized;
	int is_cas;

	unsigned int chanconfig_dchan;
#define	NO_DCHAN	(0)
#define	DCHAN(p)	((p)->chanconfig_dchan)
#define	VALID_DCHAN(p)	(DCHAN(p) != NO_DCHAN)
#define	SET_DCHAN(p, d)	do { DCHAN(p) = (d); } while (0);

	__u8 cas_rs_e[NUM_CAS_RS_E];
	__u8 cas_ts_e[NUM_CAS_RS_E];
	uint cas_replies;
	bool is_esf;
	bool local_loopback;
	uint poll_noreplies;
	uint layer1_replies;
	__u8 reg_frs0;
	__u8 reg_frs1;
	bool layer1_up;
	int alarms;
	__u8 dchan_tx_sample;
	__u8 dchan_rx_sample;
	uint dchan_tx_counter;
	uint dchan_rx_counter;
	bool dchan_alive;
	uint dchan_alive_ticks;
	enum pri_led_state ledstate[NUM_LEDS];
};

static xproto_table_t PROTO_TABLE(PRI);

DEF_RPACKET_DATA(PRI, SET_LED,	/* Set one of the LED's */
		 struct pri_leds pri_leds;);

static /* 0x33 */ DECLARE_CMD(PRI, SET_LED, enum pri_led_selectors led_sel,
			      enum pri_led_state to_led_state);

#define	DO_LED(xpd, which, tostate)	\
		CALL_PROTO(PRI, SET_LED, (xpd)->xbus, (xpd), (which), (tostate))

/*---------------- PRI: Methods -------------------------------------------*/

static int query_subunit(xpd_t *xpd, __u8 regnum)
{
	XPD_DBG(REGS, xpd, "(%d%d): REG=0x%02X\n", xpd->addr.unit,
		xpd->addr.subunit, regnum);
	return xpp_register_request(xpd->xbus, xpd, PRI_PORT(xpd),	/* portno       */
				    0,	/* writing      */
				    regnum, 0,	/* do_subreg    */
				    0,	/* subreg       */
				    0,	/* data_L       */
				    0,	/* do_datah     */
				    0,	/* data_H       */
				    0	/* should_reply */
	    );
}

static int write_subunit(xpd_t *xpd, __u8 regnum, __u8 val)
{
	XPD_DBG(REGS, xpd, "(%d%d): REG=0x%02X dataL=0x%02X\n", xpd->addr.unit,
		xpd->addr.subunit, regnum, val);
	return xpp_register_request(xpd->xbus, xpd,
			PRI_PORT(xpd),	/* portno       */
			1,		/* writing      */
			regnum, 0,	/* do_subreg    */
			0,		/* subreg       */
			val,		/* data_L       */
			0,		/* do_datah     */
			0,		/* data_H       */
			0		/* should_reply */
	    );
}

static int pri_write_reg(xpd_t *xpd, int regnum, __u8 val)
{
	XPD_DBG(REGS, xpd, "(%d%d): REG=0x%02X dataL=0x%02X\n", xpd->addr.unit,
		xpd->addr.subunit, regnum, val);
	return xpp_register_request(xpd->xbus, xpd, 0,	/* portno=0     */
				    1,	/* writing      */
				    regnum, 0,	/* do_subreg    */
				    0,	/* subreg       */
				    val,	/* data_L       */
				    0,	/* do_datah     */
				    0,	/* data_H       */
				    0	/* should_reply */
	    );
}

static int cas_regbase(xpd_t *xpd)
{
	struct PRI_priv_data *priv;

	priv = xpd->priv;
	switch (priv->pri_protocol) {
	case PRI_PROTO_E1:
		return REG_RS2_E;
	case PRI_PROTO_T1:
		/* fall-through */
	case PRI_PROTO_J1:
		return REG_RS1_E;
	case PRI_PROTO_0:
		/* fall-through */
		;
	}
	BUG();
	return 0;
}

static int cas_numregs(xpd_t *xpd)
{
	struct PRI_priv_data *priv;

	priv = xpd->priv;
	switch (priv->pri_protocol) {
	case PRI_PROTO_E1:
		return NUM_CAS_RS_E;
	case PRI_PROTO_T1:
		/* fall-through */
	case PRI_PROTO_J1:
		return NUM_CAS_RS_T;
	case PRI_PROTO_0:
		/* fall-through */
		;
	}
	BUG();
	return 0;
}

static int write_cas_reg(xpd_t *xpd, int rsnum, __u8 val)
{
	struct PRI_priv_data *priv;
	int regbase = cas_regbase(xpd);
	int num_cas_rs = cas_numregs(xpd);
	int regnum;
	bool is_d4 = 0;

	BUG_ON(!xpd);
	priv = xpd->priv;
	if ((priv->pri_protocol == PRI_PROTO_T1) && !priv->is_esf) {
		/* same data should be copied to RS7..12 in D4 only */
		is_d4 = 1;
	}
	if (rsnum < 0 || rsnum >= num_cas_rs) {
		XPD_ERR(xpd, "RBS(TX): rsnum=%d\n", rsnum);
		BUG();
	}
	regnum = regbase + rsnum;
	priv->cas_ts_e[rsnum] = val;
	XPD_DBG(SIGNAL, xpd, "RBS(TX): reg=0x%X val=0x%02X\n", regnum, val);
	write_subunit(xpd, regbase + rsnum, val);
	if (is_d4) {
		/* same data should be copied to RS7..12 in D4 only */
		regnum = REG_RS7_E + rsnum;
		XPD_DBG(SIGNAL, xpd, "RBS(TX): reg=0x%X val=0x%02X\n", regnum,
			val);
		write_subunit(xpd, regnum, val);
	}
	return 0;
}

static bool valid_pri_modes(const xpd_t *xpd)
{
	struct PRI_priv_data *priv;

	BUG_ON(!xpd);
	priv = xpd->priv;
	if (priv->pri_protocol != PRI_PROTO_E1
	    && priv->pri_protocol != PRI_PROTO_T1
	    && priv->pri_protocol != PRI_PROTO_J1)
		return 0;
	return 1;
}

static void PRI_card_pcm_recompute(xpd_t *xpd, xpp_line_t pcm_mask)
{
	struct PRI_priv_data *priv;
	int i;
	int line_count = 0;
	unsigned long flags;
	uint pcm_len;

	BUG_ON(!xpd);
	priv = xpd->priv;
	spin_lock_irqsave(&PHONEDEV(xpd).lock_recompute_pcm, flags);
	//XPD_DBG(SIGNAL, xpd, "pcm_mask=0x%X\n", pcm_mask);
	/* Add/remove all the trivial cases */
	pcm_mask |= PHONEDEV(xpd).offhook_state;
	for_each_line(xpd, i)
	    if (IS_SET(pcm_mask, i))
		line_count++;
	if (priv->is_cas) {
		if (priv->pri_protocol == PRI_PROTO_E1) {
			/* CAS: Don't send PCM to D-Channel */
			line_count--;
			pcm_mask &= ~BIT(PRI_DCHAN_IDX(priv));
		}
	}
	/*
	 * FIXME: Workaround a bug in sync code of the Astribank.
	 *        Send dummy PCM for sync.
	 */
	if (xpd->addr.unit == 0 && pcm_mask == 0) {
		pcm_mask = BIT(0);
		line_count = 1;
	}
	pcm_len = (line_count)
	    ? RPACKET_HEADERSIZE + sizeof(xpp_line_t) +
	    line_count * DAHDI_CHUNKSIZE : 0L;
	update_wanted_pcm_mask(xpd, pcm_mask, pcm_len);
	spin_unlock_irqrestore(&PHONEDEV(xpd).lock_recompute_pcm, flags);
}

/*
 * Set E1/T1/J1
 * May only be called on unregistered xpd's
 * (the span and channel description are set according to this)
 */
static int set_pri_proto(xpd_t *xpd, enum pri_protocol set_proto)
{
	struct PRI_priv_data *priv;
	int deflaw;
	unsigned int dchan_num;
	int default_lineconfig = 0;
	int ret;
	struct phonedev *phonedev;

	BUG_ON(!xpd);
	priv = xpd->priv;
	phonedev = &PHONEDEV(xpd);
	if (test_bit(DAHDI_FLAGBIT_REGISTERED, &phonedev->span.flags)) {
		XPD_NOTICE(xpd, "%s: %s already assigned as span %d\n",
			   __func__, phonedev->span.name,
			   phonedev->span.spanno);
		return -EBUSY;
	}
	if (priv->pri_protocol != PRI_PROTO_0) {
		if (priv->pri_protocol == set_proto) {
			XPD_NOTICE(xpd, "Already in protocol %s. Ignored\n",
				   pri_protocol_name(set_proto));
			return 0;
		} else {
			XPD_INFO(xpd, "Switching from %s to %s\n",
				 pri_protocol_name(priv->pri_protocol),
				 pri_protocol_name(set_proto));
		}
	}
	switch (set_proto) {
	case PRI_PROTO_E1:
		deflaw = DAHDI_LAW_ALAW;
		dchan_num = 16;
		default_lineconfig =
		    DAHDI_CONFIG_CCS | DAHDI_CONFIG_CRC4 | DAHDI_CONFIG_HDB3;
		break;
	case PRI_PROTO_T1:
		deflaw = DAHDI_LAW_MULAW;
		dchan_num = 24;
		default_lineconfig = DAHDI_CONFIG_ESF | DAHDI_CONFIG_B8ZS;
		break;
	case PRI_PROTO_J1:
		/*
		 * Check all assumptions
		 */
		deflaw = DAHDI_LAW_MULAW;
		dchan_num = 24;
		default_lineconfig = 0;	/* FIXME: J1??? */
		XPD_NOTICE(xpd, "J1 is not supported yet\n");
		return -ENOSYS;
	default:
		XPD_ERR(xpd, "%s: Unknown pri protocol = %d\n", __func__,
			set_proto);
		return -EINVAL;
	}
	priv->pri_protocol = set_proto;
	priv->is_cas = -1;
	phonedev->channels = pri_num_channels(set_proto);
	phonedev->offhook_state = BITMASK(phonedev->channels);
	CALL_PHONE_METHOD(card_pcm_recompute, xpd, 0);
	priv->deflaw = deflaw;
	priv->dchan_num = dchan_num;
	priv->local_loopback = 0;
	xpd->type_name = type_name(priv->pri_protocol);
	XPD_DBG(GENERAL, xpd, "%s, channels=%d, dchan_num=%d, deflaw=%d\n",
		pri_protocol_name(set_proto), phonedev->channels,
		priv->dchan_num, priv->deflaw);
	/*
	 * Must set default now, so layer1 polling (Register REG_FRS0) would
	 * give reliable results.
	 */
	ret = pri_lineconfig(xpd, default_lineconfig);
	if (ret) {
		XPD_NOTICE(xpd, "Failed setting PRI default line config\n");
		return ret;
	}
	return apply_pri_protocol(xpd);
}

static void dahdi_update_syncsrc(xpd_t *xpd)
{
	struct PRI_priv_data *priv;
	xpd_t *subxpd;
	int best_spanno = 0;
	int i;

	if (!SPAN_REGISTERED(xpd))
		return;
	for (i = 0; i < MAX_SLAVES; i++) {
		subxpd = xpd_byaddr(xpd->xbus, xpd->addr.unit, i);
		if (!subxpd)
			continue;
		priv = subxpd->priv;
		if (priv->clock_source && priv->alarms == 0) {
			if (best_spanno)
				XPD_ERR(xpd,
					"Duplicate XPD with clock_source=1\n");
			best_spanno = PHONEDEV(subxpd).span.spanno;
		}
	}
	for (i = 0; i < MAX_SLAVES; i++) {
		subxpd = xpd_byaddr(xpd->xbus, xpd->addr.unit, i);
		if (!subxpd)
			continue;
		if (PHONEDEV(subxpd).span.syncsrc == best_spanno)
			XPD_DBG(SYNC, xpd, "Setting SyncSource to span %d\n",
				best_spanno);
		else
			XPD_DBG(SYNC, xpd, "Slaving to span %d\n", best_spanno);
		PHONEDEV(subxpd).span.syncsrc = best_spanno;
	}
}

/*
 * Called from:
 *   - set_master_mode() --
 *       As a result of dahdi_cfg
 *   - layer1_state() --
 *       As a result of an alarm.
 */
static void set_clocking(xpd_t *xpd)
{
	xbus_t *xbus;
	xpd_t *best_xpd = NULL;
	int best_subunit = -1;	/* invalid */
	unsigned int best_subunit_prio = INT_MAX;
	int i;

	xbus = xpd->xbus;
	/* Find subunit with best timing priority */
	for (i = 0; i < MAX_SLAVES; i++) {
		struct PRI_priv_data *priv;
		xpd_t *subxpd;

		subxpd = xpd_byaddr(xbus, xpd->addr.unit, i);
		if (!subxpd)
			continue;
		priv = subxpd->priv;
		if (priv->alarms != 0)
			continue;
		if (PHONEDEV(subxpd).timing_priority > 0
		    && PHONEDEV(subxpd).timing_priority < best_subunit_prio) {
			best_xpd = subxpd;
			best_subunit = i;
			best_subunit_prio = PHONEDEV(subxpd).timing_priority;
		}
	}
	/* Now set it */
	if (best_xpd
	    && ((struct PRI_priv_data *)(best_xpd->priv))->clock_source == 0) {
		__u8 reg_pc_init[] = { VAL_PC_GPI, VAL_PC_GPI, VAL_PC_GPI };

		for (i = 0; i < ARRAY_SIZE(reg_pc_init); i++) {
			__u8 reg_pc = reg_pc_init[i];

			reg_pc |=
			    (best_subunit & (1 << i)) ? VAL_PC_GPOH :
			    VAL_PC_GPOL;
			XPD_DBG(SYNC, best_xpd,
				"ClockSource Set: PC%d=0x%02X\n", 2 + i,
				reg_pc);
			pri_write_reg(xpd, REG_PC2 + i, reg_pc);
		}
		((struct PRI_priv_data *)(best_xpd->priv))->clock_source = 1;
	}
	/* clear old clock sources */
	for (i = 0; i < MAX_SLAVES; i++) {
		struct PRI_priv_data *priv;
		xpd_t *subxpd;

		subxpd = xpd_byaddr(xbus, xpd->addr.unit, i);
		if (subxpd && subxpd != best_xpd) {
			XPD_DBG(SYNC, subxpd, "Clearing clock source\n");
			priv = subxpd->priv;
			priv->clock_source = 0;
		}
	}
	dahdi_update_syncsrc(xpd);
}

static void set_reg_lim0(const char *msg, xpd_t *xpd)
{
	struct PRI_priv_data *priv;
	bool is_master_mode;
	bool localloop;
	__u8 lim0 = 0;

	BUG_ON(!xpd);
	priv = xpd->priv;
	BUG_ON(!priv);
	is_master_mode = PHONEDEV(xpd).timing_priority == 0;
	localloop = priv->local_loopback;
	lim0 |= (localloop) ? REG_LIM0_LL : 0;
	if (is_master_mode)
		lim0 |= REG_LIM0_MAS;
	else
		lim0 &= ~REG_LIM0_MAS;
	XPD_DBG(SIGNAL, xpd, "%s(%s): %s, %s\n", __func__, msg,
		(is_master_mode) ? "MASTER" : "SLAVE",
		(localloop) ? "LOCALLOOP" : "NO_LOCALLOOP");
	write_subunit(xpd, REG_LIM0, lim0);
}

/*
 * Normally set by the timing parameter in /etc/dahdi/system.conf
 * If this is called by dahdi_cfg, than it's too late to change
 * dahdi sync priority (we are already registered)
 *
 * Also called from set_localloop()
 */
static int set_master_mode(const char *msg, xpd_t *xpd)
{
	BUG_ON(!xpd);
	XPD_DBG(SIGNAL, xpd, "\n");
	set_reg_lim0(__func__, xpd);
	set_clocking(xpd);
	return 0;
}

static int set_localloop(xpd_t *xpd, bool localloop)
{
	struct PRI_priv_data *priv;

	BUG_ON(!xpd);
	priv = xpd->priv;
	if (SPAN_REGISTERED(xpd)) {
		XPD_NOTICE(xpd, "Registered as span %d. Cannot do %s\n",
			   PHONEDEV(xpd).span.spanno, __func__);
		return -EBUSY;
	}
	priv->local_loopback = localloop;
	XPD_DBG(SIGNAL, xpd, "%s: %s\n", __func__,
		(localloop) ? "LOCALLOOP" : "NO");
	set_master_mode(__func__, xpd);
	return 0;
}

#define	VALID_CONFIG(bit, flg, str)	[bit] = { .flags = flg, .name = str }

static const struct {
	const char *name;
	const int flags;
} valid_spanconfigs[sizeof(unsigned int) * 8] = {
	/* These apply to T1 */
	VALID_CONFIG(4, DAHDI_CONFIG_D4, "D4"),
	VALID_CONFIG(5, DAHDI_CONFIG_ESF, "ESF"),
	VALID_CONFIG(6, DAHDI_CONFIG_AMI, "AMI"),
	VALID_CONFIG(7, DAHDI_CONFIG_B8ZS, "B8ZS"),
	/* These apply to E1 */
	VALID_CONFIG(8, DAHDI_CONFIG_CCS, "CCS"),
	VALID_CONFIG(9, DAHDI_CONFIG_HDB3, "HDB3"),
	VALID_CONFIG(10, DAHDI_CONFIG_CRC4, "CRC4"),
};

/*
 * Mark the lines as CLEAR or RBS signalling.
 * With T1, we need to mark the CLEAR lines on the REG_CCB1_T registers
 * Should be called only when we are registered to DAHDI
 * The channo parameter:
 *	channo == 0: set lines for the whole span
 *	channo != 0: only set modified lines
 */
static void set_rbslines(xpd_t *xpd, int channo)
{
	struct PRI_priv_data *priv;
	xpp_line_t new_rbslines = 0;
	xpp_line_t modified_lines;
	int i;

	priv = xpd->priv;
	for_each_line(xpd, i) {
		struct dahdi_chan *chan = XPD_CHAN(xpd, i);

		if (chan->flags & DAHDI_FLAG_CLEAR)
			BIT_CLR(new_rbslines, i);
		else
			BIT_SET(new_rbslines, i);
	}
	new_rbslines &= BITMASK(PHONEDEV(xpd).channels);
	modified_lines = priv->rbslines ^ new_rbslines;
	XPD_DBG(DEVICES, xpd, "RBSLINES-%d(%s): 0x%X\n", channo,
		pri_protocol_name(priv->pri_protocol), new_rbslines);
	if ((priv->pri_protocol == PRI_PROTO_T1)
	    || (priv->pri_protocol == PRI_PROTO_J1)) {
		__u8 clear_lines = 0;	/* Mark clear lines */
		bool reg_changed = 0;

		for_each_line(xpd, i) {
			int bytenum = i / 8;
			int bitnum = i % 8;

			if (!IS_SET(new_rbslines, i)) {
				BIT_SET(clear_lines, (7 - bitnum));
			}
			if (IS_SET(modified_lines, i))
				reg_changed = 1;
			if (bitnum == 7) {
				if (channo == 0 || reg_changed) {
					bytenum += REG_CCB1_T;
					XPD_DBG(DEVICES, xpd,
						"RBS(%s): modified=0x%X rbslines=0x%X reg=0x%X clear_lines=0x%X\n",
						pri_protocol_name(priv->pri_protocol),
						modified_lines, new_rbslines,
						bytenum, clear_lines);
					write_subunit(xpd, bytenum, clear_lines);
				}
				clear_lines = 0;
				reg_changed = 0;
			}
		}
	}
	priv->rbslines = new_rbslines;
}

static int set_mode_cas(xpd_t *xpd, bool want_cas)
{
	struct PRI_priv_data *priv;

	priv = xpd->priv;
	XPD_INFO(xpd, "Setting TDM to %s\n", (want_cas) ? "CAS" : "PRI");
	if (want_cas) {
		priv->is_cas = 1;
		priv->dchan_alive = 0;
	} else {
		priv->is_cas = 0;
	}
	return 0;
}

static int pri_lineconfig(xpd_t *xpd, int lineconfig)
{
	struct PRI_priv_data *priv;
	const char *framingstr = "";
	const char *codingstr = "";
	const char *crcstr = "";
#ifdef JAPANEZE_SUPPORT
	__u8 rc0 = 0;		/* FIXME: PCM offsets */
#endif
	__u8 fmr0 = 0;
	__u8 fmr1 = REG_FMR1_ECM;
	__u8 fmr2 = 0;
	__u8 fmr3 = 0;		/* write only for CRC4 */
	__u8 fmr4 = 0;
	__u8 cmdr = REG_CMDR_RRES | REG_CMDR_XRES;
	__u8 xsp = 0;
	unsigned int bad_bits;
	bool force_cas = 0;
	int i;

	BUG_ON(!xpd);
	priv = xpd->priv;
	/*
	 * validate
	 */
	bad_bits = lineconfig & pri_linecompat(priv->pri_protocol);
	bad_bits = bad_bits ^ lineconfig;
	for (i = 0; i < ARRAY_SIZE(valid_spanconfigs); i++) {
		unsigned int flags = valid_spanconfigs[i].flags;

		if (bad_bits & BIT(i)) {
			if (flags) {
				XPD_ERR(xpd,
					"Bad config item '%s' for %s. Ignore\n",
					valid_spanconfigs[i].name,
					pri_protocol_name(priv->pri_protocol));
			} else {
				/* we got real garbage */
				XPD_ERR(xpd,
					"Unknown config item 0x%lX for %s. "
					"Ignore.\n",
					BIT(i),
					pri_protocol_name(priv->pri_protocol));
			}
		}
		if (flags && flags != BIT(i)) {
			ERR("%s: BUG: i=%d flags=0x%X\n", __func__, i, flags);
			// BUG();
		}
	}
	if (bad_bits)
		goto bad_lineconfig;
	if (priv->pri_protocol == PRI_PROTO_E1) {
		fmr1 |= REG_FMR1_AFR;
		fmr2 = REG_FMR2_E_AXRA | REG_FMR2_E_ALMF;	/* 0x03 */
		fmr4 = 0x9F;	/*  E1.XSW:  All spare bits = 1 */
		xsp |= REG_XSP_E_EBP | REG_XSP_E_AXS | REG_XSP_E_XSIF;
	} else if (priv->pri_protocol == PRI_PROTO_T1) {
		fmr1 |= REG_FMR1_PMOD | REG_FMR1_T_CRC;
		fmr2 = REG_FMR2_T_SSP | REG_FMR2_T_AXRA;	/* 0x22 */
		fmr4 = 0x0C;
		xsp &= ~REG_FMR5_T_XTM;
		force_cas = 1;	/* T1 - Chip always in CAS mode */
	} else if (priv->pri_protocol == PRI_PROTO_J1) {
		fmr1 |= REG_FMR1_PMOD;
		fmr4 = 0x1C;
		xsp &= ~REG_FMR5_T_XTM;
		force_cas = 1;	/* T1 - Chip always in CAS mode */
		XPD_ERR(xpd, "J1 unsupported yet\n");
		return -ENOSYS;
	}
	if (priv->local_loopback)
		fmr2 |= REG_FMR2_E_PLB;
	/* framing first */
	if (lineconfig & DAHDI_CONFIG_B8ZS) {
		framingstr = "B8ZS";
		fmr0 =
		    REG_FMR0_E_XC1 | REG_FMR0_E_XC0 | REG_FMR0_E_RC1 |
		    REG_FMR0_E_RC0;
	} else if (lineconfig & DAHDI_CONFIG_AMI) {
		framingstr = "AMI";
		fmr0 = REG_FMR0_E_XC1 | REG_FMR0_E_RC1;
		/*
		 * From Infineon Errata Sheet: PEF 22554, Version 3.1
		 * Problem: Incorrect CAS Receiption when
		 *          using AMI receive line code
		 * Workaround: For E1,
		 *               "...The receive line coding HDB3 is
		 *                recommended instead."
		 *             For T1,
		 *               "...in T1 mode it is recommended to
		 *                configure the Rx side to B8ZS coding"
		 * For both cases this is the same bit in FMR0
		 */
		if (priv->pri_protocol == PRI_PROTO_J1)
			XPD_NOTICE(xpd, "J1 is not supported yet\n");
		else
			fmr0 |= REG_FMR0_E_RC0;
	} else if (lineconfig & DAHDI_CONFIG_HDB3) {
		framingstr = "HDB3";
		fmr0 =
		    REG_FMR0_E_XC1 | REG_FMR0_E_XC0 | REG_FMR0_E_RC1 |
		    REG_FMR0_E_RC0;
	} else {
		XPD_NOTICE(xpd,
			   "Bad lineconfig. Not (B8ZS|AMI|HDB3). Ignored.\n");
		return -EINVAL;
	}
	/* then coding */
	priv->is_esf = 0;
	if (lineconfig & DAHDI_CONFIG_ESF) {
		codingstr = "ESF";
		fmr4 |= REG_FMR4_FM1;
		fmr2 |= REG_FMR2_T_AXRA | REG_FMR2_T_MCSP | REG_FMR2_T_SSP;
		priv->is_esf = 1;
	} else if (lineconfig & DAHDI_CONFIG_D4) {
		codingstr = "D4";
	} else if (lineconfig & DAHDI_CONFIG_CCS) {
		codingstr = "CCS";
		/* In E1 we know right from the span statement. */
		set_mode_cas(xpd, 0);
	} else {
		/* In E1 we know right from the span statement. */
		codingstr = "CAS";
		force_cas = 1;
		set_mode_cas(xpd, 1);
	}
	CALL_PHONE_METHOD(card_pcm_recompute, xpd, 0);
	/*
	 * E1's can enable CRC checking
	 * CRC4 is legal only for E1, and it is checked by pri_linecompat()
	 * in the beginning of the function.
	 */
	if (lineconfig & DAHDI_CONFIG_CRC4) {
		crcstr = "CRC4";
		fmr1 |= REG_FMR1_E_XFS;
		fmr2 |= REG_FMR2_E_RFS1;
		fmr3 |= REG_FMR3_EXTIW;
	}
	XPD_DBG(GENERAL, xpd, "[%s] lineconfig=%s/%s/%s %s (0x%X)\n",
		(priv->clock_source) ? "MASTER" : "SLAVE", framingstr,
		codingstr, crcstr,
		(lineconfig & DAHDI_CONFIG_NOTOPEN) ? "YELLOW" : "",
		lineconfig);
	set_reg_lim0(__func__, xpd);
	XPD_DBG(GENERAL, xpd, "%s: fmr1(0x%02X) = 0x%02X\n", __func__, REG_FMR1,
		fmr1);
	write_subunit(xpd, REG_FMR1, fmr1);
	XPD_DBG(GENERAL, xpd, "%s: fmr2(0x%02X) = 0x%02X\n", __func__, REG_FMR2,
		fmr2);
	write_subunit(xpd, REG_FMR2, fmr2);
	XPD_DBG(GENERAL, xpd, "%s: fmr0(0x%02X) = 0x%02X\n", __func__, REG_FMR0,
		fmr0);
	write_subunit(xpd, REG_FMR0, fmr0);
	XPD_DBG(GENERAL, xpd, "%s: fmr4(0x%02X) = 0x%02X\n", __func__, REG_FMR4,
		fmr4);
	write_subunit(xpd, REG_FMR4, fmr4);
	if (fmr3) {
		XPD_DBG(GENERAL, xpd, "%s: fmr3(0x%02X) = 0x%02X\n", __func__,
			REG_FMR3, fmr3);
		write_subunit(xpd, REG_FMR3, fmr3);
	}
	XPD_DBG(GENERAL, xpd, "%s: cmdr(0x%02X) = 0x%02X\n", __func__,
		REG_CMDR_E, cmdr);
	write_subunit(xpd, REG_CMDR_E, cmdr);
#ifdef JAPANEZE_SUPPORT
	if (rc0) {
		XPD_DBG(GENERAL, xpd, "%s: rc0(0x%02X) = 0x%02X\n", __func__,
			REG_RC0, rc0);
		write_subunit(xpd, REG_RC0, rc0);
	}
#endif
	if (force_cas) {
		if (priv->pri_protocol == PRI_PROTO_E1) {
			int rs1 = 0x0B;

			/*
			 * Set correct X1-X3 bits in the E1 CAS MFAS
			 * They are unused in E1 and should be 1
			 */
			XPD_DBG(GENERAL, xpd, "%s: rs1(0x%02X) = 0x%02X\n",
				__func__, REG_RS1_E, rs1);
			write_subunit(xpd, REG_RS1_E, rs1);
		}
		xsp |= REG_XSP_E_CASEN;	/* Same as REG_FMR5_T_EIBR for T1 */
	}
	XPD_DBG(GENERAL, xpd, "%s: xsp(0x%02X) = 0x%02X\n", __func__, REG_XSP_E,
		xsp);
	write_subunit(xpd, REG_XSP_E, xsp);
	return 0;
bad_lineconfig:
	XPD_ERR(xpd, "Bad lineconfig. Abort\n");
	return -EINVAL;
}

static int pri_set_spantype(struct dahdi_span *span, const char *spantype)
{
	struct phonedev *phonedev = container_of(span, struct phonedev, span);
	xpd_t *xpd = container_of(phonedev, struct xpd, phonedev);
	enum pri_protocol set_proto = PRI_PROTO_0;

	XPD_INFO(xpd, "%s: %s\n", __func__, spantype);
	set_proto = pri_protocol_bystr(spantype);
	return set_pri_proto(xpd, set_proto);
}

/*
 * Called only for 'span' keyword in /etc/dahdi/system.conf
 */

static int pri_spanconfig(struct file *file, struct dahdi_span *span,
			  struct dahdi_lineconfig *lc)
{
	struct phonedev *phonedev = container_of(span, struct phonedev, span);
	xpd_t *xpd = container_of(phonedev, struct xpd, phonedev);
	struct PRI_priv_data *priv;
	int ret;

	BUG_ON(!xpd);
	priv = xpd->priv;
	if (lc->span != PHONEDEV(xpd).span.spanno) {
		XPD_ERR(xpd, "I am span %d but got spanconfig for span %d\n",
			PHONEDEV(xpd).span.spanno, lc->span);
		return -EINVAL;
	}
	/*
	 * FIXME: lc->name is unused by dahdi_cfg and dahdi...
	 *        We currently ignore it also.
	 */
	XPD_DBG(GENERAL, xpd, "[%s] lbo=%d lineconfig=0x%X sync=%d\n",
		(priv->clock_source) ? "MASTER" : "SLAVE", lc->lbo,
		lc->lineconfig, lc->sync);
	ret = pri_lineconfig(xpd, lc->lineconfig);
	if (!ret) {
		span->lineconfig = lc->lineconfig;
		PHONEDEV(xpd).timing_priority = lc->sync;
		set_master_mode("spanconfig", xpd);
		elect_syncer("PRI-master_mode");
	}
	return ret;
}

/*
 * Set signalling type (if appropriate)
 * Called from dahdi with spinlock held on chan. Must not call back
 * dahdi functions.
 */
static int pri_chanconfig(struct file *file, struct dahdi_chan *chan,
			  int sigtype)
{
	struct phonedev *phonedev =
	    container_of(chan->span, struct phonedev, span);
	xpd_t *xpd = container_of(phonedev, struct xpd, phonedev);
	struct PRI_priv_data *priv;

	BUG_ON(!xpd);
	priv = xpd->priv;
	DBG(GENERAL, "channel %d (%s) -> %s\n", chan->channo, chan->name,
	    sig2str(sigtype));
	/*
	 * Some bookkeeping to check if we have DChan defined or not
	 * FIXME: actually use this to prevent duplicate DChan definitions
	 *        and prevent DChan definitions with CAS.
	 */
	if (is_sigtype_dchan(sigtype)) {
		if (VALID_DCHAN(priv) && DCHAN(priv) != chan->channo) {
			ERR("channel %d (%s) marked DChan but "
				"also channel %d.\n",
				chan->channo, chan->name, DCHAN(priv));
			return -EINVAL;
		}
		XPD_DBG(GENERAL, xpd, "channel %d (%s) marked as DChan\n",
			chan->channo, chan->name);
		SET_DCHAN(priv, chan->channo);
		/* In T1, we don't know before-hand */
		if (priv->pri_protocol != PRI_PROTO_E1 && priv->is_cas != 0) {
			set_mode_cas(xpd, 0);
		}
	} else {
		if (chan->channo == 1) {
			XPD_DBG(GENERAL, xpd,
				"channel %d (%s) marked a not DChan\n",
				chan->channo, chan->name);
			SET_DCHAN(priv, NO_DCHAN);
		}
		/* In T1, we don't know before-hand */
		if (priv->pri_protocol != PRI_PROTO_E1 && priv->is_cas != 1)
			set_mode_cas(xpd, 1);
	}
	if (PHONEDEV(xpd).span.flags & DAHDI_FLAG_RUNNING) {
		XPD_DBG(DEVICES, xpd, "Span is RUNNING. Updating rbslines.\n");
		set_rbslines(xpd, chan->channo);
	}
	// FIXME: sanity checks:
	// - should be supported (within the sigcap)
	// - should not replace fxs <->fxo ??? (covered by previous?)
	return 0;
}

static xpd_t *PRI_card_new(xbus_t *xbus, int unit, int subunit,
			   const xproto_table_t *proto_table, __u8 subtype,
			   int subunits, int subunit_ports, bool to_phone)
{
	xpd_t *xpd = NULL;
	struct PRI_priv_data *priv;
	int channels = min(31, CHANNELS_PERXPD);	/* worst case */

	if (subunit_ports != 1) {
		XBUS_ERR(xbus, "Bad subunit_ports=%d\n", subunit_ports);
		return NULL;
	}
	XBUS_DBG(GENERAL, xbus, "\n");
	xpd =
	    xpd_alloc(xbus, unit, subunit, subtype, subunits,
		      sizeof(struct PRI_priv_data), proto_table, channels);
	if (!xpd)
		return NULL;
	priv = xpd->priv;
	/* Default, changes in set_pri_proto() */
	priv->pri_protocol = PRI_PROTO_0;
	/* Default, changes in set_pri_proto() */
	priv->deflaw = DAHDI_LAW_DEFAULT;
	xpd->type_name = type_name(priv->pri_protocol);
	xbus->sync_mode_default = SYNC_MODE_AB;
	return xpd;
}

static int PRI_card_init(xbus_t *xbus, xpd_t *xpd)
{
	struct PRI_priv_data *priv;
	int ret = 0;

	BUG_ON(!xpd);
	XPD_DBG(GENERAL, xpd, "\n");
	xpd->type = XPD_TYPE_PRI;
	priv = xpd->priv;
	if (priv->pri_protocol == PRI_PROTO_0) {
		/*
		 * init_card_* script didn't set pri protocol
		 * Let's have a default E1
		 */
		ret = set_pri_proto(xpd, PRI_PROTO_E1);
		if (ret < 0)
			goto err;
	}
	SET_DCHAN(priv, NO_DCHAN);
	/*
	 * initialization script should have set correct
	 * operating modes.
	 */
	if (!valid_pri_modes(xpd)) {
		XPD_NOTICE(xpd, "PRI protocol not set\n");
		goto err;
	}
	xpd->type_name = type_name(priv->pri_protocol);
	PHONEDEV(xpd).direction = TO_PSTN;
	XPD_DBG(DEVICES, xpd, "%s\n", xpd->type_name);
	PHONEDEV(xpd).timing_priority = 1;	/* High priority SLAVE */
	set_master_mode(__func__, xpd);
	for (ret = 0; ret < NUM_LEDS; ret++) {
		DO_LED(xpd, ret, PRI_LED_ON);
		msleep(20);
		DO_LED(xpd, ret, PRI_LED_OFF);
	}
	priv->initialized = 1;
	return 0;
err:
	XPD_ERR(xpd, "Failed initializing registers (%d)\n", ret);
	return ret;
}

static int PRI_card_remove(xbus_t *xbus, xpd_t *xpd)
{
	BUG_ON(!xpd);
	XPD_DBG(GENERAL, xpd, "\n");
	return 0;
}

#ifdef	DAHDI_AUDIO_NOTIFY
static int pri_audio_notify(struct dahdi_chan *chan, int on)
{
	xpd_t *xpd = chan->pvt;
	int pos = chan->chanpos - 1;

	BUG_ON(!xpd);
	LINE_DBG(SIGNAL, xpd, pos, "PRI-AUDIO: %s\n", (on) ? "on" : "off");
	mark_offhook(xpd, pos, on);
	return 0;
}
#endif

static const struct dahdi_span_ops PRI_span_ops = {
	.owner = THIS_MODULE,
	.set_spantype = pri_set_spantype,
	.spanconfig = pri_spanconfig,
	.chanconfig = pri_chanconfig,
	.startup = pri_startup,
	.shutdown = pri_shutdown,
	.rbsbits = pri_rbsbits,
	.open = xpp_open,
	.close = xpp_close,
	.ioctl = xpp_ioctl,
	.maint = xpp_maint,
	.echocan_create = xpp_echocan_create,
	.echocan_name = xpp_echocan_name,
	.assigned = xpp_span_assigned,
#ifdef	DAHDI_SYNC_TICK
	.sync_tick = dahdi_sync_tick,
#endif
#ifdef	CONFIG_DAHDI_WATCHDOG
	.watchdog = xpp_watchdog,
#endif

#ifdef	DAHDI_AUDIO_NOTIFY
	.audio_notify = pri_audio_notify,
#endif
};

static int apply_pri_protocol(xpd_t *xpd)
{
	xbus_t *xbus;
	struct PRI_priv_data *priv;
	int i;

	BUG_ON(!xpd);
	xbus = xpd->xbus;
	priv = xpd->priv;
	BUG_ON(!xbus);
	XPD_DBG(GENERAL, xpd, "\n");
	PHONEDEV(xpd).span.spantype = pri_protocol_name(priv->pri_protocol);
	PHONEDEV(xpd).span.linecompat = pri_linecompat(priv->pri_protocol);
	PHONEDEV(xpd).span.deflaw = priv->deflaw;
	PHONEDEV(xpd).span.alarms = DAHDI_ALARM_NONE;
	for_each_line(xpd, i) {
		struct dahdi_chan *cur_chan = XPD_CHAN(xpd, i);
		bool is_dchan = i == PRI_DCHAN_IDX(priv);

		XPD_DBG(GENERAL, xpd, "setting PRI channel %d (%s)\n", i,
			(is_dchan) ? "DCHAN" : "CLEAR");
		snprintf(cur_chan->name, MAX_CHANNAME, "XPP_%s/%02d/%1d%1d/%d",
			 xpd->type_name, xbus->num, xpd->addr.unit,
			 xpd->addr.subunit, i);
		cur_chan->chanpos = i + 1;
		cur_chan->pvt = xpd;
		cur_chan->sigcap = PRI_SIGCAP;
		if (is_dchan && !priv->is_cas) {	/* D-CHAN */
			//FIXME: cur_chan->flags |= DAHDI_FLAG_PRIDCHAN;
			cur_chan->flags &= ~DAHDI_FLAG_HDLC;
		}
	}
	PHONEDEV(xpd).offhook_state = PHONEDEV(xpd).wanted_pcm_mask;
	PHONEDEV(xpd).span.ops = &PRI_span_ops;
	PHONEDEV(xpd).span.channels = PHONEDEV(xpd).channels;
	xpd_set_spanname(xpd);
	return 0;
}

static int PRI_card_dahdi_preregistration(xpd_t *xpd, bool on)
{
	xbus_t *xbus;
	struct PRI_priv_data *priv;

	BUG_ON(!xpd);
	xbus = xpd->xbus;
	priv = xpd->priv;
	BUG_ON(!xbus);
	XPD_DBG(GENERAL, xpd, "%s (proto=%s, channels=%d, deflaw=%d)\n",
		(on) ? "on" : "off", pri_protocol_name(priv->pri_protocol),
		PHONEDEV(xpd).channels, priv->deflaw);
	if (!on) {
		/* Nothing to do yet */
		return 0;
	}
	return apply_pri_protocol(xpd);
}

static int PRI_card_dahdi_postregistration(xpd_t *xpd, bool on)
{
	xbus_t *xbus;

	BUG_ON(!xpd);
	xbus = xpd->xbus;
	BUG_ON(!xbus);
	XPD_DBG(GENERAL, xpd, "%s\n", (on) ? "on" : "off");
	dahdi_update_syncsrc(xpd);
	return (0);
}

static void dchan_state(xpd_t *xpd, bool up)
{
	struct PRI_priv_data *priv;

	BUG_ON(!xpd);
	priv = xpd->priv;
	BUG_ON(!priv);
	if (priv->is_cas) {
		return;
	}
	if (priv->dchan_alive == up)
		return;
	if (!priv->layer1_up)	/* No layer1, kill dchan */
		up = 0;
	if (up) {
		XPD_DBG(SIGNAL, xpd, "STATE CHANGE: D-Channel RUNNING\n");
		priv->dchan_alive = 1;
	} else {
		int d = PRI_DCHAN_IDX(priv);

		if (SPAN_REGISTERED(xpd) && d >= 0
		    && d < PHONEDEV(xpd).channels) {
			__u8 *pcm;

			pcm = (__u8 *)XPD_CHAN(xpd, d)->readchunk;
			pcm[0] = 0x00;
			pcm = (__u8 *)XPD_CHAN(xpd, d)->writechunk;
			pcm[0] = 0x00;
		}
		XPD_DBG(SIGNAL, xpd, "STATE CHANGE: D-Channel STOPPED\n");
		priv->dchan_rx_counter = priv->dchan_tx_counter = 0;
		priv->dchan_alive = 0;
		priv->dchan_alive_ticks = 0;
		priv->dchan_rx_sample = priv->dchan_tx_sample = 0x00;
	}
}

/*
 * LED managment is done by the driver now:
 *   - Turn constant ON RED/GREEN led to indicate MASTER/SLAVE port
 *   - Very fast "Double Blink" to indicate Layer1 alive (without D-Channel)
 *   - Constant blink (1/2 sec cycle) to indicate D-Channel alive.
 */
static void handle_leds(xbus_t *xbus, xpd_t *xpd)
{
	struct PRI_priv_data *priv;
	unsigned int timer_count;
	int which_led;
	int other_led;
	enum pri_led_state ledstate;
	int mod;

	BUG_ON(!xpd);
	priv = xpd->priv;
	BUG_ON(!priv);
	if (PHONEDEV(xpd).timing_priority == 0) {
		which_led = TOP_RED_LED;
		other_led = BOTTOM_GREEN_LED;
	} else {
		which_led = BOTTOM_GREEN_LED;
		other_led = TOP_RED_LED;
	}
	ledstate = priv->ledstate[which_led];
	timer_count = xpd->timer_count;
	if (xpd->blink_mode) {
		if ((timer_count % DEFAULT_LED_PERIOD) == 0) {
			// led state is toggled
			if (ledstate == PRI_LED_OFF) {
				DO_LED(xpd, which_led, PRI_LED_ON);
				DO_LED(xpd, other_led, PRI_LED_ON);
			} else {
				DO_LED(xpd, which_led, PRI_LED_OFF);
				DO_LED(xpd, other_led, PRI_LED_OFF);
			}
		}
		return;
	}
	if (priv->ledstate[other_led] != PRI_LED_OFF)
		DO_LED(xpd, other_led, PRI_LED_OFF);
	if (priv->dchan_alive) {
		mod = timer_count % 1000;
		switch (mod) {
		case 0:
			DO_LED(xpd, which_led, PRI_LED_ON);
			break;
		case 500:
			DO_LED(xpd, which_led, PRI_LED_OFF);
			break;
		}
	} else if (priv->layer1_up) {
		mod = timer_count % 1000;
		switch (mod) {
		case 0:
		case 100:
			DO_LED(xpd, which_led, PRI_LED_ON);
			break;
		case 50:
		case 150:
			DO_LED(xpd, which_led, PRI_LED_OFF);
			break;
		}
	} else {
		if (priv->ledstate[which_led] != PRI_LED_ON)
			DO_LED(xpd, which_led, PRI_LED_ON);
	}
}

static int PRI_card_tick(xbus_t *xbus, xpd_t *xpd)
{
	struct PRI_priv_data *priv;

	BUG_ON(!xpd);
	priv = xpd->priv;
	BUG_ON(!priv);
	if (!priv->initialized || !xbus->self_ticking)
		return 0;
	/*
	 * Poll layer1 status (cascade subunits)
	 */
	if (poll_interval != 0 && ((xpd->timer_count % poll_interval) == 0)) {
		priv->poll_noreplies++;
		query_subunit(xpd, REG_FRS0);
		//query_subunit(xpd, REG_FRS1);
	}
	if (priv->dchan_tx_counter >= 1 && priv->dchan_rx_counter > 1) {
		dchan_state(xpd, 1);
		priv->dchan_alive_ticks++;
	}
	handle_leds(xbus, xpd);
	return 0;
}

static int PRI_card_ioctl(xpd_t *xpd, int pos, unsigned int cmd,
			  unsigned long arg)
{
	struct dahdi_chan *chan;

	BUG_ON(!xpd);
	if (!XBUS_IS(xpd->xbus, READY))
		return -ENODEV;
	chan = XPD_CHAN(xpd, pos);
	switch (cmd) {
		/*
		 * Asterisk may send FXS type ioctl()'s to us:
		 *   - Some are sent to everybody (DAHDI_TONEDETECT)
		 *   - Some are sent because we may be in CAS mode
		 *     (FXS signalling)
		 * Ignore them.
		 */
	case DAHDI_TONEDETECT:
		LINE_DBG(SIGNAL, xpd, pos, "PRI: TONEDETECT (%s)\n",
			 (chan->
			  flags & DAHDI_FLAG_AUDIO) ? "AUDIO" : "SILENCE");
		return -ENOTTY;
	case DAHDI_ONHOOKTRANSFER:
		LINE_DBG(SIGNAL, xpd, pos, "PRI: ONHOOKTRANSFER\n");
		return -ENOTTY;
	case DAHDI_VMWI:
		LINE_DBG(SIGNAL, xpd, pos, "PRI: VMWI\n");
		return -ENOTTY;
	case DAHDI_VMWI_CONFIG:
		LINE_DBG(SIGNAL, xpd, pos, "PRI: VMWI_CONFIG\n");
		return -ENOTTY;
	case DAHDI_SETPOLARITY:
		LINE_DBG(SIGNAL, xpd, pos, "PRI: SETPOLARITY\n");
		return -ENOTTY;
		/* report on really bad ioctl()'s */
	default:
		report_bad_ioctl(THIS_MODULE->name, xpd, pos, cmd);
		return -ENOTTY;
	}
	return 0;
}

static int PRI_card_close(xpd_t *xpd, lineno_t pos)
{
	//struct dahdi_chan     *chan = XPD_CHAN(xpd, pos);
	dchan_state(xpd, 0);
	return 0;
}

/*
 * Called only for 'span' keyword in /etc/dahdi/system.conf
 */
static int pri_startup(struct file *file, struct dahdi_span *span)
{
	struct phonedev *phonedev = container_of(span, struct phonedev, span);
	xpd_t *xpd = container_of(phonedev, struct xpd, phonedev);
	struct PRI_priv_data *priv;

	BUG_ON(!xpd);
	priv = xpd->priv;
	BUG_ON(!priv);
	if (!XBUS_IS(xpd->xbus, READY)) {
		XPD_DBG(GENERAL, xpd,
			"Startup called by dahdi. No Hardware. Ignored\n");
		return -ENODEV;
	}
	XPD_DBG(GENERAL, xpd, "STARTUP\n");
	// Turn on all channels
	CALL_PHONE_METHOD(card_state, xpd, 1);
	set_rbslines(xpd, 0);
	write_subunit(xpd, REG_XPM2, 0x00);
	return 0;
}

/*
 * Called only for 'span' keyword in /etc/dahdi/system.conf
 */
static int pri_shutdown(struct dahdi_span *span)
{
	struct phonedev *phonedev = container_of(span, struct phonedev, span);
	xpd_t *xpd = container_of(phonedev, struct xpd, phonedev);
	struct PRI_priv_data *priv;

	BUG_ON(!xpd);
	priv = xpd->priv;
	BUG_ON(!priv);
	if (!XBUS_IS(xpd->xbus, READY)) {
		XPD_DBG(GENERAL, xpd,
			"Shutdown called by dahdi. No Hardware. Ignored\n");
		return -ENODEV;
	}
	XPD_DBG(GENERAL, xpd, "SHUTDOWN\n");
	// Turn off all channels
	CALL_PHONE_METHOD(card_state, xpd, 0);
	return 0;
}

static int encode_rbsbits_e1(xpd_t *xpd, int pos, int bits)
{
	struct PRI_priv_data *priv;
	__u8 val;
	int rsnum;

	BUG_ON(!xpd);
	priv = xpd->priv;
	BUG_ON(!priv);
	BUG_ON(priv->pri_protocol != PRI_PROTO_E1);
	if (pos == 15)
		return 0;	/* Don't write dchan in CAS */
	if (pos < 0 || pos > 31) {
		XPD_NOTICE(xpd, "%s: pos=%d out of range. Ignore\n", __func__,
			   pos);
		return 0;
	}
	if (pos >= 16) {
		/* Low nibble */
		rsnum = pos - 16;
		val = (priv->cas_ts_e[rsnum] & 0xF0) | (bits & 0x0F);
	} else {
		/* High nibble */
		rsnum = pos;
		val = (priv->cas_ts_e[rsnum] & 0x0F) | ((bits << 4) & 0xF0);
	}
	LINE_DBG(SIGNAL, xpd, pos, "RBS: TX: bits=0x%X\n", bits);
	write_cas_reg(xpd, rsnum, val);
	return 0;
}

static int encode_rbsbits_t1(xpd_t *xpd, int pos, int bits)
{
	struct PRI_priv_data *priv;
	int rsnum;
	int chan_per_reg;
	int offset;
	int width;
	uint tx_bits = bits;
	uint mask;
	__u8 val;

	BUG_ON(!xpd);
	priv = xpd->priv;
	BUG_ON(!priv);
	BUG_ON(priv->pri_protocol != PRI_PROTO_T1);
	if (pos < 0 || pos >= PHONEDEV(xpd).channels) {
		XPD_ERR(xpd, "%s: Bad pos=%d\n", __func__, pos);
		return 0;
	}
	chan_per_reg = CHAN_PER_REGS(priv);
	width = 8 / chan_per_reg;
	rsnum = pos / chan_per_reg;
	offset = pos % chan_per_reg;
	mask = BITMASK(width) << (chan_per_reg - offset - 1) * width;
	if (!priv->is_esf)
		tx_bits >>= 2;
	tx_bits &= BITMASK(width);
	tx_bits <<= (chan_per_reg - offset - 1) * width;
	val = priv->cas_ts_e[rsnum];
	val &= ~mask;
	val |= tx_bits;
	LINE_DBG(SIGNAL, xpd, pos,
		 "bits=0x%02X RS%02d(%s) offset=%d tx_bits=0x%02X\n", bits,
		 rsnum + 1, (priv->is_esf) ? "esf" : "d4", offset, tx_bits);
	write_cas_reg(xpd, rsnum, val);
	priv->dchan_tx_counter++;
	return 0;
}

static void send_idlebits(xpd_t *xpd, bool saveold)
{
	struct PRI_priv_data *priv;
	__u8 save_rs[NUM_CAS_RS_E];
	int i;

	if (!SPAN_REGISTERED(xpd))
		return;
	priv = xpd->priv;
	BUG_ON(!priv);
	XPD_DBG(SIGNAL, xpd, "saveold=%d\n", saveold);
	if (saveold)
		memcpy(save_rs, priv->cas_ts_e, sizeof(save_rs));
	for_each_line(xpd, i) {
		struct dahdi_chan *chan = XPD_CHAN(xpd, i);

		pri_rbsbits(chan, chan->idlebits);
	}
	if (saveold)
		memcpy(priv->cas_ts_e, save_rs, sizeof(save_rs));
}

static void send_oldbits(xpd_t *xpd)
{
	struct PRI_priv_data *priv;
	int i;

	BUG_ON(!xpd);
	priv = xpd->priv;
	BUG_ON(!priv);
	XPD_DBG(SIGNAL, xpd, "\n");
	for (i = 0; i < cas_numregs(xpd); i++)
		write_cas_reg(xpd, i, priv->cas_ts_e[i]);
}

static int pri_rbsbits(struct dahdi_chan *chan, int bits)
{
	xpd_t *xpd;
	struct PRI_priv_data *priv;
	int pos;

	xpd = chan->pvt;
	BUG_ON(!xpd);
	pos = chan->chanpos - 1;
	priv = xpd->priv;
	BUG_ON(!priv);
	if (!priv->is_cas) {
		XPD_DBG(SIGNAL, xpd, "RBS: TX: not in CAS mode. Ignore.\n");
		return 0;
	}
	if (chan->sig == DAHDI_SIG_NONE) {
		LINE_DBG(SIGNAL, xpd, pos,
			 "RBS: TX: sigtyp=%s. , bits=0x%X. Ignore.\n",
			 sig2str(chan->sig), bits);
		return 0;
	}
	if (!priv->layer1_up) {
		XPD_DBG(SIGNAL, xpd, "RBS: TX: No layer1 yet. Keep going.\n");
	}
	if (priv->pri_protocol == PRI_PROTO_E1) {
		if (encode_rbsbits_e1(xpd, pos, bits) < 0)
			return -EINVAL;
	} else if (priv->pri_protocol == PRI_PROTO_T1) {
		if (encode_rbsbits_t1(xpd, pos, bits) < 0)
			return -EINVAL;
	} else {
		XPD_NOTICE(xpd,
			   "%s: protocol %s is not supported yet with CAS\n",
			   __func__, pri_protocol_name(priv->pri_protocol));
		return -EINVAL;
	}
	return 0;
}

/*! Copy PCM chunks from the buffers of the xpd to a new packet
 * \param xbus	xbus of source xpd.
 * \param xpd	source xpd.
 * \param lines	a bitmask of the active channels that need to be copied.
 * \param pack	packet to be filled.
 *
 * On PRI this function is should also shift the lines mask one bit, as
 * channel 0 on the wire is an internal chip control channel. We only
 * send 31 channels to the device, but they should be called 1-31 rather
 * than 0-30 .
 */
static void PRI_card_pcm_fromspan(xpd_t *xpd, xpacket_t *pack)
{
	struct PRI_priv_data *priv;
	__u8 *pcm;
	unsigned long flags;
	int i;
	xpp_line_t wanted_lines;
	int physical_chan;
	int physical_mask = 0;

	BUG_ON(!xpd);
	BUG_ON(!pack);
	priv = xpd->priv;
	BUG_ON(!priv);
	pcm = RPACKET_FIELD(pack, GLOBAL, PCM_WRITE, pcm);
	spin_lock_irqsave(&xpd->lock, flags);
	wanted_lines = PHONEDEV(xpd).wanted_pcm_mask;
	physical_chan = 0;
	for_each_line(xpd, i) {
		struct dahdi_chan *chan = XPD_CHAN(xpd, i);

		if (priv->pri_protocol == PRI_PROTO_E1) {
			/* In E1 - Only 0'th channel is unused */
			if (i == 0) {
				physical_chan++;
			}
		} else if (priv->pri_protocol == PRI_PROTO_T1) {
			/* In T1 - Every 4'th channel is unused */
			if ((i % 3) == 0) {
				physical_chan++;
			}
		}
		if (IS_SET(wanted_lines, i)) {
			physical_mask |= BIT(physical_chan);
			if (SPAN_REGISTERED(xpd)) {
#ifdef	DEBUG_PCMTX
				int channo = XPD_CHAN(xpd, i)->channo;

				if (pcmtx >= 0 && pcmtx_chan == channo)
					memset((u_char *)pcm, pcmtx,
					       DAHDI_CHUNKSIZE);
				else
#endif
					memcpy((u_char *)pcm, chan->writechunk,
					       DAHDI_CHUNKSIZE);
				if (i == PRI_DCHAN_IDX(priv)) {
					if (priv->dchan_tx_sample !=
					    chan->writechunk[0]) {
						priv->dchan_tx_sample =
						    chan->writechunk[0];
						priv->dchan_tx_counter++;
					} else if (chan->writechunk[0] == 0xFF)
						dchan_state(xpd, 0);
					else
						/* Clobber for next tick */
						chan->writechunk[0] = 0xFF;
				}
			} else
				memset((u_char *)pcm, DAHDI_XLAW(0, chan),
				       DAHDI_CHUNKSIZE);
			pcm += DAHDI_CHUNKSIZE;
		}
		physical_chan++;
	}
	RPACKET_FIELD(pack, GLOBAL, PCM_WRITE, lines) = physical_mask;
	XPD_COUNTER(xpd, PCM_WRITE)++;
	spin_unlock_irqrestore(&xpd->lock, flags);
}

/*! Copy PCM chunks from the packet we received to the xpd struct.
 * \param xbus	xbus of target xpd.
 * \param xpd	target xpd.
 * \param pack	Source packet.
 *
 * On PRI this function is should also shift the lines back mask one bit, as
 * channel 0 on the wire is an internal chip control channel.
 *
 * \see PRI_card_pcm_fromspan
 */
static void PRI_card_pcm_tospan(xpd_t *xpd, xpacket_t *pack)
{
	struct PRI_priv_data *priv;
	__u8 *pcm;
	xpp_line_t physical_mask;
	unsigned long flags;
	int i;
	int logical_chan;

	if (!SPAN_REGISTERED(xpd))
		return;
	priv = xpd->priv;
	BUG_ON(!priv);
	pcm = RPACKET_FIELD(pack, GLOBAL, PCM_READ, pcm);
	physical_mask = RPACKET_FIELD(pack, GLOBAL, PCM_WRITE, lines);
	spin_lock_irqsave(&xpd->lock, flags);
	logical_chan = 0;
	for (i = 0; i < CHANNELS_PERXPD; i++) {
		volatile u_char *r;

		if (priv->pri_protocol == PRI_PROTO_E1) {
			/* In E1 - Only 0'th channel is unused */
			if (i == 0)
				continue;
		} else if (priv->pri_protocol == PRI_PROTO_T1) {
			/* In T1 - Every 4'th channel is unused */
			if ((i % 4) == 0)
				continue;
		}
		if (logical_chan == PRI_DCHAN_IDX(priv) && !priv->is_cas) {
			if (priv->dchan_rx_sample != pcm[0]) {
				if (debug & DBG_PCM) {
					XPD_INFO(xpd,
						"RX-D-Chan: prev=0x%X now=0x%X\n",
						priv->dchan_rx_sample, pcm[0]);
					dump_packet("RX-D-Chan", pack, 1);
				}
				priv->dchan_rx_sample = pcm[0];
				priv->dchan_rx_counter++;
			} else if (pcm[0] == 0xFF)
				dchan_state(xpd, 0);
		}
		if (IS_SET(physical_mask, i)) {
			r = XPD_CHAN(xpd, logical_chan)->readchunk;
			// memset((u_char *)r, 0x5A, DAHDI_CHUNKSIZE);  // DEBUG
			memcpy((u_char *)r, pcm, DAHDI_CHUNKSIZE);
			pcm += DAHDI_CHUNKSIZE;
		}
		logical_chan++;
	}
	XPD_COUNTER(xpd, PCM_READ)++;
	spin_unlock_irqrestore(&xpd->lock, flags);
}

static int PRI_timing_priority(xpd_t *xpd)
{
	struct PRI_priv_data *priv;

	priv = xpd->priv;
	BUG_ON(!priv);
	if (priv->layer1_up)
		return PHONEDEV(xpd).timing_priority;
	XPD_DBG(SYNC, xpd, "No timing priority (no layer1)\n");
	return -ENOENT;
}

static int PRI_echocancel_timeslot(xpd_t *xpd, int pos)
{
	/*
	 * Skip ts=0 (used for PRI sync)
	 */
	return (1 + pos) * 4 + xpd->addr.subunit;
}

static int PRI_echocancel_setmask(xpd_t *xpd, xpp_line_t ec_mask)
{
	struct PRI_priv_data *priv;
	int i;

	BUG_ON(!xpd);
	priv = xpd->priv;
	BUG_ON(!priv);
	XPD_DBG(GENERAL, xpd, "0x%8X\n", ec_mask);
	if (!ECHOOPS(xpd->xbus)) {
		XPD_DBG(GENERAL, xpd,
			"No echo canceller in XBUS: Doing nothing.\n");
		return -EINVAL;
	}
	for (i = 0; i < PHONEDEV(xpd).channels; i++) {
		int on = BIT(i) & ec_mask;

		if (i == PRI_DCHAN_IDX(priv))
			on = 0;
		CALL_EC_METHOD(ec_set, xpd->xbus, xpd, i, on);
	}
	CALL_EC_METHOD(ec_update, xpd->xbus, xpd->xbus);
	return 0;
}

/*---------------- PRI: HOST COMMANDS -------------------------------------*/

static /* 0x33 */ HOSTCMD(PRI, SET_LED, enum pri_led_selectors led_sel,
			  enum pri_led_state to_led_state)
{
	int ret = 0;
	xframe_t *xframe;
	xpacket_t *pack;
	struct pri_leds *pri_leds;
	struct PRI_priv_data *priv;

	BUG_ON(!xbus);
	BUG_ON(!xpd);
	priv = xpd->priv;
	BUG_ON(!priv);
	XPD_DBG(LEDS, xpd, "led_sel=%d to_state=%d\n", led_sel, to_led_state);
	XFRAME_NEW_CMD(xframe, pack, xbus, PRI, SET_LED, xpd->xbus_idx);
	pri_leds = &RPACKET_FIELD(pack, PRI, SET_LED, pri_leds);
	pri_leds->state = to_led_state;
	pri_leds->led_sel = led_sel;
	pri_leds->reserved = 0;
	XPACKET_LEN(pack) = RPACKET_SIZE(PRI, SET_LED);
	ret = send_cmd_frame(xbus, xframe);
	priv->ledstate[led_sel] = to_led_state;
	return ret;
}

/*---------------- PRI: Astribank Reply Handlers --------------------------*/
static void layer1_state(xpd_t *xpd, __u8 data_low)
{
	struct PRI_priv_data *priv;
	int alarms = DAHDI_ALARM_NONE;
	int layer1_up_prev;

	BUG_ON(!xpd);
	priv = xpd->priv;
	BUG_ON(!priv);
	priv->poll_noreplies = 0;
	if (data_low & REG_FRS0_LOS)
		alarms |= DAHDI_ALARM_RED;
	if (data_low & REG_FRS0_AIS)
		alarms |= DAHDI_ALARM_BLUE;
	if (data_low & REG_FRS0_RRA)
		alarms |= DAHDI_ALARM_YELLOW;
	layer1_up_prev = priv->layer1_up;
	priv->layer1_up = alarms == DAHDI_ALARM_NONE;
#if 0
	/*
	 * Some bad bits (e.g: LMFA and NMF have no alarm "colors"
	 * associated. However, layer1 is still not working if they are set.
	 * FIXME: These behave differently in E1/T1, so ignore them for while.
	 */
	if (data_low & (REG_FRS0_LMFA | REG_FRS0_E1_NMF))
		priv->layer1_up = 0;
#endif
	priv->alarms = alarms;
	if (!priv->layer1_up) {
		dchan_state(xpd, 0);
	} else if (priv->is_cas && !layer1_up_prev) {
		int regbase = cas_regbase(xpd);
		int i;

		XPD_DBG(SIGNAL, xpd,
			"Returning From Alarm Refreshing Rx register data \n");
		for (i = 0; i < cas_numregs(xpd); i++)
			query_subunit(xpd, regbase + i);
	}

	if (SPAN_REGISTERED(xpd) && PHONEDEV(xpd).span.alarms != alarms) {
		char str1[MAX_PROC_WRITE];
		char str2[MAX_PROC_WRITE];

		alarm2str(PHONEDEV(xpd).span.alarms, str1, sizeof(str1));
		alarm2str(alarms, str2, sizeof(str2));
		XPD_NOTICE(xpd, "Alarms: 0x%X (%s) => 0x%X (%s)\n",
			   PHONEDEV(xpd).span.alarms, str1, alarms, str2);
		if (priv->is_cas) {
			if (alarms == DAHDI_ALARM_NONE)
				send_oldbits(xpd);
			else if (PHONEDEV(xpd).span.alarms == DAHDI_ALARM_NONE)
				send_idlebits(xpd, 1);
		}
		PHONEDEV(xpd).span.alarms = alarms;
		elect_syncer("LAYER1");
		dahdi_alarm_notify(&PHONEDEV(xpd).span);
		set_clocking(xpd);
	}
	priv->reg_frs0 = data_low;
	priv->layer1_replies++;
	XPD_DBG(REGS, xpd, "subunit=%d data_low=0x%02X\n", xpd->addr.subunit,
		data_low);
}

static int decode_cas_e1(xpd_t *xpd, __u8 regnum, __u8 data_low)
{
	struct PRI_priv_data *priv;
	uint pos = regnum - REG_RS2_E;
	int rsnum = pos + 2;
	int chan1 = pos;
	int chan2 = pos + 16;
	int val1 = (data_low >> 4) & 0xF;
	int val2 = data_low & 0xF;

	priv = xpd->priv;
	BUG_ON(!priv->is_cas);
	BUG_ON(priv->pri_protocol != PRI_PROTO_E1);
	XPD_DBG(SIGNAL, xpd, "RBS: RX: data_low=0x%02X\n", data_low);
	if (pos >= NUM_CAS_RS_E) {
		XPD_ERR(xpd, "%s: got bad pos=%d [0-%d]\n", __func__, pos,
			NUM_CAS_RS_E);
		return -EINVAL;
	}
	if (chan1 < 0 || chan1 > PHONEDEV(xpd).channels) {
		XPD_NOTICE(xpd, "%s: %s CAS: Bad chan1 number (%d)\n", __func__,
			   pri_protocol_name(priv->pri_protocol), chan1);
		return -EINVAL;
	}
	if (chan2 < 0 || chan2 > PHONEDEV(xpd).channels) {
		XPD_NOTICE(xpd, "%s: %s CAS: Bad chan2 number (%d)\n", __func__,
			   pri_protocol_name(priv->pri_protocol), chan2);
		return -EINVAL;
	}
	XPD_DBG(SIGNAL, xpd,
		"RBS: RX: RS%02d (channel %2d, channel %2d): 0x%02X -> 0x%02X\n",
		rsnum, chan1 + 1, chan2 + 1, priv->cas_rs_e[pos], data_low);
	if (SPAN_REGISTERED(xpd)) {
		dahdi_rbsbits(XPD_CHAN(xpd, chan1), val1);
		dahdi_rbsbits(XPD_CHAN(xpd, chan2), val2);
	}
	priv->dchan_rx_counter++;
	priv->cas_rs_e[pos] = data_low;
	return 0;
}

static int decode_cas_t1(xpd_t *xpd, __u8 regnum, __u8 data_low)
{
	struct PRI_priv_data *priv;
	uint rsnum;
	uint chan_per_reg;
	uint width;
	int i;

	priv = xpd->priv;
	BUG_ON(!priv->is_cas);
	BUG_ON(priv->pri_protocol != PRI_PROTO_T1);
	rsnum = regnum - REG_RS1_E;
	if (rsnum >= 12) {
		XPD_ERR(xpd, "Bad rsnum=%d\n", rsnum);
		return 0;
	}
	if (!priv->is_esf)
		rsnum = rsnum % 6;	/* 2 identical banks of 6 registers */
	chan_per_reg = CHAN_PER_REGS(priv);
	width = 8 / chan_per_reg;
	XPD_DBG(SIGNAL, xpd, "RBS: RX(%s,%d): RS%02d data_low=0x%02X\n",
		(priv->is_esf) ? "esf" : "d4", chan_per_reg, rsnum + 1,
		data_low);
	for (i = 0; i < chan_per_reg; i++) {
		uint rxsig = (data_low >> (i * width)) & BITMASK(width);
		int pos;
		struct dahdi_chan *chan;

		if (!priv->is_esf)
			rxsig <<= 2;
		pos = rsnum * chan_per_reg + chan_per_reg - i - 1;
		if (pos < 0 || pos >= PHONEDEV(xpd).channels) {
			XPD_ERR(xpd, "%s: Bad pos=%d\n", __func__, pos);
			continue;
		}
		chan = XPD_CHAN(xpd, pos);
		if (!chan) {
			XPD_ERR(xpd, "%s: Null channel in pos=%d\n", __func__,
				pos);
			continue;
		}
		if (chan->rxsig != rxsig) {
			LINE_DBG(SIGNAL, xpd, pos, "i=%d rxsig=0x%02X\n", i,
				 rxsig);
			dahdi_rbsbits(chan, rxsig);
		}
	}
	priv->cas_rs_e[rsnum] = data_low;
	return 0;
}

static void process_cas_dchan(xpd_t *xpd, __u8 regnum, __u8 data_low)
{
	struct PRI_priv_data *priv;

	priv = xpd->priv;
	if (!priv->is_cas) {
		static int rate_limit;

		if ((rate_limit++ % 10003) == 0)
			XPD_NOTICE(xpd, "RBS: RX: not in CAS mode. Ignore.\n");
		return;
	}
	if (!priv->layer1_up) {
		static int rate_limit;

		if ((rate_limit++ % 10003) == 0)
			XPD_DBG(SIGNAL, xpd, "RBS: RX: No layer1.\n");
	}
	if (!SPAN_REGISTERED(xpd)) {
		static int rate_limit;

		if ((rate_limit++ % 10003) == 0)
			XPD_DBG(SIGNAL, xpd,
				"RBS: RX: Span not registered. Ignore.\n");
		return;
	}
	if (priv->pri_protocol == PRI_PROTO_E1) {
		if (regnum == REG_RS1_E)
			return;	/* Time slot 0: Ignored for E1 */
		if (regnum < REG_RS2_E) {
			/* Should not happen, but harmless. Ignore */
			if (regnum == REG_RS1_E)
				return;

			XPD_NOTICE(xpd,
				"%s: received register 0x%X in protocol %s. "
				"Ignore.\n",
				__func__, regnum,
				pri_protocol_name(priv->pri_protocol));
			return;
		}
		if (decode_cas_e1(xpd, regnum, data_low) < 0)
			return;
	} else if (priv->pri_protocol == PRI_PROTO_T1) {
		if (regnum > REG_RS12_E) {
			XPD_NOTICE(xpd,
				"%s: received register 0x%X in protocol %s. "
				"Ignore.\n",
				__func__, regnum,
				   pri_protocol_name(priv->pri_protocol));
			return;
		}
		if (decode_cas_t1(xpd, regnum, data_low) < 0)
			return;
	} else {
		XPD_NOTICE(xpd,
			   "%s: protocol %s is not supported yet with CAS\n",
			   __func__, pri_protocol_name(priv->pri_protocol));
	}
	priv->cas_replies++;
}

static int PRI_card_register_reply(xbus_t *xbus, xpd_t *xpd, reg_cmd_t *info)
{
	unsigned long flags;
	struct PRI_priv_data *priv;
	struct xpd_addr addr;
	xpd_t *orig_xpd;
	__u8 regnum;
	__u8 data_low;

	/* Map UNIT + PORTNUM to XPD */
	orig_xpd = xpd;
	addr.unit = orig_xpd->addr.unit;
	addr.subunit = info->portnum;
	regnum = REG_FIELD(info, regnum);
	data_low = REG_FIELD(info, data_low);
	xpd = xpd_byaddr(xbus, addr.unit, addr.subunit);
	if (!xpd) {
		static int rate_limit;

		if ((rate_limit++ % 1003) < 5)
			notify_bad_xpd(__func__, xbus, addr, orig_xpd->xpdname);
		return -EPROTO;
	}
	spin_lock_irqsave(&xpd->lock, flags);
	priv = xpd->priv;
	BUG_ON(!priv);
	if (info->is_multibyte) {
		XPD_NOTICE(xpd, "Got Multibyte: %d bytes, eoframe: %d\n",
			   info->bytes, info->eoframe);
		goto end;
	}
	if (regnum == REG_FRS0 && !REG_FIELD(info, do_subreg))
		layer1_state(xpd, data_low);
	else if (regnum == REG_FRS1 && !REG_FIELD(info, do_subreg))
		priv->reg_frs1 = data_low;
	if (priv->is_cas && !REG_FIELD(info, do_subreg)) {
		if (regnum >= REG_RS1_E && regnum <= REG_RS16_E) {
			process_cas_dchan(xpd, regnum, data_low);
		}
	}
	/*
	 * Update /proc info only if reply relate to the
	 * last slic read request
	 */
	if (REG_FIELD(&xpd->requested_reply, regnum) ==
			REG_FIELD(info, regnum)
		&& REG_FIELD(&xpd->requested_reply, do_subreg) ==
			REG_FIELD(info, do_subreg)
		&& REG_FIELD(&xpd->requested_reply, subreg) ==
			REG_FIELD(info, subreg)) {
		xpd->last_reply = *info;
	}

end:
	spin_unlock_irqrestore(&xpd->lock, flags);
	return 0;
}

static int PRI_card_state(xpd_t *xpd, bool on)
{
	BUG_ON(!xpd);
	XPD_DBG(GENERAL, xpd, "%s\n", (on) ? "on" : "off");
	return 0;
}

static const struct xops pri_xops = {
	.card_new = PRI_card_new,
	.card_init = PRI_card_init,
	.card_remove = PRI_card_remove,
	.card_tick = PRI_card_tick,
	.card_register_reply = PRI_card_register_reply,
};

static const struct phoneops pri_phoneops = {
	.card_dahdi_preregistration = PRI_card_dahdi_preregistration,
	.card_dahdi_postregistration = PRI_card_dahdi_postregistration,
	.card_pcm_recompute = PRI_card_pcm_recompute,
	.card_pcm_fromspan = PRI_card_pcm_fromspan,
	.card_pcm_tospan = PRI_card_pcm_tospan,
	.echocancel_timeslot = PRI_echocancel_timeslot,
	.echocancel_setmask = PRI_echocancel_setmask,
	.card_timing_priority = PRI_timing_priority,
	.card_ioctl = PRI_card_ioctl,
	.card_close = PRI_card_close,
	.card_state = PRI_card_state,
};

static xproto_table_t PROTO_TABLE(PRI) = {
	.owner = THIS_MODULE,.entries = {
		/*      Table   Card    Opcode          */
	},.name = "PRI",	/* protocol name */
.ports_per_subunit = 1,.type = XPD_TYPE_PRI,.xops =
	    &pri_xops,.phoneops = &pri_phoneops,.packet_is_valid =
	    pri_packet_is_valid,.packet_dump = pri_packet_dump,};

static bool pri_packet_is_valid(xpacket_t *pack)
{
	const xproto_entry_t *xe = NULL;
	// DBG(GENERAL, "\n");
	xe = xproto_card_entry(&PROTO_TABLE(PRI), XPACKET_OP(pack));
	return xe != NULL;
}

static void pri_packet_dump(const char *msg, xpacket_t *pack)
{
	DBG(GENERAL, "%s\n", msg);
}

/*------------------------- REGISTER Handling --------------------------*/

/*------------------------- sysfs stuff --------------------------------*/
static DEVICE_ATTR_READER(pri_protocol_show, dev, buf)
{
	xpd_t *xpd;
	struct PRI_priv_data *priv;
	unsigned long flags;
	int len = 0;

	BUG_ON(!dev);
	xpd = dev_to_xpd(dev);
	if (!xpd)
		return -ENODEV;
	priv = xpd->priv;
	BUG_ON(!priv);
	spin_lock_irqsave(&xpd->lock, flags);
	len += sprintf(buf, "%s\n", pri_protocol_name(priv->pri_protocol));
	spin_unlock_irqrestore(&xpd->lock, flags);
	return len;
}

static DEVICE_ATTR_WRITER(pri_protocol_store, dev, buf, count)
{
	xpd_t *xpd;
	enum pri_protocol new_protocol = PRI_PROTO_0;
	int i;
	int ret;

	BUG_ON(!dev);
	xpd = dev_to_xpd(dev);
	XPD_DBG(GENERAL, xpd, "%s\n", buf);
	if (!xpd)
		return -ENODEV;
	i = strcspn(buf, " \r\n");
	if (i != 2) {
		XPD_NOTICE(xpd,
			"Protocol name '%s' has %d characters (should be 2). "
			"Ignored.\n",
			buf, i);
		return -EINVAL;
	}
	if (strnicmp(buf, "E1", 2) == 0)
		new_protocol = PRI_PROTO_E1;
	else if (strnicmp(buf, "T1", 2) == 0)
		new_protocol = PRI_PROTO_T1;
	else if (strnicmp(buf, "J1", 2) == 0)
		new_protocol = PRI_PROTO_J1;
	else {
		XPD_NOTICE(xpd,
			"Unknown PRI protocol '%s' (should be E1|T1|J1). "
			"Ignored.\n",
			buf);
		return -EINVAL;
	}
	ret = set_pri_proto(xpd, new_protocol);
	return (ret < 0) ? ret : count;
}

static DEVICE_ATTR(pri_protocol, S_IRUGO | S_IWUSR, pri_protocol_show,
		   pri_protocol_store);

static DEVICE_ATTR_READER(pri_localloop_show, dev, buf)
{
	xpd_t *xpd;
	struct PRI_priv_data *priv;
	unsigned long flags;
	int len = 0;

	BUG_ON(!dev);
	xpd = dev_to_xpd(dev);
	if (!xpd)
		return -ENODEV;
	priv = xpd->priv;
	BUG_ON(!priv);
	spin_lock_irqsave(&xpd->lock, flags);
	len += sprintf(buf, "%c\n", (priv->local_loopback) ? 'Y' : 'N');
	spin_unlock_irqrestore(&xpd->lock, flags);
	return len;
}

static DEVICE_ATTR_WRITER(pri_localloop_store, dev, buf, count)
{
	xpd_t *xpd;
	bool ll = 0;
	int i;
	int ret;

	BUG_ON(!dev);
	xpd = dev_to_xpd(dev);
	XPD_DBG(GENERAL, xpd, "%s\n", buf);
	if (!xpd)
		return -ENODEV;
	if ((i = strcspn(buf, " \r\n")) != 1) {
		XPD_NOTICE(xpd,
			"Value '%s' has %d characters (should be 1). Ignored\n",
			buf, i);
		return -EINVAL;
	}
	if (strchr("1Yy", buf[0]) != NULL)
		ll = 1;
	else if (strchr("0Nn", buf[0]) != NULL)
		ll = 0;
	else {
		XPD_NOTICE(xpd,
			"Unknown value '%s' (should be [1Yy]|[0Nn]). Ignored\n",
			buf);
		return -EINVAL;
	}
	ret = set_localloop(xpd, ll);
	return (ret < 0) ? ret : count;
}

static DEVICE_ATTR(pri_localloop, S_IRUGO | S_IWUSR, pri_localloop_show,
		   pri_localloop_store);

static DEVICE_ATTR_READER(pri_layer1_show, dev, buf)
{
	xpd_t *xpd;
	struct PRI_priv_data *priv;
	unsigned long flags;
	int len = 0;

	BUG_ON(!dev);
	xpd = dev_to_xpd(dev);
	if (!xpd)
		return -ENODEV;
	priv = xpd->priv;
	BUG_ON(!priv);
	spin_lock_irqsave(&xpd->lock, flags);
	if (priv->poll_noreplies > 1)
		len += sprintf(buf + len, "Unknown[%d]", priv->poll_noreplies);
	else
		len +=
		    sprintf(buf + len, "%-10s",
			    ((priv->layer1_up) ? "UP" : "DOWN"));
	len += sprintf(buf + len, "%d\n", priv->layer1_replies);
	spin_unlock_irqrestore(&xpd->lock, flags);
	return len;
}

static DEVICE_ATTR(pri_layer1, S_IRUGO, pri_layer1_show, NULL);

static DEVICE_ATTR_READER(pri_alarms_show, dev, buf)
{
	xpd_t *xpd;
	struct PRI_priv_data *priv;
	unsigned long flags;
	int len = 0;
	static const struct {
		__u8 bits;
		const char *name;
	} alarm_types[] = {
		{
		REG_FRS0_LOS, "RED"}, {
		REG_FRS0_AIS, "BLUE"}, {
	REG_FRS0_RRA, "YELLOW"},};

	BUG_ON(!dev);
	xpd = dev_to_xpd(dev);
	if (!xpd)
		return -ENODEV;
	priv = xpd->priv;
	BUG_ON(!priv);
	spin_lock_irqsave(&xpd->lock, flags);
	if (priv->poll_noreplies > 1)
		len += sprintf(buf + len, "Unknown[%d]", priv->poll_noreplies);
	else {
		int i;

		for (i = 0; i < ARRAY_SIZE(alarm_types); i++) {
			if (priv->reg_frs0 & alarm_types[i].bits)
				len +=
				    sprintf(buf + len, "%s ",
					    alarm_types[i].name);
		}
	}
	len += sprintf(buf + len, "\n");
	spin_unlock_irqrestore(&xpd->lock, flags);
	return len;
}

static DEVICE_ATTR(pri_alarms, S_IRUGO, pri_alarms_show, NULL);

static DEVICE_ATTR_READER(pri_cas_show, dev, buf)
{
	xpd_t *xpd;
	struct PRI_priv_data *priv;
	unsigned long flags;
	int len = 0;

	BUG_ON(!dev);
	xpd = dev_to_xpd(dev);
	if (!xpd)
		return -ENODEV;
	priv = xpd->priv;
	BUG_ON(!priv);
	spin_lock_irqsave(&xpd->lock, flags);
	if (priv->is_cas) {
		int i;

		len +=
		    sprintf(buf + len, "CAS: replies=%d\n", priv->cas_replies);
		len += sprintf(buf + len, "   CAS-TS: ");
		for (i = 0; i < NUM_CAS_RS_E; i++) {
			len += sprintf(buf + len, " %02X", priv->cas_ts_e[i]);
		}
		len += sprintf(buf + len, "\n");
		len += sprintf(buf + len, "   CAS-RS: ");
		for (i = 0; i < NUM_CAS_RS_E; i++) {
			len += sprintf(buf + len, " %02X", priv->cas_rs_e[i]);
		}
		len += sprintf(buf + len, "\n");
	}
	spin_unlock_irqrestore(&xpd->lock, flags);
	return len;
}

static DEVICE_ATTR(pri_cas, S_IRUGO, pri_cas_show, NULL);

static DEVICE_ATTR_READER(pri_dchan_show, dev, buf)
{
	xpd_t *xpd;
	struct PRI_priv_data *priv;
	unsigned long flags;
	int len = 0;

	BUG_ON(!dev);
	xpd = dev_to_xpd(dev);
	if (!xpd)
		return -ENODEV;
	priv = xpd->priv;
	BUG_ON(!priv);
	spin_lock_irqsave(&xpd->lock, flags);
	len +=
	    sprintf(buf + len,
		    "D-Channel: TX=[%5d] (0x%02X)   RX=[%5d] (0x%02X) ",
		    priv->dchan_tx_counter, priv->dchan_tx_sample,
		    priv->dchan_rx_counter, priv->dchan_rx_sample);
	if (priv->dchan_alive) {
		len +=
		    sprintf(buf + len, "(alive %d K-ticks)\n",
			    priv->dchan_alive_ticks / 1000);
	} else {
		len += sprintf(buf + len, "(dead)\n");
	}
	spin_unlock_irqrestore(&xpd->lock, flags);
	return len;
}

static DEVICE_ATTR(pri_dchan, S_IRUGO, pri_dchan_show, NULL);

static DEVICE_ATTR_READER(pri_clocking_show, dev, buf)
{
	xpd_t *xpd;
	struct PRI_priv_data *priv;
	unsigned long flags;
	int len = 0;

	BUG_ON(!dev);
	xpd = dev_to_xpd(dev);
	if (!xpd)
		return -ENODEV;
	priv = xpd->priv;
	BUG_ON(!priv);
	spin_lock_irqsave(&xpd->lock, flags);
	len +=
	    sprintf(buf + len, "%s\n",
		    (priv->clock_source) ? "MASTER" : "SLAVE");
	spin_unlock_irqrestore(&xpd->lock, flags);
	return len;
}

static DEVICE_ATTR(pri_clocking, S_IRUGO, pri_clocking_show, NULL);

static int pri_xpd_probe(struct device *dev)
{
	xpd_t *xpd;
	int ret = 0;

	xpd = dev_to_xpd(dev);
	/* Is it our device? */
	if (xpd->type != XPD_TYPE_PRI) {
		XPD_ERR(xpd, "drop suggestion for %s (%d)\n", dev_name(dev),
			xpd->type);
		return -EINVAL;
	}
	XPD_DBG(DEVICES, xpd, "SYSFS\n");
	ret = device_create_file(dev, &dev_attr_pri_protocol);
	if (ret) {
		XPD_ERR(xpd,
			"%s: device_create_file(pri_protocol) failed: %d\n",
			__func__, ret);
		goto fail_pri_protocol;
	}
	ret = device_create_file(dev, &dev_attr_pri_localloop);
	if (ret) {
		XPD_ERR(xpd,
			"%s: device_create_file(pri_localloop) failed: %d\n",
			__func__, ret);
		goto fail_pri_localloop;
	}
	ret = device_create_file(dev, &dev_attr_pri_layer1);
	if (ret) {
		XPD_ERR(xpd, "%s: device_create_file(pri_layer1) failed: %d\n",
			__func__, ret);
		goto fail_pri_layer1;
	}
	ret = device_create_file(dev, &dev_attr_pri_alarms);
	if (ret) {
		XPD_ERR(xpd, "%s: device_create_file(pri_alarms) failed: %d\n",
			__func__, ret);
		goto fail_pri_alarms;
	}
	ret = device_create_file(dev, &dev_attr_pri_cas);
	if (ret) {
		XPD_ERR(xpd, "%s: device_create_file(pri_cas) failed: %d\n",
			__func__, ret);
		goto fail_pri_cas;
	}
	ret = device_create_file(dev, &dev_attr_pri_dchan);
	if (ret) {
		XPD_ERR(xpd, "%s: device_create_file(pri_dchan) failed: %d\n",
			__func__, ret);
		goto fail_pri_dchan;
	}
	ret = device_create_file(dev, &dev_attr_pri_clocking);
	if (ret) {
		XPD_ERR(xpd,
			"%s: device_create_file(pri_clocking) failed: %d\n",
			__func__, ret);
		goto fail_pri_clocking;
	}
	return 0;
fail_pri_clocking:
	device_remove_file(dev, &dev_attr_pri_dchan);
fail_pri_dchan:
	device_remove_file(dev, &dev_attr_pri_cas);
fail_pri_cas:
	device_remove_file(dev, &dev_attr_pri_alarms);
fail_pri_alarms:
	device_remove_file(dev, &dev_attr_pri_layer1);
fail_pri_layer1:
	device_remove_file(dev, &dev_attr_pri_localloop);
fail_pri_localloop:
	device_remove_file(dev, &dev_attr_pri_protocol);
fail_pri_protocol:
	return ret;
}

static int pri_xpd_remove(struct device *dev)
{
	xpd_t *xpd;

	xpd = dev_to_xpd(dev);
	XPD_DBG(DEVICES, xpd, "SYSFS\n");
	device_remove_file(dev, &dev_attr_pri_clocking);
	device_remove_file(dev, &dev_attr_pri_dchan);
	device_remove_file(dev, &dev_attr_pri_cas);
	device_remove_file(dev, &dev_attr_pri_alarms);
	device_remove_file(dev, &dev_attr_pri_layer1);
	device_remove_file(dev, &dev_attr_pri_localloop);
	device_remove_file(dev, &dev_attr_pri_protocol);
	return 0;
}

static struct xpd_driver pri_driver = {
	.type = XPD_TYPE_PRI,
	.driver = {
		   .name = "pri",
#ifndef OLD_HOTPLUG_SUPPORT
		   .owner = THIS_MODULE,
#endif
		   .probe = pri_xpd_probe,
		   .remove = pri_xpd_remove}
};

static int __init card_pri_startup(void)
{
	int ret;

	if ((ret = xpd_driver_register(&pri_driver.driver)) < 0)
		return ret;
	INFO("revision %s\n", XPP_VERSION);
#ifdef	DAHDI_AUDIO_NOTIFY
	INFO("FEATURE: WITH DAHDI_AUDIO_NOTIFY\n");
#else
	INFO("FEATURE: WITHOUT DAHDI_AUDIO_NOTIFY\n");
#endif
	xproto_register(&PROTO_TABLE(PRI));
	return 0;
}

static void __exit card_pri_cleanup(void)
{
	DBG(GENERAL, "\n");
	xproto_unregister(&PROTO_TABLE(PRI));
	xpd_driver_unregister(&pri_driver.driver);
}

MODULE_DESCRIPTION("XPP PRI Card Driver");
MODULE_AUTHOR("Oron Peled <oron@actcom.co.il>");
MODULE_LICENSE("GPL");
MODULE_VERSION(XPP_VERSION);
MODULE_ALIAS_XPD(XPD_TYPE_PRI);

module_init(card_pri_startup);
module_exit(card_pri_cleanup);