summaryrefslogtreecommitdiffstats
path: root/drivers
diff options
context:
space:
mode:
authorRalf Baechle <ralf@linux-mips.org>1997-06-03 09:23:20 +0000
committerRalf Baechle <ralf@linux-mips.org>1997-06-03 09:23:20 +0000
commitac5ff8f4a72f7b4e66f73c3c6cb9fe7758cf6f12 (patch)
tree9fc7f8ce32e0d9a4aa055b2a58a05a5d727b333c /drivers
parent52662ff3e66770fd7e4fc508c91056d29c08bff0 (diff)
Sync with Linux 2.1.42.
Diffstat (limited to 'drivers')
-rw-r--r--drivers/block/ez.c5
-rw-r--r--drivers/cdrom/bpcd.c5
-rw-r--r--drivers/char/istallion.c2
-rw-r--r--drivers/char/lp.c5
-rw-r--r--drivers/char/pc_keyb.c1
-rw-r--r--drivers/char/riscom8.c9
-rw-r--r--drivers/char/selection.c38
-rw-r--r--drivers/char/selection.h13
-rw-r--r--drivers/char/stallion.c8
-rw-r--r--drivers/char/vc_screen.c18
-rw-r--r--drivers/isdn/Config.in8
-rw-r--r--drivers/isdn/Makefile22
-rw-r--r--drivers/isdn/hisax/Makefile10
-rw-r--r--drivers/isdn/hisax/avm_a1.c355
-rw-r--r--drivers/isdn/hisax/callc.c239
-rw-r--r--drivers/isdn/hisax/config.c32
-rw-r--r--drivers/isdn/hisax/elsa.c801
-rw-r--r--drivers/isdn/hisax/elsa.h37
-rw-r--r--drivers/isdn/hisax/fsm.c29
-rw-r--r--drivers/isdn/hisax/hisax.h186
-rw-r--r--drivers/isdn/hisax/isdnl1.c362
-rw-r--r--drivers/isdn/hisax/isdnl1.h14
-rw-r--r--drivers/isdn/hisax/isdnl2.c997
-rw-r--r--drivers/isdn/hisax/isdnl2.h1
-rw-r--r--drivers/isdn/hisax/isdnl3.c50
-rw-r--r--drivers/isdn/hisax/isdnl3.h12
-rw-r--r--drivers/isdn/hisax/ix1_micro.c369
-rw-r--r--drivers/isdn/hisax/l3_1tr6.c432
-rw-r--r--drivers/isdn/hisax/l3dss1.c477
-rw-r--r--drivers/isdn/hisax/q931.c65
-rw-r--r--drivers/isdn/hisax/tei.c55
-rw-r--r--drivers/isdn/hisax/teles0.c426
-rw-r--r--drivers/isdn/hisax/teles3.c450
-rw-r--r--drivers/isdn/icn/icn.c114
-rw-r--r--drivers/isdn/isdn_audio.c22
-rw-r--r--drivers/isdn/isdn_cards.c35
-rw-r--r--drivers/isdn/isdn_common.c591
-rw-r--r--drivers/isdn/isdn_common.h8
-rw-r--r--drivers/isdn/isdn_net.c140
-rw-r--r--drivers/isdn/isdn_ppp.c158
-rw-r--r--drivers/isdn/isdn_tty.c702
-rw-r--r--drivers/isdn/isdn_tty.h17
-rw-r--r--drivers/isdn/pcbit/drv.c8
-rw-r--r--drivers/isdn/sc/Makefile2
-rw-r--r--drivers/isdn/sc/command.c9
-rw-r--r--drivers/isdn/sc/init.c2
-rw-r--r--drivers/isdn/sc/ioctl.c32
-rw-r--r--drivers/net/Config.in10
-rw-r--r--drivers/net/apricot.c22
-rw-r--r--drivers/net/bpqether.c40
-rw-r--r--drivers/net/dgrs.c2
-rw-r--r--drivers/net/lapbether.c22
-rw-r--r--drivers/net/mkiss.c54
-rw-r--r--drivers/net/pi2.c25
-rw-r--r--drivers/net/pt.c17
-rw-r--r--drivers/net/soundmodem/sm.c1
-rw-r--r--drivers/net/soundmodem/sm.h1
-rw-r--r--drivers/net/soundmodem/sm_afsk1200.c2
-rw-r--r--drivers/net/soundmodem/sm_fsk9600.c2
-rw-r--r--drivers/net/soundmodem/sm_hapn4800.c2
-rw-r--r--drivers/net/soundmodem/sm_sbc.c391
-rw-r--r--drivers/sbus/char/sunserial.c8
-rw-r--r--drivers/scsi/advansys.c15866
-rw-r--r--drivers/scsi/advansys.h171
-rw-r--r--drivers/scsi/g_NCR5380.c2
-rw-r--r--drivers/scsi/qlogicpti.c5
-rw-r--r--drivers/scsi/qlogicpti.h1
-rw-r--r--drivers/scsi/scsi.h3
-rw-r--r--drivers/sound/configure.c2
69 files changed, 12542 insertions, 11480 deletions
diff --git a/drivers/block/ez.c b/drivers/block/ez.c
index 82270915d..6c2960a5a 100644
--- a/drivers/block/ez.c
+++ b/drivers/block/ez.c
@@ -176,7 +176,7 @@ static int ez_open(struct inode *inode, struct file *file);
static void do_ez_request(void);
static int ez_ioctl(struct inode *inode,struct file *file,
unsigned int cmd, unsigned long arg);
-static void ez_release (struct inode *inode, struct file *file);
+static int ez_release (struct inode *inode, struct file *file);
static int ez_revalidate(kdev_t dev);
static int ez_check_media(kdev_t dev);
static void ez_get_capacity( void );
@@ -387,7 +387,7 @@ static int ez_ioctl(struct inode *inode,struct file *file,
}
}
-static void ez_release (struct inode *inode, struct file *file)
+static int ez_release (struct inode *inode, struct file *file)
{ kdev_t devp;
@@ -400,6 +400,7 @@ static void ez_release (struct inode *inode, struct file *file)
if (!ez_access) ez_doorlock(IDE_DOORUNLOCK);
MOD_DEC_USE_COUNT;
}
+ return 0;
}
static int ez_check_media( kdev_t dev)
diff --git a/drivers/cdrom/bpcd.c b/drivers/cdrom/bpcd.c
index 9f7e8b395..4ea0f66bc 100644
--- a/drivers/cdrom/bpcd.c
+++ b/drivers/cdrom/bpcd.c
@@ -149,7 +149,7 @@ static void do_bp_request(void);
static void do_bp_read(void);
static int bp_ioctl(struct inode *inode,struct file *file,
unsigned int cmd, unsigned long arg);
-static void bp_release (struct inode *inode, struct file *file);
+static int bp_release (struct inode *inode, struct file *file);
static int bp_detect(void);
static int bp_lock(void);
@@ -277,7 +277,7 @@ static int bp_ioctl(struct inode *inode,struct file *file,
}
}
-static void bp_release (struct inode *inode, struct file *file)
+static int bp_release (struct inode *inode, struct file *file)
{ kdev_t devp;
@@ -290,6 +290,7 @@ static void bp_release (struct inode *inode, struct file *file)
bp_unlock();
}
MOD_DEC_USE_COUNT;
+ return 0;
}
#ifdef MODULE
diff --git a/drivers/char/istallion.c b/drivers/char/istallion.c
index f21693bff..270159480 100644
--- a/drivers/char/istallion.c
+++ b/drivers/char/istallion.c
@@ -2450,7 +2450,7 @@ static inline int stli_hostcmd(stlibrd_t *brdp, stliport_t *portp)
if (! ((portp->flags & ASYNC_CALLOUT_ACTIVE) &&
(portp->flags & ASYNC_CALLOUT_NOHUP))) {
if (tty != (struct tty_struct *) NULL)
- queue_task_irq_off(&portp->tqhangup, &tq_scheduler);
+ queue_task(&portp->tqhangup, &tq_scheduler);
}
}
}
diff --git a/drivers/char/lp.c b/drivers/char/lp.c
index 599ae87fc..5eb52752d 100644
--- a/drivers/char/lp.c
+++ b/drivers/char/lp.c
@@ -501,9 +501,8 @@ static int lp_open(struct inode * inode, struct file * file)
static int lp_release(struct inode * inode, struct file * file)
{
unsigned int minor = MINOR(inode->i_rdev);
- unsigned int irq;
- if ((irq = LP_IRQ(minor))) {
+ if (LP_IRQ(minor) > 0) {
kfree_s(lp_table[minor].lp_buffer, LP_BUFFER_SIZE);
lp_table[minor].lp_buffer = NULL;
}
@@ -707,7 +706,7 @@ __initfunc(int lp_init(void))
lp_table[count].flags |= LP_EXIST;
printk(KERN_INFO "lp%d: using %s at 0x%x, ",
count, pb->name, pb->base);
- if (pb->irq == -1)
+ if (pb->irq == PARPORT_IRQ_NONE)
printk("polling.\n");
else
printk("irq %d.\n", pb->irq);
diff --git a/drivers/char/pc_keyb.c b/drivers/char/pc_keyb.c
index 88dcb1986..2d075636f 100644
--- a/drivers/char/pc_keyb.c
+++ b/drivers/char/pc_keyb.c
@@ -24,7 +24,6 @@
#include <linux/signal.h>
#include <linux/ioport.h>
#include <linux/init.h>
-#include <linux/config.h>
#include <asm/bitops.h>
diff --git a/drivers/char/riscom8.c b/drivers/char/riscom8.c
index dfe150e07..806caf370 100644
--- a/drivers/char/riscom8.c
+++ b/drivers/char/riscom8.c
@@ -337,7 +337,7 @@ extern inline void rc_mark_event(struct riscom_port * port, int event)
* Still hope this will be changed in near future.
*/
set_bit(event, &port->event);
- queue_task_irq_off(&port->tqueue, &tq_riscom);
+ queue_task(&port->tqueue, &tq_riscom);
mark_bh(RISCOM8_BH);
}
@@ -419,7 +419,7 @@ extern inline void rc_receive_exc(struct riscom_board const * bp)
*tty->flip.char_buf_ptr++ = ch;
tty->flip.count++;
- queue_task_irq_off(&tty->flip.tqueue, &tq_timer);
+ queue_task(&tty->flip.tqueue, &tq_timer);
}
extern inline void rc_receive(struct riscom_board const * bp)
@@ -449,7 +449,7 @@ extern inline void rc_receive(struct riscom_board const * bp)
*tty->flip.flag_buf_ptr++ = 0;
tty->flip.count++;
}
- queue_task_irq_off(&tty->flip.tqueue, &tq_timer);
+ queue_task(&tty->flip.tqueue, &tq_timer);
}
extern inline void rc_transmit(struct riscom_board const * bp)
@@ -538,8 +538,7 @@ extern inline void rc_check_modem(struct riscom_board const * bp)
wake_up_interruptible(&port->open_wait);
else if (!((port->flags & ASYNC_CALLOUT_ACTIVE) &&
(port->flags & ASYNC_CALLOUT_NOHUP)))
- queue_task_irq_off(&port->tqueue_hangup,
- &tq_scheduler);
+ queue_task(&port->tqueue_hangup, &tq_scheduler);
}
#ifdef RISCOM_BRAIN_DAMAGED_CTS
diff --git a/drivers/char/selection.c b/drivers/char/selection.c
index 0f1e15b7a..b3f6d1570 100644
--- a/drivers/char/selection.c
+++ b/drivers/char/selection.c
@@ -92,10 +92,11 @@ static inline int inword(const unsigned char c) {
/* set inwordLut contents. Invoked by ioctl(). */
int sel_loadlut(const unsigned long arg)
{
- int i = verify_area(VERIFY_READ, (char *) arg, 36);
- if (i)
- return i;
- copy_from_user(inwordLut, (u32 *)(arg+4), 32);
+ int err;
+
+ err = copy_from_user(inwordLut, (u32 *)(arg+4), 32);
+ if (err)
+ return -EFAULT;
return 0;
}
@@ -120,10 +121,15 @@ int set_selection(const unsigned long arg, struct tty_struct *tty, int user)
int sel_mode, new_sel_start, new_sel_end, spc;
char *bp, *obp;
int i, ps, pe;
+ unsigned long num_lines, num_columns, size_row;
do_unblank_screen();
poke_blanked_console();
+ num_lines = get_video_num_lines(fg_console);
+ num_columns = get_video_num_columns(fg_console);
+ size_row = get_video_size_row(fg_console);
+
{ unsigned short *args, xs, ys, xe, ye;
args = (unsigned short *)(arg + 1);
@@ -145,12 +151,12 @@ int set_selection(const unsigned long arg, struct tty_struct *tty, int user)
sel_mode = *args;
}
xs--; ys--; xe--; ye--;
- xs = limit(xs, video_num_columns - 1);
- ys = limit(ys, video_num_lines - 1);
- xe = limit(xe, video_num_columns - 1);
- ye = limit(ye, video_num_lines - 1);
- ps = ys * video_size_row + (xs << 1);
- pe = ye * video_size_row + (xe << 1);
+ xs = limit(xs, num_columns - 1);
+ ys = limit(ys, num_lines - 1);
+ xe = limit(xe, num_columns - 1);
+ ye = limit(ye, num_lines - 1);
+ ps = ys * size_row + (xs << 1);
+ pe = ye * size_row + (xe << 1);
if (sel_mode == 4) {
/* useful for screendump without selection highlights */
@@ -190,7 +196,7 @@ int set_selection(const unsigned long arg, struct tty_struct *tty, int user)
(!spc && !inword(sel_pos(ps))))
break;
new_sel_start = ps;
- if (!(ps % video_size_row))
+ if (!(ps % size_row))
break;
}
spc = isspace(sel_pos(pe));
@@ -200,14 +206,14 @@ int set_selection(const unsigned long arg, struct tty_struct *tty, int user)
(!spc && !inword(sel_pos(pe))))
break;
new_sel_end = pe;
- if (!((pe + 2) % video_size_row))
+ if (!((pe + 2) % size_row))
break;
}
break;
case 2: /* line-by-line selection */
- new_sel_start = ps - ps % video_size_row;
- new_sel_end = pe + video_size_row
- - pe % video_size_row - 2;
+ new_sel_start = ps - ps % size_row;
+ new_sel_end = pe + size_row
+ - pe % size_row - 2;
break;
case 3:
highlight_pointer(pe);
@@ -268,7 +274,7 @@ int set_selection(const unsigned long arg, struct tty_struct *tty, int user)
*bp = sel_pos(i);
if (!isspace(*bp++))
obp = bp;
- if (! ((i + 2) % video_size_row)) {
+ if (! ((i + 2) % size_row)) {
/* strip trailing blanks from line and add newline,
unless non-space at end of line. */
if (obp != bp) {
diff --git a/drivers/char/selection.h b/drivers/char/selection.h
index a1056490b..4ed656ff9 100644
--- a/drivers/char/selection.h
+++ b/drivers/char/selection.h
@@ -3,6 +3,9 @@
*
* Interface between console.c, tty_io.c, vt.c, vc_screen.c and selection.c
*/
+
+#include <linux/config.h>
+
extern int sel_cons;
extern void clear_selection(void);
@@ -12,6 +15,16 @@ extern int sel_loadlut(const unsigned long arg);
extern int mouse_reporting(void);
extern void mouse_report(struct tty_struct * tty, int butt, int mrx, int mry);
+#ifdef CONFIG_FB_CONSOLE
+extern unsigned long get_video_num_columns(unsigned int console);
+extern unsigned long get_video_num_lines(unsigned int console);
+extern unsigned long get_video_size_row(unsigned int console);
+#else
+#define get_video_num_columns(dummy) video_num_columns
+#define get_video_num_lines(dummy) video_num_lines
+#define get_video_size_row(dummy) video_size_row
+#endif
+
extern unsigned long video_num_columns;
extern unsigned long video_num_lines;
extern unsigned long video_size_row;
diff --git a/drivers/char/stallion.c b/drivers/char/stallion.c
index 7ebb33c14..184a21040 100644
--- a/drivers/char/stallion.c
+++ b/drivers/char/stallion.c
@@ -3301,7 +3301,7 @@ static void stl_cd1400txisr(stlpanel_t *panelp, int ioaddr)
len = (head >= tail) ? (head - tail) : (STL_TXBUFSIZE - (tail - head));
if ((len == 0) || ((len < STL_TXBUFLOW) && (test_bit(ASYI_TXLOW, &portp->istate) == 0))) {
set_bit(ASYI_TXLOW, &portp->istate);
- queue_task_irq_off(&portp->tqueue, &tq_scheduler);
+ queue_task(&portp->tqueue, &tq_scheduler);
}
if (len == 0) {
@@ -3479,7 +3479,7 @@ static void stl_cd1400mdmisr(stlpanel_t *panelp, int ioaddr)
misr = inb(ioaddr + EREG_DATA);
if (misr & MISR_DCD) {
set_bit(ASYI_DCDCHANGE, &portp->istate);
- queue_task_irq_off(&portp->tqueue, &tq_scheduler);
+ queue_task(&portp->tqueue, &tq_scheduler);
portp->stats.modem++;
}
@@ -4159,7 +4159,7 @@ static void stl_sc26198txisr(stlport_t *portp)
len = (head >= tail) ? (head - tail) : (STL_TXBUFSIZE - (tail - head));
if ((len == 0) || ((len < STL_TXBUFLOW) && (test_bit(ASYI_TXLOW, &portp->istate) == 0))) {
set_bit(ASYI_TXLOW, &portp->istate);
- queue_task_irq_off(&portp->tqueue, &tq_scheduler);
+ queue_task(&portp->tqueue, &tq_scheduler);
}
if (len == 0) {
@@ -4377,7 +4377,7 @@ static void stl_sc26198otherisr(stlport_t *portp, unsigned int iack)
ipr = stl_sc26198getreg(portp, IPR);
if (ipr & IPR_DCDCHANGE) {
set_bit(ASYI_DCDCHANGE, &portp->istate);
- queue_task_irq_off(&portp->tqueue, &tq_scheduler);
+ queue_task(&portp->tqueue, &tq_scheduler);
portp->stats.modem++;
}
break;
diff --git a/drivers/char/vc_screen.c b/drivers/char/vc_screen.c
index 71f4e2f84..cb91431dc 100644
--- a/drivers/char/vc_screen.c
+++ b/drivers/char/vc_screen.c
@@ -61,7 +61,19 @@ vcs_size(struct inode *inode)
/* Multimon patch */
if (!vc_cons[currcons].d) return 0;
#endif
- size= video_num_lines * video_num_columns;
+#ifdef CONFIG_FB_CONSOLE
+ int cons = MINOR(inode->i_rdev) & 127;
+
+ if (cons == 0)
+ cons = fg_console;
+ else
+ cons--;
+ if (!vc_cons_allocated(cons))
+ return -ENXIO;
+#endif
+
+ size = get_video_num_lines(cons) * get_video_num_columns(cons);
+
if (MINOR(inode->i_rdev) & 128)
size = 2*size + HEADER_SIZE;
return size;
@@ -128,8 +140,8 @@ vcs_read(struct inode *inode, struct file *file, char *buf, unsigned long count)
} else {
if (p < HEADER_SIZE) {
char header[HEADER_SIZE];
- header[0] = (char) video_num_lines;
- header[1] = (char) video_num_columns;
+ header[0] = (char) get_video_num_lines(currcons);
+ header[1] = (char) get_video_num_columns(currcons);
getconsxy(currcons, header+2);
while (p < HEADER_SIZE && count > 0)
{ count--; put_user(header[p++], buf++); }
diff --git a/drivers/isdn/Config.in b/drivers/isdn/Config.in
index f731a096d..758e30d2b 100644
--- a/drivers/isdn/Config.in
+++ b/drivers/isdn/Config.in
@@ -16,11 +16,17 @@ if [ "$CONFIG_ISDN_DRV_HISAX" != "n" ]; then
bool 'HiSax Support for Teles 16.0/8.0' CONFIG_HISAX_16_0
bool 'HiSax Support for Teles 16.3 or PNP or PCMCIA' CONFIG_HISAX_16_3
bool 'HiSax Support for AVM A1 (Fritz)' CONFIG_HISAX_AVM_A1
- bool 'HiSax Support for Elsa cards' CONFIG_HISAX_ELSA_PCC
+ bool 'HiSax Support for Elsa ISA cards' CONFIG_HISAX_ELSA_PCC
+ bool 'HiSax Support for Elsa PCMCIA card' CONFIG_HISAX_ELSA_PCMCIA
bool 'HiSax Support for ITK ix1-micro Revision 2' CONFIG_HISAX_IX1MICROR2
bool 'HiSax Support for EURO/DSS1' CONFIG_HISAX_EURO
+ bool 'HiSax Support for US/NI-1' CONFIG_HISAX_NI1
bool 'HiSax Support for german 1TR6' CONFIG_HISAX_1TR6
fi
if [ "$CONFIG_EXPERIMENTAL" != "n" ]; then
dep_tristate 'Spellcaster support (EXPERIMENTAL)' CONFIG_ISDN_DRV_SC $CONFIG_ISDN
fi
+dep_tristate 'AVM-B1 with CAPI2.0 support' CONFIG_ISDN_DRV_AVMB1 $CONFIG_ISDN
+if [ "$CONFIG_ISDN_DRV_AVMB1" != "n" ]; then
+ bool 'Verbose reason code reporting (kernel size +=7K)' CONFIG_ISDN_DRV_AVMB1_VERBOSE_REASON
+fi
diff --git a/drivers/isdn/Makefile b/drivers/isdn/Makefile
index e88e81735..6de004157 100644
--- a/drivers/isdn/Makefile
+++ b/drivers/isdn/Makefile
@@ -1,6 +1,6 @@
SUB_DIRS :=
MOD_SUB_DIRS :=
-ALL_SUB_DIRS := icn pcbit hisax
+ALL_SUB_DIRS := icn pcbit hisax avmb1
L_OBJS :=
LX_OBJS :=
@@ -76,5 +76,25 @@ else
endif
endif
+ifeq ($(CONFIG_ISDN_DRV_AVMB1),y)
+ L_OBJS += avmb1/avmb1.o
+ SUB_DIRS += avmb1
+ MOD_SUB_DIRS += avmb1
+else
+ ifeq ($(CONFIG_ISDN_DRV_AVMB1),m)
+ MOD_SUB_DIRS += avmb1
+ endif
+endif
+
+ifeq ($(CONFIG_ISDN_DRV_LOOP),y)
+ L_OBJS += isdnloop/isdnloop.o
+ SUB_DIRS += isdnloop
+ MOD_SUB_DIRS += isdnloop
+else
+ ifeq ($(CONFIG_ISDN_DRV_LOOP),m)
+ MOD_SUB_DIRS += isdnloop
+ endif
+endif
+
include $(TOPDIR)/Rules.make
diff --git a/drivers/isdn/hisax/Makefile b/drivers/isdn/hisax/Makefile
index 0ae107e81..2cc325b1f 100644
--- a/drivers/isdn/hisax/Makefile
+++ b/drivers/isdn/hisax/Makefile
@@ -1,6 +1,6 @@
L_OBJS :=
M_OBJS :=
-O_OBJS := isdnl1.o config.o buffers.o tei.o isdnl2.o isdnl3.o \
+O_OBJS := isdnl1.o config.o tei.o isdnl2.o isdnl3.o \
q931.o callc.o fsm.o
# EXTRA_CFLAGS += -S
@@ -9,6 +9,10 @@ ifeq ($(CONFIG_HISAX_EURO),y)
O_OBJS += l3dss1.o
endif
+ifeq ($(CONFIG_HISAX_NI1),y)
+ O_OBJS += l3ni1.o
+endif
+
ifeq ($(CONFIG_HISAX_1TR6),y)
O_OBJS += l3_1tr6.o
endif
@@ -29,6 +33,10 @@ ifeq ($(CONFIG_HISAX_ELSA_PCC),y)
O_OBJS += elsa.o
endif
+ifeq ($(CONFIG_HISAX_ELSA_PCMCIA),y)
+ O_OBJS += elsa.o
+endif
+
ifeq ($(CONFIG_HISAX_IX1MICROR2),y)
O_OBJS += ix1_micro.o
endif
diff --git a/drivers/isdn/hisax/avm_a1.c b/drivers/isdn/hisax/avm_a1.c
index 32c04dcef..a17549904 100644
--- a/drivers/isdn/hisax/avm_a1.c
+++ b/drivers/isdn/hisax/avm_a1.c
@@ -1,4 +1,4 @@
-/* $Id: avm_a1.c,v 1.4 1997/01/27 15:50:21 keil Exp $
+/* $Id: avm_a1.c,v 1.6 1997/04/13 19:54:07 keil Exp $
* avm_a1.c low level stuff for AVM A1 (Fritz) isdn cards
*
@@ -6,6 +6,12 @@
*
*
* $Log: avm_a1.c,v $
+ * Revision 1.6 1997/04/13 19:54:07 keil
+ * Change in IRQ check delay for SMP
+ *
+ * Revision 1.5 1997/04/06 22:54:10 keil
+ * Using SKB's
+ *
* Revision 1.4 1997/01/27 15:50:21 keil
* SMP proof,cosmetics
*
@@ -28,32 +34,32 @@
#include <linux/kernel_stat.h>
extern const char *CardType[];
-const char *avm_revision = "$Revision: 1.4 $";
+const char *avm_revision = "$Revision: 1.6 $";
#define byteout(addr,val) outb_p(val,addr)
#define bytein(addr) inb_p(addr)
-static inline byte
-readreg(unsigned int adr, byte off)
+static inline u_char
+readreg(unsigned int adr, u_char off)
{
return (bytein(adr + off));
}
static inline void
-writereg(unsigned int adr, byte off, byte data)
+writereg(unsigned int adr, u_char off, u_char data)
{
byteout(adr + off, data);
}
static inline void
-read_fifo(unsigned int adr, byte * data, int size)
+read_fifo(unsigned int adr, u_char * data, int size)
{
insb(adr - 0x400, data, size);
}
static void
-write_fifo(unsigned int adr, byte * data, int size)
+write_fifo(unsigned int adr, u_char * data, int size)
{
outsb(adr - 0x400, data, size);
}
@@ -84,8 +90,9 @@ waitforXFW(int adr)
if (!to)
printk(KERN_WARNING "AVM A1: waitforXFW timeout\n");
}
+
static inline void
-writehscxCMDR(int adr, byte data)
+writehscxCMDR(int adr, u_char data)
{
long flags;
@@ -127,25 +134,22 @@ avm_a1_report(struct IsdnCardState *sp)
static void
hscx_empty_fifo(struct HscxState *hsp, int count)
{
- byte *ptr;
+ u_char *ptr;
struct IsdnCardState *sp = hsp->sp;
- struct BufHeader *ibh = hsp->rcvibh;
long flags;
if ((sp->debug & L1_DEB_HSCX) && !(sp->debug & L1_DEB_HSCX_FIFO))
debugl1(sp, "hscx_empty_fifo");
- if (hsp->rcvptr + count > BUFFER_SIZE(HSCX_RBUF_ORDER,
- HSCX_RBUF_BPPS)) {
+ if (hsp->rcvidx + count > HSCX_BUFMAX) {
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "hscx_empty_fifo: incoming packet too large");
writehscxCMDR(sp->hscx[hsp->hscx], 0x80);
+ hsp->rcvidx = 0;
return;
}
- ptr = DATAPTR(ibh);
- ptr += hsp->rcvptr;
-
- hsp->rcvptr += count;
+ ptr = hsp->rcvbuf + hsp->rcvidx;
+ hsp->rcvidx += count;
save_flags(flags);
cli();
read_fifo(sp->hscx[hsp->hscx], ptr, count);
@@ -166,34 +170,32 @@ static void
hscx_fill_fifo(struct HscxState *hsp)
{
struct IsdnCardState *sp = hsp->sp;
- struct BufHeader *ibh;
int more, count;
- byte *ptr;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_HSCX) && !(sp->debug & L1_DEB_HSCX_FIFO))
debugl1(sp, "hscx_fill_fifo");
- ibh = hsp->xmtibh;
- if (!ibh)
+ if (!hsp->tx_skb)
return;
-
- count = ibh->datasize - hsp->sendptr;
- if (count <= 0)
+ if (hsp->tx_skb->len <= 0)
return;
more = (hsp->mode == 1) ? 1 : 0;
- if (count > 32) {
+ if (hsp->tx_skb->len > 32) {
more = !0;
count = 32;
- }
- ptr = DATAPTR(ibh);
- ptr += hsp->sendptr;
- hsp->sendptr += count;
+ } else
+ count = hsp->tx_skb->len;
waitforXFW(sp->hscx[hsp->hscx]);
save_flags(flags);
cli();
+ ptr = hsp->tx_skb->data;
+ skb_pull(hsp->tx_skb, count);
+ hsp->tx_cnt -= count;
+ hsp->count += count;
write_fifo(sp->hscx[hsp->hscx], ptr, count);
writehscxCMDR(sp->hscx[hsp->hscx], more ? 0x8 : 0xa);
restore_flags(flags);
@@ -209,11 +211,12 @@ hscx_fill_fifo(struct HscxState *hsp)
}
static inline void
-hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
+hscx_interrupt(struct IsdnCardState *sp, u_char val, u_char hscx)
{
- byte r;
+ u_char r;
struct HscxState *hsp = sp->hs + hscx;
- int count, err;
+ struct sk_buff *skb;
+ int count;
char tmp[32];
if (!hsp->init)
@@ -235,79 +238,57 @@ hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
if (!r & 0x20)
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "HSCX CRC error");
- if (hsp->rcvibh)
- BufPoolRelease(hsp->rcvibh);
- hsp->rcvibh = NULL;
writehscxCMDR(sp->hscx[hsp->hscx], 0x80);
- goto afterRME;
+ } else {
+ count = readreg(sp->hscx[hsp->hscx], HSCX_RBCL) & 0x1f;
+ if (count == 0)
+ count = 32;
+ hscx_empty_fifo(hsp, count);
+ if ((count = hsp->rcvidx - 1) > 0) {
+ if (!(skb = dev_alloc_skb(count)))
+ printk(KERN_WARNING "AVM: receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, count), hsp->rcvbuf, count);
+ skb_queue_tail(&hsp->rqueue, skb);
+ }
+ }
}
- if (!hsp->rcvibh)
- if (BufPoolGet(&hsp->rcvibh, &hsp->rbufpool,
- GFP_ATOMIC, (void *) 1, 1)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "HSCX RME out of buffers");
- writehscxCMDR(sp->hscx[hsp->hscx], 0x80);
- goto afterRME;
- } else
- hsp->rcvptr = 0;
-
- count = readreg(sp->hscx[hsp->hscx], HSCX_RBCL) & 0x1f;
- if (count == 0)
- count = 32;
- hscx_empty_fifo(hsp, count);
- hsp->rcvibh->datasize = hsp->rcvptr - 1;
- BufQueueLink(&hsp->rq, hsp->rcvibh);
- hsp->rcvibh = NULL;
+ hsp->rcvidx = 0;
hscx_sched_event(hsp, HSCX_RCVBUFREADY);
}
- afterRME:
if (val & 0x40) { /* RPF */
- if (!hsp->rcvibh) {
- if (hsp->mode == 1)
- err = BufPoolGet(&hsp->rcvibh, &hsp->smallpool,
- GFP_ATOMIC, (void *) 1, 2);
- else
- err = BufPoolGet(&hsp->rcvibh, &hsp->rbufpool,
- GFP_ATOMIC, (void *) 1, 2);
-
- if (err) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "HSCX RPF out of buffers");
- writehscxCMDR(sp->hscx[hsp->hscx], 0x80);
- goto afterRPF;
- } else
- hsp->rcvptr = 0;
- }
hscx_empty_fifo(hsp, 32);
if (hsp->mode == 1) {
/* receive audio data */
- hsp->rcvibh->datasize = hsp->rcvptr;
- BufQueueLink(&hsp->rq, hsp->rcvibh);
- hsp->rcvibh = NULL;
+ if (!(skb = dev_alloc_skb(32)))
+ printk(KERN_WARNING "AVM: receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, 32), hsp->rcvbuf, 32);
+ skb_queue_tail(&hsp->rqueue, skb);
+ }
+ hsp->rcvidx = 0;
hscx_sched_event(hsp, HSCX_RCVBUFREADY);
}
}
- afterRPF:
if (val & 0x10) { /* XPR */
- if (hsp->xmtibh)
- if (hsp->xmtibh->datasize > hsp->sendptr) {
+ if (hsp->tx_skb)
+ if (hsp->tx_skb->len) {
hscx_fill_fifo(hsp);
- goto afterXPR;
+ return;
} else {
- if (hsp->releasebuf)
- BufPoolRelease(hsp->xmtibh);
- hsp->sendptr = 0;
+ SET_SKB_FREE(hsp->tx_skb);
+ dev_kfree_skb(hsp->tx_skb, FREE_WRITE);
+ hsp->count = 0;
if (hsp->st->l4.l1writewakeup)
hsp->st->l4.l1writewakeup(hsp->st);
- hsp->xmtibh = NULL;
+ hsp->tx_skb = NULL;
}
- if (!BufQueueUnlink(&hsp->xmtibh, &hsp->sq)) {
- hsp->releasebuf = !0;
+ if ((hsp->tx_skb = skb_dequeue(&hsp->squeue))) {
+ hsp->count = 0;
hscx_fill_fifo(hsp);
} else
hscx_sched_event(hsp, HSCX_XMTBUFREADY);
}
- afterXPR:
}
/*
@@ -317,26 +298,26 @@ hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
static void
isac_empty_fifo(struct IsdnCardState *sp, int count)
{
- byte *ptr;
- struct BufHeader *ibh = sp->rcvibh;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_ISAC) && !(sp->debug & L1_DEB_ISAC_FIFO))
if (sp->debug & L1_DEB_ISAC)
debugl1(sp, "isac_empty_fifo");
- if (sp->rcvptr >= 3072) {
+ if ((sp->rcvidx + count) >= MAX_DFRAME_LEN) {
if (sp->debug & L1_DEB_WARN) {
char tmp[40];
- sprintf(tmp, "isac_empty_fifo rcvptr %d", sp->rcvptr);
+ sprintf(tmp, "isac_empty_fifo overrun %d",
+ sp->rcvidx + count);
debugl1(sp, tmp);
}
+ writereg(sp->isac, ISAC_CMDR, 0x80);
+ sp->rcvidx = 0;
return;
}
- ptr = DATAPTR(ibh);
- ptr += sp->rcvptr;
- sp->rcvptr += count;
-
+ ptr = sp->rcvbuf + sp->rcvidx;
+ sp->rcvidx += count;
save_flags(flags);
cli();
read_fifo(sp->isac, ptr, count);
@@ -355,35 +336,30 @@ isac_empty_fifo(struct IsdnCardState *sp, int count)
static void
isac_fill_fifo(struct IsdnCardState *sp)
{
- struct BufHeader *ibh;
int count, more;
- byte *ptr;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_ISAC) && !(sp->debug & L1_DEB_ISAC_FIFO))
debugl1(sp, "isac_fill_fifo");
- ibh = sp->xmtibh;
- if (!ibh)
+ if (!sp->tx_skb)
return;
- count = ibh->datasize - sp->sendptr;
+ count = sp->tx_skb->len;
if (count <= 0)
return;
- if (count >= 3072)
- return;
more = 0;
if (count > 32) {
more = !0;
count = 32;
}
- ptr = DATAPTR(ibh);
- ptr += sp->sendptr;
- sp->sendptr += count;
-
save_flags(flags);
cli();
+ ptr = sp->tx_skb->data;
+ skb_pull(sp->tx_skb, count);
+ sp->tx_cnt += count;
write_fifo(sp->isac, ptr, count);
writereg(sp->isac, ISAC_CMDR, more ? 0x8 : 0xa);
restore_flags(flags);
@@ -410,9 +386,10 @@ ph_command(struct IsdnCardState *sp, unsigned int command)
static inline void
-isac_interrupt(struct IsdnCardState *sp, byte val)
+isac_interrupt(struct IsdnCardState *sp, u_char val)
{
- byte exval;
+ u_char exval;
+ struct sk_buff *skb;
unsigned int count;
char tmp[32];
@@ -429,62 +406,45 @@ isac_interrupt(struct IsdnCardState *sp, byte val)
if (!exval & 0x20)
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "ISAC CRC error");
- if (sp->rcvibh)
- BufPoolRelease(sp->rcvibh);
- sp->rcvibh = NULL;
writereg(sp->isac, ISAC_CMDR, 0x80);
- goto afterRME;
+ } else {
+ count = readreg(sp->isac, ISAC_RBCL) & 0x1f;
+ if (count == 0)
+ count = 32;
+ isac_empty_fifo(sp, count);
+ if ((count = sp->rcvidx) > 0) {
+ if (!(skb = alloc_skb(count, GFP_ATOMIC)))
+ printk(KERN_WARNING "AVM: D receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, count), sp->rcvbuf, count);
+ skb_queue_tail(&sp->rq, skb);
+ }
+ }
}
- if (!sp->rcvibh)
- if (BufPoolGet(&(sp->rcvibh), &(sp->rbufpool),
- GFP_ATOMIC, (void *) 1, 3)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "ISAC RME out of buffers!");
- writereg(sp->isac, ISAC_CMDR, 0x80);
- goto afterRME;
- } else
- sp->rcvptr = 0;
- count = readreg(sp->isac, ISAC_RBCL) & 0x1f;
- if (count == 0)
- count = 32;
- isac_empty_fifo(sp, count);
- sp->rcvibh->datasize = sp->rcvptr;
- BufQueueLink(&(sp->rq), sp->rcvibh);
- sp->rcvibh = NULL;
+ sp->rcvidx = 0;
isac_sched_event(sp, ISAC_RCVBUFREADY);
}
- afterRME:
if (val & 0x40) { /* RPF */
- if (!sp->rcvibh)
- if (BufPoolGet(&(sp->rcvibh), &(sp->rbufpool),
- GFP_ATOMIC, (void *) 1, 4)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "ISAC RME out of buffers!");
- writereg(sp->isac, ISAC_CMDR, 0x80);
- goto afterRPF;
- } else
- sp->rcvptr = 0;
isac_empty_fifo(sp, 32);
}
- afterRPF:
if (val & 0x20) { /* RSC */
/* never */
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "ISAC RSC interrupt");
}
if (val & 0x10) { /* XPR */
- if (sp->xmtibh)
- if (sp->xmtibh->datasize > sp->sendptr) {
+ if (sp->tx_skb)
+ if (sp->tx_skb->len) {
isac_fill_fifo(sp);
goto afterXPR;
} else {
- if (sp->releasebuf)
- BufPoolRelease(sp->xmtibh);
- sp->xmtibh = NULL;
- sp->sendptr = 0;
+ SET_SKB_FREE(sp->tx_skb);
+ dev_kfree_skb(sp->tx_skb, FREE_WRITE);
+ sp->tx_cnt = 0;
+ sp->tx_skb = NULL;
}
- if (!BufQueueUnlink(&sp->xmtibh, &sp->sq)) {
- sp->releasebuf = !0;
+ if ((sp->tx_skb = skb_dequeue(&sp->sq))) {
+ sp->tx_cnt = 0;
isac_fill_fifo(sp);
} else
isac_sched_event(sp, ISAC_XMTBUFREADY);
@@ -514,10 +474,10 @@ isac_interrupt(struct IsdnCardState *sp, byte val)
}
static inline void
-hscx_int_main(struct IsdnCardState *sp, byte val)
+hscx_int_main(struct IsdnCardState *sp, u_char val)
{
- byte exval;
+ u_char exval;
struct HscxState *hsp;
char tmp[32];
@@ -532,7 +492,11 @@ hscx_int_main(struct IsdnCardState *sp, byte val)
/* Here we lost an TX interrupt, so
* restart transmitting the whole frame.
*/
- hsp->sendptr = 0;
+ if (hsp->tx_skb) {
+ skb_push(hsp->tx_skb, hsp->count);
+ hsp->tx_cnt += hsp->count;
+ hsp->count = 0;
+ }
writehscxCMDR(sp->hscx[hsp->hscx], 0x01);
if (sp->debug & L1_DEB_WARN) {
sprintf(tmp, "HSCX B EXIR %x Lost TX", exval);
@@ -561,7 +525,11 @@ hscx_int_main(struct IsdnCardState *sp, byte val)
/* Here we lost an TX interrupt, so
* restart transmitting the whole frame.
*/
- hsp->sendptr = 0;
+ if (hsp->tx_skb) {
+ skb_push(hsp->tx_skb, hsp->count);
+ hsp->tx_cnt += hsp->count;
+ hsp->count = 0;
+ }
writehscxCMDR(sp->hscx[hsp->hscx], 0x01);
if (sp->debug & L1_DEB_WARN) {
sprintf(tmp, "HSCX A EXIR %x Lost TX", exval);
@@ -587,7 +555,7 @@ static void
avm_a1_interrupt(int intno, void *dev_id, struct pt_regs *regs)
{
struct IsdnCardState *sp;
- byte val, sval, stat = 0;
+ u_char val, sval, stat = 0;
char tmp[32];
sp = (struct IsdnCardState *) irq2dev_map[intno];
@@ -675,48 +643,48 @@ modehscx(struct HscxState *hs, int mode, int ichan)
writereg(sp->hscx[hscx], HSCX_RLCR, 0x0);
switch (mode) {
- case (0):
- writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0xff);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0xff);
- writereg(sp->hscx[hscx], HSCX_XCCR, 7);
- writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- writereg(sp->hscx[hscx], HSCX_MODE, 0x84);
- break;
- case (1):
- if (ichan == 0) {
- writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0x2f);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0x2f);
- writereg(sp->hscx[hscx], HSCX_XCCR, 7);
- writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- } else {
- writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0x3);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0x3);
- writereg(sp->hscx[hscx], HSCX_XCCR, 7);
- writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- }
- writereg(sp->hscx[hscx], HSCX_MODE, 0xe4);
- writereg(sp->hscx[hscx], HSCX_CMDR, 0x41);
- break;
- case (2):
- if (ichan == 0) {
- writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0x2f);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0x2f);
- writereg(sp->hscx[hscx], HSCX_XCCR, 7);
- writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- } else {
+ case (0):
writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0x3);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0x3);
+ writereg(sp->hscx[hscx], HSCX_TSAX, 0xff);
+ writereg(sp->hscx[hscx], HSCX_TSAR, 0xff);
writereg(sp->hscx[hscx], HSCX_XCCR, 7);
writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- }
- writereg(sp->hscx[hscx], HSCX_MODE, 0x8c);
- writereg(sp->hscx[hscx], HSCX_CMDR, 0x41);
- break;
+ writereg(sp->hscx[hscx], HSCX_MODE, 0x84);
+ break;
+ case (1):
+ if (ichan == 0) {
+ writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
+ writereg(sp->hscx[hscx], HSCX_TSAX, 0x2f);
+ writereg(sp->hscx[hscx], HSCX_TSAR, 0x2f);
+ writereg(sp->hscx[hscx], HSCX_XCCR, 7);
+ writereg(sp->hscx[hscx], HSCX_RCCR, 7);
+ } else {
+ writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
+ writereg(sp->hscx[hscx], HSCX_TSAX, 0x3);
+ writereg(sp->hscx[hscx], HSCX_TSAR, 0x3);
+ writereg(sp->hscx[hscx], HSCX_XCCR, 7);
+ writereg(sp->hscx[hscx], HSCX_RCCR, 7);
+ }
+ writereg(sp->hscx[hscx], HSCX_MODE, 0xe4);
+ writereg(sp->hscx[hscx], HSCX_CMDR, 0x41);
+ break;
+ case (2):
+ if (ichan == 0) {
+ writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
+ writereg(sp->hscx[hscx], HSCX_TSAX, 0x2f);
+ writereg(sp->hscx[hscx], HSCX_TSAR, 0x2f);
+ writereg(sp->hscx[hscx], HSCX_XCCR, 7);
+ writereg(sp->hscx[hscx], HSCX_RCCR, 7);
+ } else {
+ writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
+ writereg(sp->hscx[hscx], HSCX_TSAX, 0x3);
+ writereg(sp->hscx[hscx], HSCX_TSAR, 0x3);
+ writereg(sp->hscx[hscx], HSCX_XCCR, 7);
+ writereg(sp->hscx[hscx], HSCX_RCCR, 7);
+ }
+ writereg(sp->hscx[hscx], HSCX_MODE, 0x8c);
+ writereg(sp->hscx[hscx], HSCX_CMDR, 0x41);
+ break;
}
writereg(sp->hscx[hscx], HSCX_ISTA, 0x00);
}
@@ -801,6 +769,7 @@ int
initavm_a1(struct IsdnCardState *sp)
{
int ret;
+ int loop = 0;
char tmp[40];
sp->counter = kstat.interrupts[sp->irq];
@@ -812,6 +781,16 @@ initavm_a1(struct IsdnCardState *sp)
initisac(sp);
sp->modehscx(sp->hs, 0, 0);
sp->modehscx(sp->hs + 1, 0, 0);
+ while (loop++ < 10) {
+ /* At least 1-3 irqs must happen
+ * (one from HSCX A, one from HSCX B, 3rd from ISAC)
+ */
+ if (kstat.interrupts[sp->irq] > sp->counter)
+ break;
+ current->state = TASK_INTERRUPTIBLE;
+ current->timeout = jiffies + 1;
+ schedule();
+ }
sprintf(tmp, "IRQ %d count %d", sp->irq,
kstat.interrupts[sp->irq]);
debugl1(sp, tmp);
@@ -830,7 +809,7 @@ initavm_a1(struct IsdnCardState *sp)
int
setup_avm_a1(struct IsdnCard *card)
{
- byte val, verA, verB;
+ u_char val, verA, verB;
struct IsdnCardState *sp = card->sp;
long flags;
char tmp[64];
diff --git a/drivers/isdn/hisax/callc.c b/drivers/isdn/hisax/callc.c
index fc1868f43..dc29bdf79 100644
--- a/drivers/isdn/hisax/callc.c
+++ b/drivers/isdn/hisax/callc.c
@@ -1,4 +1,4 @@
-/* $Id: callc.c,v 1.20 1997/02/17 00:32:47 keil Exp $
+/* $Id: callc.c,v 1.29 1997/04/23 20:09:49 fritz Exp $
* Author Karsten Keil (keil@temic-ech.spacenet.de)
* based on the teles driver from Jan den Ouden
@@ -7,6 +7,34 @@
* Fritz Elfert
*
* $Log: callc.c,v $
+ * Revision 1.29 1997/04/23 20:09:49 fritz
+ * Removed tmp, used by removed debugging code.
+ *
+ * Revision 1.28 1997/04/21 13:42:25 keil
+ * Remove unneeded debug
+ *
+ * Revision 1.27 1997/04/16 14:21:01 keil
+ * remove unused variable
+ *
+ * Revision 1.26 1997/04/13 19:55:21 keil
+ * Changes in debugging code
+ *
+ * Revision 1.25 1997/04/06 22:54:08 keil
+ * Using SKB's
+ *
+ * Revision 1.24 1997/03/05 11:28:03 keil
+ * fixed undefined l2tei procedure
+ * a layer1 release delete now the drel timer
+ *
+ * Revision 1.23 1997/03/04 23:07:42 keil
+ * bugfix dial parameter
+ *
+ * Revision 1.22 1997/02/27 13:51:55 keil
+ * Reset B-channel (dlc) statemachine in every release
+ *
+ * Revision 1.21 1997/02/19 09:24:27 keil
+ * Bugfix: Hangup to LL if a ttyI rings
+ *
* Revision 1.20 1997/02/17 00:32:47 keil
* Bugfix: No Busy reported to LL
*
@@ -81,7 +109,7 @@ extern long mod_use_count_;
#endif
#endif /* MODULE */
-const char *l4_revision = "$Revision: 1.20 $";
+const char *l4_revision = "$Revision: 1.29 $";
extern struct IsdnCard cards[];
extern int nrcards;
@@ -304,18 +332,18 @@ static inline void
l4_deliver_cause(struct Channel *chanp)
{
isdn_ctrl ic;
-
- if (chanp->para.cause<0)
+
+ if (chanp->para.cause < 0)
return;
ic.driver = chanp->sp->myid;
ic.command = ISDN_STAT_CAUSE;
ic.arg = chanp->chan;
if (chanp->sp->protocol == ISDN_PTYPE_EURO)
- sprintf(ic.parm.num, "E%02X%02X", chanp->para.loc,
- chanp->para.cause);
+ sprintf(ic.parm.num, "E%02X%02X", chanp->para.loc & 0x7f,
+ chanp->para.cause & 0x7f);
else
- sprintf(ic.parm.num, "%02X%02X", chanp->para.loc,
- chanp->para.cause);
+ sprintf(ic.parm.num, "%02X%02X", chanp->para.loc & 0x7f,
+ chanp->para.cause & 0x7f);
chanp->sp->iif.statcallb(&ic);
}
@@ -325,15 +353,11 @@ l4_deliver_cause(struct Channel *chanp)
static void
l4_prep_dialout(struct FsmInst *fi, int event, void *arg)
{
- isdn_ctrl *ic = arg;
struct Channel *chanp = fi->userdata;
FsmChangeState(fi, ST_OUT_WAIT_D);
FsmDelTimer(&chanp->drel_timer, 60);
FsmDelTimer(&chanp->dial_timer, 73);
- chanp->para.setup = ic->parm.setup;
- if (!strcmp(chanp->para.setup.eazmsn, "0"))
- chanp->para.setup.eazmsn[0] = '\0';
chanp->l2_active_protocol = chanp->l2_protocol;
chanp->incoming = 0;
@@ -614,8 +638,9 @@ l4_go_null(struct FsmInst *fi, int event, void *arg)
{
struct Channel *chanp = fi->userdata;
- chanp->Flags = 0;
FsmChangeState(fi, ST_NULL);
+ chanp->Flags = 0;
+ FsmDelTimer(&chanp->drel_timer, 63);
}
static void
@@ -718,11 +743,9 @@ l4_received_d_rel(struct FsmInst *fi, int event, void *arg)
release_ds(chanp);
RESBIT(chanp->Flags, FLG_START_B);
}
- if (chanp->Flags & (FLG_LL_DCONN | FLG_CALL_SEND)) {
+ if (chanp->Flags & (FLG_LL_DCONN | FLG_CALL_SEND | FLG_CALL_ALERT)) {
if (chanp->debug & 1)
link_debug(chanp, "STAT_DHUP", 0);
- RESBIT(chanp->Flags, FLG_LL_DCONN);
- RESBIT(chanp->Flags, FLG_CALL_SEND);
l4_deliver_cause(chanp);
ic.driver = chanp->sp->myid;
ic.command = ISDN_STAT_DHUP;
@@ -734,6 +757,8 @@ l4_received_d_rel(struct FsmInst *fi, int event, void *arg)
RESBIT(chanp->Flags, FLG_DISC_SEND);
RESBIT(chanp->Flags, FLG_CALL_REC);
RESBIT(chanp->Flags, FLG_CALL_ALERT);
+ RESBIT(chanp->Flags, FLG_LL_DCONN);
+ RESBIT(chanp->Flags, FLG_CALL_SEND);
}
static void
@@ -762,11 +787,9 @@ l4_received_d_relcnf(struct FsmInst *fi, int event, void *arg)
release_ds(chanp);
RESBIT(chanp->Flags, FLG_START_B);
}
- if (chanp->Flags & (FLG_LL_DCONN | FLG_CALL_SEND)) {
+ if (chanp->Flags & (FLG_LL_DCONN | FLG_CALL_SEND | FLG_CALL_ALERT)) {
if (chanp->debug & 1)
link_debug(chanp, "STAT_DHUP", 0);
- RESBIT(chanp->Flags, FLG_LL_DCONN);
- RESBIT(chanp->Flags, FLG_CALL_SEND);
l4_deliver_cause(chanp);
ic.driver = chanp->sp->myid;
ic.command = ISDN_STAT_DHUP;
@@ -778,6 +801,8 @@ l4_received_d_relcnf(struct FsmInst *fi, int event, void *arg)
RESBIT(chanp->Flags, FLG_DISC_SEND);
RESBIT(chanp->Flags, FLG_CALL_REC);
RESBIT(chanp->Flags, FLG_CALL_ALERT);
+ RESBIT(chanp->Flags, FLG_LL_DCONN);
+ RESBIT(chanp->Flags, FLG_CALL_SEND);
}
static void
@@ -802,18 +827,17 @@ l4_received_d_disc(struct FsmInst *fi, int event, void *arg)
release_ds(chanp);
RESBIT(chanp->Flags, FLG_START_B);
}
- if (chanp->Flags & (FLG_LL_DCONN | FLG_CALL_SEND)) {
+ if (chanp->Flags & (FLG_LL_DCONN | FLG_CALL_SEND | FLG_CALL_ALERT)) {
if (chanp->debug & 1)
link_debug(chanp, "STAT_DHUP", 0);
- RESBIT(chanp->Flags, FLG_LL_DCONN);
- RESBIT(chanp->Flags, FLG_CALL_SEND);
- RESBIT(chanp->Flags, FLG_CALL_ALERT);
l4_deliver_cause(chanp);
ic.driver = chanp->sp->myid;
ic.command = ISDN_STAT_DHUP;
ic.arg = chanp->chan;
chanp->sp->iif.statcallb(&ic);
}
+ RESBIT(chanp->Flags, FLG_LL_DCONN);
+ RESBIT(chanp->Flags, FLG_CALL_SEND);
RESBIT(chanp->Flags, FLG_CALL_ALERT);
chanp->is.l4.l4l3(&chanp->is, CC_RELEASE_REQ, NULL);
}
@@ -964,11 +988,11 @@ l4_active_dlrl(struct FsmInst *fi, int event, void *arg)
link_debug(chanp, "STAT_DHUP", 0);
RESBIT(chanp->Flags, FLG_LL_DCONN);
if (chanp->sp->protocol == ISDN_PTYPE_EURO) {
- chanp->para.cause = 0x2f;
- chanp->para.loc = 0;
+ chanp->para.cause = 0x2f;
+ chanp->para.loc = 0;
} else {
- chanp->para.cause = 0x70;
- chanp->para.loc = 0;
+ chanp->para.cause = 0x70;
+ chanp->para.loc = 0;
}
l4_deliver_cause(chanp);
ic.driver = chanp->sp->myid;
@@ -986,6 +1010,7 @@ static struct FsmNode fnlist[] =
{ST_NULL, EV_DIAL, l4_prep_dialout},
{ST_NULL, EV_SETUP_IND, l4_start_dchan},
{ST_NULL, EV_SHUTDOWN_D, l4_shutdown_d},
+ {ST_NULL, EV_DLRL, l4_go_null},
{ST_OUT_WAIT_D, EV_DLEST, l4_do_dialout},
{ST_OUT_WAIT_D, EV_DLRL, l4_no_dchan},
{ST_OUT_WAIT_D, EV_HANGUP, l4_no_dchan},
@@ -1057,10 +1082,6 @@ static struct FsmNode fnlist[] =
-
-
-
-
#define FNCOUNT (sizeof(fnlist)/sizeof(struct FsmNode))
static void
@@ -1194,6 +1215,9 @@ static struct FsmNode LcFnList[] =
+
+
+
#define LC_FN_COUNT (sizeof(LcFnList)/sizeof(struct FsmNode))
void
@@ -1240,6 +1264,9 @@ release_ds(struct Channel *chanp)
releasestack_transl2(st);
break;
}
+ /* Reset B-Channel Statemachine */
+ FsmDelTimer(&chanp->lc_b.act_timer, 79);
+ FsmChangeState(&chanp->lc_b.lcfi, ST_LC_NULL);
}
static void
@@ -1306,8 +1333,18 @@ dcc_l2man(struct PStack *st, int pr, void *arg)
}
static void
-ll_handler(struct PStack *st, int pr,
- struct BufHeader *ibh)
+l2tei_dummy(struct PStack *st, int pr, void *arg)
+{
+ struct Channel *chanp = (struct Channel *) st->l4.userdata;
+ char tmp[64], tm[32];
+
+ jiftime(tm, jiffies);
+ sprintf(tmp, "%s Channel %d Warning! Dummy l2tei called pr=%d\n", tm, chanp->chan, pr);
+ HiSax_putstatus(chanp->sp, tmp);
+}
+
+static void
+ll_handler(struct PStack *st, int pr, void *arg)
{
struct Channel *chanp = (struct Channel *) st->l4.userdata;
char tmp[64], tm[32];
@@ -1347,9 +1384,12 @@ ll_handler(struct PStack *st, int pr,
FsmEvent(&chanp->fi, EV_RELEASE_ERR, NULL);
break;
default:
- jiftime(tm, jiffies);
- sprintf(tmp, "%s Channel %d L3->L4 unknown primitiv %d\n", tm, chanp->chan, pr);
- HiSax_putstatus(chanp->sp, tmp);
+ if (chanp->debug & 2048) {
+ jiftime(tm, jiffies);
+ sprintf(tmp, "%s Channel %d L3->L4 unknown primitiv %d\n",
+ tm, chanp->chan, pr);
+ HiSax_putstatus(chanp->sp, tmp);
+ }
}
}
@@ -1525,7 +1565,6 @@ release_is(struct Channel *chanp)
releasestack_isdnl2(st);
releasestack_isdnl3(st);
HiSax_rmlist(st->l1.hardware, st);
- BufQueueRelease(&st->l2.i_queue);
}
void
@@ -1546,23 +1585,19 @@ CallcFreeChan(struct IsdnCardState *csta)
}
static void
-lldata_handler(struct PStack *st, int pr,
- void *arg)
+lldata_handler(struct PStack *st, int pr, void *arg)
{
struct Channel *chanp = (struct Channel *) st->l4.userdata;
- byte *ptr;
- int size;
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
switch (pr) {
case (DL_DATA):
- if (chanp->data_open) {
- ptr = DATAPTR(ibh);
- ptr += chanp->ds.l2.ihsize;
- size = ibh->datasize - chanp->ds.l2.ihsize;
- chanp->sp->iif.rcvcallb(chanp->sp->myid, chanp->chan, ptr, size);
+ if (chanp->data_open)
+ chanp->sp->iif.rcvcallb_skb(chanp->sp->myid, chanp->chan, skb);
+ else {
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
}
- BufPoolRelease(ibh);
break;
default:
printk(KERN_WARNING "lldata_handler unknown primitive %d\n",
@@ -1572,19 +1607,19 @@ lldata_handler(struct PStack *st, int pr,
}
static void
-lltrans_handler(struct PStack *st, int pr,
- struct BufHeader *ibh)
+lltrans_handler(struct PStack *st, int pr, void *arg)
{
struct Channel *chanp = (struct Channel *) st->l4.userdata;
- byte *ptr;
+ struct sk_buff *skb = arg;
switch (pr) {
case (PH_DATA):
- if (chanp->data_open) {
- ptr = DATAPTR(ibh);
- chanp->sp->iif.rcvcallb(chanp->sp->myid, chanp->chan, ptr, ibh->datasize);
+ if (chanp->data_open)
+ chanp->sp->iif.rcvcallb_skb(chanp->sp->myid, chanp->chan, skb);
+ else {
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
}
- BufPoolRelease(ibh);
break;
default:
printk(KERN_WARNING "lltrans_handler unknown primitive %d\n",
@@ -1616,7 +1651,6 @@ init_ds(struct Channel *chanp, int incoming)
st->l1.hardware = sp;
hsp->mode = 2;
- hsp->transbufsize = 4000;
if (setstack_hscx(st, hsp))
return (-1);
@@ -1637,6 +1671,7 @@ init_ds(struct Channel *chanp, int incoming)
st->l2.l2l3 = lldata_handler;
st->l1.l1man = dcc_l1man;
st->l2.l2man = dcc_l2man;
+ st->l2.l2tei = l2tei_dummy;
st->l4.userdata = chanp;
st->l4.l1writewakeup = NULL;
st->l4.l2writewakeup = ll_writewakeup;
@@ -1726,16 +1761,19 @@ HiSax_command(isdn_ctrl * ic)
if (chanp->debug & 1) {
sprintf(tmp, "DIAL %s -> %s (%d,%d)",
ic->parm.setup.eazmsn, ic->parm.setup.phone,
- ic->parm.setup.si1, ic->parm.setup.si2);
+ ic->parm.setup.si1, ic->parm.setup.si2);
link_debug(chanp, tmp, 1);
}
+ chanp->para.setup = ic->parm.setup;
+ if (!strcmp(chanp->para.setup.eazmsn, "0"))
+ chanp->para.setup.eazmsn[0] = '\0';
/* this solution is dirty and may be change, if
* we make a callreference based callmanager */
if (chanp->fi.state == ST_NULL) {
- FsmEvent(&chanp->fi, EV_DIAL, ic);
+ FsmEvent(&chanp->fi, EV_DIAL, NULL);
} else {
FsmDelTimer(&chanp->dial_timer, 70);
- FsmAddTimer(&chanp->dial_timer, 50, EV_DIAL, ic, 71);
+ FsmAddTimer(&chanp->dial_timer, 50, EV_DIAL, NULL, 71);
}
break;
case (ISDN_CMD_ACCEPTB):
@@ -1849,7 +1887,7 @@ HiSax_command(isdn_ctrl * ic)
case (11):
csta->debug = *(unsigned int *) ic->parm.num;
sprintf(tmp, "l1 debugging flags card %d set to %x\n",
- csta->cardnr + 1, csta->debug);
+ csta->cardnr + 1, csta->debug);
HiSax_putstatus(cards[0].sp, tmp);
printk(KERN_DEBUG "HiSax: %s", tmp);
break;
@@ -1875,14 +1913,14 @@ HiSax_command(isdn_ctrl * ic)
}
int
-HiSax_writebuf(int id, int chan, const u_char * buf, int count, int user)
+HiSax_writebuf_skb(int id, int chan, struct sk_buff *skb)
{
struct IsdnCardState *csta = hisax_findcard(id);
struct Channel *chanp;
struct PStack *st;
- struct BufHeader *ibh;
- int err, i;
- byte *ptr;
+ int len = skb->len;
+ unsigned long flags;
+ struct sk_buff *nskb;
char tmp[64];
if (!csta) {
@@ -1896,51 +1934,38 @@ HiSax_writebuf(int id, int chan, const u_char * buf, int count, int user)
link_debug(chanp, "writebuf: channel not open", 1);
return -EIO;
}
- err = BufPoolGet(&ibh, st->l1.sbufpool, GFP_ATOMIC, st, 21);
- if (err) {
- /* Must return 0 here, since this is not an error
- * but a temporary lack of resources.
- */
- if (chanp->debug & 1) {
- sprintf(tmp, "writebuf: no buffers for %d bytes", count);
- link_debug(chanp, tmp, 1);
- }
- return 0;
- }
-#if 0
- if (chanp->debug & 1) {
- sprintf(tmp, "writebuf: %d bytes", count);
- link_debug(chanp, tmp, 1);
- }
-#endif
- ptr = DATAPTR(ibh);
- if (chanp->lc_b.l2_establish)
- i = st->l2.ihsize;
- else
- i = 0;
-
- if ((count + i) > BUFFER_SIZE(HSCX_SBUF_ORDER, HSCX_SBUF_BPPS)) {
- sprintf(tmp, "writebuf: packet too large (%d bytes)", count + i);
+ if (len > MAX_DATA_SIZE) {
+ sprintf(tmp, "writebuf: packet too large (%d bytes)", len);
printk(KERN_WARNING "HiSax_%s !\n", tmp);
link_debug(chanp, tmp, 1);
- return (-EINVAL);
+ return -EINVAL;
}
- ptr += i;
-
- if (user)
- copy_from_user(ptr, buf, count);
- else
- memcpy(ptr, buf, count);
- ibh->datasize = count + i;
-
- if (chanp->data_open) {
- if (chanp->lc_b.l2_establish)
- chanp->ds.l3.l3l2(&chanp->ds, DL_DATA, ibh);
- else
- chanp->ds.l2.l2l1(&chanp->ds, PH_DATA, ibh);
- return (count);
- } else {
- BufPoolRelease(ibh);
- return (0);
+ if (len) {
+ if ((len + csta->hs[chanp->hscx].tx_cnt) > MAX_DATA_MEM) {
+ /* Must return 0 here, since this is not an error
+ * but a temporary lack of resources.
+ */
+ if (chanp->debug & 2048) {
+ sprintf(tmp, "writebuf: no buffers for %d bytes", len);
+ link_debug(chanp, tmp, 1);
+ }
+ return 0;
+ }
+ save_flags(flags);
+ cli();
+ nskb = skb_clone(skb, GFP_ATOMIC);
+ if (nskb) {
+ if (chanp->lc_b.l2_establish) {
+ csta->hs[chanp->hscx].tx_cnt += len + st->l2.ihsize;
+ chanp->ds.l3.l3l2(&chanp->ds, DL_DATA, nskb);
+ } else {
+ csta->hs[chanp->hscx].tx_cnt += len;
+ chanp->ds.l2.l2l1(&chanp->ds, PH_DATA, nskb);
+ }
+ dev_kfree_skb(skb, FREE_WRITE);
+ } else
+ len = 0;
+ restore_flags(flags);
}
+ return (len);
}
diff --git a/drivers/isdn/hisax/config.c b/drivers/isdn/hisax/config.c
index 0596e3b85..595fb713e 100644
--- a/drivers/isdn/hisax/config.c
+++ b/drivers/isdn/hisax/config.c
@@ -1,10 +1,22 @@
-/* $Id: config.c,v 1.11 1997/02/14 12:23:12 fritz Exp $
+/* $Id: config.c,v 1.15 1997/04/06 22:57:24 keil Exp $
* Author Karsten Keil (keil@temic-ech.spacenet.de)
* based on the teles driver from Jan den Ouden
*
*
* $Log: config.c,v $
+ * Revision 1.15 1997/04/06 22:57:24 keil
+ * Hisax version 2.1
+ *
+ * Revision 1.14 1997/03/25 23:11:22 keil
+ * US NI-1 protocol
+ *
+ * Revision 1.13 1997/03/23 21:45:49 keil
+ * Add support for ELSA PCMCIA
+ *
+ * Revision 1.12 1997/03/11 21:01:43 keil
+ * nzproto is only used with modules
+ *
* Revision 1.11 1997/02/14 12:23:12 fritz
* Added support for new insmod parameter handling.
*
@@ -63,11 +75,12 @@
* 5 AVM A1 (Fritz) p0=irq p1=iobase
* 6 ELSA PC [p0=iobase] or nothing (autodetect)
* 7 ELSA Quickstep p0=irq p1=iobase
+ * ELSA PCMCIA p0=irq p1=iobase
* 8 Teles PCMCIA p0=irq p1=iobase
* 9 ITK ix1-micro p0=irq p1=iobase
*
*
- * protocol can be either ISDN_PTYPE_EURO or ISDN_PTYPE_1TR6
+ * protocol can be either ISDN_PTYPE_EURO or ISDN_PTYPE_1TR6 or ISDN_PTYPE_NI1
*
*
*/
@@ -76,6 +89,10 @@
#define DEFAULT_CARD ISDN_CTYPE_ELSA
#define DEFAULT_CFG {0,0,0}
#endif
+#ifdef CONFIG_HISAX_ELSA_PCMCIA
+#define DEFAULT_CARD ISDN_CTYPE_ELSA_QS1000
+#define DEFAULT_CFG {3,0x2f8,0}
+#endif
#ifdef CONFIG_HISAX_AVM_A1
#undef DEFAULT_CARD
#undef DEFAULT_CFG
@@ -112,6 +129,12 @@
#undef DEFAULT_PROTO_NAME
#define DEFAULT_PROTO_NAME "EURO"
#endif
+#ifdef CONFIG_HISAX_NI1
+#undef DEFAULT_PROTO
+#define DEFAULT_PROTO ISDN_PTYPE_NI1
+#undef DEFAULT_PROTO_NAME
+#define DEFAULT_PROTO_NAME "NI1"
+#endif
#ifndef DEFAULT_PROTO
#define DEFAULT_PROTO ISDN_PTYPE_UNKNOWN
#define DEFAULT_PROTO_NAME "UNKNOWN"
@@ -280,8 +303,9 @@ HiSax_init(void)
int i;
char tmp[64], rev[64];
char *r = rev;
+#ifdef MODULE
int nzproto = 0;
-
+#endif
nrcards = 0;
strcpy(tmp, l1_revision);
r += sprintf(r, "%s/", HiSax_getrev(tmp));
@@ -295,7 +319,7 @@ HiSax_init(void)
r += sprintf(r, "%s", HiSax_getrev(tmp));
printk(KERN_NOTICE "HiSax: Driver for Siemens chip set ISDN cards\n");
- printk(KERN_NOTICE "HiSax: Version 2.0\n");
+ printk(KERN_NOTICE "HiSax: Version 2.1\n");
printk(KERN_NOTICE "HiSax: Revisions %s\n", rev);
#ifdef MODULE
diff --git a/drivers/isdn/hisax/elsa.c b/drivers/isdn/hisax/elsa.c
index 417bc77a3..9c402f492 100644
--- a/drivers/isdn/hisax/elsa.c
+++ b/drivers/isdn/hisax/elsa.c
@@ -1,4 +1,4 @@
-/* $Id: elsa.c,v 1.8 1997/01/27 15:51:48 keil Exp $
+/* $Id: elsa.c,v 1.14 1997/04/13 19:53:25 keil Exp $
* elsa.c low level stuff for Elsa isdn cards
*
@@ -8,6 +8,24 @@
*
*
* $Log: elsa.c,v $
+ * Revision 1.14 1997/04/13 19:53:25 keil
+ * Fixed QS1000 init, change in IRQ check delay for SMP
+ *
+ * Revision 1.13 1997/04/07 22:58:07 keil
+ * need include config.h
+ *
+ * Revision 1.12 1997/04/06 22:54:14 keil
+ * Using SKB's
+ *
+ * Revision 1.11 1997/03/23 21:45:46 keil
+ * Add support for ELSA PCMCIA
+ *
+ * Revision 1.10 1997/03/12 21:42:19 keil
+ * Bugfix: IRQ hangs with QS1000
+ *
+ * Revision 1.9 1997/03/04 15:57:39 keil
+ * bugfix IRQ reset Quickstep, ELSA PC changes, some stuff for new cards
+ *
* Revision 1.8 1997/01/27 15:51:48 keil
* SMP proof,cosmetics
*
@@ -38,6 +56,7 @@
#define ARCOFI_USE 0
#define __NO_VERSION__
+#include <linux/config.h>
#include "siemens.h"
#include "hisax.h"
#include "elsa.h"
@@ -46,18 +65,22 @@
extern const char *CardType[];
-const char *Elsa_revision = "$Revision: 1.8 $";
+const char *Elsa_revision = "$Revision: 1.14 $";
const char *Elsa_Types[] =
-{"None", "PCC-8", "PCF-Pro", "PCC-16", "PCF",
- "QS 1000"};
+{"None", "PC", "PCC-8", "PCC-16", "PCF", "PCF-Pro",
+ "PCMCIA", "QS 1000", "QS 3000"};
+
+const char *ITACVer[] =
+{"?0?", "?1?", "?2?", "?3?", "?4?", "V2.2",
+ "B1", "A1"};
#define byteout(addr,val) outb_p(val,addr)
#define bytein(addr) inb_p(addr)
-static inline byte
-readhscx(unsigned int adr, int hscx, byte off)
+static inline u_char
+readhscx(unsigned int adr, int hscx, u_char off)
{
- register byte ret;
+ register u_char ret;
long flags;
save_flags(flags);
@@ -69,7 +92,7 @@ readhscx(unsigned int adr, int hscx, byte off)
}
static inline void
-read_fifo_hscx(unsigned int adr, int hscx, byte * data, int size)
+read_fifo_hscx(unsigned int adr, int hscx, u_char * data, int size)
{
/* fifo read without cli because it's allready done */
@@ -79,7 +102,7 @@ read_fifo_hscx(unsigned int adr, int hscx, byte * data, int size)
static inline void
-writehscx(unsigned int adr, int hscx, byte off, byte data)
+writehscx(unsigned int adr, int hscx, u_char off, u_char data)
{
long flags;
@@ -91,74 +114,103 @@ writehscx(unsigned int adr, int hscx, byte off, byte data)
}
static inline void
-write_fifo_hscx(unsigned int adr, int hscx, byte * data, int size)
+write_fifo_hscx(unsigned int adr, int hscx, u_char * data, int size)
{
/* fifo write without cli because it's allready done */
byteout(adr + CARD_ALE, (hscx ? 0x40 : 0));
outsb(adr + CARD_HSCX, data, size);
}
-static inline byte
-readisac(unsigned int adr, byte off)
+static inline u_char
+readisac(unsigned int adr, u_char off)
{
- register byte ret;
+ register u_char ret;
long flags;
save_flags(flags);
cli();
byteout(adr + CARD_ALE, off + 0x20);
- ret = bytein(adr);
+ ret = bytein(adr + CARD_ISAC);
restore_flags(flags);
return (ret);
}
static inline void
-read_fifo_isac(unsigned int adr, byte * data, int size)
+read_fifo_isac(unsigned int adr, u_char * data, int size)
{
/* fifo read without cli because it's allready done */
byteout(adr + CARD_ALE, 0);
- insb(adr, data, size);
+ insb(adr + CARD_ISAC, data, size);
}
static inline void
-writeisac(unsigned int adr, byte off, byte data)
+writeisac(unsigned int adr, u_char off, u_char data)
{
long flags;
save_flags(flags);
cli();
byteout(adr + CARD_ALE, off + 0x20);
- byteout(adr, data);
+ byteout(adr + CARD_ISAC, data);
restore_flags(flags);
}
static inline void
-write_fifo_isac(unsigned int adr, byte * data, int size)
+write_fifo_isac(unsigned int adr, u_char * data, int size)
{
/* fifo write without cli because it's allready done */
byteout(adr + CARD_ALE, 0);
- outsb(adr, data, size);
+ outsb(adr + CARD_ISAC, data, size);
+}
+
+#ifdef CONFIG_HISAX_ELSA_PCC
+static inline u_char
+readitac(unsigned int adr, u_char off)
+{
+ register u_char ret;
+ long flags;
+
+ save_flags(flags);
+ cli();
+ byteout(adr + CARD_ALE, off);
+ ret = bytein(adr + CARD_ITAC);
+ restore_flags(flags);
+ return (ret);
+}
+
+static inline void
+writeitac(unsigned int adr, u_char off, u_char data)
+{
+ long flags;
+
+ save_flags(flags);
+ cli();
+ byteout(adr + CARD_ALE, off);
+ byteout(adr + CARD_ITAC, data);
+ restore_flags(flags);
}
static inline int
TimerRun(struct IsdnCardState *sp)
{
- register byte val;
+ register u_char val;
val = bytein(sp->cfg_reg + CARD_CONFIG);
if (sp->subtyp == ELSA_QS1000)
return (0 == (val & TIMER_RUN));
- return ((val & TIMER_RUN));
+ else if (sp->subtyp == ELSA_PCC8)
+ return (val & TIMER_RUN_PCC8);
+ return (val & TIMER_RUN);
}
static inline void
elsa_led_handler(struct IsdnCardState *sp)
{
- byte outval = 0xf0;
+ u_char outval = 0xf0;
int stat = 0, cval;
@@ -172,49 +224,50 @@ elsa_led_handler(struct IsdnCardState *sp)
}
cval = (sp->counter >> 6) & 3;
switch (cval) {
- case 0:
- if (!stat)
- outval |= STAT_LED;
- else if (stat == 1)
- outval |= LINE_LED | STAT_LED;
- else {
- if (stat & 2)
- outval |= STAT_LED;
- if (stat & 4)
- outval |= LINE_LED;
- }
- break;
- case 1:
- if (!stat)
- outval |= LINE_LED;
- else if (stat == 1)
- outval |= LINE_LED | STAT_LED;
- else {
- if (stat & 2)
+ case 0:
+ if (!stat)
outval |= STAT_LED;
- if (stat & 4)
+ else if (stat == 1)
+ outval |= LINE_LED | STAT_LED;
+ else {
+ if (stat & 2)
+ outval |= STAT_LED;
+ if (stat & 4)
+ outval |= LINE_LED;
+ }
+ break;
+ case 1:
+ if (!stat)
outval |= LINE_LED;
- }
- break;
- case 2:
- if (!stat)
- outval |= STAT_LED;
- else if (stat == 1)
- outval |= 0;
- else {
- if (stat & 2)
+ else if (stat == 1)
+ outval |= LINE_LED | STAT_LED;
+ else {
+ if (stat & 2)
+ outval |= STAT_LED;
+ if (stat & 4)
+ outval |= LINE_LED;
+ }
+ break;
+ case 2:
+ if (!stat)
outval |= STAT_LED;
- if (stat & 4)
+ else if (stat == 1)
+ outval |= 0;
+ else {
+ if (stat & 2)
+ outval |= STAT_LED;
+ if (stat & 4)
+ outval |= LINE_LED;
+ }
+ break;
+ case 3:
+ if (!stat)
outval |= LINE_LED;
- }
- break;
- case 3:
- if (!stat)
- outval |= LINE_LED;
- break;
+ break;
}
byteout(sp->cfg_reg + CARD_CONTROL, outval);
}
+#endif
static inline void
waitforCEC(int adr, int hscx)
@@ -244,7 +297,7 @@ waitforXFW(int adr, int hscx)
}
static inline void
-writehscxCMDR(int adr, int hscx, byte data)
+writehscxCMDR(int adr, int hscx, u_char data)
{
long flags;
@@ -287,25 +340,22 @@ elsa_report(struct IsdnCardState *sp)
static void
hscx_empty_fifo(struct HscxState *hsp, int count)
{
- byte *ptr;
+ u_char *ptr;
struct IsdnCardState *sp = hsp->sp;
- struct BufHeader *ibh = hsp->rcvibh;
long flags;
if ((sp->debug & L1_DEB_HSCX) && !(sp->debug & L1_DEB_HSCX_FIFO))
debugl1(sp, "hscx_empty_fifo");
- if (hsp->rcvptr + count > BUFFER_SIZE(HSCX_RBUF_ORDER,
- HSCX_RBUF_BPPS)) {
+ if (hsp->rcvidx + count > HSCX_BUFMAX) {
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "hscx_empty_fifo: incoming packet too large");
writehscxCMDR(sp->cfg_reg, hsp->hscx, 0x80);
+ hsp->rcvidx = 0;
return;
}
- ptr = DATAPTR(ibh);
- ptr += hsp->rcvptr;
-
- hsp->rcvptr += count;
+ ptr = hsp->rcvbuf + hsp->rcvidx;
+ hsp->rcvidx += count;
save_flags(flags);
cli();
read_fifo_hscx(sp->cfg_reg, hsp->hscx, ptr, count);
@@ -326,34 +376,33 @@ static void
hscx_fill_fifo(struct HscxState *hsp)
{
struct IsdnCardState *sp = hsp->sp;
- struct BufHeader *ibh;
int more, count;
- byte *ptr;
+ u_char *ptr;
long flags;
+
if ((sp->debug & L1_DEB_HSCX) && !(sp->debug & L1_DEB_HSCX_FIFO))
debugl1(sp, "hscx_fill_fifo");
- ibh = hsp->xmtibh;
- if (!ibh)
+ if (!hsp->tx_skb)
return;
-
- count = ibh->datasize - hsp->sendptr;
- if (count <= 0)
+ if (hsp->tx_skb->len <= 0)
return;
more = (hsp->mode == 1) ? 1 : 0;
- if (count > 32) {
+ if (hsp->tx_skb->len > 32) {
more = !0;
count = 32;
- }
- ptr = DATAPTR(ibh);
- ptr += hsp->sendptr;
- hsp->sendptr += count;
+ } else
+ count = hsp->tx_skb->len;
waitforXFW(sp->cfg_reg, hsp->hscx);
save_flags(flags);
cli();
+ ptr = hsp->tx_skb->data;
+ skb_pull(hsp->tx_skb, count);
+ hsp->tx_cnt -= count;
+ hsp->count += count;
write_fifo_hscx(sp->cfg_reg, hsp->hscx, ptr, count);
writehscxCMDR(sp->cfg_reg, hsp->hscx, more ? 0x8 : 0xa);
restore_flags(flags);
@@ -369,11 +418,12 @@ hscx_fill_fifo(struct HscxState *hsp)
}
static inline void
-hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
+hscx_interrupt(struct IsdnCardState *sp, u_char val, u_char hscx)
{
- byte r;
+ u_char r;
struct HscxState *hsp = sp->hs + hscx;
- int count, err;
+ struct sk_buff *skb;
+ int count;
char tmp[32];
if (!hsp->init)
@@ -395,79 +445,61 @@ hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
if (!r & 0x20)
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "HSCX CRC error");
- if (hsp->rcvibh)
- BufPoolRelease(hsp->rcvibh);
- hsp->rcvibh = NULL;
writehscxCMDR(sp->cfg_reg, hsp->hscx, 0x80);
- goto afterRME;
+ } else {
+ count = readhscx(sp->cfg_reg, hsp->hscx, HSCX_RBCL) & 0x1f;
+ if (count == 0)
+ count = 32;
+ hscx_empty_fifo(hsp, count);
+ if ((count = hsp->rcvidx - 1) > 0) {
+ if (sp->debug & L1_DEB_HSCX_FIFO) {
+ sprintf(tmp, "HX Frame %d", count);
+ debugl1(sp, tmp);
+ }
+ if (!(skb = dev_alloc_skb(count)))
+ printk(KERN_WARNING "Elsa: receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, count), hsp->rcvbuf, count);
+ skb_queue_tail(&hsp->rqueue, skb);
+ }
+ }
}
- if (!hsp->rcvibh)
- if (BufPoolGet(&hsp->rcvibh, &hsp->rbufpool,
- GFP_ATOMIC, (void *) 1, 1)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "HSCX RME out of buffers");
- writehscxCMDR(sp->cfg_reg, hsp->hscx, 0x80);
- goto afterRME;
- } else
- hsp->rcvptr = 0;
-
- count = readhscx(sp->cfg_reg, hsp->hscx, HSCX_RBCL) & 0x1f;
- if (count == 0)
- count = 32;
- hscx_empty_fifo(hsp, count);
- hsp->rcvibh->datasize = hsp->rcvptr - 1;
- BufQueueLink(&hsp->rq, hsp->rcvibh);
- hsp->rcvibh = NULL;
+ hsp->rcvidx = 0;
hscx_sched_event(hsp, HSCX_RCVBUFREADY);
}
- afterRME:
if (val & 0x40) { /* RPF */
- if (!hsp->rcvibh) {
- if (hsp->mode == 1)
- err = BufPoolGet(&hsp->rcvibh, &hsp->smallpool,
- GFP_ATOMIC, (void *) 1, 2);
- else
- err = BufPoolGet(&hsp->rcvibh, &hsp->rbufpool,
- GFP_ATOMIC, (void *) 1, 2);
-
- if (err) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "HSCX RPF out of buffers");
- writehscxCMDR(sp->cfg_reg, hsp->hscx, 0x80);
- goto afterRPF;
- } else
- hsp->rcvptr = 0;
- }
hscx_empty_fifo(hsp, 32);
if (hsp->mode == 1) {
/* receive audio data */
- hsp->rcvibh->datasize = hsp->rcvptr;
- BufQueueLink(&hsp->rq, hsp->rcvibh);
- hsp->rcvibh = NULL;
+ if (!(skb = dev_alloc_skb(32)))
+ printk(KERN_WARNING "elsa: receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, 32), hsp->rcvbuf, 32);
+ skb_queue_tail(&hsp->rqueue, skb);
+ }
+ hsp->rcvidx = 0;
hscx_sched_event(hsp, HSCX_RCVBUFREADY);
}
}
- afterRPF:
if (val & 0x10) { /* XPR */
- if (hsp->xmtibh)
- if (hsp->xmtibh->datasize > hsp->sendptr) {
+ if (hsp->tx_skb)
+ if (hsp->tx_skb->len) {
hscx_fill_fifo(hsp);
- goto afterXPR;
+ return;
} else {
- if (hsp->releasebuf)
- BufPoolRelease(hsp->xmtibh);
- hsp->sendptr = 0;
+ SET_SKB_FREE(hsp->tx_skb);
+ dev_kfree_skb(hsp->tx_skb, FREE_WRITE);
+ hsp->count = 0;
if (hsp->st->l4.l1writewakeup)
hsp->st->l4.l1writewakeup(hsp->st);
- hsp->xmtibh = NULL;
+ hsp->tx_skb = NULL;
}
- if (!BufQueueUnlink(&hsp->xmtibh, &hsp->sq)) {
- hsp->releasebuf = !0;
+ if ((hsp->tx_skb = skb_dequeue(&hsp->squeue))) {
+ hsp->count = 0;
hscx_fill_fifo(hsp);
} else
hscx_sched_event(hsp, HSCX_XMTBUFREADY);
}
- afterXPR:
}
/*
@@ -477,25 +509,25 @@ hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
static void
isac_empty_fifo(struct IsdnCardState *sp, int count)
{
- byte *ptr;
- struct BufHeader *ibh = sp->rcvibh;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_ISAC) && !(sp->debug & L1_DEB_ISAC_FIFO))
debugl1(sp, "isac_empty_fifo");
- if (sp->rcvptr >= 3072) {
+ if ((sp->rcvidx + count) >= MAX_DFRAME_LEN) {
if (sp->debug & L1_DEB_WARN) {
char tmp[40];
- sprintf(tmp, "isac_empty_fifo rcvptr %d", sp->rcvptr);
+ sprintf(tmp, "isac_empty_fifo overrun %d",
+ sp->rcvidx + count);
debugl1(sp, tmp);
}
+ writeisac(sp->cfg_reg, ISAC_CMDR, 0x80);
+ sp->rcvidx = 0;
return;
}
- ptr = DATAPTR(ibh);
- ptr += sp->rcvptr;
- sp->rcvptr += count;
-
+ ptr = sp->rcvbuf + sp->rcvidx;
+ sp->rcvidx += count;
save_flags(flags);
cli();
read_fifo_isac(sp->cfg_reg, ptr, count);
@@ -514,35 +546,30 @@ isac_empty_fifo(struct IsdnCardState *sp, int count)
static void
isac_fill_fifo(struct IsdnCardState *sp)
{
- struct BufHeader *ibh;
int count, more;
- byte *ptr;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_ISAC) && !(sp->debug & L1_DEB_ISAC_FIFO))
debugl1(sp, "isac_fill_fifo");
- ibh = sp->xmtibh;
- if (!ibh)
+ if (!sp->tx_skb)
return;
- count = ibh->datasize - sp->sendptr;
+ count = sp->tx_skb->len;
if (count <= 0)
return;
- if (count >= 3072)
- return;
more = 0;
if (count > 32) {
more = !0;
count = 32;
}
- ptr = DATAPTR(ibh);
- ptr += sp->sendptr;
- sp->sendptr += count;
-
save_flags(flags);
cli();
+ ptr = sp->tx_skb->data;
+ skb_pull(sp->tx_skb, count);
+ sp->tx_cnt += count;
write_fifo_isac(sp->cfg_reg, ptr, count);
writeisac(sp->cfg_reg, ISAC_CMDR, more ? 0x8 : 0xa);
restore_flags(flags);
@@ -568,14 +595,15 @@ ph_command(struct IsdnCardState *sp, unsigned int command)
}
static inline void
-isac_interrupt(struct IsdnCardState *sp, byte val)
+isac_interrupt(struct IsdnCardState *sp, u_char val)
{
- byte exval, v1;
+ u_char exval, v1;
+ struct sk_buff *skb;
unsigned int count;
char tmp[32];
#if ARCOFI_USE
struct BufHeader *ibh;
- byte *ptr;
+ u_char *ptr;
#endif
if (sp->debug & L1_DEB_ISAC) {
@@ -591,62 +619,46 @@ isac_interrupt(struct IsdnCardState *sp, byte val)
if (!exval & 0x20)
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "ISAC CRC error");
- if (sp->rcvibh)
- BufPoolRelease(sp->rcvibh);
- sp->rcvibh = NULL;
writeisac(sp->cfg_reg, ISAC_CMDR, 0x80);
- goto afterRME;
+ } else {
+ count = readisac(sp->cfg_reg, ISAC_RBCL) & 0x1f;
+ if (count == 0)
+ count = 32;
+ isac_empty_fifo(sp, count);
+ if ((count = sp->rcvidx) > 0) {
+ sp->rcvidx = 0;
+ if (!(skb = alloc_skb(count, GFP_ATOMIC)))
+ printk(KERN_WARNING "Elsa: D receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, count), sp->rcvbuf, count);
+ skb_queue_tail(&sp->rq, skb);
+ }
+ }
}
- if (!sp->rcvibh)
- if (BufPoolGet(&(sp->rcvibh), &(sp->rbufpool),
- GFP_ATOMIC, (void *) 1, 3)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "ISAC RME out of buffers!");
- writeisac(sp->cfg_reg, ISAC_CMDR, 0x80);
- goto afterRME;
- } else
- sp->rcvptr = 0;
- count = readisac(sp->cfg_reg, ISAC_RBCL) & 0x1f;
- if (count == 0)
- count = 32;
- isac_empty_fifo(sp, count);
- sp->rcvibh->datasize = sp->rcvptr;
- BufQueueLink(&(sp->rq), sp->rcvibh);
- sp->rcvibh = NULL;
+ sp->rcvidx = 0;
isac_sched_event(sp, ISAC_RCVBUFREADY);
}
- afterRME:
if (val & 0x40) { /* RPF */
- if (!sp->rcvibh)
- if (BufPoolGet(&(sp->rcvibh), &(sp->rbufpool),
- GFP_ATOMIC, (void *) 1, 4)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "ISAC RME out of buffers!");
- writeisac(sp->cfg_reg, ISAC_CMDR, 0x80);
- goto afterRPF;
- } else
- sp->rcvptr = 0;
isac_empty_fifo(sp, 32);
}
- afterRPF:
if (val & 0x20) { /* RSC */
/* never */
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "ISAC RSC interrupt");
}
if (val & 0x10) { /* XPR */
- if (sp->xmtibh)
- if (sp->xmtibh->datasize > sp->sendptr) {
+ if (sp->tx_skb)
+ if (sp->tx_skb->len) {
isac_fill_fifo(sp);
goto afterXPR;
} else {
- if (sp->releasebuf)
- BufPoolRelease(sp->xmtibh);
- sp->xmtibh = NULL;
- sp->sendptr = 0;
+ SET_SKB_FREE(sp->tx_skb);
+ dev_kfree_skb(sp->tx_skb, FREE_WRITE);
+ sp->tx_cnt = 0;
+ sp->tx_skb = NULL;
}
- if (!BufQueueUnlink(&sp->xmtibh, &sp->sq)) {
- sp->releasebuf = !0;
+ if ((sp->tx_skb = skb_dequeue(&sp->sq))) {
+ sp->tx_cnt = 0;
isac_fill_fifo(sp);
} else
isac_sched_event(sp, ISAC_XMTBUFREADY);
@@ -793,14 +805,13 @@ isac_interrupt(struct IsdnCardState *sp, byte val)
}
static inline void
-hscx_int_main(struct IsdnCardState *sp, byte val)
+hscx_int_main(struct IsdnCardState *sp, u_char val)
{
- byte exval;
+ u_char exval;
struct HscxState *hsp;
char tmp[32];
-
if (val & 0x01) {
hsp = sp->hs + 1;
exval = readhscx(sp->cfg_reg, 1, HSCX_EXIR);
@@ -811,7 +822,11 @@ hscx_int_main(struct IsdnCardState *sp, byte val)
/* Here we lost an TX interrupt, so
* restart transmitting the whole frame.
*/
- hsp->sendptr = 0;
+ if (hsp->tx_skb) {
+ skb_push(hsp->tx_skb, hsp->count);
+ hsp->tx_cnt += hsp->count;
+ hsp->count = 0;
+ }
writehscxCMDR(sp->cfg_reg, hsp->hscx, 0x01);
if (sp->debug & L1_DEB_WARN) {
sprintf(tmp, "HSCX B EXIR %x Lost TX", exval);
@@ -840,7 +855,11 @@ hscx_int_main(struct IsdnCardState *sp, byte val)
/* Here we lost an TX interrupt, so
* restart transmitting the whole frame.
*/
- hsp->sendptr = 0;
+ if (hsp->tx_skb) {
+ skb_push(hsp->tx_skb, hsp->count);
+ hsp->tx_cnt += hsp->count;
+ hsp->count = 0;
+ }
writehscxCMDR(sp->cfg_reg, hsp->hscx, 0x01);
if (sp->debug & L1_DEB_WARN) {
sprintf(tmp, "HSCX A EXIR %x Lost TX", exval);
@@ -866,7 +885,7 @@ static void
elsa_interrupt(int intno, void *dev_id, struct pt_regs *regs)
{
struct IsdnCardState *sp;
- byte val, sval, stat = 0;
+ u_char val;
sp = (struct IsdnCardState *) irq2dev_map[intno];
@@ -874,32 +893,31 @@ elsa_interrupt(int intno, void *dev_id, struct pt_regs *regs)
printk(KERN_WARNING "Elsa: Spurious interrupt!\n");
return;
}
- sval = bytein(sp->cfg_reg + CARD_CONFIG);
+#ifdef CONFIG_HISAX_ELSA_PCC
INT_RESTART:
if (!TimerRun(sp)) {
/* Timer Restart */
- bytein(sp->cfg_reg + CARD_START_TIMER);
+ byteout(sp->cfg_reg + CARD_START_TIMER, 0);
if (!(sp->counter++ & 0x3f)) {
/* Call LEDs all 64 tics */
elsa_led_handler(sp);
}
}
+#endif
val = readhscx(sp->cfg_reg, 1, HSCX_ISTA);
Start_HSCX:
if (val) {
hscx_int_main(sp, val);
- stat |= 1;
}
val = readisac(sp->cfg_reg, ISAC_ISTA);
Start_ISAC:
if (val) {
isac_interrupt(sp, val);
- stat |= 2;
}
- sval = bytein(sp->cfg_reg + CARD_CONFIG);
+#ifdef CONFIG_HISAX_ELSA_PCC
if (!TimerRun(sp))
goto INT_RESTART;
-
+#endif
val = readhscx(sp->cfg_reg, 1, HSCX_ISTA);
if (val) {
if (sp->debug & L1_DEB_HSCX)
@@ -912,17 +930,18 @@ elsa_interrupt(int intno, void *dev_id, struct pt_regs *regs)
debugl1(sp, "ISAC IntStat after IntRoutine");
goto Start_ISAC;
}
- if (stat & 1) {
- writehscx(sp->cfg_reg, 0, HSCX_MASK, 0xFF);
- writehscx(sp->cfg_reg, 1, HSCX_MASK, 0xFF);
- writehscx(sp->cfg_reg, 0, HSCX_MASK, 0x0);
- writehscx(sp->cfg_reg, 1, HSCX_MASK, 0x0);
+ writehscx(sp->cfg_reg, 0, HSCX_MASK, 0xFF);
+ writehscx(sp->cfg_reg, 1, HSCX_MASK, 0xFF);
+ writeisac(sp->cfg_reg, ISAC_MASK, 0xFF);
+#ifdef CONFIG_HISAX_ELSA_PCC
+ if (sp->subtyp == ELSA_QS1000) {
+ byteout(sp->cfg_reg + CARD_START_TIMER, 0);
+ byteout(sp->cfg_reg + CARD_TRIG_IRQ, 0xff);
}
- if (stat & 2) {
- writeisac(sp->cfg_reg, ISAC_MASK, 0xFF);
- writeisac(sp->cfg_reg, ISAC_MASK, 0x0);
- }
- byteout(sp->cfg_reg + 7, 0xff);
+#endif
+ writehscx(sp->cfg_reg, 0, HSCX_MASK, 0x0);
+ writehscx(sp->cfg_reg, 1, HSCX_MASK, 0x0);
+ writeisac(sp->cfg_reg, ISAC_MASK, 0x0);
}
@@ -967,39 +986,39 @@ modehscx(struct HscxState *hs, int mode, int ichan)
writehscx(sp->cfg_reg, hscx, HSCX_CCR2, 0x30);
switch (mode) {
- case (0):
- writehscx(sp->cfg_reg, hscx, HSCX_TSAX, 0xff);
- writehscx(sp->cfg_reg, hscx, HSCX_TSAR, 0xff);
- writehscx(sp->cfg_reg, hscx, HSCX_XCCR, 7);
- writehscx(sp->cfg_reg, hscx, HSCX_RCCR, 7);
- writehscx(sp->cfg_reg, hscx, HSCX_MODE, 0x84);
- break;
- case (1):
- if (ichan == 0) {
- writehscx(sp->cfg_reg, hscx, HSCX_TSAX, 0x2f);
- writehscx(sp->cfg_reg, hscx, HSCX_TSAR, 0x2f);
- } else {
- writehscx(sp->cfg_reg, hscx, HSCX_TSAX, 0x3);
- writehscx(sp->cfg_reg, hscx, HSCX_TSAR, 0x3);
- }
- writehscx(sp->cfg_reg, hscx, HSCX_XCCR, 7);
- writehscx(sp->cfg_reg, hscx, HSCX_RCCR, 7);
- writehscx(sp->cfg_reg, hscx, HSCX_MODE, 0xe4);
- writehscx(sp->cfg_reg, hscx, HSCX_CMDR, 0x41);
- break;
- case (2):
- if (ichan == 0) {
- writehscx(sp->cfg_reg, hscx, HSCX_TSAX, 0x2f);
- writehscx(sp->cfg_reg, hscx, HSCX_TSAR, 0x2f);
- } else {
- writehscx(sp->cfg_reg, hscx, HSCX_TSAX, 0x3);
- writehscx(sp->cfg_reg, hscx, HSCX_TSAR, 0x3);
- }
- writehscx(sp->cfg_reg, hscx, HSCX_XCCR, 7);
- writehscx(sp->cfg_reg, hscx, HSCX_RCCR, 7);
- writehscx(sp->cfg_reg, hscx, HSCX_MODE, 0x8c);
- writehscx(sp->cfg_reg, hscx, HSCX_CMDR, 0x41);
- break;
+ case (0):
+ writehscx(sp->cfg_reg, hscx, HSCX_TSAX, 0xff);
+ writehscx(sp->cfg_reg, hscx, HSCX_TSAR, 0xff);
+ writehscx(sp->cfg_reg, hscx, HSCX_XCCR, 7);
+ writehscx(sp->cfg_reg, hscx, HSCX_RCCR, 7);
+ writehscx(sp->cfg_reg, hscx, HSCX_MODE, 0x84);
+ break;
+ case (1):
+ if (ichan == 0) {
+ writehscx(sp->cfg_reg, hscx, HSCX_TSAX, 0x2f);
+ writehscx(sp->cfg_reg, hscx, HSCX_TSAR, 0x2f);
+ } else {
+ writehscx(sp->cfg_reg, hscx, HSCX_TSAX, 0x3);
+ writehscx(sp->cfg_reg, hscx, HSCX_TSAR, 0x3);
+ }
+ writehscx(sp->cfg_reg, hscx, HSCX_XCCR, 7);
+ writehscx(sp->cfg_reg, hscx, HSCX_RCCR, 7);
+ writehscx(sp->cfg_reg, hscx, HSCX_MODE, 0xe4);
+ writehscx(sp->cfg_reg, hscx, HSCX_CMDR, 0x41);
+ break;
+ case (2):
+ if (ichan == 0) {
+ writehscx(sp->cfg_reg, hscx, HSCX_TSAX, 0x2f);
+ writehscx(sp->cfg_reg, hscx, HSCX_TSAR, 0x2f);
+ } else {
+ writehscx(sp->cfg_reg, hscx, HSCX_TSAX, 0x3);
+ writehscx(sp->cfg_reg, hscx, HSCX_TSAR, 0x3);
+ }
+ writehscx(sp->cfg_reg, hscx, HSCX_XCCR, 7);
+ writehscx(sp->cfg_reg, hscx, HSCX_RCCR, 7);
+ writehscx(sp->cfg_reg, hscx, HSCX_MODE, 0x8c);
+ writehscx(sp->cfg_reg, hscx, HSCX_CMDR, 0x41);
+ break;
}
writehscx(sp->cfg_reg, hscx, HSCX_ISTA, 0x00);
}
@@ -1016,9 +1035,86 @@ release_io_elsa(struct IsdnCard *card)
}
static void
+reset_elsa(struct IsdnCardState *sp)
+{
+#ifdef CONFIG_HISAX_ELSA_PCC
+ /* Wait 1 Timer */
+ byteout(sp->cfg_reg + CARD_START_TIMER, 0);
+ while (TimerRun(sp));
+ byteout(sp->cfg_reg + CARD_CONTROL, 0x00); /* Reset On */
+ /* Wait 1 Timer */
+ byteout(sp->cfg_reg + CARD_START_TIMER, 0);
+ while (TimerRun(sp));
+ byteout(sp->cfg_reg + CARD_CONTROL, ISDN_RESET); /* Reset Off */
+ /* Wait 1 Timer */
+ byteout(sp->cfg_reg + CARD_START_TIMER, 0);
+ while (TimerRun(sp));
+ byteout(sp->cfg_reg + CARD_TRIG_IRQ, 0xff);
+#endif
+}
+
+static void
clear_pending_ints(struct IsdnCardState *sp)
{
- writeisac(sp->cfg_reg, ISAC_MASK, 0);
+#ifdef CONFIG_HISAX_ELSA_PCMCIA
+ int val;
+ char tmp[64];
+
+ val = readhscx(sp->cfg_reg, 1, HSCX_ISTA);
+ sprintf(tmp, "HSCX B ISTA %x", val);
+ debugl1(sp, tmp);
+ if (val & 0x01) {
+ val = readhscx(sp->cfg_reg, 1, HSCX_EXIR);
+ sprintf(tmp, "HSCX B EXIR %x", val);
+ debugl1(sp, tmp);
+ } else if (val & 0x02) {
+ val = readhscx(sp->cfg_reg, 0, HSCX_EXIR);
+ sprintf(tmp, "HSCX A EXIR %x", val);
+ debugl1(sp, tmp);
+ }
+ val = readhscx(sp->cfg_reg, 0, HSCX_ISTA);
+ sprintf(tmp, "HSCX A ISTA %x", val);
+ debugl1(sp, tmp);
+ val = readhscx(sp->cfg_reg, 1, HSCX_STAR);
+ sprintf(tmp, "HSCX B STAR %x", val);
+ debugl1(sp, tmp);
+ val = readhscx(sp->cfg_reg, 0, HSCX_STAR);
+ sprintf(tmp, "HSCX A STAR %x", val);
+ debugl1(sp, tmp);
+ val = readisac(sp->cfg_reg, ISAC_STAR);
+ sprintf(tmp, "ISAC STAR %x", val);
+ debugl1(sp, tmp);
+ val = readisac(sp->cfg_reg, ISAC_MODE);
+ sprintf(tmp, "ISAC MODE %x", val);
+ debugl1(sp, tmp);
+ val = readisac(sp->cfg_reg, ISAC_ADF2);
+ sprintf(tmp, "ISAC ADF2 %x", val);
+ debugl1(sp, tmp);
+ val = readisac(sp->cfg_reg, ISAC_ISTA);
+ sprintf(tmp, "ISAC ISTA %x", val);
+ debugl1(sp, tmp);
+ if (val & 0x01) {
+ val = readisac(sp->cfg_reg, ISAC_EXIR);
+ sprintf(tmp, "ISAC EXIR %x", val);
+ debugl1(sp, tmp);
+ } else if (val & 0x04) {
+ val = readisac(sp->cfg_reg, ISAC_CIR0);
+ sprintf(tmp, "ISAC CIR0 %x", val);
+ debugl1(sp, tmp);
+ }
+#endif
+ writehscx(sp->cfg_reg, 0, HSCX_MASK, 0xFF);
+ writehscx(sp->cfg_reg, 1, HSCX_MASK, 0xFF);
+ writeisac(sp->cfg_reg, ISAC_MASK, 0xFF);
+#ifdef CONFIG_HISAX_ELSA_PCC
+ if (sp->subtyp == ELSA_QS1000) {
+ byteout(sp->cfg_reg + CARD_START_TIMER, 0);
+ byteout(sp->cfg_reg + CARD_TRIG_IRQ, 0xff);
+ }
+#endif
+ writehscx(sp->cfg_reg, 0, HSCX_MASK, 0x0);
+ writehscx(sp->cfg_reg, 1, HSCX_MASK, 0x0);
+ writeisac(sp->cfg_reg, ISAC_MASK, 0x0);
writeisac(sp->cfg_reg, ISAC_CMDR, 0x41);
}
@@ -1026,11 +1122,11 @@ static void
check_arcofi(struct IsdnCardState *sp)
{
#if 0
- byte val;
+ u_char val;
char tmp[40];
char *t;
long flags;
- byte *p;
+ u_char *p;
if (BufPoolGet(&(sp->mon_tx), &(sp->sbufpool),
GFP_ATOMIC, (void *) 1, 3)) {
@@ -1081,55 +1177,70 @@ check_arcofi(struct IsdnCardState *sp)
int
initelsa(struct IsdnCardState *sp)
{
- int ret, irq_cnt;
+ int ret, irq_cnt, cnt = 3;
long flags;
- sp->counter = 0;
irq_cnt = kstat.interrupts[sp->irq];
printk(KERN_INFO "Elsa: IRQ %d count %d\n", sp->irq, irq_cnt);
- clear_pending_ints(sp);
ret = get_irq(sp->cardnr, &elsa_interrupt);
- if (ret) {
+#ifdef CONFIG_HISAX_ELSA_PCC
+ byteout(sp->cfg_reg + CARD_TRIG_IRQ, 0xff);
+#endif
+ while (ret && cnt) {
+ sp->counter = 0;
+ clear_pending_ints(sp);
initisac(sp);
sp->modehscx(sp->hs, 0, 0);
sp->modehscx(sp->hs + 1, 0, 0);
save_flags(flags);
sp->counter = 0;
sti();
+#ifdef CONFIG_HISAX_ELSA_PCC
byteout(sp->cfg_reg + CARD_CONTROL, ISDN_RESET | ENABLE_TIM_INT);
- bytein(sp->cfg_reg + CARD_START_TIMER);
- HZDELAY(11); /* Warte 110 ms */
+ byteout(sp->cfg_reg + CARD_START_TIMER, 0);
+ current->state = TASK_INTERRUPTIBLE;
+ current->timeout = jiffies + (110 * HZ) / 1000; /* Timeout 110ms */
+ schedule();
restore_flags(flags);
printk(KERN_INFO "Elsa: %d timer tics in 110 msek\n",
sp->counter);
- if (abs(sp->counter - 12) < 3) {
+ if (abs(sp->counter - 13) < 3) {
printk(KERN_INFO "Elsa: timer and irq OK\n");
} else {
printk(KERN_WARNING
- "Elsa: timer problem maybe an IRQ(%d) conflict\n",
- sp->irq);
+ "Elsa: timer tic problem (%d/12) maybe an IRQ(%d) conflict\n",
+ sp->counter, sp->irq);
}
+#endif
printk(KERN_INFO "Elsa: IRQ %d count %d\n", sp->irq,
kstat.interrupts[sp->irq]);
if (kstat.interrupts[sp->irq] == irq_cnt) {
printk(KERN_WARNING
- "Elsa: IRQ(%d) getting no interrupts during init\n",
- sp->irq);
- irq2dev_map[sp->irq] = NULL;
- free_irq(sp->irq, NULL);
- return (0);
+ "Elsa: IRQ(%d) getting no interrupts during init %d\n",
+ sp->irq, 4 - cnt);
+ if (cnt == 1) {
+ irq2dev_map[sp->irq] = NULL;
+ free_irq(sp->irq, NULL);
+ return (0);
+ } else {
+ reset_elsa(sp);
+ cnt--;
+ }
+ } else {
+ check_arcofi(sp);
+ cnt = 0;
}
- check_arcofi(sp);
}
sp->counter = 0;
return (ret);
}
+#ifdef CONFIG_HISAX_ELSA_PCC
static unsigned char
probe_elsa_adr(unsigned int adr)
{
- int i, in1, in2, p16_1 = 0, p16_2 = 0, pcc_1 = 0, pcc_2 = 0,
- pfp_1 = 0, pfp_2 = 0;
+ int i, in1, in2, p16_1 = 0, p16_2 = 0, p8_1 = 0, p8_2 = 0, pc_1 = 0,
+ pc_2 = 0, pfp_1 = 0, pfp_2 = 0;
long flags;
if (check_region(adr, 8)) {
@@ -1145,8 +1256,10 @@ probe_elsa_adr(unsigned int adr)
in2 = inb(adr + CARD_CONFIG); /* jedem Zugriff */
p16_1 += 0x04 & in1;
p16_2 += 0x04 & in2;
- pcc_1 += 0x01 & in1;
- pcc_2 += 0x01 & in2;
+ p8_1 += 0x02 & in1;
+ p8_2 += 0x02 & in2;
+ pc_1 += 0x01 & in1;
+ pc_2 += 0x01 & in2;
pfp_1 += 0x40 & in1;
pfp_2 += 0x40 & in2;
}
@@ -1154,13 +1267,16 @@ probe_elsa_adr(unsigned int adr)
printk(KERN_INFO "Elsa: Probing IO 0x%x", adr);
if (65 == ++p16_1 * ++p16_2) {
printk(" PCC-16/PCF found\n");
- return (3);
+ return (ELSA_PCC16);
} else if (1025 == ++pfp_1 * ++pfp_2) {
printk(" PCF-Pro found\n");
- return (2);
- } else if (17 == ++pcc_1 * ++pcc_2) {
+ return (ELSA_PCFPRO);
+ } else if (33 == ++p8_1 * ++p8_2) {
printk(" PCC8 found\n");
- return (1);
+ return (ELSA_PCC8);
+ } else if (17 == ++pc_1 * ++pc_2) {
+ printk(" PC found\n");
+ return (ELSA_PC);
} else {
printk(" failed\n");
return (0);
@@ -1180,25 +1296,29 @@ probe_elsa(struct IsdnCardState *sp)
}
return (CARD_portlist[i]);
}
+#endif
int
setup_elsa(struct IsdnCard *card)
{
+#ifdef CONFIG_HISAX_ELSA_PCC
long flags;
+#endif
int bytecnt;
- byte val, verA, verB;
+ u_char val, verA, verB;
struct IsdnCardState *sp = card->sp;
char tmp[64];
strcpy(tmp, Elsa_revision);
printk(KERN_NOTICE "HiSax: Elsa driver Rev. %s\n", HiSax_getrev(tmp));
+#ifdef CONFIG_HISAX_ELSA_PCC
if (sp->typ == ISDN_CTYPE_ELSA) {
sp->cfg_reg = card->para[0];
- printk(KERN_INFO "Elsa: Mircolink IO probing\n");
+ printk(KERN_INFO "Elsa: Microlink IO probing\n");
if (sp->cfg_reg) {
if (!(sp->subtyp = probe_elsa_adr(sp->cfg_reg))) {
printk(KERN_WARNING
- "Elsa: no Elsa Mircolink at 0x%x\n",
+ "Elsa: no Elsa Microlink at 0x%x\n",
sp->cfg_reg);
return (0);
}
@@ -1206,14 +1326,18 @@ setup_elsa(struct IsdnCard *card)
sp->cfg_reg = probe_elsa(sp);
if (sp->cfg_reg) {
val = bytein(sp->cfg_reg + CARD_CONFIG);
- if (sp->subtyp == ELSA_PCC) {
- const byte CARD_IrqTab[8] =
+ if (sp->subtyp == ELSA_PC) {
+ const u_char CARD_IrqTab[8] =
+ {7, 3, 5, 9, 0, 0, 0, 0};
+ sp->irq = CARD_IrqTab[(val & IRQ_INDEX_PC) >> 2];
+ } else if (sp->subtyp == ELSA_PCC8) {
+ const u_char CARD_IrqTab[8] =
{7, 3, 5, 9, 0, 0, 0, 0};
- sp->irq = CARD_IrqTab[(val & 0x0c) >> 2];
+ sp->irq = CARD_IrqTab[(val & IRQ_INDEX_PCC8) >> 4];
} else {
- const byte CARD_IrqTab[8] =
+ const u_char CARD_IrqTab[8] =
{15, 10, 15, 3, 11, 5, 11, 9};
- sp->irq = CARD_IrqTab[(val & 0x38) >> 3];
+ sp->irq = CARD_IrqTab[(val & IRQ_INDEX) >> 3];
}
val = bytein(sp->cfg_reg + CARD_ALE) & 0x7;
if (val < 3)
@@ -1231,39 +1355,64 @@ setup_elsa(struct IsdnCard *card)
val = bytein(sp->cfg_reg + CARD_ALE) & 0x08;
if (val)
printk(KERN_WARNING
- "Elsa: Mircolink S0 bus power bad\n");
+ "Elsa: Microlink S0 bus power bad\n");
} else {
printk(KERN_WARNING
- "No Elsa Mircolink found\n");
+ "No Elsa Microlink found\n");
return (0);
}
} else if (sp->typ == ISDN_CTYPE_ELSA_QS1000) {
sp->cfg_reg = card->para[1];
sp->irq = card->para[0];
sp->subtyp = ELSA_QS1000;
+ printk(KERN_INFO
+ "Elsa: %s found at 0x%x IRQ %d\n",
+ Elsa_Types[sp->subtyp],
+ sp->cfg_reg,
+ sp->irq);
} else
return (0);
+#endif
+#ifdef CONFIG_HISAX_ELSA_PCMCIA
+ if (sp->typ == ISDN_CTYPE_ELSA_QS1000) {
+ sp->cfg_reg = card->para[1];
+ sp->irq = card->para[0];
+ sp->subtyp = ELSA_PCMCIA;
+ printk(KERN_INFO
+ "Elsa: %s found at 0x%x IRQ %d\n",
+ Elsa_Types[sp->subtyp],
+ sp->cfg_reg,
+ sp->irq);
+ } else
+ return (0);
+#endif
switch (sp->subtyp) {
- case ELSA_PCC:
- bytecnt = 8;
- break;
- case ELSA_PCFPRO:
- bytecnt = 16;
- break;
- case ELSA_PCC16:
- bytecnt = 8;
- break;
- case ELSA_PCF:
- bytecnt = 16;
- break;
- case ELSA_QS1000:
- bytecnt = 8;
- break;
- default:
- printk(KERN_WARNING
- "Unknown ELSA subtype %d\n", sp->subtyp);
- return (0);
+ case ELSA_PC:
+ bytecnt = 8;
+ break;
+ case ELSA_PCC8:
+ bytecnt = 8;
+ break;
+ case ELSA_PCFPRO:
+ bytecnt = 16;
+ break;
+ case ELSA_PCC16:
+ bytecnt = 8;
+ break;
+ case ELSA_PCF:
+ bytecnt = 16;
+ break;
+ case ELSA_QS1000:
+ bytecnt = 8;
+ break;
+ case ELSA_PCMCIA:
+ bytecnt = 8;
+ break;
+ default:
+ printk(KERN_WARNING
+ "Unknown ELSA subtype %d\n", sp->subtyp);
+ return (0);
}
if (check_region((sp->cfg_reg), bytecnt)) {
@@ -1278,9 +1427,11 @@ setup_elsa(struct IsdnCard *card)
}
/* Teste Timer */
- bytein(sp->cfg_reg + CARD_START_TIMER);
+#ifdef CONFIG_HISAX_ELSA_PCC
+ byteout(sp->cfg_reg + CARD_TRIG_IRQ, 0xff);
+ byteout(sp->cfg_reg + CARD_START_TIMER, 0);
if (!TimerRun(sp)) {
- bytein(sp->cfg_reg + CARD_START_TIMER); /* 2. Versuch */
+ byteout(sp->cfg_reg + CARD_START_TIMER, 0); /* 2. Versuch */
if (!TimerRun(sp)) {
printk(KERN_WARNING
"Elsa: timer do not start\n");
@@ -1298,18 +1449,8 @@ setup_elsa(struct IsdnCard *card)
return (0);
}
printk(KERN_INFO "Elsa: timer OK; resetting card\n");
- /* Wait 1 Timer */
- bytein(sp->cfg_reg + CARD_START_TIMER);
- while (TimerRun(sp));
- byteout(sp->cfg_reg + CARD_CONTROL, 0x00); /* Reset On */
- /* Wait 1 Timer */
- bytein(sp->cfg_reg + CARD_START_TIMER);
- while (TimerRun(sp));
- byteout(sp->cfg_reg + CARD_CONTROL, ISDN_RESET); /* Reset Off */
- /* Wait 1 Timer */
- bytein(sp->cfg_reg + CARD_START_TIMER);
- while (TimerRun(sp));
-
+ reset_elsa(sp);
+#endif
verA = readhscx(sp->cfg_reg, 0, HSCX_VSTR) & 0xf;
verB = readhscx(sp->cfg_reg, 1, HSCX_VSTR) & 0xf;
printk(KERN_INFO "Elsa: HSCX version A: %s B: %s\n",
@@ -1318,6 +1459,26 @@ setup_elsa(struct IsdnCard *card)
printk(KERN_INFO "Elsa: ISAC %s\n",
ISACVersion(val));
+#ifdef CONFIG_HISAX_ELSA_PCMCIA
+ if ((verA == 0) | (verA == 0xf) | (verB == 0) | (verB == 0xf)) {
+ printk(KERN_WARNING
+ "Elsa: wrong HSCX versions check IO address\n");
+ release_io_elsa(card);
+ return (0);
+ }
+#endif
+
+#ifdef CONFIG_HISAX_ELSA_PCC
+ if (sp->subtyp == ELSA_PC) {
+ val = readitac(sp->cfg_reg, ITAC_SYS);
+ printk(KERN_INFO "Elsa: ITAC version %s\n", ITACVer[val & 7]);
+ writeitac(sp->cfg_reg, ITAC_ISEN, 0);
+ writeitac(sp->cfg_reg, ITAC_RFIE, 0);
+ writeitac(sp->cfg_reg, ITAC_XFIE, 0);
+ writeitac(sp->cfg_reg, ITAC_SCIE, 0);
+ writeitac(sp->cfg_reg, ITAC_STIE, 0);
+ }
+#endif
sp->modehscx = &modehscx;
sp->ph_command = &ph_command;
sp->hscx_fill_fifo = &hscx_fill_fifo;
diff --git a/drivers/isdn/hisax/elsa.h b/drivers/isdn/hisax/elsa.h
index b2f1b80fb..5187e6abb 100644
--- a/drivers/isdn/hisax/elsa.h
+++ b/drivers/isdn/hisax/elsa.h
@@ -1,4 +1,4 @@
-/* $Id: elsa.h,v 1.4 1997/01/21 22:21:05 keil Exp $
+/* $Id: elsa.h,v 1.6 1997/03/23 21:45:48 keil Exp $
*
* elsa.h Header for Elsa ISDN cards
*
@@ -8,6 +8,12 @@
*
*
* $Log: elsa.h,v $
+ * Revision 1.6 1997/03/23 21:45:48 keil
+ * Add support for ELSA PCMCIA
+ *
+ * Revision 1.5 1997/03/04 15:58:13 keil
+ * ELSA PC changes, some stuff for new cards
+ *
* Revision 1.4 1997/01/21 22:21:05 keil
* Elsa Quickstep support
*
@@ -22,20 +28,39 @@
*
*
*/
+#include <linux/config.h>
+#ifdef CONFIG_HISAX_ELSA_PCMCIA
+#define CARD_ISAC 1
+#define CARD_HSCX 2
+#define CARD_ALE 4
+#else
#define CARD_ISAC 0
+#define CARD_ITAC 1
#define CARD_HSCX 2
#define CARD_ALE 3
#define CARD_CONTROL 4
#define CARD_CONFIG 5
#define CARD_START_TIMER 6
#define CARD_TRIG_IRQ 7
+#endif
-#define ELSA_PCC 1
-#define ELSA_PCFPRO 2
+#define ELSA_PC 1
+#define ELSA_PCC8 2
#define ELSA_PCC16 3
#define ELSA_PCF 4
-#define ELSA_QS1000 5
+#define ELSA_PCFPRO 5
+#define ELSA_PCMCIA 6
+#define ELSA_QS1000 7
+#define ELSA_QS3000 8
+
+/* ITAC Registeradressen (only Microlink PC) */
+#define ITAC_SYS 0x34
+#define ITAC_ISEN 0x48
+#define ITAC_RFIE 0x4A
+#define ITAC_XFIE 0x4C
+#define ITAC_SCIE 0x4E
+#define ITAC_STIE 0x46
/*** ***
*** Makros als Befehle fuer die Kartenregister ***
@@ -44,8 +69,10 @@
/* Config-Register (Read) */
#define TIMER_RUN 0x02 /* Bit 1 des Config-Reg */
-#define TIMER_RUN_PCC 0x01 /* Bit 0 des Config-Reg bei PCC */
+#define TIMER_RUN_PCC8 0x01 /* Bit 0 des Config-Reg bei PCC */
#define IRQ_INDEX 0x38 /* Bit 3,4,5 des Config-Reg */
+#define IRQ_INDEX_PCC8 0x30 /* Bit 4,5 des Config-Reg */
+#define IRQ_INDEX_PC 0x0c /* Bit 2,3 des Config-Reg */
/* Control-Register (Write) */
#define LINE_LED 0x02 /* Bit 1 Gelbe LED */
diff --git a/drivers/isdn/hisax/fsm.c b/drivers/isdn/hisax/fsm.c
index 9ba0a2c18..d0bb2f14f 100644
--- a/drivers/isdn/hisax/fsm.c
+++ b/drivers/isdn/hisax/fsm.c
@@ -1,5 +1,5 @@
-/* $Id: fsm.c,v 1.3 1997/02/16 01:04:08 fritz Exp $
- *
+/* $Id: fsm.c,v 1.4 1997/04/06 22:56:42 keil Exp $
+
* Author Karsten Keil (keil@temic-ech.spacenet.de)
* based on the teles driver from Jan den Ouden
*
@@ -7,6 +7,9 @@
* Fritz Elfert
*
* $Log: fsm.c,v $
+ * Revision 1.4 1997/04/06 22:56:42 keil
+ * Some cosmetic changes
+ *
* Revision 1.3 1997/02/16 01:04:08 fritz
* Bugfix: Changed timer handling caused hang with 2.1.X
*
@@ -27,10 +30,10 @@ void
FsmNew(struct Fsm *fsm,
struct FsmNode *fnlist, int fncount)
{
- int i;
+ int i;
- fsm->jumpmatrix = (int *) Smalloc(4L * fsm->state_count * fsm->event_count,
- GFP_KERNEL, "Fsm jumpmatrix");
+ fsm->jumpmatrix = (int *)
+ kmalloc(4L * fsm->state_count * fsm->event_count, GFP_KERNEL);
memset(fsm->jumpmatrix, 0, 4L * fsm->state_count * fsm->event_count);
for (i = 0; i < fncount; i++)
@@ -41,14 +44,14 @@ FsmNew(struct Fsm *fsm,
void
FsmFree(struct Fsm *fsm)
{
- Sfree((void *) fsm->jumpmatrix);
+ kfree((void *) fsm->jumpmatrix);
}
int
FsmEvent(struct FsmInst *fi, int event, void *arg)
{
- void (*r) (struct FsmInst *, int, void *);
- char str[80];
+ void (*r) (struct FsmInst *, int, void *);
+ char str[80];
r = (void (*)) fi->fsm->jumpmatrix[fi->fsm->state_count * event + fi->state];
if (r) {
@@ -74,7 +77,7 @@ FsmEvent(struct FsmInst *fi, int event, void *arg)
void
FsmChangeState(struct FsmInst *fi, int newstate)
{
- char str[80];
+ char str[80];
fi->state = newstate;
if (fi->debug) {
@@ -90,7 +93,7 @@ FsmExpireTimer(struct FsmTimer *ft)
#if FSM_TIMER_DEBUG
if (ft->fi->debug) {
char str[40];
- sprintf(str, "FsmExpireTimer %lx", (long)ft);
+ sprintf(str, "FsmExpireTimer %lx", (long) ft);
ft->fi->printdebug(ft->fi, str);
}
#endif
@@ -106,7 +109,7 @@ FsmInitTimer(struct FsmInst *fi, struct FsmTimer *ft)
#if FSM_TIMER_DEBUG
if (ft->fi->debug) {
char str[40];
- sprintf(str, "FsmInitTimer %lx", (long)ft);
+ sprintf(str, "FsmInitTimer %lx", (long) ft);
ft->fi->printdebug(ft->fi, str);
}
#endif
@@ -119,7 +122,7 @@ FsmDelTimer(struct FsmTimer *ft, int where)
#if FSM_TIMER_DEBUG
if (ft->fi->debug) {
char str[40];
- sprintf(str, "FsmDelTimer %lx %d", (long)ft, where);
+ sprintf(str, "FsmDelTimer %lx %d", (long) ft, where);
ft->fi->printdebug(ft->fi, str);
}
#endif
@@ -134,7 +137,7 @@ FsmAddTimer(struct FsmTimer *ft,
#if FSM_TIMER_DEBUG
if (ft->fi->debug) {
char str[40];
- sprintf(str, "FsmAddTimer %lx %d %d", (long)ft, millisec, where);
+ sprintf(str, "FsmAddTimer %lx %d %d", (long) ft, millisec, where);
ft->fi->printdebug(ft->fi, str);
}
#endif
diff --git a/drivers/isdn/hisax/hisax.h b/drivers/isdn/hisax/hisax.h
index f4b62ece4..efe7d5329 100644
--- a/drivers/isdn/hisax/hisax.h
+++ b/drivers/isdn/hisax/hisax.h
@@ -1,8 +1,14 @@
-/* $Id: hisax.h,v 1.11 1997/02/11 01:36:02 keil Exp $
+/* $Id: hisax.h,v 1.13 1997/04/06 22:54:12 keil Exp $
* Basic declarations, defines and prototypes
*
* $Log: hisax.h,v $
+ * Revision 1.13 1997/04/06 22:54:12 keil
+ * Using SKB's
+ *
+ * Revision 1.12 1997/03/23 21:45:45 keil
+ * Add support for ELSA PCMCIA
+ *
* Revision 1.11 1997/02/11 01:36:02 keil
* New Param structure
*
@@ -182,36 +188,12 @@ struct HscxIoctlArg {
#undef DEBUG_MAGIC
-#define HSCX_SBUF_ORDER 1
-#define HSCX_SBUF_BPPS 2
-#define HSCX_SBUF_MAXPAGES 3
-
-#define HSCX_RBUF_ORDER 1
-#define HSCX_RBUF_BPPS 2
-#define HSCX_RBUF_MAXPAGES 3
-
-#define HSCX_SMALLBUF_ORDER 0
-#define HSCX_SMALLBUF_BPPS 40
-#define HSCX_SMALLBUF_MAXPAGES 1
-
-#define ISAC_SBUF_ORDER 0
-#define ISAC_SBUF_BPPS 16
-#define ISAC_SBUF_MAXPAGES 1
-
-#define ISAC_RBUF_ORDER 0
-#define ISAC_RBUF_BPPS 16
-#define ISAC_RBUF_MAXPAGES 1
-
-#define ISAC_SMALLBUF_ORDER 0
-#define ISAC_SMALLBUF_BPPS 40
-#define ISAC_SMALLBUF_MAXPAGES 1
-
-#define byte unsigned char
-
-#define MAX_WINDOW 8
-
-byte *Smalloc(int size, int pr, char *why);
-void Sfree(byte * ptr);
+#define MAX_DFRAME_LEN 3072
+#define HSCX_BUFMAX 4096
+#define MAX_DATA_SIZE (HSCX_BUFMAX - 4)
+#define MAX_DATA_MEM (HSCX_BUFMAX * 2)
+#define MAX_HEADER_LEN 4
+#define MAX_WINDOW 8
/*
* Statemachine
@@ -249,48 +231,12 @@ struct L3Timer {
int event;
};
-struct BufHeader {
-#ifdef DEBUG_MAGIC
- int magic;
-#endif
- struct BufHeader *next;
- struct BufPool *bp;
- int datasize;
- byte primitive, where;
- void *heldby;
-};
-
-struct Pages {
- struct Pages *next;
-};
-
-struct BufPool {
-#ifdef DEBUG_MAGIC
- int magic;
-#endif
- struct BufHeader *freelist;
- struct Pages *pageslist;
- int pageorder;
- int pagescount;
- int bpps;
- int bufsize;
- int maxpages;
-};
-
-struct BufQueue {
-#ifdef DEBUG_MAGIC
- int magic;
-#endif
- struct BufHeader *head, *tail;
-};
-
struct Layer1 {
void *hardware;
int hscx;
- struct BufPool *sbufpool, *rbufpool, *smallpool;
struct PStack **stlistp;
int act_state;
- void (*l1l2) (struct PStack *, int, struct BufHeader *);
+ void (*l1l2) (struct PStack *, int, void *);
void (*l1man) (struct PStack *, int, void *);
int hscxmode, hscxchannel, requestpull;
};
@@ -300,14 +246,14 @@ struct Layer2 {
int extended, laptype;
int uihsize, ihsize;
int vs, va, vr;
- struct BufQueue i_queue;
+ struct sk_buff_head i_queue;
int window, orig;
int rejexp;
int debug;
- struct BufHeader *windowar[MAX_WINDOW];
+ struct sk_buff *windowar[MAX_WINDOW];
int sow;
struct FsmInst l2m;
- void (*l2l1) (struct PStack *, int, struct BufHeader *);
+ void (*l2l1) (struct PStack *, int, void *);
void (*l2l1discardq) (struct PStack *, int, void *, int);
void (*l2man) (struct PStack *, int, void *);
void (*l2l3) (struct PStack *, int, void *);
@@ -319,7 +265,7 @@ struct Layer2 {
};
struct Layer3 {
- void (*l3l4) (struct PStack *, int, struct BufHeader *);
+ void (*l3l4) (struct PStack *, int, void *);
void (*l3l2) (struct PStack *, int, void *);
int state, callref;
struct L3Timer timer;
@@ -347,7 +293,7 @@ struct Param {
int loc;
int bchannel;
int callref; /* Callreferenz Number */
- setup_parm setup; /* from isdnif.h numbers and Serviceindicator */
+ setup_parm setup; /* from isdnif.h numbers and Serviceindicator */
int chargeinfo; /* Charge Info - only for 1tr6 in
* the moment
*/
@@ -367,17 +313,18 @@ struct PStack {
struct HscxState {
int inuse, init, active;
- struct BufPool sbufpool, rbufpool, smallpool;
struct IsdnCardState *sp;
int hscx, mode;
- int transbufsize, receive;
- struct BufHeader *rcvibh, *xmtibh;
- int rcvptr, sendptr;
+ u_char *rcvbuf; /* B-Channel receive Buffer */
+ int rcvidx; /* B-Channel receive Buffer Index */
+ struct sk_buff *tx_skb; /* B-Channel transmit Buffer */
+ int tx_cnt; /* B-Channel transmit counter */
+ int count; /* Current skb sent count */
+ struct sk_buff_head rqueue; /* B-Channel receive Queue */
+ struct sk_buff_head squeue; /* B-Channel receive Queue */
struct PStack *st;
struct tq_struct tqueue;
int event;
- struct BufQueue rq, sq;
- int releasebuf;
#ifdef DEBUG_MAGIC
int magic; /* 301270 */
#endif
@@ -431,27 +378,26 @@ struct IsdnCardState {
unsigned int isac;
unsigned int hscx[2];
unsigned int counter;
- int myid;
- isdn_if iif;
- byte *status_buf;
- byte *status_read;
- byte *status_write;
- byte *status_end;
- struct BufHeader *mon_rx, *mon_tx;
- int mon_rxp, mon_txp, mon_flg;
+ int myid;
+ isdn_if iif;
+ u_char *status_buf;
+ u_char *status_read;
+ u_char *status_write;
+ u_char *status_end;
void (*ph_command) (struct IsdnCardState *, unsigned int);
void (*modehscx) (struct HscxState *, int, int);
void (*hscx_fill_fifo) (struct HscxState *);
void (*isac_fill_fifo) (struct IsdnCardState *);
- struct BufPool sbufpool, rbufpool, smallpool;
struct Channel channel[2];
struct PStack *stlist;
- struct BufHeader *xmtibh, *rcvibh;
- int rcvptr, sendptr;
+ u_char *rcvbuf;
+ int rcvidx;
+ struct sk_buff *tx_skb;
+ int tx_cnt;
int event;
struct tq_struct tqueue;
int ph_active;
- struct BufQueue rq, sq;
+ struct sk_buff_head rq, sq; /* D-channel queues */
int cardnr;
int ph_state;
struct PStack *teistack;
@@ -459,7 +405,6 @@ struct IsdnCardState {
int dlogflag;
char *dlogspace;
int debug;
- int releasebuf;
unsigned int CallFlags;
};
@@ -505,6 +450,15 @@ struct IsdnCardState {
#define CARD_ELSA 0
#endif
+#ifdef CONFIG_HISAX_ELSA_PCMCIA
+#if CARD_ELSA
+#error "You can't use a ELSA ISA card and a ELSA PCMCIA card with the same driver"
+#else
+#undef CARD_ELSA
+#define CARD_ELSA (1<< ISDN_CTYPE_ELSA_QS1000)
+#endif
+#endif
+
#ifdef CONFIG_HISAX_IX1MICROR2
#define CARD_IX1MICROR2 (1 << ISDN_CTYPE_IX1MICROR2)
#else
@@ -521,37 +475,20 @@ struct IsdnCard {
struct IsdnCardState *sp;
};
-#define DATAPTR(x) ((byte *)x+sizeof(struct BufHeader))
#define LAPD 0
#define LAPB 1
-void BufPoolInit(struct BufPool *bp, int order, int bpps,
- int maxpages);
-int BufPoolAdd(struct BufPool *bp, int priority);
-void BufPoolFree(struct BufPool *bp);
-int BufPoolGet(struct BufHeader **bh, struct BufPool *bp,
- int priority, void *heldby, int where);
-void BufPoolRelease(struct BufHeader *bh);
-void BufQueueLink(struct BufQueue *bq, struct BufHeader *bh);
-int BufQueueUnlink(struct BufHeader **bh, struct BufQueue *bq);
-void BufQueueInit(struct BufQueue *bq);
-void BufQueueRelease(struct BufQueue *bq);
-void BufQueueDiscard(struct BufQueue *q, int pr, void *heldby,
- int releasetoo);
-int BufQueueLength(struct BufQueue *bq);
-void BufQueueLinkFront(struct BufQueue *bq, struct BufHeader *bh);
-
-void l2down(struct PStack *st, byte pr, struct BufHeader *ibh);
-void l2up(struct PStack *st, byte pr, struct BufHeader *ibh);
-void acceptph(struct PStack *st, struct BufHeader *ibh);
+void l2down(struct PStack *st, u_char pr, struct sk_buff *skb);
+void l2up(struct PStack *st, u_char pr, struct sk_buff *skb);
+void acceptph(struct PStack *st, struct sk_buff *skb);
void setstack_isdnl2(struct PStack *st, char *debug_id);
int HiSax_inithardware(void);
void HiSax_closehardware(void);
void setstack_HiSax(struct PStack *st, struct IsdnCardState *sp);
unsigned int randomces(void);
-void setstack_isdnl3(struct PStack *st, struct Channel *chanp );
+void setstack_isdnl3(struct PStack *st, struct Channel *chanp);
void HiSax_addlist(struct IsdnCardState *sp, struct PStack *st);
void releasestack_isdnl2(struct PStack *st);
void releasestack_isdnl3(struct PStack *st);
@@ -559,8 +496,8 @@ void HiSax_rmlist(struct IsdnCardState *sp, struct PStack *st);
void newcallref(struct PStack *st);
int setstack_hscx(struct PStack *st, struct HscxState *hs);
-byte *findie(byte * p, int size, byte ie, int wanted_set);
-int getcallref(byte * p);
+u_char *findie(u_char * p, int size, u_char ie, int wanted_set);
+int getcallref(u_char * p);
void FsmNew(struct Fsm *fsm, struct FsmNode *fnlist, int fncount);
void FsmFree(struct Fsm *fsm);
@@ -574,27 +511,18 @@ int FsmTimerRunning(struct FsmTimer *ft);
void jiftime(char *s, long mark);
int HiSax_command(isdn_ctrl * ic);
-int HiSax_writebuf(int id, int chan, const u_char * buf, int count, int user);
+int HiSax_writebuf_skb(int id, int chan, struct sk_buff *skb);
void HiSax_putstatus(struct IsdnCardState *csta, char *buf);
void HiSax_reportcard(int cardnr);
-int ListLength(struct BufHeader *ibh);
-int QuickHex(char *txt, byte * p, int cnt);
-void LogFrame(struct IsdnCardState *sp, byte * p, int size);
-void dlogframe(struct IsdnCardState *sp, byte * p, int size, char *comment);
-void iecpy(byte * dest, byte * iestart, int ieoffset);
+int QuickHex(char *txt, u_char * p, int cnt);
+void LogFrame(struct IsdnCardState *sp, u_char * p, int size);
+void dlogframe(struct IsdnCardState *sp, u_char * p, int size, char *comment);
+void iecpy(u_char * dest, u_char * iestart, int ieoffset);
void setstack_transl2(struct PStack *st);
void releasestack_transl2(struct PStack *st);
void close_hscxstate(struct HscxState *);
void setstack_tei(struct PStack *st);
-
-
-
-#define PART_SIZE(order,bpps) (( (PAGE_SIZE<<order) -\
- sizeof(void *))/bpps)
-#define BUFFER_SIZE(order,bpps) (PART_SIZE(order,bpps)-\
- sizeof(struct BufHeader))
-
#endif /* __KERNEL__ */
#define HZDELAY(jiffs) {int tout = jiffs; while (tout--) udelay(1000000/HZ);}
diff --git a/drivers/isdn/hisax/isdnl1.c b/drivers/isdn/hisax/isdnl1.c
index ebf0957b5..0dc0bb520 100644
--- a/drivers/isdn/hisax/isdnl1.c
+++ b/drivers/isdn/hisax/isdnl1.c
@@ -1,4 +1,4 @@
-/* $Id: isdnl1.c,v 1.8 1997/02/09 00:24:31 keil Exp $
+/* $Id: isdnl1.c,v 1.15 1997/05/27 15:17:55 fritz Exp $
* isdnl1.c common low level stuff for Siemens Chipsetbased isdn cards
* based on the teles driver from Jan den Ouden
@@ -11,6 +11,31 @@
*
*
* $Log: isdnl1.c,v $
+ * Revision 1.15 1997/05/27 15:17:55 fritz
+ * Added changes for recent 2.1.x kernels:
+ * changed return type of isdn_close
+ * queue_task_* -> queue_task
+ * clear/set_bit -> test_and_... where apropriate.
+ * changed type of hard_header_cache parameter.
+ *
+ * Revision 1.14 1997/04/07 23:00:08 keil
+ * GFP_KERNEL ---> GFP_ATOMIC
+ *
+ * Revision 1.13 1997/04/06 22:55:50 keil
+ * Using SKB's
+ *
+ * Revision 1.12 1997/03/26 13:43:57 keil
+ * small cosmetics
+ *
+ * Revision 1.11 1997/03/25 23:11:23 keil
+ * US NI-1 protocol
+ *
+ * Revision 1.10 1997/03/13 14:45:05 keil
+ * using IRQ proof queue_task
+ *
+ * Revision 1.9 1997/03/12 21:44:21 keil
+ * change Interrupt routine from atomic quick to normal
+ *
* Revision 1.8 1997/02/09 00:24:31 keil
* new interface handling, one interface per card
*
@@ -39,9 +64,10 @@
*
*/
-const char *l1_revision = "$Revision: 1.8 $";
+const char *l1_revision = "$Revision: 1.15 $";
#define __NO_VERSION__
+#include <linux/config.h>
#include "hisax.h"
#include "isdnl1.h"
@@ -65,6 +91,9 @@ const char *l1_revision = "$Revision: 1.8 $";
#include "ix1_micro.h"
#endif
+/* #define I4L_IRQ_FLAG SA_INTERRUPT */
+#define I4L_IRQ_FLAG 0
+
#define HISAX_STATUS_BUFSIZE 4096
#define INCLUDE_INLINE_FUNCS
@@ -73,7 +102,12 @@ const char *l1_revision = "$Revision: 1.8 $";
const char *CardType[] =
{"No Card", "Teles 16.0", "Teles 8.0", "Teles 16.3",
- "Creatix PnP", "AVM A1", "Elsa ML", "Elsa Quickstep",
+ "Creatix/Teles PnP", "AVM A1", "Elsa ML",
+#ifdef CONFIG_HISAX_ELSA_PCMCIA
+ "Elsa PCMCIA",
+#else
+ "Elsa Quickstep",
+#endif
"Teles PCMCIA", "ITK ix1-micro Rev.2"};
static char *HSCXVer[] =
@@ -84,8 +118,6 @@ static char *ISACVer[] =
{"2086/2186 V1.1", "2085 B1", "2085 B2",
"2085 V2.3"};
-extern void tei_handler(struct PStack *st, byte pr,
- struct BufHeader *ibh);
extern struct IsdnCard cards[];
extern int nrcards;
extern char *HiSax_id;
@@ -107,10 +139,10 @@ hisax_findcard(int driverid)
}
int
-HiSax_readstatus(byte * buf, int len, int user, int id, int channel)
+HiSax_readstatus(u_char * buf, int len, int user, int id, int channel)
{
int count;
- byte *p;
+ u_char *p;
struct IsdnCardState *csta = hisax_findcard(id);
if (csta) {
@@ -135,7 +167,7 @@ HiSax_putstatus(struct IsdnCardState *csta, char *buf)
{
long flags;
int len, count, i;
- byte *p;
+ u_char *p;
isdn_ctrl ic;
save_flags(flags);
@@ -198,11 +230,11 @@ ll_unload(struct IsdnCardState *csta)
ic.driver = csta->myid;
csta->iif.statcallb(&ic);
if (csta->status_buf)
- Sfree(csta->status_buf);
+ kfree(csta->status_buf);
csta->status_read = NULL;
csta->status_write = NULL;
csta->status_end = NULL;
- Sfree(csta->dlogspace);
+ kfree(csta->dlogspace);
}
void
@@ -221,7 +253,7 @@ debugl1(struct IsdnCardState *sp, char *msg)
char *
-HscxVersion(byte v)
+HscxVersion(u_char v)
{
return (HSCXVer[v & 0xf]);
}
@@ -230,7 +262,7 @@ void
hscx_sched_event(struct HscxState *hsp, int event)
{
hsp->event |= 1 << event;
- queue_task_irq_off(&hsp->tqueue, &tq_immediate);
+ queue_task(&hsp->tqueue, &tq_immediate);
mark_bh(IMMEDIATE_BH);
}
@@ -239,7 +271,7 @@ hscx_sched_event(struct HscxState *hsp, int event)
*/
char *
-ISACVersion(byte v)
+ISACVersion(u_char v)
{
return (ISACVer[(v >> 5) & 3]);
}
@@ -248,7 +280,7 @@ void
isac_sched_event(struct IsdnCardState *sp, int event)
{
sp->event |= 1 << event;
- queue_task_irq_off(&sp->tqueue, &tq_immediate);
+ queue_task(&sp->tqueue, &tq_immediate);
mark_bh(IMMEDIATE_BH);
}
@@ -301,21 +333,23 @@ isac_new_ph(struct IsdnCardState *sp)
sp->ph_command(sp, 8);
sp->ph_active = 5;
isac_sched_event(sp, ISAC_PHCHANGE);
- if (!sp->xmtibh)
- if (!BufQueueUnlink(&sp->xmtibh, &sp->sq))
- sp->sendptr = 0;
- if (sp->xmtibh)
+ if (!sp->tx_skb)
+ sp->tx_skb = skb_dequeue(&sp->sq);
+ if (sp->tx_skb) {
+ sp->tx_cnt = 0;
sp->isac_fill_fifo(sp);
+ }
break;
case (13):
sp->ph_command(sp, 9);
sp->ph_active = 5;
isac_sched_event(sp, ISAC_PHCHANGE);
- if (!sp->xmtibh)
- if (!BufQueueUnlink(&sp->xmtibh, &sp->sq))
- sp->sendptr = 0;
- if (sp->xmtibh)
+ if (!sp->tx_skb)
+ sp->tx_skb = skb_dequeue(&sp->sq);
+ if (sp->tx_skb) {
+ sp->tx_cnt = 0;
sp->isac_fill_fifo(sp);
+ }
break;
case (4):
case (8):
@@ -372,7 +406,7 @@ process_xmt(struct IsdnCardState *sp)
{
struct PStack *stptr;
- if (sp->xmtibh)
+ if (sp->tx_skb)
return;
stptr = sp->stlist;
@@ -388,48 +422,44 @@ process_xmt(struct IsdnCardState *sp)
static void
process_rcv(struct IsdnCardState *sp)
{
- struct BufHeader *ibh, *cibh;
+ struct sk_buff *skb, *nskb;
struct PStack *stptr;
- byte *ptr;
int found, broadc;
char tmp[64];
- while (!BufQueueUnlink(&ibh, &sp->rq)) {
+ while ((skb = skb_dequeue(&sp->rq))) {
#ifdef L2FRAME_DEBUG /* psa */
if (sp->debug & L1_DEB_LAPD)
- Logl2Frame(sp, ibh, "PH_DATA", 1);
+ Logl2Frame(sp, skb, "PH_DATA", 1);
#endif
stptr = sp->stlist;
- ptr = DATAPTR(ibh);
- broadc = (ptr[1] >> 1) == 127;
+ broadc = (skb->data[1] >> 1) == 127;
if (broadc) {
- if (!(ptr[0] >> 2)) { /* sapi 0 */
+ if (!(skb->data[0] >> 2)) { /* sapi 0 */
sp->CallFlags = 3;
if (sp->dlogflag) {
- LogFrame(sp, ptr, ibh->datasize);
- dlogframe(sp, ptr + 3, ibh->datasize - 3,
+ LogFrame(sp, skb->data, skb->len);
+ dlogframe(sp, skb->data + 3, skb->len - 3,
"Q.931 frame network->user broadcast");
}
}
while (stptr != NULL) {
- if ((ptr[0] >> 2) == stptr->l2.sap)
- if (!BufPoolGet(&cibh, &sp->rbufpool, GFP_ATOMIC,
- (void *) 1, 5)) {
- memcpy(DATAPTR(cibh), DATAPTR(ibh), ibh->datasize);
- cibh->datasize = ibh->datasize;
- stptr->l1.l1l2(stptr, PH_DATA, cibh);
- } else
+ if ((skb->data[0] >> 2) == stptr->l2.sap)
+ if ((nskb = skb_clone(skb, GFP_ATOMIC)))
+ stptr->l1.l1l2(stptr, PH_DATA, nskb);
+ else
printk(KERN_WARNING "HiSax: isdn broadcast buffer shortage\n");
stptr = stptr->next;
}
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
} else {
found = 0;
while (stptr != NULL)
- if (((ptr[0] >> 2) == stptr->l2.sap) &&
- ((ptr[1] >> 1) == stptr->l2.tei)) {
- stptr->l1.l1l2(stptr, PH_DATA, ibh);
+ if (((skb->data[0] >> 2) == stptr->l2.sap) &&
+ ((skb->data[1] >> 1) == stptr->l2.tei)) {
+ stptr->l1.l1l2(stptr, PH_DATA, skb);
found = !0;
break;
} else
@@ -440,14 +470,15 @@ process_rcv(struct IsdnCardState *sp)
* by isdn4linux
*/
- if ((!(ptr[0] >> 2)) && (!(ptr[2] & 0x01))) {
+ if ((!(skb->data[0] >> 2)) && (!(skb->data[2] & 0x01))) {
sprintf(tmp,
"Q.931 frame network->user with tei %d (not for us)",
- ptr[1] >> 1);
- LogFrame(sp, ptr, ibh->datasize);
- dlogframe(sp, ptr + 4, ibh->datasize - 4, tmp);
+ skb->data[1] >> 1);
+ LogFrame(sp, skb->data, skb->len);
+ dlogframe(sp, skb->data + 4, skb->len - 4, tmp);
}
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
}
}
@@ -470,65 +501,62 @@ isac_bh(struct IsdnCardState *sp)
}
static void
-l2l1(struct PStack *st, int pr,
- struct BufHeader *ibh)
+l2l1(struct PStack *st, int pr, void *arg)
{
struct IsdnCardState *sp = (struct IsdnCardState *) st->l1.hardware;
- byte *ptr = DATAPTR(ibh);
+ struct sk_buff *skb = arg;
char str[64];
switch (pr) {
case (PH_DATA):
- if (sp->xmtibh) {
- BufQueueLink(&sp->sq, ibh);
+ if (sp->tx_skb) {
+ skb_queue_tail(&sp->sq, skb);
#ifdef L2FRAME_DEBUG /* psa */
if (sp->debug & L1_DEB_LAPD)
- Logl2Frame(sp, ibh, "PH_DATA Queued", 0);
+ Logl2Frame(sp, skb, "PH_DATA Queued", 0);
#endif
} else {
- if ((sp->dlogflag) && (!(ptr[2] & 1))) { /* I-FRAME */
- LogFrame(sp, ptr, ibh->datasize);
+ if ((sp->dlogflag) && (!(skb->data[2] & 1))) { /* I-FRAME */
+ LogFrame(sp, skb->data, skb->len);
sprintf(str, "Q.931 frame user->network tei %d", st->l2.tei);
- dlogframe(sp, ptr + st->l2.ihsize, ibh->datasize - st->l2.ihsize,
+ dlogframe(sp, skb->data + st->l2.ihsize, skb->len - st->l2.ihsize,
str);
}
- sp->xmtibh = ibh;
- sp->sendptr = 0;
- sp->releasebuf = !0;
- sp->isac_fill_fifo(sp);
+ sp->tx_skb = skb;
+ sp->tx_cnt = 0;
#ifdef L2FRAME_DEBUG /* psa */
if (sp->debug & L1_DEB_LAPD)
- Logl2Frame(sp, ibh, "PH_DATA", 0);
+ Logl2Frame(sp, skb, "PH_DATA", 0);
#endif
+ sp->isac_fill_fifo(sp);
}
break;
case (PH_DATA_PULLED):
- if (sp->xmtibh) {
+ if (sp->tx_skb) {
if (sp->debug & L1_DEB_WARN)
- debugl1(sp, " l2l1 xmtibh exist this shouldn't happen");
+ debugl1(sp, " l2l1 tx_skb exist this shouldn't happen");
break;
}
- if ((sp->dlogflag) && (!(ptr[2] & 1))) { /* I-FRAME */
- LogFrame(sp, ptr, ibh->datasize);
+ if ((sp->dlogflag) && (!(skb->data[2] & 1))) { /* I-FRAME */
+ LogFrame(sp, skb->data, skb->len);
sprintf(str, "Q.931 frame user->network tei %d", st->l2.tei);
- dlogframe(sp, ptr + st->l2.ihsize, ibh->datasize - st->l2.ihsize,
+ dlogframe(sp, skb->data + st->l2.ihsize, skb->len - st->l2.ihsize,
str);
}
- sp->xmtibh = ibh;
- sp->sendptr = 0;
- sp->releasebuf = 0;
- sp->isac_fill_fifo(sp);
+ sp->tx_skb = skb;
+ sp->tx_cnt = 0;
#ifdef L2FRAME_DEBUG /* psa */
if (sp->debug & L1_DEB_LAPD)
- Logl2Frame(sp, ibh, "PH_DATA_PULLED", 0);
+ Logl2Frame(sp, skb, "PH_DATA_PULLED", 0);
#endif
+ sp->isac_fill_fifo(sp);
break;
case (PH_REQUEST_PULL):
#ifdef L2FRAME_DEBUG /* psa */
if (sp->debug & L1_DEB_LAPD)
debugl1(sp, "-> PH_REQUEST_PULL");
#endif
- if (!sp->xmtibh) {
+ if (!sp->tx_skb) {
st->l1.requestpull = 0;
st->l1.l1l2(st, PH_PULL_ACK, NULL);
} else
@@ -543,7 +571,7 @@ hscx_process_xmt(struct HscxState *hsp)
{
struct PStack *st = hsp->st;
- if (hsp->xmtibh)
+ if (hsp->tx_skb)
return;
if (st->l1.requestpull) {
@@ -551,14 +579,14 @@ hscx_process_xmt(struct HscxState *hsp)
st->l1.l1l2(st, PH_PULL_ACK, NULL);
}
if (!hsp->active)
- if ((!hsp->xmtibh) && (!hsp->sq.head))
+ if ((!hsp->tx_skb) && (!skb_queue_len(&hsp->squeue)))
hsp->sp->modehscx(hsp, 0, 0);
}
static void
hscx_process_rcv(struct HscxState *hsp)
{
- struct BufHeader *ibh;
+ struct sk_buff *skb;
#ifdef DEBUG_MAGIC
if (hsp->magic != 301270) {
@@ -566,8 +594,8 @@ hscx_process_rcv(struct HscxState *hsp)
return;
}
#endif
- while (!BufQueueUnlink(&ibh, &hsp->rq)) {
- hsp->st->l1.l1l2(hsp->st, PH_DATA, ibh);
+ while ((skb = skb_dequeue(&hsp->rqueue))) {
+ hsp->st->l1.l1l2(hsp->st, PH_DATA, skb);
}
}
@@ -675,6 +703,7 @@ HiSax_l2l1discardq(struct PStack *st, int pr,
void *heldby, int releasetoo)
{
struct IsdnCardState *sp = (struct IsdnCardState *) st->l1.hardware;
+ struct sk_buff *skb;
#ifdef DEBUG_MAGIC
if (sp->magic != 301271) {
@@ -683,16 +712,16 @@ HiSax_l2l1discardq(struct PStack *st, int pr,
}
#endif
- BufQueueDiscard(&sp->sq, pr, heldby, releasetoo);
+ while ((skb = skb_dequeue(&sp->sq))) {
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_WRITE);
+ }
}
void
setstack_HiSax(struct PStack *st, struct IsdnCardState *sp)
{
st->l1.hardware = sp;
- st->l1.sbufpool = &(sp->sbufpool);
- st->l1.rbufpool = &(sp->rbufpool);
- st->l1.smallpool = &(sp->smallpool);
st->protocol = sp->protocol;
setstack_tei(st);
@@ -737,7 +766,7 @@ get_irq(int cardnr, void *routine)
save_flags(flags);
cli();
if (request_irq(card->sp->irq, routine,
- SA_INTERRUPT, "HiSax", NULL)) {
+ I4L_IRQ_FLAG, "HiSax", NULL)) {
printk(KERN_WARNING "HiSax: couldn't get interrupt %d\n",
card->sp->irq);
restore_flags(flags);
@@ -760,13 +789,28 @@ release_irq(int cardnr)
void
close_hscxstate(struct HscxState *hs)
{
+ struct sk_buff *skb;
+
hs->sp->modehscx(hs, 0, 0);
hs->inuse = 0;
-
if (hs->init) {
- BufPoolFree(&hs->smallpool);
- BufPoolFree(&hs->rbufpool);
- BufPoolFree(&hs->sbufpool);
+ if (hs->rcvbuf) {
+ kfree(hs->rcvbuf);
+ hs->rcvbuf = NULL;
+ }
+ while ((skb = skb_dequeue(&hs->rqueue))) {
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
+ }
+ while ((skb = skb_dequeue(&hs->squeue))) {
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_WRITE);
+ }
+ if (hs->tx_skb) {
+ SET_SKB_FREE(hs->tx_skb);
+ dev_kfree_skb(hs->tx_skb, FREE_WRITE);
+ hs->tx_skb = NULL;
+ }
}
hs->init = 0;
}
@@ -775,14 +819,28 @@ static void
closecard(int cardnr)
{
struct IsdnCardState *csta = cards[cardnr].sp;
-
- BufPoolFree(&csta->smallpool);
- BufPoolFree(&csta->rbufpool);
- BufPoolFree(&csta->sbufpool);
+ struct sk_buff *skb;
close_hscxstate(csta->hs + 1);
close_hscxstate(csta->hs);
+ if (csta->rcvbuf) {
+ kfree(csta->rcvbuf);
+ csta->rcvbuf = NULL;
+ }
+ while ((skb = skb_dequeue(&csta->rq))) {
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
+ }
+ while ((skb = skb_dequeue(&csta->sq))) {
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_WRITE);
+ }
+ if (csta->tx_skb) {
+ SET_SKB_FREE(csta->tx_skb);
+ dev_kfree_skb(csta->tx_skb, FREE_WRITE);
+ csta->tx_skb = NULL;
+ }
switch (csta->typ) {
#if CARD_TELES0
case ISDN_CTYPE_16_0:
@@ -830,8 +888,7 @@ checkcard(int cardnr, char *id)
save_flags(flags);
cli();
if (!(sp = (struct IsdnCardState *)
- Smalloc(sizeof(struct IsdnCardState), GFP_KERNEL,
- "struct IsdnCardState"))) {
+ kmalloc(sizeof(struct IsdnCardState), GFP_ATOMIC))) {
printk(KERN_WARNING
"HiSax: No memory for IsdnCardState(card %d)\n",
cardnr + 1);
@@ -858,18 +915,18 @@ checkcard(int cardnr, char *id)
restore_flags(flags);
return (0);
}
- if (!(sp->dlogspace = Smalloc(4096, GFP_KERNEL, "dlogspace"))) {
+ if (!(sp->dlogspace = kmalloc(4096, GFP_ATOMIC))) {
printk(KERN_WARNING
"HiSax: No memory for dlogspace(card %d)\n",
cardnr + 1);
restore_flags(flags);
return (0);
}
- if (!(sp->status_buf = Smalloc(HISAX_STATUS_BUFSIZE, GFP_KERNEL, "status_buf"))) {
+ if (!(sp->status_buf = kmalloc(HISAX_STATUS_BUFSIZE, GFP_ATOMIC))) {
printk(KERN_WARNING
"HiSax: No memory for status_buf(card %d)\n",
cardnr + 1);
- Sfree(sp->dlogspace);
+ kfree(sp->dlogspace);
restore_flags(flags);
return (0);
}
@@ -880,7 +937,8 @@ checkcard(int cardnr, char *id)
sp->CallFlags = 0;
strcpy(sp->iif.id, id);
sp->iif.channels = 2;
- sp->iif.maxbufsize = BUFFER_SIZE(HSCX_SBUF_ORDER, HSCX_SBUF_BPPS);
+ sp->iif.maxbufsize = MAX_DATA_SIZE;
+ sp->iif.hl_hdrlen = MAX_HEADER_LEN;
sp->iif.features =
ISDN_FEATURE_L2_X75I |
ISDN_FEATURE_L2_HDLC |
@@ -892,12 +950,15 @@ checkcard(int cardnr, char *id)
#ifdef CONFIG_HISAX_EURO
ISDN_FEATURE_P_EURO |
#endif
+#ifdef CONFIG_HISAX_NI1
+ ISDN_FEATURE_P_NI1 |
+#endif
0;
sp->iif.command = HiSax_command;
- sp->iif.writebuf = HiSax_writebuf;
+ sp->iif.writebuf = NULL;
sp->iif.writecmd = NULL;
- sp->iif.writebuf_skb = NULL;
+ sp->iif.writebuf_skb = HiSax_writebuf_skb;
sp->iif.readstat = HiSax_readstatus;
register_isdn(&sp->iif);
sp->myid = sp->iif.channels;
@@ -907,6 +968,7 @@ checkcard(int cardnr, char *id)
(card->protocol == ISDN_PTYPE_1TR6) ? "1TR6" :
(card->protocol == ISDN_PTYPE_EURO) ? "EDSS1" :
(card->protocol == ISDN_PTYPE_LEASED) ? "LEASED" :
+ (card->protocol == ISDN_PTYPE_NI1) ? "NI1" :
"NONE", sp->iif.id, sp->myid);
switch (card->typ) {
#if CARD_TELES0
@@ -948,35 +1010,27 @@ checkcard(int cardnr, char *id)
ll_unload(sp);
return (0);
}
- BufPoolInit(&sp->sbufpool, ISAC_SBUF_ORDER, ISAC_SBUF_BPPS,
- ISAC_SBUF_MAXPAGES);
- BufPoolInit(&sp->rbufpool, ISAC_RBUF_ORDER, ISAC_RBUF_BPPS,
- ISAC_RBUF_MAXPAGES);
- BufPoolInit(&sp->smallpool, ISAC_SMALLBUF_ORDER, ISAC_SMALLBUF_BPPS,
- ISAC_SMALLBUF_MAXPAGES);
- sp->rcvibh = NULL;
- sp->rcvptr = 0;
- sp->xmtibh = NULL;
- sp->sendptr = 0;
- sp->mon_rx = NULL;
- sp->mon_rxp = 0;
- sp->mon_tx = NULL;
- sp->mon_txp = 0;
- sp->mon_flg = 0;
+ if (!(sp->rcvbuf = kmalloc(MAX_DFRAME_LEN, GFP_ATOMIC))) {
+ printk(KERN_WARNING
+ "HiSax: No memory for isac rcvbuf\n");
+ return (1);
+ }
+ sp->rcvidx = 0;
+ sp->tx_skb = NULL;
+ sp->tx_cnt = 0;
sp->event = 0;
sp->tqueue.next = 0;
sp->tqueue.sync = 0;
sp->tqueue.routine = (void *) (void *) isac_bh;
sp->tqueue.data = sp;
- BufQueueInit(&sp->rq);
- BufQueueInit(&sp->sq);
+ skb_queue_head_init(&sp->rq);
+ skb_queue_head_init(&sp->sq);
sp->stlist = NULL;
sp->ph_active = 0;
sp->dlogflag = 0;
sp->debug = L1_DEB_WARN;
- sp->releasebuf = 0;
#ifdef DEBUG_MAGIC
sp->magic = 301271;
#endif
@@ -1075,7 +1129,7 @@ HiSax_inithardware(void)
printk(KERN_WARNING "HiSax: Card %s not installed !\n",
CardType[cards[i].typ]);
if (cards[i].sp)
- Sfree((void *) cards[i].sp);
+ kfree((void *) cards[i].sp);
cards[i].sp = NULL;
HiSax_shiftcards(i);
}
@@ -1098,7 +1152,7 @@ HiSax_closehardware(void)
release_tei(cards[i].sp);
release_irq(i);
closecard(i);
- Sfree((void *) cards[i].sp);
+ kfree((void *) cards[i].sp);
cards[i].sp = NULL;
}
Isdnl2Free();
@@ -1107,11 +1161,10 @@ HiSax_closehardware(void)
}
static void
-hscx_l2l1(struct PStack *st, int pr,
- struct BufHeader *ibh)
+hscx_l2l1(struct PStack *st, int pr, void *arg)
{
- struct IsdnCardState *sp = (struct IsdnCardState *)
- st->l1.hardware;
+ struct sk_buff *skb = arg;
+ struct IsdnCardState *sp = (struct IsdnCardState *) st->l1.hardware;
struct HscxState *hsp = sp->hs + st->l1.hscx;
long flags;
@@ -1119,29 +1172,27 @@ hscx_l2l1(struct PStack *st, int pr,
case (PH_DATA):
save_flags(flags);
cli();
- if (hsp->xmtibh) {
- BufQueueLink(&hsp->sq, ibh);
+ if (hsp->tx_skb) {
+ skb_queue_tail(&hsp->squeue, skb);
restore_flags(flags);
} else {
restore_flags(flags);
- hsp->xmtibh = ibh;
- hsp->sendptr = 0;
- hsp->releasebuf = !0;
+ hsp->tx_skb = skb;
+ hsp->count = 0;
sp->hscx_fill_fifo(hsp);
}
break;
case (PH_DATA_PULLED):
- if (hsp->xmtibh) {
+ if (hsp->tx_skb) {
printk(KERN_WARNING "hscx_l2l1: this shouldn't happen\n");
break;
}
- hsp->xmtibh = ibh;
- hsp->sendptr = 0;
- hsp->releasebuf = 0;
+ hsp->tx_skb = skb;
+ hsp->count = 0;
sp->hscx_fill_fifo(hsp);
break;
case (PH_REQUEST_PULL):
- if (!hsp->xmtibh) {
+ if (!hsp->tx_skb) {
st->l1.requestpull = 0;
st->l1.l1l2(st, PH_PULL_ACK, NULL);
} else
@@ -1159,6 +1210,7 @@ hscx_l2l1discardq(struct PStack *st, int pr, void *heldby,
struct IsdnCardState *sp = (struct IsdnCardState *)
st->l1.hardware;
struct HscxState *hsp = sp->hs + st->l1.hscx;
+ struct sk_buff *skb;
#ifdef DEBUG_MAGIC
if (hsp->magic != 301270) {
@@ -1167,7 +1219,10 @@ hscx_l2l1discardq(struct PStack *st, int pr, void *heldby,
}
#endif
- BufQueueDiscard(&hsp->sq, pr, heldby, releasetoo);
+ while ((skb = skb_dequeue(&hsp->squeue))) {
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_WRITE);
+ }
}
static int
@@ -1177,24 +1232,20 @@ open_hscxstate(struct IsdnCardState *sp,
struct HscxState *hsp = sp->hs + hscx;
if (!hsp->init) {
- BufPoolInit(&hsp->sbufpool, HSCX_SBUF_ORDER, HSCX_SBUF_BPPS,
- HSCX_SBUF_MAXPAGES);
- BufPoolInit(&hsp->rbufpool, HSCX_RBUF_ORDER, HSCX_RBUF_BPPS,
- HSCX_RBUF_MAXPAGES);
- BufPoolInit(&hsp->smallpool, HSCX_SMALLBUF_ORDER, HSCX_SMALLBUF_BPPS,
- HSCX_SMALLBUF_MAXPAGES);
+ if (!(hsp->rcvbuf = kmalloc(HSCX_BUFMAX, GFP_ATOMIC))) {
+ printk(KERN_WARNING
+ "HiSax: No memory for hscx_rcvbuf\n");
+ return (1);
+ }
+ skb_queue_head_init(&hsp->rqueue);
+ skb_queue_head_init(&hsp->squeue);
}
hsp->init = !0;
- BufQueueInit(&hsp->rq);
- BufQueueInit(&hsp->sq);
-
- hsp->releasebuf = 0;
- hsp->rcvibh = NULL;
- hsp->xmtibh = NULL;
- hsp->rcvptr = 0;
- hsp->sendptr = 0;
+ hsp->tx_skb = NULL;
hsp->event = 0;
+ hsp->rcvidx = 0;
+ hsp->tx_cnt = 0;
return (0);
}
@@ -1212,7 +1263,7 @@ hscx_manl1(struct PStack *st, int pr,
st->l1.l1man(st, PH_ACTIVATE, NULL);
break;
case (PH_DEACTIVATE):
- if (!hsp->xmtibh)
+ if (!hsp->tx_skb)
sp->modehscx(hsp, 0, 0);
hsp->active = 0;
@@ -1231,9 +1282,6 @@ setstack_hscx(struct PStack *st, struct HscxState *hs)
st->ma.manl1 = hscx_manl1;
st->l2.l2l1discardq = hscx_l2l1discardq;
- st->l1.sbufpool = &hs->sbufpool;
- st->l1.rbufpool = &hs->rbufpool;
- st->l1.smallpool = &hs->smallpool;
st->l1.act_state = 0;
st->l1.requestpull = 0;
@@ -1256,7 +1304,7 @@ HiSax_reportcard(int cardnr)
#ifdef L2FRAME_DEBUG /* psa */
char *
-l2cmd(byte cmd)
+l2cmd(u_char cmd)
{
switch (cmd & ~0x10) {
case 1:
@@ -1290,7 +1338,7 @@ l2cmd(byte cmd)
static char tmp[20];
char *
-l2frames(byte * ptr)
+l2frames(u_char * ptr)
{
switch (ptr[2] & ~0x10) {
case 1:
@@ -1320,12 +1368,12 @@ l2frames(byte * ptr)
}
void
-Logl2Frame(struct IsdnCardState *sp, struct BufHeader *ibh, char *buf, int dir)
+Logl2Frame(struct IsdnCardState *sp, struct sk_buff *skb, char *buf, int dir)
{
char tmp[132];
- byte *ptr;
+ u_char *ptr;
- ptr = DATAPTR(ibh);
+ ptr = skb->data;
if (ptr[0] & 1 || !(ptr[1] & 1))
debugl1(sp, "Addres not LAPD");
diff --git a/drivers/isdn/hisax/isdnl1.h b/drivers/isdn/hisax/isdnl1.h
index f95d71b6e..98418c821 100644
--- a/drivers/isdn/hisax/isdnl1.h
+++ b/drivers/isdn/hisax/isdnl1.h
@@ -1,6 +1,9 @@
-/* $Id: isdnl1.h,v 1.3 1996/12/08 19:41:55 keil Exp $
+/* $Id: isdnl1.h,v 1.4 1997/04/06 22:55:52 keil Exp $
*
* $Log: isdnl1.h,v $
+ * Revision 1.4 1997/04/06 22:55:52 keil
+ * Using SKB's
+ *
* Revision 1.3 1996/12/08 19:41:55 keil
* L2FRAME_DEBUG
*
@@ -36,10 +39,13 @@
#define HSCX_XMTBUFREADY 1
extern void debugl1(struct IsdnCardState *sp, char *msg);
-extern char *HscxVersion(byte v);
-extern char *ISACVersion(byte v);
+extern char *HscxVersion(u_char v);
+extern char *ISACVersion(u_char v);
extern void hscx_sched_event(struct HscxState *hsp, int event);
extern void isac_sched_event(struct IsdnCardState *sp, int event);
extern void isac_new_ph(struct IsdnCardState *sp);
extern get_irq(int cardnr, void *routine);
-extern void Logl2Frame(struct IsdnCardState *sp, struct BufHeader *ibh, char *buf, int dir);
+
+#ifdef L2FRAME_DEBUG
+extern void Logl2Frame(struct IsdnCardState *sp, struct sk_buff *skb, char *buf, int dir);
+#endif
diff --git a/drivers/isdn/hisax/isdnl2.c b/drivers/isdn/hisax/isdnl2.c
index dbffecc21..118f0790e 100644
--- a/drivers/isdn/hisax/isdnl2.c
+++ b/drivers/isdn/hisax/isdnl2.c
@@ -1,4 +1,4 @@
-/* $Id: isdnl2.c,v 1.7 1997/02/09 00:25:44 keil Exp $
+/* $Id: isdnl2.c,v 1.10 1997/05/06 09:38:13 keil Exp $
* Author Karsten Keil (keil@temic-ech.spacenet.de)
* based on the teles driver from Jan den Ouden
@@ -7,6 +7,19 @@
* Fritz Elfert
*
* $Log: isdnl2.c,v $
+ * Revision 1.10 1997/05/06 09:38:13 keil
+ * Bugfixes: - clear ack queue entries after resend
+ * - acknowlege each frame to linklevel
+ * - UA for SABM is Response, not command
+ * - only RR was send as supervisor frame (X.75 hangs after a
+ * sequence error)
+ *
+ * Revision 1.9 1997/04/07 23:02:11 keil
+ * missing braces
+ *
+ * Revision 1.8 1997/04/06 22:59:59 keil
+ * Using SKB's; changing function names; some minor changes
+ *
* Revision 1.7 1997/02/09 00:25:44 keil
* new interface handling, one interface per card
*
@@ -35,14 +48,12 @@
#include "hisax.h"
#include "isdnl2.h"
-#define TIMER_1 2000
-
-const char *l2_revision = "$Revision: 1.7 $";
+const char *l2_revision = "$Revision: 1.10 $";
static void l2m_debug(struct FsmInst *fi, char *s);
struct Fsm l2fsm =
-{NULL, 0, 0};
+{NULL, 0, 0, NULL, NULL};
enum {
ST_L2_1,
@@ -118,6 +129,33 @@ int errcount = 0;
static int l2addrsize(struct Layer2 *tsp);
+static void
+InitWin(struct Layer2 *l2)
+{
+ int i;
+
+ for (i = 0; i < MAX_WINDOW; i++)
+ l2->windowar[i] = NULL;
+}
+
+static void
+ReleaseWin(struct Layer2 *l2)
+{
+ int i, cnt = 0;
+
+
+ for (i = 0; i < MAX_WINDOW; i++) {
+ if (l2->windowar[i]) {
+ cnt++;
+ SET_SKB_FREE(l2->windowar[i]);
+ dev_kfree_skb(l2->windowar[i], FREE_WRITE);
+ l2->windowar[i] = NULL;
+ }
+ }
+ if (cnt)
+ printk(KERN_WARNING "isdl2 freed %d skbuffs in release\n", cnt);
+}
+
static int
cansend(struct PStack *st)
{
@@ -130,10 +168,12 @@ cansend(struct PStack *st)
static void
discard_i_queue(struct PStack *st)
{
- struct BufHeader *ibh;
+ struct sk_buff *skb;
- while (!BufQueueUnlink(&ibh, &st->l2.i_queue))
- BufPoolRelease(ibh);
+ while ((skb = skb_dequeue(&st->l2.i_queue))) {
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
+ }
}
int
@@ -150,9 +190,9 @@ l2addrsize(struct Layer2 *tsp)
static int
sethdraddr(struct Layer2 *tsp,
- struct BufHeader *ibh, int rsp)
+ u_char * header, int rsp)
{
- byte *ptr = DATAPTR(ibh);
+ u_char *ptr = header;
int crbit;
if (tsp->laptype == LAPD) {
@@ -176,16 +216,16 @@ sethdraddr(struct Layer2 *tsp,
static void
enqueue_ui(struct PStack *st,
- struct BufHeader *ibh)
+ struct sk_buff *skb)
{
- st->l2.l2l1(st, PH_DATA, ibh);
+ st->l2.l2l1(st, PH_DATA, skb);
}
static void
enqueue_super(struct PStack *st,
- struct BufHeader *ibh)
+ struct sk_buff *skb)
{
- st->l2.l2l1(st, PH_DATA, ibh);
+ st->l2.l2l1(st, PH_DATA, skb);
}
static int
@@ -207,11 +247,13 @@ setva(struct PStack *st, int nr)
if (l2->va != nr) {
while (l2->va != nr) {
l2->va = (l2->va + 1) % (l2->extended ? 128 : 8);
- BufPoolRelease(l2->windowar[l2->sow]);
+ SET_SKB_FREE(l2->windowar[l2->sow]);
+ dev_kfree_skb(l2->windowar[l2->sow], FREE_WRITE);
+ l2->windowar[l2->sow] = NULL;
l2->sow = (l2->sow + 1) % l2->window;
+ if (st->l4.l2writewakeup)
+ st->l4.l2writewakeup(st);
}
- if (st->l4.l2writewakeup)
- st->l4.l2writewakeup(st);
}
}
@@ -225,38 +267,51 @@ l2s1(struct FsmInst *fi, int event, void *arg)
}
static void
-l2s2(struct FsmInst *fi, int event, void *arg)
+l2_send_ui(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
-
- byte *ptr;
+ struct sk_buff *skb = arg;
+ u_char header[MAX_HEADER_LEN];
int i;
- i = sethdraddr(&(st->l2), ibh, CMD);
- ptr = DATAPTR(ibh);
- ptr += i;
- *ptr = UI;
-
- enqueue_ui(st, ibh);
+ i = sethdraddr(&(st->l2), header, CMD);
+ header[i++] = UI;
+ memcpy(skb_push(skb, i), header, i);
+ enqueue_ui(st, skb);
}
static void
-l2s3(struct FsmInst *fi, int event, void *arg)
+l2_receive_ui(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
- st->l2.l2l3(st, DL_UNIT_DATA, ibh);
+ skb_pull(skb, l2headersize(&st->l2, 1));
+ st->l2.l2l3(st, DL_UNIT_DATA, skb);
+}
+
+inline void
+send_uframe(struct PStack *st, u_char cmd, u_char cr)
+{
+ struct sk_buff *skb;
+ u_char tmp[MAX_HEADER_LEN];
+ int i;
+
+ i = sethdraddr(&st->l2, tmp, cr);
+ tmp[i++] = cmd;
+ if (!(skb = alloc_skb(i, GFP_ATOMIC))) {
+ printk(KERN_WARNING "isdl2 can't alloc sbbuff for send_uframe\n");
+ return;
+ }
+ memcpy(skb_put(skb, i), tmp, i);
+ enqueue_super(st, skb);
}
static void
establishlink(struct FsmInst *fi)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh;
- int i;
- byte *ptr;
+ u_char cmd;
FsmChangeState(fi, ST_L2_5);
st->l2.rc = 0;
@@ -266,34 +321,21 @@ establishlink(struct FsmInst *fi)
l2m_debug(&st->l2.l2m, "FAT 1");
- if (BufPoolGet(&ibh, st->l1.smallpool, GFP_ATOMIC, (void *) st, 15))
- return;
- i = sethdraddr(&st->l2, ibh, CMD);
- ptr = DATAPTR(ibh);
- ptr += i;
- if (st->l2.extended)
- *ptr = SABME | 0x10;
- else
- *ptr = 0x3f;
- ibh->datasize = i + 1;
-
- enqueue_super(st, ibh);
+ cmd = (st->l2.extended ? SABME : SABM) | 0x10;
+ send_uframe(st, cmd, CMD);
}
static void
-l2s11(struct FsmInst *fi, int event, void *arg)
+l2_establish(struct FsmInst *fi, int event, void *arg)
{
establishlink(fi);
}
static void
-l2s13(struct FsmInst *fi, int event, void *arg)
+l2_send_disconn(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
struct Channel *chanp = st->l4.userdata;
- byte *ptr;
- struct BufHeader *ibh;
- int i;
FsmChangeState(fi, ST_L2_6);
@@ -308,70 +350,71 @@ l2s13(struct FsmInst *fi, int event, void *arg)
l2m_debug(&st->l2.l2m, "FAT 2");
- if ((chanp->impair == 2) && (st->l2.laptype == LAPB))
- goto nodisc;
+ if (!((chanp->impair == 2) && (st->l2.laptype == LAPB)))
+ send_uframe(st, DISC | 0x10, CMD);
- if (BufPoolGet(&ibh, st->l1.smallpool, GFP_ATOMIC, (void *) st, 9))
- return;
- i = sethdraddr(&(st->l2), ibh, CMD);
- ptr = DATAPTR(ibh);
- ptr += i;
- *ptr = DISC | 0x10;
- ibh->datasize = i + 1;
- enqueue_super(st, ibh);
-
- nodisc:
discard_i_queue(st);
}
static void
-l2s12(struct FsmInst *fi, int event, void *arg)
+l2_got_SABMX(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
- byte *ptr;
- int i, p;
+ struct sk_buff *skb = arg;
+ int est = 1, state;
+ u_char PollFlag;
+
+ state = fi->state;
+
+ skb_pull(skb, l2addrsize(&(st->l2)));
+ PollFlag = *skb->data & 0x10;
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
- ptr = DATAPTR(ibh);
- ptr += l2addrsize(&(st->l2));
- p = (*ptr) & 0x10;
- BufPoolRelease(ibh);
+ if (ST_L2_4 != state)
+ if (st->l2.vs != st->l2.va) {
+ discard_i_queue(st);
+ est = 1;
+ } else
+ est = 0;
st->l2.vs = 0;
st->l2.va = 0;
st->l2.vr = 0;
st->l2.sow = 0;
- FsmChangeState(fi, ST_L2_7);
+ if (ST_L2_7 != state)
+ FsmChangeState(fi, ST_L2_7);
+
+ send_uframe(st, UA | PollFlag, RSP);
+
+ if (st->l2.t200_running) {
+ FsmDelTimer(&st->l2.t200_timer, 15);
+ st->l2.t200_running = 0;
+ }
if (FsmAddTimer(&st->l2.t203_timer, st->l2.t203, EV_L2_T203, NULL, 3))
if (st->l2.l2m.debug)
l2m_debug(&st->l2.l2m, "FAT 3");
- st->l2.l2man(st, DL_ESTABLISH, NULL);
-
- if (BufPoolGet(&ibh, st->l1.smallpool, GFP_ATOMIC, (void *) st, 10))
- return;
- i = sethdraddr(&(st->l2), ibh, RSP);
- ptr = DATAPTR(ibh);
- ptr += i;
- *ptr = UA | p;
- ibh->datasize = i + 1;
- enqueue_super(st, ibh);
+ if (est)
+ st->l2.l2man(st, DL_ESTABLISH, NULL);
+ if (ST_L2_8 == state)
+ if (skb_queue_len(&st->l2.i_queue) && cansend(st))
+ st->l2.l2l1(st, PH_REQUEST_PULL, NULL);
}
static void
-l2s14(struct FsmInst *fi, int event, void *arg)
+l2_got_disconn(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
struct Channel *chanp = st->l4.userdata;
- byte *ptr;
- int i, p;
+ u_char PollFlag;
- ptr = DATAPTR(ibh);
- ptr += l2addrsize(&(st->l2));
- p = (*ptr) & 0x10;
- BufPoolRelease(ibh);
+ skb_pull(skb, l2addrsize(&(st->l2)));
+ PollFlag = *skb->data & 0x10;
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
FsmChangeState(fi, ST_L2_4);
@@ -380,68 +423,41 @@ l2s14(struct FsmInst *fi, int event, void *arg)
FsmDelTimer(&st->l2.t200_timer, 4);
st->l2.t200_running = 0;
}
- if ((chanp->impair == 1) && (st->l2.laptype == LAPB))
- goto noresponse;
+ if (!((chanp->impair == 1) && (st->l2.laptype == LAPB)))
+ send_uframe(st, UA | PollFlag, RSP);
- if (BufPoolGet(&ibh, st->l1.smallpool, GFP_ATOMIC, (void *) st, 11))
- return;
- i = sethdraddr(&(st->l2), ibh, RSP);
- ptr = DATAPTR(ibh);
- ptr += i;
- *ptr = UA | p;
- ibh->datasize = i + 1;
- enqueue_super(st, ibh);
-
- noresponse:
st->l2.l2man(st, DL_RELEASE, NULL);
-
}
static void
-l2s14_1(struct FsmInst *fi, int event, void *arg)
+l2_got_st4_disc(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
struct Channel *chanp = st->l4.userdata;
- byte *ptr;
- int i, p;
+ u_char PollFlag;
- ptr = DATAPTR(ibh);
- ptr += l2addrsize(&(st->l2));
- p = (*ptr) & 0x10;
- BufPoolRelease(ibh);
+ skb_pull(skb, l2addrsize(&(st->l2)));
+ PollFlag = *skb->data & 0x10;
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
- if ((chanp->impair == 1) && (st->l2.laptype == LAPB))
- goto noresponse;
-
- if (BufPoolGet(&ibh, st->l1.smallpool, GFP_ATOMIC, (void *) st, 11))
- return;
- i = sethdraddr(&(st->l2), ibh, RSP);
- ptr = DATAPTR(ibh);
- ptr += i;
- *ptr = DM | (p ? 0x10 : 0x0);
-
- ibh->datasize = i + 1;
- enqueue_super(st, ibh);
-
- noresponse:
+ if (!((chanp->impair == 1) && (st->l2.laptype == LAPB)))
+ send_uframe(st, DM | (PollFlag ? 0x10 : 0x0), RSP);
}
static void
-l2s5(struct FsmInst *fi, int event, void *arg)
+l2_got_ua_establish(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
- int f;
- byte *data;
-
- data = DATAPTR(ibh);
- data += l2addrsize(&(st->l2));
-
- f = *data & 0x10;
- BufPoolRelease(ibh);
+ struct sk_buff *skb = arg;
+ u_char f;
+ skb_pull(skb, l2addrsize(&(st->l2)));
+ f = *skb->data & 0x10;
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
if (f) {
st->l2.vs = 0;
st->l2.va = 0;
@@ -454,25 +470,21 @@ l2s5(struct FsmInst *fi, int event, void *arg)
if (st->l2.l2m.debug)
l2m_debug(&st->l2.l2m, "FAT 4");
-
st->l2.l2man(st, DL_ESTABLISH, NULL);
}
}
static void
-l2s15(struct FsmInst *fi, int event, void *arg)
+l2_got_ua_disconn(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
- int f;
- byte *data;
-
- data = DATAPTR(ibh);
- data += l2addrsize(&st->l2);
-
- f = *data & 0x10;
- BufPoolRelease(ibh);
+ struct sk_buff *skb = arg;
+ u_char f;
+ skb_pull(skb, l2addrsize(&(st->l2)));
+ f = *skb->data & 0x10;
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
if (f) {
FsmDelTimer(&st->l2.t200_timer, 6);
FsmChangeState(fi, ST_L2_4);
@@ -480,31 +492,39 @@ l2s15(struct FsmInst *fi, int event, void *arg)
}
}
-static void
-enquiry_response(struct PStack *st)
+inline void
+enquiry_cr(struct PStack *st, u_char typ, u_char cr, u_char pf)
{
- struct BufHeader *ibh2;
- int i;
- byte *ptr;
+ struct sk_buff *skb;
struct Layer2 *l2;
+ u_char tmp[MAX_HEADER_LEN];
+ int i;
l2 = &st->l2;
- if (!BufPoolGet(&ibh2, st->l1.smallpool, GFP_ATOMIC, (void *) st, 16)) {
- i = sethdraddr(l2, ibh2, RSP);
- ptr = DATAPTR(ibh2);
- ptr += i;
-
- if (l2->extended) {
- *ptr++ = RR;
- *ptr++ = (l2->vr << 1) | 0x1;
- i += 2;
- } else {
- *ptr++ = (l2->vr << 5) | 0x1 | 0x10;
- i += 1;
- }
- ibh2->datasize = i;
- enqueue_super(st, ibh2);
+ i = sethdraddr(l2, tmp, cr);
+ if (l2->extended) {
+ tmp[i++] = typ;
+ tmp[i++] = (l2->vr << 1) | (pf ? 1 : 0);
+ } else
+ tmp[i++] = (l2->vr << 5) | typ | (pf ? 0x10 : 0);
+ if (!(skb = alloc_skb(i, GFP_ATOMIC))) {
+ printk(KERN_WARNING "isdl2 can't alloc sbbuff for enquiry_cr\n");
+ return;
}
+ memcpy(skb_put(skb, i), tmp, i);
+ enqueue_super(st, skb);
+}
+
+inline void
+enquiry_response(struct PStack *st, u_char typ, u_char final)
+{
+ enquiry_cr(st, typ, RSP, final);
+}
+
+inline void
+enquiry_command(struct PStack *st, u_char typ, u_char poll)
+{
+ enquiry_cr(st, typ, CMD, poll);
}
static void
@@ -515,88 +535,74 @@ nrerrorrecovery(struct FsmInst *fi)
}
static void
-l2s6(struct FsmInst *fi, int event, void *arg)
+l2_got_st7_RR(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
struct Channel *chanp = st->l4.userdata;
- struct BufHeader *ibh = arg;
- int p, seq, rsp;
- byte *ptr;
+ struct sk_buff *skb = arg;
+ int PollFlag, seq, rsp;
struct Layer2 *l2;
l2 = &st->l2;
- ptr = DATAPTR(ibh);
-
- if (l2->laptype == LAPD) {
- rsp = ptr[0] & 0x2;
- if (l2->orig)
- rsp = !rsp;
- } else {
- rsp = ptr[0] == 0x3;
- if (l2->orig)
- rsp = !rsp;
- }
-
- ptr += l2addrsize(l2);
+ if (l2->laptype == LAPD)
+ rsp = *skb->data & 0x2;
+ else
+ rsp = *skb->data == 0x3;
+ if (l2->orig)
+ rsp = !rsp;
+ skb_pull(skb, l2addrsize(l2));
if (l2->extended) {
- p = (ptr[1] & 0x1) == 0x1;
- seq = ptr[1] >> 1;
+ PollFlag = (skb->data[1] & 0x1) == 0x1;
+ seq = skb->data[1] >> 1;
} else {
- p = (ptr[0] & 0x10);
- seq = (ptr[0] >> 5) & 0x7;
+ PollFlag = (skb->data[0] & 0x10);
+ seq = (skb->data[0] >> 5) & 0x7;
}
- BufPoolRelease(ibh);
-
- if ((chanp->impair == 4) && (st->l2.laptype == LAPB))
- goto noresp;
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
- if ((!rsp) && p)
- enquiry_response(st);
+ if (!((chanp->impair == 4) && (st->l2.laptype == LAPB)))
+ if ((!rsp) && PollFlag)
+ enquiry_response(st, RR, PollFlag);
- noresp:
if (legalnr(st, seq)) {
- if (seq == st->l2.vs) {
+ if (seq == l2->vs) {
setva(st, seq);
- FsmDelTimer(&st->l2.t200_timer, 7);
- st->l2.t200_running = 0;
- FsmDelTimer(&st->l2.t203_timer, 8);
- if (FsmAddTimer(&st->l2.t203_timer, st->l2.t203, EV_L2_T203, NULL, 5))
- if (st->l2.l2m.debug)
+ FsmDelTimer(&l2->t200_timer, 7);
+ l2->t200_running = 0;
+ FsmDelTimer(&l2->t203_timer, 8);
+ if (FsmAddTimer(&l2->t203_timer, l2->t203, EV_L2_T203, NULL, 5))
+ if (l2->l2m.debug)
l2m_debug(&st->l2.l2m, "FAT 5");
- if (st->l2.i_queue.head)
+ if (skb_queue_len(&st->l2.i_queue))
st->l2.l2l1(st, PH_REQUEST_PULL, NULL);
- } else if (st->l2.va != seq) {
+ } else if (l2->va != seq) {
setva(st, seq);
FsmDelTimer(&st->l2.t200_timer, 9);
if (FsmAddTimer(&st->l2.t200_timer, st->l2.t200, EV_L2_T200, NULL, 6))
if (st->l2.l2m.debug)
l2m_debug(&st->l2.l2m, "FAT 6");
-
- if (st->l2.i_queue.head)
+ if (skb_queue_len(&st->l2.i_queue))
st->l2.l2l1(st, PH_REQUEST_PULL, NULL);
}
} else
nrerrorrecovery(fi);
- if ((fi->userint & LC_FLUSH_WAIT) && rsp && !l2->i_queue.head) {
+ if ((fi->userint & LC_FLUSH_WAIT) && rsp && !(skb_queue_len(&st->l2.i_queue))) {
fi->userint &= ~LC_FLUSH_WAIT;
st->l2.l2man(st, DL_FLUSH, NULL);
}
}
static void
-l2s7(struct FsmInst *fi, int event, void *arg)
+l2_feed_iqueue(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
- int i;
- byte *ptr;
+ struct sk_buff *skb = arg;
- i = sethdraddr(&st->l2, ibh, CMD);
- ptr = DATAPTR(ibh);
- BufQueueLink(&st->l2.i_queue, ibh);
+ skb_queue_tail(&st->l2.i_queue, skb);
st->l2.l2l1(st, PH_REQUEST_PULL, NULL);
}
@@ -605,24 +611,21 @@ icommandreceived(struct FsmInst *fi, int event, void *arg, int *nr)
{
struct PStack *st = fi->userdata;
struct Channel *chanp = st->l4.userdata;
- struct BufHeader *ibh = arg;
- byte *ptr;
- struct BufHeader *ibh2;
+ struct sk_buff *skb = arg;
struct IsdnCardState *sp = st->l1.hardware;
struct Layer2 *l2 = &(st->l2);
int i, p, seq, wasok;
char str[64];
- ptr = DATAPTR(ibh);
- ptr += l2addrsize(l2);
+ i = l2addrsize(l2);
if (l2->extended) {
- p = (ptr[1] & 0x1) == 0x1;
- seq = ptr[0] >> 1;
- *nr = (ptr[1] >> 1) & 0x7f;
+ p = (skb->data[i + 1] & 0x1) == 0x1;
+ seq = skb->data[i] >> 1;
+ *nr = (skb->data[i + 1] >> 1) & 0x7f;
} else {
- p = (ptr[0] & 0x10);
- seq = (ptr[0] >> 1) & 0x7;
- *nr = (ptr[0] >> 5) & 0x7;
+ p = (skb->data[i] & 0x10);
+ seq = (skb->data[i] >> 1) & 0x7;
+ *nr = (skb->data[i] >> 5) & 0x7;
}
if (l2->vr == seq) {
@@ -631,72 +634,39 @@ icommandreceived(struct FsmInst *fi, int event, void *arg, int *nr)
l2->vr = (l2->vr + 1) % (l2->extended ? 128 : 8);
l2->rejexp = 0;
- ptr = DATAPTR(ibh);
if (st->l2.laptype == LAPD)
if (sp->dlogflag) {
- LogFrame(st->l1.hardware, ptr, ibh->datasize);
+ LogFrame(st->l1.hardware, skb->data, skb->len);
sprintf(str, "Q.931 frame network->user tei %d", st->l2.tei);
- dlogframe(st->l1.hardware, ptr + l2->ihsize,
- ibh->datasize - l2->ihsize, str);
- }
- label8_1:
- if ((chanp->impair == 3) && (st->l2.laptype == LAPB))
- goto noRR;
-
- if (!BufPoolGet(&ibh2, st->l1.smallpool, GFP_ATOMIC, (void *) st, 13)) {
- i = sethdraddr(&(st->l2), ibh2, RSP);
- ptr = DATAPTR(ibh2);
- ptr += i;
-
- if (l2->extended) {
- *ptr++ = RR;
- *ptr++ = (l2->vr << 1) | (p ? 1 : 0);
- i += 2;
- } else {
- *ptr++ = (l2->vr << 5) | 0x1 | (p ? 0x10 : 0x0);
- i += 1;
+ dlogframe(st->l1.hardware, skb->data + l2->ihsize,
+ skb->len - l2->ihsize, str);
}
- ibh2->datasize = i;
- enqueue_super(st, ibh2);
- noRR:
- }
+ if (!((chanp->impair == 3) && (st->l2.laptype == LAPB)))
+ if (p || (!skb_queue_len(&st->l2.i_queue)))
+ enquiry_response(st, RR, p);
+ skb_pull(skb, l2headersize(l2, 0));
} else {
/* n(s)!=v(r) */
wasok = 0;
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
if (st->l2.rejexp) {
if (p)
- goto label8_1;
+ if (!((chanp->impair == 3) && (st->l2.laptype == LAPB)))
+ enquiry_response(st, RR, p);
} else {
st->l2.rejexp = !0;
- if (!BufPoolGet(&ibh2, st->l1.smallpool, GFP_ATOMIC, (void *) st, 14)) {
- i = sethdraddr(&(st->l2), ibh2, RSP);
- ptr = DATAPTR(ibh2);
- ptr += i;
-
- if (l2->extended) {
- *ptr++ = REJ;
- *ptr++ = (l2->vr << 1) | (p ? 1 : 0);
- i += 2;
- } else {
- *ptr++ = (l2->vr << 5) | 0x9 | (p ? 0x10 : 0x0);
- i += 1;
- }
- ibh2->datasize = i;
- enqueue_super(st, ibh2);
- }
+ enquiry_command(st, REJ, 1);
}
}
-
return wasok;
-
}
static void
-l2s8(struct FsmInst *fi, int event, void *arg)
+l2_got_st7_data(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
int nr, wasok;
wasok = icommandreceived(fi, event, arg, &nr);
@@ -711,7 +681,7 @@ l2s8(struct FsmInst *fi, int event, void *arg)
if (st->l2.l2m.debug)
l2m_debug(&st->l2.l2m, "FAT 5");
- if (st->l2.i_queue.head)
+ if (skb_queue_len(&st->l2.i_queue))
st->l2.l2l1(st, PH_REQUEST_PULL, NULL);
} else if (nr != st->l2.va) {
setva(st, nr);
@@ -720,38 +690,38 @@ l2s8(struct FsmInst *fi, int event, void *arg)
if (st->l2.l2m.debug)
l2m_debug(&st->l2.l2m, "FAT 6");
- if (st->l2.i_queue.head)
+ if (skb_queue_len(&st->l2.i_queue))
st->l2.l2l1(st, PH_REQUEST_PULL, NULL);
}
} else
nrerrorrecovery(fi);
if (wasok)
- st->l2.l2l3(st, DL_DATA, ibh);
+ st->l2.l2l3(st, DL_DATA, skb);
}
static void
-l2s8_1(struct FsmInst *fi, int event, void *arg)
+l2_got_st8_data(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
int nr, wasok;
wasok = icommandreceived(fi, event, arg, &nr);
if (legalnr(st, nr)) {
setva(st, nr);
- if (st->l2.i_queue.head)
+ if (skb_queue_len(&st->l2.i_queue))
st->l2.l2l1(st, PH_REQUEST_PULL, NULL);
} else
nrerrorrecovery(fi);
if (wasok)
- st->l2.l2l3(st, DL_DATA, ibh);
+ st->l2.l2l3(st, DL_DATA, skb);
}
static void
-l2s17(struct FsmInst *fi, int event, void *arg)
+l2_got_tei(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
@@ -777,70 +747,61 @@ invoke_retransmission(struct PStack *st, int nr)
p1 += l2->extended ? 128 : 8;
p1 = (p1 + l2->sow) % l2->window;
- BufQueueLinkFront(&l2->i_queue, l2->windowar[p1]);
+ skb_queue_head(&l2->i_queue, l2->windowar[p1]);
+ l2->windowar[p1] = NULL;
}
st->l2.l2l1(st, PH_REQUEST_PULL, NULL);
}
}
static void
-l2s16(struct FsmInst *fi, int event, void *arg)
+l2_got_st7_rej(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
- int p, seq, rsp;
- byte *ptr;
+ struct sk_buff *skb = arg;
+ int PollFlag, seq, rsp;
struct Layer2 *l2;
- l2 = &(st->l2);
- ptr = DATAPTR(ibh);
-
- if (l2->laptype == LAPD) {
- rsp = ptr[0] & 0x2;
- if (l2->orig)
- rsp = !rsp;
- } else {
- rsp = ptr[0] == 0x3;
- if (l2->orig)
- rsp = !rsp;
- }
-
-
- ptr += l2addrsize(l2);
+ l2 = &st->l2;
+ if (l2->laptype == LAPD)
+ rsp = *skb->data & 0x2;
+ else
+ rsp = *skb->data == 0x3;
+ if (l2->orig)
+ rsp = !rsp;
+ skb_pull(skb, l2addrsize(l2));
if (l2->extended) {
- p = (ptr[1] & 0x1) == 0x1;
- seq = ptr[1] >> 1;
+ PollFlag = (skb->data[1] & 0x1) == 0x1;
+ seq = skb->data[1] >> 1;
} else {
- p = (ptr[0] & 0x10);
- seq = (ptr[0] >> 5) & 0x7;
+ PollFlag = (skb->data[0] & 0x10);
+ seq = (skb->data[0] >> 5) & 0x7;
}
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
- if ((!rsp) && p)
- enquiry_response(st);
+ if ((!rsp) && PollFlag)
+ enquiry_response(st, RR, PollFlag);
if (!legalnr(st, seq))
return;
setva(st, seq);
invoke_retransmission(st, seq);
-
}
static void
-l2s19(struct FsmInst *fi, int event, void *arg)
+l2_no_tei(struct FsmInst *fi, int event, void *arg)
{
FsmChangeState(fi, ST_L2_4);
}
static void
-l2s20(struct FsmInst *fi, int event, void *arg)
+l2_st5_tout_200(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- int i;
- struct BufHeader *ibh;
- byte *ptr;
+ u_char cmd;
if (st->l2.rc == st->l2.n200) {
FsmChangeState(fi, ST_L2_4);
@@ -853,29 +814,16 @@ l2s20(struct FsmInst *fi, int event, void *arg)
if (st->l2.l2m.debug)
l2m_debug(&st->l2.l2m, "FAT 7");
- if (BufPoolGet(&ibh, st->l1.smallpool, GFP_ATOMIC, (void *) st, 15))
- return;
-
- i = sethdraddr(&st->l2, ibh, CMD);
- ptr = DATAPTR(ibh);
- ptr += i;
- if (st->l2.extended)
- *ptr = SABME | 0x10;
- else
- *ptr = 0x3f;
- ibh->datasize = i + 1;
- enqueue_super(st, ibh);
+ cmd = (st->l2.extended ? SABME : SABM) | 0x10;
+ send_uframe(st, cmd, CMD);
}
}
static void
-l2s21(struct FsmInst *fi, int event, void *arg)
+l2_st6_tout_200(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
struct Channel *chanp = st->l4.userdata;
- int i;
- struct BufHeader *ibh;
- byte *ptr;
if (st->l2.rc == st->l2.n200) {
FsmChangeState(fi, ST_L2_4);
@@ -888,59 +836,53 @@ l2s21(struct FsmInst *fi, int event, void *arg)
l2m_debug(&st->l2.l2m, "FAT 8");
- if ((chanp->impair == 2) && (st->l2.laptype == LAPB))
- goto nodisc;
-
- if (BufPoolGet(&ibh, st->l1.smallpool, GFP_ATOMIC, (void *) st, 15))
- return;
-
- i = sethdraddr(&st->l2, ibh, CMD);
- ptr = DATAPTR(ibh);
- ptr += i;
- *ptr = DISC | 0x10;
- ibh->datasize = i + 1;
- enqueue_super(st, ibh);
- nodisc:
+ if (!((chanp->impair == 2) && (st->l2.laptype == LAPB)))
+ send_uframe(st, DISC | 0x10, CMD);
}
}
static void
-l2s22(struct FsmInst *fi, int event, void *arg)
+l2_pull_iqueue(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh;
+ struct sk_buff *skb;
struct Layer2 *l2 = &st->l2;
- byte *ptr;
- int p1;
+ u_char header[MAX_HEADER_LEN];
+ int p1, i;
if (!cansend(st))
return;
- if (BufQueueUnlink(&ibh, &l2->i_queue))
+ skb = skb_dequeue(&l2->i_queue);
+ if (!skb)
return;
-
p1 = l2->vs - l2->va;
if (p1 < 0)
p1 += l2->extended ? 128 : 8;
p1 = (p1 + l2->sow) % l2->window;
- l2->windowar[p1] = ibh;
+ if (l2->windowar[p1]) {
+ printk(KERN_WARNING "isdnl2 try overwrite ack queue entry %d\n",
+ p1);
+ SET_SKB_FREE(l2->windowar[p1]);
+ dev_kfree_skb(l2->windowar[p1], FREE_WRITE);
+ }
+ l2->windowar[p1] = skb_clone(skb, GFP_ATOMIC);
- ptr = DATAPTR(ibh);
- ptr += l2addrsize(l2);
+ i = sethdraddr(&st->l2, header, CMD);
if (l2->extended) {
- *ptr++ = l2->vs << 1;
- *ptr++ = l2->vr << 1;
+ header[i++] = l2->vs << 1;
+ header[i++] = l2->vr << 1;
l2->vs = (l2->vs + 1) % 128;
} else {
- *ptr++ = (l2->vr << 5) | (l2->vs << 1);
+ header[i++] = (l2->vr << 5) | (l2->vs << 1);
l2->vs = (l2->vs + 1) % 8;
}
- st->l2.l2l1(st, PH_DATA_PULLED, ibh);
-
+ memcpy(skb_push(skb, i), header, i);
+ st->l2.l2l1(st, PH_DATA_PULLED, skb);
if (!st->l2.t200_running) {
FsmDelTimer(&st->l2.t203_timer, 13);
if (FsmAddTimer(&st->l2.t200_timer, st->l2.t200, EV_L2_T200, NULL, 11))
@@ -949,38 +891,24 @@ l2s22(struct FsmInst *fi, int event, void *arg)
st->l2.t200_running = !0;
}
- if (l2->i_queue.head && cansend(st))
+ if (skb_queue_len(&l2->i_queue) && cansend(st))
st->l2.l2l1(st, PH_REQUEST_PULL, NULL);
}
static void
transmit_enquiry(struct PStack *st)
{
- struct BufHeader *ibh;
- byte *ptr;
-
- if (!BufPoolGet(&ibh, st->l1.smallpool, GFP_ATOMIC, (void *) st, 12)) {
- ptr = DATAPTR(ibh);
- ptr += sethdraddr(&st->l2, ibh, CMD);
- if (st->l2.extended) {
- *ptr++ = RR;
- *ptr++ = (st->l2.vr << 1) | 1;
- } else {
- *ptr++ = (st->l2.vr << 5) | 0x11;
- }
- ibh->datasize = ptr - DATAPTR(ibh);
- enqueue_super(st, ibh);
- if (FsmAddTimer(&st->l2.t200_timer, st->l2.t200, EV_L2_T200, NULL, 12))
- if (st->l2.l2m.debug)
- l2m_debug(&st->l2.l2m, "FAT 10");
+ enquiry_command(st, RR, 1);
+ if (FsmAddTimer(&st->l2.t200_timer, st->l2.t200, EV_L2_T200, NULL, 12))
+ if (st->l2.l2m.debug)
+ l2m_debug(&st->l2.l2m, "FAT 10");
- st->l2.t200_running = !0;
- }
+ st->l2.t200_running = !0;
}
static void
-l2s23(struct FsmInst *fi, int event, void *arg)
+l2_st7_tout_200(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
@@ -992,40 +920,33 @@ l2s23(struct FsmInst *fi, int event, void *arg)
}
static void
-l2s24(struct FsmInst *fi, int event, void *arg)
+l2_got_st8_rr_rej(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
- int p, seq, rsp;
- byte *ptr;
+ struct sk_buff *skb = arg;
+ int PollFlag, seq, rsp;
struct Layer2 *l2;
l2 = &st->l2;
- ptr = DATAPTR(ibh);
-
- if (l2->laptype == LAPD) {
- rsp = ptr[0] & 0x2;
- if (l2->orig)
- rsp = !rsp;
- } else {
- rsp = ptr[0] == 0x3;
- if (l2->orig)
- rsp = !rsp;
- }
-
-
- ptr += l2addrsize(l2);
+ if (l2->laptype == LAPD)
+ rsp = *skb->data & 0x2;
+ else
+ rsp = *skb->data == 0x3;
+ if (l2->orig)
+ rsp = !rsp;
+ skb_pull(skb, l2addrsize(l2));
if (l2->extended) {
- p = (ptr[1] & 0x1) == 0x1;
- seq = ptr[1] >> 1;
+ PollFlag = (skb->data[1] & 0x1) == 0x1;
+ seq = skb->data[1] >> 1;
} else {
- p = (ptr[0] & 0x10);
- seq = (ptr[0] >> 5) & 0x7;
+ PollFlag = (skb->data[0] & 0x10);
+ seq = (skb->data[0] >> 5) & 0x7;
}
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
- if (rsp && p) {
+ if (rsp && PollFlag) {
if (legalnr(st, seq)) {
FsmChangeState(fi, ST_L2_7);
setva(st, seq);
@@ -1039,7 +960,7 @@ l2s24(struct FsmInst *fi, int event, void *arg)
invoke_retransmission(st, seq);
- if (l2->i_queue.head && cansend(st))
+ if (skb_queue_len(&l2->i_queue) && cansend(st))
st->l2.l2l1(st, PH_REQUEST_PULL, NULL);
else if (fi->userint & LC_FLUSH_WAIT) {
fi->userint &= ~LC_FLUSH_WAIT;
@@ -1047,8 +968,8 @@ l2s24(struct FsmInst *fi, int event, void *arg)
}
}
} else {
- if (!rsp && p)
- enquiry_response(st);
+ if (!rsp && PollFlag)
+ enquiry_response(st, RR, PollFlag);
if (legalnr(st, seq)) {
setva(st, seq);
}
@@ -1056,7 +977,7 @@ l2s24(struct FsmInst *fi, int event, void *arg)
}
static void
-l2s25(struct FsmInst *fi, int event, void *arg)
+l2_st7_tout_203(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
@@ -1066,7 +987,7 @@ l2s25(struct FsmInst *fi, int event, void *arg)
}
static void
-l2s26(struct FsmInst *fi, int event, void *arg)
+l2_st8_tout_200(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
@@ -1079,92 +1000,30 @@ l2s26(struct FsmInst *fi, int event, void *arg)
}
static void
-l2s27(struct FsmInst *fi, int event, void *arg)
+l2_got_FRMR(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
- byte *ptr;
- int i, p, est;
-
- ptr = DATAPTR(ibh);
- ptr += l2addrsize(&st->l2);
-
- p = ptr[0] & 0x10;
-
- BufPoolRelease(ibh);
-
- if (BufPoolGet(&ibh, st->l1.smallpool, GFP_ATOMIC, (void *) st, 10))
- return;
- i = sethdraddr(&st->l2, ibh, RSP);
- ptr = DATAPTR(ibh);
- ptr += i;
- *ptr = UA | p;
- ibh->datasize = i + 1;
- enqueue_super(st, ibh);
-
- if (st->l2.vs != st->l2.va) {
- discard_i_queue(st);
- est = !0;
- } else
- est = 0;
-
- FsmDelTimer(&st->l2.t200_timer, 15);
- st->l2.t200_running = 0;
-
- if (FsmAddTimer(&st->l2.t203_timer, st->l2.t203, EV_L2_T203, NULL, 3))
- if (st->l2.l2m.debug)
- l2m_debug(&st->l2.l2m, "FAT 12");
-
- st->l2.vs = 0;
- st->l2.va = 0;
- st->l2.vr = 0;
- st->l2.sow = 0;
-
-
- if (est)
- st->l2.l2man(st, DL_ESTABLISH, NULL);
-
-}
-
-static void
-l2s27_1(struct FsmInst *fi, int event, void *arg)
-{
- struct PStack *st = fi->userdata;
-
- FsmChangeState(fi, ST_L2_7);
- l2s27(fi, event, arg);
-
- if (st->l2.i_queue.head && cansend(st))
- st->l2.l2l1(st, PH_REQUEST_PULL, NULL);
-}
-
-static void
-l2s28(struct FsmInst *fi, int event, void *arg)
-{
- struct PStack *st = fi->userdata;
- struct BufHeader *ibh = arg;
- byte *ptr;
+ struct sk_buff *skb = arg;
char tmp[64];
- ptr = DATAPTR(ibh);
- ptr += l2addrsize(&st->l2);
- ptr++;
-
+ skb_pull(skb, l2addrsize(&st->l2));
if (st->l2.l2m.debug) {
if (st->l2.extended)
sprintf(tmp, "FRMR information %2x %2x %2x %2x %2x",
- ptr[0], ptr[1], ptr[2], ptr[3], ptr[4]);
+ skb->data[0], skb->data[1], skb->data[2],
+ skb->data[3], skb->data[4]);
else
sprintf(tmp, "FRMR information %2x %2x %2x",
- ptr[0], ptr[1], ptr[2]);
+ skb->data[0], skb->data[1], skb->data[2]);
l2m_debug(&st->l2.l2m, tmp);
}
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
}
static void
-l2s30(struct FsmInst *fi, int event, void *arg)
+l2_tei_remove(struct FsmInst *fi, int event, void *arg)
{
struct PStack *st = fi->userdata;
@@ -1188,26 +1047,26 @@ l2s30(struct FsmInst *fi, int event, void *arg)
FsmChangeState(fi, ST_L2_1);
}
-static int
-IsUI(byte * data, int ext)
+inline int
+IsUI(u_char * data, int ext)
{
return ((data[0] & 0xef) == UI);
}
-static int
-IsUA(byte * data, int ext)
+inline int
+IsUA(u_char * data, int ext)
{
return ((data[0] & 0xef) == UA);
}
-static int
-IsDISC(byte * data, int ext)
+inline int
+IsDISC(u_char * data, int ext)
{
return ((data[0] & 0xef) == DISC);
}
-static int
-IsRR(byte * data, int ext)
+inline int
+IsRR(u_char * data, int ext)
{
if (ext)
return (data[0] == RR);
@@ -1215,32 +1074,34 @@ IsRR(byte * data, int ext)
return ((data[0] & 0xf) == 1);
}
-static int
-IsI(byte * data, int ext)
+inline int
+IsI(u_char * data, int ext)
{
return ((data[0] & 0x1) == 0x0);
}
-static int
-IsSABMX(byte * data, int ext)
+inline int
+IsSABMX(u_char * data, int ext)
{
- return (ext ? (data[0] & ~0x10) == SABME : data[0] == 0x3f);
+ u_char d = data[0] & ~0x10;
+
+ return (ext ? d == SABME : d == SABM);
}
-static int
-IsREJ(byte * data, int ext)
+inline int
+IsREJ(u_char * data, int ext)
{
return (ext ? data[0] == REJ : (data[0] & 0xf) == 0x9);
}
-static int
-IsFRMR(byte * data, int ext)
+inline int
+IsFRMR(u_char * data, int ext)
{
return ((data[0] & 0xef) == FRMR);
}
-static int
-IsRNR(byte * data, int ext)
+inline int
+IsRNR(u_char * data, int ext)
{
if (ext)
return (data[0] == RNR);
@@ -1251,91 +1112,89 @@ IsRNR(byte * data, int ext)
static struct FsmNode L2FnList[] =
{
{ST_L2_1, EV_L2_DL_ESTABLISH, l2s1},
- {ST_L2_1, EV_L2_MDL_NOTEIPROC, l2s19},
- {ST_L2_3, EV_L2_MDL_ASSIGN, l2s17},
- {ST_L2_4, EV_L2_DL_UNIT_DATA, l2s2},
- {ST_L2_4, EV_L2_DL_ESTABLISH, l2s11},
- {ST_L2_7, EV_L2_DL_UNIT_DATA, l2s2},
- {ST_L2_7, EV_L2_DL_DATA, l2s7},
- {ST_L2_7, EV_L2_DL_RELEASE, l2s13},
- {ST_L2_7, EV_L2_ACK_PULL, l2s22},
- {ST_L2_8, EV_L2_DL_DATA, l2s7},
- {ST_L2_8, EV_L2_DL_RELEASE, l2s13},
-
- {ST_L2_1, EV_L2_UI, l2s3},
- {ST_L2_4, EV_L2_UI, l2s3},
- {ST_L2_4, EV_L2_SABMX, l2s12},
- {ST_L2_4, EV_L2_DISC, l2s14_1},
- {ST_L2_5, EV_L2_UA, l2s5},
- {ST_L2_6, EV_L2_UA, l2s15},
- {ST_L2_7, EV_L2_UI, l2s3},
- {ST_L2_7, EV_L2_DISC, l2s14},
- {ST_L2_7, EV_L2_I, l2s8},
- {ST_L2_7, EV_L2_RR, l2s6},
- {ST_L2_7, EV_L2_REJ, l2s16},
- {ST_L2_7, EV_L2_SABMX, l2s27},
- {ST_L2_7, EV_L2_FRMR, l2s28},
- {ST_L2_8, EV_L2_RR, l2s24},
- {ST_L2_8, EV_L2_REJ, l2s24},
- {ST_L2_8, EV_L2_SABMX, l2s27_1},
- {ST_L2_8, EV_L2_DISC, l2s14},
- {ST_L2_8, EV_L2_FRMR, l2s28},
- {ST_L2_8, EV_L2_I, l2s8_1},
-
- {ST_L2_5, EV_L2_T200, l2s20},
- {ST_L2_6, EV_L2_T200, l2s21},
- {ST_L2_7, EV_L2_T200, l2s23},
- {ST_L2_7, EV_L2_T203, l2s25},
- {ST_L2_8, EV_L2_T200, l2s26},
-
- {ST_L2_1, EV_L2_MDL_REMOVE, l2s30},
-/* {ST_L2_2, EV_L2_MDL_REMOVE, l2s30 }, */
- {ST_L2_3, EV_L2_MDL_REMOVE, l2s30},
- {ST_L2_4, EV_L2_MDL_REMOVE, l2s30},
- {ST_L2_5, EV_L2_MDL_REMOVE, l2s30},
- {ST_L2_6, EV_L2_MDL_REMOVE, l2s30},
- {ST_L2_7, EV_L2_MDL_REMOVE, l2s30},
- {ST_L2_8, EV_L2_MDL_REMOVE, l2s30},
+ {ST_L2_1, EV_L2_MDL_NOTEIPROC, l2_no_tei},
+ {ST_L2_3, EV_L2_MDL_ASSIGN, l2_got_tei},
+ {ST_L2_4, EV_L2_DL_UNIT_DATA, l2_send_ui},
+ {ST_L2_4, EV_L2_DL_ESTABLISH, l2_establish},
+ {ST_L2_7, EV_L2_DL_UNIT_DATA, l2_send_ui},
+ {ST_L2_7, EV_L2_DL_DATA, l2_feed_iqueue},
+ {ST_L2_7, EV_L2_DL_RELEASE, l2_send_disconn},
+ {ST_L2_7, EV_L2_ACK_PULL, l2_pull_iqueue},
+ {ST_L2_8, EV_L2_DL_DATA, l2_feed_iqueue},
+ {ST_L2_8, EV_L2_DL_RELEASE, l2_send_disconn},
+
+ {ST_L2_1, EV_L2_UI, l2_receive_ui},
+ {ST_L2_4, EV_L2_UI, l2_receive_ui},
+ {ST_L2_4, EV_L2_SABMX, l2_got_SABMX},
+ {ST_L2_4, EV_L2_DISC, l2_got_st4_disc},
+ {ST_L2_5, EV_L2_UA, l2_got_ua_establish},
+ {ST_L2_6, EV_L2_UA, l2_got_ua_disconn},
+ {ST_L2_7, EV_L2_UI, l2_receive_ui},
+ {ST_L2_7, EV_L2_DISC, l2_got_disconn},
+ {ST_L2_7, EV_L2_I, l2_got_st7_data},
+ {ST_L2_7, EV_L2_RR, l2_got_st7_RR},
+ {ST_L2_7, EV_L2_REJ, l2_got_st7_rej},
+ {ST_L2_7, EV_L2_SABMX, l2_got_SABMX},
+ {ST_L2_7, EV_L2_FRMR, l2_got_FRMR},
+ {ST_L2_8, EV_L2_RR, l2_got_st8_rr_rej},
+ {ST_L2_8, EV_L2_REJ, l2_got_st8_rr_rej},
+ {ST_L2_8, EV_L2_SABMX, l2_got_SABMX},
+ {ST_L2_8, EV_L2_DISC, l2_got_disconn},
+ {ST_L2_8, EV_L2_FRMR, l2_got_FRMR},
+ {ST_L2_8, EV_L2_I, l2_got_st8_data},
+
+ {ST_L2_5, EV_L2_T200, l2_st5_tout_200},
+ {ST_L2_6, EV_L2_T200, l2_st6_tout_200},
+ {ST_L2_7, EV_L2_T200, l2_st7_tout_200},
+ {ST_L2_7, EV_L2_T203, l2_st7_tout_203},
+ {ST_L2_8, EV_L2_T200, l2_st8_tout_200},
+
+ {ST_L2_1, EV_L2_MDL_REMOVE, l2_tei_remove},
+ {ST_L2_3, EV_L2_MDL_REMOVE, l2_tei_remove},
+ {ST_L2_4, EV_L2_MDL_REMOVE, l2_tei_remove},
+ {ST_L2_5, EV_L2_MDL_REMOVE, l2_tei_remove},
+ {ST_L2_6, EV_L2_MDL_REMOVE, l2_tei_remove},
+ {ST_L2_7, EV_L2_MDL_REMOVE, l2_tei_remove},
+ {ST_L2_8, EV_L2_MDL_REMOVE, l2_tei_remove},
};
#define L2_FN_COUNT (sizeof(L2FnList)/sizeof(struct FsmNode))
static void
-isdnl2_l1l2(struct PStack *st, int pr, struct BufHeader *arg)
+isdnl2_l1l2(struct PStack *st, int pr, void *arg)
{
- struct BufHeader *ibh;
- byte *datap;
+ struct sk_buff *skb = arg;
+ u_char *datap;
int ret = !0;
switch (pr) {
case (PH_DATA):
-
- ibh = arg;
- datap = DATAPTR(ibh);
+ datap = skb->data;
datap += l2addrsize(&st->l2);
if (IsI(datap, st->l2.extended))
- ret = FsmEvent(&st->l2.l2m, EV_L2_I, ibh);
+ ret = FsmEvent(&st->l2.l2m, EV_L2_I, skb);
else if (IsRR(datap, st->l2.extended))
- ret = FsmEvent(&st->l2.l2m, EV_L2_RR, ibh);
+ ret = FsmEvent(&st->l2.l2m, EV_L2_RR, skb);
else if (IsUI(datap, st->l2.extended))
- ret = FsmEvent(&st->l2.l2m, EV_L2_UI, ibh);
+ ret = FsmEvent(&st->l2.l2m, EV_L2_UI, skb);
else if (IsSABMX(datap, st->l2.extended))
- ret = FsmEvent(&st->l2.l2m, EV_L2_SABMX, ibh);
+ ret = FsmEvent(&st->l2.l2m, EV_L2_SABMX, skb);
else if (IsUA(datap, st->l2.extended))
- ret = FsmEvent(&st->l2.l2m, EV_L2_UA, ibh);
+ ret = FsmEvent(&st->l2.l2m, EV_L2_UA, skb);
else if (IsDISC(datap, st->l2.extended))
- ret = FsmEvent(&st->l2.l2m, EV_L2_DISC, ibh);
+ ret = FsmEvent(&st->l2.l2m, EV_L2_DISC, skb);
else if (IsREJ(datap, st->l2.extended))
- ret = FsmEvent(&st->l2.l2m, EV_L2_REJ, ibh);
+ ret = FsmEvent(&st->l2.l2m, EV_L2_REJ, skb);
else if (IsFRMR(datap, st->l2.extended))
- ret = FsmEvent(&st->l2.l2m, EV_L2_FRMR, ibh);
+ ret = FsmEvent(&st->l2.l2m, EV_L2_FRMR, skb);
else if (IsRNR(datap, st->l2.extended))
- ret = FsmEvent(&st->l2.l2m, EV_L2_RNR, ibh);
-
- if (ret)
- BufPoolRelease(ibh);
+ ret = FsmEvent(&st->l2.l2m, EV_L2_RNR, skb);
+ if (ret) {
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
+ }
break;
case (PH_PULL_ACK):
FsmEvent(&st->l2.l2m, EV_L2_ACK_PULL, arg);
@@ -1344,24 +1203,26 @@ isdnl2_l1l2(struct PStack *st, int pr, struct BufHeader *arg)
}
static void
-isdnl2_l3l2(struct PStack *st, int pr,
- void *arg)
+isdnl2_l3l2(struct PStack *st, int pr, void *arg)
{
switch (pr) {
case (DL_DATA):
- if (FsmEvent(&st->l2.l2m, EV_L2_DL_DATA, arg))
- BufPoolRelease((struct BufHeader *) arg);
+ if (FsmEvent(&st->l2.l2m, EV_L2_DL_DATA, arg)) {
+ SET_SKB_FREE(((struct sk_buff *) arg));
+ dev_kfree_skb((struct sk_buff *) arg, FREE_READ);
+ }
break;
case (DL_UNIT_DATA):
- if (FsmEvent(&st->l2.l2m, EV_L2_DL_UNIT_DATA, arg))
- BufPoolRelease((struct BufHeader *) arg);
+ if (FsmEvent(&st->l2.l2m, EV_L2_DL_UNIT_DATA, arg)) {
+ SET_SKB_FREE(((struct sk_buff *) arg));
+ dev_kfree_skb((struct sk_buff *) arg, FREE_READ);
+ }
break;
}
}
static void
-isdnl2_manl2(struct PStack *st, int pr,
- void *arg)
+isdnl2_manl2(struct PStack *st, int pr, void *arg)
{
switch (pr) {
case (DL_ESTABLISH):
@@ -1380,8 +1241,7 @@ isdnl2_manl2(struct PStack *st, int pr,
}
static void
-isdnl2_teil2(struct PStack *st, int pr,
- void *arg)
+isdnl2_teil2(struct PStack *st, int pr, void *arg)
{
switch (pr) {
case (MDL_ASSIGN):
@@ -1398,6 +1258,8 @@ releasestack_isdnl2(struct PStack *st)
{
FsmDelTimer(&st->l2.t200_timer, 15);
FsmDelTimer(&st->l2.t203_timer, 16);
+ discard_i_queue(st);
+ ReleaseWin(&st->l2);
}
static void
@@ -1421,7 +1283,8 @@ setstack_isdnl2(struct PStack *st, char *debug_id)
st->l2.uihsize = l2headersize(&st->l2, !0);
st->l2.ihsize = l2headersize(&st->l2, 0);
- BufQueueInit(&(st->l2.i_queue));
+ skb_queue_head_init(&st->l2.i_queue);
+ InitWin(&st->l2);
st->l2.rejexp = 0;
st->l2.debug = 0;
diff --git a/drivers/isdn/hisax/isdnl2.h b/drivers/isdn/hisax/isdnl2.h
index e02d51395..ac21d1c4d 100644
--- a/drivers/isdn/hisax/isdnl2.h
+++ b/drivers/isdn/hisax/isdnl2.h
@@ -4,6 +4,7 @@
#define RNR 0x05
#define REJ 0x09
#define SABME 0x6f
+#define SABM 0x2f
#define DM 0x0f
#define UI 0x03
#define DISC 0x43
diff --git a/drivers/isdn/hisax/isdnl3.c b/drivers/isdn/hisax/isdnl3.c
index 942fc1204..d86efcc1a 100644
--- a/drivers/isdn/hisax/isdnl3.c
+++ b/drivers/isdn/hisax/isdnl3.c
@@ -1,4 +1,4 @@
-/* $Id: isdnl3.c,v 1.6 1997/02/16 01:04:08 fritz Exp $
+/* $Id: isdnl3.c,v 1.10 1997/04/06 22:54:16 keil Exp $
* Author Karsten Keil (keil@temic-ech.spacenet.de)
* based on the teles driver from Jan den Ouden
@@ -7,6 +7,18 @@
* Fritz Elfert
*
* $Log: isdnl3.c,v $
+ * Revision 1.10 1997/04/06 22:54:16 keil
+ * Using SKB's
+ *
+ * Revision 1.9 1997/03/25 23:11:25 keil
+ * US NI-1 protocol
+ *
+ * Revision 1.8 1997/03/21 18:53:44 keil
+ * Report no protocol error to syslog too
+ *
+ * Revision 1.7 1997/03/17 18:34:38 keil
+ * fixed oops if no protocol selected during config
+ *
* Revision 1.6 1997/02/16 01:04:08 fritz
* Bugfix: Changed timer handling caused hang with 2.1.X
*
@@ -34,7 +46,7 @@
#include "isdnl3.h"
#include <linux/config.h>
-const char *l3_revision = "$Revision: 1.6 $";
+const char *l3_revision = "$Revision: 1.10 $";
void
l3_debug(struct PStack *st, char *s)
@@ -102,20 +114,39 @@ StopAllL3Timer(struct PStack *st)
L3DelTimer(&st->l3.timer);
}
+struct sk_buff *
+l3_alloc_skb(int len)
+{
+ struct sk_buff *skb;
+
+ if (!(skb = alloc_skb(len + MAX_HEADER_LEN, GFP_ATOMIC))) {
+ printk(KERN_WARNING "HiSax: No skb for D-channel\n");
+ return (NULL);
+ }
+ skb_reserve(skb, MAX_HEADER_LEN);
+ return (skb);
+}
+
static void
no_l3_proto(struct PStack *st, int pr, void *arg)
{
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
l3_debug(st, "no protocol");
- if (ibh)
- BufPoolRelease(ibh);
+ if (skb) {
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
+ }
}
#ifdef CONFIG_HISAX_EURO
extern void setstack_dss1(struct PStack *st);
#endif
+#ifdef CONFIG_HISAX_NI1
+extern void setstack_ni1(struct PStack *st);
+#endif
+
#ifdef CONFIG_HISAX_1TR6
extern void setstack_1tr6(struct PStack *st);
#endif
@@ -134,6 +165,11 @@ setstack_isdnl3(struct PStack *st, struct Channel *chanp)
setstack_dss1(st);
} else
#endif
+#ifdef CONFIG_HISAX_NI1
+ if (st->protocol == ISDN_PTYPE_NI1) {
+ setstack_ni1(st);
+ } else
+#endif
#ifdef CONFIG_HISAX_1TR6
if (st->protocol == ISDN_PTYPE_1TR6) {
setstack_1tr6(st);
@@ -144,10 +180,14 @@ setstack_isdnl3(struct PStack *st, struct Channel *chanp)
st->l2.l2l3 = no_l3_proto;
printk(KERN_NOTICE "HiSax: Leased line mode\n");
} else {
+ st->l4.l4l3 = no_l3_proto;
+ st->l2.l2l3 = no_l3_proto;
sprintf(tmp, "protocol %s not supported",
(st->protocol == ISDN_PTYPE_1TR6) ? "1tr6" :
(st->protocol == ISDN_PTYPE_EURO) ? "euro" :
+ (st->protocol == ISDN_PTYPE_NI1) ? "ni1" :
"unknown");
+ printk(KERN_WARNING "HiSax: %s\n", tmp);
l3_debug(st, tmp);
st->protocol = -1;
}
diff --git a/drivers/isdn/hisax/isdnl3.h b/drivers/isdn/hisax/isdnl3.h
index 384f9efa9..bed989a18 100644
--- a/drivers/isdn/hisax/isdnl3.h
+++ b/drivers/isdn/hisax/isdnl3.h
@@ -1,6 +1,9 @@
-/* $Id: isdnl3.h,v 1.2 1997/01/21 22:31:28 keil Exp $
+/* $Id: isdnl3.h,v 1.3 1997/04/06 22:54:17 keil Exp $
*
* $Log: isdnl3.h,v $
+ * Revision 1.3 1997/04/06 22:54:17 keil
+ * Using SKB's
+ *
* Revision 1.2 1997/01/21 22:31:28 keil
* new statemachine; L3 timers
*
@@ -21,9 +24,9 @@
#define L3_DEB_CHARGE 0x08
struct stateentry {
- int state;
- byte primitive;
- void (*rout) (struct PStack *, byte, void *);
+ int state;
+ u_char primitive;
+ void (*rout) (struct PStack *, u_char, void *);
};
extern void l3_debug(struct PStack *st, char *s);
@@ -32,3 +35,4 @@ extern void L3InitTimer(struct PStack *st, struct L3Timer *t);
extern void L3DelTimer(struct L3Timer *t);
extern int L3AddTimer(struct L3Timer *t, int millisec, int event);
extern void StopAllL3Timer(struct PStack *st);
+extern struct sk_buff *l3_alloc_skb(int len);
diff --git a/drivers/isdn/hisax/ix1_micro.c b/drivers/isdn/hisax/ix1_micro.c
index 631a0b280..ac98a4b4f 100644
--- a/drivers/isdn/hisax/ix1_micro.c
+++ b/drivers/isdn/hisax/ix1_micro.c
@@ -1,4 +1,4 @@
-/* $Id: ix1_micro.c,v 1.1 1997/01/27 15:43:10 keil Exp $
+/* $Id: ix1_micro.c,v 1.3 1997/04/13 19:54:02 keil Exp $
* ix1_micro.c low level stuff for ITK ix1-micro Rev.2 isdn cards
* derived from the original file teles3.c from Karsten Keil
@@ -11,6 +11,12 @@
* Beat Doebeli
*
* $Log: ix1_micro.c,v $
+ * Revision 1.3 1997/04/13 19:54:02 keil
+ * Change in IRQ check delay for SMP
+ *
+ * Revision 1.2 1997/04/06 22:54:21 keil
+ * Using SKB's
+ *
* Revision 1.1 1997/01/27 15:43:10 keil
* first version
*
@@ -55,7 +61,7 @@
#include <linux/kernel_stat.h>
extern const char *CardType[];
-const char *ix1_revision = "$Revision: 1.1 $";
+const char *ix1_revision = "$Revision: 1.3 $";
#define byteout(addr,val) outb_p(val,addr)
#define bytein(addr) inb_p(addr)
@@ -72,15 +78,15 @@ const char *ix1_revision = "$Revision: 1.1 $";
#define TIMEOUT 50
-static inline byte
-IsacReadReg(unsigned int adr, byte off)
+static inline u_char
+IsacReadReg(unsigned int adr, u_char off)
{
byteout(adr + ISAC_COMMAND_OFFSET, off + 0x20);
return bytein(adr + ISAC_DATA_OFFSET);
}
static inline void
-IsacWriteReg(unsigned int adr, byte off, byte data)
+IsacWriteReg(unsigned int adr, u_char off, u_char data)
{
byteout(adr + ISAC_COMMAND_OFFSET, off + 0x20);
byteout(adr + ISAC_DATA_OFFSET, data);
@@ -89,15 +95,15 @@ IsacWriteReg(unsigned int adr, byte off, byte data)
#define HSCX_OFFSET(WhichHscx,offset) \
( (WhichHscx) ? (offset+0x60) : (offset+0x20) )
-static inline byte
-HscxReadReg(unsigned int adr, int WhichHscx, byte off)
+static inline u_char
+HscxReadReg(unsigned int adr, int WhichHscx, u_char off)
{
byteout(adr + HSCX_COMMAND_OFFSET, HSCX_OFFSET(WhichHscx, off));
return bytein(adr + HSCX_DATA_OFFSET);
}
static inline void
-HscxWriteReg(unsigned int adr, int WhichHscx, byte off, byte data)
+HscxWriteReg(unsigned int adr, int WhichHscx, u_char off, u_char data)
{
byteout(adr + HSCX_COMMAND_OFFSET, HSCX_OFFSET(WhichHscx, off));
byteout(adr + HSCX_DATA_OFFSET, data);
@@ -105,7 +111,7 @@ HscxWriteReg(unsigned int adr, int WhichHscx, byte off, byte data)
static inline void
-IsacReadFifo(unsigned int adr, byte * data, int size)
+IsacReadFifo(unsigned int adr, u_char * data, int size)
{
byteout(adr + ISAC_COMMAND_OFFSET, 0);
while (size--)
@@ -113,7 +119,7 @@ IsacReadFifo(unsigned int adr, byte * data, int size)
}
static void
-IsacWriteFifo(unsigned int adr, byte * data, int size)
+IsacWriteFifo(unsigned int adr, u_char * data, int size)
{
byteout(adr + ISAC_COMMAND_OFFSET, 0);
while (size--) {
@@ -123,7 +129,7 @@ IsacWriteFifo(unsigned int adr, byte * data, int size)
}
static inline void
-HscxReadFifo(unsigned int adr, int WhichHscx, byte * data, int size)
+HscxReadFifo(unsigned int adr, int WhichHscx, u_char * data, int size)
{
byteout(adr + HSCX_COMMAND_OFFSET, (WhichHscx) ? 0x40 : 0x00);
while (size--)
@@ -131,7 +137,7 @@ HscxReadFifo(unsigned int adr, int WhichHscx, byte * data, int size)
}
static void
-HscxWriteFifo(unsigned int adr, int WhichHscx, byte * data, int size)
+HscxWriteFifo(unsigned int adr, int WhichHscx, u_char * data, int size)
{
byteout(adr + HSCX_COMMAND_OFFSET, (WhichHscx) ? 0x40 : 0x00);
while (size--) {
@@ -168,7 +174,7 @@ waitforXFW(int adr, int WhichHscx)
}
static inline void
-writehscxCMDR(int adr, int WhichHscx, byte data)
+writehscxCMDR(int adr, int WhichHscx, u_char data)
{
long flags;
@@ -210,25 +216,22 @@ ix1micro_report(struct IsdnCardState *sp)
static void
hscx_empty_fifo(struct HscxState *hsp, int count)
{
- byte *ptr;
+ u_char *ptr;
struct IsdnCardState *sp = hsp->sp;
- struct BufHeader *ibh = hsp->rcvibh;
long flags;
if ((sp->debug & L1_DEB_HSCX) && !(sp->debug & L1_DEB_HSCX_FIFO))
debugl1(sp, "hscx_empty_fifo");
- if (hsp->rcvptr + count > BUFFER_SIZE(HSCX_RBUF_ORDER,
- HSCX_RBUF_BPPS)) {
+ if (hsp->rcvidx + count > HSCX_BUFMAX) {
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "hscx_empty_fifo: incoming packet too large");
writehscxCMDR(sp->hscx[hsp->hscx], hsp->hscx, 0x80);
+ hsp->rcvidx = 0;
return;
}
- ptr = DATAPTR(ibh);
- ptr += hsp->rcvptr;
-
- hsp->rcvptr += count;
+ ptr = hsp->rcvbuf + hsp->rcvidx;
+ hsp->rcvidx += count;
save_flags(flags);
cli();
HscxReadFifo(sp->hscx[hsp->hscx], hsp->hscx, ptr, count);
@@ -249,34 +252,32 @@ static void
hscx_fill_fifo(struct HscxState *hsp)
{
struct IsdnCardState *sp = hsp->sp;
- struct BufHeader *ibh;
int more, count;
- byte *ptr;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_HSCX) && !(sp->debug & L1_DEB_HSCX_FIFO))
debugl1(sp, "hscx_fill_fifo");
- ibh = hsp->xmtibh;
- if (!ibh)
+ if (!hsp->tx_skb)
return;
-
- count = ibh->datasize - hsp->sendptr;
- if (count <= 0)
+ if (hsp->tx_skb->len <= 0)
return;
more = (hsp->mode == 1) ? 1 : 0;
- if (count > 32) {
+ if (hsp->tx_skb->len > 32) {
more = !0;
count = 32;
- }
- ptr = DATAPTR(ibh);
- ptr += hsp->sendptr;
- hsp->sendptr += count;
+ } else
+ count = hsp->tx_skb->len;
waitforXFW(sp->hscx[hsp->hscx], hsp->hscx);
save_flags(flags);
cli();
+ ptr = hsp->tx_skb->data;
+ skb_pull(hsp->tx_skb, count);
+ hsp->tx_cnt -= count;
+ hsp->count += count;
HscxWriteFifo(sp->hscx[hsp->hscx], hsp->hscx, ptr, count);
writehscxCMDR(sp->hscx[hsp->hscx], hsp->hscx, more ? 0x8 : 0xa);
restore_flags(flags);
@@ -292,11 +293,12 @@ hscx_fill_fifo(struct HscxState *hsp)
}
static inline void
-hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
+hscx_interrupt(struct IsdnCardState *sp, u_char val, u_char hscx)
{
- byte r;
+ u_char r;
struct HscxState *hsp = sp->hs + hscx;
- int count, err;
+ struct sk_buff *skb;
+ int count;
char tmp[32];
if (!hsp->init)
@@ -318,79 +320,61 @@ hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
if (!r & 0x20)
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "HSCX CRC error");
- if (hsp->rcvibh)
- BufPoolRelease(hsp->rcvibh);
- hsp->rcvibh = NULL;
writehscxCMDR(sp->hscx[hsp->hscx], hsp->hscx, 0x80);
- goto afterRME;
+ } else {
+ count = HscxReadReg(sp->hscx[hsp->hscx], hscx, HSCX_RBCL) & 0x1f;
+ if (count == 0)
+ count = 32;
+ hscx_empty_fifo(hsp, count);
+ if ((count = hsp->rcvidx - 1) > 0) {
+ if (sp->debug & L1_DEB_HSCX_FIFO) {
+ sprintf(tmp, "HX Frame %d", count);
+ debugl1(sp, tmp);
+ }
+ if (!(skb = dev_alloc_skb(count)))
+ printk(KERN_WARNING "IX1: receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, count), hsp->rcvbuf, count);
+ skb_queue_tail(&hsp->rqueue, skb);
+ }
+ }
}
- if (!hsp->rcvibh)
- if (BufPoolGet(&hsp->rcvibh, &hsp->rbufpool,
- GFP_ATOMIC, (void *) 1, 1)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "HSCX RME out of buffers");
- writehscxCMDR(sp->hscx[hsp->hscx], hsp->hscx, 0x80);
- goto afterRME;
- } else
- hsp->rcvptr = 0;
-
- count = HscxReadReg(sp->hscx[hsp->hscx], hscx, HSCX_RBCL) & 0x1f;
- if (count == 0)
- count = 32;
- hscx_empty_fifo(hsp, count);
- hsp->rcvibh->datasize = hsp->rcvptr - 1;
- BufQueueLink(&hsp->rq, hsp->rcvibh);
- hsp->rcvibh = NULL;
+ hsp->rcvidx = 0;
hscx_sched_event(hsp, HSCX_RCVBUFREADY);
}
- afterRME:
if (val & 0x40) { /* RPF */
- if (!hsp->rcvibh) {
- if (hsp->mode == 1)
- err = BufPoolGet(&hsp->rcvibh, &hsp->smallpool,
- GFP_ATOMIC, (void *) 1, 2);
- else
- err = BufPoolGet(&hsp->rcvibh, &hsp->rbufpool,
- GFP_ATOMIC, (void *) 1, 2);
-
- if (err) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "HSCX RPF out of buffers");
- writehscxCMDR(sp->hscx[hsp->hscx], hsp->hscx, 0x80);
- goto afterRPF;
- } else
- hsp->rcvptr = 0;
- }
hscx_empty_fifo(hsp, 32);
if (hsp->mode == 1) {
/* receive audio data */
- hsp->rcvibh->datasize = hsp->rcvptr;
- BufQueueLink(&hsp->rq, hsp->rcvibh);
- hsp->rcvibh = NULL;
+ if (!(skb = dev_alloc_skb(32)))
+ printk(KERN_WARNING "IX1: receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, 32), hsp->rcvbuf, 32);
+ skb_queue_tail(&hsp->rqueue, skb);
+ }
+ hsp->rcvidx = 0;
hscx_sched_event(hsp, HSCX_RCVBUFREADY);
}
}
- afterRPF:
if (val & 0x10) { /* XPR */
- if (hsp->xmtibh)
- if (hsp->xmtibh->datasize > hsp->sendptr) {
+ if (hsp->tx_skb)
+ if (hsp->tx_skb->len) {
hscx_fill_fifo(hsp);
- goto afterXPR;
+ return;
} else {
- if (hsp->releasebuf)
- BufPoolRelease(hsp->xmtibh);
- hsp->sendptr = 0;
+ SET_SKB_FREE(hsp->tx_skb);
+ dev_kfree_skb(hsp->tx_skb, FREE_WRITE);
+ hsp->count = 0;
if (hsp->st->l4.l1writewakeup)
hsp->st->l4.l1writewakeup(hsp->st);
- hsp->xmtibh = NULL;
+ hsp->tx_skb = NULL;
}
- if (!BufQueueUnlink(&hsp->xmtibh, &hsp->sq)) {
- hsp->releasebuf = !0;
+ if ((hsp->tx_skb = skb_dequeue(&hsp->squeue))) {
+ hsp->count = 0;
hscx_fill_fifo(hsp);
} else
hscx_sched_event(hsp, HSCX_XMTBUFREADY);
}
- afterXPR:
}
/*
@@ -400,26 +384,26 @@ hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
static void
isac_empty_fifo(struct IsdnCardState *sp, int count)
{
- byte *ptr;
- struct BufHeader *ibh = sp->rcvibh;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_ISAC) && !(sp->debug & L1_DEB_ISAC_FIFO))
if (sp->debug & L1_DEB_ISAC)
debugl1(sp, "isac_empty_fifo");
- if (sp->rcvptr >= 3072) {
+ if ((sp->rcvidx + count) >= MAX_DFRAME_LEN) {
if (sp->debug & L1_DEB_WARN) {
char tmp[40];
- sprintf(tmp, "isac_empty_fifo rcvptr %d", sp->rcvptr);
+ sprintf(tmp, "isac_empty_fifo overrun %d",
+ sp->rcvidx + count);
debugl1(sp, tmp);
}
+ IsacWriteReg(sp->isac, ISAC_CMDR, 0x80);
+ sp->rcvidx = 0;
return;
}
- ptr = DATAPTR(ibh);
- ptr += sp->rcvptr;
- sp->rcvptr += count;
-
+ ptr = sp->rcvbuf + sp->rcvidx;
+ sp->rcvidx += count;
save_flags(flags);
cli();
IsacReadFifo(sp->isac, ptr, count);
@@ -438,35 +422,30 @@ isac_empty_fifo(struct IsdnCardState *sp, int count)
static void
isac_fill_fifo(struct IsdnCardState *sp)
{
- struct BufHeader *ibh;
int count, more;
- byte *ptr;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_ISAC) && !(sp->debug & L1_DEB_ISAC_FIFO))
debugl1(sp, "isac_fill_fifo");
- ibh = sp->xmtibh;
- if (!ibh)
+ if (!sp->tx_skb)
return;
- count = ibh->datasize - sp->sendptr;
+ count = sp->tx_skb->len;
if (count <= 0)
return;
- if (count >= 3072)
- return;
more = 0;
if (count > 32) {
more = !0;
count = 32;
}
- ptr = DATAPTR(ibh);
- ptr += sp->sendptr;
- sp->sendptr += count;
-
save_flags(flags);
cli();
+ ptr = sp->tx_skb->data;
+ skb_pull(sp->tx_skb, count);
+ sp->tx_cnt += count;
IsacWriteFifo(sp->isac, ptr, count);
IsacWriteReg(sp->isac, ISAC_CMDR, more ? 0x8 : 0xa);
restore_flags(flags);
@@ -493,9 +472,10 @@ ph_command(struct IsdnCardState *sp, unsigned int command)
static inline void
-isac_interrupt(struct IsdnCardState *sp, byte val)
+isac_interrupt(struct IsdnCardState *sp, u_char val)
{
- byte exval;
+ u_char exval;
+ struct sk_buff *skb;
unsigned int count;
char tmp[32];
@@ -512,62 +492,46 @@ isac_interrupt(struct IsdnCardState *sp, byte val)
if (!exval & 0x20)
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "ISAC CRC error");
- if (sp->rcvibh)
- BufPoolRelease(sp->rcvibh);
- sp->rcvibh = NULL;
IsacWriteReg(sp->isac, ISAC_CMDR, 0x80);
- goto afterRME;
+ } else {
+ count = IsacReadReg(sp->isac, ISAC_RBCL) & 0x1f;
+ if (count == 0)
+ count = 32;
+ isac_empty_fifo(sp, count);
+ if ((count = sp->rcvidx) > 0) {
+ sp->rcvidx = 0;
+ if (!(skb = alloc_skb(count, GFP_ATOMIC)))
+ printk(KERN_WARNING "IX1: D receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, count), sp->rcvbuf, count);
+ skb_queue_tail(&sp->rq, skb);
+ }
+ }
}
- if (!sp->rcvibh)
- if (BufPoolGet(&(sp->rcvibh), &(sp->rbufpool),
- GFP_ATOMIC, (void *) 1, 3)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "ISAC RME out of buffers!");
- IsacWriteReg(sp->isac, ISAC_CMDR, 0x80);
- goto afterRME;
- } else
- sp->rcvptr = 0;
- count = IsacReadReg(sp->isac, ISAC_RBCL) & 0x1f;
- if (count == 0)
- count = 32;
- isac_empty_fifo(sp, count);
- sp->rcvibh->datasize = sp->rcvptr;
- BufQueueLink(&(sp->rq), sp->rcvibh);
- sp->rcvibh = NULL;
+ sp->rcvidx = 0;
isac_sched_event(sp, ISAC_RCVBUFREADY);
}
- afterRME:
if (val & 0x40) { /* RPF */
- if (!sp->rcvibh)
- if (BufPoolGet(&(sp->rcvibh), &(sp->rbufpool),
- GFP_ATOMIC, (void *) 1, 4)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "ISAC RME out of buffers!");
- IsacWriteReg(sp->isac, ISAC_CMDR, 0x80);
- goto afterRPF;
- } else
- sp->rcvptr = 0;
isac_empty_fifo(sp, 32);
}
- afterRPF:
if (val & 0x20) { /* RSC */
/* never */
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "ISAC RSC interrupt");
}
if (val & 0x10) { /* XPR */
- if (sp->xmtibh)
- if (sp->xmtibh->datasize > sp->sendptr) {
+ if (sp->tx_skb)
+ if (sp->tx_skb->len) {
isac_fill_fifo(sp);
goto afterXPR;
} else {
- if (sp->releasebuf)
- BufPoolRelease(sp->xmtibh);
- sp->xmtibh = NULL;
- sp->sendptr = 0;
+ SET_SKB_FREE(sp->tx_skb);
+ dev_kfree_skb(sp->tx_skb, FREE_WRITE);
+ sp->tx_cnt = 0;
+ sp->tx_skb = NULL;
}
- if (!BufQueueUnlink(&sp->xmtibh, &sp->sq)) {
- sp->releasebuf = !0;
+ if ((sp->tx_skb = skb_dequeue(&sp->sq))) {
+ sp->tx_cnt = 0;
isac_fill_fifo(sp);
} else
isac_sched_event(sp, ISAC_XMTBUFREADY);
@@ -597,10 +561,10 @@ isac_interrupt(struct IsdnCardState *sp, byte val)
}
static inline void
-hscx_int_main(struct IsdnCardState *sp, byte val)
+hscx_int_main(struct IsdnCardState *sp, u_char val)
{
- byte exval;
+ u_char exval;
struct HscxState *hsp;
char tmp[32];
@@ -615,7 +579,11 @@ hscx_int_main(struct IsdnCardState *sp, byte val)
/* Here we lost an TX interrupt, so
* restart transmitting the whole frame.
*/
- hsp->sendptr = 0;
+ if (hsp->tx_skb) {
+ skb_push(hsp->tx_skb, hsp->count);
+ hsp->tx_cnt += hsp->count;
+ hsp->count = 0;
+ }
writehscxCMDR(sp->hscx[hsp->hscx], hsp->hscx, 0x01);
if (sp->debug & L1_DEB_WARN) {
sprintf(tmp, "HSCX B EXIR %x Lost TX", exval);
@@ -644,7 +612,11 @@ hscx_int_main(struct IsdnCardState *sp, byte val)
/* Here we lost an TX interrupt, so
* restart transmitting the whole frame.
*/
- hsp->sendptr = 0;
+ if (hsp->tx_skb) {
+ skb_push(hsp->tx_skb, hsp->count);
+ hsp->tx_cnt += hsp->count;
+ hsp->count = 0;
+ }
writehscxCMDR(sp->hscx[hsp->hscx], hsp->hscx, 0x01);
if (sp->debug & L1_DEB_WARN) {
sprintf(tmp, "HSCX A EXIR %x Lost TX", exval);
@@ -670,7 +642,7 @@ static void
ix1micro_interrupt(int intno, void *dev_id, struct pt_regs *regs)
{
struct IsdnCardState *sp;
- byte val, stat = 0;
+ u_char val, stat = 0;
sp = (struct IsdnCardState *) irq2dev_map[intno];
@@ -757,48 +729,48 @@ modehscx(struct HscxState *hs, int mode, int ichan)
HscxWriteReg(sp->hscx[hscx], hscx, HSCX_RLCR, 0x0);
switch (mode) {
- case 0:
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_CCR2, 0x30);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAX, 0xff);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAR, 0xff);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_XCCR, 7);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_RCCR, 7);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_MODE, 0x84);
- break;
- case 1:
- if (ichan == 0) {
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_CCR2, 0x30);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAX, 0x2f);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAR, 0x2f);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_XCCR, 7);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_RCCR, 7);
- } else {
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_CCR2, 0x30);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAX, 0x3);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAR, 0x3);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_XCCR, 7);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_RCCR, 7);
- }
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_MODE, 0xe4);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_CMDR, 0x41);
- break;
- case 2:
- if (ichan == 0) {
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_CCR2, 0x30);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAX, 0x2f);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAR, 0x2f);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_XCCR, 7);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_RCCR, 7);
- } else {
+ case 0:
HscxWriteReg(sp->hscx[hscx], hscx, HSCX_CCR2, 0x30);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAX, 0x3);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAR, 0x3);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAX, 0xff);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAR, 0xff);
HscxWriteReg(sp->hscx[hscx], hscx, HSCX_XCCR, 7);
HscxWriteReg(sp->hscx[hscx], hscx, HSCX_RCCR, 7);
- }
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_MODE, 0x8c);
- HscxWriteReg(sp->hscx[hscx], hscx, HSCX_CMDR, 0x41);
- break;
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_MODE, 0x84);
+ break;
+ case 1:
+ if (ichan == 0) {
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_CCR2, 0x30);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAX, 0x2f);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAR, 0x2f);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_XCCR, 7);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_RCCR, 7);
+ } else {
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_CCR2, 0x30);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAX, 0x3);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAR, 0x3);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_XCCR, 7);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_RCCR, 7);
+ }
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_MODE, 0xe4);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_CMDR, 0x41);
+ break;
+ case 2:
+ if (ichan == 0) {
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_CCR2, 0x30);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAX, 0x2f);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAR, 0x2f);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_XCCR, 7);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_RCCR, 7);
+ } else {
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_CCR2, 0x30);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAX, 0x3);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_TSAR, 0x3);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_XCCR, 7);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_RCCR, 7);
+ }
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_MODE, 0x8c);
+ HscxWriteReg(sp->hscx[hscx], hscx, HSCX_CMDR, 0x41);
+ break;
}
HscxWriteReg(sp->hscx[hscx], hscx, HSCX_ISTA, 0x00);
}
@@ -866,6 +838,7 @@ int
initix1micro(struct IsdnCardState *sp)
{
int ret;
+ int loop = 0;
char tmp[40];
sp->counter = kstat.interrupts[sp->irq];
@@ -877,6 +850,16 @@ initix1micro(struct IsdnCardState *sp)
initisac(sp);
sp->modehscx(sp->hs, 0, 0);
sp->modehscx(sp->hs + 1, 0, 0);
+ while (loop++ < 10) {
+ /* At least 1-3 irqs must happen
+ * (one from HSCX A, one from HSCX B, 3rd from ISAC)
+ */
+ if (kstat.interrupts[sp->irq] > sp->counter)
+ break;
+ current->state = TASK_INTERRUPTIBLE;
+ current->timeout = jiffies + 1;
+ schedule();
+ }
sprintf(tmp, "IRQ %d count %d", sp->irq,
kstat.interrupts[sp->irq]);
debugl1(sp, tmp);
@@ -895,7 +878,7 @@ initix1micro(struct IsdnCardState *sp)
int
setup_ix1micro(struct IsdnCard *card)
{
- byte val, verA, verB;
+ u_char val, verA, verB;
struct IsdnCardState *sp = card->sp;
long flags;
char tmp[64];
diff --git a/drivers/isdn/hisax/l3_1tr6.c b/drivers/isdn/hisax/l3_1tr6.c
index 9f287a15c..99e318ac1 100644
--- a/drivers/isdn/hisax/l3_1tr6.c
+++ b/drivers/isdn/hisax/l3_1tr6.c
@@ -1,4 +1,4 @@
-/* $Id: l3_1tr6.c,v 1.9 1997/02/11 01:37:40 keil Exp $
+/* $Id: l3_1tr6.c,v 1.11 1997/04/06 22:54:18 keil Exp $
* German 1TR6 D-channel protocol
*
@@ -6,6 +6,12 @@
*
*
* $Log: l3_1tr6.c,v $
+ * Revision 1.11 1997/04/06 22:54:18 keil
+ * Using SKB's
+ *
+ * Revision 1.10 1997/03/13 20:37:58 keil
+ * channel request added
+ *
* Revision 1.9 1997/02/11 01:37:40 keil
* Changed setup-interface (incoming and outgoing)
*
@@ -40,9 +46,10 @@
#include "hisax.h"
#include "l3_1tr6.h"
#include "isdnl3.h"
+#include <linux/ctype.h>
extern char *HiSax_getrev(const char *revision);
-const char *l3_1tr6_revision = "$Revision: 1.9 $";
+const char *l3_1tr6_revision = "$Revision: 1.11 $";
#define MsgHead(ptr, cref, mty, dis) \
*ptr++ = dis; \
@@ -51,36 +58,63 @@ const char *l3_1tr6_revision = "$Revision: 1.9 $";
*ptr++ = mty
static void
-l3_1TR6_message(struct PStack *st, byte mt, byte pd)
+l3_1TR6_message(struct PStack *st, u_char mt, u_char pd)
{
- struct BufHeader *dibh;
- byte *p;
-
- BufPoolGet(&dibh, st->l1.sbufpool, GFP_ATOMIC, (void *) st, 18);
- p = DATAPTR(dibh);
- p += st->l2.ihsize;
+ struct sk_buff *skb;
+ u_char *p;
+ if (!(skb = l3_alloc_skb(4)))
+ return;
+ p = skb_put(skb, 4);
MsgHead(p, st->l3.callref, mt, pd);
-
- dibh->datasize = p - DATAPTR(dibh);
- st->l3.l3l2(st, DL_DATA, dibh);
+ st->l3.l3l2(st, DL_DATA, skb);
}
static void
-l3_1tr6_setup_req(struct PStack *st, byte pr, void *arg)
+l3_1tr6_setup_req(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *dibh;
- byte *p;
- char *teln;
+ struct sk_buff *skb;
+ u_char tmp[128];
+ u_char *p = tmp;
+ u_char *teln;
+ u_char *eaz;
+ u_char channel = 0;
+ int l;
- st->l3.callref = st->pa->callref;
- BufPoolGet(&dibh, st->l1.sbufpool, GFP_ATOMIC, (void *) st, 19);
- p = DATAPTR(dibh);
- p += st->l2.ihsize;
+ st->l3.callref = st->pa->callref;
MsgHead(p, st->l3.callref, MT_N1_SETUP, PROTO_DIS_N1);
- if ('S' == (st->pa->setup.phone[0] & 0x5f)) { /* SPV ? */
+ teln = st->pa->setup.phone;
+ st->pa->spv = 0;
+ if (!isdigit(*teln)) {
+ switch (0x5f & *teln) {
+ case 'S':
+ st->pa->spv = 1;
+ break;
+ case 'C':
+ channel = 0x08;
+ case 'P':
+ channel |= 0x80;
+ teln++;
+ if (*teln == '1')
+ channel |= 0x01;
+ else
+ channel |= 0x02;
+ break;
+ default:
+ if (st->l3.debug & L3_DEB_WARN)
+ l3_debug(st, "Wrong MSN Code");
+ break;
+ }
+ teln++;
+ }
+ if (channel) {
+ *p++ = 0x18; /* channel indicator */
+ *p++ = 1;
+ *p++ = channel;
+ }
+ if (st->pa->spv) { /* SPV ? */
/* NSF SPV */
*p++ = WE0_netSpecFac;
*p++ = 4; /* Laenge */
@@ -95,25 +129,17 @@ l3_1tr6_setup_req(struct PStack *st, byte pr, void *arg)
*p++ = st->pa->setup.si1; /* 0 for all Services */
*p++ = st->pa->setup.si2; /* 0 for all Services */
}
- if (st->pa->setup.eazmsn[0] != '\0') {
+ eaz = st->pa->setup.eazmsn;
+ if (*eaz) {
*p++ = WE0_origAddr;
- *p++ = strlen(st->pa->setup.eazmsn) + 1;
+ *p++ = strlen(eaz) + 1;
/* Classify as AnyPref. */
*p++ = 0x81; /* Ext = '1'B, Type = '000'B, Plan = '0001'B. */
- teln = st->pa->setup.eazmsn;
- while (*teln)
- *p++ = *teln++ & 0x7f;
+ while (*eaz)
+ *p++ = *eaz++ & 0x7f;
}
*p++ = WE0_destAddr;
- teln = st->pa->setup.phone;
- if ('S' != (st->pa->setup.phone[0] & 0x5f)) { /* Keine SPV */
- *p++ = strlen(st->pa->setup.phone) + 1;
- st->pa->spv = 0;
- } else { /* SPV */
- *p++ = strlen(st->pa->setup.phone);
- teln++; /* skip S */
- st->pa->spv = 1;
- }
+ *p++ = strlen(teln) + 1;
/* Classify as AnyPref. */
*p++ = 0x81; /* Ext = '1'B, Type = '000'B, Plan = '0001'B. */
while (*teln)
@@ -126,67 +152,64 @@ l3_1tr6_setup_req(struct PStack *st, byte pr, void *arg)
*p++ = st->pa->setup.si1;
*p++ = st->pa->setup.si2;
- dibh->datasize = p - DATAPTR(dibh);
-
+ l = p - tmp;
+ if (!(skb = l3_alloc_skb(l)))
+ return;
+ memcpy(skb_put(skb, l), tmp, l);
L3DelTimer(&st->l3.timer);
L3AddTimer(&st->l3.timer, st->l3.t303, CC_T303);
newl3state(st, 1);
- st->l3.l3l2(st, DL_DATA, dibh);
+ st->l3.l3l2(st, DL_DATA, skb);
}
static void
-l3_1tr6_setup(struct PStack *st, byte pr, void *arg)
+l3_1tr6_setup(struct PStack *st, u_char pr, void *arg)
{
- byte *p;
+ u_char *p;
int bcfound = 0;
char tmp[80];
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
- p = DATAPTR(ibh);
- p += st->l2.uihsize;
+ p = skb->data;
st->pa->callref = getcallref(p);
st->l3.callref = 0x80 + st->pa->callref;
/* Channel Identification */
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.uihsize, ibh->datasize - st->l2.uihsize,
- WE0_chanID, 0))) {
+ p = skb->data;
+ if ((p = findie(p, skb->len, WE0_chanID, 0))) {
st->pa->bchannel = p[2] & 0x3;
bcfound++;
} else if (st->l3.debug & L3_DEB_WARN)
l3_debug(st, "setup without bchannel");
- p = DATAPTR(ibh);
-
- if ((p = findie(p + st->l2.uihsize, ibh->datasize - st->l2.uihsize, WE6_serviceInd, 6))) {
+ p = skb->data;
+ if ((p = findie(p, skb->len, WE6_serviceInd, 6))) {
st->pa->setup.si1 = p[2];
st->pa->setup.si2 = p[3];
} else if (st->l3.debug & L3_DEB_WARN)
l3_debug(st, "setup without service indicator");
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.uihsize, ibh->datasize - st->l2.uihsize,
- WE0_destAddr, 0)))
+ p = skb->data;
+ if ((p = findie(p, skb->len, WE0_destAddr, 0)))
iecpy(st->pa->setup.eazmsn, p, 1);
else
st->pa->setup.eazmsn[0] = 0;
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.uihsize, ibh->datasize - st->l2.uihsize,
- WE0_origAddr, 0))) {
+ p = skb->data;
+ if ((p = findie(p, skb->len, WE0_origAddr, 0))) {
iecpy(st->pa->setup.phone, p, 1);
} else
st->pa->setup.phone[0] = 0;
- p = DATAPTR(ibh);
+ p = skb->data;
st->pa->spv = 0;
- if ((p = findie(p + st->l2.uihsize, ibh->datasize - st->l2.uihsize,
- WE0_netSpecFac, 0))) {
+ if ((p = findie(p, skb->len, WE0_netSpecFac, 0))) {
if ((FAC_SPV == p[3]) || (FAC_Activate == p[3]))
st->pa->spv = 1;
}
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
/* Signal all services, linklevel takes care of Service-Indicator */
if (bcfound) {
@@ -202,67 +225,65 @@ l3_1tr6_setup(struct PStack *st, byte pr, void *arg)
}
static void
-l3_1tr6_setup_ack(struct PStack *st, byte pr, void *arg)
+l3_1tr6_setup_ack(struct PStack *st, u_char pr, void *arg)
{
- byte *p;
- struct BufHeader *ibh = arg;
+ u_char *p;
+ struct sk_buff *skb = arg;
L3DelTimer(&st->l3.timer);
+ p = skb->data;
newl3state(st, 2);
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.ihsize, ibh->datasize - st->l2.ihsize,
- WE0_chanID, 0))) {
+ if ((p = findie(p, skb->len, WE0_chanID, 0))) {
st->pa->bchannel = p[2] & 0x3;
} else if (st->l3.debug & L3_DEB_WARN)
l3_debug(st, "setup answer without bchannel");
-
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
L3AddTimer(&st->l3.timer, st->l3.t304, CC_T304);
st->l3.l3l4(st, CC_MORE_INFO, NULL);
}
static void
-l3_1tr6_call_sent(struct PStack *st, byte pr, void *arg)
+l3_1tr6_call_sent(struct PStack *st, u_char pr, void *arg)
{
- byte *p;
- struct BufHeader *ibh = arg;
+ u_char *p;
+ struct sk_buff *skb = arg;
L3DelTimer(&st->l3.timer);
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.ihsize, ibh->datasize - st->l2.ihsize,
- WE0_chanID, 0))) {
+ p = skb->data;
+ if ((p = findie(p, skb->len, WE0_chanID, 0))) {
st->pa->bchannel = p[2] & 0x3;
} else if (st->l3.debug & L3_DEB_WARN)
l3_debug(st, "setup answer without bchannel");
-
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
L3AddTimer(&st->l3.timer, st->l3.t310, CC_T310);
newl3state(st, 3);
st->l3.l3l4(st, CC_PROCEEDING_IND, NULL);
}
static void
-l3_1tr6_alert(struct PStack *st, byte pr, void *arg)
+l3_1tr6_alert(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
L3DelTimer(&st->l3.timer); /* T304 */
newl3state(st, 4);
st->l3.l3l4(st, CC_ALERTING_IND, NULL);
}
static void
-l3_1tr6_info(struct PStack *st, byte pr, void *arg)
+l3_1tr6_info(struct PStack *st, u_char pr, void *arg)
{
- byte *p;
+ u_char *p;
int i, tmpcharge = 0;
char a_charge[8], tmp[32];
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.ihsize, ibh->datasize - st->l2.ihsize,
- WE6_chargingInfo, 6))) {
+ p = skb->data;
+ if ((p = findie(p, skb->len, WE6_chargingInfo, 6))) {
iecpy(a_charge, p, 1);
for (i = 0; i < strlen(a_charge); i++) {
tmpcharge *= 10;
@@ -278,39 +299,41 @@ l3_1tr6_info(struct PStack *st, byte pr, void *arg)
}
} else if (st->l3.debug & L3_DEB_CHARGE)
l3_debug(st, "charging info not found");
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
- BufPoolRelease(ibh);
}
static void
-l3_1tr6_info_s2(struct PStack *st, byte pr, void *arg)
+l3_1tr6_info_s2(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
}
static void
-l3_1tr6_connect(struct PStack *st, byte pr, void *arg)
+l3_1tr6_connect(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
L3DelTimer(&st->l3.timer); /* T310 */
newl3state(st, 10);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
st->pa->chargeinfo = 0;
- BufPoolRelease(ibh);
st->l3.l3l4(st, CC_SETUP_CNF, NULL);
}
static void
-l3_1tr6_rel(struct PStack *st, byte pr, void *arg)
+l3_1tr6_rel(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *ibh = arg;
- byte *p;
-
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.ihsize, ibh->datasize - st->l2.ihsize,
- WE0_cause, 0))) {
+ struct sk_buff *skb = arg;
+ u_char *p;
+
+ p = skb->data;
+ if ((p = findie(p, skb->len, WE0_cause, 0))) {
if (p[1] > 0) {
st->pa->cause = p[2];
if (p[1] > 1)
@@ -321,9 +344,10 @@ l3_1tr6_rel(struct PStack *st, byte pr, void *arg)
st->pa->cause = 0;
st->pa->loc = 0;
}
- } else
+ } else
st->pa->cause = -1;
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
StopAllL3Timer(st);
newl3state(st, 0);
l3_1TR6_message(st, MT_N1_REL_ACK, PROTO_DIS_N1);
@@ -331,11 +355,12 @@ l3_1tr6_rel(struct PStack *st, byte pr, void *arg)
}
static void
-l3_1tr6_rel_ack(struct PStack *st, byte pr, void *arg)
+l3_1tr6_rel_ack(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
StopAllL3Timer(st);
newl3state(st, 0);
st->pa->cause = -1;
@@ -343,17 +368,16 @@ l3_1tr6_rel_ack(struct PStack *st, byte pr, void *arg)
}
static void
-l3_1tr6_disc(struct PStack *st, byte pr, void *arg)
+l3_1tr6_disc(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *ibh = arg;
- byte *p;
+ struct sk_buff *skb = arg;
+ u_char *p;
int i, tmpcharge = 0;
char a_charge[8], tmp[32];
StopAllL3Timer(st);
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.ihsize, ibh->datasize - st->l2.ihsize,
- WE6_chargingInfo, 6))) {
+ p = skb->data;
+ if ((p = findie(p, skb->len, WE6_chargingInfo, 6))) {
iecpy(a_charge, p, 1);
for (i = 0; i < strlen(a_charge); i++) {
tmpcharge *= 10;
@@ -371,9 +395,8 @@ l3_1tr6_disc(struct PStack *st, byte pr, void *arg)
l3_debug(st, "charging info not found");
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.ihsize, ibh->datasize - st->l2.ihsize,
- WE0_cause, 0))) {
+ p = skb->data;
+ if ((p = findie(p, skb->len, WE0_cause, 0))) {
if (p[1] > 0) {
st->pa->cause = p[2];
if (p[1] > 1)
@@ -389,18 +412,20 @@ l3_1tr6_disc(struct PStack *st, byte pr, void *arg)
l3_debug(st, "cause not found");
st->pa->cause = -1;
}
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
newl3state(st, 12);
st->l3.l3l4(st, CC_DISCONNECT_IND, NULL);
}
static void
-l3_1tr6_connect_ack(struct PStack *st, byte pr, void *arg)
+l3_1tr6_connect_ack(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
newl3state(st, 10);
st->pa->chargeinfo = 0;
L3DelTimer(&st->l3.timer);
@@ -408,23 +433,20 @@ l3_1tr6_connect_ack(struct PStack *st, byte pr, void *arg)
}
static void
-l3_1tr6_alert_req(struct PStack *st, byte pr,
- void *arg)
+l3_1tr6_alert_req(struct PStack *st, u_char pr, void *arg)
{
newl3state(st, 7);
l3_1TR6_message(st, MT_N1_ALERT, PROTO_DIS_N1);
}
static void
-l3_1tr6_setup_rsp(struct PStack *st, byte pr,
- void *arg)
+l3_1tr6_setup_rsp(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *dibh;
- byte *p;
+ struct sk_buff *skb;
+ u_char tmp[24];
+ u_char *p = tmp;
+ int l;
- BufPoolGet(&dibh, st->l1.sbufpool, GFP_ATOMIC, (void *) st, 20);
- p = DATAPTR(dibh);
- p += st->l2.ihsize;
MsgHead(p, st->l3.callref, MT_N1_CONN, PROTO_DIS_N1);
if (st->pa->spv) { /* SPV ? */
/* NSF SPV */
@@ -442,54 +464,59 @@ l3_1tr6_setup_rsp(struct PStack *st, byte pr,
*p++ = st->pa->setup.si2;
}
newl3state(st, 8);
- dibh->datasize = p - DATAPTR(dibh);
- st->l3.l3l2(st, DL_DATA, dibh);
+ l = p - tmp;
+ if (!(skb = l3_alloc_skb(l)))
+ return;
+ memcpy(skb_put(skb, l), tmp, l);
+ st->l3.l3l2(st, DL_DATA, skb);
L3DelTimer(&st->l3.timer);
L3AddTimer(&st->l3.timer, st->l3.t313, CC_T313);
}
static void
-l3_1tr6_reset(struct PStack *st, byte pr, void *arg)
+l3_1tr6_reset(struct PStack *st, u_char pr, void *arg)
{
newl3state(st, 0);
}
static void
-l3_1tr6_disconnect_req(struct PStack *st, byte pr, void *arg)
+l3_1tr6_disconnect_req(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *dibh;
- byte *p;
- byte cause = 0x10;
- byte clen = 1;
+ struct sk_buff *skb;
+ u_char tmp[16];
+ u_char *p = tmp;
+ int l;
+ u_char cause = 0x10;
+ u_char clen = 1;
if (st->pa->cause > 0)
cause = st->pa->cause;
/* Map DSS1 causes */
switch (cause & 0x7f) {
- case 0x10:
- clen = 0;
- break;
- case 0x15:
- cause = CAUSE_CallRejected;
- break;
+ case 0x10:
+ clen = 0;
+ break;
+ case 0x15:
+ cause = CAUSE_CallRejected;
+ break;
}
StopAllL3Timer(st);
- BufPoolGet(&dibh, st->l1.sbufpool, GFP_ATOMIC, (void *) st, 21);
- p = DATAPTR(dibh);
- p += st->l2.ihsize;
MsgHead(p, st->l3.callref, MT_N1_DISC, PROTO_DIS_N1);
*p++ = WE0_cause;
*p++ = clen; /* Laenge */
if (clen)
*p++ = cause | 0x80;
- dibh->datasize = p - DATAPTR(dibh);
newl3state(st, 11);
- st->l3.l3l2(st, DL_DATA, dibh);
+ l = p - tmp;
+ if (!(skb = l3_alloc_skb(l)))
+ return;
+ memcpy(skb_put(skb, l), tmp, l);
+ st->l3.l3l2(st, DL_DATA, skb);
L3AddTimer(&st->l3.timer, st->l3.t305, CC_T305);
}
static void
-l3_1tr6_release_req(struct PStack *st, byte pr, void *arg)
+l3_1tr6_release_req(struct PStack *st, u_char pr, void *arg)
{
StopAllL3Timer(st);
newl3state(st, 19);
@@ -498,7 +525,7 @@ l3_1tr6_release_req(struct PStack *st, byte pr, void *arg)
}
static void
-l3_1tr6_t303(struct PStack *st, byte pr, void *arg)
+l3_1tr6_t303(struct PStack *st, u_char pr, void *arg)
{
if (st->l3.n_t303 > 0) {
st->l3.n_t303--;
@@ -513,7 +540,7 @@ l3_1tr6_t303(struct PStack *st, byte pr, void *arg)
}
static void
-l3_1tr6_t304(struct PStack *st, byte pr, void *arg)
+l3_1tr6_t304(struct PStack *st, u_char pr, void *arg)
{
L3DelTimer(&st->l3.timer);
st->pa->cause = 0xE6;
@@ -523,41 +550,43 @@ l3_1tr6_t304(struct PStack *st, byte pr, void *arg)
}
static void
-l3_1tr6_t305(struct PStack *st, byte pr, void *arg)
+l3_1tr6_t305(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *dibh;
- byte *p;
- byte cause = 0x90;
- byte clen = 1;
+ struct sk_buff *skb;
+ u_char tmp[16];
+ u_char *p = tmp;
+ int l;
+ u_char cause = 0x90;
+ u_char clen = 1;
L3DelTimer(&st->l3.timer);
if (st->pa->cause > 0)
cause = st->pa->cause;
/* Map DSS1 causes */
switch (cause & 0x7f) {
- case 0x10:
- clen = 0;
- break;
- case 0x15:
- cause = CAUSE_CallRejected;
- break;
+ case 0x10:
+ clen = 0;
+ break;
+ case 0x15:
+ cause = CAUSE_CallRejected;
+ break;
}
- BufPoolGet(&dibh, st->l1.sbufpool, GFP_ATOMIC, (void *) st, 20);
- p = DATAPTR(dibh);
- p += st->l2.ihsize;
MsgHead(p, st->l3.callref, MT_N1_REL, PROTO_DIS_N1);
*p++ = WE0_cause;
*p++ = clen; /* Laenge */
if (clen)
*p++ = cause;
- dibh->datasize = p - DATAPTR(dibh);
newl3state(st, 19);
- st->l3.l3l2(st, DL_DATA, dibh);
+ l = p - tmp;
+ if (!(skb = l3_alloc_skb(l)))
+ return;
+ memcpy(skb_put(skb, l), tmp, l);
+ st->l3.l3l2(st, DL_DATA, skb);
L3AddTimer(&st->l3.timer, st->l3.t308, CC_T308_1);
}
static void
-l3_1tr6_t310(struct PStack *st, byte pr, void *arg)
+l3_1tr6_t310(struct PStack *st, u_char pr, void *arg)
{
L3DelTimer(&st->l3.timer);
st->pa->cause = 0xE6;
@@ -566,7 +595,7 @@ l3_1tr6_t310(struct PStack *st, byte pr, void *arg)
}
static void
-l3_1tr6_t313(struct PStack *st, byte pr, void *arg)
+l3_1tr6_t313(struct PStack *st, u_char pr, void *arg)
{
L3DelTimer(&st->l3.timer);
st->pa->cause = 0xE6;
@@ -575,7 +604,7 @@ l3_1tr6_t313(struct PStack *st, byte pr, void *arg)
}
static void
-l3_1tr6_t308_1(struct PStack *st, byte pr, void *arg)
+l3_1tr6_t308_1(struct PStack *st, u_char pr, void *arg)
{
L3DelTimer(&st->l3.timer);
l3_1TR6_message(st, MT_N1_REL, PROTO_DIS_N1);
@@ -584,13 +613,13 @@ l3_1tr6_t308_1(struct PStack *st, byte pr, void *arg)
}
static void
-l3_1tr6_t308_2(struct PStack *st, byte pr, void *arg)
+l3_1tr6_t308_2(struct PStack *st, u_char pr, void *arg)
{
L3DelTimer(&st->l3.timer);
st->l3.l3l4(st, CC_RELEASE_ERR, NULL);
newl3state(st, 0);
}
-
+/* *INDENT-OFF* */
static struct stateentry downstl[] =
{
{SBIT(0),
@@ -637,8 +666,8 @@ static struct stateentry datastln1[] =
MT_N1_SETUP_ACK, l3_1tr6_setup_ack},
{SBIT(1) | SBIT(2),
MT_N1_CALL_SENT, l3_1tr6_call_sent},
- {SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) | SBIT(10),
- MT_N1_DISC, l3_1tr6_disc},
+ {SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) | SBIT(10),
+ MT_N1_DISC, l3_1tr6_disc},
{SBIT(2) | SBIT(3) | SBIT(4),
MT_N1_ALERT, l3_1tr6_alert},
{SBIT(2) | SBIT(3) | SBIT(4),
@@ -649,70 +678,55 @@ static struct stateentry datastln1[] =
MT_N1_CONN_ACK, l3_1tr6_connect_ack},
{SBIT(10),
MT_N1_INFO, l3_1tr6_info},
- {SBIT(0) | SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) |
- SBIT(10) | SBIT(11) | SBIT(12) | SBIT(15) | SBIT(17) | SBIT(19),
- MT_N1_REL, l3_1tr6_rel},
+ {SBIT(0) | SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) |
+ SBIT(10) | SBIT(11) | SBIT(12) | SBIT(15) | SBIT(17) | SBIT(19),
+ MT_N1_REL, l3_1tr6_rel},
{SBIT(19),
MT_N1_REL_ACK, l3_1tr6_rel_ack}
};
+/* *INDENT-ON* */
+
static int datastln1_len = sizeof(datastln1) /
sizeof(struct stateentry);
static void
-up1tr6(struct PStack *st,
- int pr, void *arg)
+up1tr6(struct PStack *st, int pr, void *arg)
{
- int i, mt, size;
- byte *ptr;
- struct BufHeader *ibh = arg;
+ int i, mt;
+ struct sk_buff *skb = arg;
char tmp[80];
- if (pr == DL_DATA) {
- ptr = DATAPTR(ibh);
- ptr += st->l2.ihsize;
- size = ibh->datasize - st->l2.ihsize;
- } else if (pr == DL_UNIT_DATA) {
- ptr = DATAPTR(ibh);
- ptr += st->l2.uihsize;
- size = ibh->datasize - st->l2.uihsize;
- } else {
- if (st->l3.debug & L3_DEB_WARN) {
- sprintf(tmp, "up1tr6 unknown data typ %d state %d",
- pr, st->l3.state);
- l3_debug(st, tmp);
- }
- BufPoolRelease(ibh);
- return;
- }
- if ((ptr[0] & 0xfe) != PROTO_DIS_N0) {
+ if ((skb->data[0] & 0xfe) != PROTO_DIS_N0) {
if (st->l3.debug & L3_DEB_PROTERR) {
- sprintf(tmp, "up1tr6%sunexpected discriminator %x message len %d state %d",
+ sprintf(tmp, "up1tr6%sunexpected discriminator %x message len %ld state %d",
(pr == DL_DATA) ? " " : "(broadcast) ",
- ptr[0], size, st->l3.state);
+ skb->data[0], skb->len, st->l3.state);
l3_debug(st, tmp);
}
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
return;
}
- mt = ptr[3];
-
- if (ptr[0] == PROTO_DIS_N0) {
- BufPoolRelease(ibh);
+ mt = skb->data[skb->data[1] + 2];
+ if (skb->data[0] == PROTO_DIS_N0) {
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
if (st->l3.debug & L3_DEB_STATE) {
sprintf(tmp, "up1tr6%s N0 state %d mt %x unhandled",
(pr == DL_DATA) ? " " : "(broadcast) ",
st->l3.state, mt);
l3_debug(st, tmp);
}
- } else if (ptr[0] == PROTO_DIS_N1) {
+ } else if (skb->data[0] == PROTO_DIS_N1) {
for (i = 0; i < datastln1_len; i++)
if ((mt == datastln1[i].primitive) &&
((1 << st->l3.state) & datastln1[i].state))
break;
if (i == datastln1_len) {
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
if (st->l3.debug & L3_DEB_STATE) {
sprintf(tmp, "up1tr6%sstate %d mt %x unhandled",
(pr == DL_DATA) ? " " : "(broadcast) ",
@@ -727,17 +741,15 @@ up1tr6(struct PStack *st,
st->l3.state, mt);
l3_debug(st, tmp);
}
- datastln1[i].rout(st, pr, ibh);
+ datastln1[i].rout(st, pr, skb);
}
}
}
static void
-down1tr6(struct PStack *st,
- int pr, void *arg)
+down1tr6(struct PStack *st, int pr, void *arg)
{
int i;
- struct BufHeader *ibh = arg;
char tmp[80];
for (i = 0; i < downstl_len; i++)
@@ -756,7 +768,7 @@ down1tr6(struct PStack *st,
st->l3.state, pr);
l3_debug(st, tmp);
}
- downstl[i].rout(st, pr, ibh);
+ downstl[i].rout(st, pr, arg);
}
}
diff --git a/drivers/isdn/hisax/l3dss1.c b/drivers/isdn/hisax/l3dss1.c
index 89078482d..60493560f 100644
--- a/drivers/isdn/hisax/l3dss1.c
+++ b/drivers/isdn/hisax/l3dss1.c
@@ -1,4 +1,4 @@
-/* $Id: l3dss1.c,v 1.12 1997/02/17 00:34:26 keil Exp $
+/* $Id: l3dss1.c,v 1.15 1997/04/17 11:50:48 keil Exp $
* EURO/DSS1 D-channel protocol
*
@@ -9,6 +9,15 @@
* Fritz Elfert
*
* $Log: l3dss1.c,v $
+ * Revision 1.15 1997/04/17 11:50:48 keil
+ * pa->loc was undefined, if it was not send by the exchange
+ *
+ * Revision 1.14 1997/04/06 22:54:20 keil
+ * Using SKB's
+ *
+ * Revision 1.13 1997/03/13 20:37:28 keil
+ * CLIR and channel request added
+ *
* Revision 1.12 1997/02/17 00:34:26 keil
* Bugfix: Wrong cause delivered
*
@@ -52,9 +61,10 @@
#define __NO_VERSION__
#include "hisax.h"
#include "isdnl3.h"
+#include <linux/ctype.h>
extern char *HiSax_getrev(const char *revision);
-const char *dss1_revision = "$Revision: 1.12 $";
+const char *dss1_revision = "$Revision: 1.15 $";
#define MsgHead(ptr, cref, mty) \
*ptr++ = 0x8; \
@@ -63,23 +73,20 @@ const char *dss1_revision = "$Revision: 1.12 $";
*ptr++ = mty
static void
-l3dss1_message(struct PStack *st, byte mt)
+l3dss1_message(struct PStack *st, u_char mt)
{
- struct BufHeader *dibh;
- byte *p;
-
- BufPoolGet(&dibh, st->l1.sbufpool, GFP_ATOMIC, (void *) st, 18);
- p = DATAPTR(dibh);
- p += st->l2.ihsize;
+ struct sk_buff *skb;
+ u_char *p;
+ if (!(skb = l3_alloc_skb(4)))
+ return;
+ p = skb_put(skb, 4);
MsgHead(p, st->l3.callref, mt);
-
- dibh->datasize = p - DATAPTR(dibh);
- st->l3.l3l2(st, DL_DATA, dibh);
+ st->l3.l3l2(st, DL_DATA, skb);
}
static void
-l3dss1_release_req(struct PStack *st, byte pr, void *arg)
+l3dss1_release_req(struct PStack *st, u_char pr, void *arg)
{
StopAllL3Timer(st);
newl3state(st, 19);
@@ -88,21 +95,22 @@ l3dss1_release_req(struct PStack *st, byte pr, void *arg)
}
static void
-l3dss1_release_cmpl(struct PStack *st, byte pr, void *arg)
+l3dss1_release_cmpl(struct PStack *st, u_char pr, void *arg)
{
- byte *p;
- struct BufHeader *ibh = arg;
+ u_char *p;
+ struct sk_buff *skb = arg;
int cause = -1;
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.ihsize, ibh->datasize - st->l2.ihsize,
- IE_CAUSE, 0))) {
+ p = skb->data;
+ st->pa->loc = 0;
+ if ((p = findie(p, skb->len, IE_CAUSE, 0))) {
p++;
- if (*p++ == 2)
+ if (*p++ == 2)
st->pa->loc = *p++;
cause = *p & 0x7f;
}
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
StopAllL3Timer(st);
st->pa->cause = cause;
newl3state(st, 0);
@@ -110,179 +118,217 @@ l3dss1_release_cmpl(struct PStack *st, byte pr, void *arg)
}
static void
-l3dss1_setup_req(struct PStack *st, byte pr,
+l3dss1_setup_req(struct PStack *st, u_char pr,
void *arg)
{
- struct BufHeader *dibh;
- byte *p;
- char *teln;
+ struct sk_buff *skb;
+ u_char tmp[128];
+ u_char *p = tmp;
+ u_char channel = 0;
+ u_char screen = 0;
+ u_char *teln;
+ u_char *msn;
+ int l;
st->l3.callref = st->pa->callref;
- BufPoolGet(&dibh, st->l1.sbufpool, GFP_ATOMIC, (void *) st, 19);
- p = DATAPTR(dibh);
- p += st->l2.ihsize;
-
MsgHead(p, st->l3.callref, MT_SETUP);
/*
* Set Bearer Capability, Map info from 1TR6-convention to EDSS1
*/
- *p++ = 0xa1;
+ *p++ = 0xa1; /* complete indicator */
switch (st->pa->setup.si1) {
- case 1: /* Telephony */
- *p++ = 0x4; /* BC-IE-code */
- *p++ = 0x3; /* Length */
- *p++ = 0x90; /* Coding Std. CCITT, 3.1 kHz audio */
- *p++ = 0x90; /* Circuit-Mode 64kbps */
- *p++ = 0xa3; /* A-Law Audio */
- break;
- case 5: /* Datatransmission 64k, BTX */
- case 7: /* Datatransmission 64k */
- default:
- *p++ = 0x4; /* BC-IE-code */
- *p++ = 0x2; /* Length */
- *p++ = 0x88; /* Coding Std. CCITT, unrestr. dig. Inform. */
- *p++ = 0x90; /* Circuit-Mode 64kbps */
- break;
+ case 1: /* Telephony */
+ *p++ = 0x4; /* BC-IE-code */
+ *p++ = 0x3; /* Length */
+ *p++ = 0x90; /* Coding Std. CCITT, 3.1 kHz audio */
+ *p++ = 0x90; /* Circuit-Mode 64kbps */
+ *p++ = 0xa3; /* A-Law Audio */
+ break;
+ case 5: /* Datatransmission 64k, BTX */
+ case 7: /* Datatransmission 64k */
+ default:
+ *p++ = 0x4; /* BC-IE-code */
+ *p++ = 0x2; /* Length */
+ *p++ = 0x88; /* Coding Std. CCITT, unrestr. dig. Inform. */
+ *p++ = 0x90; /* Circuit-Mode 64kbps */
+ break;
}
/*
* What about info2? Mapping to High-Layer-Compatibility?
*/
- if (st->pa->setup.eazmsn[0]) {
+ teln = st->pa->setup.phone;
+ if (*teln) {
+ /* parse number for special things */
+ if (!isdigit(*teln)) {
+ switch (0x5f & *teln) {
+ case 'C':
+ channel = 0x08;
+ case 'P':
+ channel |= 0x80;
+ teln++;
+ if (*teln == '1')
+ channel |= 0x01;
+ else
+ channel |= 0x02;
+ break;
+ case 'R':
+ screen = 0xA0;
+ break;
+ case 'D':
+ screen = 0x80;
+ break;
+ default:
+ if (st->l3.debug & L3_DEB_WARN)
+ l3_debug(st, "Wrong MSN Code");
+ break;
+ }
+ teln++;
+ }
+ }
+ if (channel) {
+ *p++ = 0x18; /* channel indicator */
+ *p++ = 1;
+ *p++ = channel;
+ }
+ msn = st->pa->setup.eazmsn;
+ if (*msn) {
*p++ = 0x6c;
- *p++ = strlen(st->pa->setup.eazmsn) + 1;
+ *p++ = strlen(msn) + (screen ? 2 : 1);
/* Classify as AnyPref. */
- *p++ = 0x81; /* Ext = '1'B, Type = '000'B, Plan = '0001'B. */
- teln = st->pa->setup.eazmsn;
- while (*teln)
- *p++ = *teln++ & 0x7f;
+ if (screen) {
+ *p++ = 0x01; /* Ext = '0'B, Type = '000'B, Plan = '0001'B. */
+ *p++ = screen;
+ } else
+ *p++ = 0x81; /* Ext = '1'B, Type = '000'B, Plan = '0001'B. */
+ while (*msn)
+ *p++ = *msn++ & 0x7f;
}
*p++ = 0x70;
- *p++ = strlen(st->pa->setup.phone) + 1;
+ *p++ = strlen(teln) + 1;
/* Classify as AnyPref. */
*p++ = 0x81; /* Ext = '1'B, Type = '000'B, Plan = '0001'B. */
- teln = st->pa->setup.phone;
while (*teln)
*p++ = *teln++ & 0x7f;
-
- dibh->datasize = p - DATAPTR(dibh);
+ l = p - tmp;
+ if (!(skb = l3_alloc_skb(l)))
+ return;
+ memcpy(skb_put(skb, l), tmp, l);
L3DelTimer(&st->l3.timer);
L3AddTimer(&st->l3.timer, st->l3.t303, CC_T303);
newl3state(st, 1);
- st->l3.l3l2(st, DL_DATA, dibh);
+ st->l3.l3l2(st, DL_DATA, skb);
}
static void
-l3dss1_call_proc(struct PStack *st, byte pr, void *arg)
+l3dss1_call_proc(struct PStack *st, u_char pr, void *arg)
{
- byte *p;
- struct BufHeader *ibh = arg;
+ u_char *p;
+ struct sk_buff *skb = arg;
L3DelTimer(&st->l3.timer);
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.ihsize, ibh->datasize - st->l2.ihsize,
- 0x18, 0))) {
+ p = skb->data;
+ if ((p = findie(p, skb->len, 0x18, 0))) {
st->pa->bchannel = p[2] & 0x3;
if ((!st->pa->bchannel) && (st->l3.debug & L3_DEB_WARN))
l3_debug(st, "setup answer without bchannel");
} else if (st->l3.debug & L3_DEB_WARN)
l3_debug(st, "setup answer without bchannel");
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
newl3state(st, 3);
L3AddTimer(&st->l3.timer, st->l3.t310, CC_T310);
st->l3.l3l4(st, CC_PROCEEDING_IND, NULL);
}
static void
-l3dss1_setup_ack(struct PStack *st, byte pr, void *arg)
+l3dss1_setup_ack(struct PStack *st, u_char pr, void *arg)
{
- byte *p;
- struct BufHeader *ibh = arg;
+ u_char *p;
+ struct sk_buff *skb = arg;
L3DelTimer(&st->l3.timer);
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.ihsize, ibh->datasize - st->l2.ihsize,
- 0x18, 0))) {
+ p = skb->data;
+ if ((p = findie(p, skb->len, 0x18, 0))) {
st->pa->bchannel = p[2] & 0x3;
if ((!st->pa->bchannel) && (st->l3.debug & L3_DEB_WARN))
l3_debug(st, "setup answer without bchannel");
} else if (st->l3.debug & L3_DEB_WARN)
l3_debug(st, "setup answer without bchannel");
-
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
newl3state(st, 2);
L3AddTimer(&st->l3.timer, st->l3.t304, CC_T304);
st->l3.l3l4(st, CC_MORE_INFO, NULL);
}
static void
-l3dss1_disconnect(struct PStack *st, byte pr, void *arg)
+l3dss1_disconnect(struct PStack *st, u_char pr, void *arg)
{
- byte *p;
- struct BufHeader *ibh = arg;
+ u_char *p;
+ struct sk_buff *skb = arg;
int cause = -1;
StopAllL3Timer(st);
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.ihsize, ibh->datasize - st->l2.ihsize,
- IE_CAUSE, 0))) {
+ p = skb->data;
+ st->pa->loc = 0;
+ if ((p = findie(p, skb->len, IE_CAUSE, 0))) {
p++;
if (*p++ == 2)
st->pa->loc = *p++;
cause = *p & 0x7f;
}
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
newl3state(st, 12);
st->pa->cause = cause;
st->l3.l3l4(st, CC_DISCONNECT_IND, NULL);
}
-
static void
-l3dss1_connect(struct PStack *st, byte pr, void *arg)
+l3dss1_connect(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *ibh = arg;
-
+ struct sk_buff *skb = arg;
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
L3DelTimer(&st->l3.timer); /* T310 */
newl3state(st, 10);
st->l3.l3l4(st, CC_SETUP_CNF, NULL);
}
static void
-l3dss1_alerting(struct PStack *st, byte pr, void *arg)
+l3dss1_alerting(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
L3DelTimer(&st->l3.timer); /* T304 */
newl3state(st, 4);
st->l3.l3l4(st, CC_ALERTING_IND, NULL);
}
static void
-l3dss1_setup(struct PStack *st, byte pr, void *arg)
+l3dss1_setup(struct PStack *st, u_char pr, void *arg)
{
- byte *p;
+ u_char *p;
int bcfound = 0;
char tmp[80];
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
- p = DATAPTR(ibh);
- p += st->l2.uihsize;
+ p = skb->data;
st->pa->callref = getcallref(p);
st->l3.callref = 0x80 + st->pa->callref;
/*
* Channel Identification
*/
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.uihsize, ibh->datasize - st->l2.uihsize,
- 0x18, 0))) {
+ p = skb->data;
+ if ((p = findie(p, skb->len, 0x18, 0))) {
st->pa->bchannel = p[2] & 0x3;
if (st->pa->bchannel)
bcfound++;
@@ -291,51 +337,49 @@ l3dss1_setup(struct PStack *st, byte pr, void *arg)
} else if (st->l3.debug & L3_DEB_WARN)
l3_debug(st, "setup without bchannel");
- p = DATAPTR(ibh);
/*
* Bearer Capabilities
*/
- if ((p = findie(p + st->l2.uihsize, ibh->datasize - st->l2.uihsize, 0x04, 0))) {
+ p = skb->data;
+ if ((p = findie(p, skb->len, 0x04, 0))) {
st->pa->setup.si2 = 0;
switch (p[2] & 0x1f) {
- case 0x00:
- /* Speech */
- case 0x10:
- /* 3.1 Khz audio */
- st->pa->setup.si1 = 1;
- break;
- case 0x08:
- /* Unrestricted digital information */
- st->pa->setup.si1 = 7;
- break;
- case 0x09:
- /* Restricted digital information */
- st->pa->setup.si1 = 2;
- break;
- case 0x11:
- /* Unrestr. digital information with tones/announcements */
- st->pa->setup.si1 = 3;
- break;
- case 0x18:
- /* Video */
- st->pa->setup.si1 = 4;
- break;
- default:
- st->pa->setup.si1 = 0;
+ case 0x00:
+ /* Speech */
+ case 0x10:
+ /* 3.1 Khz audio */
+ st->pa->setup.si1 = 1;
+ break;
+ case 0x08:
+ /* Unrestricted digital information */
+ st->pa->setup.si1 = 7;
+ break;
+ case 0x09:
+ /* Restricted digital information */
+ st->pa->setup.si1 = 2;
+ break;
+ case 0x11:
+ /* Unrestr. digital information with tones/announcements */
+ st->pa->setup.si1 = 3;
+ break;
+ case 0x18:
+ /* Video */
+ st->pa->setup.si1 = 4;
+ break;
+ default:
+ st->pa->setup.si1 = 0;
}
} else if (st->l3.debug & L3_DEB_WARN)
l3_debug(st, "setup without bearer capabilities");
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.uihsize, ibh->datasize - st->l2.uihsize,
- 0x70, 0)))
+ p = skb->data;
+ if ((p = findie(p, skb->len, 0x70, 0)))
iecpy(st->pa->setup.eazmsn, p, 1);
else
st->pa->setup.eazmsn[0] = 0;
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.uihsize, ibh->datasize - st->l2.uihsize,
- 0x6c, 0))) {
+ p = skb->data;
+ if ((p = findie(p, skb->len, 0x6c, 0))) {
st->pa->setup.plan = p[2];
if (p[2] & 0x80) {
iecpy(st->pa->setup.phone, p, 1);
@@ -349,7 +393,8 @@ l3dss1_setup(struct PStack *st, byte pr, void *arg)
st->pa->setup.plan = 0;
st->pa->setup.screen = 0;
}
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
if (bcfound) {
if ((st->pa->setup.si1 != 7) && (st->l3.debug & L3_DEB_WARN)) {
@@ -364,14 +409,14 @@ l3dss1_setup(struct PStack *st, byte pr, void *arg)
}
static void
-l3dss1_reset(struct PStack *st, byte pr, void *arg)
+l3dss1_reset(struct PStack *st, u_char pr, void *arg)
{
StopAllL3Timer(st);
newl3state(st, 0);
}
static void
-l3dss1_setup_rsp(struct PStack *st, byte pr,
+l3dss1_setup_rsp(struct PStack *st, u_char pr,
void *arg)
{
newl3state(st, 8);
@@ -381,30 +426,30 @@ l3dss1_setup_rsp(struct PStack *st, byte pr,
}
static void
-l3dss1_connect_ack(struct PStack *st, byte pr, void *arg)
+l3dss1_connect_ack(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *ibh = arg;
+ struct sk_buff *skb = arg;
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
newl3state(st, 10);
L3DelTimer(&st->l3.timer);
st->l3.l3l4(st, CC_SETUP_COMPLETE_IND, NULL);
}
static void
-l3dss1_disconnect_req(struct PStack *st, byte pr, void *arg)
+l3dss1_disconnect_req(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *dibh;
- byte *p;
- byte cause = 0x10;
+ struct sk_buff *skb;
+ u_char tmp[16];
+ u_char *p = tmp;
+ int l;
+ u_char cause = 0x10;
if (st->pa->cause > 0)
cause = st->pa->cause;
StopAllL3Timer(st);
- BufPoolGet(&dibh, st->l1.sbufpool, GFP_ATOMIC, (void *) st, 20);
- p = DATAPTR(dibh);
- p += st->l2.ihsize;
MsgHead(p, st->l3.callref, MT_DISCONNECT);
@@ -413,26 +458,27 @@ l3dss1_disconnect_req(struct PStack *st, byte pr, void *arg)
*p++ = 0x80;
*p++ = cause | 0x80;
- dibh->datasize = p - DATAPTR(dibh);
+ l = p - tmp;
+ if (!(skb = l3_alloc_skb(l)))
+ return;
+ memcpy(skb_put(skb, l), tmp, l);
newl3state(st, 11);
- st->l3.l3l2(st, DL_DATA, dibh);
+ st->l3.l3l2(st, DL_DATA, skb);
L3AddTimer(&st->l3.timer, st->l3.t305, CC_T305);
}
static void
-l3dss1_reject_req(struct PStack *st, byte pr, void *arg)
+l3dss1_reject_req(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *dibh;
- byte *p;
- byte cause = 0x95;
+ struct sk_buff *skb;
+ u_char tmp[16];
+ u_char *p = tmp;
+ int l;
+ u_char cause = 0x95;
if (st->pa->cause > 0)
cause = st->pa->cause;
- BufPoolGet(&dibh, st->l1.sbufpool, GFP_ATOMIC, (void *) st, 20);
- p = DATAPTR(dibh);
- p += st->l2.ihsize;
-
MsgHead(p, st->l3.callref, MT_RELEASE_COMPLETE);
*p++ = IE_CAUSE;
@@ -440,28 +486,31 @@ l3dss1_reject_req(struct PStack *st, byte pr, void *arg)
*p++ = 0x80;
*p++ = cause;
- dibh->datasize = p - DATAPTR(dibh);
+ l = p - tmp;
+ if (!(skb = l3_alloc_skb(l)))
+ return;
+ memcpy(skb_put(skb, l), tmp, l);
newl3state(st, 0);
- st->l3.l3l2(st, DL_DATA, dibh);
+ st->l3.l3l2(st, DL_DATA, skb);
st->l3.l3l4(st, CC_RELEASE_IND, NULL);
}
static void
-l3dss1_release(struct PStack *st, byte pr, void *arg)
+l3dss1_release(struct PStack *st, u_char pr, void *arg)
{
- byte *p;
- struct BufHeader *ibh = arg;
+ u_char *p;
+ struct sk_buff *skb = arg;
int cause = -1;
- p = DATAPTR(ibh);
- if ((p = findie(p + st->l2.ihsize, ibh->datasize - st->l2.ihsize,
- IE_CAUSE, 0))) {
+ p = skb->data;
+ if ((p = findie(p, skb->len, IE_CAUSE, 0))) {
p++;
if (*p++ == 2)
st->pa->loc = *p++;
cause = *p & 0x7f;
}
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
StopAllL3Timer(st);
st->pa->cause = cause;
newl3state(st, 0);
@@ -470,7 +519,7 @@ l3dss1_release(struct PStack *st, byte pr, void *arg)
}
static void
-l3dss1_alert_req(struct PStack *st, byte pr,
+l3dss1_alert_req(struct PStack *st, u_char pr,
void *arg)
{
newl3state(st, 7);
@@ -478,16 +527,15 @@ l3dss1_alert_req(struct PStack *st, byte pr,
}
static void
-l3dss1_status_enq(struct PStack *st, byte pr, void *arg)
+l3dss1_status_enq(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *dibh = arg;
- byte *p;
-
- BufPoolRelease(dibh);
+ u_char tmp[16];
+ u_char *p = tmp;
+ int l;
+ struct sk_buff *skb = arg;
- BufPoolGet(&dibh, st->l1.sbufpool, GFP_ATOMIC, (void *) st, 22);
- p = DATAPTR(dibh);
- p += st->l2.ihsize;
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
MsgHead(p, st->l3.callref, MT_STATUS);
@@ -500,12 +548,15 @@ l3dss1_status_enq(struct PStack *st, byte pr, void *arg)
*p++ = 0x1;
*p++ = st->l3.state & 0x3f;
- dibh->datasize = p - DATAPTR(dibh);
- st->l3.l3l2(st, DL_DATA, dibh);
+ l = p - tmp;
+ if (!(skb = l3_alloc_skb(l)))
+ return;
+ memcpy(skb_put(skb, l), tmp, l);
+ st->l3.l3l2(st, DL_DATA, skb);
}
static void
-l3dss1_t303(struct PStack *st, byte pr, void *arg)
+l3dss1_t303(struct PStack *st, u_char pr, void *arg)
{
if (st->l3.n_t303 > 0) {
st->l3.n_t303--;
@@ -520,7 +571,7 @@ l3dss1_t303(struct PStack *st, byte pr, void *arg)
}
static void
-l3dss1_t304(struct PStack *st, byte pr, void *arg)
+l3dss1_t304(struct PStack *st, u_char pr, void *arg)
{
L3DelTimer(&st->l3.timer);
st->pa->cause = 0xE6;
@@ -530,20 +581,18 @@ l3dss1_t304(struct PStack *st, byte pr, void *arg)
}
static void
-l3dss1_t305(struct PStack *st, byte pr, void *arg)
+l3dss1_t305(struct PStack *st, u_char pr, void *arg)
{
- struct BufHeader *dibh;
- byte *p;
- byte cause = 0x90;
+ u_char tmp[16];
+ u_char *p = tmp;
+ int l;
+ struct sk_buff *skb;
+ u_char cause = 0x90;
L3DelTimer(&st->l3.timer);
if (st->pa->cause > 0)
cause = st->pa->cause;
- BufPoolGet(&dibh, st->l1.sbufpool, GFP_ATOMIC, (void *) st, 20);
- p = DATAPTR(dibh);
- p += st->l2.ihsize;
-
MsgHead(p, st->l3.callref, MT_RELEASE);
*p++ = IE_CAUSE;
@@ -551,14 +600,17 @@ l3dss1_t305(struct PStack *st, byte pr, void *arg)
*p++ = 0x80;
*p++ = cause;
- dibh->datasize = p - DATAPTR(dibh);
+ l = p - tmp;
+ if (!(skb = l3_alloc_skb(l)))
+ return;
+ memcpy(skb_put(skb, l), tmp, l);
newl3state(st, 19);
- st->l3.l3l2(st, DL_DATA, dibh);
+ st->l3.l3l2(st, DL_DATA, skb);
L3AddTimer(&st->l3.timer, st->l3.t308, CC_T308_1);
}
static void
-l3dss1_t310(struct PStack *st, byte pr, void *arg)
+l3dss1_t310(struct PStack *st, u_char pr, void *arg)
{
L3DelTimer(&st->l3.timer);
st->pa->cause = 0xE6;
@@ -567,7 +619,7 @@ l3dss1_t310(struct PStack *st, byte pr, void *arg)
}
static void
-l3dss1_t313(struct PStack *st, byte pr, void *arg)
+l3dss1_t313(struct PStack *st, u_char pr, void *arg)
{
L3DelTimer(&st->l3.timer);
st->pa->cause = 0xE6;
@@ -576,7 +628,7 @@ l3dss1_t313(struct PStack *st, byte pr, void *arg)
}
static void
-l3dss1_t308_1(struct PStack *st, byte pr, void *arg)
+l3dss1_t308_1(struct PStack *st, u_char pr, void *arg)
{
newl3state(st, 19);
L3DelTimer(&st->l3.timer);
@@ -585,13 +637,13 @@ l3dss1_t308_1(struct PStack *st, byte pr, void *arg)
}
static void
-l3dss1_t308_2(struct PStack *st, byte pr, void *arg)
+l3dss1_t308_2(struct PStack *st, u_char pr, void *arg)
{
newl3state(st, 0);
L3DelTimer(&st->l3.timer);
st->l3.l3l4(st, CC_RELEASE_ERR, NULL);
}
-
+/* *INDENT-OFF* */
static struct stateentry downstatelist[] =
{
{SBIT(0),
@@ -647,60 +699,45 @@ static struct stateentry datastatelist[] =
{SBIT(0) | SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) | SBIT(10) |
SBIT(11) | SBIT(12) | SBIT(15) | SBIT(17) | SBIT(19),
MT_RELEASE, l3dss1_release},
- {SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) | SBIT(10),
- MT_DISCONNECT, l3dss1_disconnect},
+ {SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4) | SBIT(7) | SBIT(8) | SBIT(10),
+ MT_DISCONNECT, l3dss1_disconnect},
{SBIT(1) | SBIT(2) | SBIT(3) | SBIT(4),
MT_CONNECT, l3dss1_connect},
{SBIT(8),
MT_CONNECT_ACKNOWLEDGE, l3dss1_connect_ack},
};
+/* *INDENT-ON* */
+
static int datasllen = sizeof(datastatelist) /
sizeof(struct stateentry);
static void
-dss1up(struct PStack *st,
- int pr, void *arg)
+dss1up(struct PStack *st, int pr, void *arg)
{
- int i, mt, size;
- byte *ptr;
- struct BufHeader *ibh = arg;
+ int i, mt;
+ struct sk_buff *skb = arg;
char tmp[80];
- if (pr == DL_DATA) {
- ptr = DATAPTR(ibh);
- ptr += st->l2.ihsize;
- size = ibh->datasize - st->l2.ihsize;
- } else if (pr == DL_UNIT_DATA) {
- ptr = DATAPTR(ibh);
- ptr += st->l2.uihsize;
- size = ibh->datasize - st->l2.uihsize;
- } else {
- if (st->l3.debug & L3_DEB_WARN) {
- sprintf(tmp, "dss1up unknown data typ %d state %d",
- pr, st->l3.state);
- l3_debug(st, tmp);
- }
- BufPoolRelease(ibh);
- return;
- }
- if (ptr[0] != PROTO_DIS_EURO) {
+ if (skb->data[0] != PROTO_DIS_EURO) {
if (st->l3.debug & L3_DEB_PROTERR) {
- sprintf(tmp, "dss1up%sunexpected discriminator %x message len %d state %d",
+ sprintf(tmp, "dss1up%sunexpected discriminator %x message len %ld state %d",
(pr == DL_DATA) ? " " : "(broadcast) ",
- ptr[0], size, st->l3.state);
+ skb->data[0], skb->len, st->l3.state);
l3_debug(st, tmp);
}
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
return;
}
- mt = ptr[3];
+ mt = skb->data[skb->data[1] + 2];
for (i = 0; i < datasllen; i++)
if ((mt == datastatelist[i].primitive) &&
((1 << st->l3.state) & datastatelist[i].state))
break;
if (i == datasllen) {
- BufPoolRelease(ibh);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
if (st->l3.debug & L3_DEB_STATE) {
sprintf(tmp, "dss1up%sstate %d mt %x unhandled",
(pr == DL_DATA) ? " " : "(broadcast) ",
@@ -715,16 +752,14 @@ dss1up(struct PStack *st,
st->l3.state, mt);
l3_debug(st, tmp);
}
- datastatelist[i].rout(st, pr, ibh);
+ datastatelist[i].rout(st, pr, skb);
}
}
static void
-dss1down(struct PStack *st,
- int pr, void *arg)
+dss1down(struct PStack *st, int pr, void *arg)
{
int i;
- struct BufHeader *ibh = arg;
char tmp[80];
for (i = 0; i < downsllen; i++)
@@ -743,7 +778,7 @@ dss1down(struct PStack *st,
st->l3.state, pr);
l3_debug(st, tmp);
}
- downstatelist[i].rout(st, pr, ibh);
+ downstatelist[i].rout(st, pr, arg);
}
}
diff --git a/drivers/isdn/hisax/q931.c b/drivers/isdn/hisax/q931.c
index 36573b67f..1e1ee4772 100644
--- a/drivers/isdn/hisax/q931.c
+++ b/drivers/isdn/hisax/q931.c
@@ -1,4 +1,4 @@
-/* $Id: q931.c,v 1.4 1997/02/09 00:29:11 keil Exp $
+/* $Id: q931.c,v 1.5 1997/04/06 22:56:43 keil Exp $
* q931.c code to decode ITU Q.931 call control messages
*
@@ -14,6 +14,9 @@
*
*
* $Log: q931.c,v $
+ * Revision 1.5 1997/04/06 22:56:43 keil
+ * Some cosmetic changes
+ *
* Revision 1.4 1997/02/09 00:29:11 keil
* new interface handling, one interface per card
*
@@ -34,11 +37,11 @@
#include "hisax.h"
#include "l3_1tr6.h"
-byte *
-findie(byte * p, int size, byte ie, int wanted_set)
+u_char *
+findie(u_char * p, int size, u_char ie, int wanted_set)
{
int l, codeset, maincodeset;
- byte *pend = p + size;
+ u_char *pend = p + size;
/* skip protocol discriminator, callref and message type */
p++;
@@ -73,9 +76,9 @@ findie(byte * p, int size, byte ie, int wanted_set)
}
void
-iecpy(byte * dest, byte * iestart, int ieoffset)
+iecpy(u_char * dest, u_char * iestart, int ieoffset)
{
- byte *p;
+ u_char *p;
int l;
p = iestart + ieoffset + 2;
@@ -86,7 +89,7 @@ iecpy(byte * dest, byte * iestart, int ieoffset)
}
int
-getcallref(byte * p)
+getcallref(u_char * p)
{
p++; /* prot discr */
p++; /* callref length */
@@ -98,7 +101,7 @@ getcallref(byte * p)
*/
static
struct MessageType {
- byte nr;
+ u_char nr;
char *descr;
} mtlist[] = {
@@ -265,7 +268,7 @@ int fac_1tr6_len = (sizeof(fac_1tr6) / sizeof(struct MessageType));
static int
-prbits(char *dest, byte b, int start, int len)
+prbits(char *dest, u_char b, int start, int len)
{
char *dp = dest;
@@ -281,8 +284,8 @@ prbits(char *dest, byte b, int start, int len)
}
static
-byte *
-skipext(byte * p)
+u_char *
+skipext(u_char * p)
{
while (!(*p++ & 0x80));
return (p);
@@ -297,7 +300,7 @@ skipext(byte * p)
static
struct CauseValue {
- byte nr;
+ u_char nr;
char *edescr;
char *ddescr;
} cvlist[] = {
@@ -509,9 +512,9 @@ struct CauseValue {
static
int
-prcause(char *dest, byte * p)
+prcause(char *dest, u_char * p)
{
- byte *end;
+ u_char *end;
char *dp = dest;
int i, cause;
@@ -586,7 +589,7 @@ struct MessageType cause_1tr6[] =
int cause_1tr6_len = (sizeof(cause_1tr6) / sizeof(struct MessageType));
static int
-prcause_1tr6(char *dest, byte * p)
+prcause_1tr6(char *dest, u_char * p)
{
char *dp = dest;
int i, cause;
@@ -621,7 +624,7 @@ prcause_1tr6(char *dest, byte * p)
}
static int
-prchident(char *dest, byte * p)
+prchident(char *dest, u_char * p)
{
char *dp = dest;
@@ -633,7 +636,7 @@ prchident(char *dest, byte * p)
}
static int
-prcalled(char *dest, byte * p)
+prcalled(char *dest, u_char * p)
{
int l;
char *dp = dest;
@@ -650,7 +653,7 @@ prcalled(char *dest, byte * p)
return (dp - dest);
}
static int
-prcalling(char *dest, byte * p)
+prcalling(char *dest, u_char * p)
{
int l;
char *dp = dest;
@@ -677,7 +680,7 @@ prcalling(char *dest, byte * p)
static
int
-prbearer(char *dest, byte * p)
+prbearer(char *dest, u_char * p)
{
char *dp = dest, ch;
@@ -723,7 +726,7 @@ prbearer(char *dest, byte * p)
}
static int
-general(char *dest, byte * p)
+general(char *dest, u_char * p)
{
char *dp = dest;
char ch = ' ';
@@ -750,7 +753,7 @@ general(char *dest, byte * p)
}
static int
-prcharge(char *dest, byte * p)
+prcharge(char *dest, u_char * p)
{
char *dp = dest;
int l;
@@ -767,7 +770,7 @@ prcharge(char *dest, byte * p)
return (dp - dest);
}
static int
-prtext(char *dest, byte * p)
+prtext(char *dest, u_char * p)
{
char *dp = dest;
int l;
@@ -782,7 +785,7 @@ prtext(char *dest, byte * p)
return (dp - dest);
}
static int
-display(char *dest, byte * p)
+display(char *dest, u_char * p)
{
char *dp = dest;
char ch = ' ';
@@ -811,7 +814,7 @@ display(char *dest, byte * p)
}
int
-prfacility(char *dest, byte * p)
+prfacility(char *dest, u_char * p)
{
char *dp = dest;
int l, l2;
@@ -842,9 +845,9 @@ prfacility(char *dest, byte * p)
static
struct InformationElement {
- byte nr;
+ u_char nr;
char *descr;
- int (*f) (char *, byte *);
+ int (*f) (char *, u_char *);
} ielist[] = {
{
@@ -980,11 +983,11 @@ static struct InformationElement we_6[] =
static int we_6_len = (sizeof(we_6) / sizeof(struct InformationElement));
int
-QuickHex(char *txt, byte * p, int cnt)
+QuickHex(char *txt, u_char * p, int cnt)
{
register int i;
register char *t = txt;
- register byte w;
+ register u_char w;
for (i = 0; i < cnt; i++) {
*t++ = ' ';
@@ -1004,7 +1007,7 @@ QuickHex(char *txt, byte * p, int cnt)
}
void
-LogFrame(struct IsdnCardState *sp, byte * buf, int size)
+LogFrame(struct IsdnCardState *sp, u_char * buf, int size)
{
char *dp;
@@ -1024,9 +1027,9 @@ LogFrame(struct IsdnCardState *sp, byte * buf, int size)
}
void
-dlogframe(struct IsdnCardState *sp, byte * buf, int size, char *comment)
+dlogframe(struct IsdnCardState *sp, u_char * buf, int size, char *comment)
{
- byte *bend = buf + size;
+ u_char *bend = buf + size;
char *dp;
unsigned char pd, cr_l, cr, mt;
int i, cs = 0, cs_old = 0, cs_fest = 0;
diff --git a/drivers/isdn/hisax/tei.c b/drivers/isdn/hisax/tei.c
index 35ab18862..f8a149234 100644
--- a/drivers/isdn/hisax/tei.c
+++ b/drivers/isdn/hisax/tei.c
@@ -1,4 +1,4 @@
-/* $Id: tei.c,v 1.6 1997/02/09 00:25:12 keil Exp $
+/* $Id: tei.c,v 1.8 1997/04/07 22:59:08 keil Exp $
* Author Karsten Keil (keil@temic-ech.spacenet.de)
* based on the teles driver from Jan den Ouden
@@ -7,6 +7,12 @@
* Fritz Elfert
*
* $Log: tei.c,v $
+ * Revision 1.8 1997/04/07 22:59:08 keil
+ * GFP_KERNEL --> GFP_ATOMIC
+ *
+ * Revision 1.7 1997/04/06 22:54:03 keil
+ * Using SKB's
+ *
* Revision 1.6 1997/02/09 00:25:12 keil
* new interface handling, one interface per card
*
@@ -34,7 +40,7 @@
extern struct IsdnCard cards[];
extern int nrcards;
-const char *tei_revision = "$Revision: 1.6 $";
+const char *tei_revision = "$Revision: 1.8 $";
static struct PStack *
findces(struct PStack *st, int ces)
@@ -66,26 +72,27 @@ findtei(struct PStack *st, int tei)
}
static void
-mdl_unit_data_res(struct PStack *st, unsigned int ri, byte mt, byte ai)
+mdl_unit_data_res(struct PStack *st, unsigned int ri, u_char mt, u_char ai)
{
- struct BufHeader *ibh;
- byte *bp;
+ struct sk_buff *skb;
+ u_char *bp;
- if (BufPoolGet(&ibh, st->l1.smallpool, GFP_ATOMIC, (void *) st, 7))
+ if (!(skb = alloc_skb(6 + MAX_HEADER_LEN, GFP_ATOMIC))) {
+ printk(KERN_WARNING "HiSax: No skb for TEI manager\n");
return;
- bp = DATAPTR(ibh);
- bp += 3;
+ }
+ skb_reserve(skb, MAX_HEADER_LEN);
+ bp = skb_put(skb, 5);
bp[0] = 0xf;
bp[1] = ri >> 8;
bp[2] = ri & 0xff;
bp[3] = mt;
bp[4] = (ai << 1) | 1;
- ibh->datasize = 8;
- st->l3.l3l2(st, DL_UNIT_DATA, ibh);
+ st->l3.l3l2(st, DL_UNIT_DATA, skb);
}
static void
-mdl_unit_data_ind(struct PStack *st, unsigned int ri, byte mt, byte ai)
+mdl_unit_data_ind(struct PStack *st, unsigned int ri, u_char mt, u_char ai)
{
unsigned int tces;
struct PStack *otsp, *ptr;
@@ -194,15 +201,15 @@ mdl_unit_data_ind(struct PStack *st, unsigned int ri, byte mt, byte ai)
void
tei_handler(struct PStack *st,
- byte pr, struct BufHeader *ibh)
+ u_char pr, struct sk_buff *skb)
{
- byte *bp;
+ u_char *bp;
unsigned int data;
char tmp[32];
switch (pr) {
case (MDL_ASSIGN):
- data = (unsigned int) ibh;
+ data = (unsigned int) skb;
if (st->l3.debug) {
sprintf(tmp, "ces %d assign request", data);
st->l2.l2m.printdebug(&st->l2.l2m, tmp);
@@ -210,7 +217,7 @@ tei_handler(struct PStack *st,
mdl_unit_data_res(st, data, 1, 127);
break;
case (MDL_VERIFY):
- data = (unsigned int) ibh;
+ data = (unsigned int) skb;
if (st->l3.debug) {
sprintf(tmp, "%d id verify request", data);
st->l2.l2m.printdebug(&st->l2.l2m, tmp);
@@ -218,17 +225,15 @@ tei_handler(struct PStack *st,
mdl_unit_data_res(st, 0, 7, data);
break;
case (DL_UNIT_DATA):
- bp = DATAPTR(ibh);
- bp += 3;
+ bp = skb->data;
if (bp[0] != 0xf) {
/* wrong management entity identifier, ignore */
/* shouldn't ibh be released??? */
printk(KERN_WARNING "tei handler wrong entity id %x\n", bp[0]);
- BufPoolRelease(ibh);
- break;
- }
- mdl_unit_data_ind(st, (bp[1] << 8) | bp[2], bp[3], bp[4] >> 1);
- BufPoolRelease(ibh);
+ } else
+ mdl_unit_data_ind(st, (bp[1] << 8) | bp[2], bp[3], bp[4] >> 1);
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_READ);
break;
default:
break;
@@ -270,8 +275,7 @@ init_tei(struct IsdnCardState *sp, int protocol)
struct PStack *st;
char tmp[128];
- st = (struct PStack *) Smalloc(sizeof(struct PStack), GFP_KERNEL,
- "struct PStack");
+ st = (struct PStack *) kmalloc(sizeof(struct PStack), GFP_ATOMIC);
setstack_HiSax(st, sp);
st->l2.extended = !0;
st->l2.laptype = LAPD;
@@ -281,7 +285,6 @@ init_tei(struct IsdnCardState *sp, int protocol)
/*
* the following is not necessary for tei mng. (broadcast only)
*/
-
st->l2.t200 = 500; /* 500 milliseconds */
st->l2.n200 = 4; /* try 4 times */
@@ -310,5 +313,5 @@ release_tei(struct IsdnCardState *sp)
struct PStack *st = sp->teistack;
HiSax_rmlist(sp, st);
- Sfree((void *) st);
+ kfree((void *) st);
}
diff --git a/drivers/isdn/hisax/teles0.c b/drivers/isdn/hisax/teles0.c
index 3e2fa77bb..0c21e5228 100644
--- a/drivers/isdn/hisax/teles0.c
+++ b/drivers/isdn/hisax/teles0.c
@@ -1,4 +1,4 @@
-/* $Id: teles0.c,v 1.6 1997/01/27 15:52:18 keil Exp $
+/* $Id: teles0.c,v 1.8 1997/04/13 19:54:04 keil Exp $
* teles0.c low level stuff for Teles Memory IO isdn cards
* based on the teles driver from Jan den Ouden
@@ -10,6 +10,12 @@
* Beat Doebeli
*
* $Log: teles0.c,v $
+ * Revision 1.8 1997/04/13 19:54:04 keil
+ * Change in IRQ check delay for SMP
+ *
+ * Revision 1.7 1997/04/06 22:54:04 keil
+ * Using SKB's
+ *
* Revision 1.6 1997/01/27 15:52:18 keil
* SMP proof,cosmetics
*
@@ -40,70 +46,70 @@
extern const char *CardType[];
-const char *teles0_revision = "$Revision: 1.6 $";
+const char *teles0_revision = "$Revision: 1.8 $";
#define byteout(addr,val) outb_p(val,addr)
#define bytein(addr) inb_p(addr)
-static inline byte
-readisac(unsigned int adr, byte off)
+static inline u_char
+readisac(unsigned int adr, u_char off)
{
return readb(adr + 0x120 + ((off & 1) ? 0x1ff : 0) + off);
}
static inline void
-writeisac(unsigned int adr, byte off, byte data)
+writeisac(unsigned int adr, u_char off, u_char data)
{
writeb(data, adr + 0x120 + ((off & 1) ? 0x1ff : 0) + off);
}
-static inline byte
-readhscx(unsigned int adr, int hscx, byte off)
+static inline u_char
+readhscx(unsigned int adr, int hscx, u_char off)
{
return readb(adr + (hscx ? 0x1e0 : 0x1a0) +
((off & 1) ? 0x1ff : 0) + off);
}
static inline void
-writehscx(unsigned int adr, int hscx, byte off, byte data)
+writehscx(unsigned int adr, int hscx, u_char off, u_char data)
{
writeb(data, adr + (hscx ? 0x1e0 : 0x1a0) +
((off & 1) ? 0x1ff : 0) + off);
}
static inline void
-read_fifo_isac(unsigned int adr, byte * data, int size)
+read_fifo_isac(unsigned int adr, u_char * data, int size)
{
register int i;
- register byte *ad = (byte *) (adr + 0x100);
+ register u_char *ad = (u_char *) (adr + 0x100);
for (i = 0; i < size; i++)
data[i] = readb(ad);
}
static void
-write_fifo_isac(unsigned int adr, byte * data, int size)
+write_fifo_isac(unsigned int adr, u_char * data, int size)
{
register int i;
- register byte *ad = (byte *) (adr + 0x100);
+ register u_char *ad = (u_char *) (adr + 0x100);
for (i = 0; i < size; i++)
writeb(data[i], ad);
}
static inline void
-read_fifo_hscx(unsigned int adr, int hscx, byte * data, int size)
+read_fifo_hscx(unsigned int adr, int hscx, u_char * data, int size)
{
register int i;
- register byte *ad = (byte *) (adr + (hscx ? 0x1c0 : 0x180));
+ register u_char *ad = (u_char *) (adr + (hscx ? 0x1c0 : 0x180));
for (i = 0; i < size; i++)
data[i] = readb(ad);
}
static inline void
-write_fifo_hscx(unsigned int adr, int hscx, byte * data, int size)
+write_fifo_hscx(unsigned int adr, int hscx, u_char * data, int size)
{
int i;
- register byte *ad = (byte *) (adr + (hscx ? 0x1c0 : 0x180));
+ register u_char *ad = (u_char *) (adr + (hscx ? 0x1c0 : 0x180));
for (i = 0; i < size; i++)
writeb(data[i], ad);
}
@@ -135,7 +141,7 @@ waitforXFW(int adr, int hscx)
}
static inline void
-writehscxCMDR(int adr, int hscx, byte data)
+writehscxCMDR(int adr, int hscx, u_char data)
{
long flags;
@@ -178,25 +184,22 @@ teles0_report(struct IsdnCardState *sp)
static void
hscx_empty_fifo(struct HscxState *hsp, int count)
{
- byte *ptr;
+ u_char *ptr;
struct IsdnCardState *sp = hsp->sp;
- struct BufHeader *ibh = hsp->rcvibh;
long flags;
if ((sp->debug & L1_DEB_HSCX) && !(sp->debug & L1_DEB_HSCX_FIFO))
debugl1(sp, "hscx_empty_fifo");
- if (hsp->rcvptr + count > BUFFER_SIZE(HSCX_RBUF_ORDER,
- HSCX_RBUF_BPPS)) {
+ if (hsp->rcvidx + count > HSCX_BUFMAX) {
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "hscx_empty_fifo: incoming packet too large");
writehscxCMDR(sp->membase, hsp->hscx, 0x80);
+ hsp->rcvidx = 0;
return;
}
- ptr = DATAPTR(ibh);
- ptr += hsp->rcvptr;
-
- hsp->rcvptr += count;
+ ptr = hsp->rcvbuf + hsp->rcvidx;
+ hsp->rcvidx += count;
save_flags(flags);
cli();
read_fifo_hscx(sp->membase, hsp->hscx, ptr, count);
@@ -217,34 +220,32 @@ static void
hscx_fill_fifo(struct HscxState *hsp)
{
struct IsdnCardState *sp = hsp->sp;
- struct BufHeader *ibh;
int more, count;
- byte *ptr;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_HSCX) && !(sp->debug & L1_DEB_HSCX_FIFO))
debugl1(sp, "hscx_fill_fifo");
- ibh = hsp->xmtibh;
- if (!ibh)
+ if (!hsp->tx_skb)
return;
-
- count = ibh->datasize - hsp->sendptr;
- if (count <= 0)
+ if (hsp->tx_skb->len <= 0)
return;
more = (hsp->mode == 1) ? 1 : 0;
- if (count > 32) {
+ if (hsp->tx_skb->len > 32) {
more = !0;
count = 32;
- }
- ptr = DATAPTR(ibh);
- ptr += hsp->sendptr;
- hsp->sendptr += count;
+ } else
+ count = hsp->tx_skb->len;
waitforXFW(sp->membase, hsp->hscx);
save_flags(flags);
cli();
+ ptr = hsp->tx_skb->data;
+ skb_pull(hsp->tx_skb, count);
+ hsp->tx_cnt -= count;
+ hsp->count += count;
write_fifo_hscx(sp->membase, hsp->hscx, ptr, count);
writehscxCMDR(sp->membase, hsp->hscx, more ? 0x8 : 0xa);
restore_flags(flags);
@@ -260,11 +261,12 @@ hscx_fill_fifo(struct HscxState *hsp)
}
static inline void
-hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
+hscx_interrupt(struct IsdnCardState *sp, u_char val, u_char hscx)
{
- byte r;
+ u_char r;
struct HscxState *hsp = sp->hs + hscx;
- int count, err;
+ struct sk_buff *skb;
+ int count;
char tmp[32];
if (!hsp->init)
@@ -286,79 +288,57 @@ hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
if (!r & 0x20)
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "HSCX CRC error");
- if (hsp->rcvibh)
- BufPoolRelease(hsp->rcvibh);
- hsp->rcvibh = NULL;
writehscxCMDR(sp->membase, hsp->hscx, 0x80);
- goto afterRME;
+ } else {
+ count = readhscx(sp->membase, hsp->hscx, HSCX_RBCL) & 0x1f;
+ if (count == 0)
+ count = 32;
+ hscx_empty_fifo(hsp, count);
+ if ((count = hsp->rcvidx - 1) > 0) {
+ if (!(skb = dev_alloc_skb(count)))
+ printk(KERN_WARNING "AVM: receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, count), hsp->rcvbuf, count);
+ skb_queue_tail(&hsp->rqueue, skb);
+ }
+ }
}
- if (!hsp->rcvibh)
- if (BufPoolGet(&hsp->rcvibh, &hsp->rbufpool,
- GFP_ATOMIC, (void *) 1, 1)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "HSCX RME out of buffers");
- writehscxCMDR(sp->membase, hsp->hscx, 0x80);
- goto afterRME;
- } else
- hsp->rcvptr = 0;
-
- count = readhscx(sp->membase, hsp->hscx, HSCX_RBCL) & 0x1f;
- if (count == 0)
- count = 32;
- hscx_empty_fifo(hsp, count);
- hsp->rcvibh->datasize = hsp->rcvptr - 1;
- BufQueueLink(&hsp->rq, hsp->rcvibh);
- hsp->rcvibh = NULL;
+ hsp->rcvidx = 0;
hscx_sched_event(hsp, HSCX_RCVBUFREADY);
}
- afterRME:
if (val & 0x40) { /* RPF */
- if (!hsp->rcvibh) {
- if (hsp->mode == 1)
- err = BufPoolGet(&hsp->rcvibh, &hsp->smallpool,
- GFP_ATOMIC, (void *) 1, 2);
- else
- err = BufPoolGet(&hsp->rcvibh, &hsp->rbufpool,
- GFP_ATOMIC, (void *) 1, 2);
-
- if (err) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "HSCX RPF out of buffers");
- writehscxCMDR(sp->membase, hsp->hscx, 0x80);
- goto afterRPF;
- } else
- hsp->rcvptr = 0;
- }
hscx_empty_fifo(hsp, 32);
if (hsp->mode == 1) {
/* receive audio data */
- hsp->rcvibh->datasize = hsp->rcvptr;
- BufQueueLink(&hsp->rq, hsp->rcvibh);
- hsp->rcvibh = NULL;
+ if (!(skb = dev_alloc_skb(32)))
+ printk(KERN_WARNING "AVM: receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, 32), hsp->rcvbuf, 32);
+ skb_queue_tail(&hsp->rqueue, skb);
+ }
+ hsp->rcvidx = 0;
hscx_sched_event(hsp, HSCX_RCVBUFREADY);
}
}
- afterRPF:
if (val & 0x10) { /* XPR */
- if (hsp->xmtibh)
- if (hsp->xmtibh->datasize > hsp->sendptr) {
+ if (hsp->tx_skb)
+ if (hsp->tx_skb->len) {
hscx_fill_fifo(hsp);
- goto afterXPR;
+ return;
} else {
- if (hsp->releasebuf)
- BufPoolRelease(hsp->xmtibh);
- hsp->sendptr = 0;
+ SET_SKB_FREE(hsp->tx_skb);
+ dev_kfree_skb(hsp->tx_skb, FREE_WRITE);
+ hsp->count = 0;
if (hsp->st->l4.l1writewakeup)
hsp->st->l4.l1writewakeup(hsp->st);
- hsp->xmtibh = NULL;
+ hsp->tx_skb = NULL;
}
- if (!BufQueueUnlink(&hsp->xmtibh, &hsp->sq)) {
- hsp->releasebuf = !0;
+ if ((hsp->tx_skb = skb_dequeue(&hsp->squeue))) {
+ hsp->count = 0;
hscx_fill_fifo(hsp);
} else
hscx_sched_event(hsp, HSCX_XMTBUFREADY);
}
- afterXPR:
}
/*
@@ -368,25 +348,25 @@ hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
static void
isac_empty_fifo(struct IsdnCardState *sp, int count)
{
- byte *ptr;
- struct BufHeader *ibh = sp->rcvibh;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_ISAC) && !(sp->debug & L1_DEB_ISAC_FIFO))
debugl1(sp, "isac_empty_fifo");
- if (sp->rcvptr >= 3072) {
+ if ((sp->rcvidx + count) >= MAX_DFRAME_LEN) {
if (sp->debug & L1_DEB_WARN) {
char tmp[40];
- sprintf(tmp, "isac_empty_fifo rcvptr %d", sp->rcvptr);
+ sprintf(tmp, "isac_empty_fifo overrun %d",
+ sp->rcvidx + count);
debugl1(sp, tmp);
}
+ writeisac(sp->membase, ISAC_CMDR, 0x80);
+ sp->rcvidx = 0;
return;
}
- ptr = DATAPTR(ibh);
- ptr += sp->rcvptr;
- sp->rcvptr += count;
-
+ ptr = sp->rcvbuf + sp->rcvidx;
+ sp->rcvidx += count;
save_flags(flags);
cli();
read_fifo_isac(sp->membase, ptr, count);
@@ -405,35 +385,30 @@ isac_empty_fifo(struct IsdnCardState *sp, int count)
static void
isac_fill_fifo(struct IsdnCardState *sp)
{
- struct BufHeader *ibh;
int count, more;
- byte *ptr;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_ISAC) && !(sp->debug & L1_DEB_ISAC_FIFO))
debugl1(sp, "isac_fill_fifo");
- ibh = sp->xmtibh;
- if (!ibh)
+ if (!sp->tx_skb)
return;
- count = ibh->datasize - sp->sendptr;
+ count = sp->tx_skb->len;
if (count <= 0)
return;
- if (count >= 3072)
- return;
more = 0;
if (count > 32) {
more = !0;
count = 32;
}
- ptr = DATAPTR(ibh);
- ptr += sp->sendptr;
- sp->sendptr += count;
-
save_flags(flags);
cli();
+ ptr = sp->tx_skb->data;
+ skb_pull(sp->tx_skb, count);
+ sp->tx_cnt += count;
write_fifo_isac(sp->membase, ptr, count);
writeisac(sp->membase, ISAC_CMDR, more ? 0x8 : 0xa);
restore_flags(flags);
@@ -459,9 +434,10 @@ ph_command(struct IsdnCardState *sp, unsigned int command)
}
static inline void
-isac_interrupt(struct IsdnCardState *sp, byte val)
+isac_interrupt(struct IsdnCardState *sp, u_char val)
{
- byte exval;
+ u_char exval;
+ struct sk_buff *skb;
unsigned int count;
char tmp[32];
@@ -478,62 +454,45 @@ isac_interrupt(struct IsdnCardState *sp, byte val)
if (!exval & 0x20)
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "ISAC CRC error");
- if (sp->rcvibh)
- BufPoolRelease(sp->rcvibh);
- sp->rcvibh = NULL;
writeisac(sp->membase, ISAC_CMDR, 0x80);
- goto afterRME;
+ } else {
+ count = readisac(sp->membase, ISAC_RBCL) & 0x1f;
+ if (count == 0)
+ count = 32;
+ isac_empty_fifo(sp, count);
+ if ((count = sp->rcvidx) > 0) {
+ if (!(skb = alloc_skb(count, GFP_ATOMIC)))
+ printk(KERN_WARNING "AVM: D receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, count), sp->rcvbuf, count);
+ skb_queue_tail(&sp->rq, skb);
+ }
+ }
}
- if (!sp->rcvibh)
- if (BufPoolGet(&(sp->rcvibh), &(sp->rbufpool),
- GFP_ATOMIC, (void *) 1, 3)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "ISAC RME out of buffers!");
- writeisac(sp->membase, ISAC_CMDR, 0x80);
- goto afterRME;
- } else
- sp->rcvptr = 0;
- count = readisac(sp->membase, ISAC_RBCL) & 0x1f;
- if (count == 0)
- count = 32;
- isac_empty_fifo(sp, count);
- sp->rcvibh->datasize = sp->rcvptr;
- BufQueueLink(&(sp->rq), sp->rcvibh);
- sp->rcvibh = NULL;
+ sp->rcvidx = 0;
isac_sched_event(sp, ISAC_RCVBUFREADY);
}
- afterRME:
if (val & 0x40) { /* RPF */
- if (!sp->rcvibh)
- if (BufPoolGet(&(sp->rcvibh), &(sp->rbufpool),
- GFP_ATOMIC, (void *) 1, 4)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "ISAC RME out of buffers!");
- writeisac(sp->membase, ISAC_CMDR, 0x80);
- goto afterRPF;
- } else
- sp->rcvptr = 0;
isac_empty_fifo(sp, 32);
}
- afterRPF:
if (val & 0x20) { /* RSC */
/* never */
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "ISAC RSC interrupt");
}
if (val & 0x10) { /* XPR */
- if (sp->xmtibh)
- if (sp->xmtibh->datasize > sp->sendptr) {
+ if (sp->tx_skb)
+ if (sp->tx_skb->len) {
isac_fill_fifo(sp);
goto afterXPR;
} else {
- if (sp->releasebuf)
- BufPoolRelease(sp->xmtibh);
- sp->xmtibh = NULL;
- sp->sendptr = 0;
+ SET_SKB_FREE(sp->tx_skb);
+ dev_kfree_skb(sp->tx_skb, FREE_WRITE);
+ sp->tx_cnt = 0;
+ sp->tx_skb = NULL;
}
- if (!BufQueueUnlink(&sp->xmtibh, &sp->sq)) {
- sp->releasebuf = !0;
+ if ((sp->tx_skb = skb_dequeue(&sp->sq))) {
+ sp->tx_cnt = 0;
isac_fill_fifo(sp);
} else
isac_sched_event(sp, ISAC_XMTBUFREADY);
@@ -563,10 +522,10 @@ isac_interrupt(struct IsdnCardState *sp, byte val)
}
static inline void
-hscx_int_main(struct IsdnCardState *sp, byte val)
+hscx_int_main(struct IsdnCardState *sp, u_char val)
{
- byte exval;
+ u_char exval;
struct HscxState *hsp;
char tmp[32];
@@ -581,7 +540,11 @@ hscx_int_main(struct IsdnCardState *sp, byte val)
/* Here we lost an TX interrupt, so
* restart transmitting the whole frame.
*/
- hsp->sendptr = 0;
+ if (hsp->tx_skb) {
+ skb_push(hsp->tx_skb, hsp->count);
+ hsp->tx_cnt += hsp->count;
+ hsp->count = 0;
+ }
writehscxCMDR(sp->membase, hsp->hscx, 0x01);
if (sp->debug & L1_DEB_WARN) {
sprintf(tmp, "HSCX B EXIR %x Lost TX", exval);
@@ -610,7 +573,11 @@ hscx_int_main(struct IsdnCardState *sp, byte val)
/* Here we lost an TX interrupt, so
* restart transmitting the whole frame.
*/
- hsp->sendptr = 0;
+ if (hsp->tx_skb) {
+ skb_push(hsp->tx_skb, hsp->count);
+ hsp->tx_cnt += hsp->count;
+ hsp->count = 0;
+ }
writehscxCMDR(sp->membase, hsp->hscx, 0x01);
if (sp->debug & L1_DEB_WARN) {
sprintf(tmp, "HSCX A EXIR %x Lost TX", exval);
@@ -636,7 +603,7 @@ static void
telesS0_interrupt(int intno, void *dev_id, struct pt_regs *regs)
{
struct IsdnCardState *sp;
- byte val, stat = 0;
+ u_char val, stat = 0;
sp = (struct IsdnCardState *) irq2dev_map[intno];
@@ -723,48 +690,48 @@ modehscx(struct HscxState *hs, int mode, int ichan)
ichan = 1 - ichan;
switch (mode) {
- case (0):
- writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
- writehscx(sp->membase, hscx, HSCX_TSAX, 0xff);
- writehscx(sp->membase, hscx, HSCX_TSAR, 0xff);
- writehscx(sp->membase, hscx, HSCX_XCCR, 7);
- writehscx(sp->membase, hscx, HSCX_RCCR, 7);
- writehscx(sp->membase, hscx, HSCX_MODE, 0x84);
- break;
- case (1):
- if (ichan == 0) {
- writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
- writehscx(sp->membase, hscx, HSCX_TSAX, 0x7);
- writehscx(sp->membase, hscx, HSCX_TSAR, 0x7);
- writehscx(sp->membase, hscx, HSCX_XCCR, 7);
- writehscx(sp->membase, hscx, HSCX_RCCR, 7);
- } else {
+ case (0):
writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
- writehscx(sp->membase, hscx, HSCX_TSAX, 0x3);
- writehscx(sp->membase, hscx, HSCX_TSAR, 0x3);
+ writehscx(sp->membase, hscx, HSCX_TSAX, 0xff);
+ writehscx(sp->membase, hscx, HSCX_TSAR, 0xff);
writehscx(sp->membase, hscx, HSCX_XCCR, 7);
writehscx(sp->membase, hscx, HSCX_RCCR, 7);
- }
- writehscx(sp->membase, hscx, HSCX_MODE, 0xe4);
- writehscx(sp->membase, hscx, HSCX_CMDR, 0x41);
- break;
- case (2):
- if (ichan == 0) {
- writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
- writehscx(sp->membase, hscx, HSCX_TSAX, 0x7);
- writehscx(sp->membase, hscx, HSCX_TSAR, 0x7);
- writehscx(sp->membase, hscx, HSCX_XCCR, 7);
- writehscx(sp->membase, hscx, HSCX_RCCR, 7);
- } else {
- writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
- writehscx(sp->membase, hscx, HSCX_TSAX, 0x3);
- writehscx(sp->membase, hscx, HSCX_TSAR, 0x3);
- writehscx(sp->membase, hscx, HSCX_XCCR, 7);
- writehscx(sp->membase, hscx, HSCX_RCCR, 7);
- }
- writehscx(sp->membase, hscx, HSCX_MODE, 0x8c);
- writehscx(sp->membase, hscx, HSCX_CMDR, 0x41);
- break;
+ writehscx(sp->membase, hscx, HSCX_MODE, 0x84);
+ break;
+ case (1):
+ if (ichan == 0) {
+ writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
+ writehscx(sp->membase, hscx, HSCX_TSAX, 0x7);
+ writehscx(sp->membase, hscx, HSCX_TSAR, 0x7);
+ writehscx(sp->membase, hscx, HSCX_XCCR, 7);
+ writehscx(sp->membase, hscx, HSCX_RCCR, 7);
+ } else {
+ writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
+ writehscx(sp->membase, hscx, HSCX_TSAX, 0x3);
+ writehscx(sp->membase, hscx, HSCX_TSAR, 0x3);
+ writehscx(sp->membase, hscx, HSCX_XCCR, 7);
+ writehscx(sp->membase, hscx, HSCX_RCCR, 7);
+ }
+ writehscx(sp->membase, hscx, HSCX_MODE, 0xe4);
+ writehscx(sp->membase, hscx, HSCX_CMDR, 0x41);
+ break;
+ case (2):
+ if (ichan == 0) {
+ writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
+ writehscx(sp->membase, hscx, HSCX_TSAX, 0x7);
+ writehscx(sp->membase, hscx, HSCX_TSAR, 0x7);
+ writehscx(sp->membase, hscx, HSCX_XCCR, 7);
+ writehscx(sp->membase, hscx, HSCX_RCCR, 7);
+ } else {
+ writehscx(sp->membase, hscx, HSCX_CCR2, 0x30);
+ writehscx(sp->membase, hscx, HSCX_TSAX, 0x3);
+ writehscx(sp->membase, hscx, HSCX_TSAR, 0x3);
+ writehscx(sp->membase, hscx, HSCX_XCCR, 7);
+ writehscx(sp->membase, hscx, HSCX_RCCR, 7);
+ }
+ writehscx(sp->membase, hscx, HSCX_MODE, 0x8c);
+ writehscx(sp->membase, hscx, HSCX_CMDR, 0x41);
+ break;
}
writehscx(sp->membase, hscx, HSCX_ISTA, 0x00);
}
@@ -832,6 +799,7 @@ int
initteles0(struct IsdnCardState *sp)
{
int ret;
+ int loop = 0;
char tmp[40];
sp->counter = kstat.interrupts[sp->irq];
@@ -843,6 +811,16 @@ initteles0(struct IsdnCardState *sp)
initisac(sp);
sp->modehscx(sp->hs, 0, 0);
sp->modehscx(sp->hs + 1, 0, 0);
+ while (loop++ < 10) {
+ /* At least 1-3 irqs must happen
+ * (one from HSCX A, one from HSCX B, 3rd from ISAC)
+ */
+ if (kstat.interrupts[sp->irq] > sp->counter)
+ break;
+ current->state = TASK_INTERRUPTIBLE;
+ current->timeout = jiffies + 1;
+ schedule();
+ }
sprintf(tmp, "IRQ %d count %d", sp->irq,
kstat.interrupts[sp->irq]);
debugl1(sp, tmp);
@@ -861,7 +839,7 @@ initteles0(struct IsdnCardState *sp)
int
setup_teles0(struct IsdnCard *card)
{
- byte cfval, val, verA, verB;
+ u_char cfval, val, verA, verB;
struct IsdnCardState *sp = card->sp;
long flags;
char tmp[64];
@@ -897,33 +875,33 @@ setup_teles0(struct IsdnCard *card)
}
}
switch (sp->irq) {
- case 2:
- cfval = 0x00;
- break;
- case 3:
- cfval = 0x02;
- break;
- case 4:
- cfval = 0x04;
- break;
- case 5:
- cfval = 0x06;
- break;
- case 10:
- cfval = 0x08;
- break;
- case 11:
- cfval = 0x0A;
- break;
- case 12:
- cfval = 0x0C;
- break;
- case 15:
- cfval = 0x0E;
- break;
- default:
- cfval = 0x00;
- break;
+ case 2:
+ cfval = 0x00;
+ break;
+ case 3:
+ cfval = 0x02;
+ break;
+ case 4:
+ cfval = 0x04;
+ break;
+ case 5:
+ cfval = 0x06;
+ break;
+ case 10:
+ cfval = 0x08;
+ break;
+ case 11:
+ cfval = 0x0A;
+ break;
+ case 12:
+ cfval = 0x0C;
+ break;
+ case 15:
+ cfval = 0x0E;
+ break;
+ default:
+ cfval = 0x00;
+ break;
}
cfval |= ((card->para[1] >> 9) & 0xF0);
if (sp->cfg_reg) {
diff --git a/drivers/isdn/hisax/teles3.c b/drivers/isdn/hisax/teles3.c
index 988130ed5..357f21e7e 100644
--- a/drivers/isdn/hisax/teles3.c
+++ b/drivers/isdn/hisax/teles3.c
@@ -1,4 +1,4 @@
-/* $Id: teles3.c,v 1.7 1997/01/28 22:48:33 keil Exp $
+/* $Id: teles3.c,v 1.11 1997/04/13 19:54:05 keil Exp $
* teles3.c low level stuff for Teles 16.3 & PNP isdn cards
*
@@ -11,6 +11,24 @@
* Beat Doebeli
*
* $Log: teles3.c,v $
+ * Revision 1.11 1997/04/13 19:54:05 keil
+ * Change in IRQ check delay for SMP
+ *
+ * Revision 1.10 1997/04/06 22:54:05 keil
+ * Using SKB's
+ *
+ * Revision 1.9 1997/03/22 02:01:07 fritz
+ * -Reworked toplevel Makefile. From now on, no different Makefiles
+ * for standalone- and in-kernel-compilation are needed any more.
+ * -Added local Rules.make for above reason.
+ * -Experimental changes in teles3.c for enhanced IRQ-checking with
+ * 2.1.X and SMP kernels.
+ * -Removed diffstd-script, same functionality is in stddiff -r.
+ * -Enhanced scripts std2kern and stddiff.
+ *
+ * Revision 1.8 1997/02/23 18:43:55 fritz
+ * Added support for Teles-Vision.
+ *
* Revision 1.7 1997/01/28 22:48:33 keil
* fixes for Teles PCMCIA (Christof Petig)
*
@@ -43,32 +61,32 @@
#include <linux/kernel_stat.h>
extern const char *CardType[];
-const char *teles3_revision = "$Revision: 1.7 $";
+const char *teles3_revision = "$Revision: 1.11 $";
#define byteout(addr,val) outb_p(val,addr)
#define bytein(addr) inb_p(addr)
-static inline byte
-readreg(unsigned int adr, byte off)
+static inline u_char
+readreg(unsigned int adr, u_char off)
{
return (bytein(adr + off));
}
static inline void
-writereg(unsigned int adr, byte off, byte data)
+writereg(unsigned int adr, u_char off, u_char data)
{
byteout(adr + off, data);
}
static inline void
-read_fifo(unsigned int adr, byte * data, int size)
+read_fifo(unsigned int adr, u_char * data, int size)
{
insb(adr + 0x1e, data, size);
}
static void
-write_fifo(unsigned int adr, byte * data, int size)
+write_fifo(unsigned int adr, u_char * data, int size)
{
outsb(adr + 0x1e, data, size);
}
@@ -100,7 +118,7 @@ waitforXFW(int adr)
printk(KERN_WARNING "Teles3: waitforXFW timeout\n");
}
static inline void
-writehscxCMDR(int adr, byte data)
+writehscxCMDR(int adr, u_char data)
{
long flags;
@@ -142,25 +160,22 @@ teles3_report(struct IsdnCardState *sp)
static void
hscx_empty_fifo(struct HscxState *hsp, int count)
{
- byte *ptr;
+ u_char *ptr;
struct IsdnCardState *sp = hsp->sp;
- struct BufHeader *ibh = hsp->rcvibh;
long flags;
if ((sp->debug & L1_DEB_HSCX) && !(sp->debug & L1_DEB_HSCX_FIFO))
debugl1(sp, "hscx_empty_fifo");
- if (hsp->rcvptr + count > BUFFER_SIZE(HSCX_RBUF_ORDER,
- HSCX_RBUF_BPPS)) {
+ if (hsp->rcvidx + count > HSCX_BUFMAX) {
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "hscx_empty_fifo: incoming packet too large");
writehscxCMDR(sp->hscx[hsp->hscx], 0x80);
+ hsp->rcvidx = 0;
return;
}
- ptr = DATAPTR(ibh);
- ptr += hsp->rcvptr;
-
- hsp->rcvptr += count;
+ ptr = hsp->rcvbuf + hsp->rcvidx;
+ hsp->rcvidx += count;
save_flags(flags);
cli();
read_fifo(sp->hscx[hsp->hscx], ptr, count);
@@ -181,34 +196,32 @@ static void
hscx_fill_fifo(struct HscxState *hsp)
{
struct IsdnCardState *sp = hsp->sp;
- struct BufHeader *ibh;
int more, count;
- byte *ptr;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_HSCX) && !(sp->debug & L1_DEB_HSCX_FIFO))
debugl1(sp, "hscx_fill_fifo");
- ibh = hsp->xmtibh;
- if (!ibh)
+ if (!hsp->tx_skb)
return;
-
- count = ibh->datasize - hsp->sendptr;
- if (count <= 0)
+ if (hsp->tx_skb->len <= 0)
return;
more = (hsp->mode == 1) ? 1 : 0;
- if (count > 32) {
+ if (hsp->tx_skb->len > 32) {
more = !0;
count = 32;
- }
- ptr = DATAPTR(ibh);
- ptr += hsp->sendptr;
- hsp->sendptr += count;
+ } else
+ count = hsp->tx_skb->len;
waitforXFW(sp->hscx[hsp->hscx]);
save_flags(flags);
cli();
+ ptr = hsp->tx_skb->data;
+ skb_pull(hsp->tx_skb, count);
+ hsp->tx_cnt -= count;
+ hsp->count += count;
write_fifo(sp->hscx[hsp->hscx], ptr, count);
writehscxCMDR(sp->hscx[hsp->hscx], more ? 0x8 : 0xa);
restore_flags(flags);
@@ -224,11 +237,12 @@ hscx_fill_fifo(struct HscxState *hsp)
}
static inline void
-hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
+hscx_interrupt(struct IsdnCardState *sp, u_char val, u_char hscx)
{
- byte r;
+ u_char r;
struct HscxState *hsp = sp->hs + hscx;
- int count, err;
+ struct sk_buff *skb;
+ int count;
char tmp[32];
if (!hsp->init)
@@ -250,79 +264,57 @@ hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
if (!r & 0x20)
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "HSCX CRC error");
- if (hsp->rcvibh)
- BufPoolRelease(hsp->rcvibh);
- hsp->rcvibh = NULL;
writehscxCMDR(sp->hscx[hsp->hscx], 0x80);
- goto afterRME;
+ } else {
+ count = readreg(sp->hscx[hsp->hscx], HSCX_RBCL) & 0x1f;
+ if (count == 0)
+ count = 32;
+ hscx_empty_fifo(hsp, count);
+ if ((count = hsp->rcvidx - 1) > 0) {
+ if (!(skb = dev_alloc_skb(count)))
+ printk(KERN_WARNING "AVM: receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, count), hsp->rcvbuf, count);
+ skb_queue_tail(&hsp->rqueue, skb);
+ }
+ }
}
- if (!hsp->rcvibh)
- if (BufPoolGet(&hsp->rcvibh, &hsp->rbufpool,
- GFP_ATOMIC, (void *) 1, 1)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "HSCX RME out of buffers");
- writehscxCMDR(sp->hscx[hsp->hscx], 0x80);
- goto afterRME;
- } else
- hsp->rcvptr = 0;
-
- count = readreg(sp->hscx[hsp->hscx], HSCX_RBCL) & 0x1f;
- if (count == 0)
- count = 32;
- hscx_empty_fifo(hsp, count);
- hsp->rcvibh->datasize = hsp->rcvptr - 1;
- BufQueueLink(&hsp->rq, hsp->rcvibh);
- hsp->rcvibh = NULL;
+ hsp->rcvidx = 0;
hscx_sched_event(hsp, HSCX_RCVBUFREADY);
}
- afterRME:
if (val & 0x40) { /* RPF */
- if (!hsp->rcvibh) {
- if (hsp->mode == 1)
- err = BufPoolGet(&hsp->rcvibh, &hsp->smallpool,
- GFP_ATOMIC, (void *) 1, 2);
- else
- err = BufPoolGet(&hsp->rcvibh, &hsp->rbufpool,
- GFP_ATOMIC, (void *) 1, 2);
-
- if (err) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "HSCX RPF out of buffers");
- writehscxCMDR(sp->hscx[hsp->hscx], 0x80);
- goto afterRPF;
- } else
- hsp->rcvptr = 0;
- }
hscx_empty_fifo(hsp, 32);
if (hsp->mode == 1) {
/* receive audio data */
- hsp->rcvibh->datasize = hsp->rcvptr;
- BufQueueLink(&hsp->rq, hsp->rcvibh);
- hsp->rcvibh = NULL;
+ if (!(skb = dev_alloc_skb(32)))
+ printk(KERN_WARNING "AVM: receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, 32), hsp->rcvbuf, 32);
+ skb_queue_tail(&hsp->rqueue, skb);
+ }
+ hsp->rcvidx = 0;
hscx_sched_event(hsp, HSCX_RCVBUFREADY);
}
}
- afterRPF:
if (val & 0x10) { /* XPR */
- if (hsp->xmtibh)
- if (hsp->xmtibh->datasize > hsp->sendptr) {
+ if (hsp->tx_skb)
+ if (hsp->tx_skb->len) {
hscx_fill_fifo(hsp);
- goto afterXPR;
+ return;
} else {
- if (hsp->releasebuf)
- BufPoolRelease(hsp->xmtibh);
- hsp->sendptr = 0;
+ SET_SKB_FREE(hsp->tx_skb);
+ dev_kfree_skb(hsp->tx_skb, FREE_WRITE);
+ hsp->count = 0;
if (hsp->st->l4.l1writewakeup)
hsp->st->l4.l1writewakeup(hsp->st);
- hsp->xmtibh = NULL;
+ hsp->tx_skb = NULL;
}
- if (!BufQueueUnlink(&hsp->xmtibh, &hsp->sq)) {
- hsp->releasebuf = !0;
+ if ((hsp->tx_skb = skb_dequeue(&hsp->squeue))) {
+ hsp->count = 0;
hscx_fill_fifo(hsp);
} else
hscx_sched_event(hsp, HSCX_XMTBUFREADY);
}
- afterXPR:
}
/*
@@ -332,26 +324,26 @@ hscx_interrupt(struct IsdnCardState *sp, byte val, byte hscx)
static void
isac_empty_fifo(struct IsdnCardState *sp, int count)
{
- byte *ptr;
- struct BufHeader *ibh = sp->rcvibh;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_ISAC) && !(sp->debug & L1_DEB_ISAC_FIFO))
if (sp->debug & L1_DEB_ISAC)
debugl1(sp, "isac_empty_fifo");
- if (sp->rcvptr >= 3072) {
+ if ((sp->rcvidx + count) >= MAX_DFRAME_LEN) {
if (sp->debug & L1_DEB_WARN) {
char tmp[40];
- sprintf(tmp, "isac_empty_fifo rcvptr %d", sp->rcvptr);
+ sprintf(tmp, "isac_empty_fifo overrun %d",
+ sp->rcvidx + count);
debugl1(sp, tmp);
}
+ writereg(sp->isac, ISAC_CMDR, 0x80);
+ sp->rcvidx = 0;
return;
}
- ptr = DATAPTR(ibh);
- ptr += sp->rcvptr;
- sp->rcvptr += count;
-
+ ptr = sp->rcvbuf + sp->rcvidx;
+ sp->rcvidx += count;
save_flags(flags);
cli();
read_fifo(sp->isac, ptr, count);
@@ -370,35 +362,30 @@ isac_empty_fifo(struct IsdnCardState *sp, int count)
static void
isac_fill_fifo(struct IsdnCardState *sp)
{
- struct BufHeader *ibh;
int count, more;
- byte *ptr;
+ u_char *ptr;
long flags;
if ((sp->debug & L1_DEB_ISAC) && !(sp->debug & L1_DEB_ISAC_FIFO))
debugl1(sp, "isac_fill_fifo");
- ibh = sp->xmtibh;
- if (!ibh)
+ if (!sp->tx_skb)
return;
- count = ibh->datasize - sp->sendptr;
+ count = sp->tx_skb->len;
if (count <= 0)
return;
- if (count >= 3072)
- return;
more = 0;
if (count > 32) {
more = !0;
count = 32;
}
- ptr = DATAPTR(ibh);
- ptr += sp->sendptr;
- sp->sendptr += count;
-
save_flags(flags);
cli();
+ ptr = sp->tx_skb->data;
+ skb_pull(sp->tx_skb, count);
+ sp->tx_cnt += count;
write_fifo(sp->isac, ptr, count);
writereg(sp->isac, ISAC_CMDR, more ? 0x8 : 0xa);
restore_flags(flags);
@@ -425,9 +412,10 @@ ph_command(struct IsdnCardState *sp, unsigned int command)
static inline void
-isac_interrupt(struct IsdnCardState *sp, byte val)
+isac_interrupt(struct IsdnCardState *sp, u_char val)
{
- byte exval;
+ u_char exval;
+ struct sk_buff *skb;
unsigned int count;
char tmp[32];
@@ -444,62 +432,45 @@ isac_interrupt(struct IsdnCardState *sp, byte val)
if (!exval & 0x20)
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "ISAC CRC error");
- if (sp->rcvibh)
- BufPoolRelease(sp->rcvibh);
- sp->rcvibh = NULL;
writereg(sp->isac, ISAC_CMDR, 0x80);
- goto afterRME;
+ } else {
+ count = readreg(sp->isac, ISAC_RBCL) & 0x1f;
+ if (count == 0)
+ count = 32;
+ isac_empty_fifo(sp, count);
+ if ((count = sp->rcvidx) > 0) {
+ if (!(skb = alloc_skb(count, GFP_ATOMIC)))
+ printk(KERN_WARNING "AVM: D receive out of memory\n");
+ else {
+ memcpy(skb_put(skb, count), sp->rcvbuf, count);
+ skb_queue_tail(&sp->rq, skb);
+ }
+ }
}
- if (!sp->rcvibh)
- if (BufPoolGet(&(sp->rcvibh), &(sp->rbufpool),
- GFP_ATOMIC, (void *) 1, 3)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "ISAC RME out of buffers!");
- writereg(sp->isac, ISAC_CMDR, 0x80);
- goto afterRME;
- } else
- sp->rcvptr = 0;
- count = readreg(sp->isac, ISAC_RBCL) & 0x1f;
- if (count == 0)
- count = 32;
- isac_empty_fifo(sp, count);
- sp->rcvibh->datasize = sp->rcvptr;
- BufQueueLink(&(sp->rq), sp->rcvibh);
- sp->rcvibh = NULL;
+ sp->rcvidx = 0;
isac_sched_event(sp, ISAC_RCVBUFREADY);
}
- afterRME:
if (val & 0x40) { /* RPF */
- if (!sp->rcvibh)
- if (BufPoolGet(&(sp->rcvibh), &(sp->rbufpool),
- GFP_ATOMIC, (void *) 1, 4)) {
- if (sp->debug & L1_DEB_WARN)
- debugl1(sp, "ISAC RME out of buffers!");
- writereg(sp->isac, ISAC_CMDR, 0x80);
- goto afterRPF;
- } else
- sp->rcvptr = 0;
isac_empty_fifo(sp, 32);
}
- afterRPF:
if (val & 0x20) { /* RSC */
/* never */
if (sp->debug & L1_DEB_WARN)
debugl1(sp, "ISAC RSC interrupt");
}
if (val & 0x10) { /* XPR */
- if (sp->xmtibh)
- if (sp->xmtibh->datasize > sp->sendptr) {
+ if (sp->tx_skb)
+ if (sp->tx_skb->len) {
isac_fill_fifo(sp);
goto afterXPR;
} else {
- if (sp->releasebuf)
- BufPoolRelease(sp->xmtibh);
- sp->xmtibh = NULL;
- sp->sendptr = 0;
+ SET_SKB_FREE(sp->tx_skb);
+ dev_kfree_skb(sp->tx_skb, FREE_WRITE);
+ sp->tx_cnt = 0;
+ sp->tx_skb = NULL;
}
- if (!BufQueueUnlink(&sp->xmtibh, &sp->sq)) {
- sp->releasebuf = !0;
+ if ((sp->tx_skb = skb_dequeue(&sp->sq))) {
+ sp->tx_cnt = 0;
isac_fill_fifo(sp);
} else
isac_sched_event(sp, ISAC_XMTBUFREADY);
@@ -529,10 +500,10 @@ isac_interrupt(struct IsdnCardState *sp, byte val)
}
static inline void
-hscx_int_main(struct IsdnCardState *sp, byte val)
+hscx_int_main(struct IsdnCardState *sp, u_char val)
{
- byte exval;
+ u_char exval;
struct HscxState *hsp;
char tmp[32];
@@ -547,7 +518,11 @@ hscx_int_main(struct IsdnCardState *sp, byte val)
/* Here we lost an TX interrupt, so
* restart transmitting the whole frame.
*/
- hsp->sendptr = 0;
+ if (hsp->tx_skb) {
+ skb_push(hsp->tx_skb, hsp->count);
+ hsp->tx_cnt += hsp->count;
+ hsp->count = 0;
+ }
writehscxCMDR(sp->hscx[hsp->hscx], 0x01);
if (sp->debug & L1_DEB_WARN) {
sprintf(tmp, "HSCX B EXIR %x Lost TX", exval);
@@ -576,7 +551,11 @@ hscx_int_main(struct IsdnCardState *sp, byte val)
/* Here we lost an TX interrupt, so
* restart transmitting the whole frame.
*/
- hsp->sendptr = 0;
+ if (hsp->tx_skb) {
+ skb_push(hsp->tx_skb, hsp->count);
+ hsp->tx_cnt += hsp->count;
+ hsp->count = 0;
+ }
writehscxCMDR(sp->hscx[hsp->hscx], 0x01);
if (sp->debug & L1_DEB_WARN) {
sprintf(tmp, "HSCX A EXIR %x Lost TX", exval);
@@ -601,8 +580,10 @@ hscx_int_main(struct IsdnCardState *sp, byte val)
static void
teles3_interrupt(int intno, void *dev_id, struct pt_regs *regs)
{
+#define MAXCOUNT 20
struct IsdnCardState *sp;
- byte val, stat = 0;
+ u_char val, stat = 0;
+ int count = 0;
sp = (struct IsdnCardState *) irq2dev_map[intno];
@@ -622,18 +603,21 @@ teles3_interrupt(int intno, void *dev_id, struct pt_regs *regs)
isac_interrupt(sp, val);
stat |= 2;
}
+ count++;
val = readreg(sp->hscx[1], HSCX_ISTA);
- if (val) {
+ if (val && count < MAXCOUNT) {
if (sp->debug & L1_DEB_HSCX)
debugl1(sp, "HSCX IntStat after IntRoutine");
goto Start_HSCX;
}
val = readreg(sp->isac, ISAC_ISTA);
- if (val) {
+ if (val && count < MAXCOUNT) {
if (sp->debug & L1_DEB_ISAC)
debugl1(sp, "ISAC IntStat after IntRoutine");
goto Start_ISAC;
}
+ if (count >= MAXCOUNT)
+ printk(KERN_WARNING "Teles3: more than %d loops in teles3_interrupt\n", count);
if (stat & 1) {
writereg(sp->hscx[0], HSCX_MASK, 0xFF);
writereg(sp->hscx[1], HSCX_MASK, 0xFF);
@@ -689,48 +673,48 @@ modehscx(struct HscxState *hs, int mode, int ichan)
writereg(sp->hscx[hscx], HSCX_RLCR, 0x0);
switch (mode) {
- case (0):
- writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0xff);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0xff);
- writereg(sp->hscx[hscx], HSCX_XCCR, 7);
- writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- writereg(sp->hscx[hscx], HSCX_MODE, 0x84);
- break;
- case (1):
- if (ichan == 0) {
- writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0x2f);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0x2f);
- writereg(sp->hscx[hscx], HSCX_XCCR, 7);
- writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- } else {
- writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0x3);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0x3);
- writereg(sp->hscx[hscx], HSCX_XCCR, 7);
- writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- }
- writereg(sp->hscx[hscx], HSCX_MODE, 0xe4);
- writereg(sp->hscx[hscx], HSCX_CMDR, 0x41);
- break;
- case (2):
- if (ichan == 0) {
- writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0x2f);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0x2f);
- writereg(sp->hscx[hscx], HSCX_XCCR, 7);
- writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- } else {
+ case (0):
writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
- writereg(sp->hscx[hscx], HSCX_TSAX, 0x3);
- writereg(sp->hscx[hscx], HSCX_TSAR, 0x3);
+ writereg(sp->hscx[hscx], HSCX_TSAX, 0xff);
+ writereg(sp->hscx[hscx], HSCX_TSAR, 0xff);
writereg(sp->hscx[hscx], HSCX_XCCR, 7);
writereg(sp->hscx[hscx], HSCX_RCCR, 7);
- }
- writereg(sp->hscx[hscx], HSCX_MODE, 0x8c);
- writereg(sp->hscx[hscx], HSCX_CMDR, 0x41);
- break;
+ writereg(sp->hscx[hscx], HSCX_MODE, 0x84);
+ break;
+ case (1):
+ if (ichan == 0) {
+ writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
+ writereg(sp->hscx[hscx], HSCX_TSAX, 0x2f);
+ writereg(sp->hscx[hscx], HSCX_TSAR, 0x2f);
+ writereg(sp->hscx[hscx], HSCX_XCCR, 7);
+ writereg(sp->hscx[hscx], HSCX_RCCR, 7);
+ } else {
+ writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
+ writereg(sp->hscx[hscx], HSCX_TSAX, 0x3);
+ writereg(sp->hscx[hscx], HSCX_TSAR, 0x3);
+ writereg(sp->hscx[hscx], HSCX_XCCR, 7);
+ writereg(sp->hscx[hscx], HSCX_RCCR, 7);
+ }
+ writereg(sp->hscx[hscx], HSCX_MODE, 0xe4);
+ writereg(sp->hscx[hscx], HSCX_CMDR, 0x41);
+ break;
+ case (2):
+ if (ichan == 0) {
+ writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
+ writereg(sp->hscx[hscx], HSCX_TSAX, 0x2f);
+ writereg(sp->hscx[hscx], HSCX_TSAR, 0x2f);
+ writereg(sp->hscx[hscx], HSCX_XCCR, 7);
+ writereg(sp->hscx[hscx], HSCX_RCCR, 7);
+ } else {
+ writereg(sp->hscx[hscx], HSCX_CCR2, 0x30);
+ writereg(sp->hscx[hscx], HSCX_TSAX, 0x3);
+ writereg(sp->hscx[hscx], HSCX_TSAR, 0x3);
+ writereg(sp->hscx[hscx], HSCX_XCCR, 7);
+ writereg(sp->hscx[hscx], HSCX_RCCR, 7);
+ }
+ writereg(sp->hscx[hscx], HSCX_MODE, 0x8c);
+ writereg(sp->hscx[hscx], HSCX_CMDR, 0x41);
+ break;
}
writereg(sp->hscx[hscx], HSCX_ISTA, 0x00);
}
@@ -814,6 +798,7 @@ int
initteles3(struct IsdnCardState *sp)
{
int ret;
+ int loop = 0;
char tmp[40];
sp->counter = kstat.interrupts[sp->irq];
@@ -824,11 +809,23 @@ initteles3(struct IsdnCardState *sp)
if (ret) {
initisac(sp);
sp->modehscx(sp->hs, 0, 0);
+ writereg(sp->hscx[sp->hs->hscx], HSCX_CMDR, 0x01);
sp->modehscx(sp->hs + 1, 0, 0);
- sprintf(tmp, "IRQ %d count %d", sp->irq,
- kstat.interrupts[sp->irq]);
+ writereg(sp->hscx[(sp->hs + 1)->hscx], HSCX_CMDR, 0x01);
+ while (loop++ < 10) {
+ /* At least 1-3 irqs must happen
+ * (one from HSCX A, one from HSCX B, 3rd from ISAC)
+ */
+ if (kstat.interrupts[sp->irq] > sp->counter)
+ break;
+ current->state = TASK_INTERRUPTIBLE;
+ current->timeout = jiffies + 1;
+ schedule();
+ }
+ sprintf(tmp, "IRQ %d count %d loop %d", sp->irq,
+ kstat.interrupts[sp->irq], loop);
debugl1(sp, tmp);
- if (kstat.interrupts[sp->irq] == sp->counter) {
+ if (kstat.interrupts[sp->irq] <= sp->counter) {
printk(KERN_WARNING
"Teles3: IRQ(%d) getting no interrupts during init\n",
sp->irq);
@@ -843,7 +840,7 @@ initteles3(struct IsdnCardState *sp)
int
setup_teles3(struct IsdnCard *card)
{
- byte cfval = 0, val, verA, verB;
+ u_char cfval = 0, val, verA, verB;
struct IsdnCardState *sp = card->sp;
long flags;
char tmp[64];
@@ -857,11 +854,11 @@ setup_teles3(struct IsdnCard *card)
if (sp->typ == ISDN_CTYPE_16_3) {
sp->cfg_reg = card->para[1];
switch (sp->cfg_reg) {
- case 0x180:
- case 0x280:
- case 0x380:
- sp->cfg_reg |= 0xc00;
- break;
+ case 0x180:
+ case 0x280:
+ case 0x380:
+ sp->cfg_reg |= 0xc00;
+ break;
}
sp->isac = sp->cfg_reg - 0x400;
sp->hscx[0] = sp->cfg_reg - 0xc00;
@@ -943,33 +940,33 @@ setup_teles3(struct IsdnCard *card)
request_region(sp->hscx[1], 32, "HiSax hscx B");
}
switch (sp->irq) {
- case 2:
- cfval = 0x00;
- break;
- case 3:
- cfval = 0x02;
- break;
- case 4:
- cfval = 0x04;
- break;
- case 5:
- cfval = 0x06;
- break;
- case 10:
- cfval = 0x08;
- break;
- case 11:
- cfval = 0x0A;
- break;
- case 12:
- cfval = 0x0C;
- break;
- case 15:
- cfval = 0x0E;
- break;
- default:
- cfval = 0x00;
- break;
+ case 2:
+ cfval = 0x00;
+ break;
+ case 3:
+ cfval = 0x02;
+ break;
+ case 4:
+ cfval = 0x04;
+ break;
+ case 5:
+ cfval = 0x06;
+ break;
+ case 10:
+ cfval = 0x08;
+ break;
+ case 11:
+ cfval = 0x0A;
+ break;
+ case 12:
+ cfval = 0x0C;
+ break;
+ case 15:
+ cfval = 0x0E;
+ break;
+ default:
+ cfval = 0x00;
+ break;
}
}
if (sp->cfg_reg) {
@@ -988,8 +985,9 @@ setup_teles3(struct IsdnCard *card)
val = bytein(sp->cfg_reg + 2); /* 0x1e=without AB
* 0x1f=with AB
* 0x1c 16.3 ???
+ * 0x46 16.3 with AB + Video (Teles-Vision)
*/
- if (val != 0x1c && val != 0x1e && val != 0x1f) {
+ if (val != 0x46 && val != 0x1c && val != 0x1e && val != 0x1f) {
printk(KERN_WARNING "Teles: 16.3 Byte at %x is %x\n",
sp->cfg_reg + 2, val);
release_io_teles3(card);
diff --git a/drivers/isdn/icn/icn.c b/drivers/isdn/icn/icn.c
index d460c844a..f51ae3d7d 100644
--- a/drivers/isdn/icn/icn.c
+++ b/drivers/isdn/icn/icn.c
@@ -1,4 +1,4 @@
-/* $Id: icn.c,v 1.38 1997/02/11 18:29:31 fritz Exp $
+/* $Id: icn.c,v 1.44 1997/03/30 16:51:26 calle Exp $
* ISDN low-level module for the ICN active ISDN-Card.
*
@@ -19,6 +19,25 @@
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
* $Log: icn.c,v $
+ * Revision 1.44 1997/03/30 16:51:26 calle
+ * changed calls to copy_from_user/copy_to_user and removed verify_area
+ * were possible.
+ *
+ * Revision 1.43 1997/03/21 18:27:04 fritz
+ * Corrected parsing of incoming setup.
+ *
+ * Revision 1.42 1997/03/05 21:13:18 fritz
+ * Bugfix: sndcount was not reset on hangup.
+ *
+ * Revision 1.41 1997/02/24 23:34:29 fritz
+ * Bugfix in Layer1 error-recovery.
+ *
+ * Revision 1.40 1997/02/23 23:34:45 fritz
+ * Minor bugfixes in debugging code.
+ *
+ * Revision 1.39 1997/02/23 16:21:56 fritz
+ * Bugfix: Check for NULL pointer in icn_parse_status().
+ *
* Revision 1.38 1997/02/11 18:29:31 fritz
* Bugfix in D64S initialization.
*
@@ -171,22 +190,25 @@
#undef MAP_DEBUG
static char
-*revision = "$Revision: 1.38 $";
+*revision = "$Revision: 1.44 $";
static int icn_addcard(int, char *, char *);
/*
- * Free queue completely.
+ * Free send-queue completely.
* Parameter:
- * queue = pointer to queue-head
+ * card = pointer to card struct
+ * channel = channel number
*/
static void
-icn_free_queue(struct sk_buff_head *queue)
+icn_free_queue(icn_card * card, int channel)
{
+ struct sk_buff_head *queue = &card->spqueue[channel];
struct sk_buff *skb;
while ((skb = skb_dequeue(queue)))
dev_kfree_skb(skb, FREE_WRITE);
+ card->sndcount[channel] = 0;
}
/* Put a value into a shift-register, highest bit first.
@@ -235,7 +257,7 @@ static inline void
icn_map_channel(icn_card * card, int channel)
{
#ifdef MAP_DEBUG
- printk(KERN_DEBUG "icn_map_channel %d %d\n", dev->channel, channel);
+ printk(KERN_DEBUG "icn_map_channel %d %d\n", dev.channel, channel);
#endif
if ((channel == dev.channel) && (card == dev.mcard))
return;
@@ -275,7 +297,7 @@ icn_lock_channel(icn_card * card, int channel)
} else {
retval = 0;
#ifdef MAP_DEBUG
- printk(KERN_DEBUG "icn_lock_channel %d FAILED, dc=%d\n", channel, device->channel);
+ printk(KERN_DEBUG "icn_lock_channel %d FAILED, dc=%d\n", channel, dev.channel);
#endif
}
restore_flags(flags);
@@ -291,7 +313,7 @@ icn_release_channel(void)
ulong flags;
#ifdef MAP_DEBUG
- printk(KERN_DEBUG "icn_release_channel l=%d\n", device->chanlock);
+ printk(KERN_DEBUG "icn_release_channel l=%d\n", dev.chanlock);
#endif
save_flags(flags);
cli();
@@ -501,7 +523,6 @@ typedef struct icn_stat {
int command;
int action;
} icn_stat;
-
/* *INDENT-OFF* */
static icn_stat icn_stat_table[] =
{
@@ -519,10 +540,13 @@ static icn_stat icn_stat_table[] =
{"NO D-CHAN", ISDN_STAT_NODCH, 0}, /* No D-channel available */
{"E_L1: ACT FAIL", ISDN_STAT_BHUP, 8}, /* Layer-1 activation failed */
{"E_L2: DATA LIN", ISDN_STAT_BHUP, 8}, /* Layer-2 data link lost */
+ {"E_L1: ACTIVATION FAILED",
+ ISDN_STAT_BHUP, 8}, /* Layer-1 activation failed */
{NULL, 0, -1}
};
/* *INDENT-ON* */
+
/*
* Check Statusqueue-Pointer from isdn-cards.
* If there are new status-replies from the interface, check
@@ -562,7 +586,7 @@ icn_parse_status(u_char * status, int channel, icn_card * card)
case 2:
card->flags &= ~((channel) ?
ICN_FLAGS_B2ACTIVE : ICN_FLAGS_B1ACTIVE);
- icn_free_queue(&card->spqueue[channel]);
+ icn_free_queue(card, channel);
save_flags(flags);
cli();
card->rcvidx[channel] = 0;
@@ -571,20 +595,28 @@ icn_parse_status(u_char * status, int channel, icn_card * card)
break;
case 3:
{
- char *s = strtok(status + 6, ",");
- strncpy(cmd.parm.setup.phone, s, sizeof(cmd.parm.setup.phone));
- s = strtok(NULL, ",");
- if (!strlen(s))
+ char *t = status + 6;
+ char *s = strpbrk(t, ",");
+
+ *s++ = '\0';
+ strncpy(cmd.parm.setup.phone, t,
+ sizeof(cmd.parm.setup.phone));
+ s = strpbrk(t = s, ",");
+ *s++ = '\0';
+ if (!strlen(t))
cmd.parm.setup.si1 = 0;
else
- cmd.parm.setup.si1 = simple_strtoul(s, NULL, 10);
- s = strtok(NULL, ",");
- if (!strlen(s))
+ cmd.parm.setup.si1 =
+ simple_strtoul(t, NULL, 10);
+ s = strpbrk(t = s, ",");
+ *s++ = '\0';
+ if (!strlen(t))
cmd.parm.setup.si2 = 0;
else
- cmd.parm.setup.si2 = simple_strtoul(s, NULL, 10);
- s = strtok(NULL, ",");
- strncpy(cmd.parm.setup.eazmsn, s, sizeof(cmd.parm.setup.eazmsn));
+ cmd.parm.setup.si2 =
+ simple_strtoul(t, NULL, 10);
+ strncpy(cmd.parm.setup.eazmsn, s,
+ sizeof(cmd.parm.setup.eazmsn));
}
cmd.parm.setup.plan = 0;
cmd.parm.setup.screen = 0;
@@ -613,6 +645,13 @@ icn_parse_status(u_char * status, int channel, icn_card * card)
strncpy(cmd.parm.num, status + 1, sizeof(cmd.parm.num) - 1);
break;
case 8:
+ dflag = 3;
+ card->flags &= ~ICN_FLAGS_B1ACTIVE;
+ icn_free_queue(card, 0);
+ save_flags(flags);
+ cli();
+ card->rcvidx[0] = 0;
+ restore_flags(flags);
cmd.arg = 0;
cmd.driver = card->myid;
card->interface.statcallb(&cmd);
@@ -621,6 +660,12 @@ icn_parse_status(u_char * status, int channel, icn_card * card)
cmd.driver = card->myid;
card->interface.statcallb(&cmd);
cmd.command = ISDN_STAT_BHUP;
+ card->flags &= ~ICN_FLAGS_B2ACTIVE;
+ icn_free_queue(card, 1);
+ save_flags(flags);
+ cli();
+ card->rcvidx[1] = 0;
+ restore_flags(flags);
cmd.arg = 1;
cmd.driver = card->myid;
card->interface.statcallb(&cmd);
@@ -867,12 +912,14 @@ icn_loadboot(u_char * buffer, icn_card * card)
#ifdef BOOT_DEBUG
printk(KERN_DEBUG "icn_loadboot called, buffaddr=%08lx\n", (ulong) buffer);
#endif
- if ((ret = verify_area(VERIFY_READ, (void *) buffer, ICN_CODE_STAGE1)))
- return ret;
if (!(codebuf = kmalloc(ICN_CODE_STAGE1, GFP_KERNEL))) {
printk(KERN_WARNING "icn: Could not allocate code buffer\n");
return -ENOMEM;
}
+ if ((ret = copy_from_user(codebuf, buffer, ICN_CODE_STAGE1))) {
+ kfree(codebuf);
+ return ret;
+ }
save_flags(flags);
cli();
if (!card->rvalid) {
@@ -920,7 +967,6 @@ icn_loadboot(u_char * buffer, icn_card * card)
icn_lock_channel(card, 0); /* Lock Bank 0 */
restore_flags(flags);
SLEEP(1);
- copy_from_user(codebuf, buffer, ICN_CODE_STAGE1);
memcpy_toio(dev.shmem, codebuf, ICN_CODE_STAGE1); /* Copy code */
#ifdef BOOT_DEBUG
printk(KERN_DEBUG "Bootloader transfered\n");
@@ -992,7 +1038,10 @@ icn_loadproto(u_char * buffer, icn_card * card)
while (left) {
if (sbfree) { /* If there is a free buffer... */
cnt = MIN(256, left);
- copy_from_user(codebuf, p, cnt);
+ if (copy_from_user(codebuf, p, cnt)) {
+ icn_maprelease_channel(card, 0);
+ return -EFAULT;
+ }
memcpy_toio(&sbuf_l, codebuf, cnt); /* copy data */
sbnext; /* switch to next buffer */
p += cnt;
@@ -1290,17 +1339,15 @@ icn_command(isdn_ctrl * c, icn_card * card)
case ICN_IOCTL_GETDOUBLE:
return (int) card->doubleS0;
case ICN_IOCTL_DEBUGVAR:
- if ((i = verify_area(VERIFY_WRITE,
- (void *) a,
- sizeof(ulong) * 2)))
+ if ((i = copy_to_user((char *) a,
+ (char *) &card, sizeof(ulong))))
return i;
- copy_to_user((char *) a,
- (char *) &card, sizeof(ulong));
a += sizeof(ulong);
{
ulong l = (ulong) & dev;
- copy_to_user((char *) a,
- (char *) &l, sizeof(ulong));
+ if ((i = copy_to_user((char *) a,
+ (char *) &l, sizeof(ulong))))
+ return i;
}
return 0;
case ICN_IOCTL_LOADBOOT:
@@ -1321,9 +1368,8 @@ icn_command(isdn_ctrl * c, icn_card * card)
case ICN_IOCTL_ADDCARD:
if (!dev.firstload)
return -EBUSY;
- if ((i = verify_area(VERIFY_READ, (void *) a, sizeof(icn_cdef))))
+ if ((i = copy_from_user((char *) &cdef, (char *) a, sizeof(cdef))))
return i;
- copy_from_user((char *) &cdef, (char *) a, sizeof(cdef));
return (icn_addcard(cdef.port, cdef.id1, cdef.id2));
break;
case ICN_IOCTL_LEASEDCFG:
@@ -1774,7 +1820,7 @@ cleanup_module(void)
card->rvalid = 0;
}
for (i = 0; i < ICN_BCH; i++)
- icn_free_queue(&card->spqueue[i]);
+ icn_free_queue(card, i);
}
card = card->next;
}
diff --git a/drivers/isdn/isdn_audio.c b/drivers/isdn/isdn_audio.c
index 72d5e97d9..89446a4fa 100644
--- a/drivers/isdn/isdn_audio.c
+++ b/drivers/isdn/isdn_audio.c
@@ -1,4 +1,4 @@
-/* $Id: isdn_audio.c,v 1.7 1997/02/03 22:44:11 fritz Exp $
+/* $Id: isdn_audio.c,v 1.8 1997/03/02 14:29:16 fritz Exp $
* Linux ISDN subsystem, audio conversion and compression (linklevel).
*
@@ -20,6 +20,9 @@
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
* $Log: isdn_audio.c,v $
+ * Revision 1.8 1997/03/02 14:29:16 fritz
+ * More ttyI related cleanup.
+ *
* Revision 1.7 1997/02/03 22:44:11 fritz
* Reformatted according CodingStyle
*
@@ -50,7 +53,7 @@
#include "isdn_audio.h"
#include "isdn_common.h"
-char *isdn_audio_revision = "$Revision: 1.7 $";
+char *isdn_audio_revision = "$Revision: 1.8 $";
/*
* Misc. lookup-tables.
@@ -529,14 +532,7 @@ isdn_audio_goertzel(int *sample, modem_info * info)
return;
}
SET_SKB_FREE(skb);
- if (skb_headroom(skb) < sizeof(isdn_audio_skb)) {
- printk(KERN_WARNING
- "isdn_audio: insufficient DTMF skb_headroom, dropping\n");
- dev_kfree_skb(skb, FREE_READ);
- return;
- }
result = (int *) skb_put(skb, sizeof(int) * NCOEFF);
- ISDN_AUDIO_SKB_DLECOUNT(skb) = 0;
for (k = 0; k < NCOEFF; k++) {
sk = sk1 = sk2 = 0;
for (n = 0; n < DTMF_NPOINTS; n++) {
@@ -597,6 +593,14 @@ isdn_audio_eval_dtmf(modem_info * info)
*p++ = 0x10;
*p = what;
skb_trim(skb, 2);
+ if (skb_headroom(skb) < sizeof(isdn_audio_skb)) {
+ printk(KERN_WARNING
+ "isdn_audio: insufficient skb_headroom, dropping\n");
+ kfree_skb(skb, FREE_READ);
+ return;
+ }
+ ISDN_AUDIO_SKB_DLECOUNT(skb) = 0;
+ ISDN_AUDIO_SKB_LOCK(skb) = 0;
save_flags(flags);
cli();
di = info->isdn_driver;
diff --git a/drivers/isdn/isdn_cards.c b/drivers/isdn/isdn_cards.c
index 84acdd552..c7f4e8b08 100644
--- a/drivers/isdn/isdn_cards.c
+++ b/drivers/isdn/isdn_cards.c
@@ -1,4 +1,4 @@
-/* $Id: isdn_cards.c,v 1.3 1997/02/03 23:31:14 fritz Exp $
+/* $Id: isdn_cards.c,v 1.6 1997/04/23 18:56:03 fritz Exp $
* Linux ISDN subsystem, initialization for non-modularized drivers.
*
@@ -19,6 +19,15 @@
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
* $Log: isdn_cards.c,v $
+ * Revision 1.6 1997/04/23 18:56:03 fritz
+ * Old Teles driver removed, Changed doc and scripts accordingly.
+ *
+ * Revision 1.5 1997/03/30 17:10:36 calle
+ * added support for AVM-B1-PCI card.
+ *
+ * Revision 1.4 1997/03/04 21:59:44 calle
+ * Added AVM-B1-CAPI2.0 driver
+ *
* Revision 1.3 1997/02/03 23:31:14 fritz
* Reformatted according CodingStyle
*
@@ -36,10 +45,6 @@
extern void icn_init(void);
#endif
-#ifdef CONFIG_ISDN_DRV_TELES
-extern void teles_init(void);
-#endif
-
#ifdef CONFIG_ISDN_DRV_HISAX
extern void HiSax_init(void);
#endif
@@ -48,19 +53,33 @@ extern void HiSax_init(void);
extern void pcbit_init(void);
#endif
+#ifdef CONFIG_ISDN_DRV_AVMB1
+extern void avmb1_init(void);
+extern void capi_init(void);
+extern void capidrv_init(void);
+#ifdef CONFIG_PCI
+extern int b1pci_init(void);
+#endif
+#endif
+
void
isdn_cards_init(void)
{
#if CONFIG_ISDN_DRV_ICN
icn_init();
#endif
-#if CONFIG_ISDN_DRV_TELES
- teles_init();
-#endif
#ifdef CONFIG_ISDN_DRV_HISAX
HiSax_init();
#endif
#if CONFIG_ISDN_DRV_PCBIT
pcbit_init();
#endif
+#ifdef CONFIG_ISDN_DRV_AVMB1
+ avmb1_init();
+#ifdef CONFIG_PCI
+ b1pci_init();
+#endif
+ capi_init();
+ capidrv_init();
+#endif
}
diff --git a/drivers/isdn/isdn_common.c b/drivers/isdn/isdn_common.c
index e69dc54c5..dcd251a01 100644
--- a/drivers/isdn/isdn_common.c
+++ b/drivers/isdn/isdn_common.c
@@ -1,4 +1,4 @@
-/* $Id: isdn_common.c,v 1.34 1997/02/10 20:12:43 fritz Exp $
+/* $Id: isdn_common.c,v 1.44 1997/05/27 15:17:23 fritz Exp $
* Linux ISDN subsystem, common used functions (linklevel).
*
@@ -21,6 +21,43 @@
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
* $Log: isdn_common.c,v $
+ * Revision 1.44 1997/05/27 15:17:23 fritz
+ * Added changes for recent 2.1.x kernels:
+ * changed return type of isdn_close
+ * queue_task_* -> queue_task
+ * clear/set_bit -> test_and_... where apropriate.
+ * changed type of hard_header_cache parameter.
+ *
+ * Revision 1.43 1997/03/31 14:09:43 fritz
+ * Fixed memory leak in isdn_close().
+ *
+ * Revision 1.42 1997/03/30 16:51:08 calle
+ * changed calls to copy_from_user/copy_to_user and removed verify_area
+ * were possible.
+ *
+ * Revision 1.41 1997/03/24 22:54:41 fritz
+ * Some small fixes in debug code.
+ *
+ * Revision 1.40 1997/03/08 08:13:51 fritz
+ * Bugfix: IIOCSETMAP (Set mapping) was broken.
+ *
+ * Revision 1.39 1997/03/07 01:32:54 fritz
+ * Added proper ifdef's for CONFIG_ISDN_AUDIO
+ *
+ * Revision 1.38 1997/03/05 21:15:02 fritz
+ * Fix: reduced stack usage of isdn_ioctl() and isdn_set_allcfg()
+ *
+ * Revision 1.37 1997/03/02 14:29:18 fritz
+ * More ttyI related cleanup.
+ *
+ * Revision 1.36 1997/02/28 02:32:40 fritz
+ * Cleanup: Moved some tty related stuff from isdn_common.c
+ * to isdn_tty.c
+ * Bugfix: Bisync protocol did not behave like documented.
+ *
+ * Revision 1.35 1997/02/21 13:01:19 fritz
+ * Changes CAUSE message output in kernel log.
+ *
* Revision 1.34 1997/02/10 20:12:43 fritz
* Changed interface for reporting incoming calls.
*
@@ -177,12 +214,11 @@
#include "isdn_cards.h"
/* Debugflags */
-#undef ISDN_DEBUG_STATCALLB
-#define NEW_ISDN_TIMER_CTRL
+#undef ISDN_DEBUG_STATCALLB
isdn_dev *dev = (isdn_dev *) 0;
-static char *isdn_revision = "$Revision: 1.34 $";
+static char *isdn_revision = "$Revision: 1.44 $";
extern char *isdn_net_revision;
extern char *isdn_tty_revision;
@@ -299,9 +335,6 @@ isdn_timer_funct(ulong dummy)
save_flags(flags);
cli();
del_timer(&dev->timer);
-#ifndef NEW_ISDN_TIMER_CTRL
- dev->timer.function = isdn_timer_funct;
-#endif
dev->timer.expires = jiffies + ISDN_TIMER_RES;
add_timer(&dev->timer);
restore_flags(flags);
@@ -324,20 +357,11 @@ isdn_timer_ctrl(int tf, int onoff)
dev->tflags |= tf;
else
dev->tflags &= ~tf;
-#ifdef NEW_ISDN_TIMER_CTRL
if (dev->tflags) {
if (!del_timer(&dev->timer)) /* del_timer is 1, when active */
dev->timer.expires = jiffies + ISDN_TIMER_RES;
add_timer(&dev->timer);
}
-#else
- if (dev->tflags) {
- del_timer(&dev->timer);
- dev->timer.function = isdn_timer_funct;
- dev->timer.expires = jiffies + ISDN_TIMER_RES;
- add_timer(&dev->timer);
- }
-#endif
restore_flags(flags);
}
@@ -347,13 +371,7 @@ isdn_timer_ctrl(int tf, int onoff)
static void
isdn_receive_skb_callback(int di, int channel, struct sk_buff *skb)
{
- ulong flags;
int i;
- int midx;
-#ifdef CONFIG_ISDN_AUDIO
- int ifmt;
-#endif
- modem_info *info;
if ((i = isdn_dc2minor(di, channel)) == -1) {
isdn_trash_skb(skb, FREE_READ);
@@ -367,86 +385,8 @@ isdn_receive_skb_callback(int di, int channel, struct sk_buff *skb)
/* No network-device found, deliver to tty or raw-channel */
SET_SKB_FREE(skb);
if (skb->len) {
- if ((midx = dev->m_idx[i]) < 0) {
- /* if midx is invalid, drop packet */
- isdn_trash_skb(skb, FREE_READ);
- return;
- }
- info = &dev->mdm.info[midx];
-#ifdef CONFIG_ISDN_AUDIO
- ifmt = 1;
-
- if (info->vonline)
- isdn_audio_calc_dtmf(info, skb->data, skb->len, ifmt);
-#endif
- if ((info->online < 2) &&
- (!(info->vonline & 1))) {
- /* If Modem not listening, drop data */
- isdn_trash_skb(skb, FREE_READ);
+ if (isdn_tty_rcv_skb(i, di, channel, skb))
return;
- }
- if (info->emu.mdmreg[13] & 2)
- /* T.70 decoding: Simply throw away the T.70 header (4 bytes) */
- if ((skb->data[0] == 1) && ((skb->data[1] == 0) || (skb->data[1] == 1)))
- skb_pull(skb, 4);
- if (skb_headroom(skb) < sizeof(isdn_audio_skb)) {
- printk(KERN_WARNING
- "isdn_audio: insufficient skb_headroom, dropping\n");
- isdn_trash_skb(skb, FREE_READ);
- return;
- }
- ISDN_AUDIO_SKB_DLECOUNT(skb) = 0;
- ISDN_AUDIO_SKB_LOCK(skb) = 0;
-#ifdef CONFIG_ISDN_AUDIO
- if (info->vonline & 1) {
- /* voice conversion/compression */
- switch (info->emu.vpar[3]) {
- case 2:
- case 3:
- case 4:
- /* adpcm
- * Since compressed data takes less
- * space, we can overwrite the buffer.
- */
- skb_trim(skb, isdn_audio_xlaw2adpcm(info->adpcmr,
- ifmt,
- skb->data,
- skb->data,
- skb->len));
- break;
- case 5:
- /* a-law */
- if (!ifmt)
- isdn_audio_ulaw2alaw(skb->data, skb->len);
- break;
- case 6:
- /* u-law */
- if (ifmt)
- isdn_audio_alaw2ulaw(skb->data, skb->len);
- break;
- }
- ISDN_AUDIO_SKB_DLECOUNT(skb) =
- isdn_tty_countDLE(skb->data, skb->len);
- }
-#endif
- /* Try to deliver directly via tty-flip-buf if queue is empty */
- save_flags(flags);
- cli();
- if (skb_queue_empty(&dev->drv[di]->rpqueue[channel]))
- if (isdn_tty_try_read(info, skb)) {
- restore_flags(flags);
- return;
- }
- /* Direct deliver failed or queue wasn't empty.
- * Queue up for later dequeueing via timer-irq.
- */
- __skb_queue_tail(&dev->drv[di]->rpqueue[channel], skb);
- dev->drv[di]->rcvcount[channel] +=
- (skb->len + ISDN_AUDIO_SKB_DLECOUNT(skb));
- restore_flags(flags);
- /* Schedule dequeuing */
- if ((dev->modempoll) && (info->rcvsched))
- isdn_timer_ctrl(ISDN_TIMER_MODEMREAD, 1);
wake_up_interruptible(&dev->drv[di]->rcv_waitq[channel]);
} else
isdn_trash_skb(skb, FREE_READ);
@@ -470,12 +410,10 @@ static int
isdn_status_callback(isdn_ctrl * c)
{
int di;
- int mi;
ulong flags;
int i;
int r;
int retval = 0;
- modem_info *info;
isdn_ctrl cmd;
di = c->driver;
@@ -488,7 +426,8 @@ isdn_status_callback(isdn_ctrl * c)
return 0;
if (isdn_net_stat_callback(i, c->command))
return 0;
- isdn_tty_bsent(di, c->arg);
+ if (isdn_tty_stat_callback(i, c))
+ return 0;
wake_up_interruptible(&dev->drv[di]->snd_waitq[c->arg]);
break;
case ISDN_STAT_STAVAIL:
@@ -511,7 +450,7 @@ isdn_status_callback(isdn_ctrl * c)
if (i < 0)
return -1;
#ifdef ISDN_DEBUG_STATCALLB
- printk(KERN_DEBUG "ICALL (net): %d %ld %s\n", di, c->arg, c->num);
+ printk(KERN_DEBUG "ICALL (net): %d %ld %s\n", di, c->arg, c->parm.num);
#endif
if (dev->global_flags & ISDN_GLOBAL_STOPPED) {
cmd.driver = di;
@@ -528,16 +467,12 @@ isdn_status_callback(isdn_ctrl * c)
r = isdn_net_find_icall(di, c->arg, i, c->parm.setup);
switch (r) {
case 0:
- /* No network-device replies. Schedule RING-message to
- * tty and set RI-bit of modem-status.
+ /* No network-device replies.
+ * Try ttyI's
*/
- if ((mi = isdn_tty_find_icall(di, c->arg, c->parm.setup)) >= 0) {
- info = &dev->mdm.info[mi];
- info->msr |= UART_MSR_RI;
- isdn_tty_modem_result(2, info);
- isdn_timer_ctrl(ISDN_TIMER_MODEMRING, 1);
+ if (isdn_tty_find_icall(di, c->arg, c->parm.setup) >= 0)
retval = 1;
- } else if (dev->drv[di]->reject_bus) {
+ else if (dev->drv[di]->reject_bus) {
cmd.driver = di;
cmd.arg = c->arg;
cmd.command = ISDN_CMD_HANGUP;
@@ -582,7 +517,7 @@ isdn_status_callback(isdn_ctrl * c)
if (i < 0)
return -1;
#ifdef ISDN_DEBUG_STATCALLB
- printk(KERN_DEBUG "CINF: %ld %s\n", c->arg, c->num);
+ printk(KERN_DEBUG "CINF: %ld %s\n", c->arg, c->parm.num);
#endif
if (dev->global_flags & ISDN_GLOBAL_STOPPED)
return 0;
@@ -591,14 +526,11 @@ isdn_status_callback(isdn_ctrl * c)
break;
case ISDN_STAT_CAUSE:
#ifdef ISDN_DEBUG_STATCALLB
- printk(KERN_DEBUG "CAUSE: %ld %s\n", c->arg, c->num);
+ printk(KERN_DEBUG "CAUSE: %ld %s\n", c->arg, c->parm.num);
#endif
- printk(KERN_INFO "isdn: cause: %s\n", c->parm.num);
- if ((mi = dev->m_idx[i]) >= 0) {
- /* Signal cause to tty-device */
- info = &dev->mdm.info[mi];
- strncpy(info->last_cause, c->parm.num, 5);
- }
+ printk(KERN_INFO "isdn: %s,ch%ld cause: %s\n",
+ dev->drvid[di], c->arg, c->parm.num);
+ isdn_tty_stat_callback(i, c);
break;
case ISDN_STAT_DCONN:
if (i < 0)
@@ -608,24 +540,16 @@ isdn_status_callback(isdn_ctrl * c)
#endif
if (dev->global_flags & ISDN_GLOBAL_STOPPED)
return 0;
- /* Find any network-device, waiting for D-channel setup */
+ /* Find any net-device, waiting for D-channel setup */
if (isdn_net_stat_callback(i, c->command))
break;
-
- if ((mi = dev->m_idx[i]) >= 0) {
- /* If any tty has just dialed-out, setup B-Channel */
- info = &dev->mdm.info[mi];
- if (info->flags &
- (ISDN_ASYNC_NORMAL_ACTIVE | ISDN_ASYNC_CALLOUT_ACTIVE)) {
- if (info->dialing == 1) {
- info->dialing = 2;
- cmd.driver = di;
- cmd.arg = c->arg;
- cmd.command = ISDN_CMD_ACCEPTB;
- dev->drv[di]->interface->command(&cmd);
- return 0;
- }
- }
+ /* Find any ttyI, waiting for D-channel setup */
+ if (isdn_tty_stat_callback(i, c)) {
+ cmd.driver = di;
+ cmd.arg = c->arg;
+ cmd.command = ISDN_CMD_ACCEPTB;
+ dev->drv[di]->interface->command(&cmd);
+ break;
}
break;
case ISDN_STAT_DHUP:
@@ -641,24 +565,8 @@ isdn_status_callback(isdn_ctrl * c)
/* Signal hangup to network-devices */
if (isdn_net_stat_callback(i, c->command))
break;
- if ((mi = dev->m_idx[i]) >= 0) {
- /* Signal hangup to tty-device */
- info = &dev->mdm.info[mi];
- if (info->flags &
- (ISDN_ASYNC_NORMAL_ACTIVE | ISDN_ASYNC_CALLOUT_ACTIVE)) {
- if (info->dialing == 1) {
- info->dialing = 0;
- isdn_tty_modem_result(7, info);
- }
- if (info->online)
- isdn_tty_modem_result(3, info);
-#ifdef ISDN_DEBUG_MODEM_HUP
- printk(KERN_DEBUG "Mhup in ISDN_STAT_DHUP\n");
-#endif
- isdn_tty_modem_hup(info, 0);
- return 0;
- }
- }
+ if (isdn_tty_stat_callback(i, c))
+ break;
break;
case ISDN_STAT_BCONN:
if (i < 0)
@@ -673,26 +581,8 @@ isdn_status_callback(isdn_ctrl * c)
isdn_info_update();
if (isdn_net_stat_callback(i, c->command))
break;
- if ((mi = dev->m_idx[i]) >= 0) {
- /* Schedule CONNECT-Message to any tty, waiting for it and
- * set DCD-bit of its modem-status.
- */
- info = &dev->mdm.info[mi];
- if (info->flags &
- (ISDN_ASYNC_NORMAL_ACTIVE | ISDN_ASYNC_CALLOUT_ACTIVE)) {
- info->msr |= UART_MSR_DCD;
- if (info->dialing) {
- info->dialing = 0;
- info->last_dir = 1;
- } else
- info->last_dir = 0;
- info->rcvsched = 1;
- if (USG_MODEM(dev->usage[i]))
- isdn_tty_modem_result(5, info);
- if (USG_VOICE(dev->usage[i]))
- isdn_tty_modem_result(11, info);
- }
- }
+ if (isdn_tty_stat_callback(i, c))
+ break;
break;
case ISDN_STAT_BHUP:
if (i < 0)
@@ -704,20 +594,8 @@ isdn_status_callback(isdn_ctrl * c)
return 0;
dev->drv[di]->flags &= ~(1 << (c->arg));
isdn_info_update();
- if ((mi = dev->m_idx[i]) >= 0) {
- /* Signal hangup to tty-device, schedule NO CARRIER-message */
- info = &dev->mdm.info[mi];
- if (info->flags &
- (ISDN_ASYNC_NORMAL_ACTIVE | ISDN_ASYNC_CALLOUT_ACTIVE)) {
- if (info->msr & UART_MSR_DCD)
- isdn_tty_modem_result(3, info);
- info->msr &= ~(UART_MSR_DCD | UART_MSR_RI);
-#ifdef ISDN_DEBUG_MODEM_HUP
- printk(KERN_DEBUG "Mhup in ISDN_STAT_BHUP\n");
-#endif
- isdn_tty_modem_hup(info, 0);
- }
- }
+ if (isdn_tty_stat_callback(i, c))
+ break;
break;
case ISDN_STAT_NODCH:
if (i < 0)
@@ -729,47 +607,20 @@ isdn_status_callback(isdn_ctrl * c)
return 0;
if (isdn_net_stat_callback(i, c->command))
break;
- if ((mi = dev->m_idx[i]) >= 0) {
- info = &dev->mdm.info[mi];
- if (info->flags &
- (ISDN_ASYNC_NORMAL_ACTIVE | ISDN_ASYNC_CALLOUT_ACTIVE)) {
- if (info->dialing) {
- info->dialing = 0;
- info->last_l2 = -1;
- info->last_si = 0;
- sprintf(info->last_cause, "0000");
- isdn_tty_modem_result(6, info);
- }
- info->msr &= ~UART_MSR_DCD;
- if (info->online) {
- isdn_tty_modem_result(3, info);
- info->online = 0;
- }
- }
- }
+ if (isdn_tty_stat_callback(i, c))
+ break;
break;
case ISDN_STAT_ADDCH:
break;
case ISDN_STAT_UNLOAD:
save_flags(flags);
cli();
+ isdn_tty_stat_callback(i, c);
for (i = 0; i < ISDN_MAX_CHANNELS; i++)
if (dev->drvmap[i] == di) {
dev->drvmap[i] = -1;
dev->chanmap[i] = -1;
}
- for (i = 0; i < ISDN_MAX_CHANNELS; i++) {
- modem_info *info = &dev->mdm.info[i];
-
- if (info->isdn_driver == di) {
- info->isdn_driver = -1;
- info->isdn_channel = -1;
- if (info->online) {
- isdn_tty_modem_result(3, info);
- isdn_tty_modem_hup(info, 1);
- }
- }
- }
dev->drivers--;
dev->channels -= dev->drv[di]->channels;
kfree(dev->drv[di]->rcverr);
@@ -835,6 +686,7 @@ isdn_readbchan(int di, int channel, u_char * buf, u_char * fp, int len, int user
while (left) {
if (!(skb = skb_peek(&dev->drv[di]->rpqueue[channel])))
break;
+#ifdef CONFIG_ISDN_AUDIO
if (ISDN_AUDIO_SKB_LOCK(skb))
break;
ISDN_AUDIO_SKB_LOCK(skb) = 1;
@@ -868,6 +720,7 @@ isdn_readbchan(int di, int channel, u_char * buf, u_char * fp, int len, int user
if (count_pull >= skb->len)
dflag = 1;
} else {
+#endif
/* No DLE's in buff, so simply copy it */
dflag = 1;
if ((count_pull = skb->len) > left) {
@@ -881,7 +734,9 @@ isdn_readbchan(int di, int channel, u_char * buf, u_char * fp, int len, int user
memcpy(cp, skb->data, count_put);
cp += count_put;
left -= count_put;
+#ifdef CONFIG_ISDN_AUDIO
}
+#endif
count += count_put;
if (fp) {
memset(fp, 0, count_put);
@@ -893,7 +748,9 @@ isdn_readbchan(int di, int channel, u_char * buf, u_char * fp, int len, int user
*/
if (fp)
*(fp - 1) = 0xff;
+#ifdef CONFIG_ISDN_AUDIO
ISDN_AUDIO_SKB_LOCK(skb) = 0;
+#endif
skb = skb_dequeue(&dev->drv[di]->rpqueue[channel]);
isdn_trash_skb(skb, FREE_READ);
} else {
@@ -902,7 +759,9 @@ isdn_readbchan(int di, int channel, u_char * buf, u_char * fp, int len, int user
* but we pull off the data we got until now.
*/
skb_pull(skb, count_pull);
+#ifdef CONFIG_ISDN_AUDIO
ISDN_AUDIO_SKB_LOCK(skb) = 0;
+#endif
}
dev->drv[di]->rcvcount[channel] -= count_put;
}
@@ -1008,7 +867,8 @@ isdn_read(struct inode *inode, struct file *file, char *buf, RWARG count)
p = isdn_statstr();
file->private_data = 0;
if ((len = strlen(p)) <= count) {
- copy_to_user(buf, p, len);
+ if (copy_to_user(buf, p, len))
+ return -EFAULT;
file->f_pos += len;
return len;
}
@@ -1190,29 +1050,24 @@ isdn_set_allcfg(char *src)
int ret;
int i;
ulong flags;
- char buf[1024];
isdn_net_ioctl_cfg cfg;
isdn_net_ioctl_phone phone;
if ((ret = isdn_net_rmall()))
return ret;
+ if ((ret = copy_from_user((char *) &i, src, sizeof(int))))
+ return ret;
save_flags(flags);
cli();
- if ((ret = verify_area(VERIFY_READ, (void *) src, sizeof(int)))) {
- restore_flags(flags);
- return ret;
- }
- copy_from_user((char *) &i, src, sizeof(int));
src += sizeof(int);
while (i) {
- char *c;
- char *c2;
+ int phone_len;
+ int out_flag;
- if ((ret = verify_area(VERIFY_READ, (void *) src, sizeof(cfg)))) {
+ if ((ret = copy_from_user((char *) &cfg, src, sizeof(cfg)))) {
restore_flags(flags);
return ret;
}
- copy_from_user((char *) &cfg, src, sizeof(cfg));
src += sizeof(cfg);
if (!isdn_net_new(cfg.name, NULL)) {
restore_flags(flags);
@@ -1222,49 +1077,31 @@ isdn_set_allcfg(char *src)
restore_flags(flags);
return ret;
}
- if ((ret = verify_area(VERIFY_READ, (void *) src, sizeof(buf)))) {
- restore_flags(flags);
- return ret;
- }
- copy_from_user(buf, src, sizeof(buf));
- src += sizeof(buf);
- c = buf;
- while (*c) {
- if ((c2 = strchr(c, ' ')))
- *c2++ = '\0';
- strcpy(phone.phone, c);
- strcpy(phone.name, cfg.name);
- phone.outgoing = 0;
- if ((ret = isdn_net_addphone(&phone))) {
+ phone_len = out_flag = 0;
+ while (out_flag < 2) {
+ if ((ret = verify_area(VERIFY_READ, src, 1))) {
restore_flags(flags);
return ret;
}
- if (c2)
- c = c2;
- else
- c += strlen(c);
- }
- if ((ret = verify_area(VERIFY_READ, (void *) src, sizeof(buf)))) {
- restore_flags(flags);
- return ret;
- }
- copy_from_user(buf, src, sizeof(buf));
- src += sizeof(buf);
- c = buf;
- while (*c) {
- if ((c2 = strchr(c, ' ')))
- *c2++ = '\0';
- strcpy(phone.phone, c);
- strcpy(phone.name, cfg.name);
- phone.outgoing = 1;
- if ((ret = isdn_net_addphone(&phone))) {
- restore_flags(flags);
- return ret;
+ GET_USER(phone.phone[phone_len], src++);
+ if ((phone.phone[phone_len] == ' ') ||
+ (phone.phone[phone_len] == '\0')) {
+ if (phone_len) {
+ phone.phone[phone_len] = '\0';
+ strcpy(phone.name, cfg.name);
+ phone.outgoing = out_flag;
+ if ((ret = isdn_net_addphone(&phone))) {
+ restore_flags(flags);
+ return ret;
+ }
+ } else
+ out_flag++;
+ phone_len = 0;
}
- if (c2)
- c = c2;
- else
- c += strlen(c);
+ if (++phone_len >= sizeof(phone.phone))
+ printk(KERN_WARNING
+ "%s: IIOCSETSET phone number too long, ignored\n",
+ cfg.name);
}
i--;
}
@@ -1307,9 +1144,15 @@ isdn_get_allcfg(char *dest)
cfg.chargehup = (p->local.hupflags & ISDN_CHARGEHUP) ? 1 : 0;
cfg.ihup = (p->local.hupflags & ISDN_INHUP) ? 1 : 0;
cfg.chargeint = p->local.chargeint;
- copy_to_user(dest, p->local.name, 10);
+ if (copy_to_user(dest, p->local.name, 10)) {
+ restore_flags(flags);
+ return -EFAULT;
+ }
dest += 10;
- copy_to_user(dest, (char *) &cfg, sizeof(cfg));
+ if (copy_to_user(dest, (char *) &cfg, sizeof(cfg))) {
+ restore_flags(flags);
+ return -EFAULT;
+ }
dest += sizeof(cfg);
strcpy(phone.name, p->local.name);
phone.outgoing = 0;
@@ -1340,12 +1183,22 @@ isdn_ioctl(struct inode *inode, struct file *file, uint cmd, ulong arg)
int drvidx;
int chidx;
int ret;
+ int i;
+ char *p;
char *s;
- char name[10];
- char bname[21];
- isdn_ioctl_struct iocts;
- isdn_net_ioctl_phone phone;
- isdn_net_ioctl_cfg cfg;
+ union iocpar {
+ char name[10];
+ char bname[22];
+ isdn_ioctl_struct iocts;
+ isdn_net_ioctl_phone phone;
+ isdn_net_ioctl_cfg cfg;
+ } iocpar;
+
+#define name iocpar.name
+#define bname iocpar.bname
+#define iocts iocpar.iocts
+#define phone iocpar.phone
+#define cfg iocpar.cfg
if (minor == ISDN_MINOR_STATUS) {
switch (cmd) {
@@ -1389,62 +1242,54 @@ isdn_ioctl(struct inode *inode, struct file *file, uint cmd, ulong arg)
case IIOCNETAIF:
/* Add a network-interface */
if (arg) {
- if ((ret = verify_area(VERIFY_READ, (void *) arg, sizeof(name))))
+ if ((ret = copy_from_user(name, (char *) arg, sizeof(name))))
return ret;
- copy_from_user(name, (char *) arg, sizeof(name));
s = name;
} else
s = NULL;
if ((s = isdn_net_new(s, NULL))) {
- if ((ret = verify_area(VERIFY_WRITE, (void *) arg, strlen(s) + 1)))
+ if ((ret = copy_to_user((char *) arg, s, strlen(s) + 1)))
return ret;
- copy_to_user((char *) arg, s, strlen(s) + 1);
return 0;
} else
return -ENODEV;
case IIOCNETASL:
/* Add a slave to a network-interface */
if (arg) {
- if ((ret = verify_area(VERIFY_READ, (void *) arg, sizeof(bname))))
+ if ((ret = copy_from_user(bname, (char *) arg, sizeof(bname) - 1)))
return ret;
- copy_from_user(bname, (char *) arg, sizeof(bname));
} else
return -EINVAL;
if ((s = isdn_net_newslave(bname))) {
- if ((ret = verify_area(VERIFY_WRITE, (void *) arg, strlen(s) + 1)))
+ if ((ret = copy_to_user((char *) arg, s, strlen(s) + 1)))
return ret;
- copy_to_user((char *) arg, s, strlen(s) + 1);
return 0;
} else
return -ENODEV;
case IIOCNETDIF:
/* Delete a network-interface */
if (arg) {
- if ((ret = verify_area(VERIFY_READ, (void *) arg, sizeof(name))))
+ if ((ret = copy_from_user(name, (char *) arg, sizeof(name))))
return ret;
- copy_from_user(name, (char *) arg, sizeof(name));
return isdn_net_rm(name);
} else
return -EINVAL;
case IIOCNETSCF:
/* Set configurable parameters of a network-interface */
if (arg) {
- if ((ret = verify_area(VERIFY_READ, (void *) arg, sizeof(cfg))))
+ if ((ret = copy_from_user((char *) &cfg, (char *) arg, sizeof(cfg))))
return ret;
- copy_from_user((char *) &cfg, (char *) arg, sizeof(cfg));
return isdn_net_setcfg(&cfg);
} else
return -EINVAL;
case IIOCNETGCF:
/* Get configurable parameters of a network-interface */
if (arg) {
- if ((ret = verify_area(VERIFY_READ, (void *) arg, sizeof(cfg))))
+ if ((ret = copy_from_user((char *) &cfg, (char *) arg, sizeof(cfg))))
return ret;
- copy_from_user((char *) &cfg, (char *) arg, sizeof(cfg));
if (!(ret = isdn_net_getcfg(&cfg))) {
- if ((ret = verify_area(VERIFY_WRITE, (void *) arg, sizeof(cfg))))
+ if ((ret = copy_to_user((char *) arg, (char *) &cfg, sizeof(cfg))))
return ret;
- copy_to_user((char *) arg, (char *) &cfg, sizeof(cfg));
}
return ret;
} else
@@ -1452,70 +1297,56 @@ isdn_ioctl(struct inode *inode, struct file *file, uint cmd, ulong arg)
case IIOCNETANM:
/* Add a phone-number to a network-interface */
if (arg) {
- if ((ret = verify_area(VERIFY_READ, (void *) arg, sizeof(phone))))
+ if ((ret = copy_from_user((char *) &phone, (char *) arg, sizeof(phone))))
return ret;
- copy_from_user((char *) &phone, (char *) arg, sizeof(phone));
return isdn_net_addphone(&phone);
} else
return -EINVAL;
case IIOCNETGNM:
/* Get list of phone-numbers of a network-interface */
if (arg) {
- if ((ret = verify_area(VERIFY_READ, (void *) arg, sizeof(phone))))
+ if ((ret = copy_from_user((char *) &phone, (char *) arg, sizeof(phone))))
return ret;
- copy_from_user((char *) &phone, (char *) arg, sizeof(phone));
return isdn_net_getphones(&phone, (char *) arg);
} else
return -EINVAL;
case IIOCNETDNM:
/* Delete a phone-number of a network-interface */
if (arg) {
- if ((ret = verify_area(VERIFY_READ, (void *) arg, sizeof(phone))))
+ if ((ret = copy_from_user((char *) &phone, (char *) arg, sizeof(phone))))
return ret;
- copy_from_user((char *) &phone, (char *) arg, sizeof(phone));
return isdn_net_delphone(&phone);
} else
return -EINVAL;
case IIOCNETDIL:
/* Force dialing of a network-interface */
if (arg) {
- if ((ret = verify_area(VERIFY_READ, (void *) arg, sizeof(name))))
+ if ((ret = copy_from_user(name, (char *) arg, sizeof(name))))
return ret;
- copy_from_user(name, (char *) arg, sizeof(name));
return isdn_net_force_dial(name);
} else
return -EINVAL;
#ifdef CONFIG_ISDN_PPP
case IIOCNETALN:
- if (arg) {
- if ((ret = verify_area(VERIFY_READ,
- (void *) arg,
- sizeof(name))))
- return ret;
- } else
+ if (!arg)
return -EINVAL;
- copy_from_user(name, (char *) arg, sizeof(name));
+ if ((ret = copy_from_user(name, (char *) arg, sizeof(name))))
+ return ret;
return isdn_ppp_dial_slave(name);
case IIOCNETDLN:
- if (arg) {
- if ((ret = verify_area(VERIFY_READ,
- (void *) arg,
- sizeof(name))))
- return ret;
- } else
+ if (!arg)
return -EINVAL;
- copy_from_user(name, (char *) arg, sizeof(name));
+ if ((ret = copy_from_user(name, (char *) arg, sizeof(name))))
+ return ret;
return isdn_ppp_hangup_slave(name);
#endif
case IIOCNETHUP:
/* Force hangup of a network-interface */
- if (arg) {
- if ((ret = verify_area(VERIFY_READ, (void *) arg, sizeof(name))))
- return ret;
- copy_from_user(name, (char *) arg, sizeof(name));
- return isdn_net_force_hangup(name);
- } else
+ if (!arg)
return -EINVAL;
+ if ((ret = copy_from_user(name, (char *) arg, sizeof(name))))
+ return ret;
+ return isdn_net_force_hangup(name);
break;
#endif /* CONFIG_NETDEVICES */
case IIOCSETVER:
@@ -1535,11 +1366,9 @@ isdn_ioctl(struct inode *inode, struct file *file, uint cmd, ulong arg)
if (arg) {
int i;
char *p;
- if ((ret = verify_area(VERIFY_READ, (void *) arg,
- sizeof(isdn_ioctl_struct))))
+ if ((ret = copy_from_user((char *) &iocts, (char *) arg,
+ sizeof(isdn_ioctl_struct))))
return ret;
- copy_from_user((char *) &iocts, (char *) arg,
- sizeof(isdn_ioctl_struct));
if (strlen(iocts.drvid)) {
if ((p = strchr(iocts.drvid, ',')))
*p = 0;
@@ -1587,10 +1416,12 @@ isdn_ioctl(struct inode *inode, struct file *file, uint cmd, ulong arg)
return ret;
for (i = 0; i < ISDN_MAX_CHANNELS; i++) {
- copy_to_user(p, dev->mdm.info[i].emu.profile,
- ISDN_MODEM_ANZREG);
+ if (copy_to_user(p, dev->mdm.info[i].emu.profile,
+ ISDN_MODEM_ANZREG))
+ return -EFAULT;
p += ISDN_MODEM_ANZREG;
- copy_to_user(p, dev->mdm.info[i].emu.pmsn, ISDN_MSNLEN);
+ if (copy_to_user(p, dev->mdm.info[i].emu.pmsn, ISDN_MSNLEN))
+ return -EFAULT;
p += ISDN_MSNLEN;
}
return (ISDN_MODEM_ANZREG + ISDN_MSNLEN) * ISDN_MAX_CHANNELS;
@@ -1609,10 +1440,12 @@ isdn_ioctl(struct inode *inode, struct file *file, uint cmd, ulong arg)
return ret;
for (i = 0; i < ISDN_MAX_CHANNELS; i++) {
- copy_from_user(dev->mdm.info[i].emu.profile, p,
- ISDN_MODEM_ANZREG);
+ if ((ret = copy_from_user(dev->mdm.info[i].emu.profile, p,
+ ISDN_MODEM_ANZREG)))
+ return ret;
p += ISDN_MODEM_ANZREG;
- copy_from_user(dev->mdm.info[i].emu.pmsn, p, ISDN_MSNLEN);
+ if ((ret = copy_from_user(dev->mdm.info[i].emu.pmsn, p, ISDN_MSNLEN)))
+ return ret;
p += ISDN_MSNLEN;
}
return 0;
@@ -1623,14 +1456,11 @@ isdn_ioctl(struct inode *inode, struct file *file, uint cmd, ulong arg)
case IIOCGETMAP:
/* Set/Get MSN->EAZ-Mapping for a driver */
if (arg) {
- int i;
- char *p;
- char nstring[255];
- if ((ret = verify_area(VERIFY_READ, (void *) arg,
+ if ((ret = copy_from_user((char *) &iocts,
+ (char *) arg,
sizeof(isdn_ioctl_struct))))
return ret;
- copy_from_user((char *) &iocts, (char *) arg, sizeof(isdn_ioctl_struct));
if (strlen(iocts.drvid)) {
drvidx = -1;
for (i = 0; i < ISDN_MAX_DRIVERS; i++)
@@ -1643,37 +1473,54 @@ isdn_ioctl(struct inode *inode, struct file *file, uint cmd, ulong arg)
if (drvidx == -1)
return -ENODEV;
if (cmd == IIOCSETMAP) {
- if ((ret = verify_area(VERIFY_READ, (void *) iocts.arg, 255)))
- return ret;
- copy_from_user(nstring, (char *) iocts.arg, 255);
- memset(dev->drv[drvidx]->msn2eaz, 0,
- sizeof(dev->drv[drvidx]->msn2eaz));
- p = strtok(nstring, ",");
+ int loop = 1;
+
+ p = (char *) iocts.arg;
i = 0;
- while ((p) && (i < 10)) {
- strcpy(dev->drv[drvidx]->msn2eaz[i++], p);
- p = strtok(NULL, ",");
+ while (loop) {
+ int j = 0;
+
+ while (1) {
+ if ((ret = verify_area(VERIFY_READ, p, 1)))
+ return ret;
+ GET_USER(bname[j], p++);
+ switch (bname[j]) {
+ case '\0':
+ loop = 0;
+ /* Fall through */
+ case ',':
+ bname[j] = '\0';
+ strcpy(dev->drv[drvidx]->msn2eaz[i], bname);
+ j = ISDN_MSNLEN;
+ break;
+ default:
+ j++;
+ }
+ if (j >= ISDN_MSNLEN)
+ break;
+ }
+ if (++i > 9)
+ break;
}
} else {
- p = nstring;
- for (i = 0; i < 10; i++)
- p += sprintf(p, "%s%s",
- strlen(dev->drv[drvidx]->msn2eaz[i]) ?
- dev->drv[drvidx]->msn2eaz[i] : "-",
- (i < 9) ? "," : "\0");
- if ((ret = verify_area(VERIFY_WRITE, (void *) iocts.arg,
- strlen(nstring) + 1)))
- return ret;
- copy_to_user((char *) iocts.arg, nstring, strlen(nstring) + 1);
+ p = (char *) iocts.arg;
+ for (i = 0; i < 10; i++) {
+ sprintf(bname, "%s%s",
+ strlen(dev->drv[drvidx]->msn2eaz[i]) ?
+ dev->drv[drvidx]->msn2eaz[i] : "-",
+ (i < 9) ? "," : "\0");
+ if ((ret = copy_to_user(p, bname, strlen(bname) + 1)))
+ return ret;
+ p += strlen(bname);
+ }
}
return 0;
} else
return -EINVAL;
case IIOCDBGVAR:
if (arg) {
- if ((ret = verify_area(VERIFY_WRITE, (void *) arg, sizeof(ulong))))
+ if ((ret = copy_to_user((char *) arg, (char *) &dev, sizeof(ulong))))
return ret;
- copy_to_user((char *) arg, (char *) &dev, sizeof(ulong));
return 0;
} else
return -EINVAL;
@@ -1686,10 +1533,8 @@ isdn_ioctl(struct inode *inode, struct file *file, uint cmd, ulong arg)
if (arg) {
int i;
char *p;
- if ((ret = verify_area(VERIFY_READ, (void *) arg,
- sizeof(isdn_ioctl_struct))))
+ if ((ret = copy_from_user((char *) &iocts, (char *) arg, sizeof(isdn_ioctl_struct))))
return ret;
- copy_from_user((char *) &iocts, (char *) arg, sizeof(isdn_ioctl_struct));
if (strlen(iocts.drvid)) {
if ((p = strchr(iocts.drvid, ',')))
*p = 0;
@@ -1712,7 +1557,8 @@ isdn_ioctl(struct inode *inode, struct file *file, uint cmd, ulong arg)
memcpy(c.parm.num, (char *) &iocts.arg, sizeof(ulong));
ret = dev->drv[drvidx]->interface->command(&c);
memcpy((char *) &iocts.arg, c.parm.num, sizeof(ulong));
- copy_to_user((char *) arg, &iocts, sizeof(isdn_ioctl_struct));
+ if ((copy_to_user((char *) arg, &iocts, sizeof(isdn_ioctl_struct))))
+ return -EFAULT;
return ret;
} else
return -EINVAL;
@@ -1723,6 +1569,12 @@ isdn_ioctl(struct inode *inode, struct file *file, uint cmd, ulong arg)
return (isdn_ppp_ioctl(minor - ISDN_MINOR_PPP, file, cmd, arg));
#endif
return -ENODEV;
+
+#undef name
+#undef bname
+#undef iocts
+#undef phone
+#undef cfg
}
/*
@@ -1790,7 +1642,7 @@ isdn_open(struct inode *ino, struct file *filep)
return -ENODEV;
}
-static int
+static CLOSETYPE
isdn_close(struct inode *ino, struct file *filep)
{
uint minor = MINOR(ino->i_rdev);
@@ -1807,39 +1659,40 @@ isdn_close(struct inode *ino, struct file *filep)
q->next = p->next;
else
dev->infochain = (infostruct *) (p->next);
- return 0;
+ kfree(p);
+ return CLOSEVAL;
}
q = p;
p = (infostruct *) (p->next);
}
printk(KERN_WARNING "isdn: No private data while closing isdnctrl\n");
- return 0;
+ return CLOSEVAL;
}
if (minor < ISDN_MINOR_CTRL) {
drvidx = isdn_minor2drv(minor);
if (drvidx < 0)
- return;
+ return CLOSEVAL;
c.command = ISDN_CMD_UNLOCK;
c.driver = drvidx;
(void) dev->drv[drvidx]->interface->command(&c);
- return 0;
+ return CLOSEVAL;
}
if (minor <= ISDN_MINOR_CTRLMAX) {
drvidx = isdn_minor2drv(minor - ISDN_MINOR_CTRL);
if (drvidx < 0)
- return 0;
+ return CLOSEVAL;
if (dev->profd == current)
dev->profd = NULL;
c.command = ISDN_CMD_UNLOCK;
c.driver = drvidx;
(void) dev->drv[drvidx]->interface->command(&c);
- return 0;
+ return CLOSEVAL;
}
#ifdef CONFIG_ISDN_PPP
if (minor <= ISDN_MINOR_PPPMAX)
isdn_ppp_release(minor - ISDN_MINOR_PPP, filep);
#endif
- return 0;
+ return CLOSEVAL;
}
static struct file_operations isdn_fops =
@@ -2238,10 +2091,8 @@ isdn_init(void)
return -EIO;
}
memset((char *) dev, 0, sizeof(isdn_dev));
-#ifdef NEW_ISDN_TIMER_CTRL
init_timer(&dev->timer);
dev->timer.function = isdn_timer_funct;
-#endif
for (i = 0; i < ISDN_MAX_CHANNELS; i++) {
dev->drvmap[i] = -1;
dev->chanmap[i] = -1;
diff --git a/drivers/isdn/isdn_common.h b/drivers/isdn/isdn_common.h
index 2d3dbd95a..d0df7fe79 100644
--- a/drivers/isdn/isdn_common.h
+++ b/drivers/isdn/isdn_common.h
@@ -1,4 +1,4 @@
-/* $Id: isdn_common.h,v 1.5 1997/02/10 10:05:45 fritz Exp $
+/* $Id: isdn_common.h,v 1.6 1997/02/28 02:32:44 fritz Exp $
* header for Linux ISDN subsystem, common used functions and debugging-switches (linklevel).
*
@@ -21,6 +21,11 @@
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
* $Log: isdn_common.h,v $
+ * Revision 1.6 1997/02/28 02:32:44 fritz
+ * Cleanup: Moved some tty related stuff from isdn_common.c
+ * to isdn_tty.c
+ * Bugfix: Bisync protocol did not behave like documented.
+ *
* Revision 1.5 1997/02/10 10:05:45 fritz
* More changes for Kernel 2.1.X
* Symbol information moved to isdn_syms.c
@@ -45,6 +50,7 @@
#undef ISDN_DEBUG_MODEM_HUP
#undef ISDN_DEBUG_MODEM_ICALL
#undef ISDN_DEBUG_MODEM_DUMP
+#undef ISDN_DEBUG_MODEM_VOICE
#undef ISDN_DEBUG_AT
#undef ISDN_DEBUG_NET_DUMP
#undef ISDN_DEBUG_NET_DIAL
diff --git a/drivers/isdn/isdn_net.c b/drivers/isdn/isdn_net.c
index 7d7bdad8d..a1866f07f 100644
--- a/drivers/isdn/isdn_net.c
+++ b/drivers/isdn/isdn_net.c
@@ -1,4 +1,4 @@
-/* $Id: isdn_net.c,v 1.37 1997/02/11 18:32:51 fritz Exp $
+/* $Id: isdn_net.c,v 1.44 1997/05/27 15:17:26 fritz Exp $
* Linux ISDN subsystem, network interfaces and related functions (linklevel).
*
@@ -21,6 +21,32 @@
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
* $Log: isdn_net.c,v $
+ * Revision 1.44 1997/05/27 15:17:26 fritz
+ * Added changes for recent 2.1.x kernels:
+ * changed return type of isdn_close
+ * queue_task_* -> queue_task
+ * clear/set_bit -> test_and_... where apropriate.
+ * changed type of hard_header_cache parameter.
+ *
+ * Revision 1.43 1997/03/30 16:51:13 calle
+ * changed calls to copy_from_user/copy_to_user and removed verify_area
+ * were possible.
+ *
+ * Revision 1.42 1997/03/11 08:43:51 fritz
+ * Perform a hangup if number is deleted while dialing.
+ *
+ * Revision 1.41 1997/03/08 08:16:31 fritz
+ * Bugfix: Deleting a phone number during dial gave unpredictable results.
+ *
+ * Revision 1.40 1997/03/05 21:16:08 fritz
+ * Fix: did not compile with 2.1.27
+ *
+ * Revision 1.39 1997/03/04 21:36:52 fritz
+ * Added sending ICMP messages when no connetion is possible.
+ *
+ * Revision 1.38 1997/02/23 23:41:14 fritz
+ * Bugfix: Slave interfaces have to be hung up before master.
+ *
* Revision 1.37 1997/02/11 18:32:51 fritz
* Bugfix in isdn_ppp_free_mpqueue().
*
@@ -170,6 +196,7 @@
#include <linux/isdn.h>
#include <linux/if_arp.h>
#include <net/arp.h>
+#include <net/icmp.h>
#include "isdn_common.h"
#include "isdn_net.h"
#ifdef CONFIG_ISDN_PPP
@@ -184,13 +211,25 @@ static int isdn_net_start_xmit(struct sk_buff *, struct device *);
static int isdn_net_xmit(struct device *, isdn_net_local *, struct sk_buff *);
static void dev_purge_queues(struct device *dev); /* move this to net/core/dev.c */
-char *isdn_net_revision = "$Revision: 1.37 $";
+char *isdn_net_revision = "$Revision: 1.44 $";
/*
* Code for raw-networking over ISDN
*/
static void
+isdn_net_unreachable(struct device *dev, struct sk_buff *skb, char *reason)
+{
+ printk(KERN_DEBUG "isdn_net: %s: %s, send ICMP\n",
+ dev->name, reason);
+ icmp_send(skb, ICMP_DEST_UNREACH, ICMP_HOST_UNREACH, 0
+#if (LINUX_VERSION_CODE < 0x02010f) /* 2.1.15 */
+ ,dev
+#endif
+ );
+}
+
+static void
isdn_net_reset(struct device *dev)
{
ulong flags;
@@ -513,6 +552,7 @@ isdn_net_dial(void)
isdn_net_dev *p = dev->netdev;
int anymore = 0;
int i;
+ int flags;
isdn_ctrl cmd;
while (p) {
@@ -528,7 +568,16 @@ isdn_net_dial(void)
/* Initiate dialout. Set phone-number-pointer to first number
* of interface.
*/
+ save_flags(flags);
+ cli();
p->local.dial = p->local.phone[1];
+ restore_flags(flags);
+ if (!p->local.dial) {
+ printk(KERN_WARNING "%s: phone number deleted?\n",
+ p->local.name);
+ isdn_net_hangup(&p->dev);
+ break;
+ }
anymore = 1;
p->local.dialstate++;
/* Fall through */
@@ -560,39 +609,41 @@ isdn_net_dial(void)
dev->drv[p->local.isdn_device]->interface->command(&cmd);
cmd.driver = p->local.isdn_device;
cmd.arg = p->local.isdn_channel;
- p->local.huptimer = 0;
- p->local.outgoing = 1;
- if (p->local.chargeint) {
- p->local.hupflags |= ISDN_HAVECHARGE;
- p->local.hupflags &= ~ISDN_WAITCHARGE;
- } else {
- p->local.hupflags |= ISDN_WAITCHARGE;
- p->local.hupflags &= ~ISDN_HAVECHARGE;
+ save_flags(flags);
+ cli();
+ if (!p->local.dial) {
+ restore_flags(flags);
+ printk(KERN_WARNING "%s: phone number deleted?\n",
+ p->local.name);
+ isdn_net_hangup(&p->dev);
+ break;
}
if (!strcmp(p->local.dial->num, "LEASED")) {
+ restore_flags(flags);
p->local.dialstate = 4;
printk(KERN_INFO "%s: Open leased line ...\n", p->local.name);
} else {
+ sprintf(cmd.parm.setup.phone, "%s", p->local.dial->num);
+ /*
+ * Switch to next number or back to start if at end of list.
+ */
+ if (!(p->local.dial = (isdn_net_phone *) p->local.dial->next)) {
+ p->local.dial = p->local.phone[1];
+ p->local.dialretry++;
+ }
+ restore_flags(flags);
cmd.command = ISDN_CMD_DIAL;
cmd.parm.setup.si1 = 7;
cmd.parm.setup.si2 = 0;
- sprintf(cmd.parm.setup.phone, "%s", p->local.dial->num);
sprintf(cmd.parm.setup.eazmsn, "%s",
isdn_map_eaz2msn(p->local.msn, cmd.driver));
i = isdn_dc2minor(p->local.isdn_device, p->local.isdn_channel);
if (i >= 0) {
- strcpy(dev->num[i], p->local.dial->num);
+ strcpy(dev->num[i], cmd.parm.setup.phone);
isdn_info_update();
}
printk(KERN_INFO "%s: dialing %d %s...\n", p->local.name,
- p->local.dialretry, p->local.dial->num);
- /*
- * Switch to next number or back to start if at end of list.
- */
- if (!(p->local.dial = (isdn_net_phone *) p->local.dial->next)) {
- p->local.dial = p->local.phone[1];
- p->local.dialretry++;
- }
+ p->local.dialretry - 1, cmd.parm.setup.phone);
p->local.dtimer = 0;
#ifdef ISDN_DEBUG_NET_DIAL
printk(KERN_DEBUG "dial: d=%d c=%d\n", p->local.isdn_device,
@@ -600,6 +651,15 @@ isdn_net_dial(void)
#endif
dev->drv[p->local.isdn_device]->interface->command(&cmd);
}
+ p->local.huptimer = 0;
+ p->local.outgoing = 1;
+ if (p->local.chargeint) {
+ p->local.hupflags |= ISDN_HAVECHARGE;
+ p->local.hupflags &= ~ISDN_WAITCHARGE;
+ } else {
+ p->local.hupflags |= ISDN_WAITCHARGE;
+ p->local.hupflags &= ~ISDN_HAVECHARGE;
+ }
anymore = 1;
p->local.dialstate =
(p->local.cbdelay &&
@@ -956,13 +1016,21 @@ isdn_net_start_xmit(struct sk_buff *skb, struct device *ndev)
lp->l3_proto,
lp->pre_device,
lp->pre_channel)) < 0) {
+ restore_flags(flags);
+#if 0
printk(KERN_WARNING
"isdn_net_start_xmit: No channel for %s\n",
ndev->name);
- restore_flags(flags);
/* we probably should drop the skb here and return 0 to omit
'socket destroy delayed' messages */
return 1;
+#else
+ isdn_net_unreachable(ndev, skb,
+ "No channel");
+ dev_kfree_skb(skb, FREE_WRITE);
+ ndev->tbusy = 0;
+ return 0;
+#endif
}
/* Log packet, which triggered dialing */
if (dev->net_verbose)
@@ -1000,20 +1068,8 @@ isdn_net_start_xmit(struct sk_buff *skb, struct device *ndev)
isdn_net_dial();
return 0;
} else {
- /*
- * Having no phone-number is a permanent
- * failure or misconfiguration.
- * Instead of just dropping, we should also
- * have the upper layers to respond
- * with an ICMP No route to host in the
- * future, however at the moment, i don't
- * know a simple way to do that.
- * The same applies, when the telecom replies
- * "no destination" to our dialing-attempt.
- */
- printk(KERN_WARNING
- "isdn_net: No phone number for %s, packet dropped\n",
- ndev->name);
+ isdn_net_unreachable(ndev, skb,
+ "No phone number");
dev_kfree_skb(skb, FREE_WRITE);
ndev->tbusy = 0;
return 0;
@@ -1045,7 +1101,6 @@ isdn_net_close(struct device *dev)
dev->tbusy = 1;
dev->start = 0;
- isdn_net_hangup(dev);
if ((p = (((isdn_net_local *) dev->priv)->slave))) {
/* If this interface has slaves, stop them also */
while (p) {
@@ -1055,6 +1110,7 @@ isdn_net_close(struct device *dev)
p = (((isdn_net_local *) p->priv)->slave);
}
}
+ isdn_net_hangup(dev);
isdn_MOD_DEC_USE_COUNT();
return 0;
}
@@ -2314,11 +2370,10 @@ isdn_net_getphones(isdn_net_ioctl_phone * phone, char *phones)
put_user(' ', phones++);
count++;
}
- if ((ret = verify_area(VERIFY_WRITE, (void *) phones, strlen(n->num) + 1))) {
+ if ((ret = copy_to_user(phones, n->num, strlen(n->num) + 1))) {
restore_flags(flags);
return ret;
}
- copy_to_user(phones, n->num, strlen(n->num) + 1);
phones += strlen(n->num);
count += strlen(n->num);
more = 1;
@@ -2340,12 +2395,17 @@ isdn_net_delphone(isdn_net_ioctl_phone * phone)
int inout = phone->outgoing & 1;
isdn_net_phone *n;
isdn_net_phone *m;
+ int flags;
if (p) {
+ save_flags(flags);
+ cli();
n = p->local.phone[inout];
m = NULL;
while (n) {
if (!strcmp(n->num, phone->phone)) {
+ if (p->local.dial == n)
+ p->local.dial = n->next;
if (m)
m->next = n->next;
else
@@ -2356,6 +2416,7 @@ isdn_net_delphone(isdn_net_ioctl_phone * phone)
m = n;
n = (isdn_net_phone *) n->next;
}
+ restore_flags(flags);
return -EINVAL;
}
return -ENODEV;
@@ -2383,6 +2444,7 @@ isdn_net_rmallphone(isdn_net_dev * p)
}
p->local.phone[i] = NULL;
}
+ p->local.dial = NULL;
restore_flags(flags);
return 0;
}
@@ -2399,13 +2461,13 @@ isdn_net_force_hangup(char *name)
if (p) {
if (p->local.isdn_device < 0)
return 1;
- isdn_net_hangup(&p->dev);
q = p->local.slave;
/* If this interface has slaves, do a hangup for them also. */
while (q) {
isdn_net_hangup(q);
q = (((isdn_net_local *) q->priv)->slave);
}
+ isdn_net_hangup(&p->dev);
return 0;
}
return -ENODEV;
diff --git a/drivers/isdn/isdn_ppp.c b/drivers/isdn/isdn_ppp.c
index 5c2ad3e84..a909c298f 100644
--- a/drivers/isdn/isdn_ppp.c
+++ b/drivers/isdn/isdn_ppp.c
@@ -1,4 +1,4 @@
-/* $Id: isdn_ppp.c,v 1.25 1997/02/12 20:37:35 hipp Exp $
+/* $Id: isdn_ppp.c,v 1.27 1997/03/30 16:51:17 calle Exp $
*
* Linux ISDN subsystem, functions for synchronous PPP (linklevel).
*
@@ -19,6 +19,15 @@
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
* $Log: isdn_ppp.c,v $
+ * Revision 1.27 1997/03/30 16:51:17 calle
+ * changed calls to copy_from_user/copy_to_user and removed verify_area
+ * were possible.
+ *
+ * Revision 1.26 1997/02/23 16:53:44 hipp
+ * minor cleanup
+ * some initial changes for future PPP compresion
+ * added AC,PC compression for outgoing frames
+ *
* Revision 1.25 1997/02/12 20:37:35 hipp
* New ioctl() PPPIOCGCALLINFO, minor cleanup
*
@@ -138,6 +147,7 @@ static int isdn_ppp_closewait(int slot);
static void isdn_ppp_push_higher(isdn_net_dev * net_dev, isdn_net_local * lp,
struct sk_buff *skb, int proto);
static int isdn_ppp_if_get_unit(char *namebuf);
+static int isdn_ppp_set_compressor(struct ippp_struct *is,int num);
#ifdef CONFIG_ISDN_MPP
static int isdn_ppp_bundle(struct ippp_struct *, int unit);
@@ -150,9 +160,10 @@ static int isdn_ppp_fill_mpqueue(isdn_net_dev *, struct sk_buff **skb,
static void isdn_ppp_free_mpqueue(isdn_net_dev *);
#endif
-char *isdn_ppp_revision = "$Revision: 1.25 $";
+char *isdn_ppp_revision = "$Revision: 1.27 $";
static struct ippp_struct *ippp_table[ISDN_MAX_CHANNELS];
+static struct isdn_ppp_compressor *ipc_head = NULL;
extern int isdn_net_force_dial_lp(isdn_net_local *);
@@ -371,6 +382,7 @@ isdn_ppp_open(int min, struct file *file)
if (is->debug & 0x1)
printk(KERN_DEBUG "ippp, open, slot: %d, minor: %d, state: %04x\n", slot, min, is->state);
+ is->compressor = NULL;
is->lp = NULL;
is->mp_seqno = 0; /* MP sequence number */
is->pppcfg = 0; /* ppp configuration */
@@ -451,9 +463,8 @@ get_arg(void *b, void *val, int len)
int r;
if (len <= 0)
len = sizeof(unsigned long);
- if ((r = verify_area(VERIFY_READ, (void *) b, len)))
+ if ((r = copy_from_user((void *) val, b, len)))
return r;
- copy_from_user((void *) val, b, len);
return 0;
}
@@ -465,13 +476,11 @@ set_arg(void *b, unsigned long val, void *str)
{
int r;
if (!str) {
- if ((r = verify_area(VERIFY_WRITE, b, 4)))
+ if ((r = copy_to_user(b, (void *) &val, 4)))
return r;
- copy_to_user(b, (void *) &val, 4);
} else {
- if ((r = verify_area(VERIFY_WRITE, b, val)))
+ if ((r = copy_to_user(b, str, val)))
return r;
- copy_to_user(b, str, val);
}
return 0;
}
@@ -483,7 +492,7 @@ int
isdn_ppp_ioctl(int min, struct file *file, unsigned int cmd, unsigned long arg)
{
unsigned long val;
- int r;
+ int num,r;
struct ippp_struct *is;
isdn_net_local *lp;
@@ -592,16 +601,22 @@ isdn_ppp_ioctl(int min, struct file *file, unsigned int cmd, unsigned long arg)
return r;
is->debug = val;
break;
- case PPPIOCSCOMPRESS:
-#if 0
+ case PPPIOCGCOMPRESSORS:
{
- struct ppp_option_data pod;
- r = get_arg((void *) arg, &pod, sizeof(struct ppp_option_data));
- if (r)
+ unsigned long protos = 0;
+ struct isdn_ppp_compressor *ipc = ipc_head;
+ while(ipc) {
+ protos |= (0x1<<ipc->num);
+ ipc = ipc->next;
+ }
+ if ((r = set_arg((void *) arg, protos, 0)))
return r;
- ippp_set_compression(is, &pod);
}
-#endif
+ break;
+ case PPPIOCSCOMPRESSOR:
+ if ((r = get_arg((void *) arg, &num, sizeof(int))))
+ return r;
+ return isdn_ppp_set_compressor(is, num);
break;
case PPPIOCGCALLINFO:
{
@@ -789,9 +804,6 @@ isdn_ppp_read(int min, struct file *file, char *buf, int count)
if (!(is->state & IPPP_OPEN))
return 0;
- if ((r = verify_area(VERIFY_WRITE, (void *) buf, count)))
- return r;
-
save_flags(flags);
cli();
@@ -802,7 +814,10 @@ isdn_ppp_read(int min, struct file *file, char *buf, int count)
}
if (b->len < count)
count = b->len;
- copy_to_user(buf, b->buf, count);
+ if ((r = copy_to_user(buf, b->buf, count))) {
+ restore_flags(flags);
+ return r;
+ }
kfree(b->buf);
b->buf = NULL;
is->first = b;
@@ -839,7 +854,8 @@ isdn_ppp_write(int min, struct file *file, const char *buf, int count)
* Don't reset huptimer for
* LCP packets. (Echo requests).
*/
- copy_from_user(protobuf, buf, 4);
+ if (copy_from_user(protobuf, buf, 4))
+ return -EFAULT;
proto = PPP_PROTOCOL(protobuf);
if (proto != PPP_LCP)
lp->huptimer = 0;
@@ -857,7 +873,8 @@ isdn_ppp_write(int min, struct file *file, const char *buf, int count)
return count;
}
SET_SKB_FREE(skb);
- copy_from_user(skb_put(skb, count), buf, count);
+ if (copy_from_user(skb_put(skb, count), buf, count))
+ return -EFAULT;
if (is->debug & 0x40) {
printk(KERN_DEBUG "ppp xmit: len %d\n", (int) skb->len);
isdn_ppp_frame_log("xmit", skb->data, skb->len, 32);
@@ -1209,7 +1226,7 @@ isdn_ppp_xmit(struct sk_buff *skb, struct device *dev)
isdn_net_local *lp,
*mlp;
isdn_net_dev *nd;
- int proto = PPP_IP; /* 0x21 */
+ unsigned int proto = PPP_IP; /* 0x21 */
struct ippp_struct *ipt,
*ipts;
@@ -1240,7 +1257,8 @@ isdn_ppp_xmit(struct sk_buff *skb, struct device *dev)
if (ipts->old_pa_addr != mdev->pa_addr) {
struct iphdr *ipfr;
ipfr = (struct iphdr *) skb->data;
- printk(KERN_DEBUG "IF-address changed from %lx to %lx\n", ipts->old_pa_addr, mdev->pa_addr);
+ if(ipts->debug & 0x4)
+ printk(KERN_DEBUG "IF-address changed from %lx to %lx\n", ipts->old_pa_addr, mdev->pa_addr);
if (ipfr->version == 4) {
if (ipfr->saddr == ipts->old_pa_addr) {
printk(KERN_DEBUG "readdressing %lx to %lx\n", ipfr->saddr, mdev->pa_addr);
@@ -1248,7 +1266,7 @@ isdn_ppp_xmit(struct sk_buff *skb, struct device *dev)
}
}
}
- /* dstaddr change not so improtant */
+ /* dstaddr change not so important */
#endif
break;
case ETH_P_IPX:
@@ -1331,27 +1349,36 @@ isdn_ppp_xmit(struct sk_buff *skb, struct device *dev)
ipts->mp_seqno++;
nd->queue = nd->queue->next;
if (ipt->mpppcfg & SC_OUT_SHORT_SEQ) {
- skb_push(skb, 3);
+ unsigned char *data = skb_push(skb, 3);
mp_seqno &= 0xfff;
- skb->data[0] = MP_BEGIN_FRAG | MP_END_FRAG | (mp_seqno >> 8); /* (B)egin & (E)ndbit .. */
- skb->data[1] = mp_seqno & 0xff;
- skb->data[2] = proto; /* PID compression */
+ data[0] = MP_BEGIN_FRAG | MP_END_FRAG | (mp_seqno >> 8); /* (B)egin & (E)ndbit .. */
+ data[1] = mp_seqno & 0xff;
+ data[2] = proto; /* PID compression */
} else {
- skb_push(skb, 5);
- skb->data[0] = MP_BEGIN_FRAG | MP_END_FRAG; /* (B)egin & (E)ndbit .. */
- skb->data[1] = (mp_seqno >> 16) & 0xff; /* sequence number: 24bit */
- skb->data[2] = (mp_seqno >> 8) & 0xff;
- skb->data[3] = (mp_seqno >> 0) & 0xff;
- skb->data[4] = proto; /* PID compression */
+ unsigned char *data = skb_push(skb, 5);
+ data[0] = MP_BEGIN_FRAG | MP_END_FRAG; /* (B)egin & (E)ndbit .. */
+ data[1] = (mp_seqno >> 16) & 0xff; /* sequence number: 24bit */
+ data[2] = (mp_seqno >> 8) & 0xff;
+ data[3] = (mp_seqno >> 0) & 0xff;
+ data[4] = proto; /* PID compression */
}
proto = PPP_MP; /* MP Protocol, 0x003d */
}
#endif
- skb_push(skb, 4);
- skb->data[0] = 0xff; /* All Stations */
- skb->data[1] = 0x03; /* Unnumbered information */
- skb->data[2] = proto >> 8;
- skb->data[3] = proto & 0xff;
+ if( (ipt->pppcfg & SC_COMP_PROT) && (proto <= 0xff) ) {
+ unsigned char *data = skb_push(skb,1);
+ data[0] = proto & 0xff;
+ }
+ else {
+ unsigned char *data = skb_push(skb,2);
+ data[0] = (proto >> 8) & 0xff;
+ data[1] = proto & 0xff;
+ }
+ if(!(ipt->pppcfg & SC_COMP_AC)) {
+ unsigned char *data = skb_push(skb,2);
+ data[0] = 0xff; /* All Stations */
+ data[1] = 0x03; /* Unnumbered information */
+ }
/* tx-stats are now updated via BSENT-callback */
@@ -1755,9 +1782,7 @@ isdn_ppp_dev_ioctl_stats(int slot, struct ifreq *ifr, struct device *dev)
}
#endif
}
- copy_to_user(res, &t, sizeof(struct ppp_stats));
- return 0;
-
+ return copy_to_user(res, &t, sizeof(struct ppp_stats));
}
int
@@ -1779,9 +1804,7 @@ isdn_ppp_dev_ioctl(struct device *dev, struct ifreq *ifr, int cmd)
case SIOCGPPPVER:
r = (char *) ifr->ifr_ifru.ifru_data;
len = strlen(PPP_VERSION) + 1;
- error = verify_area(VERIFY_WRITE, r, len);
- if (!error)
- copy_to_user(r, PPP_VERSION, len);
+ error = copy_to_user(r, PPP_VERSION, len);
break;
case SIOCGPPPSTATS:
error = isdn_ppp_dev_ioctl_stats(lp->ppp_slot, ifr, dev);
@@ -1882,6 +1905,45 @@ isdn_ppp_hangup_slave(char *name)
#endif
}
+
+int isdn_ppp_register_compressor(struct isdn_ppp_compressor *ipc)
+{
+ ipc->next = ipc_head;
+ ipc->prev = NULL;
+ if(ipc_head) {
+ ipc_head->prev = ipc;
+ }
+ ipc_head = ipc;
+ return 0;
+}
+
+int isdn_ppp_unregister_compressor(struct isdn_ppp_compressor *ipc)
+{
+ if(ipc->prev)
+ ipc->prev->next = ipc->next;
+ else
+ ipc_head = ipc->next;
+ if(ipc->next)
+ ipc->next->prev = ipc->prev;
+ ipc->prev = ipc->next = NULL;
+ return 0;
+}
+
+static int isdn_ppp_set_compressor(struct ippp_struct *is,int num)
+{
+ struct isdn_ppp_compressor *ipc = ipc_head;
+
+ while(ipc) {
+ if(ipc->num == num) {
+ return 0;
+ is->compressor = ipc;
+ }
+ ipc = ipc->next;
+ }
+ return -EINVAL;
+}
+
+
#if 0
static struct symbol_table isdn_ppp_syms =
{
@@ -1891,3 +1953,7 @@ static struct symbol_table isdn_ppp_syms =
#include <linux/symtab_end.h>
};
#endif
+
+
+
+
diff --git a/drivers/isdn/isdn_tty.c b/drivers/isdn/isdn_tty.c
index c87605d80..a5f31eaf3 100644
--- a/drivers/isdn/isdn_tty.c
+++ b/drivers/isdn/isdn_tty.c
@@ -1,4 +1,4 @@
-/* $Id: isdn_tty.c,v 1.29 1997/02/16 12:11:51 fritz Exp $
+/* $Id: isdn_tty.c,v 1.41 1997/05/27 15:17:31 fritz Exp $
* Linux ISDN subsystem, tty functions and AT-command emulator (linklevel).
*
@@ -20,6 +20,55 @@
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
* $Log: isdn_tty.c,v $
+ * Revision 1.41 1997/05/27 15:17:31 fritz
+ * Added changes for recent 2.1.x kernels:
+ * changed return type of isdn_close
+ * queue_task_* -> queue_task
+ * clear/set_bit -> test_and_... where apropriate.
+ * changed type of hard_header_cache parameter.
+ *
+ * Revision 1.40 1997/03/24 22:55:27 fritz
+ * Added debug code for status callbacks.
+ *
+ * Revision 1.39 1997/03/21 18:25:56 fritz
+ * Corrected CTS handling.
+ *
+ * Revision 1.38 1997/03/07 12:13:35 fritz
+ * Bugfix: Send audio in adpcm format was broken.
+ * Bugfix: CTS handling was wrong.
+ *
+ * Revision 1.37 1997/03/07 01:37:34 fritz
+ * Bugfix: Did not compile with CONFIG_ISDN_AUDIO disabled.
+ * Bugfix: isdn_tty_tint() did not handle lowlevel errors correctly.
+ * Bugfix: conversion was wrong when sending ulaw audio.
+ * Added proper ifdef's for CONFIG_ISDN_AUDIO
+ *
+ * Revision 1.36 1997/03/04 21:41:55 fritz
+ * Fix: Excessive stack usage of isdn_tty_senddown()
+ * and isdn_tty_end_vrx() could lead to problems.
+ *
+ * Revision 1.35 1997/03/02 19:05:52 fritz
+ * Bugfix: Avoid recursion.
+ *
+ * Revision 1.34 1997/03/02 14:29:22 fritz
+ * More ttyI related cleanup.
+ *
+ * Revision 1.33 1997/02/28 02:32:45 fritz
+ * Cleanup: Moved some tty related stuff from isdn_common.c
+ * to isdn_tty.c
+ * Bugfix: Bisync protocol did not behave like documented.
+ *
+ * Revision 1.32 1997/02/23 15:43:03 fritz
+ * Small change in handling of incoming calls
+ * documented in newest version of ttyI.4
+ *
+ * Revision 1.31 1997/02/21 13:05:57 fritz
+ * Bugfix: Remote hangup did not set location-info on ttyI's
+ *
+ * Revision 1.30 1997/02/18 09:41:05 fritz
+ * Added support for bitwise access to modem registers (ATSx.y=n, ATSx.y?).
+ * Beautified output of AT&V.
+ *
* Revision 1.29 1997/02/16 12:11:51 fritz
* Added S13,Bit4 option.
*
@@ -136,6 +185,7 @@
* Initial revision
*
*/
+#undef ISDN_TTY_STAT_DEBUG
#define __NO_VERSION__
#include <linux/config.h>
@@ -157,6 +207,10 @@ static void isdn_tty_modem_reset_regs(modem_info *, int);
static void isdn_tty_cmd_ATA(modem_info *);
static void isdn_tty_at_cout(char *, modem_info *);
static void isdn_tty_flush_buffer(struct tty_struct *);
+static void isdn_tty_modem_result(int, modem_info *);
+#ifdef CONFIG_ISDN_AUDIO
+static int isdn_tty_countDLE(unsigned char *, int);
+#endif
/* Leave this unchanged unless you know what you do! */
#define MODEM_PARANOIA_CHECK
@@ -169,13 +223,13 @@ static int bit2si[8] =
static int si2bit[8] =
{4, 1, 4, 4, 4, 4, 4, 4};
-char *isdn_tty_revision = "$Revision: 1.29 $";
+char *isdn_tty_revision = "$Revision: 1.41 $";
#define DLE 0x10
#define ETX 0x03
#define DC4 0x14
-/* isdn_tty_try_read() is called from within isdn_receive_callback()
+/* isdn_tty_try_read() is called from within isdn_tty_rcv_skb()
* to stuff incoming data directly into a tty's flip-buffer. This
* is done to speed up tty-receiving if the receive-queue is empty.
* This routine MUST be called with interrupts off.
@@ -184,7 +238,7 @@ char *isdn_tty_revision = "$Revision: 1.29 $";
* 0 = Failure, data has to be buffered and later processed by
* isdn_tty_readmodem().
*/
-int
+static int
isdn_tty_try_read(modem_info * info, struct sk_buff *skb)
{
int c;
@@ -195,24 +249,32 @@ isdn_tty_try_read(modem_info * info, struct sk_buff *skb)
if ((tty = info->tty)) {
if (info->mcr & UART_MCR_RTS) {
c = TTY_FLIPBUF_SIZE - tty->flip.count;
- len = skb->len + ISDN_AUDIO_SKB_DLECOUNT(skb);
+ len = skb->len
+#ifdef CONFIG_ISDN_AUDIO
+ + ISDN_AUDIO_SKB_DLECOUNT(skb)
+#endif
+ ;
if (c >= len) {
+#ifdef CONFIG_ISDN_AUDIO
if (ISDN_AUDIO_SKB_DLECOUNT(skb))
while (skb->len--) {
if (*skb->data == DLE)
tty_insert_flip_char(tty, DLE, 0);
tty_insert_flip_char(tty, *skb->data++, 0);
} else {
+#endif
memcpy(tty->flip.char_buf_ptr,
skb->data, len);
tty->flip.count += len;
tty->flip.char_buf_ptr += len;
memset(tty->flip.flag_buf_ptr, 0, len);
tty->flip.flag_buf_ptr += len;
+#ifdef CONFIG_ISDN_AUDIO
}
+#endif
if (info->emu.mdmreg[12] & 128)
tty->flip.flag_buf_ptr[len - 1] = 0xff;
- queue_task_irq_off(&tty->flip.tqueue, &tq_timer);
+ queue_task(&tty->flip.tqueue, &tq_timer);
SET_SKB_FREE(skb);
kfree_skb(skb, FREE_READ);
return 1;
@@ -263,7 +325,7 @@ isdn_tty_readmodem(void)
tty->flip.flag_buf_ptr += r;
tty->flip.char_buf_ptr += r;
if (r)
- queue_task_irq_off(&tty->flip.tqueue, &tq_timer);
+ queue_task(&tty->flip.tqueue, &tq_timer);
restore_flags(flags);
}
} else
@@ -282,6 +344,107 @@ isdn_tty_readmodem(void)
isdn_timer_ctrl(ISDN_TIMER_MODEMREAD, 0);
}
+int
+isdn_tty_rcv_skb(int i, int di, int channel, struct sk_buff *skb)
+{
+ ulong flags;
+ int midx;
+#ifdef CONFIG_ISDN_AUDIO
+ int ifmt;
+#endif
+ modem_info *info;
+
+ if ((midx = dev->m_idx[i]) < 0) {
+ /* if midx is invalid, packet is not for tty */
+ return 0;
+ }
+ info = &dev->mdm.info[midx];
+#ifdef CONFIG_ISDN_AUDIO
+ ifmt = 1;
+
+ if (info->vonline)
+ isdn_audio_calc_dtmf(info, skb->data, skb->len, ifmt);
+#endif
+ if ((info->online < 2)
+#ifdef CONFIG_ISDN_AUDIO
+ && (!(info->vonline & 1))
+#endif
+ ) {
+ /* If Modem not listening, drop data */
+ SET_SKB_FREE(skb);
+ kfree_skb(skb, FREE_READ);
+ return 1;
+ }
+ if (info->emu.mdmreg[13] & 2)
+ /* T.70 decoding: Simply throw away the T.70 header (4 bytes) */
+ if ((skb->data[0] == 1) && ((skb->data[1] == 0) || (skb->data[1] == 1)))
+ skb_pull(skb, 4);
+#ifdef CONFIG_ISDN_AUDIO
+ if (skb_headroom(skb) < sizeof(isdn_audio_skb)) {
+ printk(KERN_WARNING
+ "isdn_audio: insufficient skb_headroom, dropping\n");
+ SET_SKB_FREE(skb);
+ kfree_skb(skb, FREE_READ);
+ return 1;
+ }
+ ISDN_AUDIO_SKB_DLECOUNT(skb) = 0;
+ ISDN_AUDIO_SKB_LOCK(skb) = 0;
+ if (info->vonline & 1) {
+ /* voice conversion/compression */
+ switch (info->emu.vpar[3]) {
+ case 2:
+ case 3:
+ case 4:
+ /* adpcm
+ * Since compressed data takes less
+ * space, we can overwrite the buffer.
+ */
+ skb_trim(skb, isdn_audio_xlaw2adpcm(info->adpcmr,
+ ifmt,
+ skb->data,
+ skb->data,
+ skb->len));
+ break;
+ case 5:
+ /* a-law */
+ if (!ifmt)
+ isdn_audio_ulaw2alaw(skb->data, skb->len);
+ break;
+ case 6:
+ /* u-law */
+ if (ifmt)
+ isdn_audio_alaw2ulaw(skb->data, skb->len);
+ break;
+ }
+ ISDN_AUDIO_SKB_DLECOUNT(skb) =
+ isdn_tty_countDLE(skb->data, skb->len);
+ }
+#endif
+ /* Try to deliver directly via tty-flip-buf if queue is empty */
+ save_flags(flags);
+ cli();
+ if (skb_queue_empty(&dev->drv[di]->rpqueue[channel]))
+ if (isdn_tty_try_read(info, skb)) {
+ restore_flags(flags);
+ return 1;
+ }
+ /* Direct deliver failed or queue wasn't empty.
+ * Queue up for later dequeueing via timer-irq.
+ */
+ __skb_queue_tail(&dev->drv[di]->rpqueue[channel], skb);
+ dev->drv[di]->rcvcount[channel] +=
+ (skb->len
+#ifdef CONFIG_ISDN_AUDIO
+ + ISDN_AUDIO_SKB_DLECOUNT(skb)
+#endif
+ );
+ restore_flags(flags);
+ /* Schedule dequeuing */
+ if ((dev->modempoll) && (info->rcvsched))
+ isdn_timer_ctrl(ISDN_TIMER_MODEMREAD, 1);
+ return 1;
+}
+
void
isdn_tty_cleanup_xmit(modem_info * info)
{
@@ -295,11 +458,13 @@ isdn_tty_cleanup_xmit(modem_info * info)
SET_SKB_FREE(skb);
kfree_skb(skb, FREE_WRITE);
}
+#ifdef CONFIG_ISDN_AUDIO
if (skb_queue_len(&info->dtmf_queue))
while ((skb = skb_dequeue(&info->dtmf_queue))) {
SET_SKB_FREE(skb);
kfree_skb(skb, FREE_WRITE);
}
+#endif
restore_flags(flags);
}
@@ -314,7 +479,7 @@ isdn_tty_tint(modem_info * info)
return;
len = skb->len;
if ((slen = isdn_writebuf_skb_stub(info->isdn_driver,
- info->isdn_channel, skb)) == len) {
+ info->isdn_channel, skb)) == len) {
struct tty_struct *tty = info->tty;
info->send_outstanding++;
info->msr |= UART_MSR_CTS;
@@ -325,13 +490,19 @@ isdn_tty_tint(modem_info * info)
wake_up_interruptible(&tty->write_wait);
return;
}
- if (slen > 0)
+ if (slen < 0) {
+ /* Error: no channel, already shutdown, or wrong parameter */
+ SET_SKB_FREE(skb);
+ dev_kfree_skb(skb, FREE_WRITE);
+ return;
+ }
+ if (slen)
skb_pull(skb, slen);
skb_queue_head(&info->xmit_queue, skb);
}
#ifdef CONFIG_ISDN_AUDIO
-int
+static int
isdn_tty_countDLE(unsigned char *buf, int len)
{
int count = 0;
@@ -369,9 +540,20 @@ isdn_tty_handleDLEdown(modem_info * info, atemu * m, int len)
case DC4:
/* Abort RX */
info->vonline &= ~1;
+#ifdef ISDN_DEBUG_MODEM_VOICE
+ printk(KERN_DEBUG
+ "DLEdown: got DLE-DC4, send DLE-ETX on ttyI%d\n",
+ info->line);
+#endif
isdn_tty_at_cout("\020\003", info);
- if (!info->vonline)
+ if (!info->vonline) {
+#ifdef ISDN_DEBUG_MODEM_VOICE
+ printk(KERN_DEBUG
+ "DLEdown: send VCON on ttyI%d\n",
+ info->line);
+#endif
isdn_tty_at_cout("\r\nVCON\r\n", info);
+ }
/* Fall through */
case 'q':
case 's':
@@ -404,28 +586,22 @@ isdn_tty_handleDLEdown(modem_info * info, atemu * m, int len)
static int
isdn_tty_end_vrx(const char *buf, int c, int from_user)
{
- char tmpbuf[VBUF];
- char *p;
+ char ch;
- if (c > VBUF) {
- printk(KERN_ERR "isdn_tty: (end_vrx) BUFFER OVERFLOW!!!\n");
- return 1;
- }
- if (from_user) {
- copy_from_user(tmpbuf, buf, c);
- p = tmpbuf;
- } else
- p = (char *) buf;
while (c--) {
- if ((*p != 0x11) && (*p != 0x13))
+ if (from_user)
+ GET_USER(ch, buf);
+ else
+ ch = *buf;
+ if ((ch != 0x11) && (ch != 0x13))
return 1;
- p++;
+ buf++;
}
return 0;
}
static int voice_cf[7] =
-{1, 1, 4, 3, 2, 1, 1};
+{0, 0, 4, 3, 2, 0, 0};
#endif /* CONFIG_ISDN_AUDIO */
@@ -437,18 +613,36 @@ static int voice_cf[7] =
static void
isdn_tty_senddown(modem_info * info)
{
- unsigned char *buf = info->xmit_buf;
int buflen;
int skb_res;
+#ifdef CONFIG_ISDN_AUDIO
+ int audio_len;
+#endif
struct sk_buff *skb;
unsigned long flags;
+#ifdef CONFIG_ISDN_AUDIO
+ if (info->vonline & 4) {
+ info->vonline &= ~6;
+ if (!info->vonline) {
+#ifdef ISDN_DEBUG_MODEM_VOICE
+ printk(KERN_DEBUG
+ "senddown: send VCON on ttyI%d\n",
+ info->line);
+#endif
+ isdn_tty_at_cout("\r\nVCON\r\n", info);
+ }
+ }
+#endif
save_flags(flags);
cli();
if (!(buflen = info->xmit_count)) {
restore_flags(flags);
return;
}
+ if ((info->emu.mdmreg[12] & 0x10) != 0)
+ info->msr &= ~UART_MSR_CTS;
+ info->lsr &= ~UART_LSR_TEMT;
if (info->isdn_driver < 0) {
info->xmit_count = 0;
restore_flags(flags);
@@ -456,6 +650,26 @@ isdn_tty_senddown(modem_info * info)
}
skb_res = dev->drv[info->isdn_driver]->interface->hl_hdrlen + 4;
#ifdef CONFIG_ISDN_AUDIO
+ if (info->vonline & 2)
+ audio_len = buflen * voice_cf[info->emu.vpar[3]];
+ else
+ audio_len = 0;
+ skb = dev_alloc_skb(skb_res + buflen + audio_len);
+#else
+ skb = dev_alloc_skb(skb_res + buflen);
+#endif
+ if (!skb) {
+ restore_flags(flags);
+ printk(KERN_WARNING
+ "isdn_tty: Out of memory in ttyI%d senddown\n",
+ info->line);
+ return;
+ }
+ skb_reserve(skb, skb_res);
+ memcpy(skb_put(skb, buflen), info->xmit_buf, buflen);
+ info->xmit_count = 0;
+ restore_flags(flags);
+#ifdef CONFIG_ISDN_AUDIO
if (info->vonline & 2) {
/* For now, ifmt is fixed to 1 (alaw), since this
* is used with ISDN everywhere in the world, except
@@ -464,21 +678,8 @@ isdn_tty_senddown(modem_info * info)
* this setting will depend on the D-channel protocol.
*/
int ifmt = 1;
- int skb_len;
- unsigned char hbuf[VBUF];
- memcpy(hbuf, info->xmit_buf, buflen);
- info->xmit_count = 0;
- restore_flags(flags);
/* voice conversion/decompression */
- skb_len = buflen * voice_cf[info->emu.vpar[3]];
- skb = dev_alloc_skb(skb_len + skb_res);
- if (!skb) {
- printk(KERN_WARNING
- "isdn_tty: Out of memory in ttyI%d senddown\n", info->line);
- return;
- }
- skb_reserve(skb, skb_res);
switch (info->emu.vpar[3]) {
case 2:
case 3:
@@ -486,55 +687,34 @@ isdn_tty_senddown(modem_info * info)
/* adpcm, compatible to ZyXel 1496 modem
* with ROM revision 6.01
*/
- buflen = isdn_audio_adpcm2xlaw(info->adpcms,
- ifmt,
- hbuf,
- skb_put(skb, skb_len),
- buflen);
- skb_trim(skb, buflen);
+ audio_len = isdn_audio_adpcm2xlaw(info->adpcms,
+ ifmt,
+ skb->data,
+ skb_put(skb, audio_len),
+ buflen);
+ skb_pull(skb, buflen);
+ skb_trim(skb, audio_len);
break;
case 5:
/* a-law */
if (!ifmt)
- isdn_audio_alaw2ulaw(hbuf, buflen);
- memcpy(skb_put(skb, buflen), hbuf, buflen);
+ isdn_audio_alaw2ulaw(skb->data,
+ buflen);
break;
case 6:
/* u-law */
if (ifmt)
- isdn_audio_ulaw2alaw(hbuf, buflen);
- memcpy(skb_put(skb, buflen), hbuf, buflen);
+ isdn_audio_ulaw2alaw(skb->data,
+ buflen);
break;
}
- if (info->vonline & 4) {
- info->vonline &= ~6;
- if (!info->vonline)
- isdn_tty_at_cout("\r\nVCON\r\n", info);
- }
- } else {
-#endif /* CONFIG_ISDN_AUDIO */
- skb = dev_alloc_skb(buflen + skb_res);
- if (!skb) {
- printk(KERN_WARNING
- "isdn_tty: Out of memory in ttyI%d senddown\n", info->line);
- restore_flags(flags);
- return;
- }
- skb_reserve(skb, skb_res);
- memcpy(skb_put(skb, buflen), buf, buflen);
- info->xmit_count = 0;
- restore_flags(flags);
-#ifdef CONFIG_ISDN_AUDIO
}
-#endif
+#endif /* CONFIG_ISDN_AUDIO */
SET_SKB_FREE(skb);
if (info->emu.mdmreg[13] & 2)
/* Add T.70 simplified header */
memcpy(skb_push(skb, 4), "\1\0\1\0", 4);
skb_queue_tail(&info->xmit_queue, skb);
- if ((info->emu.mdmreg[12] & 0x10) != 0)
- info->msr &= UART_MSR_CTS;
- info->lsr &= UART_LSR_TEMT;
}
/************************************************************
@@ -566,7 +746,6 @@ static void
isdn_tty_modem_ncarrier(modem_info * info)
{
if (info->ncarrier) {
- info->ncarrier = 0;
info->nc_timer.expires = jiffies + HZ;
info->nc_timer.function = isdn_tty_modem_do_ncarrier;
info->nc_timer.data = (unsigned long) info;
@@ -652,7 +831,7 @@ isdn_tty_dial(char *n, modem_info * info, atemu * m)
* ISDN-line (hangup). The usage-status is cleared
* and some cleanup is done also.
*/
-void
+static void
isdn_tty_modem_hup(modem_info * info, int local)
{
isdn_ctrl cmd;
@@ -664,20 +843,15 @@ isdn_tty_modem_hup(modem_info * info, int local)
printk(KERN_DEBUG "Mhup ttyI%d\n", info->line);
#endif
info->rcvsched = 0;
- info->online = 0;
- if (info->online || info->vonline)
- info->last_lhup = local;
isdn_tty_flush_buffer(info->tty);
- if (info->vonline & 1) {
- /* voice-recording, add DLE-ETX */
- isdn_tty_at_cout("\020\003", info);
- }
- if (info->vonline & 2) {
- /* voice-playing, add DLE-DC4 */
- isdn_tty_at_cout("\020\024", info);
+ if (info->online) {
+ info->last_lhup = local;
+ info->online = 0;
+ /* NO CARRIER message */
+ isdn_tty_modem_result(3, info);
}
- info->vonline = 0;
#ifdef CONFIG_ISDN_AUDIO
+ info->vonline = 0;
if (info->dtmf_state) {
kfree(info->dtmf_state);
info->dtmf_state = NULL;
@@ -694,10 +868,12 @@ isdn_tty_modem_hup(modem_info * info, int local)
info->msr &= ~(UART_MSR_DCD | UART_MSR_RI);
info->lsr |= UART_LSR_TEMT;
if (info->isdn_driver >= 0) {
- cmd.driver = info->isdn_driver;
- cmd.command = ISDN_CMD_HANGUP;
- cmd.arg = info->isdn_channel;
- dev->drv[info->isdn_driver]->interface->command(&cmd);
+ if (local) {
+ cmd.driver = info->isdn_driver;
+ cmd.command = ISDN_CMD_HANGUP;
+ cmd.arg = info->isdn_channel;
+ dev->drv[info->isdn_driver]->interface->command(&cmd);
+ }
isdn_all_eaz(info->isdn_driver, info->isdn_channel);
info->emu.mdmreg[1] = 0;
usage = (info->emu.mdmreg[20] == 1) ?
@@ -888,11 +1064,16 @@ isdn_tty_write(struct tty_struct *tty, int from_user, const u_char * buf, int co
c = MIN(c, dev->drv[info->isdn_driver]->maxbufsize);
if (c <= 0)
break;
- if ((info->online > 1) ||
- (info->vonline & 2)) {
+ if ((info->online > 1)
+#ifdef CONFIG_ISDN_AUDIO
+ || (info->vonline & 3)
+#endif
+ ) {
atemu *m = &info->emu;
- if (!(info->vonline & 2))
+#ifdef CONFIG_ISDN_AUDIO
+ if (!info->vonline)
+#endif
isdn_tty_check_esc(buf, m->mdmreg[2], c,
&(m->pluscount),
&(m->lastplus),
@@ -902,21 +1083,36 @@ isdn_tty_write(struct tty_struct *tty, int from_user, const u_char * buf, int co
else
memcpy(&(info->xmit_buf[info->xmit_count]), buf, c);
#ifdef CONFIG_ISDN_AUDIO
- if (info->vonline & 2) {
- int cc;
-
- if (!(cc = isdn_tty_handleDLEdown(info, m, c))) {
- /* If DLE decoding results in zero-transmit, but
- * c originally was non-zero, do a wakeup.
+ if (info->vonline) {
+ int cc = isdn_tty_handleDLEdown(info, m, c);
+ if (info->vonline & 2) {
+ if (!cc) {
+ /* If DLE decoding results in zero-transmit, but
+ * c originally was non-zero, do a wakeup.
+ */
+ if ((tty->flags & (1 << TTY_DO_WRITE_WAKEUP)) &&
+ tty->ldisc.write_wakeup)
+ (tty->ldisc.write_wakeup) (tty);
+ wake_up_interruptible(&tty->write_wait);
+ info->msr |= UART_MSR_CTS;
+ info->lsr |= UART_LSR_TEMT;
+ }
+ info->xmit_count += cc;
+ }
+ if ((info->vonline & 3) == 1) {
+ /* Do NOT handle Ctrl-Q or Ctrl-S
+ * when in full-duplex audio mode.
*/
- if ((tty->flags & (1 << TTY_DO_WRITE_WAKEUP)) &&
- tty->ldisc.write_wakeup)
- (tty->ldisc.write_wakeup) (tty);
- wake_up_interruptible(&tty->write_wait);
- info->msr |= UART_MSR_CTS;
- info->lsr |= UART_LSR_TEMT;
+ if (isdn_tty_end_vrx(buf, c, from_user)) {
+ info->vonline &= ~1;
+#ifdef ISDN_DEBUG_MODEM_VOICE
+ printk(KERN_DEBUG
+ "got !^Q/^S, send DLE-ETX,VCON on ttyI%d\n",
+ info->line);
+#endif
+ isdn_tty_at_cout("\020\003\r\nVCON\r\n", info);
+ }
}
- info->xmit_count += cc;
} else
#endif
info->xmit_count += c;
@@ -927,17 +1123,6 @@ isdn_tty_write(struct tty_struct *tty, int from_user, const u_char * buf, int co
} else {
info->msr |= UART_MSR_CTS;
info->lsr |= UART_LSR_TEMT;
-#ifdef CONFIG_ISDN_AUDIO
- if ((info->vonline & 3) == 1) {
- /* Do NOT handle Ctrl-Q or Ctrl-S
- * when in full-duplex audio mode.
- */
- if (isdn_tty_end_vrx(buf, c, from_user)) {
- info->vonline &= ~1;
- isdn_tty_at_cout("\020\003\r\nVCON\r\n", info);
- }
- } else
-#endif
if (info->dialing) {
info->dialing = 0;
#ifdef ISDN_DEBUG_MODEM_HUP
@@ -1623,6 +1808,7 @@ isdn_tty_reset_profile(atemu * m)
m->pmsn[0] = '\0';
}
+#ifdef CONFIG_ISDN_AUDIO
static void
isdn_tty_modem_reset_vpar(atemu * m)
{
@@ -1631,6 +1817,7 @@ isdn_tty_modem_reset_vpar(atemu * m)
m->vpar[2] = 70; /* Silence interval (7 sec. ) */
m->vpar[3] = 2; /* Compression type (1 = ADPCM-2 ) */
}
+#endif
static void
isdn_tty_modem_reset_regs(modem_info * info, int force)
@@ -1641,7 +1828,9 @@ isdn_tty_modem_reset_regs(modem_info * info, int force)
memcpy(m->msn, m->pmsn, ISDN_MSNLEN);
info->xmit_size = m->mdmreg[16] * 16;
}
+#ifdef CONFIG_ISDN_AUDIO
isdn_tty_modem_reset_vpar(m);
+#endif
m->mdmcmdl = 0;
}
@@ -1735,7 +1924,9 @@ isdn_tty_modem_init(void)
info->drv_index = -1;
info->xmit_size = ISDN_SERIAL_XMIT_SIZE;
skb_queue_head_init(&info->xmit_queue);
+#ifdef CONFIG_ISDN_AUDIO
skb_queue_head_init(&info->dtmf_queue);
+#endif
if (!(info->xmit_buf = kmalloc(ISDN_SERIAL_XMIT_SIZE + 5, GFP_KERNEL))) {
printk(KERN_ERR "Could not allocate modem xmit-buffer\n");
return -3;
@@ -1817,6 +2008,9 @@ isdn_tty_find_icall(int di, int ch, setup_parm setup)
restore_flags(flags);
printk(KERN_INFO "isdn_tty: call from %s, -> RING on ttyI%d\n", nr,
info->line);
+ info->msr |= UART_MSR_RI;
+ isdn_tty_modem_result(2, info);
+ isdn_timer_ctrl(ISDN_TIMER_MODEMRING, 1);
return info->line;
}
}
@@ -1827,6 +2021,140 @@ isdn_tty_find_icall(int di, int ch, setup_parm setup)
return -1;
}
+#define TTY_IS_ACTIVE(info) \
+ (info->flags & (ISDN_ASYNC_NORMAL_ACTIVE | ISDN_ASYNC_CALLOUT_ACTIVE))
+
+int
+isdn_tty_stat_callback(int i, isdn_ctrl * c)
+{
+ int mi;
+ modem_info *info;
+
+ if (i < 0)
+ return 0;
+ if ((mi = dev->m_idx[i]) >= 0) {
+ info = &dev->mdm.info[mi];
+ switch (c->command) {
+ case ISDN_STAT_BSENT:
+#ifdef ISDN_TTY_STAT_DEBUG
+ printk(KERN_DEBUG "tty_STAT_BSENT ttyI%d\n", info->line);
+#endif
+ if ((info->isdn_driver == c->driver) &&
+ (info->isdn_channel == c->arg)) {
+ info->msr |= UART_MSR_CTS;
+ if (info->send_outstanding)
+ if (!(--info->send_outstanding))
+ info->lsr |= UART_LSR_TEMT;
+ isdn_tty_tint(info);
+ return 1;
+ }
+ break;
+ case ISDN_STAT_CAUSE:
+#ifdef ISDN_TTY_STAT_DEBUG
+ printk(KERN_DEBUG "tty_STAT_CAUSE ttyI%d\n", info->line);
+#endif
+ /* Signal cause to tty-device */
+ strncpy(info->last_cause, c->parm.num, 5);
+ return 1;
+ case ISDN_STAT_DCONN:
+#ifdef ISDN_TTY_STAT_DEBUG
+ printk(KERN_DEBUG "tty_STAT_DCONN ttyI%d\n", info->line);
+#endif
+ if (TTY_IS_ACTIVE(info)) {
+ if (info->dialing == 1) {
+ info->dialing = 2;
+ return 1;
+ }
+ }
+ break;
+ case ISDN_STAT_DHUP:
+#ifdef ISDN_TTY_STAT_DEBUG
+ printk(KERN_DEBUG "tty_STAT_DHUP ttyI%d\n", info->line);
+#endif
+ if (TTY_IS_ACTIVE(info)) {
+ if (info->dialing == 1) {
+ info->dialing = 0;
+ isdn_tty_modem_result(7, info);
+ }
+#ifdef ISDN_DEBUG_MODEM_HUP
+ printk(KERN_DEBUG "Mhup in ISDN_STAT_DHUP\n");
+#endif
+ isdn_tty_modem_hup(info, 0);
+ return 1;
+ }
+ break;
+ case ISDN_STAT_BCONN:
+#ifdef ISDN_TTY_STAT_DEBUG
+ printk(KERN_DEBUG "tty_STAT_BCONN ttyI%d\n", info->line);
+#endif
+ /* Schedule CONNECT-Message to any tty
+ * waiting for it and
+ * set DCD-bit of its modem-status.
+ */
+ if (TTY_IS_ACTIVE(info)) {
+ info->msr |= UART_MSR_DCD;
+ if (info->dialing) {
+ info->dialing = 0;
+ info->last_dir = 1;
+ } else
+ info->last_dir = 0;
+ info->rcvsched = 1;
+ if (USG_MODEM(dev->usage[i]))
+ isdn_tty_modem_result(5, info);
+ if (USG_VOICE(dev->usage[i]))
+ isdn_tty_modem_result(11, info);
+ return 1;
+ }
+ break;
+ case ISDN_STAT_BHUP:
+#ifdef ISDN_TTY_STAT_DEBUG
+ printk(KERN_DEBUG "tty_STAT_BHUP ttyI%d\n", info->line);
+#endif
+ if (TTY_IS_ACTIVE(info)) {
+#ifdef ISDN_DEBUG_MODEM_HUP
+ printk(KERN_DEBUG "Mhup in ISDN_STAT_BHUP\n");
+#endif
+ isdn_tty_modem_hup(info, 0);
+ return 1;
+ }
+ break;
+ case ISDN_STAT_NODCH:
+#ifdef ISDN_TTY_STAT_DEBUG
+ printk(KERN_DEBUG "tty_STAT_NODCH ttyI%d\n", info->line);
+#endif
+ if (TTY_IS_ACTIVE(info)) {
+ if (info->dialing) {
+ info->dialing = 0;
+ info->last_l2 = -1;
+ info->last_si = 0;
+ sprintf(info->last_cause, "0000");
+ isdn_tty_modem_result(6, info);
+ }
+ info->msr &= ~UART_MSR_DCD;
+ if (info->online) {
+ isdn_tty_modem_result(3, info);
+ info->online = 0;
+ }
+ return 1;
+ }
+ break;
+ case ISDN_STAT_UNLOAD:
+#ifdef ISDN_TTY_STAT_DEBUG
+ printk(KERN_DEBUG "tty_STAT_UNLOAD ttyI%d\n", info->line);
+#endif
+ for (i = 0; i < ISDN_MAX_CHANNELS; i++) {
+ info = &dev->mdm.info[i];
+ if (info->isdn_driver == c->driver) {
+ if (info->online)
+ isdn_tty_modem_hup(info, 1);
+ }
+ }
+ return 1;
+ }
+ }
+ return 0;
+}
+
/*********************************************************************
Modem-Emulator-Routines
*********************************************************************/
@@ -1889,7 +2217,6 @@ isdn_tty_on_hook(modem_info * info)
#ifdef ISDN_DEBUG_MODEM_HUP
printk(KERN_DEBUG "Mhup in isdn_tty_on_hook\n");
#endif
- isdn_tty_modem_result(3, info);
isdn_tty_modem_hup(info, 1);
}
}
@@ -1959,7 +2286,7 @@ isdn_tty_check_esc(const u_char * p, u_char plus, int count, int *pluscount,
* For CONNECT-messages also switch to online-mode.
* For RING-message handle auto-ATA if register 0 != 0
*/
-void
+static void
isdn_tty_modem_result(int code, modem_info * info)
{
atemu *m = &info->emu;
@@ -1979,27 +2306,39 @@ isdn_tty_modem_result(int code, modem_info * info)
break;
case 3:
/* NO CARRIER */
- save_flags(flags);
- cli();
- m->mdmreg[1] = 0;
#ifdef ISDN_DEBUG_MODEM_HUP
printk(KERN_DEBUG "modem_result: NO CARRIER %d %d\n",
(info->flags & ISDN_ASYNC_CLOSING),
(!info->tty));
#endif
+ save_flags(flags);
+ cli();
+ m->mdmreg[1] = 0;
+ del_timer(&info->nc_timer);
+ info->ncarrier = 0;
if ((info->flags & ISDN_ASYNC_CLOSING) || (!info->tty)) {
restore_flags(flags);
return;
}
restore_flags(flags);
+#ifdef CONFIG_ISDN_AUDIO
if (info->vonline & 1) {
+#ifdef ISDN_DEBUG_MODEM_VOICE
+ printk(KERN_DEBUG "res3: send DLE-ETX on ttyI%d\n",
+ info->line);
+#endif
/* voice-recording, add DLE-ETX */
isdn_tty_at_cout("\020\003", info);
}
if (info->vonline & 2) {
+#ifdef ISDN_DEBUG_MODEM_VOICE
+ printk(KERN_DEBUG "res3: send DLE-DC4 on ttyI%d\n",
+ info->line);
+#endif
/* voice-playing, add DLE-DC4 */
isdn_tty_at_cout("\020\024", info);
}
+#endif
break;
case 1:
case 5:
@@ -2008,6 +2347,10 @@ isdn_tty_modem_result(int code, modem_info * info)
info->online = 2;
break;
case 11:
+#ifdef ISDN_DEBUG_MODEM_VOICE
+ printk(KERN_DEBUG "res3: send VCON on ttyI%d\n",
+ info->line);
+#endif
sprintf(info->last_cause, "0000");
if (!info->online)
info->online = 1;
@@ -2240,9 +2583,10 @@ isdn_tty_cmd_ATand(char **p, modem_info * info)
case 'V':
/* &V - Show registers */
p[0]++;
+ isdn_tty_at_cout("\r\n", info);
for (i = 0; i < ISDN_MODEM_ANZREG; i++) {
- sprintf(rb, "S%d=%d%s", i,
- m->mdmreg[i], (i == 6) ? "\r\n" : " ");
+ sprintf(rb, "S%02d=%03d%s", i,
+ m->mdmreg[i], ((i + 1) % 10) ? " " : "\r\n");
isdn_tty_at_cout(rb, info);
}
sprintf(rb, "\r\nEAZ/MSN: %s\r\n",
@@ -2286,6 +2630,33 @@ isdn_tty_cmd_ATand(char **p, modem_info * info)
return 0;
}
+static int
+isdn_tty_check_ats(int mreg, int mval, modem_info * info, atemu * m)
+{
+ /* Some plausibility checks */
+ switch (mreg) {
+ case 14:
+ if (mval > ISDN_PROTO_L2_TRANS)
+ return 1;
+ break;
+ case 16:
+ if ((mval * 16) > ISDN_SERIAL_XMIT_SIZE)
+ return 1;
+#ifdef CONFIG_ISDN_AUDIO
+ if ((m->mdmreg[18] & 1) && (mval > VBUFX))
+ return 1;
+#endif
+ info->xmit_size = mval * 16;
+ break;
+ case 20:
+ case 21:
+ case 22:
+ /* readonly registers */
+ return 1;
+ }
+ return 0;
+}
+
/*
* Perform ATS command
*/
@@ -2293,8 +2664,10 @@ static int
isdn_tty_cmd_ATS(char **p, modem_info * info)
{
atemu *m = &info->emu;
+ int bitpos;
int mreg;
int mval;
+ int bval;
mreg = isdn_getnum(p);
if (mreg < 0 || mreg > ISDN_MODEM_ANZREG)
@@ -2305,25 +2678,39 @@ isdn_tty_cmd_ATS(char **p, modem_info * info)
mval = isdn_getnum(p);
if (mval < 0 || mval > 255)
PARSE_ERROR1;
- switch (mreg) {
- /* Some plausibility checks */
- case 14:
- if (mval > ISDN_PROTO_L2_TRANS)
- PARSE_ERROR1;
- break;
- case 16:
- if ((mval * 16) > ISDN_SERIAL_XMIT_SIZE)
+ if (isdn_tty_check_ats(mreg, mval, info, m))
+ PARSE_ERROR1;
+ m->mdmreg[mreg] = mval;
+ break;
+ case '.':
+ /* Set/Clear a single bit */
+ p[0]++;
+ bitpos = isdn_getnum(p);
+ if ((bitpos < 0) || (bitpos > 7))
+ PARSE_ERROR1;
+ switch (*p[0]) {
+ case '=':
+ p[0]++;
+ bval = isdn_getnum(p);
+ if (bval < 0 || bval > 1)
PARSE_ERROR1;
-#ifdef CONFIG_ISDN_AUDIO
- if ((m->mdmreg[18] & 1) && (mval > VBUFX))
+ if (bval)
+ mval = m->mdmreg[mreg] | (1 << bitpos);
+ else
+ mval = m->mdmreg[mreg] & ~(1 << bitpos);
+ if (isdn_tty_check_ats(mreg, mval, info, m))
PARSE_ERROR1;
-#endif
- info->xmit_size = mval * 16;
+ m->mdmreg[mreg] = mval;
break;
- case 20:
+ case '?':
+ p[0]++;
+ isdn_tty_at_cout("\r\n", info);
+ isdn_tty_at_cout((m->mdmreg[mreg] & (1 << bitpos)) ? "1" : "0",
+ info);
+ break;
+ default:
PARSE_ERROR1;
}
- m->mdmreg[mreg] = mval;
break;
case '?':
p[0]++;
@@ -2355,9 +2742,12 @@ isdn_tty_cmd_ATA(modem_info * info)
l2 = m->mdmreg[14];
#ifdef CONFIG_ISDN_AUDIO
/* If more than one bit set in reg18, autoselect Layer2 */
- if ((m->mdmreg[18] & m->mdmreg[20]) != m->mdmreg[18])
+ if ((m->mdmreg[18] & m->mdmreg[20]) != m->mdmreg[18]) {
if (m->mdmreg[20] == 1)
l2 = 4;
+ else
+ l2 = 0;
+ }
#endif
cmd.driver = info->isdn_driver;
cmd.command = ISDN_CMD_SETL2;
@@ -2709,7 +3099,7 @@ isdn_tty_parse_at(modem_info * info)
else if (strlen(ds))
isdn_tty_dial(ds, info, m);
else
- isdn_tty_modem_result(4, info);
+ PARSE_ERROR;
return;
case 'E':
/* E - Turn Echo on/off */
@@ -2822,6 +3212,8 @@ isdn_tty_parse_at(modem_info * info)
if (isdn_tty_cmd_PLUSV(&p, info))
return;
break;
+ default:
+ PARSE_ERROR;
}
break;
#endif /* CONFIG_ISDN_AUDIO */
@@ -2831,11 +3223,13 @@ isdn_tty_parse_at(modem_info * info)
return;
break;
default:
- isdn_tty_modem_result(4, info);
- return;
+ PARSE_ERROR;
}
}
- isdn_tty_modem_result(0, info);
+#ifdef CONFIG_ISDN_AUDIO
+ if (!info->vonline)
+#endif
+ isdn_tty_modem_result(0, info);
}
/* Need own toupper() because standard-toupper is not available
@@ -2987,27 +3381,3 @@ isdn_tty_modem_xmit(void)
}
isdn_timer_ctrl(ISDN_TIMER_MODEMXMIT, ton);
}
-
-/*
- * A packet has been output successfully.
- * Search the tty-devices for an appropriate device, decrement its
- * counter for outstanding packets, and set CTS.
- */
-void
-isdn_tty_bsent(int drv, int chan)
-{
- int i;
-
- for (i = 0; i < ISDN_MAX_CHANNELS; i++) {
- modem_info *info = &dev->mdm.info[i];
- if ((info->isdn_driver == drv) &&
- (info->isdn_channel == chan)) {
- info->msr |= UART_MSR_CTS;
- if (info->send_outstanding)
- if (!(--info->send_outstanding))
- info->lsr |= UART_LSR_TEMT;
- isdn_tty_tint(info);
- }
- }
- return;
-}
diff --git a/drivers/isdn/isdn_tty.h b/drivers/isdn/isdn_tty.h
index 037df4912..986cb54f7 100644
--- a/drivers/isdn/isdn_tty.h
+++ b/drivers/isdn/isdn_tty.h
@@ -1,4 +1,4 @@
-/* $Id: isdn_tty.h,v 1.8 1997/02/10 20:12:50 fritz Exp $
+/* $Id: isdn_tty.h,v 1.10 1997/03/02 14:29:26 fritz Exp $
* header for Linux ISDN subsystem, tty related functions (linklevel).
*
@@ -20,6 +20,14 @@
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
* $Log: isdn_tty.h,v $
+ * Revision 1.10 1997/03/02 14:29:26 fritz
+ * More ttyI related cleanup.
+ *
+ * Revision 1.9 1997/02/28 02:32:49 fritz
+ * Cleanup: Moved some tty related stuff from isdn_common.c
+ * to isdn_tty.c
+ * Bugfix: Bisync protocol did not behave like documented.
+ *
* Revision 1.8 1997/02/10 20:12:50 fritz
* Changed interface for reporting incoming calls.
*
@@ -46,15 +54,12 @@
*
*/
-extern void isdn_tty_modem_result(int, modem_info *);
extern void isdn_tty_modem_escape(void);
extern void isdn_tty_modem_ring(void);
extern void isdn_tty_modem_xmit(void);
-extern void isdn_tty_modem_hup(modem_info *, int);
extern int isdn_tty_modem_init(void);
extern void isdn_tty_readmodem(void);
-extern int isdn_tty_try_read(modem_info *, struct sk_buff *);
extern int isdn_tty_find_icall(int, int, setup_parm);
-extern int isdn_tty_countDLE(unsigned char *, int);
-extern void isdn_tty_bsent(int, int);
extern void isdn_tty_cleanup_xmit(modem_info *);
+extern int isdn_tty_stat_callback(int, isdn_ctrl *);
+extern int isdn_tty_rcv_skb(int, int, int, struct sk_buff *);
diff --git a/drivers/isdn/pcbit/drv.c b/drivers/isdn/pcbit/drv.c
index 54c728107..e7d765a95 100644
--- a/drivers/isdn/pcbit/drv.c
+++ b/drivers/isdn/pcbit/drv.c
@@ -449,15 +449,9 @@ int pcbit_writecmd(const u_char* buf, int len, int user, int driver, int channel
for (i=0; i < len; i++)
{
for(j=0; j < LOAD_RETRY; j++)
- {
- __volatile__ unsigned char * ptr;
-
- ptr = dev->sh_mem + dev->loadptr;
- if (*ptr == 0)
+ if (!(readb(dev->sh_mem + dev->loadptr)))
break;
- }
-
if (j == LOAD_RETRY)
{
errstat = -ETIME;
diff --git a/drivers/isdn/sc/Makefile b/drivers/isdn/sc/Makefile
index be0d8b76c..5af3d2e6c 100644
--- a/drivers/isdn/sc/Makefile
+++ b/drivers/isdn/sc/Makefile
@@ -1,5 +1,5 @@
#
-# $Id: Makefile,v 1.2 1997/05/01 08:53:47 davem Exp $
+# $Id: Makefile,v 1.3 1997/05/27 23:25:01 fritz Exp $
# Copyright (C) 1996 SpellCaster Telecommunications Inc.
#
# This program is free software; you can redistribute it and/or modify
diff --git a/drivers/isdn/sc/command.c b/drivers/isdn/sc/command.c
index 577d52e79..28accdc0f 100644
--- a/drivers/isdn/sc/command.c
+++ b/drivers/isdn/sc/command.c
@@ -1,5 +1,5 @@
/*
- * $Id: command.c,v 1.3 1997/02/11 22:53:40 fritz Exp $
+ * $Id: command.c,v 1.4 1997/03/30 16:51:34 calle Exp $
* Copyright (C) 1996 SpellCaster Telecommunications Inc.
*
* This program is free software; you can redistribute it and/or modify
@@ -136,15 +136,12 @@ int command(isdn_ctrl *cmd)
int err;
memcpy(&cmdptr, cmd->parm.num, sizeof(unsigned long));
- if((err = verify_area(VERIFY_READ,
- (scs_ioctl *) cmdptr, sizeof(scs_ioctl)))) {
+ if((err = copy_from_user(&ioc, (scs_ioctl *) cmdptr,
+ sizeof(scs_ioctl)))) {
pr_debug("%s: Failed to verify user space 0x%x\n",
adapter[card]->devicename, cmdptr);
return err;
-
}
- copy_from_user(&ioc, (scs_ioctl *) cmdptr,
- sizeof(scs_ioctl));
return sc_ioctl(card, &ioc);
}
case ISDN_CMD_DIAL:
diff --git a/drivers/isdn/sc/init.c b/drivers/isdn/sc/init.c
index 3a181b998..eeaecdd8f 100644
--- a/drivers/isdn/sc/init.c
+++ b/drivers/isdn/sc/init.c
@@ -305,7 +305,7 @@ int init_sc(void)
/*
* No interrupt could be used
*/
- pr_debug("Failed to acquire an IRQ line\n");
+ pr_debug("Failed to aquire an IRQ line\n");
continue;
}
diff --git a/drivers/isdn/sc/ioctl.c b/drivers/isdn/sc/ioctl.c
index 600a1f6d5..9915cb0d8 100644
--- a/drivers/isdn/sc/ioctl.c
+++ b/drivers/isdn/sc/ioctl.c
@@ -50,9 +50,8 @@ int sc_ioctl(int card, scs_ioctl *data)
/*
* Get the SRec from user space
*/
- if((err = verify_area(VERIFY_READ, (char *) data->dataptr, sizeof(srec))))
+ if ((err = copy_from_user(srec, (char *) data->dataptr, sizeof(srec))))
return err;
- copy_from_user(srec, (char *) data->dataptr, sizeof(srec));
status = send_and_receive(card, CMPID, cmReqType2, cmReqClass0, cmReqLoadProc,
0, sizeof(srec), srec, &rcvmsg, SAR_TIMEOUT);
@@ -92,9 +91,8 @@ int sc_ioctl(int card, scs_ioctl *data)
/*
* Get the switch type from user space
*/
- if((err = verify_area(VERIFY_READ, (char *) data->dataptr, sizeof(char))))
+ if ((err = copy_from_user(&switchtype, (char *) data->dataptr, sizeof(char))))
return err;
- copy_from_user(&switchtype, (char *) data->dataptr, sizeof(char));
pr_debug("%s: SCIOCSETSWITCH: Setting switch type to %d\n", adapter[card]->devicename,
switchtype);
@@ -138,9 +136,8 @@ int sc_ioctl(int card, scs_ioctl *data)
/*
* Package the switch type and send to user space
*/
- if((err = verify_area(VERIFY_WRITE, (char *) data->dataptr, sizeof(char))))
+ if ((err = copy_to_user((char *) data->dataptr, &switchtype, sizeof(char))))
return err;
- copy_to_user((char *) data->dataptr, &switchtype, sizeof(char));
return 0;
}
@@ -171,9 +168,8 @@ int sc_ioctl(int card, scs_ioctl *data)
/*
* Package the switch type and send to user space
*/
- if((err = verify_area(VERIFY_WRITE, (char *) data->dataptr, sizeof(spid))))
+ if ((err = copy_to_user((char *) data->dataptr, spid, sizeof(spid))))
return err;
- copy_to_user((char *) data->dataptr, spid, sizeof(spid));
return 0;
}
@@ -189,10 +185,8 @@ int sc_ioctl(int card, scs_ioctl *data)
/*
* Get the spid from user space
*/
- if((err = verify_area(VERIFY_READ, (char *) data->dataptr,
- sizeof(spid))))
+ if ((err = copy_from_user(spid, (char *) data->dataptr, sizeof(spid))))
return err;
- copy_from_user(spid, (char *) data->dataptr, sizeof(spid));
pr_debug("%s: SCIOCSETSPID: Setting channel %d spid to %s\n",
adapter[card]->devicename, data->channel, spid);
@@ -238,9 +232,8 @@ int sc_ioctl(int card, scs_ioctl *data)
/*
* Package the dn and send to user space
*/
- if((err = verify_area(VERIFY_WRITE, (char *) data->dataptr, sizeof(dn))))
+ if ((err = copy_to_user((char *) data->dataptr, dn, sizeof(dn))))
return err;
- copy_to_user((char *) data->dataptr, dn, sizeof(dn));
return 0;
}
@@ -256,10 +249,8 @@ int sc_ioctl(int card, scs_ioctl *data)
/*
* Get the spid from user space
*/
- if((err = verify_area(VERIFY_READ, (char *) data->dataptr,
- sizeof(dn))))
+ if ((err = copy_from_user(dn, (char *) data->dataptr, sizeof(dn))))
return err;
- copy_from_user(dn, (char *) data->dataptr, sizeof(dn));
pr_debug("%s: SCIOCSETDN: Setting channel %d dn to %s\n",
adapter[card]->devicename, data->channel, dn);
@@ -293,11 +284,9 @@ int sc_ioctl(int card, scs_ioctl *data)
pr_debug("%s: SCIOSTAT: ioctl received\n", adapter[card]->devicename);
GetStatus(card, &bi);
- if((err = verify_area(VERIFY_WRITE, (boardInfo *) data->dataptr,
- sizeof(boardInfo))))
- return err;
- copy_to_user((boardInfo *) data->dataptr, &bi, sizeof(boardInfo));
+ if ((err = copy_to_user((boardInfo *) data->dataptr, &bi, sizeof(boardInfo))))
+ return err;
return 0;
}
@@ -330,9 +319,8 @@ int sc_ioctl(int card, scs_ioctl *data)
/*
* Package the switch type and send to user space
*/
- if((err = verify_area(VERIFY_WRITE, (char *) data->dataptr, sizeof(char))))
+ if ((err = copy_to_user((char *) data->dataptr, &speed, sizeof(char))))
return err;
- copy_to_user((char *) data->dataptr, &speed, sizeof(char));
return 0;
}
diff --git a/drivers/net/Config.in b/drivers/net/Config.in
index c56811d5f..e14c76a61 100644
--- a/drivers/net/Config.in
+++ b/drivers/net/Config.in
@@ -183,9 +183,13 @@ if [ "$CONFIG_WAN_ROUTER" = "y" ]; then
fi
fi
fi
-
+#
+# X.25 network drivers
+#
if [ "$CONFIG_X25" != "n" ]; then
- tristate 'LAPB over Ethernet driver' CONFIG_LAPBETHER
- tristate 'X.25 async driver' CONFIG_X25_ASY
+if [ "$CONFIG_LAPB" != "n" ]; then
+ dep_tristate 'LAPB over Ethernet driver' CONFIG_LAPBETHER $CONFIG_LAPB
+ dep_tristate 'X.25 async driver' CONFIG_X25_ASY $CONFIG_LAPB
+fi
fi
diff --git a/drivers/net/apricot.c b/drivers/net/apricot.c
index cc118f7e3..e15d77966 100644
--- a/drivers/net/apricot.c
+++ b/drivers/net/apricot.c
@@ -299,7 +299,7 @@ init_i596_mem(struct device *dev)
i596_add_cmd(dev, &lp->tdr);
boguscnt = 200;
- while (lp->scb.status, lp->scb.command)
+ while (lp->scb.command)
if (--boguscnt == 0)
{
printk("%s: receive unit start timed out with status %4.4x, cmd %4.4x.\n",
@@ -311,7 +311,7 @@ init_i596_mem(struct device *dev)
outw(0, ioaddr+4);
boguscnt = 200;
- while (lp->scb.status, lp->scb.command)
+ while (lp->scb.command)
if (--boguscnt == 0)
{
printk("i82596 init timed out with status %4.4x, cmd %4.4x.\n",
@@ -427,7 +427,7 @@ i596_cleanup_cmd(struct i596_private *lp)
}
}
- while (lp->scb.status, lp->scb.command)
+ while (lp->scb.command)
if (--boguscnt == 0)
{
printk("i596_cleanup_cmd timed out with status %4.4x, cmd %4.4x.\n",
@@ -445,7 +445,7 @@ i596_reset(struct device *dev, struct i596_private *lp, int ioaddr)
if (i596_debug > 4) printk ("i596_reset\n");
- while (lp->scb.status, lp->scb.command)
+ while (lp->scb.command)
if (--boguscnt == 0)
{
printk("i596_reset timed out with status %4.4x, cmd %4.4x.\n",
@@ -462,7 +462,7 @@ i596_reset(struct device *dev, struct i596_private *lp, int ioaddr)
/* wait for shutdown */
boguscnt = 400;
- while ((lp->scb.status, lp->scb.command) || lp->scb.command)
+ while (lp->scb.command)
if (--boguscnt == 0)
{
printk("i596_reset 2 timed out with status %4.4x, cmd %4.4x.\n",
@@ -499,7 +499,7 @@ static void i596_add_cmd(struct device *dev, struct i596_cmd *cmd)
else
{
lp->cmd_head = cmd;
- while (lp->scb.status, lp->scb.command)
+ while (lp->scb.command)
if (--boguscnt == 0)
{
printk("i596_add_cmd timed out with status %4.4x, cmd %4.4x.\n",
@@ -768,7 +768,7 @@ i596_interrupt(int irq, void *dev_id, struct pt_regs *regs)
lp = (struct i596_private *)dev->priv;
- while (lp->scb.status, lp->scb.command)
+ while (lp->scb.command)
if (--boguscnt == 0)
{
printk("%s: i596 interrupt, timeout status %4.4x command %4.4x.\n", dev->name, lp->scb.status, lp->scb.command);
@@ -827,8 +827,6 @@ i596_interrupt(int irq, void *dev_id, struct pt_regs *regs)
}
case CmdMulticastList:
{
- unsigned short count = *((unsigned short *) (ptr + 1));
-
ptr->next = (struct i596_cmd * ) I596_NULL;
kfree(ptr);
break;
@@ -890,7 +888,7 @@ i596_interrupt(int irq, void *dev_id, struct pt_regs *regs)
if ((lp->scb.cmd != (struct i596_cmd *) I596_NULL) && (dev->start)) ack_cmd | = CUC_START;
*/
boguscnt = 100;
- while (lp->scb.status, lp->scb.command)
+ while (lp->scb.command)
if (--boguscnt == 0)
{
printk("%s: i596 interrupt, timeout status %4.4x command %4.4x.\n", dev->name, lp->scb.status, lp->scb.command);
@@ -928,7 +926,7 @@ i596_close(struct device *dev)
i596_cleanup_cmd(lp);
- while (lp->scb.status, lp->scb.command)
+ while (lp->scb.command)
if (--boguscnt == 0)
{
printk("%s: close timed timed out with status %4.4x, cmd %4.4x.\n",
@@ -1033,7 +1031,7 @@ void
cleanup_module(void)
{
unregister_netdev(&dev_apricot);
- kfree(dev_apricot.mem_start);
+ kfree((void*)dev_apricot.mem_start);
dev_apricot.priv = NULL;
/* If we don't do this, we can't re-insmod it later. */
diff --git a/drivers/net/bpqether.c b/drivers/net/bpqether.c
index ca1bcc9c7..2f698a747 100644
--- a/drivers/net/bpqether.c
+++ b/drivers/net/bpqether.c
@@ -1,10 +1,6 @@
/*
* G8BPQ compatible "AX.25 via ethernet" driver release 003
*
- * This is ALPHA test software. This code may break your machine, randomly
- * fail to work with new releases, misbehave and/or generally screw up.
- * It might even work.
- *
* This code REQUIRES 2.0.0 or higher/ NET3.029
*
* This module:
@@ -268,6 +264,7 @@ static int bpq_rcv(struct sk_buff *skb, struct device *dev, struct packet_type *
*/
static int bpq_xmit(struct sk_buff *skb, struct device *dev)
{
+ struct sk_buff *newskb;
unsigned char *ptr;
struct bpqdev *bpq;
int size;
@@ -278,7 +275,7 @@ static int bpq_xmit(struct sk_buff *skb, struct device *dev)
*/
if (!dev->start) {
bpq_check_devices(dev);
- dev_kfree_skb(skb, FREE_WRITE);
+ kfree_skb(skb, FREE_WRITE);
return -ENODEV;
}
@@ -290,21 +287,16 @@ static int bpq_xmit(struct sk_buff *skb, struct device *dev)
* sendto() does not.
*/
if (skb_headroom(skb) < AX25_BPQ_HEADER_LEN) { /* Ough! */
- struct sk_buff *newskb = alloc_skb(skb->len + AX25_BPQ_HEADER_LEN, GFP_ATOMIC);
-
- if (newskb == NULL) { /* Argh! */
- printk(KERN_WARNING "bpq_xmit: not enough space to add BPQ Ether header\n");
- dev_kfree_skb(skb, FREE_WRITE);
+ if ((newskb = skb_realloc_headroom(skb, AX25_BPQ_HEADER_LEN)) == NULL) {
+ printk(KERN_WARNING "bpqether: out of memory\n");
+ kfree_skb(skb, FREE_WRITE);
return -ENOMEM;
}
- newskb->arp = 1;
- if (skb->sk)
+ if (skb->sk != NULL)
skb_set_owner_w(newskb, skb->sk);
- skb_reserve(newskb, AX25_BPQ_HEADER_LEN);
- memcpy(skb_put(newskb, size), skb->data, size);
- dev_kfree_skb(skb, FREE_WRITE);
+ kfree_skb(skb, FREE_WRITE);
skb = newskb;
}
@@ -319,7 +311,7 @@ static int bpq_xmit(struct sk_buff *skb, struct device *dev)
if ((dev = bpq_get_ether_dev(dev)) == NULL) {
bpq->stats.tx_dropped++;
- dev_kfree_skb(skb, FREE_WRITE);
+ kfree_skb(skb, FREE_WRITE);
return -ENODEV;
}
@@ -509,7 +501,7 @@ static int bpq_new_device(struct device *dev)
unsigned char *buf;
struct bpqdev *bpq, *bpq2;
- if ((bpq = (struct bpqdev *)kmalloc(sizeof(struct bpqdev), GFP_KERNEL)) == NULL)
+ if ((bpq = kmalloc(sizeof(struct bpqdev), GFP_KERNEL)) == NULL)
return -ENOMEM;
memset(bpq, 0, sizeof(struct bpqdev));
@@ -523,7 +515,7 @@ static int bpq_new_device(struct device *dev)
memcpy(bpq->acpt_addr, bcast_addr, sizeof(bpq_eth_addr));
dev = &bpq->axdev;
- buf = (unsigned char *)kmalloc(14, GFP_KERNEL);
+ buf = kmalloc(14, GFP_KERNEL);
for (k = 0; k < MAXBPQDEV; k++) {
struct device *odev;
@@ -562,12 +554,13 @@ static int bpq_new_device(struct device *dev)
/* preset with reasonable values */
-#if CONFIG_INET
dev->flags = 0;
dev->family = AF_INET;
- dev->pa_addr = 0;
- dev->pa_brdaddr = 0;
- dev->pa_mask = 0;
+
+#ifdef CONFIG_INET
+ dev->pa_addr = in_aton("192.168.0.1");
+ dev->pa_brdaddr = in_aton("192.168.0.255");
+ dev->pa_mask = in_aton("255.255.255.0");
dev->pa_alen = 4;
#endif
@@ -664,6 +657,9 @@ __initfunc(int bpq_init(void))
#ifdef MODULE
EXPORT_NO_SYMBOLS;
+MODULE_AUTHOR("Joerg Reuter DL1BKE <jreuter@lykos.oche.de>");
+MODULE_DESCRIPTION("Transmit and receive AX.25 packets over Ethernet");
+
int init_module(void)
{
return bpq_init();
diff --git a/drivers/net/dgrs.c b/drivers/net/dgrs.c
index 1a9d48827..17b4f5387 100644
--- a/drivers/net/dgrs.c
+++ b/drivers/net/dgrs.c
@@ -844,7 +844,7 @@ static int dgrs_ioctl(struct device *devN, struct ifreq *ifr, int cmd)
{
DGRS_PRIV *privN = (DGRS_PRIV *) devN->priv;
DGRS_IOCTL ioc;
- int i, rc;
+ int i;
if (cmd != DGRSIOCTL)
return -EINVAL;
diff --git a/drivers/net/lapbether.c b/drivers/net/lapbether.c
index 3d9801352..e282847a9 100644
--- a/drivers/net/lapbether.c
+++ b/drivers/net/lapbether.c
@@ -1,10 +1,6 @@
/*
* "LAPB via ethernet" driver release 001
*
- * This is ALPHA test software. This code may break your machine, randomly
- * fail to work with new releases, misbehave and/or generally screw up.
- * It might even work.
- *
* This code REQUIRES 2.1.15 or higher/ NET3.038
*
* This module:
@@ -226,7 +222,7 @@ static int lapbeth_xmit(struct sk_buff *skb, struct device *dev)
*/
if (!dev->start) {
lapbeth_check_devices(dev);
- dev_kfree_skb(skb, FREE_WRITE);
+ kfree_skb(skb, FREE_WRITE);
return -ENODEV;
}
@@ -427,7 +423,7 @@ static int lapbeth_new_device(struct device *dev)
unsigned char *buf;
struct lapbethdev *lapbeth, *lapbeth2;
- if ((lapbeth = (struct lapbethdev *)kmalloc(sizeof(struct lapbethdev), GFP_KERNEL)) == NULL)
+ if ((lapbeth = kmalloc(sizeof(struct lapbethdev), GFP_KERNEL)) == NULL)
return -ENOMEM;
memset(lapbeth, 0, sizeof(struct lapbethdev));
@@ -438,7 +434,7 @@ static int lapbeth_new_device(struct device *dev)
strncpy(lapbeth->ethname, dev->name, sizeof(lapbeth->ethname)-1);
dev = &lapbeth->axdev;
- buf = (unsigned char *)kmalloc(14, GFP_KERNEL);
+ buf = kmalloc(14, GFP_KERNEL);
for (k = 0; k < MAXLAPBDEV; k++) {
struct device *odev;
@@ -474,12 +470,13 @@ static int lapbeth_new_device(struct device *dev)
/* preset with reasonable values */
-#if CONFIG_INET
dev->flags = 0;
dev->family = AF_INET;
- dev->pa_addr = 0;
- dev->pa_brdaddr = 0;
- dev->pa_mask = 0;
+
+#ifdef CONFIG_INET
+ dev->pa_addr = in_aton("192.168.0.1");
+ dev->pa_brdaddr = in_aton("192.168.0.255");
+ dev->pa_mask = in_aton("255.255.255.0");
dev->pa_alen = 4;
#endif
@@ -562,6 +559,9 @@ int lapbeth_init(void)
#ifdef MODULE
EXPORT_NO_SYMBOLS;
+MODULE_AUTHOR("Jonathan Naylor <g4klx@g4klx.demon.co.uk>");
+MODULE_DESCRIPTION("The unofficial LAPB over Ethernet driver");
+
int init_module(void)
{
return lapbeth_init();
diff --git a/drivers/net/mkiss.c b/drivers/net/mkiss.c
index 13ebbd9b4..34980a7aa 100644
--- a/drivers/net/mkiss.c
+++ b/drivers/net/mkiss.c
@@ -15,7 +15,7 @@
* This method clears the way to implement other kiss protocols
* like mkiss smack g8bpq ..... so far only mkiss is implemented.
*
- * Hans Alblas Hansa@cuci.nl
+ * Hans Alblas <hans@esrac.ele.tue.nl>
*
* History
* Jonathan (G4KLX) Fixed to match Linux networking changes - 2.1.15.
@@ -31,6 +31,7 @@
#include <linux/mm.h>
#include <linux/interrupt.h>
#include <linux/in.h>
+#include <linux/inet.h>
#include <linux/tty.h>
#include <linux/errno.h>
#include <linux/netdevice.h>
@@ -75,8 +76,8 @@ typedef struct ax25_ctrl {
} ax25_ctrl_t;
static ax25_ctrl_t **ax25_ctrls = NULL;
+
int ax25_maxdev = AX25_MAXDEV; /* Can be overridden with insmod! */
-MODULE_PARM(ax25_maxdev, "i");
static struct tty_ldisc ax_ldisc;
static struct tty_driver mkiss_driver;
@@ -118,7 +119,7 @@ static inline struct ax_disp *ax_alloc(void)
return NULL;
/* If no channels are available, allocate one */
- if (axp == NULL && (ax25_ctrls[i] = (ax25_ctrl_t *)kmalloc(sizeof(ax25_ctrl_t), GFP_KERNEL)) != NULL) {
+ if (axp == NULL && (ax25_ctrls[i] = kmalloc(sizeof(ax25_ctrl_t), GFP_KERNEL)) != NULL) {
axp = ax25_ctrls[i];
memset(axp, 0, sizeof(ax25_ctrl_t));
@@ -148,7 +149,7 @@ static inline struct ax_disp *ax_alloc(void)
return &axp->ctrl;
} else {
clear_bit(AXF_INUSE,&axp->ctrl.flags);
- printk(KERN_ERR "ax_alloc() - register_netdev() failure.\n");
+ printk(KERN_ERR "mkiss: ax_alloc() - register_netdev() failure.\n");
}
}
@@ -166,7 +167,7 @@ static inline void ax_free(struct ax_disp *ax)
kfree(ax->xbuff);
ax->xbuff = NULL;
if (!test_and_clear_bit(AXF_INUSE, &ax->flags))
- printk(KERN_ERR "%s: ax_free for already free unit.\n", ax->dev->name);
+ printk(KERN_ERR "mkiss: %s: ax_free for already free unit.\n", ax->dev->name);
}
static void ax_changedmtu(struct ax_disp *ax)
@@ -186,11 +187,11 @@ static void ax_changedmtu(struct ax_disp *ax)
if (len < 576 * 2)
len = 576 * 2;
- xbuff = (unsigned char *)kmalloc(len + 4, GFP_ATOMIC);
- rbuff = (unsigned char *)kmalloc(len + 4, GFP_ATOMIC);
+ xbuff = kmalloc(len + 4, GFP_ATOMIC);
+ rbuff = kmalloc(len + 4, GFP_ATOMIC);
if (xbuff == NULL || rbuff == NULL) {
- printk(KERN_ERR "%s: unable to grow ax25 buffers, MTU change cancelled.\n",
+ printk(KERN_ERR "mkiss: %s: unable to grow ax25 buffers, MTU change cancelled.\n",
ax->dev->name);
dev->mtu = ax->mtu;
if (xbuff != NULL)
@@ -245,7 +246,7 @@ static void ax_changedmtu(struct ax_disp *ax)
static inline void ax_lock(struct ax_disp *ax)
{
if (test_and_set_bit(0, (void *)&ax->dev->tbusy))
- printk(KERN_ERR "%s: trying to lock already locked device!\n", ax->dev->name);
+ printk(KERN_ERR "mkiss: %s: trying to lock already locked device!\n", ax->dev->name);
}
@@ -253,7 +254,7 @@ static inline void ax_lock(struct ax_disp *ax)
static inline void ax_unlock(struct ax_disp *ax)
{
if (!test_and_clear_bit(0, (void *)&ax->dev->tbusy))
- printk(KERN_ERR "%s: trying to unlock already unlocked device!\n", ax->dev->name);
+ printk(KERN_ERR "mkiss: %s: trying to unlock already unlocked device!\n", ax->dev->name);
}
/* Send one completely decapsulated AX.25 packet to the AX.25 layer. */
@@ -277,7 +278,7 @@ static void ax_bump(struct ax_disp *ax)
count = ax->rcount;
if ((skb = dev_alloc_skb(count)) == NULL) {
- printk(KERN_ERR "%s: memory squeeze, dropping packet.\n", ax->dev->name);
+ printk(KERN_ERR "mkiss: %s: memory squeeze, dropping packet.\n", ax->dev->name);
ax->rx_dropped++;
return;
}
@@ -302,7 +303,7 @@ static void ax_encaps(struct ax_disp *ax, unsigned char *icp, int len)
if (len > ax->mtu) { /* Sigh, shouldn't occur BUT ... */
len = ax->mtu;
- printk(KERN_ERR "%s: truncating oversized transmit packet!\n", ax->dev->name);
+ printk(KERN_ERR "mkiss: %s: truncating oversized transmit packet!\n", ax->dev->name);
ax->tx_dropped++;
ax_unlock(ax);
return;
@@ -380,7 +381,7 @@ static int ax_xmit(struct sk_buff *skb, struct device *dev)
}
if (!dev->start) {
- printk(KERN_ERR "%s: xmit call when iface is down\n", dev->name);
+ printk(KERN_ERR "mkiss: %s: xmit call when iface is down\n", dev->name);
return 1;
}
@@ -404,7 +405,7 @@ static int ax_xmit(struct sk_buff *skb, struct device *dev)
return 1;
}
- printk(KERN_ERR "%s: transmit timed out, %s?\n", dev->name,
+ printk(KERN_ERR "mkiss: %s: transmit timed out, %s?\n", dev->name,
(ax->tty->driver.chars_in_buffer(ax->tty) || ax->xleft) ?
"bad line quality" : "driver error");
@@ -419,7 +420,7 @@ static int ax_xmit(struct sk_buff *skb, struct device *dev)
if (tmp_ax != NULL)
ax_lock(tmp_ax);
ax_encaps(ax, skb->data, skb->len);
- dev_kfree_skb(skb, FREE_WRITE);
+ kfree_skb(skb, FREE_WRITE);
}
return 0;
@@ -476,10 +477,10 @@ static int ax_open(struct device *dev)
if (len < 576 * 2)
len = 576 * 2;
- if ((ax->rbuff = (unsigned char *) kmalloc(len + 4, GFP_KERNEL)) == NULL)
+ if ((ax->rbuff = kmalloc(len + 4, GFP_KERNEL)) == NULL)
goto norbuff;
- if ((ax->xbuff = (unsigned char *) kmalloc(len + 4, GFP_KERNEL)) == NULL)
+ if ((ax->xbuff = kmalloc(len + 4, GFP_KERNEL)) == NULL)
goto noxbuff;
ax->mtu = dev->mtu + 73;
@@ -823,7 +824,7 @@ __initfunc(int mkiss_init_ctrl_dev(void))
if (ax25_maxdev < 4) ax25_maxdev = 4; /* Sanity */
- if ((ax25_ctrls = (ax25_ctrl_t **)kmalloc(sizeof(void*) * ax25_maxdev, GFP_KERNEL)) == NULL) {
+ if ((ax25_ctrls = kmalloc(sizeof(void*) * ax25_maxdev, GFP_KERNEL)) == NULL) {
printk(KERN_ERR "mkiss: Can't allocate ax25_ctrls[] array ! No mkiss available\n");
return -ENOMEM;
}
@@ -910,10 +911,13 @@ static int ax25_init(struct device *dev)
/* New-style flags. */
dev->flags = 0;
dev->family = AF_INET;
- dev->pa_addr = 0;
- dev->pa_brdaddr = 0;
- dev->pa_mask = 0;
+
+#ifdef CONFIG_INET
+ dev->pa_addr = in_aton("192.168.0.1");
+ dev->pa_brdaddr = in_aton("192.168.0.255");
+ dev->pa_mask = in_aton("255.255.255.0");
dev->pa_alen = 4;
+#endif
return 0;
}
@@ -1080,7 +1084,7 @@ __initfunc(static int mkiss_init(void))
mkiss_driver.put_char = mkiss_dummy2;
if (tty_register_driver(&mkiss_driver)) {
- printk(KERN_ERR "Couldn't register Mkiss device\n");
+ printk(KERN_ERR "mkiss: couldn't register Mkiss device\n");
return -EIO;
}
@@ -1092,6 +1096,12 @@ __initfunc(static int mkiss_init(void))
#ifdef MODULE
EXPORT_NO_SYMBOLS;
+MODULE_PARM(ax25_maxdev, "i");
+MODULE_PARM_DESC(ax25_maxdev, "number of MKISS devices");
+
+MODULE_AUTHOR("Hans Albas PE1AYX <hans@esrac.ele.tue.nl>");
+MODULE_DESCRIPTION("KISS driver for AX.25 over TTYs");
+
int init_module(void)
{
return mkiss_init_ctrl_dev();
diff --git a/drivers/net/pi2.c b/drivers/net/pi2.c
index 347d6d980..6a2b4f112 100644
--- a/drivers/net/pi2.c
+++ b/drivers/net/pi2.c
@@ -332,11 +332,6 @@ static void tdelay(struct pi_local *lp, int time)
wrtscc(lp->cardbase, lp->base + CTL, R0, RES_EXT_INT);
}
-static void free_p(struct sk_buff *skb)
-{
- dev_kfree_skb(skb, FREE_WRITE);
-}
-
static void a_txint(struct pi_local *lp)
{
int cmd;
@@ -413,7 +408,7 @@ static void a_exint(struct pi_local *lp)
}
switch (lp->tstate) {
case ACTIVE:
- free_p(lp->sndbuf);
+ kfree_skb(lp->sndbuf, FREE_WRITE);
lp->sndbuf = NULL;
lp->tstate = FLAGOUT;
tdelay(lp, lp->squeldelay);
@@ -731,7 +726,7 @@ static void b_txint(struct pi_local *lp)
/* stuffing a char satisfies Interrupt condition */
} else {
/* No more to send */
- free_p(lp->sndbuf);
+ kfree_skb(lp->sndbuf, FREE_WRITE);
lp->sndbuf = NULL;
if ((rdscc(lp->cardbase, cmd, R0) & 0x40)) {
/* Did we underrun? */
@@ -783,7 +778,7 @@ static void b_exint(struct pi_local *lp)
switch (lp->tstate) {
case ACTIVE: /* Unexpected underrun */
- free_p(lp->sndbuf);
+ kfree_skb(lp->sndbuf, FREE_WRITE);
lp->sndbuf = NULL;
wrtscc(lp->cardbase, cmd, R0, SEND_ABORT);
lp->tstate = FLAGOUT;
@@ -1565,7 +1560,7 @@ static int pi_close(struct device *dev)
/* Free any buffers left in the hardware transmit queue */
while ((ptr = skb_dequeue(&lp->sndq)) != NULL)
- free_p(ptr);
+ kfree_skb(ptr, FREE_WRITE);
restore_flags(flags);
@@ -1665,6 +1660,9 @@ static struct net_device_stats *pi_get_stats(struct device *dev)
#ifdef MODULE
EXPORT_NO_SYMBOLS;
+MODULE_AUTHOR("David Perry <dp@hydra.carleton.ca>");
+MODULE_DESCRIPTION("AX.25 driver for the Ottawa PI and PI/2 HDLC cards");
+
int init_module(void)
{
return pi_init();
@@ -1685,12 +1683,3 @@ void cleanup_module(void)
unregister_netdev(&pi0b);
}
#endif
-
-/*
- * Local variables:
- * compile-command: "gcc -D__KERNEL__ -I/usr/src/linux/net/inet -Wall -Wstrict-prototypes -O6 -m486 -c skeleton.c"
- * version-control: t
- * kept-new-versions: 5
- * tab-width: 4
- * End:
- */
diff --git a/drivers/net/pt.c b/drivers/net/pt.c
index f6ef6db65..bdef58992 100644
--- a/drivers/net/pt.c
+++ b/drivers/net/pt.c
@@ -26,7 +26,7 @@
* 03/03/95 cs Painfully found out (after 3 days) SERIAL_CFG is write only
* created image of it and DMA_CFG
* 21/06/95 cs Upgraded to suit PI driver 0.8 ALPHA
- * 22/08/95 cs Changed it all around to make it like pi driver
+ * 22/08/95 cs Changed it all around to make it like pi driver
* 23/08/95 cs It now works, got caught again by TMR2 and we must have
* auto-enables for daughter boards.
* 07/10/95 cs Fixed for 1.3.30 (hopefully)
@@ -318,12 +318,6 @@ static void setup_tx_dma(struct pt_local *lp, int length)
restore_flags(flags);
}
-static void free_p(struct sk_buff *skb)
-{
- dev_kfree_skb(skb, FREE_WRITE);
-}
-
-
/*
* This sets up all the registers in the SCC for the given channel
* based upon tsync_hwint()
@@ -979,7 +973,7 @@ static int pt_close(struct device *dev)
/* Free any buffers left in the hardware transmit queue */
while ((ptr = skb_dequeue(&lp->sndq)) != NULL)
- free_p(ptr);
+ kfree_skb(ptr, FREE_WRITE);
restore_flags(flags);
@@ -1197,7 +1191,7 @@ static void pt_txisr(struct pt_local *lp)
/* stuffing a char satisfies interrupt condition */
} else {
/* No more to send */
- free_p(lp->sndbuf);
+ kfree_skb(lp->sndbuf, FREE_WRITE);
lp->sndbuf = NULL;
if ((rdscc(lp->cardbase, cmd, R0) & TxEOM))
{
@@ -1552,7 +1546,7 @@ static void pt_exisr(struct pt_local *lp)
#ifdef PT_DEBUG
printk(KERN_DEBUG "PT: exisr(): unexpected underrun detected.\n");
#endif
- free_p(lp->sndbuf);
+ kfree_skb(lp->sndbuf, FREE_WRITE);
lp->sndbuf = NULL;
if (!lp->dmachan)
{
@@ -1766,6 +1760,9 @@ static void pt_exisr(struct pt_local *lp)
#ifdef MODULE
EXPORT_NO_SYMBOLS;
+MODULE_AUTHOR("Craig Small VK2XLZ <vk2xlz@vk2xlz.ampr.org>");
+MODULE_DESCRIPTION("AX.25 driver for the Gracillis PacketTwin HDLC card");
+
int init_module(void)
{
return pt_init();
diff --git a/drivers/net/soundmodem/sm.c b/drivers/net/soundmodem/sm.c
index 7d57dd692..d55bc0c04 100644
--- a/drivers/net/soundmodem/sm.c
+++ b/drivers/net/soundmodem/sm.c
@@ -158,6 +158,7 @@ const struct modem_rx_info *sm_modem_rx_table[] = {
static const struct hardware_info *sm_hardware_table[] = {
#ifdef CONFIG_SOUNDMODEM_SBC
&sm_hw_sbc,
+ &sm_hw_sbcfdx,
#endif /* CONFIG_SOUNDMODEM_SBC */
#ifdef CONFIG_SOUNDMODEM_WSS
&sm_hw_wss,
diff --git a/drivers/net/soundmodem/sm.h b/drivers/net/soundmodem/sm.h
index a50a3db37..2cce82992 100644
--- a/drivers/net/soundmodem/sm.h
+++ b/drivers/net/soundmodem/sm.h
@@ -325,6 +325,7 @@ extern const struct modem_rx_info sm_fsk9600_4_rx;
extern const struct modem_rx_info sm_fsk9600_5_rx;
extern const struct hardware_info sm_hw_sbc;
+extern const struct hardware_info sm_hw_sbcfdx;
extern const struct hardware_info sm_hw_wss;
extern const struct hardware_info sm_hw_wssfdx;
diff --git a/drivers/net/soundmodem/sm_afsk1200.c b/drivers/net/soundmodem/sm_afsk1200.c
index 6c8aa0c4a..0519c5e79 100644
--- a/drivers/net/soundmodem/sm_afsk1200.c
+++ b/drivers/net/soundmodem/sm_afsk1200.c
@@ -1,7 +1,7 @@
/*****************************************************************************/
/*
- * sm_afsk1200.h -- soundcard radio modem driver, 1200 baud AFSK modem
+ * sm_afsk1200.c -- soundcard radio modem driver, 1200 baud AFSK modem
*
* Copyright (C) 1996 Thomas Sailer (sailer@ife.ee.ethz.ch)
*
diff --git a/drivers/net/soundmodem/sm_fsk9600.c b/drivers/net/soundmodem/sm_fsk9600.c
index 02581463b..8fbf9d218 100644
--- a/drivers/net/soundmodem/sm_fsk9600.c
+++ b/drivers/net/soundmodem/sm_fsk9600.c
@@ -1,7 +1,7 @@
/*****************************************************************************/
/*
- * sm_fsk9600.h -- soundcard radio modem driver,
+ * sm_fsk9600.c -- soundcard radio modem driver,
* 9600 baud G3RUH compatible FSK modem
*
* Copyright (C) 1996 Thomas Sailer (sailer@ife.ee.ethz.ch)
diff --git a/drivers/net/soundmodem/sm_hapn4800.c b/drivers/net/soundmodem/sm_hapn4800.c
index f058876fb..9472d5e06 100644
--- a/drivers/net/soundmodem/sm_hapn4800.c
+++ b/drivers/net/soundmodem/sm_hapn4800.c
@@ -1,7 +1,7 @@
/*****************************************************************************/
/*
- * sm_hapn4800.h -- soundcard radio modem driver, 4800 baud HAPN modem
+ * sm_hapn4800.c -- soundcard radio modem driver, 4800 baud HAPN modem
*
* Copyright (C) 1996 Thomas Sailer (sailer@ife.ee.ethz.ch)
*
diff --git a/drivers/net/soundmodem/sm_sbc.c b/drivers/net/soundmodem/sm_sbc.c
index 4421418e4..1011dca97 100644
--- a/drivers/net/soundmodem/sm_sbc.c
+++ b/drivers/net/soundmodem/sm_sbc.c
@@ -1,7 +1,7 @@
/*****************************************************************************/
/*
- * sm_sbc.h -- soundcard radio modem driver soundblaster hardware driver
+ * sm_sbc.c -- soundcard radio modem driver soundblaster hardware driver
*
* Copyright (C) 1996 Thomas Sailer (sailer@ife.ee.ethz.ch)
*
@@ -80,9 +80,12 @@ extern inline int copy_to_user(void *to, const void *from, unsigned long n)
struct sc_state_sbc {
unsigned char revhi, revlo;
unsigned char fmt[2];
+ unsigned int sr[2];
unsigned int dmabuflen;
unsigned char *dmabuf;
+ unsigned char *dmabuf2;
unsigned char dmabufidx;
+ unsigned char dma2bufidx;
unsigned char ptt;
};
@@ -99,6 +102,7 @@ struct sc_state_sbc {
#define DSP_DATA_AVAIL(iobase) (iobase+0xe)
#define DSP_MIXER_ADDR(iobase) (iobase+0x4)
#define DSP_MIXER_DATA(iobase) (iobase+0x5)
+#define DSP_INTACK_16BIT(iobase) (iobase+0xf)
#define SBC_EXTENT 16
/* --------------------------------------------------------------------- */
@@ -122,6 +126,8 @@ struct sc_state_sbc {
#define SBC_DMA_ON 0xd0
#define SBC_DMA_OFF 0xd4
#define SBC_SAMPLE_RATE 0x40
+#define SBC_SAMPLE_RATE_OUT 0x41
+#define SBC_SAMPLE_RATE_IN 0x42
#define SBC_MONO_8BIT 0xa0
#define SBC_MONO_16BIT 0xa4
#define SBC_STEREO_8BIT 0xa8
@@ -131,6 +137,9 @@ struct sc_state_sbc {
#define SBC4_IN8_AI 0xce
#define SBC4_MODE_UNS_MONO 0x00
+#define SBC4_OUT16_AI 0xb6
+#define SBC4_IN16_AI 0xbe
+
/* --------------------------------------------------------------------- */
static int inline reset_dsp(struct device *dev)
@@ -179,13 +188,102 @@ static int inline read_dsp(struct device *dev, unsigned char *data)
/* --------------------------------------------------------------------- */
-static void inline sbc_int_ack(struct device *dev)
+static int config_resources(struct device *dev, struct sm_state *sm, int fdx)
+{
+ unsigned char irqreg = 0, dmareg = 0, realirq, realdma;
+ unsigned long flags;
+
+ switch (dev->irq) {
+ case 2:
+ case 9:
+ irqreg |= 0x01;
+ break;
+
+ case 5:
+ irqreg |= 0x02;
+ break;
+
+ case 7:
+ irqreg |= 0x04;
+ break;
+
+ case 10:
+ irqreg |= 0x08;
+ break;
+
+ default:
+ return -ENODEV;
+ }
+
+ switch (dev->dma) {
+ case 0:
+ dmareg |= 0x01;
+ break;
+
+ case 1:
+ dmareg |= 0x02;
+ break;
+
+ case 3:
+ dmareg |= 0x08;
+ break;
+
+ default:
+ return -ENODEV;
+ }
+
+ if (fdx) {
+ switch (sm->hdrv.ptt_out.dma2) {
+ case 5:
+ dmareg |= 0x20;
+ break;
+
+ case 6:
+ dmareg |= 0x40;
+ break;
+
+ case 7:
+ dmareg |= 0x80;
+ break;
+
+ default:
+ return -ENODEV;
+ }
+ }
+ save_flags(flags);
+ cli();
+ outb(0x80, DSP_MIXER_ADDR(dev->base_addr));
+ outb(irqreg, DSP_MIXER_DATA(dev->base_addr));
+ realirq = inb(DSP_MIXER_DATA(dev->base_addr));
+ outb(0x81, DSP_MIXER_ADDR(dev->base_addr));
+ outb(dmareg, DSP_MIXER_DATA(dev->base_addr));
+ realdma = inb(DSP_MIXER_DATA(dev->base_addr));
+ restore_flags(flags);
+ if ((~realirq) & irqreg || (~realdma) & dmareg) {
+ printk(KERN_ERR "%s: sbc resource registers cannot be set; "
+ "PnP device and IRQ/DMA specified wrongly?\n",
+ sm_drvname);
+ return -EINVAL;
+ }
+ return 0;
+}
+
+/* --------------------------------------------------------------------- */
+
+static void inline sbc_int_ack_8bit(struct device *dev)
{
inb(DSP_DATA_AVAIL(dev->base_addr));
}
/* --------------------------------------------------------------------- */
+static void inline sbc_int_ack_16bit(struct device *dev)
+{
+ inb(DSP_INTACK_16BIT(dev->base_addr));
+}
+
+/* --------------------------------------------------------------------- */
+
static void setup_dma_dsp(struct device *dev, struct sm_state *sm, int send)
{
unsigned long flags;
@@ -209,7 +307,7 @@ static void setup_dma_dsp(struct device *dev, struct sm_state *sm, int send)
panic("sm: DMA buffer violates DMA boundary!");
save_flags(flags);
cli();
- sbc_int_ack(dev);
+ sbc_int_ack_8bit(dev);
write_dsp(dev, SBC_SAMPLE_RATE); /* set sampling rate */
write_dsp(dev, SCSTATE->fmt[send]);
write_dsp(dev, sbcskr[send]);
@@ -219,7 +317,7 @@ static void setup_dma_dsp(struct device *dev, struct sm_state *sm, int send)
set_dma_addr(dev->dma, dmabufaddr);
set_dma_count(dev->dma, SCSTATE->dmabuflen);
enable_dma(dev->dma);
- sbc_int_ack(dev);
+ sbc_int_ack_8bit(dev);
if (SCSTATE->revhi >= 4) {
write_dsp(dev, sbc4mode[send]);
write_dsp(dev, SBC4_MODE_UNS_MONO);
@@ -247,7 +345,7 @@ static void sbc_interrupt(int irq, void *dev_id, struct pt_regs *regs)
if (!dev || !sm || sm->hdrv.magic != HDLCDRV_MAGIC)
return;
new_ptt = hdlcdrv_ptt(&sm->hdrv);
- sbc_int_ack(dev);
+ sbc_int_ack_8bit(dev);
buf = SCSTATE->dmabuf;
if (SCSTATE->dmabufidx)
buf += SCSTATE->dmabuflen/2;
@@ -294,6 +392,8 @@ static void sbc_interrupt(int irq, void *dev_id, struct pt_regs *regs)
static int sbc_open(struct device *dev, struct sm_state *sm)
{
+ int err;
+
if (sizeof(sm->m) < sizeof(struct sc_state_sbc)) {
printk(KERN_ERR "sm sbc: sbc state too big: %d > %d\n",
sizeof(struct sc_state_sbc), sizeof(sm->m));
@@ -327,6 +427,11 @@ static int sbc_open(struct device *dev, struct sm_state *sm)
dev->base_addr, SCSTATE->revhi, SCSTATE->revlo);
return -ENODEV;
}
+ if (SCSTATE->revhi >= 4 &&
+ (err = config_resources(dev, sm, 0))) {
+ printk(KERN_ERR "%s: invalid IRQ and/or DMA specified\n", sm_drvname);
+ return err;
+ }
/*
* initialize some variables
*/
@@ -524,3 +629,279 @@ const struct hardware_info sm_hw_sbc = {
};
/* --------------------------------------------------------------------- */
+
+static void setup_dma_fdx_dsp(struct device *dev, struct sm_state *sm)
+{
+ unsigned long flags;
+ unsigned long dmabufaddr = virt_to_bus(SCSTATE->dmabuf);
+ unsigned long dmabuf2addr = virt_to_bus(SCSTATE->dmabuf2);
+
+ if (!reset_dsp(dev)) {
+ printk(KERN_ERR "%s: sbc: cannot reset sb dsp\n", sm_drvname);
+ return;
+ }
+ if (((dmabufaddr & 0xffff) + SCSTATE->dmabuflen > 0x10000) ||
+ ((dmabuf2addr & 0xffff) + 2*(SCSTATE->dmabuflen) > 0x10000))
+ panic("sm: DMA buffer violates DMA boundary!");
+ save_flags(flags);
+ cli();
+ sbc_int_ack_8bit(dev);
+ sbc_int_ack_16bit(dev);
+ /* should eventually change to set rates individually by SBC_SAMPLE_RATE_{IN/OUT} */
+ write_dsp(dev, SBC_SAMPLE_RATE); /* set sampling rate */
+ write_dsp(dev, SCSTATE->fmt[0]);
+ write_dsp(dev, SBC_SPEAKER_ON);
+ /*
+ * DMA channel 1 (8bit) does input (capture),
+ * DMA channel 2 (16bit) does output (playback)
+ */
+ disable_dma(dev->dma);
+ disable_dma(sm->hdrv.ptt_out.dma2);
+ clear_dma_ff(dev->dma);
+ set_dma_mode(dev->dma, DMA_MODE_READ | DMA_MODE_AUTOINIT);
+ set_dma_addr(dev->dma, dmabufaddr);
+ set_dma_count(dev->dma, SCSTATE->dmabuflen);
+ clear_dma_ff(sm->hdrv.ptt_out.dma2);
+ set_dma_mode(sm->hdrv.ptt_out.dma2, DMA_MODE_WRITE | DMA_MODE_AUTOINIT);
+ set_dma_addr(sm->hdrv.ptt_out.dma2, dmabuf2addr);
+ set_dma_count(sm->hdrv.ptt_out.dma2, SCSTATE->dmabuflen);
+ enable_dma(dev->dma);
+ enable_dma(sm->hdrv.ptt_out.dma2);
+ sbc_int_ack_8bit(dev);
+ sbc_int_ack_16bit(dev);
+ write_dsp(dev, SBC4_IN8_AI);
+ write_dsp(dev, SBC4_MODE_UNS_MONO);
+ write_dsp(dev, ((SCSTATE->dmabuflen >> 1) - 1) & 0xff);
+ write_dsp(dev, ((SCSTATE->dmabuflen >> 1) - 1) >> 8);
+ write_dsp(dev, SBC4_OUT16_AI);
+ write_dsp(dev, SBC4_MODE_UNS_MONO);
+ write_dsp(dev, ((SCSTATE->dmabuflen >> 1) - 1) & 0xff);
+ write_dsp(dev, ((SCSTATE->dmabuflen >> 1) - 1) >> 8);
+ restore_flags(flags);
+}
+
+/* --------------------------------------------------------------------- */
+
+static void sbcfdx_interrupt(int irq, void *dev_id, struct pt_regs *regs)
+{
+ struct device *dev = (struct device *)dev_id;
+ struct sm_state *sm = (struct sm_state *)dev->priv;
+ unsigned char *buf;
+ unsigned char *buf2;
+ unsigned char intsrc;
+
+ if (!dev || !sm || sm->hdrv.magic != HDLCDRV_MAGIC)
+ return;
+ buf = SCSTATE->dmabuf;
+ buf2 = SCSTATE->dmabuf2;
+ outb(0x82, DSP_MIXER_ADDR(dev->base_addr));
+ intsrc = inb(DSP_MIXER_DATA(dev->base_addr));
+ if (intsrc & 0x01) {
+ sbc_int_ack_8bit(dev);
+ if (SCSTATE->dmabufidx)
+ buf += SCSTATE->dmabuflen/2;
+ SCSTATE->dmabufidx = !SCSTATE->dmabufidx;
+ }
+ if (intsrc & 0x02) {
+ sbc_int_ack_16bit(dev);
+ if (SCSTATE->dma2bufidx)
+ buf2 += SCSTATE->dmabuflen/2;
+ SCSTATE->dma2bufidx = !SCSTATE->dma2bufidx;
+ }
+ sm_int_freq(sm);
+ sti();
+ if (intsrc & 0x02) {
+ if ((SCSTATE->ptt = hdlcdrv_ptt(&sm->hdrv)))
+ time_exec(sm->debug_vals.mod_cyc,
+ sm->mode_tx->modulator(sm, buf2, SCSTATE->dmabuflen/2));
+ else
+ time_exec(sm->debug_vals.mod_cyc,
+ memset(buf2, 0x80, SCSTATE->dmabuflen/2));
+ }
+ if (intsrc & 0x01) {
+ time_exec(sm->debug_vals.demod_cyc,
+ sm->mode_rx->demodulator(sm, buf, SCSTATE->dmabuflen/2));
+ hdlcdrv_arbitrate(dev, &sm->hdrv);
+ }
+ sm_output_status(sm);
+ hdlcdrv_transmitter(dev, &sm->hdrv);
+ hdlcdrv_receiver(dev, &sm->hdrv);
+}
+
+/* --------------------------------------------------------------------- */
+
+static int sbcfdx_open(struct device *dev, struct sm_state *sm)
+{
+ int err;
+
+ if (sizeof(sm->m) < sizeof(struct sc_state_sbc)) {
+ printk(KERN_ERR "sm sbc: sbc state too big: %d > %d\n",
+ sizeof(struct sc_state_sbc), sizeof(sm->m));
+ return -ENODEV;
+ }
+ if (!dev || !sm)
+ return -ENXIO;
+ if (dev->base_addr <= 0 || dev->base_addr > 0x1000-SBC_EXTENT ||
+ dev->irq < 2 || dev->irq > 15 || dev->dma > 3)
+ return -ENXIO;
+ if (check_region(dev->base_addr, SBC_EXTENT))
+ return -EACCES;
+ /*
+ * check if a card is available
+ */
+ if (!reset_dsp(dev))
+ return -ENODEV;
+ write_dsp(dev, SBC_GET_REVISION);
+ if (!read_dsp(dev, &SCSTATE->revhi) ||
+ !read_dsp(dev, &SCSTATE->revlo))
+ return -ENODEV;
+ if (SCSTATE->revhi < 4) {
+ printk(KERN_ERR "%s: at least DSP rev 4.00 required\n", sm_drvname);
+ return -ENODEV;
+ }
+ if ((err = config_resources(dev, sm, 1))) {
+ printk(KERN_ERR "%s: invalid IRQ and/or DMA specified\n", sm_drvname);
+ return err;
+ }
+ /*
+ * initialize some variables
+ */
+ if (!(SCSTATE->dmabuf = kmalloc(SCSTATE->dmabuflen, GFP_KERNEL | GFP_DMA)))
+ return -ENOMEM;
+ if (!(SCSTATE->dmabuf2 = kmalloc(SCSTATE->dmabuflen, GFP_KERNEL | GFP_DMA))) {
+ kfree_s(SCSTATE->dmabuf, SCSTATE->dmabuflen);
+ return -ENOMEM;
+ }
+ SCSTATE->dmabufidx = SCSTATE->dma2bufidx = SCSTATE->ptt = 0;
+
+ memset(&sm->m, 0, sizeof(sm->m));
+ memset(&sm->d, 0, sizeof(sm->d));
+ if (sm->mode_tx->init)
+ sm->mode_tx->init(sm);
+ if (sm->mode_rx->init)
+ sm->mode_rx->init(sm);
+
+ if (request_dma(dev->dma, sm->hwdrv->hw_name)) {
+ kfree_s(SCSTATE->dmabuf, SCSTATE->dmabuflen);
+ kfree_s(SCSTATE->dmabuf2, SCSTATE->dmabuflen);
+ return -EBUSY;
+ }
+ if (request_dma(sm->hdrv.ptt_out.dma2, sm->hwdrv->hw_name)) {
+ kfree_s(SCSTATE->dmabuf, SCSTATE->dmabuflen);
+ kfree_s(SCSTATE->dmabuf2, SCSTATE->dmabuflen);
+ free_dma(dev->dma);
+ return -EBUSY;
+ }
+ if (request_irq(dev->irq, sbcfdx_interrupt, SA_INTERRUPT,
+ sm->hwdrv->hw_name, dev)) {
+ kfree_s(SCSTATE->dmabuf, SCSTATE->dmabuflen);
+ kfree_s(SCSTATE->dmabuf2, SCSTATE->dmabuflen);
+ free_dma(dev->dma);
+ free_dma(sm->hdrv.ptt_out.dma2);
+ return -EBUSY;
+ }
+ request_region(dev->base_addr, SBC_EXTENT, sm->hwdrv->hw_name);
+ setup_dma_fdx_dsp(dev, sm);
+ return 0;
+}
+
+/* --------------------------------------------------------------------- */
+
+static int sbcfdx_close(struct device *dev, struct sm_state *sm)
+{
+ if (!dev || !sm)
+ return -EINVAL;
+ /*
+ * disable interrupts
+ */
+ disable_dma(dev->dma);
+ disable_dma(sm->hdrv.ptt_out.dma2);
+ reset_dsp(dev);
+ free_irq(dev->irq, dev);
+ free_dma(dev->dma);
+ free_dma(sm->hdrv.ptt_out.dma2);
+ release_region(dev->base_addr, SBC_EXTENT);
+ kfree_s(SCSTATE->dmabuf, SCSTATE->dmabuflen);
+ kfree_s(SCSTATE->dmabuf2, SCSTATE->dmabuflen);
+ return 0;
+}
+
+/* --------------------------------------------------------------------- */
+
+static int sbcfdx_sethw(struct device *dev, struct sm_state *sm, char *mode)
+{
+ char *cp = strchr(mode, '.');
+ const struct modem_tx_info **mtp = sm_modem_tx_table;
+ const struct modem_rx_info **mrp;
+ int dv;
+
+ if (!strcmp(mode, "off")) {
+ sm->mode_tx = NULL;
+ sm->mode_rx = NULL;
+ return 0;
+ }
+ if (cp)
+ *cp++ = '\0';
+ else
+ cp = mode;
+ for (; *mtp; mtp++) {
+ if ((*mtp)->loc_storage > sizeof(sm->m)) {
+ printk(KERN_ERR "%s: insufficient storage for modulator %s (%d)\n",
+ sm_drvname, (*mtp)->name, (*mtp)->loc_storage);
+ continue;
+ }
+ if (!(*mtp)->name || strcmp((*mtp)->name, mode))
+ continue;
+ if ((*mtp)->srate < 5000 || (*mtp)->srate > 44100)
+ continue;
+ for (mrp = sm_modem_rx_table; *mrp; mrp++) {
+ if ((*mrp)->loc_storage > sizeof(sm->d)) {
+ printk(KERN_ERR "%s: insufficient storage for demodulator %s (%d)\n",
+ sm_drvname, (*mrp)->name, (*mrp)->loc_storage);
+ continue;
+ }
+ if ((*mrp)->name && !strcmp((*mrp)->name, cp) &&
+ (*mtp)->srate >= 5000 && (*mtp)->srate <= 44100 &&
+ (*mrp)->srate == (*mtp)->srate) {
+ sm->mode_tx = *mtp;
+ sm->mode_rx = *mrp;
+ SCSTATE->sr[0] = sm->mode_rx->srate;
+ SCSTATE->sr[1] = sm->mode_tx->srate;
+ dv = lcm(sm->mode_tx->dmabuflenmodulo,
+ sm->mode_rx->dmabuflenmodulo);
+ if (dv & 1)
+ dv <<= 1; /* dmabuflen must be a multiple of 4 */
+ SCSTATE->dmabuflen = sm->mode_rx->srate/100+dv-1;
+ SCSTATE->dmabuflen /= dv;
+ SCSTATE->dmabuflen *= 2*dv; /* make sure DMA buf is even */
+ return 0;
+ }
+ }
+ }
+ return -EINVAL;
+}
+
+/* --------------------------------------------------------------------- */
+
+static int sbcfdx_ioctl(struct device *dev, struct sm_state *sm, struct ifreq *ifr,
+ struct hdlcdrv_ioctl *hi, int cmd)
+{
+ if (cmd != SIOCDEVPRIVATE)
+ return -ENOIOCTLCMD;
+
+ if (hi->cmd == HDLCDRVCTL_MODEMPARMASK)
+ return HDLCDRV_PARMASK_IOBASE | HDLCDRV_PARMASK_IRQ |
+ HDLCDRV_PARMASK_DMA | HDLCDRV_PARMASK_DMA2 | HDLCDRV_PARMASK_SERIOBASE |
+ HDLCDRV_PARMASK_PARIOBASE | HDLCDRV_PARMASK_MIDIIOBASE;
+
+ return sbc_ioctl(dev, sm, ifr, hi, cmd);
+}
+
+/* --------------------------------------------------------------------- */
+
+const struct hardware_info sm_hw_sbcfdx = {
+ "sbcfdx", sizeof(struct sc_state_sbc),
+ sbcfdx_open, sbcfdx_close, sbcfdx_ioctl, sbcfdx_sethw
+};
+
+/* --------------------------------------------------------------------- */
diff --git a/drivers/sbus/char/sunserial.c b/drivers/sbus/char/sunserial.c
index 2fa29da26..e89384a3a 100644
--- a/drivers/sbus/char/sunserial.c
+++ b/drivers/sbus/char/sunserial.c
@@ -1,4 +1,4 @@
-/* $Id: sunserial.c,v 1.41 1997/05/14 20:46:51 davem Exp $
+/* $Id: sunserial.c,v 1.42 1997/05/26 20:10:20 davem Exp $
* serial.c: Serial port driver for the Sparc.
*
* Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
@@ -1062,7 +1062,7 @@ static void rs_fair_output(void)
/*
* zs_console_print is registered for printk.
*/
-static void zs_console_print(const char *s, int count)
+static void zs_console_print(const char *s, unsigned count)
{
int i;
@@ -1867,7 +1867,7 @@ int rs_open(struct tty_struct *tty, struct file * filp)
static void show_serial_version(void)
{
- char *revision = "$Revision: 1.41 $";
+ char *revision = "$Revision: 1.42 $";
char *version, *p;
version = strchr(revision, ' ');
@@ -2198,7 +2198,7 @@ rs_cons_check(struct sun_serial *ss, int channel)
o = 1;
/* double whee.. */
if(!consout_registered) {
- extern void serial_finish_init (void (*)(const char *, int count));
+ extern void serial_finish_init (void (*)(const char *, unsigned count));
serial_finish_init (zs_console_print);
register_console(&console);
diff --git a/drivers/scsi/advansys.c b/drivers/scsi/advansys.c
index a7cec9d06..737793e29 100644
--- a/drivers/scsi/advansys.c
+++ b/drivers/scsi/advansys.c
@@ -1,8 +1,10 @@
-/* $Id: advansys.c,v 1.29 1996/11/15 00:45:07 bobf Exp bobf $ */
+/* $Id: advansys.c,v 1997/05/28 00:06:55 bobf Exp bobf $ */
+#define ASC_VERSION "2.8" /* AdvanSys Driver Version */
+
/*
* advansys.c - Linux Host Driver for AdvanSys SCSI Adapters
*
- * Copyright (c) 1995-1996 Advanced System Products, Inc.
+ * Copyright (c) 1995-1997 Advanced System Products, Inc.
* All Rights Reserved.
*
* Redistribution and use in source and binary forms, with or without
@@ -10,36 +12,45 @@
* code retain the above copyright notice and this comment without
* modification.
*
- * The latest version of this driver is available at the AdvanSys
- * FTP and BBS sites listed below.
+ * There is an AdvanSys Linux WWW page at:
+ * http://www.advansys.com/linux.html
+ *
+ * The latest version of the AdvanSys driver is available at:
+ * ftp://ftp.advansys.com/pub/linux
*
* Please send questions, comments, bug reports to:
* bobf@advansys.com (Bob Frey)
*/
-/*
- * The driver has been used in the following kernels:
- * v1.2.13, v1.3.57, v2.0.25, v2.1.9
- */
-#define ASC_VERSION "2.0" /* AdvanSys Driver Version */
/*
Documentation for the AdvanSys Driver
- A. Adapters Supported by this Driver
- B. Linux v1.2.X - Directions for Adding the AdvanSys Driver
- C. Linux v1.3.1 - v1.3.57 - Directions for Adding the AdvanSys Driver
- D. Linux v1.3.58 and Newer - Upgrading the AdvanSys Driver
- E. Source Comments
- F. Driver Compile Time Options and Debugging
- G. Driver LILO Option
- H. Release History
- I. Known Problems or Issues
- J. Credits
- K. AdvanSys Contact Information
-
- A. Adapters Supported by this Driver
+ A. Linux Kernel Testing
+ B. Adapters Supported by this Driver
+ C. Linux v1.2.X - Directions for Adding the AdvanSys Driver
+ D. Linux v1.3.1 - v1.3.57 - Directions for Adding the AdvanSys Driver
+ E. Linux v1.3.58 and Newer - Upgrading the AdvanSys Driver
+ F. Source Comments
+ G. Driver Compile Time Options and Debugging
+ H. Driver LILO Option
+ I. Release History
+ J. Known Problems or Issues
+ K. Credits
+ L. AdvanSys Contact Information
+
+ A. Linux Kernel Testing
+
+ This driver has been tested in the following Linux kernels: v1.2.13,
+ v1.3.57, v2.0.30, v2.1.40. These kernel versions are major releases
+ of Linux or the latest Linux kernel versions available when this version
+ of the driver was released. The driver should also work in earlier
+ versions of the Linux kernel. Beginning with v1.3.58 the AdvanSys driver
+ is included with all Linux kernels. Please refer to sections C, D, and
+ E for instructions on adding or upgrading the AdvanSys driver.
+
+ B. Adapters Supported by this Driver
AdvanSys (Advanced System Products, Inc.) manufactures the following
Bus-Mastering SCSI-2 Host Adapters for the ISA, EISA, VL, and PCI
@@ -59,6 +70,7 @@
ABP920 - Bus-Master PCI (16 CDB)
ABP930 - Bus-Master PCI (16 CDB) (Footnote 5)
ABP930U - Bus-Master PCI Ultra (16 CDB)
+ ABP930UA - Bus-Master PCI Ultra (16 CDB)
ABP960 - Bus-Master PCI MAC/PC (16 CDB) (Footnote 2)
ABP960U - Bus-Master PCI MAC/PC Ultra (16 CDB)
@@ -85,7 +97,7 @@
4. This board has been sold by SIIG as the i542 SpeedMaster.
5. This board has been sold by SIIG as the Fast SCSI Pro PCI.
- B. Linux v1.2.X - Directions for Adding the AdvanSys Driver
+ C. Linux v1.2.X - Directions for Adding the AdvanSys Driver
These directions apply to v1.2.13. For versions that follow v1.2.13.
but precede v1.3.57 some of the changes for Linux v1.3.X listed
@@ -156,7 +168,7 @@
'make modules_install'. Use 'insmod' and 'rmmod' to install
and remove advansys.o.
- C. Linux v1.3.1 - v1.3.57 - Directions for Adding the AdvanSys Driver
+ D. Linux v1.3.1 - v1.3.57 - Directions for Adding the AdvanSys Driver
These directions apply to v1.3.57. For versions that precede v1.3.57
some of these changes may need to be modified or eliminated. A patch
@@ -222,7 +234,7 @@
'make modules_install'. Use 'insmod' and 'rmmod' to install
and remove advansys.o.
- D. Linux v1.3.58 and Newer - Upgrading the AdvanSys Driver
+ E. Linux v1.3.58 and Newer - Upgrading the AdvanSys Driver
To upgrade the AdvanSys driver in a Linux v1.3.58 and newer
kernel, first check the version of the current driver. The
@@ -236,7 +248,7 @@
copy the new advansys.c and advansys.h to drivers/scsi, rebuild
the kernel, and install the new kernel. No other changes are needed.
- E. Source Comments
+ F. Source Comments
1. Use tab stops set to 4 for the source files. For vi use 'se tabstops=4'.
@@ -250,8 +262,8 @@
--- Linux Version
--- Linux Include Files
--- Driver Options
- --- Asc Library Constants and Macros
--- Debugging Header
+ --- Asc Library Constants and Macros
--- Driver Constants and Macros
--- Driver Structures
--- Driver Data
@@ -275,13 +287,31 @@
--- Asc Library Constants and Macros
--- Asc Library Functions
- F. Driver Compile Time Options and Debugging
+ G. Driver Compile Time Options and Debugging
In this source file the following constants can be defined. They are
defined in the source below. Both of these options are enabled by
default.
- 1. ADVANSYS_DEBUG - enable for debugging and assertions
+ 1. ADVANSYS_ASSERT - Enable driver assertions (Def: Enabled)
+
+ Enabling this option adds assertion logic statements to the
+ driver. If an assertion fails a message will be displayed to
+ the console, but the system will continue to operate. Any
+ assertions encountered should be reported to the person
+ responsible for the driver. Assertion statements may proactively
+ detect problems with the driver and facilitate fixing these
+ problems. Enabling assertions will add a small overhead to the
+ execution of the driver.
+
+ 2. ADVANSYS_DEBUG - Enable driver debugging (Def: Disabled)
+
+ Enabling this option adds tracing functions to the driver and
+ the ability to set a driver tracing level at boot time. This
+ option will also symbols not required outside the driver to
+ the kernel name space. This option is very useful for debugging
+ the driver, but it will add to the size of the driver execution
+ image and add overhead to the execution of the driver.
The amount of debugging output can be controlled with the global
variable 'asc_dbglvl'. The higher the number the more output. By
@@ -319,9 +349,20 @@
I found that increasing LOG_BUF_LEN to 40960 in kernel/printk.c
prevents most level 1 debug messages from being lost.
+
+ this constant for debugging purposes, but for normal use of
+ the driver the constant should not be defined. This option
+ does not add overhead to the driver, but it does add unnecessary
+ symbols to the kernel name space.
- 2. ADVANSYS_STATS - enable statistics
+ 3. ADVANSYS_STATS - Enable statistics (Def: Enabled >= v1.3.0)
+ Enabling this option adds statistics collection and display
+ through /proc to the driver. The information is useful for
+ monitoring driver and device performance. It will add to the
+ size of the driver execution image and add minor overhead to
+ the execution of the driver.
+
Statistics are maintained on a per adapter basis. Driver entry
point call counts and transfer size counts are maintained.
Statistics are only available for kernels greater than or equal
@@ -339,7 +380,7 @@
contain adapter and device configuration information.
- G. Driver LILO Option
+ H. Driver LILO Option
If init/main.c is modified as described in the 'Directions for Adding
the AdvanSys Driver to Linux' section (B.4.) above, the driver will
@@ -370,7 +411,7 @@
the 'Driver Compile Time Options and Debugging' section above for
more information.
- H. Release History
+ I. Release History
BETA-1.0 (12/23/95):
First Release
@@ -479,13 +520,41 @@
structures might not have been in DMA-able memory, causing
device initialization to fail.
- I. Known Problems or Issues
+ 2.1 (12/30/96):
+ 1. In advansys_reset(), if the request is a synchronous reset
+ request, even if the request serial number has changed, then
+ complete the request.
+ 2. Add Asc Library bug fixes including new microcode.
+ 3. Clear inquiry buffer before using it.
+ 4. Correct ifdef typo.
+
+ 2.2 (1/15/97):
+ 1. Add Asc Library bug fixes including new microcode.
+ 2. Add synchronous data transfer rate information to the
+ adapter /proc file: /proc/scsi/advansys[0...].
+ 3. Change ADVANSYS_DEBUG to be disabled by default. This
+ will reduce the size of the driver image, eliminate execution
+ overhead, and remove unneeded symbols from the kernel symbol
+ space that were previously added by the driver.
+ 4. Add new compile-time option ADVANSYS_ASSERT for assertion
+ code that used to be defined within ADVANSYS_DEBUG. This
+ option is enabled by default.
+
+ 2.8 (5/26/97):
+ 1. Change version number to 2.8, skipping 2.3 through 2.7, in
+ order to synchronize the Linux driver version numbering with
+ other AdvanSys drivers.
+ 2. Reformat source files without tabs to give everyone everyone
+ the same view of the file regardless of the tab setting used.
+ 3. Add Asc Library bug fixes.
+
+ J. Known Problems or Issues
1. Remove conditional constants (ASC_QUEUE_FLOW_CONTROL) around
the queue depth flow control code when mid-level SCSI changes
are included in Linux.
- J. Credits
+ K. Credits
Nathan Hartwell <mage@cdc3.cdc.net> provided the directions and
basis for the Linux v1.3.X changes which were included in the
@@ -494,7 +563,10 @@
Thomas E Zerucha <zerucha@shell.portal.com> pointed out a bug
in advansys_biosparam() which was fixed in the 1.3 release.
- K. AdvanSys Contact Information
+ Erik Ratcliffe <erik@caldera.com> has done a lot of testing of
+ the AdvanSys driver in the Caldera releases.
+
+ L. AdvanSys Contact Information
Mail: Advanced System Products, Inc.
1150 Ringwood Court
@@ -508,6 +580,7 @@
Tech Support E-Mail: support@advansys.com
FTP Site: ftp.advansys.com (login: anonymous)
Web Site: http://www.advansys.com
+
*/
@@ -516,7 +589,7 @@
*/
/* Convert Linux Version, Patch-level, Sub-level to LINUX_VERSION_CODE. */
-#define ASC_LINUX_VERSION(V, P, S) (((V) * 65536) + ((P) * 256) + (S))
+#define ASC_LINUX_VERSION(V, P, S) (((V) * 65536) + ((P) * 256) + (S))
#ifndef LINUX_VERSION_CODE
#include <linux/version.h>
@@ -542,8 +615,10 @@
#include <linux/malloc.h>
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
#include <linux/proc_fs.h>
-#include <linux/init.h>
#endif /* version >= v1.3.0 */
+#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(2,1,23)
+#include <linux/init.h>
+#endif /* version >= v2.1.23 */
#include <asm/io.h>
#include <asm/system.h>
#include <asm/dma.h>
@@ -563,7 +638,12 @@
* --- Driver Options
*/
-#define ADVANSYS_DEBUG /* Enable assertions and tracing. */
+/* Enable driver assertions. */
+#define ADVANSYS_ASSERT
+
+/* Enable driver tracing. */
+/*#define ADVANSYS_DEBUG*/
+
/*
* Because of no /proc to display them, statistics are disabled
* for version prior to v1.3.0.
@@ -576,12 +656,23 @@
/*
+ * --- Debugging Header
+ */
+
+#ifdef ADVANSYS_DEBUG
+#define STATIC
+#else /* ADVANSYS_DEBUG */
+#define STATIC static
+#endif /* ADVANSYS_DEBUG */
+
+
+/*
* --- Asc Library Constants and Macros
*/
#define ASC_LIB_VERSION_MAJOR 1
#define ASC_LIB_VERSION_MINOR 22
-#define ASC_LIB_SERIAL_NUMBER 91
+#define ASC_LIB_SERIAL_NUMBER 105
typedef unsigned char uchar;
@@ -603,23 +694,23 @@ typedef unsigned char uchar;
#define rushort REG __u16
#define ruint REG __u32
#define rulong REG __u32
-#define NULLPTR ( void *)0
-#define FNULLPTR ( void dosfar *)0UL
+#define NULLPTR (void *)0
+#define FNULLPTR (void *)0UL
#define EOF (-1)
#define EOS '\0'
#define ERR (-1)
#define UB_ERR (uchar)(0xFF)
#define UW_ERR (uint)(0xFFFF)
#define UL_ERR (ulong)(0xFFFFFFFFUL)
-#define iseven_word( val ) ( ( ( ( uint )val) & ( uint )0x0001 ) == 0 )
-#define isodd_word( val ) ( ( ( ( uint )val) & ( uint )0x0001 ) != 0 )
-#define toeven_word( val ) ( ( ( uint )val ) & ( uint )0xFFFE )
-#define biton( val, bits ) ((( uint )( val >> bits ) & (uint)0x0001 ) != 0 )
-#define bitoff( val, bits ) ((( uint )( val >> bits ) & (uint)0x0001 ) == 0 )
-#define lbiton( val, bits ) ((( ulong )( val >> bits ) & (ulong)0x00000001UL ) != 0 )
-#define lbitoff( val, bits ) ((( ulong )( val >> bits ) & (ulong)0x00000001UL ) == 0 )
-#define absh( val ) ( ( val ) < 0 ? -( val ) : ( val ) )
-#define swapbyte( ch ) ( ( ( (ch) << 4 ) | ( (ch) >> 4 ) ) )
+#define iseven_word(val) ((((uint)val) & (uint)0x0001) == 0)
+#define isodd_word(val) ((((uint)val) & (uint)0x0001) != 0)
+#define toeven_word(val) (((uint)val) & (uint)0xFFFE)
+#define biton(val, bits) (((uint)(val >> bits) & (uint)0x0001) != 0)
+#define bitoff(val, bits) (((uint)(val >> bits) & (uint)0x0001) == 0)
+#define lbiton(val, bits) (((ulong)(val >> bits) & (ulong)0x00000001UL) != 0)
+#define lbitoff(val, bits) (((ulong)(val >> bits) & (ulong)0x00000001UL) == 0)
+#define absh(val) ((val) < 0 ? -(val) : (val))
+#define swapbyte(ch) ((((ch) << 4) | ((ch) >> 4)))
#ifndef GBYTE
#define GBYTE (0x40000000UL)
#endif
@@ -629,10 +720,10 @@ typedef unsigned char uchar;
#ifndef KBYTE
#define KBYTE (0x400)
#endif
-#define HI_BYTE(x) ( *( ( __u8 *)(&x)+1 ) )
-#define LO_BYTE(x) ( *( ( __u8 *)&x ) )
-#define HI_WORD(x) ( *( ( __u16 *)(&x)+1 ) )
-#define LO_WORD(x) ( *( ( __u16 *)&x ) )
+#define HI_BYTE(x) (*((__u8 *)(&x)+1))
+#define LO_BYTE(x) (*((__u8 *)&x))
+#define HI_WORD(x) (*((__u16 *)(&x)+1))
+#define LO_WORD(x) (*((__u16 *)&x))
#ifndef MAKEWORD
#define MAKEWORD(lo, hi) ((__u16) (((__u16) lo) | ((__u16) hi << 8)))
#endif
@@ -643,64 +734,61 @@ typedef unsigned char uchar;
#define SwapBytes(word) ((__u16) ((word >> 8) | (word << 8)))
#define BigToLittle(dWord) ((__u32) (SwapWords(MAKELONG(SwapBytes(LO_WORD(dWord)), SwapBytes(HI_WORD(dWord))))))
#define LittleToBig(dWord) BigToLittle(dWord)
-#define AscPCICmdRegBits_BusMastering 0x0007
#define AscPCIConfigVendorIDRegister 0x0000
#define AscPCIConfigDeviceIDRegister 0x0002
#define AscPCIConfigCommandRegister 0x0004
#define AscPCIConfigStatusRegister 0x0006
+#define AscPCIConfigRevisionIDRegister 0x0008
#define AscPCIConfigCacheSize 0x000C
#define AscPCIConfigLatencyTimer 0x000D
#define AscPCIIOBaseRegister 0x0010
-#define ASC_PCI_ID2BUS( id ) ((id) & 0xFF)
-#define ASC_PCI_ID2DEV( id ) (((id) >> 11) & 0x1F)
-#define ASC_PCI_ID2FUNC( id ) (((id) >> 8) & 0x7)
-#define ASC_PCI_MKID( bus, dev, func ) ((((dev) & 0x1F) << 11) | (((func) & 0x7) << 8) | ((bus) & 0xFF))
+#define AscPCICmdRegBits_IOMemBusMaster 0x0007
+#define ASC_PCI_ID2BUS(id) ((id) & 0xFF)
+#define ASC_PCI_ID2DEV(id) (((id) >> 11) & 0x1F)
+#define ASC_PCI_ID2FUNC(id) (((id) >> 8) & 0x7)
+#define ASC_PCI_MKID(bus, dev, func) ((((dev) & 0x1F) << 11) | (((func) & 0x7) << 8) | ((bus) & 0xFF))
+#define ASC_PCI_VENDORID 0x10CD
+#define ASC_PCI_DEVICEID_1200A 0x1100
+#define ASC_PCI_DEVICEID_1200B 0x1200
+#define ASC_PCI_DEVICEID_ULTRA 0x1300
+#define ASC_PCI_REVISION_3150 0x02
+#define ASC_PCI_REVISION_3050 0x03
#define ASC_DVCLIB_CALL_DONE (1)
#define ASC_DVCLIB_CALL_FAILED (0)
#define ASC_DVCLIB_CALL_ERROR (-1)
-#define Lptr
-#define dosfar
-#define far
-#define PortAddr unsigned short /* port address size */
-#define Ptr2Func ulong
+#define PortAddr unsigned short /* port address size */
+#define Ptr2Func ulong
#define inp(port) inb(port)
#define inpw(port) inw(port)
-#define inpl(port) inl(port)
+#define inpl(port) inl(port)
#define outp(port, byte) outb((byte), (port))
#define outpw(port, word) outw((word), (port))
#define outpl(port, long) outl((long), (port))
-#define ASC_MAX_SG_QUEUE 7
-#define ASC_MAX_SG_LIST SG_ALL
-
-#define CC_INIT_INQ_DISPLAY FALSE
-#define CC_CLEAR_LRAM_SRB_PTR FALSE
-#define CC_VERIFY_LRAM_COPY FALSE
-#define CC_DEBUG_SG_LIST FALSE
-#define CC_FAST_STRING_IO FALSE
-#define CC_WRITE_IO_COUNT FALSE
-#define CC_CLEAR_DMA_REMAIN FALSE
-#define CC_DISABLE_PCI_PARITY_INT TRUE
-#define CC_LINK_BUSY_Q FALSE
-#define CC_LITTLE_ENDIAN_HOST TRUE
-#define CC_STRUCT_ALIGNED TRUE
-#define CC_MEMORY_MAPPED_IO FALSE
-#define CC_INCLUDE_EEP_CONFIG TRUE
-#define CC_PCI_ULTRA TRUE
-#define CC_ASC_SCSI_Q_USRDEF FALSE
-#define CC_ASC_SCSI_REQ_Q_USRDEF FALSE
-#define CC_ASCISR_CHECK_INT_PENDING TRUE
-#define CC_CHK_FIX_EEP_CONTENT TRUE
-#define CC_CHK_AND_COALESCE_SG_LIST FALSE
-#define CC_DISABLE_PCI_PARITY_INT TRUE
-#define CC_INCLUDE_EEP_CONFIG TRUE
-#define CC_INIT_INQ_DISPLAY FALSE
-#define CC_PLEXTOR_VL FALSE
-#define CC_TMP_USE_EEP_SDTR FALSE
-#define CC_CHK_COND_REDO_SDTR TRUE
-#define CC_SET_PCI_LATENCY_TIMER_ZERO TRUE
-#define CC_DISABLE_ASYN_FIX_WANGTEK_TAPE TRUE
+#define ASC_MAX_SG_QUEUE 7
+#define ASC_MAX_SG_LIST SG_ALL
+
+#define CC_CLEAR_LRAM_SRB_PTR FALSE
+#define CC_VERIFY_LRAM_COPY FALSE
+#define CC_DEBUG_SG_LIST FALSE
+#define CC_FAST_STRING_IO FALSE
+#define CC_WRITE_IO_COUNT FALSE
+#define CC_CLEAR_DMA_REMAIN FALSE
+#define CC_DISABLE_PCI_PARITY_INT TRUE
+#define CC_LITTLE_ENDIAN_HOST TRUE
+#define CC_STRUCT_ALIGNED TRUE
+#define CC_MEMORY_MAPPED_IO FALSE
+#define CC_INCLUDE_EEP_CONFIG TRUE
+#define CC_PCI_ULTRA TRUE
+#define CC_ASC_SCSI_Q_USRDEF FALSE
+#define CC_ASC_SCSI_REQ_Q_USRDEF FALSE
+#define CC_ASCISR_CHECK_INT_PENDING TRUE
+#define CC_CHK_FIX_EEP_CONTENT TRUE
+#define CC_INCLUDE_EEP_CONFIG TRUE
+#define CC_PLEXTOR_VL FALSE
+#define CC_TMP_USE_EEP_SDTR FALSE
+#define CC_CHK_COND_REDO_SDTR TRUE
#define ASC_CS_TYPE unsigned short
#ifndef asc_ptr_type
@@ -708,9 +796,9 @@ typedef unsigned char uchar;
#endif
#ifndef ASC_GET_PTR2FUNC
-#define ASC_GET_PTR2FUNC( fun ) ( Ptr2Func )( fun )
+#define ASC_GET_PTR2FUNC(fun) (Ptr2Func)(fun)
#endif
-#define FLIP_BYTE_NIBBLE( x ) ( ((x<<4)& 0xFF) | (x>>4) )
+#define FLIP_BYTE_NIBBLE(x) (((x<<4)& 0xFF) | (x>>4))
#define ASC_IS_ISA (0x0001)
#define ASC_IS_ISAPNP (0x0081)
#define ASC_IS_EISA (0x0002)
@@ -735,11 +823,13 @@ typedef unsigned char uchar;
#define ASC_CHIP_VER_ISA_BIT (0x30)
#define ASC_CHIP_VER_ISAPNP_BIT (0x20)
#define ASC_CHIP_VER_ASYN_BUG (0x21)
-#define ASC_CHIP_VER_1ST_PCI_ULTRA (0x0A)
+#define ASC_CHIP_VER_PCI 0x08
+#define ASC_CHIP_VER_PCI_ULTRA_3150 (ASC_CHIP_VER_PCI | 0x02)
+#define ASC_CHIP_VER_PCI_ULTRA_3050 (ASC_CHIP_VER_PCI | 0x03)
#define ASC_CHIP_MIN_VER_EISA (0x41)
#define ASC_CHIP_MAX_VER_EISA (0x47)
#define ASC_CHIP_VER_EISA_BIT (0x40)
-#define ASC_CHIP_LATEST_VER_EISA ( ( ASC_CHIP_MIN_VER_EISA - 1 ) + 3 )
+#define ASC_CHIP_LATEST_VER_EISA ((ASC_CHIP_MIN_VER_EISA - 1) + 3)
#define ASC_MAX_LIB_SUPPORTED_ISA_CHIP_VER 0x21
#define ASC_MAX_LIB_SUPPORTED_PCI_CHIP_VER 0x0A
#define ASC_MAX_VL_DMA_ADDR (0x07FFFFFFL)
@@ -751,31 +841,31 @@ typedef unsigned char uchar;
#define ASC_MAX_EISA_DMA_ADDR (0x07FFFFFFL)
#define ASC_MAX_EISA_DMA_COUNT (0x07FFFFFFL)
#if !CC_STRUCT_ALIGNED
-#define DvcGetQinfo( iop_base, s_addr, outbuf, words) \
+#define DvcGetQinfo(iop_base, s_addr, outbuf, words) \
AscMemWordCopyFromLram(iop_base, s_addr, outbuf, words)
-#define DvcPutScsiQ( iop_base, s_addr, outbuf, words) \
+#define DvcPutScsiQ(iop_base, s_addr, outbuf, words) \
AscMemWordCopyToLram(iop_base, s_addr, outbuf, words)
#endif
#ifdef ASC_CHIP_VERSION
#endif
#if CC_MEMORY_MAPPED_IO
-#define inp( port ) *( (uchar *)(port) )
-#define outp( port, data ) *( (uchar *)(port) ) = ( uchar )( data )
+#define inp(port) *((uchar *)(port))
+#define outp(port, data) *((uchar *)(port)) = (uchar)(data)
#if CC_LITTLE_ENDIAN_HOST
-#define inpw( port ) *( (ushort *)(port) )
-#define outpw( port, data ) *( (ushort *)(port) ) = ( ushort )( data )
+#define inpw(port) *((ushort *)(port))
+#define outpw(port, data) *((ushort *)(port)) = (ushort)(data)
#else
-#define inpw( port ) EndianSwap16Bit( (*((ushort *)(port))) )
-#define outpw( port, data ) *( (ushort *)(port) ) = EndianSwap16Bit( (ushort)(data) )
-#define inpw_noswap( port ) *( (ushort *)(port) )
-#define outpw_noswap( port, data ) *( (ushort *)(port) ) = ( ushort )( data )
+#define inpw(port) EndianSwap16Bit((*((ushort *)(port))))
+#define outpw(port, data) *((ushort *)(port)) = EndianSwap16Bit((ushort)(data))
+#define inpw_noswap(port) *((ushort *)(port))
+#define outpw_noswap(port, data) *((ushort *)(port)) = (ushort)(data)
#endif
#endif
#ifndef inpw_noswap
-#define inpw_noswap( port ) inpw( port )
+#define inpw_noswap(port) inpw(port)
#endif
#ifndef outpw_noswap
-#define outpw_noswap( port, data ) outpw( port, data )
+#define outpw_noswap(port, data) outpw(port, data)
#endif
#define ASC_SCSI_ID_BITS 3
#define ASC_SCSI_TIX_TYPE uchar
@@ -873,10 +963,10 @@ AscMemWordCopyToLram(iop_base, s_addr, outbuf, words)
#define SCSI_SENKEY_VOL_OVERFLOW 0x0D
#define SCSI_SENKEY_MISCOMP 0x0E
#define SCSI_SENKEY_RESERVED 0x0F
-#define ASC_SRB_HOST( x ) ( ( uchar )( ( uchar )( x ) >> 4 ) )
-#define ASC_SRB_TID( x ) ( ( uchar )( ( uchar )( x ) & ( uchar )0x0F ) )
-#define ASC_SRB_LUN( x ) ( ( uchar )( ( uint )( x ) >> 13 ) )
-#define PUT_CDB1( x ) ( ( uchar )( ( uint )( x ) >> 8 ) )
+#define ASC_SRB_HOST(x) ((uchar)((uchar)(x) >> 4))
+#define ASC_SRB_TID(x) ((uchar)((uchar)(x) & (uchar)0x0F))
+#define ASC_SRB_LUN(x) ((uchar)((uint)(x) >> 13))
+#define PUT_CDB1(x) ((uchar)((uint)(x) >> 8))
#define SS_GOOD 0x00
#define SS_CHK_CONDITION 0x02
#define SS_CONDITION_MET 0x04
@@ -890,6 +980,10 @@ AscMemWordCopyToLram(iop_base, s_addr, outbuf, words)
#define MS_EXTEND 0x01
#define MS_SDTR_LEN 0x03
#define MS_SDTR_CODE 0x01
+#define MS_WDTR_LEN 0x02
+#define MS_WDTR_CODE 0x03
+#define MS_MDP_LEN 0x05
+#define MS_MDP_CODE 0x00
#define M1_SAVE_DATA_PTR 0x02
#define M1_RESTORE_PTRS 0x03
#define M1_DISCONNECT 0x04
@@ -910,149 +1004,150 @@ AscMemWordCopyToLram(iop_base, s_addr, outbuf, words)
#define M2_QTAG_MSG_HEAD 0x21
#define M2_QTAG_MSG_ORDERED 0x22
#define M2_IGNORE_WIDE_RESIDUE 0x23
+
#if CC_LITTLE_ENDIAN_HOST
typedef struct {
- uchar peri_dvc_type:5;
- uchar peri_qualifier:3;
+ uchar peri_dvc_type:5;
+ uchar peri_qualifier:3;
} ASC_SCSI_INQ0;
#else
typedef struct {
- uchar peri_qualifier:3;
- uchar peri_dvc_type:5;
+ uchar peri_qualifier:3;
+ uchar peri_dvc_type:5;
} ASC_SCSI_INQ0;
#endif
#if CC_LITTLE_ENDIAN_HOST
typedef struct {
- uchar dvc_type_modifier:7;
- uchar rmb:1;
+ uchar dvc_type_modifier:7;
+ uchar rmb:1;
} ASC_SCSI_INQ1;
#else
typedef struct {
- uchar rmb:1;
- uchar dvc_type_modifier:7;
+ uchar rmb:1;
+ uchar dvc_type_modifier:7;
} ASC_SCSI_INQ1;
#endif
#if CC_LITTLE_ENDIAN_HOST
typedef struct {
- uchar ansi_apr_ver:3;
- uchar ecma_ver:3;
- uchar iso_ver:2;
+ uchar ansi_apr_ver:3;
+ uchar ecma_ver:3;
+ uchar iso_ver:2;
} ASC_SCSI_INQ2;
#else
typedef struct {
- uchar iso_ver:2;
- uchar ecma_ver:3;
- uchar ansi_apr_ver:3;
+ uchar iso_ver:2;
+ uchar ecma_ver:3;
+ uchar ansi_apr_ver:3;
} ASC_SCSI_INQ2;
#endif
#if CC_LITTLE_ENDIAN_HOST
typedef struct {
- uchar rsp_data_fmt:4;
- uchar res:2;
- uchar TemIOP:1;
- uchar aenc:1;
+ uchar rsp_data_fmt:4;
+ uchar res:2;
+ uchar TemIOP:1;
+ uchar aenc:1;
} ASC_SCSI_INQ3;
#else
typedef struct {
- uchar aenc:1;
- uchar TemIOP:1;
- uchar res:2;
- uchar rsp_data_fmt:4;
+ uchar aenc:1;
+ uchar TemIOP:1;
+ uchar res:2;
+ uchar rsp_data_fmt:4;
} ASC_SCSI_INQ3;
#endif
#if CC_LITTLE_ENDIAN_HOST
typedef struct {
- uchar StfRe:1;
- uchar CmdQue:1;
- uchar Reserved:1;
- uchar Linked:1;
- uchar Sync:1;
- uchar WBus16:1;
- uchar WBus32:1;
- uchar RelAdr:1;
+ uchar StfRe:1;
+ uchar CmdQue:1;
+ uchar Reserved:1;
+ uchar Linked:1;
+ uchar Sync:1;
+ uchar WBus16:1;
+ uchar WBus32:1;
+ uchar RelAdr:1;
} ASC_SCSI_INQ7;
#else
typedef struct {
- uchar RelAdr:1;
- uchar WBus32:1;
- uchar WBus16:1;
- uchar Sync:1;
- uchar Linked:1;
- uchar Reserved:1;
- uchar CmdQue:1;
- uchar StfRe:1;
+ uchar RelAdr:1;
+ uchar WBus32:1;
+ uchar WBus16:1;
+ uchar Sync:1;
+ uchar Linked:1;
+ uchar Reserved:1;
+ uchar CmdQue:1;
+ uchar StfRe:1;
} ASC_SCSI_INQ7;
#endif
typedef struct {
- ASC_SCSI_INQ0 byte0;
- ASC_SCSI_INQ1 byte1;
- ASC_SCSI_INQ2 byte2;
- ASC_SCSI_INQ3 byte3;
- uchar add_len;
- uchar res1;
- uchar res2;
- ASC_SCSI_INQ7 byte7;
- uchar vendor_id[8];
- uchar product_id[16];
- uchar product_rev_level[4];
+ ASC_SCSI_INQ0 byte0;
+ ASC_SCSI_INQ1 byte1;
+ ASC_SCSI_INQ2 byte2;
+ ASC_SCSI_INQ3 byte3;
+ uchar add_len;
+ uchar res1;
+ uchar res2;
+ ASC_SCSI_INQ7 byte7;
+ uchar vendor_id[8];
+ uchar product_id[16];
+ uchar product_rev_level[4];
} ASC_SCSI_INQUIRY;
#if CC_LITTLE_ENDIAN_HOST
typedef struct asc_req_sense {
- uchar err_code:7;
- uchar info_valid:1;
- uchar segment_no;
- uchar sense_key:4;
- uchar reserved_bit:1;
- uchar sense_ILI:1;
- uchar sense_EOM:1;
- uchar file_mark:1;
- uchar info1[4];
- uchar add_sense_len;
- uchar cmd_sp_info[4];
- uchar asc;
- uchar ascq;
- uchar fruc;
- uchar sks_byte0:7;
- uchar sks_valid:1;
- uchar sks_bytes[2];
- uchar notused[2];
- uchar ex_sense_code;
- uchar info2[4];
+ uchar err_code:7;
+ uchar info_valid:1;
+ uchar segment_no;
+ uchar sense_key:4;
+ uchar reserved_bit:1;
+ uchar sense_ILI:1;
+ uchar sense_EOM:1;
+ uchar file_mark:1;
+ uchar info1[4];
+ uchar add_sense_len;
+ uchar cmd_sp_info[4];
+ uchar asc;
+ uchar ascq;
+ uchar fruc;
+ uchar sks_byte0:7;
+ uchar sks_valid:1;
+ uchar sks_bytes[2];
+ uchar notused[2];
+ uchar ex_sense_code;
+ uchar info2[4];
} ASC_REQ_SENSE;
#else
typedef struct asc_req_sense {
- uchar info_valid:1;
- uchar err_code:7;
- uchar segment_no;
- uchar file_mark:1;
- uchar sense_EOM:1;
- uchar sense_ILI:1;
- uchar reserved_bit:1;
- uchar sense_key:4;
- uchar info1[4];
- uchar add_sense_len;
- uchar cmd_sp_info[4];
- uchar asc;
- uchar ascq;
- uchar fruc;
- uchar sks_valid:1;
- uchar sks_byte0:7;
- uchar sks_bytes[2];
- uchar notused[2];
- uchar ex_sense_code;
- uchar info2[4];
+ uchar info_valid:1;
+ uchar err_code:7;
+ uchar segment_no;
+ uchar file_mark:1;
+ uchar sense_EOM:1;
+ uchar sense_ILI:1;
+ uchar reserved_bit:1;
+ uchar sense_key:4;
+ uchar info1[4];
+ uchar add_sense_len;
+ uchar cmd_sp_info[4];
+ uchar asc;
+ uchar ascq;
+ uchar fruc;
+ uchar sks_valid:1;
+ uchar sks_byte0:7;
+ uchar sks_bytes[2];
+ uchar notused[2];
+ uchar ex_sense_code;
+ uchar info2[4];
} ASC_REQ_SENSE;
#endif
@@ -1160,171 +1255,152 @@ typedef struct asc_req_sense {
#define ASC_STOP_CLEAN_UP_BUSY_Q 0x10
#define ASC_STOP_CLEAN_UP_DISC_Q 0x20
#define ASC_STOP_HOST_REQ_RISC_HALT 0x40
-#define ASC_TIDLUN_TO_IX( tid, lun ) ( ASC_SCSI_TIX_TYPE )( (tid) + ((lun)<<ASC_SCSI_ID_BITS) )
-#define ASC_TID_TO_TARGET_ID( tid ) ( ASC_SCSI_BIT_ID_TYPE )( 0x01 << (tid) )
-#define ASC_TIX_TO_TARGET_ID( tix ) ( 0x01 << ( (tix) & ASC_MAX_TID ) )
-#define ASC_TIX_TO_TID( tix ) ( (tix) & ASC_MAX_TID )
-#define ASC_TID_TO_TIX( tid ) ( (tid) & ASC_MAX_TID )
-#define ASC_TIX_TO_LUN( tix ) ( ( (tix) >> ASC_SCSI_ID_BITS ) & ASC_MAX_LUN )
-#define ASC_QNO_TO_QADDR( q_no ) ( (ASC_QADR_BEG)+( ( int )(q_no) << 6 ) )
+#define ASC_TIDLUN_TO_IX(tid, lun) (ASC_SCSI_TIX_TYPE)((tid) + ((lun)<<ASC_SCSI_ID_BITS))
+#define ASC_TID_TO_TARGET_ID(tid) (ASC_SCSI_BIT_ID_TYPE)(0x01 << (tid))
+#define ASC_TIX_TO_TARGET_ID(tix) (0x01 << ((tix) & ASC_MAX_TID))
+#define ASC_TIX_TO_TID(tix) ((tix) & ASC_MAX_TID)
+#define ASC_TID_TO_TIX(tid) ((tid) & ASC_MAX_TID)
+#define ASC_TIX_TO_LUN(tix) (((tix) >> ASC_SCSI_ID_BITS) & ASC_MAX_LUN)
+#define ASC_QNO_TO_QADDR(q_no) ((ASC_QADR_BEG)+((int)(q_no) << 6))
typedef struct asc_scisq_1 {
- uchar status;
- uchar q_no;
- uchar cntl;
- uchar sg_queue_cnt;
- uchar target_id;
- uchar target_lun;
- ulong data_addr;
- ulong data_cnt;
- ulong sense_addr;
- uchar sense_len;
- uchar extra_bytes;
+ uchar status;
+ uchar q_no;
+ uchar cntl;
+ uchar sg_queue_cnt;
+ uchar target_id;
+ uchar target_lun;
+ ulong data_addr;
+ ulong data_cnt;
+ ulong sense_addr;
+ uchar sense_len;
+ uchar extra_bytes;
} ASC_SCSIQ_1;
typedef struct asc_scisq_2 {
- ulong srb_ptr;
- uchar target_ix;
- uchar flag;
- uchar cdb_len;
- uchar tag_code;
- ushort vm_id;
+ ulong srb_ptr;
+ uchar target_ix;
+ uchar flag;
+ uchar cdb_len;
+ uchar tag_code;
+ ushort vm_id;
} ASC_SCSIQ_2;
typedef struct asc_scsiq_3 {
- uchar done_stat;
- uchar host_stat;
- uchar scsi_stat;
- uchar scsi_msg;
+ uchar done_stat;
+ uchar host_stat;
+ uchar scsi_stat;
+ uchar scsi_msg;
} ASC_SCSIQ_3;
typedef struct asc_scsiq_4 {
- uchar cdb[ASC_MAX_CDB_LEN];
- uchar y_first_sg_list_qp;
- uchar y_working_sg_qp;
- uchar y_working_sg_ix;
- uchar y_res;
- ushort x_req_count;
- ushort x_reconnect_rtn;
- ulong x_saved_data_addr;
- ulong x_saved_data_cnt;
+ uchar cdb[ASC_MAX_CDB_LEN];
+ uchar y_first_sg_list_qp;
+ uchar y_working_sg_qp;
+ uchar y_working_sg_ix;
+ uchar y_res;
+ ushort x_req_count;
+ ushort x_reconnect_rtn;
+ ulong x_saved_data_addr;
+ ulong x_saved_data_cnt;
} ASC_SCSIQ_4;
typedef struct asc_q_done_info {
- ASC_SCSIQ_2 d2;
- ASC_SCSIQ_3 d3;
- uchar q_status;
- uchar q_no;
- uchar cntl;
- uchar sense_len;
- uchar extra_bytes;
- uchar res;
- ulong remain_bytes;
+ ASC_SCSIQ_2 d2;
+ ASC_SCSIQ_3 d3;
+ uchar q_status;
+ uchar q_no;
+ uchar cntl;
+ uchar sense_len;
+ uchar extra_bytes;
+ uchar res;
+ ulong remain_bytes;
} ASC_QDONE_INFO;
typedef struct asc_sg_list {
- ulong addr;
- ulong bytes;
+ ulong addr;
+ ulong bytes;
} ASC_SG_LIST;
typedef struct asc_sg_head {
- ushort entry_cnt;
- ushort queue_cnt;
- ushort entry_to_copy;
- ushort res;
- ASC_SG_LIST sg_list[ASC_MAX_SG_LIST];
+ ushort entry_cnt;
+ ushort queue_cnt;
+ ushort entry_to_copy;
+ ushort res;
+ ASC_SG_LIST sg_list[ASC_MAX_SG_LIST];
} ASC_SG_HEAD;
#define ASC_MIN_SG_LIST 2
typedef struct asc_min_sg_head {
- ushort entry_cnt;
- ushort queue_cnt;
- ushort entry_to_copy;
- ushort res;
- ASC_SG_LIST sg_list[ASC_MIN_SG_LIST];
+ ushort entry_cnt;
+ ushort queue_cnt;
+ ushort entry_to_copy;
+ ushort res;
+ ASC_SG_LIST sg_list[ASC_MIN_SG_LIST];
} ASC_MIN_SG_HEAD;
#define QCX_SORT (0x0001)
#define QCX_COALEASE (0x0002)
-#if CC_LINK_BUSY_Q
-typedef struct asc_ext_scsi_q {
- ulong lba;
- ushort lba_len;
- struct asc_scsi_q dosfar *next;
- struct asc_scsi_q dosfar *join;
- ushort cntl;
- ushort buffer_id;
- uchar q_required;
- uchar res;
-} ASC_EXT_SCSI_Q;
-#endif
-
typedef struct asc_scsi_q {
- ASC_SCSIQ_1 q1;
- ASC_SCSIQ_2 q2;
- uchar dosfar *cdbptr;
- ASC_SG_HEAD dosfar *sg_head;
-#if CC_LINK_BUSY_Q
- ASC_EXT_SCSI_Q ext;
-#endif
+ ASC_SCSIQ_1 q1;
+ ASC_SCSIQ_2 q2;
+ uchar *cdbptr;
+ ASC_SG_HEAD *sg_head;
#if CC_ASC_SCSI_Q_USRDEF
- ASC_SCSI_Q_USR usr;
+ ASC_SCSI_Q_USR usr;
#endif
} ASC_SCSI_Q;
typedef struct asc_scsi_req_q {
- ASC_SCSIQ_1 r1;
- ASC_SCSIQ_2 r2;
- uchar dosfar *cdbptr;
- ASC_SG_HEAD dosfar *sg_head;
-#if CC_LINK_BUSY_Q
- ASC_EXT_SCSI_Q ext;
-#endif
- uchar dosfar *sense_ptr;
- ASC_SCSIQ_3 r3;
- uchar cdb[ASC_MAX_CDB_LEN];
- uchar sense[ASC_MIN_SENSE_LEN];
+ ASC_SCSIQ_1 r1;
+ ASC_SCSIQ_2 r2;
+ uchar *cdbptr;
+ ASC_SG_HEAD *sg_head;
+ uchar *sense_ptr;
+ ASC_SCSIQ_3 r3;
+ uchar cdb[ASC_MAX_CDB_LEN];
+ uchar sense[ASC_MIN_SENSE_LEN];
#if CC_ASC_SCSI_REQ_Q_USRDEF
- ASC_SCSI_REQ_Q_USR usr;
+ ASC_SCSI_REQ_Q_USR usr;
#endif
} ASC_SCSI_REQ_Q;
typedef struct asc_scsi_bios_req_q {
- ASC_SCSIQ_1 r1;
- ASC_SCSIQ_2 r2;
- uchar dosfar *cdbptr;
- ASC_SG_HEAD dosfar *sg_head;
- uchar dosfar *sense_ptr;
- ASC_SCSIQ_3 r3;
- uchar cdb[ASC_MAX_CDB_LEN];
- uchar sense[ASC_MIN_SENSE_LEN];
+ ASC_SCSIQ_1 r1;
+ ASC_SCSIQ_2 r2;
+ uchar *cdbptr;
+ ASC_SG_HEAD *sg_head;
+ uchar *sense_ptr;
+ ASC_SCSIQ_3 r3;
+ uchar cdb[ASC_MAX_CDB_LEN];
+ uchar sense[ASC_MIN_SENSE_LEN];
} ASC_SCSI_BIOS_REQ_Q;
typedef struct asc_risc_q {
- uchar fwd;
- uchar bwd;
- ASC_SCSIQ_1 i1;
- ASC_SCSIQ_2 i2;
- ASC_SCSIQ_3 i3;
- ASC_SCSIQ_4 i4;
+ uchar fwd;
+ uchar bwd;
+ ASC_SCSIQ_1 i1;
+ ASC_SCSIQ_2 i2;
+ ASC_SCSIQ_3 i3;
+ ASC_SCSIQ_4 i4;
} ASC_RISC_Q;
typedef struct asc_sg_list_q {
- uchar seq_no;
- uchar q_no;
- uchar cntl;
- uchar sg_head_qp;
- uchar sg_list_cnt;
- uchar sg_cur_list_cnt;
+ uchar seq_no;
+ uchar q_no;
+ uchar cntl;
+ uchar sg_head_qp;
+ uchar sg_list_cnt;
+ uchar sg_cur_list_cnt;
} ASC_SG_LIST_Q;
typedef struct asc_risc_sg_list_q {
- uchar fwd;
- uchar bwd;
- ASC_SG_LIST_Q sg;
- ASC_SG_LIST sg_list[7];
+ uchar fwd;
+ uchar bwd;
+ ASC_SG_LIST_Q sg;
+ ASC_SG_LIST sg_list[7];
} ASC_RISC_SG_LIST_Q;
#define ASC_EXE_SCSI_IO_MAX_IDLE_LOOP 0x1000000UL
@@ -1397,7 +1473,7 @@ typedef struct asc_risc_sg_list_q {
#define ASC_MIN_TAG_Q_PER_DVC (0x04)
#define ASC_DEF_TAG_Q_PER_DVC (0x04)
#define ASC_MIN_FREE_Q ASC_MIN_REMAIN_Q
-#define ASC_MIN_TOTAL_QNG (( ASC_MAX_SG_QUEUE )+( ASC_MIN_FREE_Q ))
+#define ASC_MIN_TOTAL_QNG ((ASC_MAX_SG_QUEUE)+(ASC_MIN_FREE_Q))
#define ASC_MAX_TOTAL_QNG 240
#define ASC_MAX_PCI_ULTRA_INRAM_TOTAL_QNG 16
#define ASC_MAX_PCI_ULTRA_INRAM_TAG_QNG 8
@@ -1406,16 +1482,16 @@ typedef struct asc_risc_sg_list_q {
#define ASC_IOADR_TABLE_MAX_IX 11
#define ASC_IOADR_GAP 0x10
#define ASC_SEARCH_IOP_GAP 0x10
-#define ASC_MIN_IOP_ADDR ( PortAddr )0x0100
-#define ASC_MAX_IOP_ADDR ( PortAddr )0x3F0
-#define ASC_IOADR_1 ( PortAddr )0x0110
-#define ASC_IOADR_2 ( PortAddr )0x0130
-#define ASC_IOADR_3 ( PortAddr )0x0150
-#define ASC_IOADR_4 ( PortAddr )0x0190
-#define ASC_IOADR_5 ( PortAddr )0x0210
-#define ASC_IOADR_6 ( PortAddr )0x0230
-#define ASC_IOADR_7 ( PortAddr )0x0250
-#define ASC_IOADR_8 ( PortAddr )0x0330
+#define ASC_MIN_IOP_ADDR (PortAddr)0x0100
+#define ASC_MAX_IOP_ADDR (PortAddr)0x3F0
+#define ASC_IOADR_1 (PortAddr)0x0110
+#define ASC_IOADR_2 (PortAddr)0x0130
+#define ASC_IOADR_3 (PortAddr)0x0150
+#define ASC_IOADR_4 (PortAddr)0x0190
+#define ASC_IOADR_5 (PortAddr)0x0210
+#define ASC_IOADR_6 (PortAddr)0x0230
+#define ASC_IOADR_7 (PortAddr)0x0250
+#define ASC_IOADR_8 (PortAddr)0x0330
#define ASC_IOADR_DEF ASC_IOADR_8
#define ASC_LIB_SCSIQ_WK_SP 256
#define ASC_MAX_SYN_XFER_NO 16
@@ -1447,35 +1523,55 @@ typedef struct asc_risc_sg_list_q {
#define SYN_ULTRA_XFER_NS_13 94
#define SYN_ULTRA_XFER_NS_14 100
#define SYN_ULTRA_XFER_NS_15 107
-#define SYN_XMSG_WLEN 3
-typedef struct sdtr_xmsg {
- uchar msg_type;
- uchar msg_len;
- uchar msg_req;
- uchar xfer_period;
- uchar req_ack_offset;
- uchar res;
-} SDTR_XMSG;
+typedef struct ext_msg {
+ uchar msg_type;
+ uchar msg_len;
+ uchar msg_req;
+ union {
+ struct {
+ uchar sdtr_xfer_period;
+ uchar sdtr_req_ack_offset;
+ } sdtr;
+ struct {
+ uchar wdtr_width;
+ } wdtr;
+ struct {
+ uchar mdp_b3;
+ uchar mdp_b2;
+ uchar mdp_b1;
+ uchar mdp_b0;
+ } mdp;
+ } u_ext_msg;
+ uchar res;
+} EXT_MSG;
+
+#define xfer_period u_ext_msg.sdtr.sdtr_xfer_period
+#define req_ack_offset u_ext_msg.sdtr.sdtr_req_ack_offset
+#define wdtr_width u_ext_msg.wdtr.wdtr_width
+#define mdp_b3 u_ext_msg.mdp_b3
+#define mdp_b2 u_ext_msg.mdp_b2
+#define mdp_b1 u_ext_msg.mdp_b1
+#define mdp_b0 u_ext_msg.mdp_b0
typedef struct asc_dvc_cfg {
- ASC_SCSI_BIT_ID_TYPE can_tagged_qng;
- ASC_SCSI_BIT_ID_TYPE cmd_qng_enabled;
- ASC_SCSI_BIT_ID_TYPE disc_enable;
- uchar res;
- uchar chip_scsi_id:4;
- uchar isa_dma_speed:4;
- uchar isa_dma_channel;
- uchar chip_version;
- ushort pci_device_id;
- ushort lib_serial_no;
- ushort lib_version;
- ushort mcode_date;
- ushort mcode_version;
- uchar max_tag_qng[ASC_MAX_TID + 1];
- uchar dosfar *overrun_buf;
- uchar sdtr_period_offset[ASC_MAX_TID + 1];
- ushort pci_slot_info;
+ ASC_SCSI_BIT_ID_TYPE can_tagged_qng;
+ ASC_SCSI_BIT_ID_TYPE cmd_qng_enabled;
+ ASC_SCSI_BIT_ID_TYPE disc_enable;
+ uchar res;
+ uchar chip_scsi_id:4;
+ uchar isa_dma_speed:4;
+ uchar isa_dma_channel;
+ uchar chip_version;
+ ushort pci_device_id;
+ ushort lib_serial_no;
+ ushort lib_version;
+ ushort mcode_date;
+ ushort mcode_version;
+ uchar max_tag_qng[ASC_MAX_TID + 1];
+ uchar *overrun_buf;
+ uchar sdtr_period_offset[ASC_MAX_TID + 1];
+ ushort pci_slot_info;
} ASC_DVC_CFG;
#define ASC_DEF_DVC_CNTL 0xFFFF
@@ -1501,82 +1597,82 @@ typedef struct asc_dvc_cfg {
#define ASC_MAX_SCSI_RESET_WAIT 30
typedef struct asc_dvc_var {
- PortAddr iop_base;
- ushort err_code;
- ushort dvc_cntl;
- ushort bug_fix_cntl;
- ushort bus_type;
- Ptr2Func isr_callback;
- Ptr2Func exe_callback;
- ASC_SCSI_BIT_ID_TYPE init_sdtr;
- ASC_SCSI_BIT_ID_TYPE sdtr_done;
- ASC_SCSI_BIT_ID_TYPE use_tagged_qng;
- ASC_SCSI_BIT_ID_TYPE unit_not_ready;
- ASC_SCSI_BIT_ID_TYPE queue_full_or_busy;
- ASC_SCSI_BIT_ID_TYPE start_motor;
- uchar scsi_reset_wait;
- uchar chip_no;
- char is_in_int;
- uchar max_total_qng;
- uchar cur_total_qng;
- uchar in_critical_cnt;
- uchar irq_no;
- uchar last_q_shortage;
- ushort init_state;
- uchar cur_dvc_qng[ASC_MAX_TID + 1];
- uchar max_dvc_qng[ASC_MAX_TID + 1];
- ASC_SCSI_Q dosfar *scsiq_busy_head[ASC_MAX_TID + 1];
- ASC_SCSI_Q dosfar *scsiq_busy_tail[ASC_MAX_TID + 1];
- uchar sdtr_period_tbl[ASC_MAX_SYN_XFER_NO];
- ASC_DVC_CFG dosfar *cfg;
- Ptr2Func saved_ptr2func;
- ASC_SCSI_BIT_ID_TYPE pci_fix_asyn_xfer_always;
- char redo_scam;
- ushort res2;
- uchar dos_int13_table[ASC_MAX_TID + 1];
- ulong max_dma_count;
- ASC_SCSI_BIT_ID_TYPE no_scam;
- ASC_SCSI_BIT_ID_TYPE pci_fix_asyn_xfer;
- uchar max_sdtr_index;
- uchar host_init_sdtr_index;
- ulong drv_ptr;
- ulong uc_break;
- ulong res7;
- ulong res8;
+ PortAddr iop_base;
+ ushort err_code;
+ ushort dvc_cntl;
+ ushort bug_fix_cntl;
+ ushort bus_type;
+ Ptr2Func isr_callback;
+ Ptr2Func exe_callback;
+ ASC_SCSI_BIT_ID_TYPE init_sdtr;
+ ASC_SCSI_BIT_ID_TYPE sdtr_done;
+ ASC_SCSI_BIT_ID_TYPE use_tagged_qng;
+ ASC_SCSI_BIT_ID_TYPE unit_not_ready;
+ ASC_SCSI_BIT_ID_TYPE queue_full_or_busy;
+ ASC_SCSI_BIT_ID_TYPE start_motor;
+ uchar scsi_reset_wait;
+ uchar chip_no;
+ char is_in_int;
+ uchar max_total_qng;
+ uchar cur_total_qng;
+ uchar in_critical_cnt;
+ uchar irq_no;
+ uchar last_q_shortage;
+ ushort init_state;
+ uchar cur_dvc_qng[ASC_MAX_TID + 1];
+ uchar max_dvc_qng[ASC_MAX_TID + 1];
+ ASC_SCSI_Q *scsiq_busy_head[ASC_MAX_TID + 1];
+ ASC_SCSI_Q *scsiq_busy_tail[ASC_MAX_TID + 1];
+ uchar sdtr_period_tbl[ASC_MAX_SYN_XFER_NO];
+ ASC_DVC_CFG *cfg;
+ Ptr2Func saved_ptr2func;
+ ASC_SCSI_BIT_ID_TYPE pci_fix_asyn_xfer_always;
+ char redo_scam;
+ ushort res2;
+ uchar dos_int13_table[ASC_MAX_TID + 1];
+ ulong max_dma_count;
+ ASC_SCSI_BIT_ID_TYPE no_scam;
+ ASC_SCSI_BIT_ID_TYPE pci_fix_asyn_xfer;
+ uchar max_sdtr_index;
+ uchar host_init_sdtr_index;
+ ulong drv_ptr;
+ ulong uc_break;
+ ulong res7;
+ ulong res8;
} ASC_DVC_VAR;
-typedef int (dosfar * ASC_ISR_CALLBACK) (ASC_DVC_VAR asc_ptr_type *, ASC_QDONE_INFO dosfar *);
-typedef int (dosfar * ASC_EXE_CALLBACK) (ASC_DVC_VAR asc_ptr_type *, ASC_SCSI_Q dosfar *);
+typedef int (* ASC_ISR_CALLBACK) (ASC_DVC_VAR asc_ptr_type *, ASC_QDONE_INFO *);
+typedef int (* ASC_EXE_CALLBACK) (ASC_DVC_VAR asc_ptr_type *, ASC_SCSI_Q *);
typedef struct asc_dvc_inq_info {
- uchar type[ASC_MAX_TID + 1][ASC_MAX_LUN + 1];
+ uchar type[ASC_MAX_TID + 1][ASC_MAX_LUN + 1];
} ASC_DVC_INQ_INFO;
typedef struct asc_cap_info {
- ulong lba;
- ulong blk_size;
+ ulong lba;
+ ulong blk_size;
} ASC_CAP_INFO;
typedef struct asc_cap_info_array {
- ASC_CAP_INFO cap_info[ASC_MAX_TID + 1][ASC_MAX_LUN + 1];
+ ASC_CAP_INFO cap_info[ASC_MAX_TID + 1][ASC_MAX_LUN + 1];
} ASC_CAP_INFO_ARRAY;
-#define ASC_MCNTL_NO_SEL_TIMEOUT ( ushort )0x0001
-#define ASC_MCNTL_NULL_TARGET ( ushort )0x0002
-#define ASC_CNTL_INITIATOR ( ushort )0x0001
-#define ASC_CNTL_BIOS_GT_1GB ( ushort )0x0002
-#define ASC_CNTL_BIOS_GT_2_DISK ( ushort )0x0004
-#define ASC_CNTL_BIOS_REMOVABLE ( ushort )0x0008
-#define ASC_CNTL_NO_SCAM ( ushort )0x0010
-#define ASC_CNTL_INT_MULTI_Q ( ushort )0x0080
-#define ASC_CNTL_NO_LUN_SUPPORT ( ushort )0x0040
-#define ASC_CNTL_NO_VERIFY_COPY ( ushort )0x0100
-#define ASC_CNTL_RESET_SCSI ( ushort )0x0200
-#define ASC_CNTL_INIT_INQUIRY ( ushort )0x0400
-#define ASC_CNTL_INIT_VERBOSE ( ushort )0x0800
-#define ASC_CNTL_SCSI_PARITY ( ushort )0x1000
-#define ASC_CNTL_BURST_MODE ( ushort )0x2000
-#define ASC_CNTL_SDTR_ENABLE_ULTRA ( ushort )0x4000
+#define ASC_MCNTL_NO_SEL_TIMEOUT (ushort)0x0001
+#define ASC_MCNTL_NULL_TARGET (ushort)0x0002
+#define ASC_CNTL_INITIATOR (ushort)0x0001
+#define ASC_CNTL_BIOS_GT_1GB (ushort)0x0002
+#define ASC_CNTL_BIOS_GT_2_DISK (ushort)0x0004
+#define ASC_CNTL_BIOS_REMOVABLE (ushort)0x0008
+#define ASC_CNTL_NO_SCAM (ushort)0x0010
+#define ASC_CNTL_INT_MULTI_Q (ushort)0x0080
+#define ASC_CNTL_NO_LUN_SUPPORT (ushort)0x0040
+#define ASC_CNTL_NO_VERIFY_COPY (ushort)0x0100
+#define ASC_CNTL_RESET_SCSI (ushort)0x0200
+#define ASC_CNTL_INIT_INQUIRY (ushort)0x0400
+#define ASC_CNTL_INIT_VERBOSE (ushort)0x0800
+#define ASC_CNTL_SCSI_PARITY (ushort)0x1000
+#define ASC_CNTL_BURST_MODE (ushort)0x2000
+#define ASC_CNTL_SDTR_ENABLE_ULTRA (ushort)0x4000
#define ASC_EEP_DVC_CFG_BEG_VL 2
#define ASC_EEP_MAX_DVC_ADDR_VL 15
#define ASC_EEP_DVC_CFG_BEG 32
@@ -1589,25 +1685,29 @@ typedef struct asc_cap_info_array {
#define ASC_EEP_ISA_PNP_WSIZE 16
typedef struct asceep_config {
- ushort cfg_lsw;
- ushort cfg_msw;
- uchar init_sdtr;
- uchar disc_enable;
- uchar use_cmd_qng;
- uchar start_motor;
- uchar max_total_qng;
- uchar max_tag_qng;
- uchar bios_scan;
- uchar power_up_wait;
- uchar no_scam;
- uchar chip_scsi_id:4;
- uchar isa_dma_speed:4;
- uchar dos_int13_table[ASC_MAX_TID + 1];
- uchar adapter_info[6];
- ushort cntl;
- ushort chksum;
+ ushort cfg_lsw;
+ ushort cfg_msw;
+ uchar init_sdtr;
+ uchar disc_enable;
+ uchar use_cmd_qng;
+ uchar start_motor;
+ uchar max_total_qng;
+ uchar max_tag_qng;
+ uchar bios_scan;
+ uchar power_up_wait;
+ uchar no_scam;
+ uchar chip_scsi_id:4;
+ uchar isa_dma_speed:4;
+ uchar dos_int13_table[ASC_MAX_TID + 1];
+ uchar adapter_info[6];
+ ushort cntl;
+ ushort chksum;
} ASCEEP_CONFIG;
+#define ASC_PCI_CFG_LSW_SCSI_PARITY 0x0800
+#define ASC_PCI_CFG_LSW_BURST_MODE 0x0080
+#define ASC_PCI_CFG_LSW_INTR_ABLE 0x0020
+
#define ASC_EEP_CMD_READ 0x80
#define ASC_EEP_CMD_WRITE 0x40
#define ASC_EEP_CMD_WRITE_ABLE 0x30
@@ -1618,54 +1718,54 @@ typedef struct asceep_config {
#define ASCV_MSGOUT_BEG 0x0000
#define ASCV_MSGOUT_SDTR_PERIOD (ASCV_MSGOUT_BEG+3)
#define ASCV_MSGOUT_SDTR_OFFSET (ASCV_MSGOUT_BEG+4)
-#define ASCV_BREAK_SAVED_CODE ( ushort )0x0006
+#define ASCV_BREAK_SAVED_CODE (ushort)0x0006
#define ASCV_MSGIN_BEG (ASCV_MSGOUT_BEG+8)
#define ASCV_MSGIN_SDTR_PERIOD (ASCV_MSGIN_BEG+3)
#define ASCV_MSGIN_SDTR_OFFSET (ASCV_MSGIN_BEG+4)
#define ASCV_SDTR_DATA_BEG (ASCV_MSGIN_BEG+8)
#define ASCV_SDTR_DONE_BEG (ASCV_SDTR_DATA_BEG+8)
-#define ASCV_MAX_DVC_QNG_BEG ( ushort )0x0020
-#define ASCV_BREAK_ADDR ( ushort )0x0028
-#define ASCV_BREAK_NOTIFY_COUNT ( ushort )0x002A
-#define ASCV_BREAK_CONTROL ( ushort )0x002C
-#define ASCV_BREAK_HIT_COUNT ( ushort )0x002E
-
-#define ASCV_ASCDVC_ERR_CODE_W ( ushort )0x0030
-#define ASCV_MCODE_CHKSUM_W ( ushort )0x0032
-#define ASCV_MCODE_SIZE_W ( ushort )0x0034
-#define ASCV_STOP_CODE_B ( ushort )0x0036
-#define ASCV_DVC_ERR_CODE_B ( ushort )0x0037
-#define ASCV_OVERRUN_PADDR_D ( ushort )0x0038
-#define ASCV_OVERRUN_BSIZE_D ( ushort )0x003C
-#define ASCV_HALTCODE_W ( ushort )0x0040
-#define ASCV_CHKSUM_W ( ushort )0x0042
-#define ASCV_MC_DATE_W ( ushort )0x0044
-#define ASCV_MC_VER_W ( ushort )0x0046
-#define ASCV_NEXTRDY_B ( ushort )0x0048
-#define ASCV_DONENEXT_B ( ushort )0x0049
-#define ASCV_USE_TAGGED_QNG_B ( ushort )0x004A
-#define ASCV_SCSIBUSY_B ( ushort )0x004B
-#define ASCV_Q_DONE_IN_PROGRESS_B ( ushort )0x004C
-#define ASCV_CURCDB_B ( ushort )0x004D
-#define ASCV_RCLUN_B ( ushort )0x004E
-#define ASCV_BUSY_QHEAD_B ( ushort )0x004F
-#define ASCV_DISC1_QHEAD_B ( ushort )0x0050
-#define ASCV_DISC_ENABLE_B ( ushort )0x0052
-#define ASCV_CAN_TAGGED_QNG_B ( ushort )0x0053
-#define ASCV_HOSTSCSI_ID_B ( ushort )0x0055
-#define ASCV_MCODE_CNTL_B ( ushort )0x0056
-#define ASCV_NULL_TARGET_B ( ushort )0x0057
-#define ASCV_FREE_Q_HEAD_W ( ushort )0x0058
-#define ASCV_DONE_Q_TAIL_W ( ushort )0x005A
-#define ASCV_FREE_Q_HEAD_B ( ushort )(ASCV_FREE_Q_HEAD_W+1)
-#define ASCV_DONE_Q_TAIL_B ( ushort )(ASCV_DONE_Q_TAIL_W+1)
-#define ASCV_HOST_FLAG_B ( ushort )0x005D
-#define ASCV_TOTAL_READY_Q_B ( ushort )0x0064
-#define ASCV_VER_SERIAL_B ( ushort )0x0065
-#define ASCV_HALTCODE_SAVED_W ( ushort )0x0066
-#define ASCV_WTM_FLAG_B ( ushort )0x0068
-#define ASCV_RISC_FLAG_B ( ushort )0x006A
-#define ASCV_REQ_SG_LIST_QP ( ushort )0x006B
+#define ASCV_MAX_DVC_QNG_BEG (ushort)0x0020
+#define ASCV_BREAK_ADDR (ushort)0x0028
+#define ASCV_BREAK_NOTIFY_COUNT (ushort)0x002A
+#define ASCV_BREAK_CONTROL (ushort)0x002C
+#define ASCV_BREAK_HIT_COUNT (ushort)0x002E
+
+#define ASCV_ASCDVC_ERR_CODE_W (ushort)0x0030
+#define ASCV_MCODE_CHKSUM_W (ushort)0x0032
+#define ASCV_MCODE_SIZE_W (ushort)0x0034
+#define ASCV_STOP_CODE_B (ushort)0x0036
+#define ASCV_DVC_ERR_CODE_B (ushort)0x0037
+#define ASCV_OVERRUN_PADDR_D (ushort)0x0038
+#define ASCV_OVERRUN_BSIZE_D (ushort)0x003C
+#define ASCV_HALTCODE_W (ushort)0x0040
+#define ASCV_CHKSUM_W (ushort)0x0042
+#define ASCV_MC_DATE_W (ushort)0x0044
+#define ASCV_MC_VER_W (ushort)0x0046
+#define ASCV_NEXTRDY_B (ushort)0x0048
+#define ASCV_DONENEXT_B (ushort)0x0049
+#define ASCV_USE_TAGGED_QNG_B (ushort)0x004A
+#define ASCV_SCSIBUSY_B (ushort)0x004B
+#define ASCV_Q_DONE_IN_PROGRESS_B (ushort)0x004C
+#define ASCV_CURCDB_B (ushort)0x004D
+#define ASCV_RCLUN_B (ushort)0x004E
+#define ASCV_BUSY_QHEAD_B (ushort)0x004F
+#define ASCV_DISC1_QHEAD_B (ushort)0x0050
+#define ASCV_DISC_ENABLE_B (ushort)0x0052
+#define ASCV_CAN_TAGGED_QNG_B (ushort)0x0053
+#define ASCV_HOSTSCSI_ID_B (ushort)0x0055
+#define ASCV_MCODE_CNTL_B (ushort)0x0056
+#define ASCV_NULL_TARGET_B (ushort)0x0057
+#define ASCV_FREE_Q_HEAD_W (ushort)0x0058
+#define ASCV_DONE_Q_TAIL_W (ushort)0x005A
+#define ASCV_FREE_Q_HEAD_B (ushort)(ASCV_FREE_Q_HEAD_W+1)
+#define ASCV_DONE_Q_TAIL_B (ushort)(ASCV_DONE_Q_TAIL_W+1)
+#define ASCV_HOST_FLAG_B (ushort)0x005D
+#define ASCV_TOTAL_READY_Q_B (ushort)0x0064
+#define ASCV_VER_SERIAL_B (ushort)0x0065
+#define ASCV_HALTCODE_SAVED_W (ushort)0x0066
+#define ASCV_WTM_FLAG_B (ushort)0x0068
+#define ASCV_RISC_FLAG_B (ushort)0x006A
+#define ASCV_REQ_SG_LIST_QP (ushort)0x006B
#define ASC_HOST_FLAG_IN_ISR 0x01
#define ASC_HOST_FLAG_ACK_INT 0x02
#define ASC_RISC_FLAG_GEN_INT 0x01
@@ -1708,32 +1808,34 @@ typedef struct asceep_config {
#define IFC_SLEW_RATE (0x20)
#define IFC_ACT_NEG (0x40)
#define IFC_INP_FILTER (0x80)
-#define IFC_INIT_DEFAULT ( IFC_ACT_NEG | IFC_REG_UNLOCK )
-#define SC_SEL ( uchar )(0x80)
-#define SC_BSY ( uchar )(0x40)
-#define SC_ACK ( uchar )(0x20)
-#define SC_REQ ( uchar )(0x10)
-#define SC_ATN ( uchar )(0x08)
-#define SC_IO ( uchar )(0x04)
-#define SC_CD ( uchar )(0x02)
-#define SC_MSG ( uchar )(0x01)
-#define SEC_ACTIVE_NEGATE ( uchar )( 0x40 )
-#define SEC_SLEW_RATE ( uchar )( 0x20 )
-#define ASC_HALT_EXTMSG_IN ( ushort )0x8000
-#define ASC_HALT_CHK_CONDITION ( ushort )0x8100
-#define ASC_HALT_SS_QUEUE_FULL ( ushort )0x8200
-#define ASC_HALT_DISABLE_ASYN_USE_SYN_FIX ( ushort )0x8300
-#define ASC_HALT_ENABLE_ASYN_USE_SYN_FIX ( ushort )0x8400
-#define ASC_HALT_SDTR_REJECTED ( ushort )0x4000
+#define IFC_INIT_DEFAULT (IFC_ACT_NEG | IFC_REG_UNLOCK)
+#define SC_SEL (uchar)(0x80)
+#define SC_BSY (uchar)(0x40)
+#define SC_ACK (uchar)(0x20)
+#define SC_REQ (uchar)(0x10)
+#define SC_ATN (uchar)(0x08)
+#define SC_IO (uchar)(0x04)
+#define SC_CD (uchar)(0x02)
+#define SC_MSG (uchar)(0x01)
+#define SEC_SCSI_CTL (uchar)(0x80)
+#define SEC_ACTIVE_NEGATE (uchar)(0x40)
+#define SEC_SLEW_RATE (uchar)(0x20)
+#define SEC_ENABLE_FILTER (uchar)(0x10)
+#define ASC_HALT_EXTMSG_IN (ushort)0x8000
+#define ASC_HALT_CHK_CONDITION (ushort)0x8100
+#define ASC_HALT_SS_QUEUE_FULL (ushort)0x8200
+#define ASC_HALT_DISABLE_ASYN_USE_SYN_FIX (ushort)0x8300
+#define ASC_HALT_ENABLE_ASYN_USE_SYN_FIX (ushort)0x8400
+#define ASC_HALT_SDTR_REJECTED (ushort)0x4000
#define ASC_MAX_QNO 0xF8
-#define ASC_DATA_SEC_BEG ( ushort )0x0080
-#define ASC_DATA_SEC_END ( ushort )0x0080
-#define ASC_CODE_SEC_BEG ( ushort )0x0080
-#define ASC_CODE_SEC_END ( ushort )0x0080
+#define ASC_DATA_SEC_BEG (ushort)0x0080
+#define ASC_DATA_SEC_END (ushort)0x0080
+#define ASC_CODE_SEC_BEG (ushort)0x0080
+#define ASC_CODE_SEC_END (ushort)0x0080
#define ASC_QADR_BEG (0x4000)
-#define ASC_QADR_USED ( ushort )( ASC_MAX_QNO * 64 )
-#define ASC_QADR_END ( ushort )0x7FFF
-#define ASC_QLAST_ADR ( ushort )0x7FC0
+#define ASC_QADR_USED (ushort)(ASC_MAX_QNO * 64)
+#define ASC_QADR_END (ushort)0x7FFF
+#define ASC_QLAST_ADR (ushort)0x7FC0
#define ASC_QBLK_SIZE 0x40
#define ASC_BIOS_DATA_QBEG 0xF8
#define ASC_MIN_ACTIVE_QNO 0x01
@@ -1755,36 +1857,36 @@ typedef struct asceep_config {
#define ASC_CFG1_SCSI_TARGET_ON 0x0080
#define ASC_CFG1_LRAM_8BITS_ON 0x0800
#define ASC_CFG_MSW_CLR_MASK 0x30C0
-#define CSW_TEST1 ( ASC_CS_TYPE )0x8000
-#define CSW_AUTO_CONFIG ( ASC_CS_TYPE )0x4000
-#define CSW_RESERVED1 ( ASC_CS_TYPE )0x2000
-#define CSW_IRQ_WRITTEN ( ASC_CS_TYPE )0x1000
-#define CSW_33MHZ_SELECTED ( ASC_CS_TYPE )0x0800
-#define CSW_TEST2 ( ASC_CS_TYPE )0x0400
-#define CSW_TEST3 ( ASC_CS_TYPE )0x0200
-#define CSW_RESERVED2 ( ASC_CS_TYPE )0x0100
-#define CSW_DMA_DONE ( ASC_CS_TYPE )0x0080
-#define CSW_FIFO_RDY ( ASC_CS_TYPE )0x0040
-#define CSW_EEP_READ_DONE ( ASC_CS_TYPE )0x0020
-#define CSW_HALTED ( ASC_CS_TYPE )0x0010
-#define CSW_SCSI_RESET_ACTIVE ( ASC_CS_TYPE )0x0008
-#define CSW_PARITY_ERR ( ASC_CS_TYPE )0x0004
-#define CSW_SCSI_RESET_LATCH ( ASC_CS_TYPE )0x0002
-#define CSW_INT_PENDING ( ASC_CS_TYPE )0x0001
-#define CIW_CLR_SCSI_RESET_INT ( ASC_CS_TYPE )0x1000
-#define CIW_INT_ACK ( ASC_CS_TYPE )0x0100
-#define CIW_TEST1 ( ASC_CS_TYPE )0x0200
-#define CIW_TEST2 ( ASC_CS_TYPE )0x0400
-#define CIW_SEL_33MHZ ( ASC_CS_TYPE )0x0800
-#define CIW_IRQ_ACT ( ASC_CS_TYPE )0x1000
-#define CC_CHIP_RESET ( uchar )0x80
-#define CC_SCSI_RESET ( uchar )0x40
-#define CC_HALT ( uchar )0x20
-#define CC_SINGLE_STEP ( uchar )0x10
-#define CC_DMA_ABLE ( uchar )0x08
-#define CC_TEST ( uchar )0x04
-#define CC_BANK_ONE ( uchar )0x02
-#define CC_DIAG ( uchar )0x01
+#define CSW_TEST1 (ASC_CS_TYPE)0x8000
+#define CSW_AUTO_CONFIG (ASC_CS_TYPE)0x4000
+#define CSW_RESERVED1 (ASC_CS_TYPE)0x2000
+#define CSW_IRQ_WRITTEN (ASC_CS_TYPE)0x1000
+#define CSW_33MHZ_SELECTED (ASC_CS_TYPE)0x0800
+#define CSW_TEST2 (ASC_CS_TYPE)0x0400
+#define CSW_TEST3 (ASC_CS_TYPE)0x0200
+#define CSW_RESERVED2 (ASC_CS_TYPE)0x0100
+#define CSW_DMA_DONE (ASC_CS_TYPE)0x0080
+#define CSW_FIFO_RDY (ASC_CS_TYPE)0x0040
+#define CSW_EEP_READ_DONE (ASC_CS_TYPE)0x0020
+#define CSW_HALTED (ASC_CS_TYPE)0x0010
+#define CSW_SCSI_RESET_ACTIVE (ASC_CS_TYPE)0x0008
+#define CSW_PARITY_ERR (ASC_CS_TYPE)0x0004
+#define CSW_SCSI_RESET_LATCH (ASC_CS_TYPE)0x0002
+#define CSW_INT_PENDING (ASC_CS_TYPE)0x0001
+#define CIW_CLR_SCSI_RESET_INT (ASC_CS_TYPE)0x1000
+#define CIW_INT_ACK (ASC_CS_TYPE)0x0100
+#define CIW_TEST1 (ASC_CS_TYPE)0x0200
+#define CIW_TEST2 (ASC_CS_TYPE)0x0400
+#define CIW_SEL_33MHZ (ASC_CS_TYPE)0x0800
+#define CIW_IRQ_ACT (ASC_CS_TYPE)0x1000
+#define CC_CHIP_RESET (uchar)0x80
+#define CC_SCSI_RESET (uchar)0x40
+#define CC_HALT (uchar)0x20
+#define CC_SINGLE_STEP (uchar)0x10
+#define CC_DMA_ABLE (uchar)0x08
+#define CC_TEST (uchar)0x04
+#define CC_BANK_ONE (uchar)0x02
+#define CC_DIAG (uchar)0x01
#define ASC_1000_ID0W 0x04C1
#define ASC_1000_ID0W_FIX 0x00C1
#define ASC_1000_ID1B 0x25
@@ -1795,337 +1897,249 @@ typedef struct asceep_config {
#define ASC_EISA_REV_IOP_MASK (0x0C83)
#define ASC_EISA_PID_IOP_MASK (0x0C80)
#define ASC_EISA_CFG_IOP_MASK (0x0C86)
-#define ASC_GET_EISA_SLOT( iop ) ( PortAddr )( (iop) & 0xF000 )
+#define ASC_GET_EISA_SLOT(iop) (PortAddr)((iop) & 0xF000)
#define ASC_EISA_ID_740 0x01745004UL
#define ASC_EISA_ID_750 0x01755004UL
-#define INS_HALTINT ( ushort )0x6281
-#define INS_HALT ( ushort )0x6280
-#define INS_SINT ( ushort )0x6200
-#define INS_RFLAG_WTM ( ushort )0x7380
+#define INS_HALTINT (ushort)0x6281
+#define INS_HALT (ushort)0x6280
+#define INS_SINT (ushort)0x6200
+#define INS_RFLAG_WTM (ushort)0x7380
#define ASC_MC_SAVE_CODE_WSIZE 0x500
#define ASC_MC_SAVE_DATA_WSIZE 0x40
typedef struct asc_mc_saved {
- ushort data[ASC_MC_SAVE_DATA_WSIZE];
- ushort code[ASC_MC_SAVE_CODE_WSIZE];
+ ushort data[ASC_MC_SAVE_DATA_WSIZE];
+ ushort code[ASC_MC_SAVE_CODE_WSIZE];
} ASC_MC_SAVED;
-#define AscGetQDoneInProgress( port ) AscReadLramByte( (port), ASCV_Q_DONE_IN_PROGRESS_B )
-#define AscPutQDoneInProgress( port, val ) AscWriteLramByte( (port), ASCV_Q_DONE_IN_PROGRESS_B, val )
-#define AscGetVarFreeQHead( port ) AscReadLramWord( (port), ASCV_FREE_Q_HEAD_W )
-#define AscGetVarDoneQTail( port ) AscReadLramWord( (port), ASCV_DONE_Q_TAIL_W )
-#define AscPutVarFreeQHead( port, val ) AscWriteLramWord( (port), ASCV_FREE_Q_HEAD_W, val )
-#define AscPutVarDoneQTail( port, val ) AscWriteLramWord( (port), ASCV_DONE_Q_TAIL_W, val )
-#define AscGetRiscVarFreeQHead( port ) AscReadLramByte( (port), ASCV_NEXTRDY_B )
-#define AscGetRiscVarDoneQTail( port ) AscReadLramByte( (port), ASCV_DONENEXT_B )
-#define AscPutRiscVarFreeQHead( port, val ) AscWriteLramByte( (port), ASCV_NEXTRDY_B, val )
-#define AscPutRiscVarDoneQTail( port, val ) AscWriteLramByte( (port), ASCV_DONENEXT_B, val )
-#define AscPutMCodeSDTRDoneAtID( port, id, data ) AscWriteLramByte( (port), ( ushort )( ( ushort )ASCV_SDTR_DONE_BEG+( ushort )id ), (data) ) ;
-#define AscGetMCodeSDTRDoneAtID( port, id ) AscReadLramByte( (port), ( ushort )( ( ushort )ASCV_SDTR_DONE_BEG+( ushort )id ) ) ;
-#define AscPutMCodeInitSDTRAtID( port, id, data ) AscWriteLramByte( (port), ( ushort )( ( ushort )ASCV_SDTR_DATA_BEG+( ushort )id ), data ) ;
-#define AscGetMCodeInitSDTRAtID( port, id ) AscReadLramByte( (port), ( ushort )( ( ushort )ASCV_SDTR_DATA_BEG+( ushort )id ) ) ;
-#define AscSynIndexToPeriod( index ) ( uchar )( asc_dvc->sdtr_period_tbl[ (index) ] )
-#define AscGetChipSignatureByte( port ) ( uchar )inp( (port)+IOP_SIG_BYTE )
-#define AscGetChipSignatureWord( port ) ( ushort )inpw( (port)+IOP_SIG_WORD )
-#define AscGetChipVerNo( port ) ( uchar )inp( (port)+IOP_VERSION )
-#define AscGetChipCfgLsw( port ) ( ushort )inpw( (port)+IOP_CONFIG_LOW )
-#define AscGetChipCfgMsw( port ) ( ushort )inpw( (port)+IOP_CONFIG_HIGH )
-#define AscSetChipCfgLsw( port, data ) outpw( (port)+IOP_CONFIG_LOW, data )
-#define AscSetChipCfgMsw( port, data ) outpw( (port)+IOP_CONFIG_HIGH, data )
-#define AscGetChipEEPCmd( port ) ( uchar )inp( (port)+IOP_EEP_CMD )
-#define AscSetChipEEPCmd( port, data ) outp( (port)+IOP_EEP_CMD, data )
-#define AscGetChipEEPData( port ) ( ushort )inpw( (port)+IOP_EEP_DATA )
-#define AscSetChipEEPData( port, data ) outpw( (port)+IOP_EEP_DATA, data )
-#define AscGetChipLramAddr( port ) ( ushort )inpw( ( PortAddr )((port)+IOP_RAM_ADDR) )
-#define AscSetChipLramAddr( port, addr ) outpw( ( PortAddr )( (port)+IOP_RAM_ADDR ), addr )
-#define AscGetChipLramData( port ) ( ushort )inpw( (port)+IOP_RAM_DATA )
-#define AscSetChipLramData( port, data ) outpw( (port)+IOP_RAM_DATA, data )
-#define AscGetChipLramDataNoSwap( port ) ( ushort )inpw_noswap( (port)+IOP_RAM_DATA )
-#define AscSetChipLramDataNoSwap( port, data ) outpw_noswap( (port)+IOP_RAM_DATA, data )
-#define AscGetChipIFC( port ) ( uchar )inp( (port)+IOP_REG_IFC )
-#define AscSetChipIFC( port, data ) outp( (port)+IOP_REG_IFC, data )
-#define AscGetChipStatus( port ) ( ASC_CS_TYPE )inpw( (port)+IOP_STATUS )
-#define AscSetChipStatus( port, cs_val ) outpw( (port)+IOP_STATUS, cs_val )
-#define AscGetChipControl( port ) ( uchar )inp( (port)+IOP_CTRL )
-#define AscSetChipControl( port, cc_val ) outp( (port)+IOP_CTRL, cc_val )
-#define AscGetChipSyn( port ) ( uchar )inp( (port)+IOP_SYN_OFFSET )
-#define AscSetChipSyn( port, data ) outp( (port)+IOP_SYN_OFFSET, data )
-#define AscSetPCAddr( port, data ) outpw( (port)+IOP_REG_PC, data )
-#define AscGetPCAddr( port ) ( ushort )inpw( (port)+IOP_REG_PC )
-#define AscIsIntPending( port ) ( AscGetChipStatus(port) & ( CSW_INT_PENDING | CSW_SCSI_RESET_LATCH ) )
-#define AscGetChipScsiID( port ) ( ( AscGetChipCfgLsw(port) >> 8 ) & ASC_MAX_TID )
-#define AscGetExtraControl( port ) ( uchar )inp( (port)+IOP_EXTRA_CONTROL )
-#define AscSetExtraControl( port, data ) outp( (port)+IOP_EXTRA_CONTROL, data )
-#define AscReadChipAX( port ) ( ushort )inpw( (port)+IOP_REG_AX )
-#define AscWriteChipAX( port, data ) outpw( (port)+IOP_REG_AX, data )
-#define AscReadChipIX( port ) ( uchar )inp( (port)+IOP_REG_IX )
-#define AscWriteChipIX( port, data ) outp( (port)+IOP_REG_IX, data )
-#define AscReadChipIH( port ) ( ushort )inpw( (port)+IOP_REG_IH )
-#define AscWriteChipIH( port, data ) outpw( (port)+IOP_REG_IH, data )
-#define AscReadChipQP( port ) ( uchar )inp( (port)+IOP_REG_QP )
-#define AscWriteChipQP( port, data ) outp( (port)+IOP_REG_QP, data )
-#define AscReadChipFIFO_L( port ) ( ushort )inpw( (port)+IOP_REG_FIFO_L )
-#define AscWriteChipFIFO_L( port, data ) outpw( (port)+IOP_REG_FIFO_L, data )
-#define AscReadChipFIFO_H( port ) ( ushort )inpw( (port)+IOP_REG_FIFO_H )
-#define AscWriteChipFIFO_H( port, data ) outpw( (port)+IOP_REG_FIFO_H, data )
-#define AscReadChipDmaSpeed( port ) ( uchar )inp( (port)+IOP_DMA_SPEED )
-#define AscWriteChipDmaSpeed( port, data ) outp( (port)+IOP_DMA_SPEED, data )
-#define AscReadChipDA0( port ) ( ushort )inpw( (port)+IOP_REG_DA0 )
-#define AscWriteChipDA0( port ) outpw( (port)+IOP_REG_DA0, data )
-#define AscReadChipDA1( port ) ( ushort )inpw( (port)+IOP_REG_DA1 )
-#define AscWriteChipDA1( port ) outpw( (port)+IOP_REG_DA1, data )
-#define AscReadChipDC0( port ) ( ushort )inpw( (port)+IOP_REG_DC0 )
-#define AscWriteChipDC0( port ) outpw( (port)+IOP_REG_DC0, data )
-#define AscReadChipDC1( port ) ( ushort )inpw( (port)+IOP_REG_DC1 )
-#define AscWriteChipDC1( port ) outpw( (port)+IOP_REG_DC1, data )
-#define AscReadChipDvcID( port ) ( uchar )inp( (port)+IOP_REG_ID )
-#define AscWriteChipDvcID( port, data ) outp( (port)+IOP_REG_ID, data )
-int AscWriteEEPCmdReg(PortAddr iop_base, uchar cmd_reg);
-int AscWriteEEPDataReg(PortAddr iop_base, ushort data_reg);
-void AscWaitEEPRead(void);
-void AscWaitEEPWrite(void);
-ushort AscReadEEPWord(PortAddr, uchar);
-ushort AscWriteEEPWord(PortAddr, uchar, ushort);
-ushort AscGetEEPConfig(PortAddr, ASCEEP_CONFIG dosfar *, ushort);
-int AscSetEEPConfigOnce(PortAddr, ASCEEP_CONFIG dosfar *, ushort);
-int AscSetEEPConfig(PortAddr, ASCEEP_CONFIG dosfar *, ushort);
-ushort AscEEPSum(PortAddr, uchar, uchar);
-int AscStartChip(PortAddr);
-int AscStopChip(PortAddr);
-void AscSetChipIH(PortAddr, ushort);
-int AscIsChipHalted(PortAddr);
-void AscResetScsiBus(PortAddr);
-int AscResetChip(PortAddr);
-void AscSetChipCfgDword(PortAddr, ulong);
-ulong AscGetChipCfgDword(PortAddr);
-void AscAckInterrupt(PortAddr);
-void AscDisableInterrupt(PortAddr);
-void AscEnableInterrupt(PortAddr);
-void AscSetBank(PortAddr, uchar);
-uchar AscGetBank(PortAddr);
-int AscResetChipAndScsiBus(PortAddr);
-ushort AscGetIsaDmaChannel(PortAddr);
-ushort AscSetIsaDmaChannel(PortAddr, ushort);
-uchar AscSetIsaDmaSpeed(PortAddr, uchar);
-uchar AscGetIsaDmaSpeed(PortAddr);
-uchar AscReadLramByte(PortAddr, ushort);
-ushort AscReadLramWord(PortAddr, ushort);
-ulong AscReadLramDWord(PortAddr, ushort);
-void AscWriteLramWord(PortAddr, ushort, ushort);
-void AscWriteLramDWord(PortAddr, ushort, ulong);
-void AscWriteLramByte(PortAddr, ushort, uchar);
-int AscVerWriteLramDWord(PortAddr, ushort, ulong);
-int AscVerWriteLramWord(PortAddr, ushort, ushort);
-int AscVerWriteLramByte(PortAddr, ushort, uchar);
-ulong AscMemSumLramWord(PortAddr, ushort, rint);
-void AscMemWordSetLram(PortAddr, ushort, ushort, rint);
-void AscMemWordCopyToLram(PortAddr, ushort, ushort dosfar *, int);
-void AscMemDWordCopyToLram(PortAddr, ushort, ulong dosfar *, int);
-void AscMemWordCopyFromLram(PortAddr, ushort, ushort dosfar *, int);
-int AscMemWordCmpToLram(PortAddr, ushort, ushort dosfar *, int);
-ushort AscInitAscDvcVar(ASC_DVC_VAR asc_ptr_type *);
-ushort AscInitFromEEP(ASC_DVC_VAR asc_ptr_type *);
-ushort AscInitWithoutEEP(ASC_DVC_VAR asc_ptr_type *);
-ushort AscInitFromAscDvcVar(ASC_DVC_VAR asc_ptr_type *);
-ushort AscInitMicroCodeVar(ASC_DVC_VAR asc_ptr_type * asc_dvc);
-void dosfar AscInitPollIsrCallBack(ASC_DVC_VAR asc_ptr_type *,
- ASC_QDONE_INFO dosfar *);
-int AscTestExternalLram(ASC_DVC_VAR asc_ptr_type *);
-ushort AscTestLramEndian(PortAddr);
-uchar AscMsgOutSDTR(ASC_DVC_VAR asc_ptr_type *, uchar, uchar);
-uchar AscCalSDTRData(ASC_DVC_VAR asc_ptr_type *, uchar, uchar);
-void AscSetChipSDTR(PortAddr, uchar, uchar);
-int AscInitChipAllSynReg(ASC_DVC_VAR asc_ptr_type *, uchar);
-uchar AscGetSynPeriodIndex(ASC_DVC_VAR asc_ptr_type *, ruchar);
-uchar AscAllocFreeQueue(PortAddr, uchar);
-uchar AscAllocMultipleFreeQueue(PortAddr, uchar, uchar);
-int AscRiscHaltedAbortSRB(ASC_DVC_VAR asc_ptr_type *, ulong);
-int AscRiscHaltedAbortTIX(ASC_DVC_VAR asc_ptr_type *, uchar);
-int AscRiscHaltedAbortALL(ASC_DVC_VAR asc_ptr_type *);
-int AscHostReqRiscHalt(PortAddr);
-int AscStopQueueExe(PortAddr);
-int AscStartQueueExe(PortAddr);
-int AscCleanUpDiscQueue(PortAddr);
-int AscCleanUpBusyQueue(PortAddr);
-int _AscAbortTidBusyQueue(ASC_DVC_VAR asc_ptr_type *,
- ASC_QDONE_INFO dosfar *, uchar);
-int _AscAbortSrbBusyQueue(ASC_DVC_VAR asc_ptr_type *,
- ASC_QDONE_INFO dosfar *, ulong);
-int AscWaitTixISRDone(ASC_DVC_VAR asc_ptr_type *, uchar);
-int AscWaitISRDone(ASC_DVC_VAR asc_ptr_type *);
-ulong AscGetOnePhyAddr(ASC_DVC_VAR asc_ptr_type *, uchar dosfar *, ulong);
-int AscSendScsiQueue(ASC_DVC_VAR asc_ptr_type * asc_dvc,
- ASC_SCSI_Q dosfar * scsiq,
- uchar n_q_required);
-int AscPutReadyQueue(ASC_DVC_VAR asc_ptr_type *, ASC_SCSI_Q dosfar *, uchar);
-int AscPutReadySgListQueue(ASC_DVC_VAR asc_ptr_type *,
- ASC_SCSI_Q dosfar *, uchar);
-int AscAbortScsiIO(ASC_DVC_VAR asc_ptr_type *, ASC_SCSI_Q dosfar *);
-void AscExeScsiIO(ASC_DVC_VAR asc_ptr_type *, ASC_SCSI_Q dosfar *);
-int AscSetChipSynRegAtID(PortAddr, uchar, uchar);
-int AscSetRunChipSynRegAtID(PortAddr, uchar, uchar);
-ushort AscInitLram(ASC_DVC_VAR asc_ptr_type *);
-int AscReInitLram(ASC_DVC_VAR asc_ptr_type *);
-ushort AscInitQLinkVar(ASC_DVC_VAR asc_ptr_type *);
-int AscSetLibErrorCode(ASC_DVC_VAR asc_ptr_type *, ushort);
-int _AscWaitQDone(PortAddr, ASC_SCSI_Q dosfar *);
-int AscEnterCritical(void);
-void AscLeaveCritical(int);
-int AscIsrChipHalted(ASC_DVC_VAR asc_ptr_type *);
-uchar _AscCopyLramScsiDoneQ(PortAddr, ushort,
- ASC_QDONE_INFO dosfar *, ulong);
-int AscIsrQDone(ASC_DVC_VAR asc_ptr_type *);
-ushort AscIsrExeBusyQueue(ASC_DVC_VAR asc_ptr_type *, uchar);
-int AscScsiSetupCmdQ(ASC_DVC_VAR asc_ptr_type *, ASC_SCSI_REQ_Q dosfar *,
- uchar dosfar *, ulong);
-int AscScsiInquiry(ASC_DVC_VAR asc_ptr_type *, ASC_SCSI_REQ_Q dosfar *,
- uchar dosfar *, int);
-int AscScsiTestUnitReady(ASC_DVC_VAR asc_ptr_type *, ASC_SCSI_REQ_Q dosfar *);
-int AscScsiStartStopUnit(ASC_DVC_VAR asc_ptr_type *,
- ASC_SCSI_REQ_Q dosfar *, uchar);
-int AscScsiReadCapacity(ASC_DVC_VAR asc_ptr_type *,
- ASC_SCSI_REQ_Q dosfar *,
- uchar dosfar *);
-ulong dosfar *swapfarbuf4(uchar dosfar *);
-int PollQueueDone(ASC_DVC_VAR asc_ptr_type *,
- ASC_SCSI_REQ_Q dosfar *,
- int);
-int PollScsiReadCapacity(ASC_DVC_VAR asc_ptr_type *,
- ASC_SCSI_REQ_Q dosfar *,
- ASC_CAP_INFO dosfar *);
-int PollScsiInquiry(ASC_DVC_VAR asc_ptr_type *, ASC_SCSI_REQ_Q dosfar *,
- uchar dosfar *, int);
-int PollScsiTestUnitReady(ASC_DVC_VAR asc_ptr_type *,
- ASC_SCSI_REQ_Q dosfar *);
-int PollScsiStartUnit(ASC_DVC_VAR asc_ptr_type *,
- ASC_SCSI_REQ_Q dosfar *);
-int InitTestUnitReady(ASC_DVC_VAR asc_ptr_type *,
- ASC_SCSI_REQ_Q dosfar *);
-void AscDispInquiry(uchar, uchar, ASC_SCSI_INQUIRY dosfar *);
-int AscPollQDone(ASC_DVC_VAR asc_ptr_type *,
- ASC_SCSI_REQ_Q dosfar *, int);
-int AscCompareString(uchar *, uchar *, int);
-int AscSetBIOSBank(PortAddr, int, ushort);
-int AscSetVlBIOSBank(PortAddr, int);
-int AscSetEisaBIOSBank(PortAddr, int);
-int AscSetIsaBIOSBank(PortAddr, int);
-ushort AscGetEisaChipCfg(PortAddr);
-ushort AscGetEisaChipGpReg(PortAddr);
-ushort AscSetEisaChipCfg(PortAddr, ushort);
-ushort AscSetEisaChipGpReg(PortAddr, ushort);
-ulong AscGetEisaProductID(PortAddr);
-PortAddr AscSearchIOPortAddrEISA(PortAddr);
-void AscClrResetScsiBus(PortAddr);
-uchar AscGetChipScsiCtrl(PortAddr);
-uchar AscSetChipScsiID(PortAddr, uchar);
-uchar AscGetChipVersion(PortAddr, ushort);
-ushort AscGetChipBusType(PortAddr);
-ulong AscLoadMicroCode(PortAddr, ushort,
- ushort dosfar *, ushort);
-int AscFindSignature(PortAddr);
-PortAddr AscSearchIOPortAddr11(PortAddr);
-PortAddr AscSearchIOPortAddr100(PortAddr);
-void AscToggleIRQAct(PortAddr);
-void AscClrResetChip(PortAddr);
-short itos(ushort, uchar dosfar *, short, short);
-int insnchar(uchar dosfar *, short, short, ruchar, short);
-void itoh(ushort, ruchar dosfar *);
-void btoh(uchar, ruchar dosfar *);
-void ltoh(ulong, ruchar dosfar *);
-uchar dosfar *todstr(ushort, uchar dosfar *);
-uchar dosfar *tohstr(ushort, uchar dosfar *);
-uchar dosfar *tobhstr(uchar, uchar dosfar *);
-uchar dosfar *tolhstr(ulong, uchar dosfar *);
-void AscSetISAPNPWaitForKey(void);
-uchar AscGetChipIRQ(PortAddr, ushort);
-uchar AscSetChipIRQ(PortAddr, uchar, ushort);
-int AscIsBiosEnabled(PortAddr, ushort);
-int AscEnableBios(PortAddr, ushort);
-ushort AscGetChipBiosAddress(PortAddr, ushort);
-ushort AscSetChipBiosAddress(PortAddr, ushort, ushort);
-void AscSingleStepChip(PortAddr);
-int AscPollQTailSync(PortAddr);
-int AscPollQHeadSync(PortAddr);
-int AscWaitQTailSync(PortAddr);
-int _AscRestoreMicroCode(PortAddr, ASC_MC_SAVED dosfar *);
-int AscSCAM(ASC_DVC_VAR asc_ptr_type *);
-ushort SwapByteOfWord(ushort word_val);
-ulong SwapWordOfDWord(ulong dword_val);
-ulong AdjEndianDword(ulong dword_val);
-int AscAdjEndianScsiQ(ASC_SCSI_Q dosfar *);
-int AscAdjEndianQDoneInfo(ASC_QDONE_INFO dosfar *);
-int AscCoalesceSgList(ASC_SCSI_Q dosfar *);
-extern int DvcEnterCritical(void);
-extern void DvcLeaveCritical(int);
-extern void DvcSetMemory(uchar dosfar *, uint, uchar);
-extern void DvcCopyMemory(uchar dosfar *, uchar dosfar *, uint);
-extern void DvcInPortWords(PortAddr, ushort dosfar *, int);
-extern void DvcOutPortWords(PortAddr, ushort dosfar *, int);
-extern void DvcOutPortDWords(PortAddr, ulong dosfar *, int);
-extern uchar DvcReadPCIConfigByte(ASC_DVC_VAR asc_ptr_type *, ushort);
-extern void DvcWritePCIConfigByte(ASC_DVC_VAR asc_ptr_type *, ushort, uchar);
-ushort AscGetChipBiosAddress(PortAddr, ushort);
-extern void DvcSleepMilliSecond(ulong);
-extern void DvcDelayNanoSecond(ASC_DVC_VAR asc_ptr_type *, ulong);
-extern void DvcDisplayString(uchar dosfar *);
-extern ulong DvcGetPhyAddr(uchar dosfar * buf_addr, ulong buf_len);
-extern ulong DvcGetSGList(ASC_DVC_VAR asc_ptr_type *, uchar dosfar *, ulong,
- ASC_SG_HEAD dosfar *);
-extern void DvcSCAMDelayMS(ulong);
-extern int DvcDisableCPUInterrupt(void);
-extern void DvcRestoreCPUInterrupt(int);
-void DvcPutScsiQ(PortAddr, ushort, ushort dosfar *, int);
-void DvcGetQinfo(PortAddr, ushort, ushort dosfar *, int);
-PortAddr AscSearchIOPortAddr(PortAddr, ushort);
-ushort AscInitGetConfig(ASC_DVC_VAR asc_ptr_type *);
-ushort AscInitSetConfig(ASC_DVC_VAR asc_ptr_type *);
-ushort AscInitAsc1000Driver(ASC_DVC_VAR asc_ptr_type *);
-int AscInitScsiTarget(ASC_DVC_VAR asc_ptr_type *,
- ASC_DVC_INQ_INFO dosfar *,
- uchar dosfar *,
- ASC_CAP_INFO_ARRAY dosfar *,
- ushort);
-int AscInitPollBegin(ASC_DVC_VAR asc_ptr_type *);
-int AscInitPollEnd(ASC_DVC_VAR asc_ptr_type *);
-int AscInitPollTarget(ASC_DVC_VAR asc_ptr_type *,
- ASC_SCSI_REQ_Q dosfar *,
- ASC_SCSI_INQUIRY dosfar *,
- ASC_CAP_INFO dosfar *);
-int AscExeScsiQueue(ASC_DVC_VAR asc_ptr_type *, ASC_SCSI_Q dosfar *);
-int AscISR(ASC_DVC_VAR asc_ptr_type *);
-void AscISR_AckInterrupt(ASC_DVC_VAR asc_ptr_type *);
-int AscISR_CheckQDone(ASC_DVC_VAR asc_ptr_type *,
- ASC_QDONE_INFO dosfar *,
- uchar dosfar *);
-int AscStartUnit(ASC_DVC_VAR asc_ptr_type *, ASC_SCSI_TIX_TYPE);
-int AscStopUnit(
- ASC_DVC_VAR asc_ptr_type * asc_dvc,
- ASC_SCSI_TIX_TYPE target_ix
-);
-uint AscGetNumOfFreeQueue(ASC_DVC_VAR asc_ptr_type *, uchar, uchar);
-int AscSgListToQueue(int);
-int AscQueueToSgList(int);
-int AscSetDvcErrorCode(ASC_DVC_VAR asc_ptr_type *, uchar);
-int AscAbortSRB(ASC_DVC_VAR asc_ptr_type *, ulong);
-int AscResetDevice(ASC_DVC_VAR asc_ptr_type *, uchar);
-int AscResetSB(ASC_DVC_VAR asc_ptr_type *);
-void AscEnableIsaDma(uchar);
-void AscDisableIsaDma(uchar);
-ulong AscGetMaxDmaAddress(ushort);
-ulong AscGetMaxDmaCount(ushort);
-int AscSaveMicroCode(ASC_DVC_VAR asc_ptr_type *, ASC_MC_SAVED dosfar *);
-int AscRestoreOldMicroCode(ASC_DVC_VAR asc_ptr_type *, ASC_MC_SAVED dosfar *);
-int AscRestoreNewMicroCode(ASC_DVC_VAR asc_ptr_type *, ASC_MC_SAVED dosfar *);
-
-/*
- * --- Debugging Header
- */
-
-#ifdef ADVANSYS_DEBUG
-#define STATIC
-#else /* ADVANSYS_DEBUG */
-#define STATIC static
-#endif /* ADVANSYS_DEBUG */
+#define AscGetQDoneInProgress(port) AscReadLramByte((port), ASCV_Q_DONE_IN_PROGRESS_B)
+#define AscPutQDoneInProgress(port, val) AscWriteLramByte((port), ASCV_Q_DONE_IN_PROGRESS_B, val)
+#define AscGetVarFreeQHead(port) AscReadLramWord((port), ASCV_FREE_Q_HEAD_W)
+#define AscGetVarDoneQTail(port) AscReadLramWord((port), ASCV_DONE_Q_TAIL_W)
+#define AscPutVarFreeQHead(port, val) AscWriteLramWord((port), ASCV_FREE_Q_HEAD_W, val)
+#define AscPutVarDoneQTail(port, val) AscWriteLramWord((port), ASCV_DONE_Q_TAIL_W, val)
+#define AscGetRiscVarFreeQHead(port) AscReadLramByte((port), ASCV_NEXTRDY_B)
+#define AscGetRiscVarDoneQTail(port) AscReadLramByte((port), ASCV_DONENEXT_B)
+#define AscPutRiscVarFreeQHead(port, val) AscWriteLramByte((port), ASCV_NEXTRDY_B, val)
+#define AscPutRiscVarDoneQTail(port, val) AscWriteLramByte((port), ASCV_DONENEXT_B, val)
+#define AscPutMCodeSDTRDoneAtID(port, id, data) AscWriteLramByte((port), (ushort)((ushort)ASCV_SDTR_DONE_BEG+(ushort)id), (data)) ;
+#define AscGetMCodeSDTRDoneAtID(port, id) AscReadLramByte((port), (ushort)((ushort)ASCV_SDTR_DONE_BEG+(ushort)id)) ;
+#define AscPutMCodeInitSDTRAtID(port, id, data) AscWriteLramByte((port), (ushort)((ushort)ASCV_SDTR_DATA_BEG+(ushort)id), data) ;
+#define AscGetMCodeInitSDTRAtID(port, id) AscReadLramByte((port), (ushort)((ushort)ASCV_SDTR_DATA_BEG+(ushort)id)) ;
+#define AscSynIndexToPeriod(index) (uchar)(asc_dvc->sdtr_period_tbl[ (index) ])
+#define AscGetChipSignatureByte(port) (uchar)inp((port)+IOP_SIG_BYTE)
+#define AscGetChipSignatureWord(port) (ushort)inpw((port)+IOP_SIG_WORD)
+#define AscGetChipVerNo(port) (uchar)inp((port)+IOP_VERSION)
+#define AscGetChipCfgLsw(port) (ushort)inpw((port)+IOP_CONFIG_LOW)
+#define AscGetChipCfgMsw(port) (ushort)inpw((port)+IOP_CONFIG_HIGH)
+#define AscSetChipCfgLsw(port, data) outpw((port)+IOP_CONFIG_LOW, data)
+#define AscSetChipCfgMsw(port, data) outpw((port)+IOP_CONFIG_HIGH, data)
+#define AscGetChipEEPCmd(port) (uchar)inp((port)+IOP_EEP_CMD)
+#define AscSetChipEEPCmd(port, data) outp((port)+IOP_EEP_CMD, data)
+#define AscGetChipEEPData(port) (ushort)inpw((port)+IOP_EEP_DATA)
+#define AscSetChipEEPData(port, data) outpw((port)+IOP_EEP_DATA, data)
+#define AscGetChipLramAddr(port) (ushort)inpw((PortAddr)((port)+IOP_RAM_ADDR))
+#define AscSetChipLramAddr(port, addr) outpw((PortAddr)((port)+IOP_RAM_ADDR), addr)
+#define AscGetChipLramData(port) (ushort)inpw((port)+IOP_RAM_DATA)
+#define AscSetChipLramData(port, data) outpw((port)+IOP_RAM_DATA, data)
+#define AscGetChipLramDataNoSwap(port) (ushort)inpw_noswap((port)+IOP_RAM_DATA)
+#define AscSetChipLramDataNoSwap(port, data) outpw_noswap((port)+IOP_RAM_DATA, data)
+#define AscGetChipIFC(port) (uchar)inp((port)+IOP_REG_IFC)
+#define AscSetChipIFC(port, data) outp((port)+IOP_REG_IFC, data)
+#define AscGetChipStatus(port) (ASC_CS_TYPE)inpw((port)+IOP_STATUS)
+#define AscSetChipStatus(port, cs_val) outpw((port)+IOP_STATUS, cs_val)
+#define AscGetChipControl(port) (uchar)inp((port)+IOP_CTRL)
+#define AscSetChipControl(port, cc_val) outp((port)+IOP_CTRL, cc_val)
+#define AscGetChipSyn(port) (uchar)inp((port)+IOP_SYN_OFFSET)
+#define AscSetChipSyn(port, data) outp((port)+IOP_SYN_OFFSET, data)
+#define AscSetPCAddr(port, data) outpw((port)+IOP_REG_PC, data)
+#define AscGetPCAddr(port) (ushort)inpw((port)+IOP_REG_PC)
+#define AscIsIntPending(port) (AscGetChipStatus(port) & (CSW_INT_PENDING | CSW_SCSI_RESET_LATCH))
+#define AscGetChipScsiID(port) ((AscGetChipCfgLsw(port) >> 8) & ASC_MAX_TID)
+#define AscGetExtraControl(port) (uchar)inp((port)+IOP_EXTRA_CONTROL)
+#define AscSetExtraControl(port, data) outp((port)+IOP_EXTRA_CONTROL, data)
+#define AscReadChipAX(port) (ushort)inpw((port)+IOP_REG_AX)
+#define AscWriteChipAX(port, data) outpw((port)+IOP_REG_AX, data)
+#define AscReadChipIX(port) (uchar)inp((port)+IOP_REG_IX)
+#define AscWriteChipIX(port, data) outp((port)+IOP_REG_IX, data)
+#define AscReadChipIH(port) (ushort)inpw((port)+IOP_REG_IH)
+#define AscWriteChipIH(port, data) outpw((port)+IOP_REG_IH, data)
+#define AscReadChipQP(port) (uchar)inp((port)+IOP_REG_QP)
+#define AscWriteChipQP(port, data) outp((port)+IOP_REG_QP, data)
+#define AscReadChipFIFO_L(port) (ushort)inpw((port)+IOP_REG_FIFO_L)
+#define AscWriteChipFIFO_L(port, data) outpw((port)+IOP_REG_FIFO_L, data)
+#define AscReadChipFIFO_H(port) (ushort)inpw((port)+IOP_REG_FIFO_H)
+#define AscWriteChipFIFO_H(port, data) outpw((port)+IOP_REG_FIFO_H, data)
+#define AscReadChipDmaSpeed(port) (uchar)inp((port)+IOP_DMA_SPEED)
+#define AscWriteChipDmaSpeed(port, data) outp((port)+IOP_DMA_SPEED, data)
+#define AscReadChipDA0(port) (ushort)inpw((port)+IOP_REG_DA0)
+#define AscWriteChipDA0(port) outpw((port)+IOP_REG_DA0, data)
+#define AscReadChipDA1(port) (ushort)inpw((port)+IOP_REG_DA1)
+#define AscWriteChipDA1(port) outpw((port)+IOP_REG_DA1, data)
+#define AscReadChipDC0(port) (ushort)inpw((port)+IOP_REG_DC0)
+#define AscWriteChipDC0(port) outpw((port)+IOP_REG_DC0, data)
+#define AscReadChipDC1(port) (ushort)inpw((port)+IOP_REG_DC1)
+#define AscWriteChipDC1(port) outpw((port)+IOP_REG_DC1, data)
+#define AscReadChipDvcID(port) (uchar)inp((port)+IOP_REG_ID)
+#define AscWriteChipDvcID(port, data) outp((port)+IOP_REG_ID, data)
+
+STATIC int AscWriteEEPCmdReg(PortAddr iop_base, uchar cmd_reg);
+STATIC int AscWriteEEPDataReg(PortAddr iop_base, ushort data_reg);
+STATIC void AscWaitEEPRead(void);
+STATIC void AscWaitEEPWrite(void);
+STATIC ushort AscReadEEPWord(PortAddr, uchar);
+STATIC ushort AscWriteEEPWord(PortAddr, uchar, ushort);
+STATIC ushort AscGetEEPConfig(PortAddr, ASCEEP_CONFIG *, ushort);
+STATIC int AscSetEEPConfigOnce(PortAddr, ASCEEP_CONFIG *, ushort);
+STATIC int AscSetEEPConfig(PortAddr, ASCEEP_CONFIG *, ushort);
+STATIC int AscStartChip(PortAddr);
+STATIC int AscStopChip(PortAddr);
+STATIC void AscSetChipIH(PortAddr, ushort);
+STATIC int AscIsChipHalted(PortAddr);
+STATIC void AscAckInterrupt(PortAddr);
+STATIC void AscDisableInterrupt(PortAddr);
+STATIC void AscEnableInterrupt(PortAddr);
+STATIC void AscSetBank(PortAddr, uchar);
+STATIC int AscResetChipAndScsiBus(PortAddr);
+STATIC ushort AscGetIsaDmaChannel(PortAddr);
+STATIC ushort AscSetIsaDmaChannel(PortAddr, ushort);
+STATIC uchar AscSetIsaDmaSpeed(PortAddr, uchar);
+STATIC uchar AscGetIsaDmaSpeed(PortAddr);
+STATIC uchar AscReadLramByte(PortAddr, ushort);
+STATIC ushort AscReadLramWord(PortAddr, ushort);
+STATIC ulong AscReadLramDWord(PortAddr, ushort);
+STATIC void AscWriteLramWord(PortAddr, ushort, ushort);
+STATIC void AscWriteLramDWord(PortAddr, ushort, ulong);
+STATIC void AscWriteLramByte(PortAddr, ushort, uchar);
+STATIC ulong AscMemSumLramWord(PortAddr, ushort, rint);
+STATIC void AscMemWordSetLram(PortAddr, ushort, ushort, rint);
+STATIC void AscMemWordCopyToLram(PortAddr, ushort, ushort *, int);
+STATIC void AscMemDWordCopyToLram(PortAddr, ushort, ulong *, int);
+STATIC void AscMemWordCopyFromLram(PortAddr, ushort, ushort *, int);
+STATIC ushort AscInitAscDvcVar(ASC_DVC_VAR asc_ptr_type *);
+STATIC ushort AscInitFromEEP(ASC_DVC_VAR asc_ptr_type *);
+STATIC ushort AscInitFromAscDvcVar(ASC_DVC_VAR asc_ptr_type *);
+STATIC ushort AscInitMicroCodeVar(ASC_DVC_VAR asc_ptr_type * asc_dvc);
+STATIC void AscInitPollIsrCallBack(ASC_DVC_VAR asc_ptr_type *,
+ ASC_QDONE_INFO *);
+STATIC int AscTestExternalLram(ASC_DVC_VAR asc_ptr_type *);
+STATIC uchar AscMsgOutSDTR(ASC_DVC_VAR asc_ptr_type *, uchar, uchar);
+STATIC uchar AscCalSDTRData(ASC_DVC_VAR asc_ptr_type *, uchar, uchar);
+STATIC void AscSetChipSDTR(PortAddr, uchar, uchar);
+STATIC uchar AscGetSynPeriodIndex(ASC_DVC_VAR asc_ptr_type *, ruchar);
+STATIC uchar AscAllocFreeQueue(PortAddr, uchar);
+STATIC uchar AscAllocMultipleFreeQueue(PortAddr, uchar, uchar);
+STATIC int AscRiscHaltedAbortSRB(ASC_DVC_VAR asc_ptr_type *, ulong);
+#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
+STATIC int AscRiscHaltedAbortTIX(ASC_DVC_VAR asc_ptr_type *, uchar);
+#endif /* version >= v1.3.89 */
+STATIC int AscHostReqRiscHalt(PortAddr);
+STATIC int AscStopQueueExe(PortAddr);
+STATIC int AscStartQueueExe(PortAddr);
+#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
+STATIC int AscCleanUpDiscQueue(PortAddr);
+#endif /* version >= v1.3.89 */
+STATIC int AscCleanUpBusyQueue(PortAddr);
+STATIC int AscWaitTixISRDone(ASC_DVC_VAR asc_ptr_type *, uchar);
+STATIC int AscWaitISRDone(ASC_DVC_VAR asc_ptr_type *);
+STATIC ulong AscGetOnePhyAddr(ASC_DVC_VAR asc_ptr_type *, uchar *,
+ ulong);
+STATIC int AscSendScsiQueue(ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ ASC_SCSI_Q * scsiq,
+ uchar n_q_required);
+STATIC int AscPutReadyQueue(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_Q *, uchar);
+STATIC int AscPutReadySgListQueue(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_Q *, uchar);
+STATIC int AscSetChipSynRegAtID(PortAddr, uchar, uchar);
+STATIC int AscSetRunChipSynRegAtID(PortAddr, uchar, uchar);
+STATIC ushort AscInitLram(ASC_DVC_VAR asc_ptr_type *);
+STATIC int AscReInitLram(ASC_DVC_VAR asc_ptr_type *);
+STATIC ushort AscInitQLinkVar(ASC_DVC_VAR asc_ptr_type *);
+STATIC int AscSetLibErrorCode(ASC_DVC_VAR asc_ptr_type *, ushort);
+#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
+STATIC int _AscWaitQDone(PortAddr, ASC_SCSI_Q *);
+#endif /* version >= v1.3.89 */
+STATIC int AscIsrChipHalted(ASC_DVC_VAR asc_ptr_type *);
+STATIC uchar _AscCopyLramScsiDoneQ(PortAddr, ushort,
+ ASC_QDONE_INFO *, ulong);
+STATIC int AscIsrQDone(ASC_DVC_VAR asc_ptr_type *);
+STATIC int AscScsiSetupCmdQ(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_REQ_Q *, uchar *, ulong);
+STATIC int AscScsiInquiry(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_REQ_Q *, uchar *, int);
+STATIC int AscScsiTestUnitReady(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_REQ_Q *);
+STATIC int AscScsiStartStopUnit(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_REQ_Q *, uchar);
+STATIC int AscScsiReadCapacity(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_REQ_Q *, uchar *);
+STATIC ulong *swapfarbuf4(uchar *);
+STATIC int PollQueueDone(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_REQ_Q *, int);
+STATIC int PollScsiReadCapacity(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_REQ_Q *, ASC_CAP_INFO *);
+STATIC int PollScsiInquiry(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_REQ_Q *, uchar *, int);
+STATIC int PollScsiTestUnitReady(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_REQ_Q *);
+STATIC int PollScsiStartUnit(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_REQ_Q *);
+STATIC int InitTestUnitReady(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_REQ_Q *);
+STATIC int AscPollQDone(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_REQ_Q *, int);
+STATIC int AscCompareString(uchar *, uchar *, int);
+STATIC ushort AscGetEisaChipCfg(PortAddr);
+STATIC ulong AscGetEisaProductID(PortAddr);
+STATIC PortAddr AscSearchIOPortAddrEISA(PortAddr);
+STATIC uchar AscGetChipScsiCtrl(PortAddr);
+STATIC uchar AscSetChipScsiID(PortAddr, uchar);
+STATIC uchar AscGetChipVersion(PortAddr, ushort);
+STATIC ushort AscGetChipBusType(PortAddr);
+STATIC ulong AscLoadMicroCode(PortAddr, ushort, ushort *, ushort);
+STATIC int AscFindSignature(PortAddr);
+STATIC PortAddr AscSearchIOPortAddr11(PortAddr);
+STATIC void AscToggleIRQAct(PortAddr);
+STATIC void AscSetISAPNPWaitForKey(void);
+STATIC uchar AscGetChipIRQ(PortAddr, ushort);
+STATIC uchar AscSetChipIRQ(PortAddr, uchar, ushort);
+STATIC ushort AscGetChipBiosAddress(PortAddr, ushort);
+STATIC int DvcEnterCritical(void);
+STATIC void DvcLeaveCritical(int);
+STATIC void DvcInPortWords(PortAddr, ushort *, int);
+STATIC void DvcOutPortWords(PortAddr, ushort *, int);
+STATIC void DvcOutPortDWords(PortAddr, ulong *, int);
+STATIC uchar DvcReadPCIConfigByte(ASC_DVC_VAR asc_ptr_type *, ushort);
+STATIC void DvcWritePCIConfigByte(ASC_DVC_VAR asc_ptr_type *,
+ ushort, uchar);
+STATIC ushort AscGetChipBiosAddress(PortAddr, ushort);
+STATIC void DvcSleepMilliSecond(ulong);
+STATIC void DvcDelayNanoSecond(ASC_DVC_VAR asc_ptr_type *, ulong);
+STATIC ulong DvcGetSGList(ASC_DVC_VAR asc_ptr_type *, uchar *,
+ ulong, ASC_SG_HEAD *);
+STATIC void DvcPutScsiQ(PortAddr, ushort, ushort *, int);
+STATIC void DvcGetQinfo(PortAddr, ushort, ushort *, int);
+STATIC PortAddr AscSearchIOPortAddr(PortAddr, ushort);
+STATIC ushort AscInitGetConfig(ASC_DVC_VAR asc_ptr_type *);
+STATIC ushort AscInitSetConfig(ASC_DVC_VAR asc_ptr_type *);
+STATIC ushort AscInitAsc1000Driver(ASC_DVC_VAR asc_ptr_type *);
+STATIC int AscInitPollBegin(ASC_DVC_VAR asc_ptr_type *);
+STATIC int AscInitPollEnd(ASC_DVC_VAR asc_ptr_type *);
+STATIC int AscInitPollTarget(ASC_DVC_VAR asc_ptr_type *,
+ ASC_SCSI_REQ_Q *, ASC_SCSI_INQUIRY *, ASC_CAP_INFO *);
+STATIC int AscExeScsiQueue(ASC_DVC_VAR asc_ptr_type *, ASC_SCSI_Q *);
+STATIC int AscISR(ASC_DVC_VAR asc_ptr_type *);
+STATIC uint AscGetNumOfFreeQueue(ASC_DVC_VAR asc_ptr_type *, uchar,
+ uchar);
+STATIC int AscSgListToQueue(int);
+STATIC int AscAbortSRB(ASC_DVC_VAR asc_ptr_type *, ulong);
+#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
+STATIC int AscResetDevice(ASC_DVC_VAR asc_ptr_type *, uchar);
+#endif /* version >= v1.3.89 */
+STATIC int AscResetSB(ASC_DVC_VAR asc_ptr_type *);
+STATIC void AscEnableIsaDma(uchar);
+STATIC ulong AscGetMaxDmaCount(ushort);
/*
@@ -2133,47 +2147,62 @@ int AscRestoreNewMicroCode(ASC_DVC_VAR asc_ptr_type *, ASC_MC_SA
*/
#define ASC_NUM_BOARD_SUPPORTED 4
-#define ASC_NUM_BUS 4
+#define ASC_NUM_BUS 4
/* Reference Scsi_Host hostdata */
#define ASC_BOARDP(host) ((asc_board_t *) &((host)->hostdata))
/* asc_board_t flags */
-#define ASC_HOST_IN_RESET 0x01
-#define ASC_HOST_IN_ABORT 0x02
+#define ASC_HOST_IN_RESET 0x01
+#define ASC_HOST_IN_ABORT 0x02
-#define NO_ISA_DMA 0xff /* No ISA DMA Channel Used */
+#define NO_ISA_DMA 0xff /* No ISA DMA Channel Used */
-#define ASC_INFO_SIZE 128 /* advansys_info() line size */
+/*
+ * If the Linux kernel version supports throwing away initialization code
+ * and data after loading, define macros for this purpose. These macros
+ * are not used when the driver is built as a module, cf. linux/init.h.
+ */
+#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(2,1,23)
+#define ASC_INITFUNC(func) __initfunc(func)
+#define ASC_INITDATA __initdata
+#define ASC_INIT __init
+#else /* version >= v2.1.23 */
+#define ASC_INITFUNC(func) func
+#define ASC_INITDATA
+#define ASC_INIT
+#endif /* version >= v2.1.23 */
+
+#define ASC_INFO_SIZE 128 /* advansys_info() line size */
/* /proc/scsi/advansys/[0...] related definitions */
-#define ASC_PRTBUF_SIZE 2048
-#define ASC_PRTLINE_SIZE 160
+#define ASC_PRTBUF_SIZE 2048
+#define ASC_PRTLINE_SIZE 160
#define ASC_PRT_NEXT() \
- if (cp) { \
- totlen += len; \
- leftlen -= len; \
- if (leftlen == 0) { \
- return totlen; \
- } \
- cp += len; \
- }
+ if (cp) { \
+ totlen += len; \
+ leftlen -= len; \
+ if (leftlen == 0) { \
+ return totlen; \
+ } \
+ cp += len; \
+ }
#define ASC_MIN(a, b) (((a) < (b)) ? (a) : (b))
/* Asc Library return codes */
-#define ASC_TRUE 1
-#define ASC_FALSE 0
-#define ASC_NOERROR 1
-#define ASC_BUSY 0
-#define ASC_ERROR (-1)
+#define ASC_TRUE 1
+#define ASC_FALSE 0
+#define ASC_NOERROR 1
+#define ASC_BUSY 0
+#define ASC_ERROR (-1)
/* Scsi_Cmnd function return codes */
-#define STATUS_BYTE(byte) (byte)
-#define MSG_BYTE(byte) ((byte) << 8)
-#define HOST_BYTE(byte) ((byte) << 16)
-#define DRIVER_BYTE(byte) ((byte) << 24)
+#define STATUS_BYTE(byte) (byte)
+#define MSG_BYTE(byte) ((byte) << 8)
+#define HOST_BYTE(byte) ((byte) << 16)
+#define DRIVER_BYTE(byte) ((byte) << 24)
/*
* The following definitions and macros are OS independent interfaces to
@@ -2186,195 +2215,194 @@ int AscRestoreNewMicroCode(ASC_DVC_VAR asc_ptr_type *, ASC_MC_SA
* REQPTIME(reqp) - reqp's time stamp value
* REQTIMESTAMP() - system time stamp value
*/
-typedef Scsi_Cmnd REQ, *REQP;
-#define REQPNEXT(reqp) ((REQP) ((reqp)->host_scribble))
-#define REQPNEXTP(reqp) ((REQP *) &((reqp)->host_scribble))
-#define REQPTID(reqp) ((reqp)->target)
-#define REQPTIME(reqp) ((reqp)->SCp.this_residual)
-#define REQTIMESTAMP() (jiffies)
+typedef Scsi_Cmnd REQ, *REQP;
+#define REQPNEXT(reqp) ((REQP) ((reqp)->host_scribble))
+#define REQPNEXTP(reqp) ((REQP *) &((reqp)->host_scribble))
+#define REQPTID(reqp) ((reqp)->target)
+#define REQPTIME(reqp) ((reqp)->SCp.this_residual)
+#define REQTIMESTAMP() (jiffies)
#define REQTIMESTAT(function, ascq, reqp, tid) \
{ \
- /*
- * If the request time stamp is less than the system time stamp, then \
- * maybe the system time stamp wrapped. Set the request time to zero.\
- */ \
- if (REQPTIME(reqp) <= REQTIMESTAMP()) { \
- REQPTIME(reqp) = REQTIMESTAMP() - REQPTIME(reqp); \
- } else { \
- /* Indicate an error occurred with the assertion. */ \
- ASC_ASSERT(REQPTIME(reqp) <= REQTIMESTAMP()); \
- REQPTIME(reqp) = 0; \
- } \
- /* Handle first minimum time case without external initialization. */ \
- if (((ascq)->q_tot_cnt[tid] == 1) || \
- (REQPTIME(reqp) < (ascq)->q_min_tim[tid])) { \
- (ascq)->q_min_tim[tid] = REQPTIME(reqp); \
- ASC_DBG3(1, "%s: new q_min_tim[%d] %u\n", \
- (function), (tid), (ascq)->q_min_tim[tid]); \
- } \
- if (REQPTIME(reqp) > (ascq)->q_max_tim[tid]) { \
- (ascq)->q_max_tim[tid] = REQPTIME(reqp); \
- ASC_DBG3(1, "%s: new q_max_tim[%d] %u\n", \
- (function), tid, (ascq)->q_max_tim[tid]); \
- } \
- (ascq)->q_tot_tim[tid] += REQPTIME(reqp); \
- /* Reset the time stamp field. */ \
- REQPTIME(reqp) = 0; \
+ /*
+ * If the request time stamp is less than the system time stamp, then \
+ * maybe the system time stamp wrapped. Set the request time to zero.\
+ */ \
+ if (REQPTIME(reqp) <= REQTIMESTAMP()) { \
+ REQPTIME(reqp) = REQTIMESTAMP() - REQPTIME(reqp); \
+ } else { \
+ /* Indicate an error occurred with the assertion. */ \
+ ASC_ASSERT(REQPTIME(reqp) <= REQTIMESTAMP()); \
+ REQPTIME(reqp) = 0; \
+ } \
+ /* Handle first minimum time case without external initialization. */ \
+ if (((ascq)->q_tot_cnt[tid] == 1) || \
+ (REQPTIME(reqp) < (ascq)->q_min_tim[tid])) { \
+ (ascq)->q_min_tim[tid] = REQPTIME(reqp); \
+ ASC_DBG3(1, "%s: new q_min_tim[%d] %u\n", \
+ (function), (tid), (ascq)->q_min_tim[tid]); \
+ } \
+ if (REQPTIME(reqp) > (ascq)->q_max_tim[tid]) { \
+ (ascq)->q_max_tim[tid] = REQPTIME(reqp); \
+ ASC_DBG3(1, "%s: new q_max_tim[%d] %u\n", \
+ (function), tid, (ascq)->q_max_tim[tid]); \
+ } \
+ (ascq)->q_tot_tim[tid] += REQPTIME(reqp); \
+ /* Reset the time stamp field. */ \
+ REQPTIME(reqp) = 0; \
}
/* asc_enqueue() flags */
-#define ASC_FRONT 1
-#define ASC_BACK 2
+#define ASC_FRONT 1
+#define ASC_BACK 2
/* asc_dequeue_list() argument */
-#define ASC_TID_ALL (-1)
+#define ASC_TID_ALL (-1)
/* Return non-zero, if the queue is empty. */
-#define ASC_QUEUE_EMPTY(ascq) ((ascq)->q_tidmask == 0)
+#define ASC_QUEUE_EMPTY(ascq) ((ascq)->q_tidmask == 0)
/* PCI configuration declarations */
-#define PCI_BASE_CLASS_PREDEFINED 0x00
-#define PCI_BASE_CLASS_MASS_STORAGE 0x01
-#define PCI_BASE_CLASS_NETWORK 0x02
-#define PCI_BASE_CLASS_DISPLAY 0x03
-#define PCI_BASE_CLASS_MULTIMEDIA 0x04
-#define PCI_BASE_CLASS_MEMORY_CONTROLLER 0x05
-#define PCI_BASE_CLASS_BRIDGE_DEVICE 0x06
+#define PCI_BASE_CLASS_PREDEFINED 0x00
+#define PCI_BASE_CLASS_MASS_STORAGE 0x01
+#define PCI_BASE_CLASS_NETWORK 0x02
+#define PCI_BASE_CLASS_DISPLAY 0x03
+#define PCI_BASE_CLASS_MULTIMEDIA 0x04
+#define PCI_BASE_CLASS_MEMORY_CONTROLLER 0x05
+#define PCI_BASE_CLASS_BRIDGE_DEVICE 0x06
/* MASS STORAGE */
-#define PCI_SUB_CLASS_SCSI_CONTROLLER 0x00
-#define PCI_SUB_CLASS_IDE_CONTROLLER 0x01
-#define PCI_SUB_CLASS_FLOPPY_DISK_CONTROLLER 0x02
-#define PCI_SUB_CLASS_IPI_BUS_CONTROLLER 0x03
-#define PCI_SUB_CLASS_OTHER_MASS_CONTROLLER 0x80
+#define PCI_SUB_CLASS_SCSI_CONTROLLER 0x00
+#define PCI_SUB_CLASS_IDE_CONTROLLER 0x01
+#define PCI_SUB_CLASS_FLOPPY_DISK_CONTROLLER 0x02
+#define PCI_SUB_CLASS_IPI_BUS_CONTROLLER 0x03
+#define PCI_SUB_CLASS_OTHER_MASS_CONTROLLER 0x80
/* NETWORK CONTROLLER */
-#define PCI_SUB_CLASS_ETHERNET_CONTROLLER 0x00
-#define PCI_SUB_CLASS_TOKEN_RING_CONTROLLER 0x01
-#define PCI_SUB_CLASS_FDDI_CONTROLLER 0x02
-#define PCI_SUB_CLASS_OTHER_NETWORK_CONTROLLER 0x80
+#define PCI_SUB_CLASS_ETHERNET_CONTROLLER 0x00
+#define PCI_SUB_CLASS_TOKEN_RING_CONTROLLER 0x01
+#define PCI_SUB_CLASS_FDDI_CONTROLLER 0x02
+#define PCI_SUB_CLASS_OTHER_NETWORK_CONTROLLER 0x80
/* DISPLAY CONTROLLER */
-#define PCI_SUB_CLASS_VGA_CONTROLLER 0x00
-#define PCI_SUB_CLASS_XGA_CONTROLLER 0x01
-#define PCI_SUB_CLASS_OTHER_DISPLAY_CONTROLLER 0x80
+#define PCI_SUB_CLASS_VGA_CONTROLLER 0x00
+#define PCI_SUB_CLASS_XGA_CONTROLLER 0x01
+#define PCI_SUB_CLASS_OTHER_DISPLAY_CONTROLLER 0x80
/* MULTIMEDIA CONTROLLER */
-#define PCI_SUB_CLASS_VIDEO_DEVICE 0x00
-#define PCI_SUB_CLASS_AUDIO_DEVICE 0x01
-#define PCI_SUB_CLASS_OTHER_MULTIMEDIA_DEVICE 0x80
+#define PCI_SUB_CLASS_VIDEO_DEVICE 0x00
+#define PCI_SUB_CLASS_AUDIO_DEVICE 0x01
+#define PCI_SUB_CLASS_OTHER_MULTIMEDIA_DEVICE 0x80
/* MEMORY CONTROLLER */
-#define PCI_SUB_CLASS_RAM_CONTROLLER 0x00
-#define PCI_SUB_CLASS_FLASH_CONTROLLER 0x01
-#define PCI_SUB_CLASS_OTHER_MEMORY_CONTROLLER 0x80
+#define PCI_SUB_CLASS_RAM_CONTROLLER 0x00
+#define PCI_SUB_CLASS_FLASH_CONTROLLER 0x01
+#define PCI_SUB_CLASS_OTHER_MEMORY_CONTROLLER 0x80
/* BRIDGE CONTROLLER */
-#define PCI_SUB_CLASS_HOST_BRIDGE_CONTROLLER 0x00
-#define PCI_SUB_CLASS_ISA_BRIDGE_CONTROLLER 0x01
-#define PCI_SUB_CLASS_EISA_BRIDGE_CONTROLLER 0x02
-#define PCI_SUB_CLASS_MC_BRIDGE_CONTROLLER 0x03
-#define PCI_SUB_CLASS_PCI_TO_PCI_BRIDGE_CONTROLLER 0x04
-#define PCI_SUB_CLASS_PCMCIA_BRIDGE_CONTROLLER 0x05
-#define PCI_SUB_CLASS_OTHER_BRIDGE_CONTROLLER 0x80
-
-#define PCI_MAX_SLOT 0x1F
-#define PCI_MAX_BUS 0xFF
-#define PCI_IOADDRESS_MASK 0xFFFE
-#define ASC_PCI_VENDORID 0x10CD
-#define ASC_PCI_DEVICE_ID_1100 0x1100
-#define ASC_PCI_DEVICE_ID_1200 0x1200
-#define ASC_PCI_DEVICE_ID_1300 0x1300
+#define PCI_SUB_CLASS_HOST_BRIDGE_CONTROLLER 0x00
+#define PCI_SUB_CLASS_ISA_BRIDGE_CONTROLLER 0x01
+#define PCI_SUB_CLASS_EISA_BRIDGE_CONTROLLER 0x02
+#define PCI_SUB_CLASS_MC_BRIDGE_CONTROLLER 0x03
+#define PCI_SUB_CLASS_PCI_TO_PCI_BRIDGE_CONTROLLER 0x04
+#define PCI_SUB_CLASS_PCMCIA_BRIDGE_CONTROLLER 0x05
+#define PCI_SUB_CLASS_OTHER_BRIDGE_CONTROLLER 0x80
+
+#define PCI_MAX_SLOT 0x1F
+#define PCI_MAX_BUS 0xFF
+#define PCI_IOADDRESS_MASK 0xFFFE
+#define ASC_PCI_VENDORID 0x10CD
+#define ASC_PCI_DEVICE_ID_1100 0x1100
+#define ASC_PCI_DEVICE_ID_1200 0x1200
+#define ASC_PCI_DEVICE_ID_1300 0x1300
/* PCI IO Port Addresses to generate special cycle */
-#define PCI_CONFIG_ADDRESS_MECH1 0x0CF8
-#define PCI_CONFIG_DATA_MECH1 0x0CFC
+#define PCI_CONFIG_ADDRESS_MECH1 0x0CF8
+#define PCI_CONFIG_DATA_MECH1 0x0CFC
-#define PCI_CONFIG_FORWARD_REGISTER 0x0CFA /* 0=type 0; 1=type 1; */
+#define PCI_CONFIG_FORWARD_REGISTER 0x0CFA /* 0=type 0; 1=type 1; */
-#define PCI_CONFIG_BUS_NUMBER_MASK 0x00FF0000
-#define PCI_CONFIG_DEVICE_FUNCTION_MASK 0x0000FF00
-#define PCI_CONFIG_REGISTER_NUMBER_MASK 0x000000F8
+#define PCI_CONFIG_BUS_NUMBER_MASK 0x00FF0000
+#define PCI_CONFIG_DEVICE_FUNCTION_MASK 0x0000FF00
+#define PCI_CONFIG_REGISTER_NUMBER_MASK 0x000000F8
-#define PCI_DEVICE_FOUND 0x0000
-#define PCI_DEVICE_NOT_FOUND 0xffff
+#define PCI_DEVICE_FOUND 0x0000
+#define PCI_DEVICE_NOT_FOUND 0xffff
-#define SUBCLASS_OFFSET 0x0A
-#define CLASSCODE_OFFSET 0x0B
-#define VENDORID_OFFSET 0x00
-#define DEVICEID_OFFSET 0x02
+#define SUBCLASS_OFFSET 0x0A
+#define CLASSCODE_OFFSET 0x0B
+#define VENDORID_OFFSET 0x00
+#define DEVICEID_OFFSET 0x02
#ifndef ADVANSYS_STATS
#define ASC_STATS(shp, counter)
#define ASC_STATS_ADD(shp, counter, count)
#else /* ADVANSYS_STATS */
#define ASC_STATS(shp, counter) \
- (ASC_BOARDP(shp)->asc_stats.counter++)
+ (ASC_BOARDP(shp)->asc_stats.counter++)
#define ASC_STATS_ADD(shp, counter, count) \
- (ASC_BOARDP(shp)->asc_stats.counter += (count))
+ (ASC_BOARDP(shp)->asc_stats.counter += (count))
#endif /* ADVANSYS_STATS */
#define ASC_CEILING(val, unit) (((val) + ((unit) - 1))/(unit))
/* If the result wraps when calculating tenths, return 0. */
#define ASC_TENTHS(num, den) \
- (((10 * ((num)/(den))) > (((num) * 10)/(den))) ? \
- 0 : ((((num) * 10)/(den)) - (10 * ((num)/(den)))))
+ (((10 * ((num)/(den))) > (((num) * 10)/(den))) ? \
+ 0 : ((((num) * 10)/(den)) - (10 * ((num)/(den)))))
/*
* Display a message to the console.
*/
#define ASC_PRINT(s) \
- { \
- printk("advansys: "); \
- printk(s); \
- }
+ { \
+ printk("advansys: "); \
+ printk(s); \
+ }
#define ASC_PRINT1(s, a1) \
- { \
- printk("advansys: "); \
- printk((s), (a1)); \
- }
+ { \
+ printk("advansys: "); \
+ printk((s), (a1)); \
+ }
#define ASC_PRINT2(s, a1, a2) \
- { \
- printk("advansys: "); \
- printk((s), (a1), (a2)); \
- }
+ { \
+ printk("advansys: "); \
+ printk((s), (a1), (a2)); \
+ }
#define ASC_PRINT3(s, a1, a2, a3) \
- { \
- printk("advansys: "); \
- printk((s), (a1), (a2), (a3)); \
- }
+ { \
+ printk("advansys: "); \
+ printk((s), (a1), (a2), (a3)); \
+ }
#define ASC_PRINT4(s, a1, a2, a3, a4) \
- { \
- printk("advansys: "); \
- printk((s), (a1), (a2), (a3), (a4)); \
- }
+ { \
+ printk("advansys: "); \
+ printk((s), (a1), (a2), (a3), (a4)); \
+ }
#ifndef ADVANSYS_DEBUG
-#define ASC_DBG(lvl, s)
-#define ASC_DBG1(lvl, s, a1)
-#define ASC_DBG2(lvl, s, a1, a2)
-#define ASC_DBG3(lvl, s, a1, a2, a3)
-#define ASC_DBG4(lvl, s, a1, a2, a3, a4)
-#define ASC_DBG_PRT_SCSI_HOST(lvl, s)
-#define ASC_DBG_PRT_SCSI_CMND(lvl, s)
-#define ASC_DBG_PRT_SCSI_Q(lvl, scsiqp)
-#define ASC_DBG_PRT_QDONE_INFO(lvl, qdone)
-#define ASC_DBG_PRT_HEX(lvl, name, start, length)
-#define ASC_DBG_PRT_CDB(lvl, cdb, len)
-#define ASC_DBG_PRT_SENSE(lvl, sense, len)
+#define ASC_DBG(lvl, s)
+#define ASC_DBG1(lvl, s, a1)
+#define ASC_DBG2(lvl, s, a1, a2)
+#define ASC_DBG3(lvl, s, a1, a2, a3)
+#define ASC_DBG4(lvl, s, a1, a2, a3, a4)
+#define ASC_DBG_PRT_SCSI_HOST(lvl, s)
+#define ASC_DBG_PRT_SCSI_CMND(lvl, s)
+#define ASC_DBG_PRT_SCSI_Q(lvl, scsiqp)
+#define ASC_DBG_PRT_QDONE_INFO(lvl, qdone)
+#define ASC_DBG_PRT_HEX(lvl, name, start, length)
+#define ASC_DBG_PRT_CDB(lvl, cdb, len)
+#define ASC_DBG_PRT_SENSE(lvl, sense, len)
#define ASC_DBG_PRT_INQUIRY(lvl, inq, len)
-#define ASC_ASSERT(a)
#else /* ADVANSYS_DEBUG */
@@ -2385,93 +2413,99 @@ typedef Scsi_Cmnd REQ, *REQP;
* 2-N: Verbose Tracing
*/
-#define ASC_DBG(lvl, s) \
- { \
- if (asc_dbglvl >= (lvl)) { \
- printk(s); \
- } \
- }
-
-#define ASC_DBG1(lvl, s, a1) \
- { \
- if (asc_dbglvl >= (lvl)) { \
- printk((s), (a1)); \
- } \
- }
-
-#define ASC_DBG2(lvl, s, a1, a2) \
- { \
- if (asc_dbglvl >= (lvl)) { \
- printk((s), (a1), (a2)); \
- } \
- }
-
-#define ASC_DBG3(lvl, s, a1, a2, a3) \
- { \
- if (asc_dbglvl >= (lvl)) { \
- printk((s), (a1), (a2), (a3)); \
- } \
- }
-
-#define ASC_DBG4(lvl, s, a1, a2, a3, a4) \
- { \
- if (asc_dbglvl >= (lvl)) { \
- printk((s), (a1), (a2), (a3), (a4)); \
- } \
- }
-
-#define ASC_DBG_PRT_SCSI_HOST(lvl, s) \
- { \
- if (asc_dbglvl >= (lvl)) { \
- asc_prt_scsi_host(s); \
- } \
- }
-
-#define ASC_DBG_PRT_SCSI_CMND(lvl, s) \
- { \
- if (asc_dbglvl >= (lvl)) { \
- asc_prt_scsi_cmnd(s); \
- } \
- }
-
-#define ASC_DBG_PRT_SCSI_Q(lvl, scsiqp) \
- { \
- if (asc_dbglvl >= (lvl)) { \
- asc_prt_scsi_q(scsiqp); \
- } \
- }
-
-#define ASC_DBG_PRT_QDONE_INFO(lvl, qdone) \
- { \
- if (asc_dbglvl >= (lvl)) { \
- asc_prt_qdone_info(qdone); \
- } \
- }
-
-#define ASC_DBG_PRT_HEX(lvl, name, start, length) \
- { \
- if (asc_dbglvl >= (lvl)) { \
- asc_prt_hex((name), (start), (length)); \
- } \
- }
-
-#define ASC_DBG_PRT_CDB(lvl, cdb, len) \
- ASC_DBG_PRT_HEX((lvl), "CDB", (uchar *) (cdb), (len));
-
-#define ASC_DBG_PRT_SENSE(lvl, sense, len) \
- ASC_DBG_PRT_HEX((lvl), "SENSE", (uchar *) (sense), (len));
+#define ASC_DBG(lvl, s) \
+ { \
+ if (asc_dbglvl >= (lvl)) { \
+ printk(s); \
+ } \
+ }
+
+#define ASC_DBG1(lvl, s, a1) \
+ { \
+ if (asc_dbglvl >= (lvl)) { \
+ printk((s), (a1)); \
+ } \
+ }
+
+#define ASC_DBG2(lvl, s, a1, a2) \
+ { \
+ if (asc_dbglvl >= (lvl)) { \
+ printk((s), (a1), (a2)); \
+ } \
+ }
+
+#define ASC_DBG3(lvl, s, a1, a2, a3) \
+ { \
+ if (asc_dbglvl >= (lvl)) { \
+ printk((s), (a1), (a2), (a3)); \
+ } \
+ }
+
+#define ASC_DBG4(lvl, s, a1, a2, a3, a4) \
+ { \
+ if (asc_dbglvl >= (lvl)) { \
+ printk((s), (a1), (a2), (a3), (a4)); \
+ } \
+ }
+
+#define ASC_DBG_PRT_SCSI_HOST(lvl, s) \
+ { \
+ if (asc_dbglvl >= (lvl)) { \
+ asc_prt_scsi_host(s); \
+ } \
+ }
+
+#define ASC_DBG_PRT_SCSI_CMND(lvl, s) \
+ { \
+ if (asc_dbglvl >= (lvl)) { \
+ asc_prt_scsi_cmnd(s); \
+ } \
+ }
+
+#define ASC_DBG_PRT_SCSI_Q(lvl, scsiqp) \
+ { \
+ if (asc_dbglvl >= (lvl)) { \
+ asc_prt_scsi_q(scsiqp); \
+ } \
+ }
+
+#define ASC_DBG_PRT_QDONE_INFO(lvl, qdone) \
+ { \
+ if (asc_dbglvl >= (lvl)) { \
+ asc_prt_qdone_info(qdone); \
+ } \
+ }
+
+#define ASC_DBG_PRT_HEX(lvl, name, start, length) \
+ { \
+ if (asc_dbglvl >= (lvl)) { \
+ asc_prt_hex((name), (start), (length)); \
+ } \
+ }
+
+#define ASC_DBG_PRT_CDB(lvl, cdb, len) \
+ ASC_DBG_PRT_HEX((lvl), "CDB", (uchar *) (cdb), (len));
+
+#define ASC_DBG_PRT_SENSE(lvl, sense, len) \
+ ASC_DBG_PRT_HEX((lvl), "SENSE", (uchar *) (sense), (len));
#define ASC_DBG_PRT_INQUIRY(lvl, inq, len) \
- ASC_DBG_PRT_HEX((lvl), "INQUIRY", (uchar *) (inq), (len));
+ ASC_DBG_PRT_HEX((lvl), "INQUIRY", (uchar *) (inq), (len));
+#endif /* ADVANSYS_DEBUG */
+
+#ifndef ADVANSYS_ASSERT
+#define ASC_ASSERT(a)
+#else /* ADVANSYS_ASSERT */
#define ASC_ASSERT(a) \
- { \
- if (!(a)) { \
- printk("ASC_ASSERT() Failure: file %s, line %d\n", \
- __FILE__, __LINE__); \
- } \
- }
-#endif /* ADVANSYS_DEBUG */
+ { \
+ if (!(a)) { \
+ printk("ASC_ASSERT() Failure: file %s, line %d\n", \
+ __FILE__, __LINE__); \
+ } \
+ }
+
+#endif /* ADVANSYS_ASSERT */
/*
@@ -2482,27 +2516,27 @@ typedef Scsi_Cmnd REQ, *REQP;
/* Per board statistics structure */
struct asc_stats {
- /* Driver Entrypoint Statistics */
- ulong command; /* # calls to advansys_command() */
- ulong queuecommand; /* # calls to advansys_queuecommand() */
- ulong abort; /* # calls to advansys_abort() */
- ulong reset; /* # calls to advansys_reset() */
- ulong biosparam; /* # calls to advansys_biosparam() */
- ulong check_interrupt;/* # advansys_interrupt() check pending calls */
- ulong interrupt; /* # advansys_interrupt() interrupts */
- ulong callback; /* # calls asc_isr_callback() */
- ulong done; /* # calls request scsi_done */
- /* AscExeScsiQueue() Statistics */
- ulong asc_noerror; /* # AscExeScsiQueue() ASC_NOERROR returns. */
- ulong asc_busy; /* # AscExeScsiQueue() ASC_BUSY returns. */
- ulong asc_error; /* # AscExeScsiQueue() ASC_ERROR returns. */
- ulong asc_unknown; /* # AscExeScsiQueue() unknown returns. */
- /* Data Transfer Statistics */
- ulong cont_cnt; /* # non-scatter-gather I/O requests received */
- ulong cont_xfer; /* # contiguous transfer 512-bytes */
- ulong sg_cnt; /* # scatter-gather I/O requests received */
- ulong sg_elem; /* # scatter-gather elements */
- ulong sg_xfer; /* # scatter-gather transfer 512-bytes */
+ /* Driver Entrypoint Statistics */
+ ulong command; /* # calls to advansys_command() */
+ ulong queuecommand; /* # calls to advansys_queuecommand() */
+ ulong abort; /* # calls to advansys_abort() */
+ ulong reset; /* # calls to advansys_reset() */
+ ulong biosparam; /* # calls to advansys_biosparam() */
+ ulong check_interrupt; /* # advansys_interrupt() check pending calls */
+ ulong interrupt; /* # advansys_interrupt() interrupts */
+ ulong callback; /* # calls asc_isr_callback() */
+ ulong done; /* # calls request scsi_done */
+ /* AscExeScsiQueue() Statistics */
+ ulong asc_noerror; /* # AscExeScsiQueue() ASC_NOERROR returns. */
+ ulong asc_busy; /* # AscExeScsiQueue() ASC_BUSY returns. */
+ ulong asc_error; /* # AscExeScsiQueue() ASC_ERROR returns. */
+ ulong asc_unknown; /* # AscExeScsiQueue() unknown returns. */
+ /* Data Transfer Statistics */
+ ulong cont_cnt; /* # non-scatter-gather I/O requests received */
+ ulong cont_xfer; /* # contiguous transfer 512-bytes */
+ ulong sg_cnt; /* # scatter-gather I/O requests received */
+ ulong sg_elem; /* # scatter-gather elements */
+ ulong sg_xfer; /* # scatter-gather transfer 512-bytes */
};
#endif /* ADVANSYS_STATS */
@@ -2510,16 +2544,16 @@ struct asc_stats {
* Request queuing structure
*/
typedef struct asc_queue {
- ASC_SCSI_BIT_ID_TYPE q_tidmask; /* queue mask */
- REQP q_first[ASC_MAX_TID+1]; /* first queued request */
- REQP q_last[ASC_MAX_TID+1]; /* last queued request */
+ ASC_SCSI_BIT_ID_TYPE q_tidmask; /* queue mask */
+ REQP q_first[ASC_MAX_TID+1]; /* first queued request */
+ REQP q_last[ASC_MAX_TID+1]; /* last queued request */
#ifdef ADVANSYS_STATS
- short q_cur_cnt[ASC_MAX_TID+1]; /* current queue count */
- short q_max_cnt[ASC_MAX_TID+1]; /* maximum queue count */
- ulong q_tot_cnt[ASC_MAX_TID+1]; /* total enqueue count */
- ulong q_tot_tim[ASC_MAX_TID+1]; /* total time queued */
- ushort q_max_tim[ASC_MAX_TID+1]; /* maximum time queued */
- ushort q_min_tim[ASC_MAX_TID+1]; /* minimum time queued */
+ short q_cur_cnt[ASC_MAX_TID+1]; /* current queue count */
+ short q_max_cnt[ASC_MAX_TID+1]; /* maximum queue count */
+ ulong q_tot_cnt[ASC_MAX_TID+1]; /* total enqueue count */
+ ulong q_tot_tim[ASC_MAX_TID+1]; /* total time queued */
+ ushort q_max_tim[ASC_MAX_TID+1]; /* maximum time queued */
+ ushort q_min_tim[ASC_MAX_TID+1]; /* minimum time queued */
#endif /* ADVANSYS_STATS */
} asc_queue_t;
@@ -2531,33 +2565,34 @@ typedef struct asc_queue {
* field. It is guaranteed to be allocated from DMA-able memory.
*/
typedef struct asc_board {
- int id; /* Board Id */
- uint flags; /* Board flags */
- ASC_DVC_VAR asc_dvc_var; /* Board configuration */
- ASC_DVC_CFG asc_dvc_cfg; /* Device configuration */
- asc_queue_t active; /* Active command queue */
- asc_queue_t waiting; /* Waiting command queue */
- asc_queue_t done; /* Done command queue */
- ASC_SCSI_BIT_ID_TYPE init_tidmask; /* Target initialized mask */
- /* The following three structures must be in DMA-able memory. */
- ASC_SCSI_REQ_Q scsireqq;
- ASC_CAP_INFO cap_info;
- ASC_SCSI_INQUIRY inquiry;
- Scsi_Device *device[ASC_MAX_TID+1]; /* Mid-Level Scsi Device */
- ushort reqcnt[ASC_MAX_TID+1]; /* Starvation request count */
+ int id; /* Board Id */
+ uint flags; /* Board flags */
+ ASC_DVC_VAR asc_dvc_var; /* Board configuration */
+ ASC_DVC_CFG asc_dvc_cfg; /* Device configuration */
+ asc_queue_t active; /* Active command queue */
+ asc_queue_t waiting; /* Waiting command queue */
+ asc_queue_t done; /* Done command queue */
+ ASC_SCSI_BIT_ID_TYPE init_tidmask; /* Target initialized mask */
+ /* The following three structures must be in DMA-able memory. */
+ ASC_SCSI_REQ_Q scsireqq;
+ ASC_CAP_INFO cap_info;
+ ASC_SCSI_INQUIRY inquiry;
+ Scsi_Device *device[ASC_MAX_TID+1]; /* Mid-Level Scsi Device */
+ ushort reqcnt[ASC_MAX_TID+1]; /* Starvation request count */
+ uchar sdtr_data[ASC_MAX_TID+1]; /* SDTR information */
#if ASC_QUEUE_FLOW_CONTROL
- ushort nerrcnt[ASC_MAX_TID+1]; /* No error request count */
+ ushort nerrcnt[ASC_MAX_TID+1]; /* No error request count */
#endif /* ASC_QUEUE_FLOW_CONTROL */
- ASC_SCSI_BIT_ID_TYPE queue_full; /* Queue full mask */
- ushort queue_full_cnt[ASC_MAX_TID+1]; /* Queue full count */
- ASCEEP_CONFIG eep_config; /* EEPROM configuration */
- ulong last_reset; /* Saved time of last reset */
+ ASC_SCSI_BIT_ID_TYPE queue_full; /* Queue full mask */
+ ushort queue_full_cnt[ASC_MAX_TID+1]; /* Queue full count */
+ ASCEEP_CONFIG eep_config; /* EEPROM configuration */
+ ulong last_reset; /* Saved last reset time */
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
- /* /proc/scsi/advansys/[0...] */
- char *prtbuf; /* Statistics Print Buffer */
+ /* /proc/scsi/advansys/[0...] */
+ char *prtbuf; /* Statistics Print Buffer */
#endif /* version >= v1.3.0 */
#ifdef ADVANSYS_STATS
- struct asc_stats asc_stats; /* Board statistics */
+ struct asc_stats asc_stats; /* Board statistics */
#endif /* ADVANSYS_STATS */
} asc_board_t;
@@ -2566,48 +2601,48 @@ typedef struct asc_board {
*/
typedef struct _PCI_DATA_
{
- uchar type;
- uchar bus;
- uchar slot;
- uchar func;
- uchar offset;
+ uchar type;
+ uchar bus;
+ uchar slot;
+ uchar func;
+ uchar offset;
} PCI_DATA;
typedef struct _PCI_DEVICE_
{
- ushort vendorID;
- ushort deviceID;
- ushort slotNumber;
- ushort slotFound;
- uchar busNumber;
- uchar maxBusNumber;
- uchar devFunc;
- ushort startSlot;
- ushort endSlot;
- uchar bridge;
- uchar type;
+ ushort vendorID;
+ ushort deviceID;
+ ushort slotNumber;
+ ushort slotFound;
+ uchar busNumber;
+ uchar maxBusNumber;
+ uchar devFunc;
+ ushort startSlot;
+ ushort endSlot;
+ uchar bridge;
+ uchar type;
} PCI_DEVICE;
typedef struct _PCI_CONFIG_SPACE_
{
- ushort vendorID;
- ushort deviceID;
- ushort command;
- ushort status;
- uchar revision;
- uchar classCode[3];
- uchar cacheSize;
- uchar latencyTimer;
- uchar headerType;
- uchar bist;
- ulong baseAddress[6];
- ushort reserved[4];
- ulong optionRomAddr;
- ushort reserved2[4];
- uchar irqLine;
- uchar irqPin;
- uchar minGnt;
- uchar maxLatency;
+ ushort vendorID;
+ ushort deviceID;
+ ushort command;
+ ushort status;
+ uchar revision;
+ uchar classCode[3];
+ uchar cacheSize;
+ uchar latencyTimer;
+ uchar headerType;
+ uchar bist;
+ ulong baseAddress[6];
+ ushort reserved[4];
+ ulong optionRomAddr;
+ ushort reserved2[4];
+ uchar irqLine;
+ uchar irqPin;
+ uchar minGnt;
+ uchar maxLatency;
} PCI_CONFIG_SPACE;
@@ -2620,17 +2655,17 @@ typedef struct _PCI_CONFIG_SPACE_
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
struct proc_dir_entry proc_scsi_advansys =
{
- PROC_SCSI_ADVANSYS, /* unsigned short low_ino */
- 8, /* unsigned short namelen */
- "advansys", /* const char *name */
- S_IFDIR | S_IRUGO | S_IXUGO, /* mode_t mode */
- 2 /* nlink_t nlink */
+ PROC_SCSI_ADVANSYS, /* unsigned short low_ino */
+ 8, /* unsigned short namelen */
+ "advansys", /* const char *name */
+ S_IFDIR | S_IRUGO | S_IXUGO, /* mode_t mode */
+ 2 /* nlink_t nlink */
};
#endif /* version >= v1.3.0 */
/* Number of boards detected in system. */
STATIC int asc_board_count = 0;
-STATIC struct Scsi_Host *asc_host[ASC_NUM_BOARD_SUPPORTED] = { 0 };
+STATIC struct Scsi_Host *asc_host[ASC_NUM_BOARD_SUPPORTED] = { 0 };
/* Overrun buffer shared between all boards. */
STATIC uchar overrun_buf[ASC_OVERRUN_BSIZE] = { 0 };
@@ -2642,34 +2677,37 @@ STATIC ASC_SCSI_Q asc_scsi_q = { { 0 } };
STATIC ASC_SG_HEAD asc_sg_head = { 0 };
/* List of supported bus types. */
-STATIC ushort asc_bus[ASC_NUM_BUS] = {
- ASC_IS_ISA,
- ASC_IS_VL,
- ASC_IS_EISA,
- ASC_IS_PCI,
+STATIC ushort asc_bus[ASC_NUM_BUS] ASC_INITDATA = {
+ ASC_IS_ISA,
+ ASC_IS_VL,
+ ASC_IS_EISA,
+ ASC_IS_PCI,
};
-STATIC int pci_scan_method = -1;
+STATIC int pci_scan_method ASC_INITDATA = -1;
/*
* Used with the LILO 'advansys' option to eliminate or
* limit I/O port probing at boot time, cf. advansys_setup().
*/
-int asc_iopflag = ASC_FALSE;
-int asc_ioport[ASC_NUM_BOARD_SUPPORTED] = { 0, 0, 0, 0 };
+STATIC int asc_iopflag = ASC_FALSE;
+STATIC int asc_ioport[ASC_NUM_BOARD_SUPPORTED] = { 0, 0, 0, 0 };
#ifdef ADVANSYS_DEBUG
-char *
+STATIC char *
asc_bus_name[ASC_NUM_BUS] = {
- "ASC_IS_ISA",
- "ASC_IS_VL",
- "ASC_IS_EISA",
- "ASC_IS_PCI",
+ "ASC_IS_ISA",
+ "ASC_IS_VL",
+ "ASC_IS_EISA",
+ "ASC_IS_PCI",
};
-int asc_dbglvl = 0;
+STATIC int asc_dbglvl = 0;
#endif /* ADVANSYS_DEBUG */
+/* Declaration for Asc Library internal data referenced by driver. */
+STATIC PortAddr _asc_def_iop_base[];
+
/*
* --- Driver Function Prototypes
@@ -2678,60 +2716,65 @@ int asc_dbglvl = 0;
*/
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
-STATIC int asc_proc_copy(off_t, off_t, char *, int , char *, int);
+STATIC int asc_proc_copy(off_t, off_t, char *, int , char *, int);
#endif /* version >= v1.3.0 */
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(1,3,70)
-STATIC void advansys_interrupt(int, struct pt_regs *);
+STATIC void advansys_interrupt(int, struct pt_regs *);
#else /* version >= v1.3.70 */
-STATIC void advansys_interrupt(int, void *, struct pt_regs *);
+STATIC void advansys_interrupt(int, void *, struct pt_regs *);
#endif /* version >= v1.3.70 */
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
-STATIC void advansys_select_queue_depths(struct Scsi_Host *,
- Scsi_Device *);
+STATIC void advansys_select_queue_depths(struct Scsi_Host *,
+ Scsi_Device *);
#endif /* version >= v1.3.89 */
-STATIC void advansys_command_done(Scsi_Cmnd *);
-STATIC void asc_scsi_done_list(Scsi_Cmnd *);
-STATIC int asc_execute_scsi_cmnd(Scsi_Cmnd *);
-STATIC void asc_isr_callback(ASC_DVC_VAR *, ASC_QDONE_INFO *);
-STATIC int asc_init_dev(ASC_DVC_VAR *, Scsi_Cmnd *);
-STATIC int asc_srch_pci_dev(PCI_DEVICE *);
-STATIC uchar asc_scan_method(void);
-STATIC int asc_pci_find_dev(PCI_DEVICE *);
-STATIC void asc_get_pci_cfg(PCI_DEVICE *, PCI_CONFIG_SPACE *);
-STATIC ushort asc_get_cfg_word(PCI_DATA *);
-STATIC uchar asc_get_cfg_byte(PCI_DATA *);
-STATIC void asc_put_cfg_byte(PCI_DATA *, uchar);
-void asc_enqueue(asc_queue_t *, REQP, int);
-REQP asc_dequeue(asc_queue_t *, int);
-REQP asc_dequeue_list(asc_queue_t *, REQP *, int);
-int asc_rmqueue(asc_queue_t *, REQP);
-int asc_isqueued(asc_queue_t *, REQP);
-void asc_execute_queue(asc_queue_t *);
-STATIC int asc_prt_board_devices(struct Scsi_Host *, char *, int);
-STATIC int asc_prt_board_eeprom(struct Scsi_Host *, char *, int);
-STATIC int asc_prt_driver_conf(struct Scsi_Host *, char *, int);
-STATIC int asc_prt_board_info(struct Scsi_Host *, char *, int);
-STATIC int asc_proc_copy(off_t, off_t, char *, int , char *, int);
-STATIC int asc_prt_line(char *, int, char *fmt, ...);
-
-/* XXX - Asc Library Routines not supposed to be used directly */
-int AscFindSignature(PortAddr);
-ushort AscGetEEPConfig(PortAddr, ASCEEP_CONFIG *, ushort);
+STATIC void advansys_command_done(Scsi_Cmnd *);
+STATIC void asc_scsi_done_list(Scsi_Cmnd *);
+STATIC int asc_execute_scsi_cmnd(Scsi_Cmnd *);
+STATIC void asc_isr_callback(ASC_DVC_VAR *, ASC_QDONE_INFO *);
+STATIC int asc_init_dev(ASC_DVC_VAR *, Scsi_Cmnd *);
+STATIC int asc_srch_pci_dev(PCI_DEVICE *);
+STATIC uchar asc_scan_method(void);
+STATIC int asc_pci_find_dev(PCI_DEVICE *);
+STATIC void asc_get_pci_cfg(PCI_DEVICE *, PCI_CONFIG_SPACE *);
+STATIC ushort asc_get_cfg_word(PCI_DATA *);
+STATIC uchar asc_get_cfg_byte(PCI_DATA *);
+STATIC void asc_put_cfg_byte(PCI_DATA *, uchar);
+STATIC void asc_enqueue(asc_queue_t *, REQP, int);
+STATIC REQP asc_dequeue(asc_queue_t *, int);
+STATIC REQP asc_dequeue_list(asc_queue_t *, REQP *, int);
+STATIC int asc_rmqueue(asc_queue_t *, REQP);
+STATIC int asc_isqueued(asc_queue_t *, REQP);
+STATIC void asc_execute_queue(asc_queue_t *);
+#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
+STATIC int asc_prt_board_devices(struct Scsi_Host *, char *, int);
+STATIC int asc_prt_board_eeprom(struct Scsi_Host *, char *, int);
+STATIC int asc_prt_driver_conf(struct Scsi_Host *, char *, int);
+STATIC int asc_prt_board_info(struct Scsi_Host *, char *, int);
+STATIC int asc_prt_line(char *, int, char *fmt, ...);
+#endif /* version >= v1.3.0 */
+
+/* Declaration for Asc Library internal functions reference by driver. */
+STATIC int AscFindSignature(PortAddr);
+STATIC ushort AscGetEEPConfig(PortAddr, ASCEEP_CONFIG *, ushort);
#ifdef ADVANSYS_STATS
-STATIC int asc_prt_board_stats(struct Scsi_Host *, char *, int);
+STATIC int asc_prt_board_stats(struct Scsi_Host *, char *, int);
#endif /* ADVANSYS_STATS */
+
#ifdef ADVANSYS_DEBUG
-STATIC void asc_prt_scsi_host(struct Scsi_Host *);
-STATIC void asc_prt_scsi_cmnd(Scsi_Cmnd *);
-STATIC void asc_prt_dvc_cfg(ASC_DVC_CFG *);
-STATIC void asc_prt_dvc_var(ASC_DVC_VAR *);
-STATIC void asc_prt_scsi_q(ASC_SCSI_Q *);
-STATIC void asc_prt_qdone_info(ASC_QDONE_INFO *);
-STATIC void asc_prt_hex(char *f, uchar *, int);
-STATIC int interrupts_enabled(void);
+STATIC void asc_prt_scsi_host(struct Scsi_Host *);
+STATIC void asc_prt_scsi_cmnd(Scsi_Cmnd *);
+STATIC void asc_prt_dvc_cfg(ASC_DVC_CFG *);
+STATIC void asc_prt_dvc_var(ASC_DVC_VAR *);
+STATIC void asc_prt_scsi_q(ASC_SCSI_Q *);
+STATIC void asc_prt_qdone_info(ASC_QDONE_INFO *);
+STATIC void asc_prt_hex(char *f, uchar *, int);
#endif /* ADVANSYS_DEBUG */
+#ifdef ADVANSYS_ASSERT
+STATIC int interrupts_enabled(void);
+#endif /* ADVANSYS_ASSERT */
+
/*
* --- Linux 'Scsi_Host_Template' and advansys_setup() Functions
@@ -2760,183 +2803,183 @@ STATIC int interrupts_enabled(void);
*/
int
advansys_proc_info(char *buffer, char **start, off_t offset, int length,
- int hostno, int inout)
-{
- struct Scsi_Host *shp;
- asc_board_t *boardp;
- int i;
- char *cp;
- int cplen;
- int cnt;
- int totcnt;
- int leftlen;
- char *curbuf;
- off_t advoffset;
- Scsi_Device *scd;
-
- ASC_DBG(1, "advansys_proc_info: begin\n");
-
- /*
- * User write not supported.
- */
- if (inout == TRUE) {
- return(-ENOSYS);
- }
-
- /*
- * User read of /proc/scsi/advansys/[0...] file.
- */
-
- /* Find the specified board. */
- for (i = 0; i < asc_board_count; i++) {
- if (asc_host[i]->host_no == hostno) {
- break;
- }
- }
- if (i == asc_board_count) {
- return(-ENOENT);
- }
-
- shp = asc_host[i];
- boardp = ASC_BOARDP(shp);
-
- /* Copy read data starting at the beginning of the buffer. */
- *start = buffer;
- curbuf = buffer;
- advoffset = 0;
- totcnt = 0;
- leftlen = length;
-
- /*
- * Get board configuration information.
- *
- * advansys_info() returns the board string from its own static buffer.
- */
- cp = (char *) advansys_info(shp);
- strcat(cp, "\n");
- cplen = strlen(cp);
- /* Copy board information. */
- cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
- totcnt += cnt;
- leftlen -= cnt;
- if (leftlen == 0) {
- ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
- return totcnt;
- }
- advoffset += cplen;
- curbuf += cnt;
-
- /*
- * Display driver information for each device attached to the board.
- */
- cp = boardp->prtbuf;
- cplen = asc_prt_board_devices(shp, cp, ASC_PRTBUF_SIZE);
- ASC_ASSERT(cplen < ASC_PRTBUF_SIZE);
- cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
- totcnt += cnt;
- leftlen -= cnt;
- if (leftlen == 0) {
- ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
- return totcnt;
- }
- advoffset += cplen;
- curbuf += cnt;
-
- /*
- * Display target driver information for each device attached
- * to the board.
- */
+ int hostno, int inout)
+{
+ struct Scsi_Host *shp;
+ asc_board_t *boardp;
+ int i;
+ char *cp;
+ int cplen;
+ int cnt;
+ int totcnt;
+ int leftlen;
+ char *curbuf;
+ off_t advoffset;
+ Scsi_Device *scd;
+
+ ASC_DBG(1, "advansys_proc_info: begin\n");
+
+ /*
+ * User write not supported.
+ */
+ if (inout == TRUE) {
+ return(-ENOSYS);
+ }
+
+ /*
+ * User read of /proc/scsi/advansys/[0...] file.
+ */
+
+ /* Find the specified board. */
+ for (i = 0; i < asc_board_count; i++) {
+ if (asc_host[i]->host_no == hostno) {
+ break;
+ }
+ }
+ if (i == asc_board_count) {
+ return(-ENOENT);
+ }
+
+ shp = asc_host[i];
+ boardp = ASC_BOARDP(shp);
+
+ /* Copy read data starting at the beginning of the buffer. */
+ *start = buffer;
+ curbuf = buffer;
+ advoffset = 0;
+ totcnt = 0;
+ leftlen = length;
+
+ /*
+ * Get board configuration information.
+ *
+ * advansys_info() returns the board string from its own static buffer.
+ */
+ cp = (char *) advansys_info(shp);
+ strcat(cp, "\n");
+ cplen = strlen(cp);
+ /* Copy board information. */
+ cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
+ totcnt += cnt;
+ leftlen -= cnt;
+ if (leftlen == 0) {
+ ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
+ return totcnt;
+ }
+ advoffset += cplen;
+ curbuf += cnt;
+
+ /*
+ * Display driver information for each device attached to the board.
+ */
+ cp = boardp->prtbuf;
+ cplen = asc_prt_board_devices(shp, cp, ASC_PRTBUF_SIZE);
+ ASC_ASSERT(cplen < ASC_PRTBUF_SIZE);
+ cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
+ totcnt += cnt;
+ leftlen -= cnt;
+ if (leftlen == 0) {
+ ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
+ return totcnt;
+ }
+ advoffset += cplen;
+ curbuf += cnt;
+
+ /*
+ * Display target driver information for each device attached
+ * to the board.
+ */
for (scd = scsi_devices; scd; scd = scd->next) {
- if (scd->host == shp) {
- cp = boardp->prtbuf;
- /*
- * Note: If proc_print_scsidevice() writes more than
- * ASC_PRTBUF_SIZE bytes, it will overrun 'prtbuf'.
- */
- proc_print_scsidevice(scd, cp, &cplen, 0);
- ASC_ASSERT(cplen < ASC_PRTBUF_SIZE);
- cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
- totcnt += cnt;
- leftlen -= cnt;
- if (leftlen == 0) {
- ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
- return totcnt;
- }
- advoffset += cplen;
- curbuf += cnt;
- }
+ if (scd->host == shp) {
+ cp = boardp->prtbuf;
+ /*
+ * Note: If proc_print_scsidevice() writes more than
+ * ASC_PRTBUF_SIZE bytes, it will overrun 'prtbuf'.
+ */
+ proc_print_scsidevice(scd, cp, &cplen, 0);
+ ASC_ASSERT(cplen < ASC_PRTBUF_SIZE);
+ cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
+ totcnt += cnt;
+ leftlen -= cnt;
+ if (leftlen == 0) {
+ ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
+ return totcnt;
+ }
+ advoffset += cplen;
+ curbuf += cnt;
+ }
}
- /*
- * Display EEPROM configuration for the board.
- */
- cp = boardp->prtbuf;
- cplen = asc_prt_board_eeprom(shp, cp, ASC_PRTBUF_SIZE);
- ASC_ASSERT(cplen < ASC_PRTBUF_SIZE);
- cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
- totcnt += cnt;
- leftlen -= cnt;
- if (leftlen == 0) {
- ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
- return totcnt;
- }
- advoffset += cplen;
- curbuf += cnt;
-
- /*
- * Display driver configuration and information for the board.
- */
- cp = boardp->prtbuf;
- cplen = asc_prt_driver_conf(shp, cp, ASC_PRTBUF_SIZE);
- ASC_ASSERT(cplen < ASC_PRTBUF_SIZE);
- cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
- totcnt += cnt;
- leftlen -= cnt;
- if (leftlen == 0) {
- ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
- return totcnt;
- }
- advoffset += cplen;
- curbuf += cnt;
+ /*
+ * Display EEPROM configuration for the board.
+ */
+ cp = boardp->prtbuf;
+ cplen = asc_prt_board_eeprom(shp, cp, ASC_PRTBUF_SIZE);
+ ASC_ASSERT(cplen < ASC_PRTBUF_SIZE);
+ cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
+ totcnt += cnt;
+ leftlen -= cnt;
+ if (leftlen == 0) {
+ ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
+ return totcnt;
+ }
+ advoffset += cplen;
+ curbuf += cnt;
+
+ /*
+ * Display driver configuration and information for the board.
+ */
+ cp = boardp->prtbuf;
+ cplen = asc_prt_driver_conf(shp, cp, ASC_PRTBUF_SIZE);
+ ASC_ASSERT(cplen < ASC_PRTBUF_SIZE);
+ cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
+ totcnt += cnt;
+ leftlen -= cnt;
+ if (leftlen == 0) {
+ ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
+ return totcnt;
+ }
+ advoffset += cplen;
+ curbuf += cnt;
#ifdef ADVANSYS_STATS
- /*
- * Display driver statistics for the board.
- */
- cp = boardp->prtbuf;
- cplen = asc_prt_board_stats(shp, cp, ASC_PRTBUF_SIZE);
- ASC_ASSERT(cplen < ASC_PRTBUF_SIZE);
- cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
- totcnt += cnt;
- leftlen -= cnt;
- if (leftlen == 0) {
- ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
- return totcnt;
- }
- advoffset += cplen;
- curbuf += cnt;
+ /*
+ * Display driver statistics for the board.
+ */
+ cp = boardp->prtbuf;
+ cplen = asc_prt_board_stats(shp, cp, ASC_PRTBUF_SIZE);
+ ASC_ASSERT(cplen < ASC_PRTBUF_SIZE);
+ cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
+ totcnt += cnt;
+ leftlen -= cnt;
+ if (leftlen == 0) {
+ ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
+ return totcnt;
+ }
+ advoffset += cplen;
+ curbuf += cnt;
#endif /* ADVANSYS_STATS */
- /*
- * Display Asc Library dynamic configuration information
- * for the board.
- */
- cp = boardp->prtbuf;
- cplen = asc_prt_board_info(shp, cp, ASC_PRTBUF_SIZE);
- ASC_ASSERT(cplen < ASC_PRTBUF_SIZE);
- cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
- totcnt += cnt;
- leftlen -= cnt;
- if (leftlen == 0) {
- ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
- return totcnt;
- }
- advoffset += cplen;
- curbuf += cnt;
-
- ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
-
- return totcnt;
+ /*
+ * Display Asc Library dynamic configuration information
+ * for the board.
+ */
+ cp = boardp->prtbuf;
+ cplen = asc_prt_board_info(shp, cp, ASC_PRTBUF_SIZE);
+ ASC_ASSERT(cplen < ASC_PRTBUF_SIZE);
+ cnt = asc_proc_copy(advoffset, offset, curbuf, leftlen, cp, cplen);
+ totcnt += cnt;
+ leftlen -= cnt;
+ if (leftlen == 0) {
+ ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
+ return totcnt;
+ }
+ advoffset += cplen;
+ curbuf += cnt;
+
+ ASC_DBG1(1, "advansys_proc_info: totcnt %d\n", totcnt);
+
+ return totcnt;
}
#endif /* version >= v1.3.0 */
@@ -2954,558 +2997,558 @@ advansys_proc_info(char *buffer, char **start, off_t offset, int length,
* it must not call SCSI mid-level functions including scsi_malloc()
* and scsi_free().
*/
-__initfunc(int
-advansys_detect(Scsi_Host_Template *tpnt))
-{
- static int detect_called = ASC_FALSE;
- int iop;
- int bus;
- struct Scsi_Host *shp;
- asc_board_t *boardp;
- ASC_DVC_VAR *asc_dvc_varp;
- int ioport = 0;
- int share_irq = FALSE;
- PCI_DEVICE pciDevice;
- PCI_CONFIG_SPACE pciConfig;
- int ret;
- extern PortAddr _asc_def_iop_base[ASC_IOADR_TABLE_MAX_IX];
-
-
- if (detect_called == ASC_FALSE) {
- detect_called = ASC_TRUE;
- } else {
- printk("AdvanSys SCSI: advansys_detect() mulitple calls ignored\n");
- return 0;
- }
-
- ASC_DBG(1, "advansys_detect: begin\n");
+ASC_INITFUNC(
+int
+advansys_detect(Scsi_Host_Template *tpnt)
+)
+{
+ static int detect_called = ASC_FALSE;
+ int iop;
+ int bus;
+ struct Scsi_Host *shp;
+ asc_board_t *boardp;
+ ASC_DVC_VAR *asc_dvc_varp;
+ int ioport = 0;
+ int share_irq = FALSE;
+ PCI_DEVICE pciDevice;
+ PCI_CONFIG_SPACE pciConfig;
+ int ret;
+
+ if (detect_called == ASC_FALSE) {
+ detect_called = ASC_TRUE;
+ } else {
+ printk("AdvanSys SCSI: advansys_detect() mulitple calls ignored\n");
+ return 0;
+ }
+
+ ASC_DBG(1, "advansys_detect: begin\n");
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
- tpnt->proc_dir = &proc_scsi_advansys;
+ tpnt->proc_dir = &proc_scsi_advansys;
#endif /* version >= v1.3.0 */
- asc_board_count = 0;
-
- /*
- * If I/O port probing has been modified, then verify and
- * clean-up the 'asc_ioport' list.
- */
- if (asc_iopflag == ASC_TRUE) {
- for (ioport = 0; ioport < ASC_NUM_BOARD_SUPPORTED; ioport++) {
- ASC_DBG2(1, "advansys_detect: asc_ioport[%d] %x\n",
- ioport, asc_ioport[ioport]);
- if (asc_ioport[ioport] != 0) {
- for (iop = 0; iop < ASC_IOADR_TABLE_MAX_IX; iop++) {
- if (_asc_def_iop_base[iop] == asc_ioport[ioport]) {
- break;
- }
- }
- if (iop == ASC_IOADR_TABLE_MAX_IX) {
- printk("AdvanSys SCSI: specified I/O Port 0x%X is invalid\n",
- asc_ioport[ioport]);
- asc_ioport[ioport] = 0;
- }
- }
- }
- ioport = 0;
- }
-
- memset(&pciDevice, 0, sizeof(PCI_DEVICE));
- memset(&pciConfig, 0, sizeof(PCI_CONFIG_SPACE));
- pciDevice.maxBusNumber = PCI_MAX_BUS;
- pciDevice.endSlot = PCI_MAX_SLOT;
-
- for (bus = 0; bus < ASC_NUM_BUS; bus++) {
-
- ASC_DBG2(1, "advansys_detect: bus search type %d (%s)\n",
- bus, asc_bus_name[bus]);
- iop = 0;
-
- while (asc_board_count < ASC_NUM_BOARD_SUPPORTED) {
-
- ASC_DBG1(2, "advansys_detect: asc_board_count %d\n",
- asc_board_count);
-
- switch (asc_bus[bus]) {
- case ASC_IS_ISA:
- case ASC_IS_VL:
- if (asc_iopflag == ASC_FALSE) {
- iop = AscSearchIOPortAddr(iop, asc_bus[bus]);
- } else {
- /*
- * ISA and VL I/O port scanning has either been
- * eliminated or limited to selected ports on
- * the LILO command line, /etc/lilo.conf, or
- * by setting variables when the module was loaded.
- */
- ASC_DBG(1, "advansys_detect: I/O port scanning modified\n");
- ioport_try_again:
- iop = 0;
- for (; ioport < ASC_NUM_BOARD_SUPPORTED; ioport++) {
- if ((iop = asc_ioport[ioport]) != 0) {
- break;
- }
- }
- if (iop) {
- ASC_DBG1(1, "advansys_detect: probing I/O port %x...\n",
- iop);
- if (check_region(iop, ASC_IOADR_GAP) != 0) {
- printk("AdvanSys SCSI: specified I/O Port 0x%X is busy\n", iop);
- /* Don't try this I/O port twice. */
- asc_ioport[ioport] = 0;
- goto ioport_try_again;
- } else if (AscFindSignature(iop) == ASC_FALSE) {
- printk("AdvanSys SCSI: specified I/O Port 0x%X has no adapter\n", iop);
- /* Don't try this I/O port twice. */
- asc_ioport[ioport] = 0;
- goto ioport_try_again;
- } else {
- /*
- * If this isn't an ISA board, then it must be
- * a VL board. If currently looking an ISA
- * board is being looked for then try for
- * another ISA board in 'asc_ioport'.
- */
- if (asc_bus[bus] == ASC_IS_ISA &&
- (AscGetChipVersion(iop, ASC_IS_ISA) &
- ASC_CHIP_VER_ISA_BIT) == 0) {
- /*
- * Don't clear 'asc_ioport[ioport]'. Try
- * this board again for VL. Increment
- * 'ioport' past this board.
- */
- ioport++;
- goto ioport_try_again;
- }
- }
- /*
- * This board appears good, don't try the I/O port
- * again by clearing its value. Increment 'ioport'
- * for the next iteration.
- */
- asc_ioport[ioport++] = 0;
- }
- }
- break;
-
- case ASC_IS_EISA:
- iop = AscSearchIOPortAddr(iop, asc_bus[bus]);
- break;
-
- case ASC_IS_PCI:
- if (asc_srch_pci_dev(&pciDevice) != PCI_DEVICE_FOUND) {
- iop = 0;
- } else {
- ASC_DBG2(2,
- "advansys_detect: slotFound %d, busNumber %d\n",
- pciDevice.slotFound, pciDevice.busNumber);
- asc_get_pci_cfg(&pciDevice, &pciConfig);
- iop = pciConfig.baseAddress[0] & PCI_IOADDRESS_MASK;
- ASC_DBG2(2, "advansys_detect: iop %x, irqLine %d\n",
- iop, pciConfig.irqLine);
- }
- break;
-
- default:
- ASC_PRINT1("advansys_detect: unknown bus type: %d\n",
- asc_bus[bus]);
- break;
- }
- ASC_DBG1(1, "advansys_detect: iop %x\n", iop);
-
- /*
- * Adapter not found, try next bus type.
- */
- if (iop == 0) {
- break;
- }
-
- /*
- * Adapter found.
- *
- * Register the adapter, get its configuration, and
- * initialize it.
- */
- ASC_DBG(2, "advansys_detect: scsi_register()\n");
- shp = scsi_register(tpnt, sizeof(asc_board_t));
-
- /* Save a pointer to the Scsi_host of each board found. */
- asc_host[asc_board_count++] = shp;
-
- /* Initialize private per board data */
- boardp = ASC_BOARDP(shp);
- memset(boardp, 0, sizeof(asc_board_t));
- boardp->id = asc_board_count - 1;
- asc_dvc_varp = &boardp->asc_dvc_var;
- asc_dvc_varp->drv_ptr = (ulong) boardp;
- asc_dvc_varp->cfg = &boardp->asc_dvc_cfg;
- asc_dvc_varp->cfg->overrun_buf = &overrun_buf[0];
- asc_dvc_varp->iop_base = iop;
+ asc_board_count = 0;
+
+ /*
+ * If I/O port probing has been modified, then verify and
+ * clean-up the 'asc_ioport' list.
+ */
+ if (asc_iopflag == ASC_TRUE) {
+ for (ioport = 0; ioport < ASC_NUM_BOARD_SUPPORTED; ioport++) {
+ ASC_DBG2(1, "advansys_detect: asc_ioport[%d] %x\n",
+ ioport, asc_ioport[ioport]);
+ if (asc_ioport[ioport] != 0) {
+ for (iop = 0; iop < ASC_IOADR_TABLE_MAX_IX; iop++) {
+ if (_asc_def_iop_base[iop] == asc_ioport[ioport]) {
+ break;
+ }
+ }
+ if (iop == ASC_IOADR_TABLE_MAX_IX) {
+ printk("AdvanSys SCSI: specified I/O Port 0x%X is invalid\n",
+ asc_ioport[ioport]);
+ asc_ioport[ioport] = 0;
+ }
+ }
+ }
+ ioport = 0;
+ }
+
+ memset(&pciDevice, 0, sizeof(PCI_DEVICE));
+ memset(&pciConfig, 0, sizeof(PCI_CONFIG_SPACE));
+ pciDevice.maxBusNumber = PCI_MAX_BUS;
+ pciDevice.endSlot = PCI_MAX_SLOT;
+
+ for (bus = 0; bus < ASC_NUM_BUS; bus++) {
+
+ ASC_DBG2(1, "advansys_detect: bus search type %d (%s)\n",
+ bus, asc_bus_name[bus]);
+ iop = 0;
+
+ while (asc_board_count < ASC_NUM_BOARD_SUPPORTED) {
+
+ ASC_DBG1(2, "advansys_detect: asc_board_count %d\n",
+ asc_board_count);
+
+ switch (asc_bus[bus]) {
+ case ASC_IS_ISA:
+ case ASC_IS_VL:
+ if (asc_iopflag == ASC_FALSE) {
+ iop = AscSearchIOPortAddr(iop, asc_bus[bus]);
+ } else {
+ /*
+ * ISA and VL I/O port scanning has either been
+ * eliminated or limited to selected ports on
+ * the LILO command line, /etc/lilo.conf, or
+ * by setting variables when the module was loaded.
+ */
+ ASC_DBG(1, "advansys_detect: I/O port scanning modified\n");
+ ioport_try_again:
+ iop = 0;
+ for (; ioport < ASC_NUM_BOARD_SUPPORTED; ioport++) {
+ if ((iop = asc_ioport[ioport]) != 0) {
+ break;
+ }
+ }
+ if (iop) {
+ ASC_DBG1(1, "advansys_detect: probing I/O port %x...\n",
+ iop);
+ if (check_region(iop, ASC_IOADR_GAP) != 0) {
+ printk("AdvanSys SCSI: specified I/O Port 0x%X is busy\n", iop);
+ /* Don't try this I/O port twice. */
+ asc_ioport[ioport] = 0;
+ goto ioport_try_again;
+ } else if (AscFindSignature(iop) == ASC_FALSE) {
+ printk("AdvanSys SCSI: specified I/O Port 0x%X has no adapter\n", iop);
+ /* Don't try this I/O port twice. */
+ asc_ioport[ioport] = 0;
+ goto ioport_try_again;
+ } else {
+ /*
+ * If this isn't an ISA board, then it must be
+ * a VL board. If currently looking an ISA
+ * board is being looked for then try for
+ * another ISA board in 'asc_ioport'.
+ */
+ if (asc_bus[bus] == ASC_IS_ISA &&
+ (AscGetChipVersion(iop, ASC_IS_ISA) &
+ ASC_CHIP_VER_ISA_BIT) == 0) {
+ /*
+ * Don't clear 'asc_ioport[ioport]'. Try
+ * this board again for VL. Increment
+ * 'ioport' past this board.
+ */
+ ioport++;
+ goto ioport_try_again;
+ }
+ }
+ /*
+ * This board appears good, don't try the I/O port
+ * again by clearing its value. Increment 'ioport'
+ * for the next iteration.
+ */
+ asc_ioport[ioport++] = 0;
+ }
+ }
+ break;
+
+ case ASC_IS_EISA:
+ iop = AscSearchIOPortAddr(iop, asc_bus[bus]);
+ break;
+
+ case ASC_IS_PCI:
+ if (asc_srch_pci_dev(&pciDevice) != PCI_DEVICE_FOUND) {
+ iop = 0;
+ } else {
+ ASC_DBG2(2,
+ "advansys_detect: slotFound %d, busNumber %d\n",
+ pciDevice.slotFound, pciDevice.busNumber);
+ asc_get_pci_cfg(&pciDevice, &pciConfig);
+ iop = pciConfig.baseAddress[0] & PCI_IOADDRESS_MASK;
+ ASC_DBG2(2, "advansys_detect: iop %x, irqLine %d\n",
+ iop, pciConfig.irqLine);
+ }
+ break;
+
+ default:
+ ASC_PRINT1("advansys_detect: unknown bus type: %d\n",
+ asc_bus[bus]);
+ break;
+ }
+ ASC_DBG1(1, "advansys_detect: iop %x\n", iop);
+
+ /*
+ * Adapter not found, try next bus type.
+ */
+ if (iop == 0) {
+ break;
+ }
+
+ /*
+ * Adapter found.
+ *
+ * Register the adapter, get its configuration, and
+ * initialize it.
+ */
+ ASC_DBG(2, "advansys_detect: scsi_register()\n");
+ shp = scsi_register(tpnt, sizeof(asc_board_t));
+
+ /* Save a pointer to the Scsi_host of each board found. */
+ asc_host[asc_board_count++] = shp;
+
+ /* Initialize private per board data */
+ boardp = ASC_BOARDP(shp);
+ memset(boardp, 0, sizeof(asc_board_t));
+ boardp->id = asc_board_count - 1;
+ asc_dvc_varp = &boardp->asc_dvc_var;
+ asc_dvc_varp->drv_ptr = (ulong) boardp;
+ asc_dvc_varp->cfg = &boardp->asc_dvc_cfg;
+ asc_dvc_varp->cfg->overrun_buf = &overrun_buf[0];
+ asc_dvc_varp->iop_base = iop;
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
- if ((boardp->prtbuf =
- kmalloc(ASC_PRTBUF_SIZE, GFP_ATOMIC)) == NULL) {
- ASC_PRINT3(
+ if ((boardp->prtbuf =
+ kmalloc(ASC_PRTBUF_SIZE, GFP_ATOMIC)) == NULL) {
+ ASC_PRINT3(
"advansys_detect: board %d: kmalloc(%d, %d) returned NULL\n",
- boardp->id, ASC_PRTBUF_SIZE, GFP_ATOMIC);
- scsi_unregister(shp);
- asc_board_count--;
- continue;
- }
+ boardp->id, ASC_PRTBUF_SIZE, GFP_ATOMIC);
+ scsi_unregister(shp);
+ asc_board_count--;
+ continue;
+ }
#endif /* version >= v1.3.0 */
- /*
- * Set the board bus type and PCI IRQ for AscInitGetConfig().
- */
- asc_dvc_varp->bus_type = asc_bus[bus];
- switch (asc_dvc_varp->bus_type) {
- case ASC_IS_ISA:
- shp->unchecked_isa_dma = TRUE;
- share_irq = FALSE;
- break;
- case ASC_IS_VL:
- shp->unchecked_isa_dma = FALSE;
- share_irq = FALSE;
- break;
- case ASC_IS_EISA:
- shp->unchecked_isa_dma = FALSE;
- share_irq = TRUE;
- break;
- case ASC_IS_PCI:
- shp->irq = asc_dvc_varp->irq_no = pciConfig.irqLine;
- asc_dvc_varp->cfg->pci_device_id = pciConfig.deviceID;
- asc_dvc_varp->cfg->pci_slot_info =
- ASC_PCI_MKID(pciDevice.busNumber,
- pciDevice.slotFound,
- pciDevice.devFunc);
- shp->unchecked_isa_dma = FALSE;
- share_irq = TRUE;
- break;
- default:
- ASC_PRINT2(
+ /*
+ * Set the board bus type and PCI IRQ for AscInitGetConfig().
+ */
+ asc_dvc_varp->bus_type = asc_bus[bus];
+ switch (asc_dvc_varp->bus_type) {
+ case ASC_IS_ISA:
+ shp->unchecked_isa_dma = TRUE;
+ share_irq = FALSE;
+ break;
+ case ASC_IS_VL:
+ shp->unchecked_isa_dma = FALSE;
+ share_irq = FALSE;
+ break;
+ case ASC_IS_EISA:
+ shp->unchecked_isa_dma = FALSE;
+ share_irq = TRUE;
+ break;
+ case ASC_IS_PCI:
+ shp->irq = asc_dvc_varp->irq_no = pciConfig.irqLine;
+ asc_dvc_varp->cfg->pci_device_id = pciConfig.deviceID;
+ asc_dvc_varp->cfg->pci_slot_info =
+ ASC_PCI_MKID(pciDevice.busNumber,
+ pciDevice.slotFound,
+ pciDevice.devFunc);
+ shp->unchecked_isa_dma = FALSE;
+ share_irq = TRUE;
+ break;
+ default:
+ ASC_PRINT2(
"advansys_detect: board %d: unknown adapter type: %d",
- boardp->id, asc_dvc_varp->bus_type);
- shp->unchecked_isa_dma = TRUE;
- share_irq = FALSE;
- break;
- }
-
- /*
- * Get the board configuration.
- *
- * NOTE: AscInitGetConfig() may change the board's bus_type
- * value. The asc_bus[bus] value should no longer be used. If
- * the bus_type field must be referenced only use the bit-wise
- * AND operator "&".
- */
- ASC_DBG(2, "advansys_detect: AscInitGetConfig()\n");
- switch(ret = AscInitGetConfig(asc_dvc_varp)) {
- case 0: /* No error */
- break;
- case ASC_WARN_IO_PORT_ROTATE:
- ASC_PRINT1(
+ boardp->id, asc_dvc_varp->bus_type);
+ shp->unchecked_isa_dma = TRUE;
+ share_irq = FALSE;
+ break;
+ }
+
+ /*
+ * Get the board configuration.
+ *
+ * NOTE: AscInitGetConfig() may change the board's bus_type
+ * value. The asc_bus[bus] value should no longer be used. If
+ * the bus_type field must be referenced only use the bit-wise
+ * AND operator "&".
+ */
+ ASC_DBG(2, "advansys_detect: AscInitGetConfig()\n");
+ switch(ret = AscInitGetConfig(asc_dvc_varp)) {
+ case 0: /* No error */
+ break;
+ case ASC_WARN_IO_PORT_ROTATE:
+ ASC_PRINT1(
"AscInitGetConfig: board %d: I/O port address modified\n",
- boardp->id);
- break;
- case ASC_WARN_AUTO_CONFIG:
- ASC_PRINT1(
+ boardp->id);
+ break;
+ case ASC_WARN_AUTO_CONFIG:
+ ASC_PRINT1(
"AscInitGetConfig: board %d: I/O port increment switch enabled\n",
- boardp->id);
- break;
- case ASC_WARN_EEPROM_CHKSUM:
- ASC_PRINT1(
+ boardp->id);
+ break;
+ case ASC_WARN_EEPROM_CHKSUM:
+ ASC_PRINT1(
"AscInitGetConfig: board %d: EEPROM checksum error\n",
- boardp->id);
- break;
- case ASC_WARN_IRQ_MODIFIED:
- ASC_PRINT1(
+ boardp->id);
+ break;
+ case ASC_WARN_IRQ_MODIFIED:
+ ASC_PRINT1(
"AscInitGetConfig: board %d: IRQ modified\n",
- boardp->id);
- break;
- case ASC_WARN_CMD_QNG_CONFLICT:
- ASC_PRINT1(
+ boardp->id);
+ break;
+ case ASC_WARN_CMD_QNG_CONFLICT:
+ ASC_PRINT1(
"AscInitGetConfig: board %d: tag queuing enabled w/o disconnects\n",
- boardp->id);
- break;
- default:
- ASC_PRINT2(
+ boardp->id);
+ break;
+ default:
+ ASC_PRINT2(
"AscInitGetConfig: board %d: unknown warning: %x\n",
- boardp->id, ret);
- break;
- }
- if (asc_dvc_varp->err_code != 0) {
- ASC_PRINT3(
+ boardp->id, ret);
+ break;
+ }
+ if (asc_dvc_varp->err_code != 0) {
+ ASC_PRINT3(
"AscInitGetConfig: board %d error: init_state %x, err_code %x\n",
- boardp->id, asc_dvc_varp->init_state,
- asc_dvc_varp->err_code);
+ boardp->id, asc_dvc_varp->init_state,
+ asc_dvc_varp->err_code);
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
- kfree(boardp->prtbuf);
+ kfree(boardp->prtbuf);
#endif /* version >= v1.3.0 */
- scsi_unregister(shp);
- asc_board_count--;
- continue;
- }
-
- /*
- * Set the adapter's target id bit in the init_tidmask field.
- */
- boardp->init_tidmask |=
- ASC_TIX_TO_TARGET_ID(asc_dvc_varp->cfg->chip_scsi_id);
-
- /*
- * Save EEPROM settings for the board.
- */
- boardp->eep_config.init_sdtr = asc_dvc_varp->init_sdtr;
- boardp->eep_config.disc_enable = asc_dvc_varp->cfg->disc_enable;
- boardp->eep_config.use_cmd_qng = asc_dvc_varp->cfg->cmd_qng_enabled;
- boardp->eep_config.isa_dma_speed = asc_dvc_varp->cfg->isa_dma_speed;
- boardp->eep_config.start_motor = asc_dvc_varp->start_motor;
- boardp->eep_config.cntl = asc_dvc_varp->dvc_cntl;
- boardp->eep_config.no_scam = asc_dvc_varp->no_scam;
- boardp->eep_config.max_total_qng = asc_dvc_varp->max_total_qng;
- boardp->eep_config.chip_scsi_id = asc_dvc_varp->cfg->chip_scsi_id;
- /* 'max_tag_qng' is set to the same value for every device. */
- boardp->eep_config.max_tag_qng = asc_dvc_varp->cfg->max_tag_qng[0];
-
- /*
- * Modify board configuration.
- */
- asc_dvc_varp->isr_callback = (Ptr2Func) asc_isr_callback;
- asc_dvc_varp->exe_callback = (Ptr2Func) NULL;
-
- ASC_DBG(2, "advansys_detect: AscInitSetConfig()\n");
- switch (ret = AscInitSetConfig(asc_dvc_varp)) {
- case 0: /* No error. */
- break;
- case ASC_WARN_IO_PORT_ROTATE:
- ASC_PRINT1(
+ scsi_unregister(shp);
+ asc_board_count--;
+ continue;
+ }
+
+ /*
+ * Set the adapter's target id bit in the init_tidmask field.
+ */
+ boardp->init_tidmask |=
+ ASC_TIX_TO_TARGET_ID(asc_dvc_varp->cfg->chip_scsi_id);
+
+ /*
+ * Save EEPROM settings for the board.
+ */
+ boardp->eep_config.init_sdtr = asc_dvc_varp->init_sdtr;
+ boardp->eep_config.disc_enable = asc_dvc_varp->cfg->disc_enable;
+ boardp->eep_config.use_cmd_qng = asc_dvc_varp->cfg->cmd_qng_enabled;
+ boardp->eep_config.isa_dma_speed = asc_dvc_varp->cfg->isa_dma_speed;
+ boardp->eep_config.start_motor = asc_dvc_varp->start_motor;
+ boardp->eep_config.cntl = asc_dvc_varp->dvc_cntl;
+ boardp->eep_config.no_scam = asc_dvc_varp->no_scam;
+ boardp->eep_config.max_total_qng = asc_dvc_varp->max_total_qng;
+ boardp->eep_config.chip_scsi_id = asc_dvc_varp->cfg->chip_scsi_id;
+ /* 'max_tag_qng' is set to the same value for every device. */
+ boardp->eep_config.max_tag_qng = asc_dvc_varp->cfg->max_tag_qng[0];
+
+ /*
+ * Modify board configuration.
+ */
+ asc_dvc_varp->isr_callback = (Ptr2Func) asc_isr_callback;
+ asc_dvc_varp->exe_callback = (Ptr2Func) NULL;
+
+ ASC_DBG(2, "advansys_detect: AscInitSetConfig()\n");
+ switch (ret = AscInitSetConfig(asc_dvc_varp)) {
+ case 0: /* No error. */
+ break;
+ case ASC_WARN_IO_PORT_ROTATE:
+ ASC_PRINT1(
"AscInitSetConfig: board %d: I/O port address modified\n",
- boardp->id);
- break;
- case ASC_WARN_AUTO_CONFIG:
- ASC_PRINT1(
+ boardp->id);
+ break;
+ case ASC_WARN_AUTO_CONFIG:
+ ASC_PRINT1(
"AscInitSetConfig: board %d: I/O port increment switch enabled\n",
- boardp->id);
- break;
- case ASC_WARN_EEPROM_CHKSUM:
- ASC_PRINT1(
+ boardp->id);
+ break;
+ case ASC_WARN_EEPROM_CHKSUM:
+ ASC_PRINT1(
"AscInitSetConfig: board %d: EEPROM checksum error\n",
- boardp->id);
- break;
- case ASC_WARN_IRQ_MODIFIED:
- ASC_PRINT1(
+ boardp->id);
+ break;
+ case ASC_WARN_IRQ_MODIFIED:
+ ASC_PRINT1(
"AscInitSetConfig: board %d: IRQ modified\n",
- boardp->id);
- break;
- case ASC_WARN_CMD_QNG_CONFLICT:
- ASC_PRINT1(
+ boardp->id);
+ break;
+ case ASC_WARN_CMD_QNG_CONFLICT:
+ ASC_PRINT1(
"AscInitSetConfig: board %d: tag queuing w/o disconnects\n",
- boardp->id);
- break;
- default:
- ASC_PRINT2(
+ boardp->id);
+ break;
+ default:
+ ASC_PRINT2(
"AscInitSetConfig: board %d: unknown warning: %x\n",
- boardp->id, ret);
- break;
- }
- if (asc_dvc_varp->err_code != 0) {
- ASC_PRINT3(
+ boardp->id, ret);
+ break;
+ }
+ if (asc_dvc_varp->err_code != 0) {
+ ASC_PRINT3(
"AscInitSetConfig: board %d error: init_state %x, err_code %x\n",
- boardp->id, asc_dvc_varp->init_state,
- asc_dvc_varp->err_code);
+ boardp->id, asc_dvc_varp->init_state,
+ asc_dvc_varp->err_code);
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
- kfree(boardp->prtbuf);
+ kfree(boardp->prtbuf);
#endif /* version >= v1.3.0 */
- scsi_unregister(shp);
- asc_board_count--;
- continue;
- }
-
- /*
- * Finish initializing the 'Scsi_Host' structure.
- */
-
- /* AscInitSetConfig() will set the IRQ for non-PCI boards. */
- if ((asc_dvc_varp->bus_type & ASC_IS_PCI) == 0) {
- shp->irq = asc_dvc_varp->irq_no;
- }
-
- /*
- * One host supports one channel. There are two different
- * hosts for each channel of a dual channel board.
- */
+ scsi_unregister(shp);
+ asc_board_count--;
+ continue;
+ }
+
+ /*
+ * Finish initializing the 'Scsi_Host' structure.
+ */
+
+ /* AscInitSetConfig() will set the IRQ for non-PCI boards. */
+ if ((asc_dvc_varp->bus_type & ASC_IS_PCI) == 0) {
+ shp->irq = asc_dvc_varp->irq_no;
+ }
+
+ /*
+ * One host supports one channel. There are two different
+ * hosts for each channel of a dual channel board.
+ */
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
- shp->max_channel = 0;
+ shp->max_channel = 0;
#endif /* version >= v1.3.89 */
- shp->max_id = ASC_MAX_TID + 1;
- shp->max_lun = ASC_MAX_LUN + 1;
+ shp->max_id = ASC_MAX_TID + 1;
+ shp->max_lun = ASC_MAX_LUN + 1;
- shp->io_port = asc_dvc_varp->iop_base;
- shp->n_io_port = ASC_IOADR_GAP;
- shp->this_id = asc_dvc_varp->cfg->chip_scsi_id;
+ shp->io_port = asc_dvc_varp->iop_base;
+ shp->n_io_port = ASC_IOADR_GAP;
+ shp->this_id = asc_dvc_varp->cfg->chip_scsi_id;
- /* Maximum number of queues this adapter can handle. */
- shp->can_queue = asc_dvc_varp->max_total_qng;
+ /* Maximum number of queues this adapter can handle. */
+ shp->can_queue = asc_dvc_varp->max_total_qng;
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(1,3,89)
- /*
- * Set a conservative 'cmd_per_lun' value to prevent memory
- * allocation failures.
- */
+ /*
+ * Set a conservative 'cmd_per_lun' value to prevent memory
+ * allocation failures.
+ */
#ifdef MODULE
- shp->cmd_per_lun = 1;
+ shp->cmd_per_lun = 1;
#else /* MODULE */
- shp->cmd_per_lun = 4;
+ shp->cmd_per_lun = 4;
#endif /* MODULE */
- ASC_DBG1(1, "advansys_detect: cmd_per_lun: %d\n", shp->cmd_per_lun);
+ ASC_DBG1(1, "advansys_detect: cmd_per_lun: %d\n", shp->cmd_per_lun);
#else /* version >= v1.3.89 */
- /*
- * Use the host 'select_queue_depths' function to determine
- * the number of commands to queue per device.
- */
- shp->select_queue_depths = advansys_select_queue_depths;
+ /*
+ * Use the host 'select_queue_depths' function to determine
+ * the number of commands to queue per device.
+ */
+ shp->select_queue_depths = advansys_select_queue_depths;
#ifdef MODULE
- /*
- * Following v1.3.89, 'cmd_per_lun' is no longer needed
- * and should be set to zero. But because of a bug introduced
- * in v1.3.89 if the driver is compiled as a module and
- * 'cmd_per_lun' is zero, the Mid-Level SCSI function
- * 'allocate_device' will panic. To allow the driver to
- * work as a module in these kernels set 'cmd_per_lun' to 1.
- */
- shp->cmd_per_lun = 1;
+ /*
+ * Following v1.3.89, 'cmd_per_lun' is no longer needed
+ * and should be set to zero. But because of a bug introduced
+ * in v1.3.89 if the driver is compiled as a module and
+ * 'cmd_per_lun' is zero, the Mid-Level SCSI function
+ * 'allocate_device' will panic. To allow the driver to
+ * work as a module in these kernels set 'cmd_per_lun' to 1.
+ */
+ shp->cmd_per_lun = 1;
#else /* MODULE */
- shp->cmd_per_lun = 0;
+ shp->cmd_per_lun = 0;
#endif /* MODULE */
#endif /* version >= v1.3.89 */
- /*
- * Set the maximum number of scatter-gather elements adapter
- * can handle.
- */
+ /*
+ * Set the maximum number of scatter-gather elements adapter
+ * can handle.
+ */
#ifdef MODULE
- /*
- * If the driver is compiled as a module, set a conservative
- * 'sg_tablesize' value to prevent memory allocation failures.
- * Memory allocation errors are more likely to occur at module
- * load time, then at driver initialization time.
- */
- shp->sg_tablesize = 8;
+ /*
+ * If the driver is compiled as a module, set a conservative
+ * 'sg_tablesize' value to prevent memory allocation failures.
+ * Memory allocation errors are more likely to occur at module
+ * load time, then at driver initialization time.
+ */
+ shp->sg_tablesize = 8;
#else /* MODULE */
- /*
- * Allow two commands with 'sg_tablesize' scatter-gather
- * elements to be executed simultaneously. This value is
- * the theoretical hardware limit. It may be decreased
- * below.
- */
- shp->sg_tablesize =
- (((asc_dvc_varp->max_total_qng - 2) / 2) *
- ASC_SG_LIST_PER_Q) + 1;
+ /*
+ * Allow two commands with 'sg_tablesize' scatter-gather
+ * elements to be executed simultaneously. This value is
+ * the theoretical hardware limit. It may be decreased
+ * below.
+ */
+ shp->sg_tablesize =
+ (((asc_dvc_varp->max_total_qng - 2) / 2) *
+ ASC_SG_LIST_PER_Q) + 1;
#endif /* MODULE */
- /*
- * The value of 'sg_tablesize' can not exceed the SCSI
- * mid-level driver definition of SG_ALL. SG_ALL also
- * must not be exceeded, because it is used to define the
- * size of the scatter-gather table in 'struct asc_sg_head'.
- */
- if (shp->sg_tablesize > SG_ALL) {
- shp->sg_tablesize = SG_ALL;
- }
-
- ASC_DBG1(1, "advansys_detect: sg_tablesize: %d\n",
- shp->sg_tablesize);
-
- /* BIOS start address. */
- shp->base = (char *) ((ulong) AscGetChipBiosAddress(
- asc_dvc_varp->iop_base,
- asc_dvc_varp->bus_type));
-
- /*
- * Register Board Resources - I/O Port, DMA, IRQ
- */
-
- /* Register I/O port range */
- ASC_DBG(2, "advansys_detect: request_region()\n");
- request_region(shp->io_port, shp->n_io_port, "advansys");
-
- /* Register DMA channel for ISA bus. */
- if ((asc_dvc_varp->bus_type & ASC_IS_ISA) == 0) {
- shp->dma_channel = NO_ISA_DMA;
- } else {
- shp->dma_channel = asc_dvc_varp->cfg->isa_dma_channel;
- if ((ret = request_dma(shp->dma_channel, "advansys")) != 0) {
- ASC_PRINT3(
+ /*
+ * The value of 'sg_tablesize' can not exceed the SCSI
+ * mid-level driver definition of SG_ALL. SG_ALL also
+ * must not be exceeded, because it is used to define the
+ * size of the scatter-gather table in 'struct asc_sg_head'.
+ */
+ if (shp->sg_tablesize > SG_ALL) {
+ shp->sg_tablesize = SG_ALL;
+ }
+
+ ASC_DBG1(1, "advansys_detect: sg_tablesize: %d\n",
+ shp->sg_tablesize);
+
+ /* BIOS start address. */
+ shp->base = (char *) ((ulong) AscGetChipBiosAddress(
+ asc_dvc_varp->iop_base,
+ asc_dvc_varp->bus_type));
+
+ /*
+ * Register Board Resources - I/O Port, DMA, IRQ
+ */
+
+ /* Register I/O port range */
+ ASC_DBG(2, "advansys_detect: request_region()\n");
+ request_region(shp->io_port, shp->n_io_port, "advansys");
+
+ /* Register DMA channel for ISA bus. */
+ if ((asc_dvc_varp->bus_type & ASC_IS_ISA) == 0) {
+ shp->dma_channel = NO_ISA_DMA;
+ } else {
+ shp->dma_channel = asc_dvc_varp->cfg->isa_dma_channel;
+ if ((ret = request_dma(shp->dma_channel, "advansys")) != 0) {
+ ASC_PRINT3(
"advansys_detect: board %d: request_dma() %d failed %d\n",
- boardp->id, shp->dma_channel, ret);
- release_region(shp->io_port, shp->n_io_port);
+ boardp->id, shp->dma_channel, ret);
+ release_region(shp->io_port, shp->n_io_port);
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
- kfree(boardp->prtbuf);
+ kfree(boardp->prtbuf);
#endif /* version >= v1.3.0 */
- scsi_unregister(shp);
- asc_board_count--;
- continue;
- }
- AscEnableIsaDma(shp->dma_channel);
- }
-
- /* Register IRQ Number. */
- ASC_DBG1(2, "advansys_detect: request_irq() %d\n", shp->irq);
+ scsi_unregister(shp);
+ asc_board_count--;
+ continue;
+ }
+ AscEnableIsaDma(shp->dma_channel);
+ }
+
+ /* Register IRQ Number. */
+ ASC_DBG1(2, "advansys_detect: request_irq() %d\n", shp->irq);
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(1,3,70)
- if ((ret = request_irq(shp->irq, advansys_interrupt,
- SA_INTERRUPT, "advansys")) != 0) {
+ if ((ret = request_irq(shp->irq, advansys_interrupt,
+ SA_INTERRUPT, "advansys")) != 0) {
#else /* version >= v1.3.70 */
- if ((ret = request_irq(shp->irq, advansys_interrupt,
- SA_INTERRUPT | (share_irq == TRUE ? SA_SHIRQ : 0),
- "advansys", boardp)) != 0) {
+ if ((ret = request_irq(shp->irq, advansys_interrupt,
+ SA_INTERRUPT | (share_irq == TRUE ? SA_SHIRQ : 0),
+ "advansys", boardp)) != 0) {
#endif /* version >= v1.3.70 */
- ASC_PRINT2(
+ ASC_PRINT2(
"advansys_detect: board %d: request_irq() failed %d\n",
- boardp->id, ret);
- release_region(shp->io_port, shp->n_io_port);
- if (shp->dma_channel != NO_ISA_DMA) {
- free_dma(shp->dma_channel);
- }
+ boardp->id, ret);
+ release_region(shp->io_port, shp->n_io_port);
+ if (shp->dma_channel != NO_ISA_DMA) {
+ free_dma(shp->dma_channel);
+ }
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
- kfree(boardp->prtbuf);
+ kfree(boardp->prtbuf);
#endif /* version >= v1.3.0 */
- scsi_unregister(shp);
- asc_board_count--;
- continue;
- }
-
- /*
- * Initialize board RISC chip and enable interrupts.
- */
- ASC_DBG(2, "advansys_detect: AscInitAsc1000Driver()\n");
- if (AscInitAsc1000Driver(asc_dvc_varp)) {
- ASC_PRINT3(
+ scsi_unregister(shp);
+ asc_board_count--;
+ continue;
+ }
+
+ /*
+ * Initialize board RISC chip and enable interrupts.
+ */
+ ASC_DBG(2, "advansys_detect: AscInitAsc1000Driver()\n");
+ if (AscInitAsc1000Driver(asc_dvc_varp)) {
+ ASC_PRINT3(
"AscInitAsc1000Driver: board %d: error: init_state %x, err_code %x\n",
- boardp->id, asc_dvc_varp->init_state,
- asc_dvc_varp->err_code);
- release_region(shp->io_port, shp->n_io_port);
- if (shp->dma_channel != NO_ISA_DMA) {
- free_dma(shp->dma_channel);
- }
+ boardp->id, asc_dvc_varp->init_state,
+ asc_dvc_varp->err_code);
+ release_region(shp->io_port, shp->n_io_port);
+ if (shp->dma_channel != NO_ISA_DMA) {
+ free_dma(shp->dma_channel);
+ }
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
- kfree(boardp->prtbuf);
+ kfree(boardp->prtbuf);
#endif /* version >= v1.3.0 */
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(1,3,70)
- free_irq(shp->irq);
+ free_irq(shp->irq);
#else /* version >= v1.3.70 */
- free_irq(shp->irq, boardp);
+ free_irq(shp->irq, boardp);
#endif /* version >= v1.3.70 */
- scsi_unregister(shp);
- asc_board_count--;
- continue;
- }
- ASC_DBG_PRT_SCSI_HOST(2, shp);
- }
- }
- ASC_DBG1(1, "advansys_detect: done: asc_board_count %d\n", asc_board_count);
- return asc_board_count;
+ scsi_unregister(shp);
+ asc_board_count--;
+ continue;
+ }
+ ASC_DBG_PRT_SCSI_HOST(2, shp);
+ }
+ }
+ ASC_DBG1(1, "advansys_detect: done: asc_board_count %d\n", asc_board_count);
+ return asc_board_count;
}
/*
@@ -3516,27 +3559,27 @@ advansys_detect(Scsi_Host_Template *tpnt))
int
advansys_release(struct Scsi_Host *shp)
{
- asc_board_t *boardp;
+ asc_board_t *boardp;
- ASC_DBG(1, "advansys_release: begin\n");
- boardp = ASC_BOARDP(shp);
+ ASC_DBG(1, "advansys_release: begin\n");
+ boardp = ASC_BOARDP(shp);
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(1,3,70)
- free_irq(shp->irq);
+ free_irq(shp->irq);
#else /* version >= v1.3.70 */
- free_irq(shp->irq, boardp);
+ free_irq(shp->irq, boardp);
#endif /* version >= v1.3.70 */
- if (shp->dma_channel != NO_ISA_DMA) {
- ASC_DBG(1, "advansys_release: free_dma()\n");
- free_dma(shp->dma_channel);
- }
- release_region(shp->io_port, shp->n_io_port);
+ if (shp->dma_channel != NO_ISA_DMA) {
+ ASC_DBG(1, "advansys_release: free_dma()\n");
+ free_dma(shp->dma_channel);
+ }
+ release_region(shp->io_port, shp->n_io_port);
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
- ASC_ASSERT(boardp->prtbuf != NULL);
- kfree(boardp->prtbuf);
+ ASC_ASSERT(boardp->prtbuf != NULL);
+ kfree(boardp->prtbuf);
#endif /* version >= v1.3.0 */
- scsi_unregister(shp);
- ASC_DBG(1, "advansys_release: end\n");
- return 0;
+ scsi_unregister(shp);
+ ASC_DBG(1, "advansys_release: end\n");
+ return 0;
}
/*
@@ -3551,58 +3594,56 @@ advansys_release(struct Scsi_Host *shp)
const char *
advansys_info(struct Scsi_Host *shp)
{
- static char info[ASC_INFO_SIZE];
- asc_board_t *boardp;
- ASC_DVC_VAR *asc_dvc_varp;
- char *busname;
-
- boardp = ASC_BOARDP(shp);
- asc_dvc_varp = &boardp->asc_dvc_var;
- ASC_DBG(1, "advansys_info: begin\n");
- if (asc_dvc_varp->bus_type & ASC_IS_ISA) {
- if ((asc_dvc_varp->bus_type & ASC_IS_ISAPNP) == ASC_IS_ISAPNP) {
- busname = "ISA PnP";
- } else {
- busname = "ISA";
- }
- sprintf(info,
- "AdvanSys SCSI %s: %s %u CDB: BIOS %X, IO %X-%X, IRQ %u, DMA %u",
- ASC_VERSION, busname, boardp->asc_dvc_var.max_total_qng,
- (unsigned) shp->base, shp->io_port,
- shp->io_port + (shp->n_io_port - 1), shp->irq, shp->dma_channel);
- } else if (asc_dvc_varp->bus_type & ASC_IS_PCI) {
- if ((asc_dvc_varp->bus_type & ASC_IS_PCI_ULTRA)
- == ASC_IS_PCI_ULTRA) {
- busname = "PCI Ultra";
- } else {
- busname = "PCI";
- }
- sprintf(info,
- "AdvanSys SCSI %s: %s %u CDB: IO %X-%X, IRQ %u",
- ASC_VERSION, busname, boardp->asc_dvc_var.max_total_qng,
- shp->io_port, shp->io_port + (shp->n_io_port - 1), shp->irq);
- } else {
- if (asc_dvc_varp->bus_type & ASC_IS_VL) {
- busname = "VL";
- } else if (asc_dvc_varp->bus_type & ASC_IS_EISA) {
- busname = "EISA";
- } else {
- busname = "?";
- ASC_PRINT2(
+ static char info[ASC_INFO_SIZE];
+ asc_board_t *boardp;
+ ASC_DVC_VAR *asc_dvc_varp;
+ char *busname;
+
+ boardp = ASC_BOARDP(shp);
+ asc_dvc_varp = &boardp->asc_dvc_var;
+ ASC_DBG(1, "advansys_info: begin\n");
+ if (asc_dvc_varp->bus_type & ASC_IS_ISA) {
+ if ((asc_dvc_varp->bus_type & ASC_IS_ISAPNP) == ASC_IS_ISAPNP) {
+ busname = "ISA PnP";
+ } else {
+ busname = "ISA";
+ }
+ sprintf(info,
+ "AdvanSys SCSI %s: %s %u CDB: BIOS %X, IO %X-%X, IRQ %u, DMA %u",
+ ASC_VERSION, busname, boardp->asc_dvc_var.max_total_qng,
+ (unsigned) shp->base, shp->io_port,
+ shp->io_port + (shp->n_io_port - 1), shp->irq, shp->dma_channel);
+ } else if (asc_dvc_varp->bus_type & ASC_IS_PCI) {
+ if ((asc_dvc_varp->bus_type & ASC_IS_PCI_ULTRA)
+ == ASC_IS_PCI_ULTRA) {
+ busname = "PCI Ultra";
+ } else {
+ busname = "PCI";
+ }
+ sprintf(info,
+ "AdvanSys SCSI %s: %s %u CDB: IO %X-%X, IRQ %u",
+ ASC_VERSION, busname, boardp->asc_dvc_var.max_total_qng,
+ shp->io_port, shp->io_port + (shp->n_io_port - 1), shp->irq);
+ } else {
+ if (asc_dvc_varp->bus_type & ASC_IS_VL) {
+ busname = "VL";
+ } else if (asc_dvc_varp->bus_type & ASC_IS_EISA) {
+ busname = "EISA";
+ } else {
+ busname = "?";
+ ASC_PRINT2(
"advansys_info: board %d: unknown bus type %d\n",
- boardp->id, asc_dvc_varp->bus_type);
- }
- sprintf(info,
- "AdvanSys SCSI %s: %s %u CDB: BIOS %X, IO %X-%X, IRQ %u",
- ASC_VERSION, busname, boardp->asc_dvc_var.max_total_qng,
- (unsigned) shp->base, shp->io_port,
- shp->io_port + (shp->n_io_port - 1), shp->irq);
- }
-#ifdef ADVANSYS_DEBUG
- ASC_ASSERT(strlen(info) < ASC_INFO_SIZE);
-#endif /* ADVANSYS_DEBUG */
- ASC_DBG(1, "advansys_info: end\n");
- return info;
+ boardp->id, asc_dvc_varp->bus_type);
+ }
+ sprintf(info,
+ "AdvanSys SCSI %s: %s %u CDB: BIOS %X, IO %X-%X, IRQ %u",
+ ASC_VERSION, busname, boardp->asc_dvc_var.max_total_qng,
+ (unsigned) shp->base, shp->io_port,
+ shp->io_port + (shp->n_io_port - 1), shp->irq);
+ }
+ ASC_ASSERT(strlen(info) < ASC_INFO_SIZE);
+ ASC_DBG(1, "advansys_info: end\n");
+ return info;
}
/*
@@ -3618,19 +3659,19 @@ advansys_info(struct Scsi_Host *shp)
int
advansys_command(Scsi_Cmnd *scp)
{
- ASC_DBG1(1, "advansys_command: scp %x\n", (unsigned) scp);
- ASC_STATS(scp->host, command);
- scp->SCp.Status = 0; /* Set to a known state */
- advansys_queuecommand(scp, advansys_command_done);
- /*
- * XXX - Can host drivers block here instead of spinning on
- * command status?
- */
- while (scp->SCp.Status == 0) {
- continue;
- }
- ASC_DBG1(1, "advansys_command: result %x\n", scp->result);
- return scp->result;
+ ASC_DBG1(1, "advansys_command: scp %x\n", (unsigned) scp);
+ ASC_STATS(scp->host, command);
+ scp->SCp.Status = 0; /* Set to a known state */
+ advansys_queuecommand(scp, advansys_command_done);
+ /*
+ * XXX - Can host drivers block here instead of spinning on
+ * command status?
+ */
+ while (scp->SCp.Status == 0) {
+ continue;
+ }
+ ASC_DBG1(1, "advansys_command: result %x\n", scp->result);
+ return scp->result;
}
/*
@@ -3642,89 +3683,89 @@ advansys_command(Scsi_Cmnd *scp)
int
advansys_queuecommand(Scsi_Cmnd *scp, void (*done)(Scsi_Cmnd *))
{
- struct Scsi_Host *shp;
- asc_board_t *boardp;
- int flags;
- Scsi_Cmnd *done_scp;
-
- shp = scp->host;
- boardp = ASC_BOARDP(shp);
- ASC_STATS(shp, queuecommand);
-
- /*
- * Disable interrupts to preserve request ordering and provide
- * mutually exclusive access to global structures used to initiate
- * a request.
- */
- save_flags(flags);
- cli();
-
- /*
- * Block new commands while handling a reset or abort request.
- */
- if (boardp->flags & (ASC_HOST_IN_RESET | ASC_HOST_IN_ABORT)) {
- if (boardp->flags & ASC_HOST_IN_RESET) {
- ASC_DBG1(1,
- "advansys_queuecommand: scp %x blocked for reset request\n",
- (unsigned) scp);
- scp->result = HOST_BYTE(DID_RESET);
- } else {
- ASC_DBG1(1,
- "advansys_queuecommand: scp %x blocked for abort request\n",
- (unsigned) scp);
- scp->result = HOST_BYTE(DID_ABORT);
- }
-
- /*
- * Add blocked requests to the board's 'done' queue. The queued
- * requests will be completed at the end of the abort or reset
- * handling.
- */
- asc_enqueue(&boardp->done, scp, ASC_BACK);
- restore_flags(flags);
- return 0;
- }
-
- /*
- * Attempt to execute any waiting commands for the board.
- */
- if (!ASC_QUEUE_EMPTY(&boardp->waiting)) {
- ASC_DBG(1,
- "advansys_queuecommand: before asc_execute_queue() waiting\n");
- asc_execute_queue(&boardp->waiting);
- }
-
- /*
- * Save the function pointer to Linux mid-level 'done' function
- * and attempt to execute the command.
- *
- * If ASC_ERROR is returned the request has been added to the
- * board's 'active' queue and will be completed by the interrupt
- * handler.
- *
- * If ASC_BUSY is returned add the request to the board's per
- * target waiting list.
- *
- * If an error occurred, the request will have been placed on the
- * board's 'done' queue and must be completed before returning.
- */
- scp->scsi_done = done;
- switch (asc_execute_scsi_cmnd(scp)) {
- case ASC_NOERROR:
- break;
- case ASC_BUSY:
- asc_enqueue(&boardp->waiting, scp, ASC_BACK);
- break;
- case ASC_ERROR:
- default:
- done_scp = asc_dequeue_list(&boardp->done, NULL, ASC_TID_ALL);
- /* Interrupts could be enabled here. */
- asc_scsi_done_list(done_scp);
- break;
- }
-
- restore_flags(flags);
- return 0;
+ struct Scsi_Host *shp;
+ asc_board_t *boardp;
+ int flags;
+ Scsi_Cmnd *done_scp;
+
+ shp = scp->host;
+ boardp = ASC_BOARDP(shp);
+ ASC_STATS(shp, queuecommand);
+
+ /*
+ * Disable interrupts to preserve request ordering and provide
+ * mutually exclusive access to global structures used to initiate
+ * a request.
+ */
+ save_flags(flags);
+ cli();
+
+ /*
+ * Block new commands while handling a reset or abort request.
+ */
+ if (boardp->flags & (ASC_HOST_IN_RESET | ASC_HOST_IN_ABORT)) {
+ if (boardp->flags & ASC_HOST_IN_RESET) {
+ ASC_DBG1(1,
+ "advansys_queuecommand: scp %x blocked for reset request\n",
+ (unsigned) scp);
+ scp->result = HOST_BYTE(DID_RESET);
+ } else {
+ ASC_DBG1(1,
+ "advansys_queuecommand: scp %x blocked for abort request\n",
+ (unsigned) scp);
+ scp->result = HOST_BYTE(DID_ABORT);
+ }
+
+ /*
+ * Add blocked requests to the board's 'done' queue. The queued
+ * requests will be completed at the end of the abort or reset
+ * handling.
+ */
+ asc_enqueue(&boardp->done, scp, ASC_BACK);
+ restore_flags(flags);
+ return 0;
+ }
+
+ /*
+ * Attempt to execute any waiting commands for the board.
+ */
+ if (!ASC_QUEUE_EMPTY(&boardp->waiting)) {
+ ASC_DBG(1,
+ "advansys_queuecommand: before asc_execute_queue() waiting\n");
+ asc_execute_queue(&boardp->waiting);
+ }
+
+ /*
+ * Save the function pointer to Linux mid-level 'done' function
+ * and attempt to execute the command.
+ *
+ * If ASC_ERROR is returned the request has been added to the
+ * board's 'active' queue and will be completed by the interrupt
+ * handler.
+ *
+ * If ASC_BUSY is returned add the request to the board's per
+ * target waiting list.
+ *
+ * If an error occurred, the request will have been placed on the
+ * board's 'done' queue and must be completed before returning.
+ */
+ scp->scsi_done = done;
+ switch (asc_execute_scsi_cmnd(scp)) {
+ case ASC_NOERROR:
+ break;
+ case ASC_BUSY:
+ asc_enqueue(&boardp->waiting, scp, ASC_BACK);
+ break;
+ case ASC_ERROR:
+ default:
+ done_scp = asc_dequeue_list(&boardp->done, NULL, ASC_TID_ALL);
+ /* Interrupts could be enabled here. */
+ asc_scsi_done_list(done_scp);
+ break;
+ }
+
+ restore_flags(flags);
+ return 0;
}
/*
@@ -3735,193 +3776,193 @@ advansys_queuecommand(Scsi_Cmnd *scp, void (*done)(Scsi_Cmnd *))
int
advansys_abort(Scsi_Cmnd *scp)
{
- struct Scsi_Host *shp;
- asc_board_t *boardp;
- ASC_DVC_VAR *asc_dvc_varp;
- int flags;
- int do_scsi_done;
- int scp_found;
- Scsi_Cmnd *done_scp = NULL;
- int ret;
+ struct Scsi_Host *shp;
+ asc_board_t *boardp;
+ ASC_DVC_VAR *asc_dvc_varp;
+ int flags;
+ int do_scsi_done;
+ int scp_found;
+ Scsi_Cmnd *done_scp = NULL;
+ int ret;
- /* Save current flags and disable interrupts. */
- save_flags(flags);
- cli();
+ /* Save current flags and disable interrupts. */
+ save_flags(flags);
+ cli();
- ASC_DBG1(1, "advansys_abort: scp %x\n", (unsigned) scp);
+ ASC_DBG1(1, "advansys_abort: scp %x\n", (unsigned) scp);
#ifdef ADVANSYS_STATS
- if (scp->host != NULL) {
- ASC_STATS(scp->host, abort);
- }
+ if (scp->host != NULL) {
+ ASC_STATS(scp->host, abort);
+ }
#endif /* ADVANSYS_STATS */
-#ifdef ADVVANSYS_DEBUG
- do_scsi_done = ASC_ERROR;
- scp_found = ASC_ERROR;
- ret = ASC_ERROR;
-#endif /* ADVANSYS_DEBUG */
+#ifdef ADVANSYS_ASSERT
+ do_scsi_done = ASC_ERROR;
+ scp_found = ASC_ERROR;
+ ret = ASC_ERROR;
+#endif /* ADVANSYS_ASSERT */
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
- if (scp->serial_number != scp->serial_number_at_timeout) {
- ASC_PRINT1(
+ if (scp->serial_number != scp->serial_number_at_timeout) {
+ ASC_PRINT1(
"advansys_abort: timeout serial number changed for request %x\n",
- (unsigned) scp);
- do_scsi_done = ASC_FALSE;
- scp_found = ASC_FALSE;
- ret = SCSI_ABORT_NOT_RUNNING;
- } else
+ (unsigned) scp);
+ do_scsi_done = ASC_FALSE;
+ scp_found = ASC_FALSE;
+ ret = SCSI_ABORT_NOT_RUNNING;
+ } else
#endif /* version >= v1.3.89 */
- if ((shp = scp->host) == NULL) {
- scp->result = HOST_BYTE(DID_ERROR);
- do_scsi_done = ASC_TRUE;
- scp_found = ASC_FALSE;
- ret = SCSI_ABORT_ERROR;
- } else if ((boardp = ASC_BOARDP(shp))->flags &
- (ASC_HOST_IN_RESET | ASC_HOST_IN_ABORT)) {
- ASC_PRINT2(
+ if ((shp = scp->host) == NULL) {
+ scp->result = HOST_BYTE(DID_ERROR);
+ do_scsi_done = ASC_TRUE;
+ scp_found = ASC_FALSE;
+ ret = SCSI_ABORT_ERROR;
+ } else if ((boardp = ASC_BOARDP(shp))->flags &
+ (ASC_HOST_IN_RESET | ASC_HOST_IN_ABORT)) {
+ ASC_PRINT2(
"advansys_abort: board %d: Nested host reset or abort, flags 0x%x\n",
- boardp->id, boardp->flags);
- do_scsi_done = ASC_TRUE;
- if ((asc_rmqueue(&boardp->active, scp) == ASC_TRUE) ||
- (asc_rmqueue(&boardp->waiting, scp) == ASC_TRUE)) {
- scp_found = ASC_TRUE;
- } else {
- scp_found = ASC_FALSE;
- }
- scp->result = HOST_BYTE(DID_ERROR);
- ret = SCSI_ABORT_ERROR;
- } else {
- /* Set abort flag to avoid nested reset or abort requests. */
- boardp->flags |= ASC_HOST_IN_ABORT;
-
- do_scsi_done = ASC_TRUE;
- if (asc_rmqueue(&boardp->waiting, scp) == ASC_TRUE) {
- /*
- * If asc_rmqueue() found the command on the waiting
- * queue, it had not been sent to the device. After
- * the queue is removed, no other handling is required.
- */
- ASC_DBG1(1, "advansys_abort: scp %x found on waiting queue\n",
- (unsigned) scp);
- scp_found = ASC_TRUE;
- scp->result = HOST_BYTE(DID_ABORT);
- ret = SCSI_ABORT_SUCCESS;
- } else if (asc_isqueued(&boardp->active, scp) == ASC_TRUE) {
- /*
- * If asc_isqueued() found the command on the active
- * queue, it has been sent to the device. The command
- * should be returned through the interrupt handler after
- * calling AscAbortSRB().
- */
- asc_dvc_varp = &boardp->asc_dvc_var;
- scp->result = HOST_BYTE(DID_ABORT);
-
- sti(); /* Enable interrupts for AscAbortSRB(). */
- ASC_DBG1(1, "advansys_abort: before AscAbortSRB(), scp %x\n",
- (unsigned) scp);
- switch (AscAbortSRB(asc_dvc_varp, (ulong) scp)) {
- case ASC_TRUE:
- /* asc_isr_callback() will be called */
- ASC_DBG(1, "advansys_abort: AscAbortSRB() TRUE\n");
- ret = SCSI_ABORT_PENDING;
- break;
- case ASC_FALSE:
- /* Request has apparently already completed. */
- ASC_DBG(1, "advansys_abort: AscAbortSRB() FALSE\n");
- ret = SCSI_ABORT_NOT_RUNNING;
- break;
- case ASC_ERROR:
- default:
- ASC_DBG(1, "advansys_abort: AscAbortSRB() ERROR\n");
- ret = SCSI_ABORT_ERROR;
- break;
- }
- cli();
-
- /*
- * The request will either still be on the active queue
- * or have been added to the board's done queue.
- */
- if (asc_rmqueue(&boardp->active, scp) == ASC_TRUE) {
- scp->result = HOST_BYTE(DID_ABORT);
- scp_found = ASC_TRUE;
- } else {
- scp_found = asc_rmqueue(&boardp->done, scp);
- ASC_ASSERT(scp_found == ASC_TRUE);
- }
-
- } else {
- /*
- * The command was not found on the active or waiting queues.
- */
- do_scsi_done = ASC_TRUE;
- scp_found = ASC_FALSE;
- ret = SCSI_ABORT_NOT_RUNNING;
- }
-
- /* Clear abort flag. */
- boardp->flags &= ~ASC_HOST_IN_ABORT;
-
- /*
- * Because the ASC_HOST_IN_ABORT flag causes both
- * 'advansys_interrupt' and 'asc_isr_callback' to
- * queue requests to the board's 'done' queue and
- * prevents waiting commands from being executed,
- * these queued requests must be handled here.
- */
- done_scp = asc_dequeue_list(&boardp->done, NULL, ASC_TID_ALL);
-
- /*
- * Start any waiting commands for the board.
- */
- if (!ASC_QUEUE_EMPTY(&boardp->waiting)) {
- ASC_DBG(1, "advansys_interrupt: before asc_execute_queue()\n");
- asc_execute_queue(&boardp->waiting);
- }
- }
-
- /* Interrupts could be enabled here. */
-
- /*
- * Complete the request to be aborted, unless it has been
- * restarted as detected above, even if it was not found on
- * the device active or waiting queues.
- */
- ASC_ASSERT(do_scsi_done != ASC_ERROR);
- ASC_ASSERT(scp_found != ASC_ERROR);
- if (do_scsi_done == ASC_TRUE) {
- if (scp->scsi_done == NULL) {
- ASC_PRINT1(
+ boardp->id, boardp->flags);
+ do_scsi_done = ASC_TRUE;
+ if ((asc_rmqueue(&boardp->active, scp) == ASC_TRUE) ||
+ (asc_rmqueue(&boardp->waiting, scp) == ASC_TRUE)) {
+ scp_found = ASC_TRUE;
+ } else {
+ scp_found = ASC_FALSE;
+ }
+ scp->result = HOST_BYTE(DID_ERROR);
+ ret = SCSI_ABORT_ERROR;
+ } else {
+ /* Set abort flag to avoid nested reset or abort requests. */
+ boardp->flags |= ASC_HOST_IN_ABORT;
+
+ do_scsi_done = ASC_TRUE;
+ if (asc_rmqueue(&boardp->waiting, scp) == ASC_TRUE) {
+ /*
+ * If asc_rmqueue() found the command on the waiting
+ * queue, it had not been sent to the device. After
+ * the queue is removed, no other handling is required.
+ */
+ ASC_DBG1(1, "advansys_abort: scp %x found on waiting queue\n",
+ (unsigned) scp);
+ scp_found = ASC_TRUE;
+ scp->result = HOST_BYTE(DID_ABORT);
+ ret = SCSI_ABORT_SUCCESS;
+ } else if (asc_isqueued(&boardp->active, scp) == ASC_TRUE) {
+ /*
+ * If asc_isqueued() found the command on the active
+ * queue, it has been sent to the device. The command
+ * should be returned through the interrupt handler after
+ * calling AscAbortSRB().
+ */
+ asc_dvc_varp = &boardp->asc_dvc_var;
+ scp->result = HOST_BYTE(DID_ABORT);
+
+ sti(); /* Enable interrupts for AscAbortSRB(). */
+ ASC_DBG1(1, "advansys_abort: before AscAbortSRB(), scp %x\n",
+ (unsigned) scp);
+ switch (AscAbortSRB(asc_dvc_varp, (ulong) scp)) {
+ case ASC_TRUE:
+ /* asc_isr_callback() will be called */
+ ASC_DBG(1, "advansys_abort: AscAbortSRB() TRUE\n");
+ ret = SCSI_ABORT_PENDING;
+ break;
+ case ASC_FALSE:
+ /* Request has apparently already completed. */
+ ASC_DBG(1, "advansys_abort: AscAbortSRB() FALSE\n");
+ ret = SCSI_ABORT_NOT_RUNNING;
+ break;
+ case ASC_ERROR:
+ default:
+ ASC_DBG(1, "advansys_abort: AscAbortSRB() ERROR\n");
+ ret = SCSI_ABORT_ERROR;
+ break;
+ }
+ cli();
+
+ /*
+ * The request will either still be on the active queue
+ * or have been added to the board's done queue.
+ */
+ if (asc_rmqueue(&boardp->active, scp) == ASC_TRUE) {
+ scp->result = HOST_BYTE(DID_ABORT);
+ scp_found = ASC_TRUE;
+ } else {
+ scp_found = asc_rmqueue(&boardp->done, scp);
+ ASC_ASSERT(scp_found == ASC_TRUE);
+ }
+
+ } else {
+ /*
+ * The command was not found on the active or waiting queues.
+ */
+ do_scsi_done = ASC_TRUE;
+ scp_found = ASC_FALSE;
+ ret = SCSI_ABORT_NOT_RUNNING;
+ }
+
+ /* Clear abort flag. */
+ boardp->flags &= ~ASC_HOST_IN_ABORT;
+
+ /*
+ * Because the ASC_HOST_IN_ABORT flag causes both
+ * 'advansys_interrupt' and 'asc_isr_callback' to
+ * queue requests to the board's 'done' queue and
+ * prevents waiting commands from being executed,
+ * these queued requests must be handled here.
+ */
+ done_scp = asc_dequeue_list(&boardp->done, NULL, ASC_TID_ALL);
+
+ /*
+ * Start any waiting commands for the board.
+ */
+ if (!ASC_QUEUE_EMPTY(&boardp->waiting)) {
+ ASC_DBG(1, "advansys_interrupt: before asc_execute_queue()\n");
+ asc_execute_queue(&boardp->waiting);
+ }
+ }
+
+ /* Interrupts could be enabled here. */
+
+ /*
+ * Complete the request to be aborted, unless it has been
+ * restarted as detected above, even if it was not found on
+ * the device active or waiting queues.
+ */
+ ASC_ASSERT(do_scsi_done != ASC_ERROR);
+ ASC_ASSERT(scp_found != ASC_ERROR);
+ if (do_scsi_done == ASC_TRUE) {
+ if (scp->scsi_done == NULL) {
+ ASC_PRINT1(
"advansys_abort: aborted request scsi_done() is NULL, %x\n",
- (unsigned) scp);
- } else {
- if (scp_found == ASC_FALSE) {
- ASC_PRINT1(
+ (unsigned) scp);
+ } else {
+ if (scp_found == ASC_FALSE) {
+ ASC_PRINT1(
"advansys_abort: abort request not active or waiting, completing anyway %x\n",
- (unsigned) scp);
- }
- ASC_STATS(scp->host, done);
- scp->scsi_done(scp);
- }
- }
+ (unsigned) scp);
+ }
+ ASC_STATS(scp->host, done);
+ scp->scsi_done(scp);
+ }
+ }
- /*
- * It is possible for the request done function to re-enable
- * interrupts without confusing the driver. But here interrupts
- * aren't enabled until all requests have been completed.
- */
- if (done_scp != NULL) {
- asc_scsi_done_list(done_scp);
- }
+ /*
+ * It is possible for the request done function to re-enable
+ * interrupts without confusing the driver. But here interrupts
+ * aren't enabled until all requests have been completed.
+ */
+ if (done_scp != NULL) {
+ asc_scsi_done_list(done_scp);
+ }
- ASC_DBG1(1, "advansys_abort: ret %d\n", ret);
+ ASC_DBG1(1, "advansys_abort: ret %d\n", ret);
- /* Re-enable interrupts, if they were enabled on entry. */
- restore_flags(flags);
+ /* Re-enable interrupts, if they were enabled on entry. */
+ restore_flags(flags);
- ASC_ASSERT(ret != ASC_ERROR);
- return ret;
+ ASC_ASSERT(ret != ASC_ERROR);
+ return ret;
}
/*
@@ -3936,304 +3977,305 @@ advansys_reset(Scsi_Cmnd *scp)
advansys_reset(Scsi_Cmnd *scp, unsigned int reset_flags)
#endif /* version >= v1.3.89 */
{
- struct Scsi_Host *shp;
- asc_board_t *boardp;
- ASC_DVC_VAR *asc_dvc_varp;
- int flags;
- Scsi_Cmnd *done_scp = NULL, *last_scp = NULL;
- Scsi_Cmnd *tscp, *new_last_scp;
- int do_scsi_done;
- int scp_found;
- int status;
- int target;
- int ret;
+ struct Scsi_Host *shp;
+ asc_board_t *boardp;
+ ASC_DVC_VAR *asc_dvc_varp;
+ int flags;
+ Scsi_Cmnd *done_scp = NULL, *last_scp = NULL;
+ Scsi_Cmnd *tscp, *new_last_scp;
+ int do_scsi_done;
+ int scp_found;
+ int status;
+ int target;
+ int ret;
- /* Save current flags and disable interrupts. */
- save_flags(flags);
- cli();
+ /* Save current flags and disable interrupts. */
+ save_flags(flags);
+ cli();
- ASC_DBG1(1, "advansys_reset: %x\n", (unsigned) scp);
+ ASC_DBG1(1, "advansys_reset: %x\n", (unsigned) scp);
#ifdef ADVANSYS_STATS
- if (scp->host != NULL) {
- ASC_STATS(scp->host, reset);
- }
+ if (scp->host != NULL) {
+ ASC_STATS(scp->host, reset);
+ }
#endif /* ADVANSYS_STATS */
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
- if (scp->serial_number != scp->serial_number_at_timeout) {
- ASC_PRINT1(
+ if ((reset_flags & SCSI_RESET_ASYNCHRONOUS) &&
+ (scp->serial_number != scp->serial_number_at_timeout)) {
+ ASC_PRINT1(
"advansys_reset: timeout serial number changed for request %x\n",
- (unsigned) scp);
- do_scsi_done = ASC_FALSE;
- scp_found = ASC_FALSE;
- ret = SCSI_RESET_NOT_RUNNING;
- } else
+ (unsigned) scp);
+ do_scsi_done = ASC_FALSE;
+ scp_found = ASC_FALSE;
+ ret = SCSI_RESET_NOT_RUNNING;
+ } else
#endif /* version >= v1.3.89 */
- if ((shp = scp->host) == NULL) {
- scp->result = HOST_BYTE(DID_ERROR);
- do_scsi_done = ASC_TRUE;
- scp_found = ASC_FALSE;
- ret = SCSI_RESET_ERROR;
- } else if ((boardp = ASC_BOARDP(shp))->flags &
- (ASC_HOST_IN_RESET | ASC_HOST_IN_ABORT)) {
- ASC_PRINT2(
+ if ((shp = scp->host) == NULL) {
+ scp->result = HOST_BYTE(DID_ERROR);
+ do_scsi_done = ASC_TRUE;
+ scp_found = ASC_FALSE;
+ ret = SCSI_RESET_ERROR;
+ } else if ((boardp = ASC_BOARDP(shp))->flags &
+ (ASC_HOST_IN_RESET | ASC_HOST_IN_ABORT)) {
+ ASC_PRINT2(
"advansys_reset: board %d: Nested host reset or abort, flags 0x%x\n",
- boardp->id, boardp->flags);
- do_scsi_done = ASC_TRUE;
- if ((asc_rmqueue(&boardp->active, scp) == ASC_TRUE) ||
- (asc_rmqueue(&boardp->waiting, scp) == ASC_TRUE)) {
- scp_found = ASC_TRUE;
- } else {
- scp_found = ASC_FALSE;
- }
- scp->result = HOST_BYTE(DID_ERROR);
- ret = SCSI_RESET_ERROR;
- } else if (jiffies >= boardp->last_reset &&
- jiffies < (boardp->last_reset + (10 * HZ))) {
- /*
- * Don't allow a reset to be attempted within 10 seconds
- * of the last reset.
- *
- * If 'jiffies' wrapping occurs, the reset request will go
- * through, because a wrapped 'jiffies' would not pass the
- * test above.
- */
- ASC_DBG(1,
- "advansys_reset: reset within 10 sec of last reset ignored\n");
- do_scsi_done = ASC_TRUE;
- if ((asc_rmqueue(&boardp->active, scp) == ASC_TRUE) ||
- (asc_rmqueue(&boardp->waiting, scp) == ASC_TRUE)) {
- scp_found = ASC_TRUE;
- } else {
- scp_found = ASC_FALSE;
- }
- scp->result = HOST_BYTE(DID_ERROR);
- ret = SCSI_RESET_ERROR;
- } else {
- int device_reset = ASC_FALSE;
-
- do_scsi_done = ASC_TRUE;
-
- /* Set reset flag to avoid nested reset or abort requests. */
- boardp->flags |= ASC_HOST_IN_RESET;
-
- /*
- * If the request is on the target waiting or active queue
- * or the board done queue, then remove it and note that it
- * was found.
- */
- if (asc_rmqueue(&boardp->active, scp) == ASC_TRUE) {
- ASC_DBG(1, "advansys_reset: active scp_found = TRUE\n");
- scp_found = ASC_TRUE;
- } else if (asc_rmqueue(&boardp->waiting, scp) == ASC_TRUE) {
- ASC_DBG(1, "advansys_reset: waiting scp_found = TRUE\n");
- scp_found = ASC_TRUE;
- } else if (asc_rmqueue(&boardp->done, scp) == ASC_TRUE) {
- scp_found = ASC_TRUE;
- } else {
- scp_found = ASC_FALSE;
- }
-
- /*
- * If the suggest reset bus flags are set, reset the bus.
- * Otherwise only reset the device.
- */
- asc_dvc_varp = &boardp->asc_dvc_var;
+ boardp->id, boardp->flags);
+ do_scsi_done = ASC_TRUE;
+ if ((asc_rmqueue(&boardp->active, scp) == ASC_TRUE) ||
+ (asc_rmqueue(&boardp->waiting, scp) == ASC_TRUE)) {
+ scp_found = ASC_TRUE;
+ } else {
+ scp_found = ASC_FALSE;
+ }
+ scp->result = HOST_BYTE(DID_ERROR);
+ ret = SCSI_RESET_ERROR;
+ } else if (jiffies >= boardp->last_reset &&
+ jiffies < (boardp->last_reset + (10 * HZ))) {
+ /*
+ * Don't allow a reset to be attempted within 10 seconds
+ * of the last reset.
+ *
+ * If 'jiffies' wrapping occurs, the reset request will go
+ * through, because a wrapped 'jiffies' would not pass the
+ * test above.
+ */
+ ASC_DBG(1,
+ "advansys_reset: reset within 10 sec of last reset ignored\n");
+ do_scsi_done = ASC_TRUE;
+ if ((asc_rmqueue(&boardp->active, scp) == ASC_TRUE) ||
+ (asc_rmqueue(&boardp->waiting, scp) == ASC_TRUE)) {
+ scp_found = ASC_TRUE;
+ } else {
+ scp_found = ASC_FALSE;
+ }
+ scp->result = HOST_BYTE(DID_ERROR);
+ ret = SCSI_RESET_ERROR;
+ } else {
+ int device_reset = ASC_FALSE;
+
+ do_scsi_done = ASC_TRUE;
+
+ /* Set reset flag to avoid nested reset or abort requests. */
+ boardp->flags |= ASC_HOST_IN_RESET;
+
+ /*
+ * If the request is on the target waiting or active queue
+ * or the board done queue, then remove it and note that it
+ * was found.
+ */
+ if (asc_rmqueue(&boardp->active, scp) == ASC_TRUE) {
+ ASC_DBG(1, "advansys_reset: active scp_found = TRUE\n");
+ scp_found = ASC_TRUE;
+ } else if (asc_rmqueue(&boardp->waiting, scp) == ASC_TRUE) {
+ ASC_DBG(1, "advansys_reset: waiting scp_found = TRUE\n");
+ scp_found = ASC_TRUE;
+ } else if (asc_rmqueue(&boardp->done, scp) == ASC_TRUE) {
+ scp_found = ASC_TRUE;
+ } else {
+ scp_found = ASC_FALSE;
+ }
+
+ /*
+ * If the suggest reset bus flags are set, reset the bus.
+ * Otherwise only reset the device.
+ */
+ asc_dvc_varp = &boardp->asc_dvc_var;
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
- if (reset_flags &
- (SCSI_RESET_SUGGEST_BUS_RESET | SCSI_RESET_SUGGEST_HOST_RESET)) {
+ if (reset_flags &
+ (SCSI_RESET_SUGGEST_BUS_RESET | SCSI_RESET_SUGGEST_HOST_RESET)) {
#endif /* version >= v1.3.89 */
- /*
- * Reset the target's SCSI bus.
- */
- ASC_DBG(1, "advansys_reset: before AscResetSB()\n");
- sti(); /* Enable interrupts for AscResetSB(). */
- status = AscResetSB(asc_dvc_varp);
- cli();
- switch (status) {
- case ASC_TRUE:
- ASC_DBG(1, "advansys_reset: AscResetSB() success\n");
- ret = SCSI_RESET_SUCCESS;
- break;
- case ASC_ERROR:
- default:
- ASC_DBG(1, "advansys_reset: AscResetSB() failed\n");
- ret = SCSI_RESET_ERROR;
- break;
- }
+ /*
+ * Reset the target's SCSI bus.
+ */
+ ASC_DBG(1, "advansys_reset: before AscResetSB()\n");
+ sti(); /* Enable interrupts for AscResetSB(). */
+ status = AscResetSB(asc_dvc_varp);
+ cli();
+ switch (status) {
+ case ASC_TRUE:
+ ASC_DBG(1, "advansys_reset: AscResetSB() success\n");
+ ret = SCSI_RESET_SUCCESS;
+ break;
+ case ASC_ERROR:
+ default:
+ ASC_DBG(1, "advansys_reset: AscResetSB() failed\n");
+ ret = SCSI_RESET_ERROR;
+ break;
+ }
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
- } else {
- /*
- * Reset the specified device. If the device reset fails,
- * then reset the SCSI bus.
- */
-
- ASC_DBG1(1, "advansys_reset: before AscResetDevice(), target %d\n",
- scp->target);
- sti(); /* Enable interrupts for AscResetDevice(). */
- status = AscResetDevice(asc_dvc_varp, scp->target);
- cli();
-
- /*
- * If the device has been reset, try to initialize it.
- */
- if (status == ASC_TRUE) {
- status = asc_init_dev(asc_dvc_varp, scp);
- }
-
- switch (status) {
- case ASC_TRUE:
- ASC_DBG(1, "advansys_reset: AscResetDevice() success\n");
- device_reset = ASC_TRUE;
- ret = SCSI_RESET_SUCCESS;
- break;
- case ASC_ERROR:
- default:
- ASC_DBG(1,
+ } else {
+ /*
+ * Reset the specified device. If the device reset fails,
+ * then reset the SCSI bus.
+ */
+
+ ASC_DBG1(1, "advansys_reset: before AscResetDevice(), target %d\n",
+ scp->target);
+ sti(); /* Enable interrupts for AscResetDevice(). */
+ status = AscResetDevice(asc_dvc_varp, scp->target);
+ cli();
+
+ /*
+ * If the device has been reset, try to initialize it.
+ */
+ if (status == ASC_TRUE) {
+ status = asc_init_dev(asc_dvc_varp, scp);
+ }
+
+ switch (status) {
+ case ASC_TRUE:
+ ASC_DBG(1, "advansys_reset: AscResetDevice() success\n");
+ device_reset = ASC_TRUE;
+ ret = SCSI_RESET_SUCCESS;
+ break;
+ case ASC_ERROR:
+ default:
+ ASC_DBG(1,
"advansys_reset: AscResetDevice() failed; Calling AscResetSB()\n");
- sti(); /* Enable interrupts for AscResetSB(). */
- status = AscResetSB(asc_dvc_varp);
- cli();
- switch (status) {
- case ASC_TRUE:
- ASC_DBG(1, "advansys_reset: AscResetSB() TRUE\n");
- ret = SCSI_RESET_SUCCESS;
- break;
- case ASC_ERROR:
- default:
- ASC_DBG(1, "advansys_reset: AscResetSB() ERROR\n");
- ret = SCSI_RESET_ERROR;
- break;
- }
- break;
- }
- }
+ sti(); /* Enable interrupts for AscResetSB(). */
+ status = AscResetSB(asc_dvc_varp);
+ cli();
+ switch (status) {
+ case ASC_TRUE:
+ ASC_DBG(1, "advansys_reset: AscResetSB() TRUE\n");
+ ret = SCSI_RESET_SUCCESS;
+ break;
+ case ASC_ERROR:
+ default:
+ ASC_DBG(1, "advansys_reset: AscResetSB() ERROR\n");
+ ret = SCSI_RESET_ERROR;
+ break;
+ }
+ break;
+ }
+ }
#endif /* version >= v1.3.89 */
- /*
- * Because the ASC_HOST_IN_RESET flag causes both
- * 'advansys_interrupt' and 'asc_isr_callback' to
- * queue requests to the board's 'done' queue and
- * prevents waiting commands from being executed,
- * these queued requests must be handled here.
- */
- done_scp = asc_dequeue_list(&boardp->done, &last_scp,
- ASC_TID_ALL);
-
- /*
- * If a device reset was performed dequeue all waiting
- * and active requests for the device and set the request
- * status to DID_RESET.
- *
- * If a SCSI bus reset was performed dequeue all waiting
- * and active requests for all devices and set the request
- * status to DID_RESET.
- */
- if (device_reset == ASC_TRUE) {
- target = scp->target;
- } else {
- target = ASC_TID_ALL;
- }
-
- /*
- * Add active requests to 'done_scp' and set the request status
- * to DID_RESET.
- */
- if (done_scp == NULL) {
- done_scp = asc_dequeue_list(&boardp->active, &last_scp, target);
- for (tscp = done_scp; tscp; tscp = REQPNEXT(tscp)) {
- tscp->result = HOST_BYTE(DID_RESET);
- }
- } else {
- ASC_ASSERT(last_scp != NULL);
- REQPNEXT(last_scp) = asc_dequeue_list(&boardp->active,
- &new_last_scp, target);
- if (new_last_scp != NULL) {
- ASC_ASSERT(REQPNEXT(last_scp) != NULL);
- for (tscp = REQPNEXT(last_scp); tscp; tscp = REQPNEXT(tscp)) {
- tscp->result = HOST_BYTE(DID_RESET);
- }
- last_scp = new_last_scp;
- }
- }
-
- /*
- * Add waiting requests to 'done_scp' and set the request status
- * to DID_RESET.
- */
- if (done_scp == NULL) {
- done_scp = asc_dequeue_list(&boardp->waiting, &last_scp, target);
- for (tscp = done_scp; tscp; tscp = REQPNEXT(tscp)) {
- tscp->result = HOST_BYTE(DID_RESET);
- }
- } else {
- ASC_ASSERT(last_scp != NULL);
- REQPNEXT(last_scp) = asc_dequeue_list(&boardp->waiting,
- &new_last_scp, target);
- if (new_last_scp != NULL) {
- ASC_ASSERT(REQPNEXT(last_scp) != NULL);
- for (tscp = REQPNEXT(last_scp); tscp; tscp = REQPNEXT(tscp)) {
- tscp->result = HOST_BYTE(DID_RESET);
- }
- last_scp = new_last_scp;
- }
- }
-
- /* Save the time of the most recently completed reset. */
- boardp->last_reset = jiffies;
-
- /* Clear reset flag. */
- boardp->flags &= ~ASC_HOST_IN_RESET;
-
- /*
- * Start any waiting commands for the board.
- */
- if (!ASC_QUEUE_EMPTY(&boardp->waiting)) {
- ASC_DBG(1, "advansys_interrupt: before asc_execute_queue()\n");
- asc_execute_queue(&boardp->waiting);
- }
- ret = SCSI_RESET_SUCCESS;
- }
-
- /* Interrupts could be enabled here. */
-
- ASC_ASSERT(do_scsi_done != ASC_ERROR);
- ASC_ASSERT(scp_found != ASC_ERROR);
- if (do_scsi_done == ASC_TRUE) {
- if (scp->scsi_done == NULL) {
- ASC_PRINT1(
+ /*
+ * Because the ASC_HOST_IN_RESET flag causes both
+ * 'advansys_interrupt' and 'asc_isr_callback' to
+ * queue requests to the board's 'done' queue and
+ * prevents waiting commands from being executed,
+ * these queued requests must be handled here.
+ */
+ done_scp = asc_dequeue_list(&boardp->done, &last_scp,
+ ASC_TID_ALL);
+
+ /*
+ * If a device reset was performed dequeue all waiting
+ * and active requests for the device and set the request
+ * status to DID_RESET.
+ *
+ * If a SCSI bus reset was performed dequeue all waiting
+ * and active requests for all devices and set the request
+ * status to DID_RESET.
+ */
+ if (device_reset == ASC_TRUE) {
+ target = scp->target;
+ } else {
+ target = ASC_TID_ALL;
+ }
+
+ /*
+ * Add active requests to 'done_scp' and set the request status
+ * to DID_RESET.
+ */
+ if (done_scp == NULL) {
+ done_scp = asc_dequeue_list(&boardp->active, &last_scp, target);
+ for (tscp = done_scp; tscp; tscp = REQPNEXT(tscp)) {
+ tscp->result = HOST_BYTE(DID_RESET);
+ }
+ } else {
+ ASC_ASSERT(last_scp != NULL);
+ REQPNEXT(last_scp) = asc_dequeue_list(&boardp->active,
+ &new_last_scp, target);
+ if (new_last_scp != NULL) {
+ ASC_ASSERT(REQPNEXT(last_scp) != NULL);
+ for (tscp = REQPNEXT(last_scp); tscp; tscp = REQPNEXT(tscp)) {
+ tscp->result = HOST_BYTE(DID_RESET);
+ }
+ last_scp = new_last_scp;
+ }
+ }
+
+ /*
+ * Add waiting requests to 'done_scp' and set the request status
+ * to DID_RESET.
+ */
+ if (done_scp == NULL) {
+ done_scp = asc_dequeue_list(&boardp->waiting, &last_scp, target);
+ for (tscp = done_scp; tscp; tscp = REQPNEXT(tscp)) {
+ tscp->result = HOST_BYTE(DID_RESET);
+ }
+ } else {
+ ASC_ASSERT(last_scp != NULL);
+ REQPNEXT(last_scp) = asc_dequeue_list(&boardp->waiting,
+ &new_last_scp, target);
+ if (new_last_scp != NULL) {
+ ASC_ASSERT(REQPNEXT(last_scp) != NULL);
+ for (tscp = REQPNEXT(last_scp); tscp; tscp = REQPNEXT(tscp)) {
+ tscp->result = HOST_BYTE(DID_RESET);
+ }
+ last_scp = new_last_scp;
+ }
+ }
+
+ /* Save the time of the most recently completed reset. */
+ boardp->last_reset = jiffies;
+
+ /* Clear reset flag. */
+ boardp->flags &= ~ASC_HOST_IN_RESET;
+
+ /*
+ * Start any waiting commands for the board.
+ */
+ if (!ASC_QUEUE_EMPTY(&boardp->waiting)) {
+ ASC_DBG(1, "advansys_interrupt: before asc_execute_queue()\n");
+ asc_execute_queue(&boardp->waiting);
+ }
+ ret = SCSI_RESET_SUCCESS;
+ }
+
+ /* Interrupts could be enabled here. */
+
+ ASC_ASSERT(do_scsi_done != ASC_ERROR);
+ ASC_ASSERT(scp_found != ASC_ERROR);
+ if (do_scsi_done == ASC_TRUE) {
+ if (scp->scsi_done == NULL) {
+ ASC_PRINT1(
"advansys_reset: reset request scsi_done() is NULL, %x\n",
- (unsigned) scp);
- } else {
- if (scp_found == ASC_FALSE) {
- ASC_PRINT1(
+ (unsigned) scp);
+ } else {
+ if (scp_found == ASC_FALSE) {
+ ASC_PRINT1(
"advansys_reset: reset request not active or waiting, completing anyway %x\n",
- (unsigned) scp);
- }
- ASC_STATS(scp->host, done);
- scp->scsi_done(scp);
- }
- }
+ (unsigned) scp);
+ }
+ ASC_STATS(scp->host, done);
+ scp->scsi_done(scp);
+ }
+ }
- /*
- * It is possible for the request done function to re-enable
- * interrupts without confusing the driver. But here interrupts
- * aren't enabled until requests have been completed.
- */
- if (done_scp != NULL) {
- asc_scsi_done_list(done_scp);
- }
+ /*
+ * It is possible for the request done function to re-enable
+ * interrupts without confusing the driver. But here interrupts
+ * aren't enabled until requests have been completed.
+ */
+ if (done_scp != NULL) {
+ asc_scsi_done_list(done_scp);
+ }
- ASC_DBG1(1, "advansys_reset: ret %d", ret);
+ ASC_DBG1(1, "advansys_reset: ret %d", ret);
- /* Re-enable interrupts, if they were enabled on entry. */
- restore_flags(flags);
+ /* Re-enable interrupts, if they were enabled on entry. */
+ restore_flags(flags);
- ASC_ASSERT(ret != ASC_ERROR);
- return ret;
+ ASC_ASSERT(ret != ASC_ERROR);
+ return ret;
}
/*
@@ -4254,19 +4296,19 @@ advansys_biosparam(Disk *dp, int dep, int ip[])
advansys_biosparam(Disk *dp, kdev_t dep, int ip[])
#endif /* version >= v1.3.0 */
{
- ASC_DBG(1, "advansys_biosparam: begin\n");
- ASC_STATS(dp->device->host, biosparam);
- if ((ASC_BOARDP(dp->device->host)->asc_dvc_var.dvc_cntl &
- ASC_CNTL_BIOS_GT_1GB) && dp->capacity > 0x200000) {
- ip[0] = 255;
- ip[1] = 63;
- } else {
- ip[0] = 64;
- ip[1] = 32;
- }
- ip[2] = dp->capacity / (ip[0] * ip[1]);
- ASC_DBG(1, "advansys_biosparam: end\n");
- return 0;
+ ASC_DBG(1, "advansys_biosparam: begin\n");
+ ASC_STATS(dp->device->host, biosparam);
+ if ((ASC_BOARDP(dp->device->host)->asc_dvc_var.dvc_cntl &
+ ASC_CNTL_BIOS_GT_1GB) && dp->capacity > 0x200000) {
+ ip[0] = 255;
+ ip[1] = 63;
+ } else {
+ ip[0] = 64;
+ ip[1] = 32;
+ }
+ ip[2] = dp->capacity / (ip[0] * ip[1]);
+ ASC_DBG(1, "advansys_biosparam: end\n");
+ return 0;
}
/*
@@ -4287,61 +4329,63 @@ advansys_biosparam(Disk *dp, kdev_t dep, int ip[])
*
* Examples:
* 1. Eliminate I/O port scanning:
- * boot: linux advansys=
+ * boot: linux advansys=
* or
- * boot: linux advansys=0x0
+ * boot: linux advansys=0x0
* 2. Limit I/O port scanning to one I/O port:
- * boot: linux advansys=0x110
+ * boot: linux advansys=0x110
* 3. Limit I/O port scanning to four I/O ports:
- * boot: linux advansys=0x110,0x210,0x230,0x330
+ * boot: linux advansys=0x110,0x210,0x230,0x330
* 4. If ADVANSYS_DEBUG, limit I/O port scanning to four I/O ports and
* set the driver debug level to 2.
- * boot: linux advansys=0x110,0x210,0x230,0x330,0xdeb2
+ * boot: linux advansys=0x110,0x210,0x230,0x330,0xdeb2
*
* ints[0] - number of arguments
* ints[1] - first argument
* ints[2] - second argument
* ...
*/
+ASC_INITFUNC(
void
advansys_setup(char *str, int *ints)
+)
{
- int i;
+ int i;
- if (asc_iopflag == ASC_TRUE) {
- printk("AdvanSys SCSI: 'advansys' LILO option may appear only once\n");
- return;
- }
+ if (asc_iopflag == ASC_TRUE) {
+ printk("AdvanSys SCSI: 'advansys' LILO option may appear only once\n");
+ return;
+ }
- asc_iopflag = ASC_TRUE;
+ asc_iopflag = ASC_TRUE;
- if (ints[0] > ASC_NUM_BOARD_SUPPORTED) {
+ if (ints[0] > ASC_NUM_BOARD_SUPPORTED) {
#ifdef ADVANSYS_DEBUG
- if ((ints[0] == ASC_NUM_BOARD_SUPPORTED + 1) &&
- (ints[ASC_NUM_BOARD_SUPPORTED + 1] >> 4 == 0xdeb)) {
- asc_dbglvl = ints[ASC_NUM_BOARD_SUPPORTED + 1] & 0xf;
- } else {
+ if ((ints[0] == ASC_NUM_BOARD_SUPPORTED + 1) &&
+ (ints[ASC_NUM_BOARD_SUPPORTED + 1] >> 4 == 0xdeb)) {
+ asc_dbglvl = ints[ASC_NUM_BOARD_SUPPORTED + 1] & 0xf;
+ } else {
#endif /* ADVANSYS_DEBUG */
- printk("AdvanSys SCSI: only %d I/O ports accepted\n",
- ASC_NUM_BOARD_SUPPORTED);
+ printk("AdvanSys SCSI: only %d I/O ports accepted\n",
+ ASC_NUM_BOARD_SUPPORTED);
#ifdef ADVANSYS_DEBUG
- }
+ }
#endif /* ADVANSYS_DEBUG */
- }
+ }
#ifdef ADVANSYS_DEBUG
- ASC_DBG1(1, "advansys_setup: ints[0] %d\n", ints[0]);
- for (i = 1; i < ints[0]; i++) {
- ASC_DBG2(1, " ints[%d] %x", i, ints[i]);
- }
- ASC_DBG(1, "\n");
+ ASC_DBG1(1, "advansys_setup: ints[0] %d\n", ints[0]);
+ for (i = 1; i < ints[0]; i++) {
+ ASC_DBG2(1, " ints[%d] %x", i, ints[i]);
+ }
+ ASC_DBG(1, "\n");
#endif /* ADVANSYS_DEBUG */
- for (i = 1; i <= ints[0] && i <= ASC_NUM_BOARD_SUPPORTED; i++) {
- asc_ioport[i-1] = ints[i];
- ASC_DBG2(1, "advansys_setup: asc_ioport[%d] %x\n",
- i - 1, asc_ioport[i-1]);
- }
+ for (i = 1; i <= ints[0] && i <= ASC_NUM_BOARD_SUPPORTED; i++) {
+ asc_ioport[i-1] = ints[i];
+ ASC_DBG2(1, "advansys_setup: asc_ioport[%d] %x\n",
+ i - 1, asc_ioport[i-1]);
+ }
}
@@ -4375,76 +4419,76 @@ advansys_interrupt(int irq, struct pt_regs *regs)
advansys_interrupt(int irq, void *dev_id, struct pt_regs *regs)
#endif /* version >= v1.3.70 */
{
- int flags;
- int i;
- asc_board_t *boardp;
- Scsi_Cmnd *done_scp = NULL, *last_scp = NULL;
- Scsi_Cmnd *new_last_scp;
-
- /* Disable interrupts, if they aren't already disabled. */
- save_flags(flags);
- cli();
-
- ASC_DBG(1, "advansys_interrupt: begin\n");
- /*
- * Check for interrupts on all boards.
- * AscISR() will call asc_isr_callback().
- */
- for (i = 0; i < asc_board_count; i++) {
- ASC_STATS(asc_host[i], check_interrupt);
- boardp = ASC_BOARDP(asc_host[i]);
- while (AscIsIntPending(asc_host[i]->io_port)) {
- ASC_STATS(asc_host[i], interrupt);
- ASC_DBG(1, "advansys_interrupt: before AscISR()\n");
- AscISR(&boardp->asc_dvc_var);
- }
-
- /*
- * Start waiting requests and create a list of completed requests.
- *
- * If a reset or abort request is being performed for the board,
- * the reset or abort handler will complete pending requests after
- * it has completed.
- */
- if ((boardp->flags & (ASC_HOST_IN_RESET | ASC_HOST_IN_ABORT)) == 0) {
- /* Start any waiting commands for the board. */
- if (!ASC_QUEUE_EMPTY(&boardp->waiting)) {
- ASC_DBG(1, "advansys_interrupt: before asc_execute_queue()\n");
- asc_execute_queue(&boardp->waiting);
- }
-
- /*
- * Add to the list of requests that must be completed.
- */
- if (done_scp == NULL) {
- done_scp = asc_dequeue_list(&boardp->done, &last_scp,
- ASC_TID_ALL);
- } else {
- ASC_ASSERT(last_scp != NULL);
- REQPNEXT(last_scp) = asc_dequeue_list(&boardp->done,
- &new_last_scp, ASC_TID_ALL);
- if (new_last_scp != NULL) {
- ASC_ASSERT(REQPNEXT(last_scp) != NULL);
- last_scp = new_last_scp;
- }
- }
- }
- }
-
- /* Interrupts could be enabled here. */
-
- /*
- * It is possible for the request done function to re-enable
- * interrupts without confusing the driver. But here interrupts
- * aren't enabled until all requests have been completed.
- */
- asc_scsi_done_list(done_scp);
-
- /* Re-enable interrupts, if they were enabled on entry. */
- restore_flags(flags);
-
- ASC_DBG(1, "advansys_interrupt: end\n");
- return;
+ int flags;
+ int i;
+ asc_board_t *boardp;
+ Scsi_Cmnd *done_scp = NULL, *last_scp = NULL;
+ Scsi_Cmnd *new_last_scp;
+
+ /* Disable interrupts, if they aren't already disabled. */
+ save_flags(flags);
+ cli();
+
+ ASC_DBG(1, "advansys_interrupt: begin\n");
+ /*
+ * Check for interrupts on all boards.
+ * AscISR() will call asc_isr_callback().
+ */
+ for (i = 0; i < asc_board_count; i++) {
+ ASC_STATS(asc_host[i], check_interrupt);
+ boardp = ASC_BOARDP(asc_host[i]);
+ while (AscIsIntPending(asc_host[i]->io_port)) {
+ ASC_STATS(asc_host[i], interrupt);
+ ASC_DBG(1, "advansys_interrupt: before AscISR()\n");
+ AscISR(&boardp->asc_dvc_var);
+ }
+
+ /*
+ * Start waiting requests and create a list of completed requests.
+ *
+ * If a reset or abort request is being performed for the board,
+ * the reset or abort handler will complete pending requests after
+ * it has completed.
+ */
+ if ((boardp->flags & (ASC_HOST_IN_RESET | ASC_HOST_IN_ABORT)) == 0) {
+ /* Start any waiting commands for the board. */
+ if (!ASC_QUEUE_EMPTY(&boardp->waiting)) {
+ ASC_DBG(1, "advansys_interrupt: before asc_execute_queue()\n");
+ asc_execute_queue(&boardp->waiting);
+ }
+
+ /*
+ * Add to the list of requests that must be completed.
+ */
+ if (done_scp == NULL) {
+ done_scp = asc_dequeue_list(&boardp->done, &last_scp,
+ ASC_TID_ALL);
+ } else {
+ ASC_ASSERT(last_scp != NULL);
+ REQPNEXT(last_scp) = asc_dequeue_list(&boardp->done,
+ &new_last_scp, ASC_TID_ALL);
+ if (new_last_scp != NULL) {
+ ASC_ASSERT(REQPNEXT(last_scp) != NULL);
+ last_scp = new_last_scp;
+ }
+ }
+ }
+ }
+
+ /* Interrupts could be enabled here. */
+
+ /*
+ * It is possible for the request done function to re-enable
+ * interrupts without confusing the driver. But here interrupts
+ * aren't enabled until all requests have been completed.
+ */
+ asc_scsi_done_list(done_scp);
+
+ /* Re-enable interrupts, if they were enabled on entry. */
+ restore_flags(flags);
+
+ ASC_DBG(1, "advansys_interrupt: end\n");
+ return;
}
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
@@ -4455,23 +4499,23 @@ advansys_interrupt(int irq, void *dev_id, struct pt_regs *regs)
STATIC void
advansys_select_queue_depths(struct Scsi_Host *shp, Scsi_Device *devicelist)
{
- Scsi_Device *device;
- asc_board_t *boardp;
-
- boardp = ASC_BOARDP(shp);
- for (device = devicelist; device != NULL; device = device->next) {
- if (device->host != shp) {
- continue;
- }
- /*
- * Save a pointer to the device and set its initial/maximum
- * queue depth.
- */
- boardp->device[device->id] = device;
- device->queue_depth = boardp->asc_dvc_var.max_dvc_qng[device->id];
- ASC_DBG3(1, "advansys_select_queue_depths: shp %x, id %d, depth %d\n",
- (unsigned) shp, device->id, device->queue_depth);
- }
+ Scsi_Device *device;
+ asc_board_t *boardp;
+
+ boardp = ASC_BOARDP(shp);
+ for (device = devicelist; device != NULL; device = device->next) {
+ if (device->host != shp) {
+ continue;
+ }
+ /*
+ * Save a pointer to the device and set its initial/maximum
+ * queue depth.
+ */
+ boardp->device[device->id] = device;
+ device->queue_depth = boardp->asc_dvc_var.max_dvc_qng[device->id];
+ ASC_DBG3(1, "advansys_select_queue_depths: shp %x, id %d, depth %d\n",
+ (unsigned) shp, device->id, device->queue_depth);
+ }
}
#endif /* version >= v1.3.89 */
@@ -4482,8 +4526,8 @@ advansys_select_queue_depths(struct Scsi_Host *shp, Scsi_Device *devicelist)
STATIC void
advansys_command_done(Scsi_Cmnd *scp)
{
- ASC_DBG1(1, "advansys_command_done: scp %x\n", (unsigned) scp);
- scp->SCp.Status = 1;
+ ASC_DBG1(1, "advansys_command_done: scp %x\n", (unsigned) scp);
+ scp->SCp.Status = 1;
}
/*
@@ -4495,17 +4539,17 @@ advansys_command_done(Scsi_Cmnd *scp)
STATIC void
asc_scsi_done_list(Scsi_Cmnd *scp)
{
- Scsi_Cmnd *tscp;
+ Scsi_Cmnd *tscp;
- while (scp != NULL) {
- tscp = REQPNEXT(scp);
- REQPNEXT(scp) = NULL;
- ASC_STATS(scp->host, done);
- ASC_ASSERT(scp->scsi_done != NULL);
- scp->scsi_done(scp);
- scp = tscp;
- }
- return;
+ while (scp != NULL) {
+ tscp = REQPNEXT(scp);
+ REQPNEXT(scp) = NULL;
+ ASC_STATS(scp->host, done);
+ ASC_ASSERT(scp->scsi_done != NULL);
+ scp->scsi_done(scp);
+ scp = tscp;
+ }
+ return;
}
/*
@@ -4520,28 +4564,28 @@ asc_scsi_done_list(Scsi_Cmnd *scp)
* target - target of device
* lun - lun of device
* cmd_len - length of SCSI CDB
- * cmnd - buffer for SCSI 8, 10, or 12 byte CDB
+ * cmnd - buffer for SCSI 8, 10, or 12 byte CDB
* use_sg - if non-zero indicates scatter-gather request with use_sg elements
*
* if (use_sg == 0)
- * request_buffer - buffer address for request
- * request_bufflen - length of request buffer
+ * request_buffer - buffer address for request
+ * request_bufflen - length of request buffer
* else
- * request_buffer - pointer to scatterlist structure
+ * request_buffer - pointer to scatterlist structure
*
* sense_buffer - sense command buffer
*
* result (4 bytes of an int):
* Byte Meaning
- * 0 SCSI Status Byte Code
- * 1 SCSI One Byte Message Code
- * 2 Host Error Code
- * 3 Mid-Level Error Code
+ * 0 SCSI Status Byte Code
+ * 1 SCSI One Byte Message Code
+ * 2 Host Error Code
+ * 3 Mid-Level Error Code
*
* host driver fields:
* SCp - Scsi_Pointer used for command processing status
* scsi_done - used to save caller's done function
- * host_scribble - used for pointer to another Scsi_Cmnd
+ * host_scribble - used for pointer to another Scsi_Cmnd
*
* If this function returns ASC_NOERROR or ASC_ERROR the request
* has been enqueued on the board's 'done' queue and must be
@@ -4553,358 +4597,358 @@ asc_scsi_done_list(Scsi_Cmnd *scp)
STATIC int
asc_execute_scsi_cmnd(Scsi_Cmnd *scp)
{
- asc_board_t *boardp;
- ASC_DVC_VAR *asc_dvc_varp;
- Scsi_Device *device;
- int ret;
-
- ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
- ASC_DBG2(1, "asc_execute_scsi_cmnd: scp %x, done %x\n",
- (unsigned) scp, (unsigned) scp->scsi_done);
-
- boardp = ASC_BOARDP(scp->host);
- asc_dvc_varp = &boardp->asc_dvc_var;
- device = boardp->device[scp->target];
-
- /*
- * If this is the first command, then initialize the device. If
- * no device is found set 'DID_BAD_TARGET' and return.
- */
- if ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(scp->target)) == 0) {
- if (asc_init_dev(asc_dvc_varp, scp) == ASC_FALSE) {
- scp->result = HOST_BYTE(DID_BAD_TARGET);
- asc_enqueue(&boardp->done, scp, ASC_BACK);
- return ASC_ERROR;
- }
- boardp->init_tidmask |= ASC_TIX_TO_TARGET_ID(scp->target);
- }
-
- /*
- * Mutually exclusive access is required to 'asc_scsi_q' and
- * 'asc_sg_head' until after the request is started.
- */
- memset(&asc_scsi_q, 0, sizeof(ASC_SCSI_Q));
-
- /*
- * Point the ASC_SCSI_Q to the 'Scsi_Cmnd'.
- */
- asc_scsi_q.q2.srb_ptr = (ulong) scp;
-
- /*
- * Build the ASC_SCSI_Q request.
- */
- asc_scsi_q.cdbptr = &scp->cmnd[0];
- asc_scsi_q.q2.cdb_len = scp->cmd_len;
- asc_scsi_q.q1.target_id = ASC_TID_TO_TARGET_ID(scp->target);
- asc_scsi_q.q1.target_lun = scp->lun;
- asc_scsi_q.q2.target_ix = ASC_TIDLUN_TO_IX(scp->target, scp->lun);
+ asc_board_t *boardp;
+ ASC_DVC_VAR *asc_dvc_varp;
+ Scsi_Device *device;
+ int ret;
+
+ ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
+ ASC_DBG2(1, "asc_execute_scsi_cmnd: scp %x, done %x\n",
+ (unsigned) scp, (unsigned) scp->scsi_done);
+
+ boardp = ASC_BOARDP(scp->host);
+ asc_dvc_varp = &boardp->asc_dvc_var;
+ device = boardp->device[scp->target];
+
+ /*
+ * If this is the first command, then initialize the device. If
+ * no device is found set 'DID_BAD_TARGET' and return.
+ */
+ if ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(scp->target)) == 0) {
+ if (asc_init_dev(asc_dvc_varp, scp) == ASC_FALSE) {
+ scp->result = HOST_BYTE(DID_BAD_TARGET);
+ asc_enqueue(&boardp->done, scp, ASC_BACK);
+ return ASC_ERROR;
+ }
+ boardp->init_tidmask |= ASC_TIX_TO_TARGET_ID(scp->target);
+ }
+
+ /*
+ * Mutually exclusive access is required to 'asc_scsi_q' and
+ * 'asc_sg_head' until after the request is started.
+ */
+ memset(&asc_scsi_q, 0, sizeof(ASC_SCSI_Q));
+
+ /*
+ * Point the ASC_SCSI_Q to the 'Scsi_Cmnd'.
+ */
+ asc_scsi_q.q2.srb_ptr = (ulong) scp;
+
+ /*
+ * Build the ASC_SCSI_Q request.
+ */
+ asc_scsi_q.cdbptr = &scp->cmnd[0];
+ asc_scsi_q.q2.cdb_len = scp->cmd_len;
+ asc_scsi_q.q1.target_id = ASC_TID_TO_TARGET_ID(scp->target);
+ asc_scsi_q.q1.target_lun = scp->lun;
+ asc_scsi_q.q2.target_ix = ASC_TIDLUN_TO_IX(scp->target, scp->lun);
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(2,0,0)
- asc_scsi_q.q1.sense_addr = (ulong) &scp->sense_buffer[0];
+ asc_scsi_q.q1.sense_addr = (ulong) &scp->sense_buffer[0];
#else /* version >= v2.0.0 */
- asc_scsi_q.q1.sense_addr = virt_to_bus(&scp->sense_buffer[0]);
+ asc_scsi_q.q1.sense_addr = virt_to_bus(&scp->sense_buffer[0]);
#endif /* version >= v2.0.0 */
- asc_scsi_q.q1.sense_len = sizeof(scp->sense_buffer);
-
- /*
- * If there are any outstanding requests for the current target,
- * then every 255th request send an ORDERED request. This heuristic
- * tries to retain the benefit of request sorting while preventing
- * request starvation. 255 is the max number of tags or pending commands
- * a device may have outstanding.
- *
- * The request count is incremented below for every successfully
- * started request.
- *
- */
- if ((asc_dvc_varp->cur_dvc_qng[scp->target] > 0) &&
- (boardp->reqcnt[scp->target] % 255) == 0) {
- asc_scsi_q.q2.tag_code = M2_QTAG_MSG_ORDERED;
- } else {
- asc_scsi_q.q2.tag_code = M2_QTAG_MSG_SIMPLE;
- }
-
- /*
- * Build ASC_SCSI_Q for a contiguous buffer or a scatter-gather
- * buffer command.
- */
- if (scp->use_sg == 0) {
- /*
- * CDB request of single contiguous buffer.
- */
- ASC_STATS(scp->host, cont_cnt);
+ asc_scsi_q.q1.sense_len = sizeof(scp->sense_buffer);
+
+ /*
+ * If there are any outstanding requests for the current target,
+ * then every 255th request send an ORDERED request. This heuristic
+ * tries to retain the benefit of request sorting while preventing
+ * request starvation. 255 is the max number of tags or pending commands
+ * a device may have outstanding.
+ *
+ * The request count is incremented below for every successfully
+ * started request.
+ *
+ */
+ if ((asc_dvc_varp->cur_dvc_qng[scp->target] > 0) &&
+ (boardp->reqcnt[scp->target] % 255) == 0) {
+ asc_scsi_q.q2.tag_code = M2_QTAG_MSG_ORDERED;
+ } else {
+ asc_scsi_q.q2.tag_code = M2_QTAG_MSG_SIMPLE;
+ }
+
+ /*
+ * Build ASC_SCSI_Q for a contiguous buffer or a scatter-gather
+ * buffer command.
+ */
+ if (scp->use_sg == 0) {
+ /*
+ * CDB request of single contiguous buffer.
+ */
+ ASC_STATS(scp->host, cont_cnt);
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(2,0,0)
- asc_scsi_q.q1.data_addr = (ulong) scp->request_buffer;
+ asc_scsi_q.q1.data_addr = (ulong) scp->request_buffer;
#else /* version >= v2.0.0 */
- asc_scsi_q.q1.data_addr = virt_to_bus(scp->request_buffer);
+ asc_scsi_q.q1.data_addr = virt_to_bus(scp->request_buffer);
#endif /* version >= v2.0.0 */
- asc_scsi_q.q1.data_cnt = scp->request_bufflen;
- ASC_STATS_ADD(scp->host, cont_xfer,
- ASC_CEILING(scp->request_bufflen, 512));
- asc_scsi_q.q1.sg_queue_cnt = 0;
- asc_scsi_q.sg_head = NULL;
- } else {
- /*
- * CDB scatter-gather request list.
- */
- int sgcnt;
- struct scatterlist *slp;
-
- if (scp->use_sg > scp->host->sg_tablesize) {
- ASC_PRINT3(
+ asc_scsi_q.q1.data_cnt = scp->request_bufflen;
+ ASC_STATS_ADD(scp->host, cont_xfer,
+ ASC_CEILING(scp->request_bufflen, 512));
+ asc_scsi_q.q1.sg_queue_cnt = 0;
+ asc_scsi_q.sg_head = NULL;
+ } else {
+ /*
+ * CDB scatter-gather request list.
+ */
+ int sgcnt;
+ struct scatterlist *slp;
+
+ if (scp->use_sg > scp->host->sg_tablesize) {
+ ASC_PRINT3(
"asc_execute_scsi_cmnd: board %d: use_sg %d > sg_tablesize %d\n",
- boardp->id, scp->use_sg, scp->host->sg_tablesize);
- scp->result = HOST_BYTE(DID_ERROR);
- asc_enqueue(&boardp->done, scp, ASC_BACK);
- return ASC_ERROR;
- }
-
- ASC_STATS(scp->host, sg_cnt);
-
- /*
- * Allocate a ASC_SG_HEAD structure and set the ASC_SCSI_Q
- * to point to it.
- */
- memset(&asc_sg_head, 0, sizeof(ASC_SG_HEAD));
-
- asc_scsi_q.q1.cntl |= QC_SG_HEAD;
- asc_scsi_q.sg_head = &asc_sg_head;
- asc_scsi_q.q1.data_cnt = 0;
- asc_scsi_q.q1.data_addr = 0;
- asc_sg_head.entry_cnt = asc_scsi_q.q1.sg_queue_cnt = scp->use_sg;
- ASC_STATS_ADD(scp->host, sg_elem, asc_sg_head.entry_cnt);
-
- /*
- * Convert scatter-gather list into ASC_SG_HEAD list.
- */
- slp = (struct scatterlist *) scp->request_buffer;
- for (sgcnt = 0; sgcnt < scp->use_sg; sgcnt++, slp++) {
+ boardp->id, scp->use_sg, scp->host->sg_tablesize);
+ scp->result = HOST_BYTE(DID_ERROR);
+ asc_enqueue(&boardp->done, scp, ASC_BACK);
+ return ASC_ERROR;
+ }
+
+ ASC_STATS(scp->host, sg_cnt);
+
+ /*
+ * Allocate a ASC_SG_HEAD structure and set the ASC_SCSI_Q
+ * to point to it.
+ */
+ memset(&asc_sg_head, 0, sizeof(ASC_SG_HEAD));
+
+ asc_scsi_q.q1.cntl |= QC_SG_HEAD;
+ asc_scsi_q.sg_head = &asc_sg_head;
+ asc_scsi_q.q1.data_cnt = 0;
+ asc_scsi_q.q1.data_addr = 0;
+ asc_sg_head.entry_cnt = asc_scsi_q.q1.sg_queue_cnt = scp->use_sg;
+ ASC_STATS_ADD(scp->host, sg_elem, asc_sg_head.entry_cnt);
+
+ /*
+ * Convert scatter-gather list into ASC_SG_HEAD list.
+ */
+ slp = (struct scatterlist *) scp->request_buffer;
+ for (sgcnt = 0; sgcnt < scp->use_sg; sgcnt++, slp++) {
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(2,0,0)
- asc_sg_head.sg_list[sgcnt].addr = (ulong) slp->address;
+ asc_sg_head.sg_list[sgcnt].addr = (ulong) slp->address;
#else /* version >= v2.0.0 */
- asc_sg_head.sg_list[sgcnt].addr = virt_to_bus(slp->address);
+ asc_sg_head.sg_list[sgcnt].addr = virt_to_bus(slp->address);
#endif /* version >= v2.0.0 */
- asc_sg_head.sg_list[sgcnt].bytes = slp->length;
- ASC_STATS_ADD(scp->host, sg_xfer, ASC_CEILING(slp->length, 512));
- }
- }
-
- ASC_DBG_PRT_SCSI_Q(2, &asc_scsi_q);
- ASC_DBG_PRT_CDB(1, scp->cmnd, scp->cmd_len);
-
- /*
- * Execute the command. If there is no error, add the command
- * to the active queue.
- */
- switch (ret = AscExeScsiQueue(asc_dvc_varp, &asc_scsi_q)) {
- case ASC_NOERROR:
- ASC_STATS(scp->host, asc_noerror);
- /*
- * Increment monotonically increasing per device successful
- * request counter. Wrapping doesn't matter.
- */
- boardp->reqcnt[scp->target]++;
+ asc_sg_head.sg_list[sgcnt].bytes = slp->length;
+ ASC_STATS_ADD(scp->host, sg_xfer, ASC_CEILING(slp->length, 512));
+ }
+ }
+
+ ASC_DBG_PRT_SCSI_Q(2, &asc_scsi_q);
+ ASC_DBG_PRT_CDB(1, scp->cmnd, scp->cmd_len);
+
+ /*
+ * Execute the command. If there is no error, add the command
+ * to the active queue.
+ */
+ switch (ret = AscExeScsiQueue(asc_dvc_varp, &asc_scsi_q)) {
+ case ASC_NOERROR:
+ ASC_STATS(scp->host, asc_noerror);
+ /*
+ * Increment monotonically increasing per device successful
+ * request counter. Wrapping doesn't matter.
+ */
+ boardp->reqcnt[scp->target]++;
#if ASC_QUEUE_FLOW_CONTROL
- /*
- * Conditionally increment the device queue depth.
- *
- * If no error occurred and there have been 100 consecutive
- * successfull requests and the current queue depth is less
- * than the maximum queue depth, then increment the current
- * queue depth.
- */
- if (boardp->nerrcnt[scp->target]++ > 100) {
- boardp->nerrcnt[scp->target] = 0;
- if ((device->queue_curr_depth < device->queue_depth) &&
- (!(boardp->queue_full & ASC_TIX_TO_TARGET_ID(scp->target)) ||
- (boardp->queue_full_cnt[scp->target] >
- device->queue_curr_depth))) {
- device->queue_curr_depth++;
- }
- }
+ /*
+ * Conditionally increment the device queue depth.
+ *
+ * If no error occurred and there have been 100 consecutive
+ * successfull requests and the current queue depth is less
+ * than the maximum queue depth, then increment the current
+ * queue depth.
+ */
+ if (boardp->nerrcnt[scp->target]++ > 100) {
+ boardp->nerrcnt[scp->target] = 0;
+ if ((device->queue_curr_depth < device->queue_depth) &&
+ (!(boardp->queue_full & ASC_TIX_TO_TARGET_ID(scp->target)) ||
+ (boardp->queue_full_cnt[scp->target] >
+ device->queue_curr_depth))) {
+ device->queue_curr_depth++;
+ }
+ }
#endif /* ASC_QUEUE_FLOW_CONTROL */
- asc_enqueue(&boardp->active, scp, ASC_BACK);
- ASC_DBG(1, "asc_execute_scsi_cmnd: AscExeScsiQueue(), ASC_NOERROR\n");
- break;
- case ASC_BUSY:
- /* Caller must enqueue request and retry later. */
- ASC_STATS(scp->host, asc_busy);
+ asc_enqueue(&boardp->active, scp, ASC_BACK);
+ ASC_DBG(1, "asc_execute_scsi_cmnd: AscExeScsiQueue(), ASC_NOERROR\n");
+ break;
+ case ASC_BUSY:
+ /* Caller must enqueue request and retry later. */
+ ASC_STATS(scp->host, asc_busy);
#if ASC_QUEUE_FLOW_CONTROL
- /*
- * Clear consecutive no error counter and if possbile decrement
- * queue depth.
- */
- boardp->nerrcnt[scp->target] = 0;
- if (device->queue_curr_depth > 1) {
- device->queue_curr_depth--;
- }
+ /*
+ * Clear consecutive no error counter and if possbile decrement
+ * queue depth.
+ */
+ boardp->nerrcnt[scp->target] = 0;
+ if (device->queue_curr_depth > 1) {
+ device->queue_curr_depth--;
+ }
#endif /* ASC_QUEUE_FLOW_CONTROL */
- break;
- case ASC_ERROR:
- ASC_PRINT2(
+ break;
+ case ASC_ERROR:
+ ASC_PRINT2(
"asc_execute_scsi_cmnd: board %d: AscExeScsiQueue() ASC_ERROR, err_code %x\n",
- boardp->id, asc_dvc_varp->err_code);
- ASC_STATS(scp->host, asc_error);
+ boardp->id, asc_dvc_varp->err_code);
+ ASC_STATS(scp->host, asc_error);
#if ASC_QUEUE_FLOW_CONTROL
- /* Clear consecutive no error counter. */
- boardp->nerrcnt[scp->target] = 0;
+ /* Clear consecutive no error counter. */
+ boardp->nerrcnt[scp->target] = 0;
#endif /* ASC_QUEUE_FLOW_CONTROL */
- scp->result = HOST_BYTE(DID_ERROR);
- asc_enqueue(&boardp->done, scp, ASC_BACK);
- break;
- default:
- ASC_PRINT2(
+ scp->result = HOST_BYTE(DID_ERROR);
+ asc_enqueue(&boardp->done, scp, ASC_BACK);
+ break;
+ default:
+ ASC_PRINT2(
"asc_execute_scsi_cmnd: board %d: AscExeScsiQueue() unknown, err_code %x\n",
- boardp->id, asc_dvc_varp->err_code);
- ASC_STATS(scp->host, asc_unknown);
+ boardp->id, asc_dvc_varp->err_code);
+ ASC_STATS(scp->host, asc_unknown);
#if ASC_QUEUE_FLOW_CONTROL
- /* Clear consecutive no error counter. */
- boardp->nerrcnt[scp->target] = 0;
+ /* Clear consecutive no error counter. */
+ boardp->nerrcnt[scp->target] = 0;
#endif /* ASC_QUEUE_FLOW_CONTROL */
- scp->result = HOST_BYTE(DID_ERROR);
- asc_enqueue(&boardp->done, scp, ASC_BACK);
- break;
- }
+ scp->result = HOST_BYTE(DID_ERROR);
+ asc_enqueue(&boardp->done, scp, ASC_BACK);
+ break;
+ }
- ASC_DBG(1, "asc_execute_scsi_cmnd: end\n");
- ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
- return ret;
+ ASC_DBG(1, "asc_execute_scsi_cmnd: end\n");
+ ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
+ return ret;
}
/*
* asc_isr_callback() - Second Level Interrupt Handler called by AscISR().
*/
-void
+STATIC void
asc_isr_callback(ASC_DVC_VAR *asc_dvc_varp, ASC_QDONE_INFO *qdonep)
{
- asc_board_t *boardp;
- Scsi_Cmnd *scp;
- struct Scsi_Host *shp;
- int i;
-
- ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
- ASC_DBG2(1, "asc_isr_callback: asc_dvc_varp %x, qdonep %x\n",
- (unsigned) asc_dvc_varp, (unsigned) qdonep);
- ASC_DBG_PRT_QDONE_INFO(2, qdonep);
-
- /*
- * Get the Scsi_Cmnd structure and Scsi_Host structure for the
- * command that has been completed.
- */
- scp = (Scsi_Cmnd *) qdonep->d2.srb_ptr;
- ASC_DBG1(1, "asc_isr_callback: scp %x\n", (unsigned) scp);
- ASC_DBG_PRT_CDB(2, scp->cmnd, scp->cmd_len);
-
- if (scp == NULL) {
- ASC_PRINT("asc_isr_callback: scp is NULL\n");
- return;
- }
-
- /*
- * If the request's host pointer is not valid, display a
- * message and return.
- */
- shp = scp->host;
- for (i = 0; i < asc_board_count; i++) {
- if (asc_host[i] == shp) {
- break;
- }
- }
- if (i == asc_board_count) {
- ASC_PRINT2("asc_isr_callback: scp %x has bad host pointer, host %x\n",
- (unsigned) scp, (unsigned) shp);
- return;
- }
-
- ASC_STATS(shp, callback);
- ASC_DBG1(1, "asc_isr_callback: shp %x\n", (unsigned) shp);
-
- /*
- * If the request isn't found on the active queue, it may
- * have been removed to handle a reset or abort request.
- * Display a message and return.
- */
- boardp = ASC_BOARDP(shp);
- if (asc_rmqueue(&boardp->active, scp) == ASC_FALSE) {
- ASC_PRINT2("asc_isr_callback: board %d: scp %x not on active queue\n",
- boardp->id, (unsigned) scp);
- return;
- }
-
- /*
- * 'qdonep' contains the command's ending status.
- */
- switch (qdonep->d3.done_stat) {
- case QD_NO_ERROR:
- ASC_DBG(2, "asc_isr_callback: QD_NO_ERROR\n");
- switch (qdonep->d3.host_stat) {
- case QHSTA_NO_ERROR:
- scp->result = 0;
- break;
- default:
- /* QHSTA error occurred */
- scp->result = HOST_BYTE(DID_ERROR);
- break;
- }
- break;
-
- case QD_WITH_ERROR:
- ASC_DBG(2, "asc_isr_callback: QD_WITH_ERROR\n");
- switch (qdonep->d3.host_stat) {
- case QHSTA_NO_ERROR:
- if (qdonep->d3.scsi_stat == SS_CHK_CONDITION) {
- ASC_DBG(2, "asc_isr_callback: SS_CHK_CONDITION\n");
- ASC_DBG_PRT_SENSE(2, scp->sense_buffer,
- sizeof(scp->sense_buffer));
- /*
- * Note: The 'status_byte()' macro used by target drivers
- * defined in scsi.h shifts the status byte returned by
- * host drivers right by 1 bit. This is why target drivers
- * also use right shifted status byte definitions. For
- * instance target drivers use CHECK_CONDITION, defined to
- * 0x1, instead of the SCSI defined check condition value
- * of 0x2. Host drivers are supposed to return the status
- * byte as it is defined by SCSI.
- */
- scp->result = DRIVER_BYTE(DRIVER_SENSE) |
- STATUS_BYTE(qdonep->d3.scsi_stat);
- } else {
- scp->result = STATUS_BYTE(qdonep->d3.scsi_stat);
- }
- break;
-
- default:
- /* QHSTA error occurred */
- ASC_DBG1(2, "asc_isr_callback: host_stat %x\n",
- qdonep->d3.host_stat);
- scp->result = HOST_BYTE(DID_ERROR) | MSG_BYTE(qdonep->d3.scsi_msg) |
- STATUS_BYTE(qdonep->d3.scsi_stat);
- break;
- }
- break;
-
- case QD_ABORTED_BY_HOST:
- ASC_DBG(1, "asc_isr_callback: QD_ABORTED_BY_HOST\n");
- scp->result = HOST_BYTE(DID_ABORT) | MSG_BYTE(qdonep->d3.scsi_msg) |
- STATUS_BYTE(qdonep->d3.scsi_stat);
- break;
-
- default:
- ASC_PRINT1("asc_isr_callback: done_stat %x\n", qdonep->d3.done_stat );
- scp->result = HOST_BYTE(DID_ERROR) | MSG_BYTE(qdonep->d3.scsi_msg) |
- STATUS_BYTE(qdonep->d3.scsi_stat);
- break;
- }
-
- /*
- * Because interrupts may be enabled by the 'Scsi_Cmnd' done
- * function, add the command to the end of the board's done queue.
- * The done function for the command will be called from
- * advansys_interrupt().
- */
- asc_enqueue(&boardp->done, scp, ASC_BACK);
-
- return;
+ asc_board_t *boardp;
+ Scsi_Cmnd *scp;
+ struct Scsi_Host *shp;
+ int i;
+
+ ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
+ ASC_DBG2(1, "asc_isr_callback: asc_dvc_varp %x, qdonep %x\n",
+ (unsigned) asc_dvc_varp, (unsigned) qdonep);
+ ASC_DBG_PRT_QDONE_INFO(2, qdonep);
+
+ /*
+ * Get the Scsi_Cmnd structure and Scsi_Host structure for the
+ * command that has been completed.
+ */
+ scp = (Scsi_Cmnd *) qdonep->d2.srb_ptr;
+ ASC_DBG1(1, "asc_isr_callback: scp %x\n", (unsigned) scp);
+ ASC_DBG_PRT_CDB(2, scp->cmnd, scp->cmd_len);
+
+ if (scp == NULL) {
+ ASC_PRINT("asc_isr_callback: scp is NULL\n");
+ return;
+ }
+
+ /*
+ * If the request's host pointer is not valid, display a
+ * message and return.
+ */
+ shp = scp->host;
+ for (i = 0; i < asc_board_count; i++) {
+ if (asc_host[i] == shp) {
+ break;
+ }
+ }
+ if (i == asc_board_count) {
+ ASC_PRINT2("asc_isr_callback: scp %x has bad host pointer, host %x\n",
+ (unsigned) scp, (unsigned) shp);
+ return;
+ }
+
+ ASC_STATS(shp, callback);
+ ASC_DBG1(1, "asc_isr_callback: shp %x\n", (unsigned) shp);
+
+ /*
+ * If the request isn't found on the active queue, it may
+ * have been removed to handle a reset or abort request.
+ * Display a message and return.
+ */
+ boardp = ASC_BOARDP(shp);
+ if (asc_rmqueue(&boardp->active, scp) == ASC_FALSE) {
+ ASC_PRINT2("asc_isr_callback: board %d: scp %x not on active queue\n",
+ boardp->id, (unsigned) scp);
+ return;
+ }
+
+ /*
+ * 'qdonep' contains the command's ending status.
+ */
+ switch (qdonep->d3.done_stat) {
+ case QD_NO_ERROR:
+ ASC_DBG(2, "asc_isr_callback: QD_NO_ERROR\n");
+ switch (qdonep->d3.host_stat) {
+ case QHSTA_NO_ERROR:
+ scp->result = 0;
+ break;
+ default:
+ /* QHSTA error occurred */
+ scp->result = HOST_BYTE(DID_ERROR);
+ break;
+ }
+ break;
+
+ case QD_WITH_ERROR:
+ ASC_DBG(2, "asc_isr_callback: QD_WITH_ERROR\n");
+ switch (qdonep->d3.host_stat) {
+ case QHSTA_NO_ERROR:
+ if (qdonep->d3.scsi_stat == SS_CHK_CONDITION) {
+ ASC_DBG(2, "asc_isr_callback: SS_CHK_CONDITION\n");
+ ASC_DBG_PRT_SENSE(2, scp->sense_buffer,
+ sizeof(scp->sense_buffer));
+ /*
+ * Note: The 'status_byte()' macro used by target drivers
+ * defined in scsi.h shifts the status byte returned by
+ * host drivers right by 1 bit. This is why target drivers
+ * also use right shifted status byte definitions. For
+ * instance target drivers use CHECK_CONDITION, defined to
+ * 0x1, instead of the SCSI defined check condition value
+ * of 0x2. Host drivers are supposed to return the status
+ * byte as it is defined by SCSI.
+ */
+ scp->result = DRIVER_BYTE(DRIVER_SENSE) |
+ STATUS_BYTE(qdonep->d3.scsi_stat);
+ } else {
+ scp->result = STATUS_BYTE(qdonep->d3.scsi_stat);
+ }
+ break;
+
+ default:
+ /* QHSTA error occurred */
+ ASC_DBG1(2, "asc_isr_callback: host_stat %x\n",
+ qdonep->d3.host_stat);
+ scp->result = HOST_BYTE(DID_ERROR) | MSG_BYTE(qdonep->d3.scsi_msg) |
+ STATUS_BYTE(qdonep->d3.scsi_stat);
+ break;
+ }
+ break;
+
+ case QD_ABORTED_BY_HOST:
+ ASC_DBG(1, "asc_isr_callback: QD_ABORTED_BY_HOST\n");
+ scp->result = HOST_BYTE(DID_ABORT) | MSG_BYTE(qdonep->d3.scsi_msg) |
+ STATUS_BYTE(qdonep->d3.scsi_stat);
+ break;
+
+ default:
+ ASC_PRINT1("asc_isr_callback: done_stat %x\n", qdonep->d3.done_stat);
+ scp->result = HOST_BYTE(DID_ERROR) | MSG_BYTE(qdonep->d3.scsi_msg) |
+ STATUS_BYTE(qdonep->d3.scsi_stat);
+ break;
+ }
+
+ /*
+ * Because interrupts may be enabled by the 'Scsi_Cmnd' done
+ * function, add the command to the end of the board's done queue.
+ * The done function for the command will be called from
+ * advansys_interrupt().
+ */
+ asc_enqueue(&boardp->done, scp, ASC_BACK);
+
+ return;
}
/*
@@ -4915,174 +4959,179 @@ asc_isr_callback(ASC_DVC_VAR *asc_dvc_varp, ASC_QDONE_INFO *qdonep)
STATIC int
asc_init_dev(ASC_DVC_VAR *asc_dvc_varp, Scsi_Cmnd *scp)
{
- asc_board_t *boardp;
- ASC_SCSI_REQ_Q *scsireqq;
- ASC_CAP_INFO *cap_info;
- ASC_SCSI_INQUIRY *inquiry;
- int found;
- ASC_SCSI_BIT_ID_TYPE save_use_tagged_qng;
- ASC_SCSI_BIT_ID_TYPE save_can_tagged_qng;
- int ret;
+ asc_board_t *boardp;
+ ASC_SCSI_REQ_Q *scsireqq;
+ ASC_CAP_INFO *cap_info;
+ ASC_SCSI_INQUIRY *inquiry;
+ int found;
+ ASC_SCSI_BIT_ID_TYPE save_use_tagged_qng;
+ ASC_SCSI_BIT_ID_TYPE save_can_tagged_qng;
+ int ret;
#ifdef ADVANSYS_DEBUG
- ASC_SCSI_BIT_ID_TYPE tidmask; /* target id bit mask: 1 - 128 */
+ ASC_SCSI_BIT_ID_TYPE tidmask; /* target id bit mask: 1 - 128 */
#endif /* ADVANSYS_DEBUG */
- ASC_DBG1(1, "asc_init_dev: target %d\n", (unsigned) scp->target);
+ ASC_DBG1(1, "asc_init_dev: target %d\n", (unsigned) scp->target);
- /* The host's target id is set in init_tidmask during initialization. */
- ASC_ASSERT(asc_dvc_varp->cfg->chip_scsi_id != scp->target);
+ /* The host's target id is set in init_tidmask during initialization. */
+ ASC_ASSERT(asc_dvc_varp->cfg->chip_scsi_id != scp->target);
- boardp = ASC_BOARDP(scp->host);
+ boardp = ASC_BOARDP(scp->host);
- /* Set-up AscInitPollTarget() arguments. */
- scsireqq = &boardp->scsireqq;
- memset(scsireqq, 0, sizeof(ASC_SCSI_REQ_Q));
- cap_info = &boardp->cap_info;
- memset(cap_info, 0, sizeof(ASC_CAP_INFO));
- inquiry = &boardp->inquiry;
+ /* Set-up AscInitPollTarget() arguments. */
+ scsireqq = &boardp->scsireqq;
+ memset(scsireqq, 0, sizeof(ASC_SCSI_REQ_Q));
+ cap_info = &boardp->cap_info;
+ memset(cap_info, 0, sizeof(ASC_CAP_INFO));
+ inquiry = &boardp->inquiry;
+ memset(inquiry, 0, sizeof(ASC_SCSI_INQUIRY));
- /*
- * XXX - AscInitPollBegin() re-initializes these fields to
- * zero. 'Or' in the new values and restore them before calling
- * AscInitPollEnd(). Normally all targets are initialized within
- * a call to AscInitPollBegin() and AscInitPollEnd().
- */
- save_use_tagged_qng = asc_dvc_varp->use_tagged_qng;
+ /*
+ * XXX - AscInitPollBegin() re-initializes these fields to
+ * zero. 'Or' in the new values and restore them before calling
+ * AscInitPollEnd(). Normally all targets are initialized within
+ * a call to AscInitPollBegin() and AscInitPollEnd().
+ */
+ save_use_tagged_qng = asc_dvc_varp->use_tagged_qng;
save_can_tagged_qng = asc_dvc_varp->cfg->can_tagged_qng;
- ASC_DBG(2, "asc_init_dev: AscInitPollBegin()\n");
- if (AscInitPollBegin(asc_dvc_varp)) {
- ASC_PRINT1("asc_init_dev: board %d: AscInitPollBegin() failed\n",
- boardp->id);
- return ASC_FALSE;
- }
-
- scsireqq->sense_ptr = &scsireqq->sense[0];
- scsireqq->r1.sense_len = ASC_MIN_SENSE_LEN;
- scsireqq->r1.target_id = ASC_TID_TO_TARGET_ID(scp->target);
- scsireqq->r1.target_lun = 0;
- scsireqq->r2.target_ix = ASC_TIDLUN_TO_IX(scp->target, 0);
-
- found = ASC_FALSE;
- ASC_DBG(2, "asc_init_dev: AscInitPollTarget()\n");
- switch (ret = AscInitPollTarget(asc_dvc_varp, scsireqq, inquiry,
- cap_info)) {
- case ASC_TRUE:
- found = ASC_TRUE;
+ ASC_DBG(2, "asc_init_dev: AscInitPollBegin()\n");
+ if (AscInitPollBegin(asc_dvc_varp)) {
+ ASC_PRINT1("asc_init_dev: board %d: AscInitPollBegin() failed\n",
+ boardp->id);
+ return ASC_FALSE;
+ }
+
+ scsireqq->sense_ptr = &scsireqq->sense[0];
+ scsireqq->r1.sense_len = ASC_MIN_SENSE_LEN;
+ scsireqq->r1.target_id = ASC_TID_TO_TARGET_ID(scp->target);
+ scsireqq->r1.target_lun = 0;
+ scsireqq->r2.target_ix = ASC_TIDLUN_TO_IX(scp->target, 0);
+
+ found = ASC_FALSE;
+ ASC_DBG(2, "asc_init_dev: AscInitPollTarget()\n");
+ switch (ret = AscInitPollTarget(asc_dvc_varp, scsireqq, inquiry,
+ cap_info)) {
+ case ASC_TRUE:
+ found = ASC_TRUE;
#ifdef ADVANSYS_DEBUG
- tidmask = ASC_TIX_TO_TARGET_ID(scp->target);
- ASC_DBG2(1, "asc_init_dev: lba %lu, blk_size %lu\n",
- cap_info->lba, cap_info->blk_size);
- ASC_DBG1(1, "asc_init_dev: peri_dvc_type %x\n",
- inquiry->byte0.peri_dvc_type);
- if (asc_dvc_varp->use_tagged_qng & tidmask) {
- ASC_DBG1(1, "asc_init_dev: command queuing enabled: %d\n",
- asc_dvc_varp->max_dvc_qng[scp->target]);
- } else {
- ASC_DBG(1, "asc_init_dev: command queuing disabled\n");
- }
- if (asc_dvc_varp->init_sdtr & tidmask) {
- ASC_DBG(1, "asc_init_dev: synchronous transfers enabled\n");
- } else {
- ASC_DBG(1, "asc_init_dev: synchronous transfers disabled\n");
- }
- /* Set bit means fix disabled. */
- if (asc_dvc_varp->pci_fix_asyn_xfer & tidmask) {
- ASC_DBG(1, "asc_init_dev: synchronous transfer fix disabled\n");
- } else {
- ASC_DBG(1, "asc_init_dev: synchronous transfer fix enabled\n");
- }
+ tidmask = ASC_TIX_TO_TARGET_ID(scp->target);
+ ASC_DBG2(1, "asc_init_dev: lba %lu, blk_size %lu\n",
+ cap_info->lba, cap_info->blk_size);
+ ASC_DBG1(1, "asc_init_dev: peri_dvc_type %x\n",
+ inquiry->byte0.peri_dvc_type);
+ if (asc_dvc_varp->use_tagged_qng & tidmask) {
+ ASC_DBG1(1, "asc_init_dev: command queuing enabled: %d\n",
+ asc_dvc_varp->max_dvc_qng[scp->target]);
+ } else {
+ ASC_DBG(1, "asc_init_dev: command queuing disabled\n");
+ }
+ if (asc_dvc_varp->init_sdtr & tidmask) {
+ ASC_DBG(1, "asc_init_dev: synchronous transfers enabled\n");
+ } else {
+ ASC_DBG(1, "asc_init_dev: synchronous transfers disabled\n");
+ }
+ /* Set bit means fix disabled. */
+ if (asc_dvc_varp->pci_fix_asyn_xfer & tidmask) {
+ ASC_DBG(1, "asc_init_dev: synchronous transfer fix disabled\n");
+ } else {
+ ASC_DBG(1, "asc_init_dev: synchronous transfer fix enabled\n");
+ }
#endif /* ADVANSYS_DEBUG */
- break;
- case ASC_FALSE:
- ASC_DBG(1, "asc_init_dev: no device found\n");
- break;
- case ASC_ERROR:
- ASC_PRINT1("asc_init_dev: board %d: AscInitPollTarget() ASC_ERROR\n",
- boardp->id);
- break;
- default:
- ASC_PRINT2(
+ break;
+ case ASC_FALSE:
+ ASC_DBG(1, "asc_init_dev: no device found\n");
+ break;
+ case ASC_ERROR:
+ ASC_PRINT1("asc_init_dev: board %d: AscInitPollTarget() ASC_ERROR\n",
+ boardp->id);
+ break;
+ default:
+ ASC_PRINT2(
"asc_init_dev: board %d: AscInitPollTarget() unknown ret %d\n",
- boardp->id, ret);
- break;
- }
+ boardp->id, ret);
+ break;
+ }
- /* XXX - 'Or' in original tag bits. */
- asc_dvc_varp->use_tagged_qng |= save_use_tagged_qng;
- asc_dvc_varp->cfg->can_tagged_qng |= save_can_tagged_qng;
+ /* XXX - 'Or' in original tag bits. */
+ asc_dvc_varp->use_tagged_qng |= save_use_tagged_qng;
+ asc_dvc_varp->cfg->can_tagged_qng |= save_can_tagged_qng;
- ASC_DBG(2, "asc_init_dev: AscInitPollEnd()\n");
- AscInitPollEnd(asc_dvc_varp);
+ ASC_DBG(2, "asc_init_dev: AscInitPollEnd()\n");
+ AscInitPollEnd(asc_dvc_varp);
- ASC_DBG1(1, "asc_init_dev: found %d\n", found);
+ ASC_DBG1(1, "asc_init_dev: found %d\n", found);
- return found;
+ return found;
}
/*
* Search for an AdvanSys PCI device in the PCI configuration space.
*/
-__initfunc(STATIC int
-asc_srch_pci_dev(PCI_DEVICE *pciDevice))
-{
- int ret;
-
- ASC_DBG(2, "asc_srch_pci_dev: begin\n");
-
- if (pci_scan_method == -1) {
- pci_scan_method = asc_scan_method();
- }
- pciDevice->type = pci_scan_method;
- ASC_DBG1(2, "asc_srch_pci_dev: type %d\n", pciDevice->type);
-
- ret = asc_pci_find_dev(pciDevice);
- ASC_DBG1(2, "asc_srch_pci_dev: asc_pci_find_dev() return %d\n", ret);
- if (ret == PCI_DEVICE_FOUND) {
- pciDevice->slotNumber = pciDevice->slotFound + 1;
- pciDevice->startSlot = pciDevice->slotFound + 1;
- } else {
- if (pciDevice->bridge > pciDevice->busNumber) {
- ASC_DBG2(2, "asc_srch_pci_dev: bridge %x, busNumber %x\n",
- pciDevice->bridge, pciDevice->busNumber);
- pciDevice->busNumber++;
- pciDevice->slotNumber = 0;
- pciDevice->startSlot = 0;
- pciDevice->endSlot = 0x0f;
- ret = asc_srch_pci_dev(pciDevice);
- ASC_DBG1(2, "asc_srch_pci_dev: recursive call return %d\n", ret);
- }
- }
- ASC_DBG1(2, "asc_srch_pci_dev: return %d\n", ret);
- return ret;
+ASC_INITFUNC(
+STATIC int
+asc_srch_pci_dev(PCI_DEVICE *pciDevice)
+)
+{
+ int ret;
+
+ ASC_DBG(2, "asc_srch_pci_dev: begin\n");
+
+ if (pci_scan_method == -1) {
+ pci_scan_method = asc_scan_method();
+ }
+ pciDevice->type = pci_scan_method;
+ ASC_DBG1(2, "asc_srch_pci_dev: type %d\n", pciDevice->type);
+
+ ret = asc_pci_find_dev(pciDevice);
+ ASC_DBG1(2, "asc_srch_pci_dev: asc_pci_find_dev() return %d\n", ret);
+ if (ret == PCI_DEVICE_FOUND) {
+ pciDevice->slotNumber = pciDevice->slotFound + 1;
+ pciDevice->startSlot = pciDevice->slotFound + 1;
+ } else {
+ if (pciDevice->bridge > pciDevice->busNumber) {
+ ASC_DBG2(2, "asc_srch_pci_dev: bridge %x, busNumber %x\n",
+ pciDevice->bridge, pciDevice->busNumber);
+ pciDevice->busNumber++;
+ pciDevice->slotNumber = 0;
+ pciDevice->startSlot = 0;
+ pciDevice->endSlot = 0x0f;
+ ret = asc_srch_pci_dev(pciDevice);
+ ASC_DBG1(2, "asc_srch_pci_dev: recursive call return %d\n", ret);
+ }
+ }
+ ASC_DBG1(2, "asc_srch_pci_dev: return %d\n", ret);
+ return ret;
}
/*
* Determine the access method to be used for 'pciDevice'.
*/
-__initfunc(STATIC uchar
-asc_scan_method(void))
-{
- ushort data;
- PCI_DATA pciData;
- uchar type;
- uchar slot;
-
- ASC_DBG(2, "asc_scan_method: begin\n");
- memset(&pciData, 0, sizeof(pciData));
- for (type = 1; type < 3; type++) {
- pciData.type = type;
- for (slot = 0; slot < PCI_MAX_SLOT; slot++) {
- pciData.slot = slot;
- data = asc_get_cfg_word(&pciData);
- if ((data != 0xFFFF) && (data != 0x0000)) {
- ASC_DBG2(4, "asc_scan_method: data %x, type %d\n", data, type);
- return (type);
- }
- }
- }
- ASC_DBG1(4, "asc_scan_method: type %d\n", type);
- return (type);
+ASC_INITFUNC(
+STATIC uchar
+asc_scan_method(void)
+)
+{
+ ushort data;
+ PCI_DATA pciData;
+ uchar type;
+ uchar slot;
+
+ ASC_DBG(2, "asc_scan_method: begin\n");
+ memset(&pciData, 0, sizeof(pciData));
+ for (type = 1; type < 3; type++) {
+ pciData.type = type;
+ for (slot = 0; slot < PCI_MAX_SLOT; slot++) {
+ pciData.slot = slot;
+ data = asc_get_cfg_word(&pciData);
+ if ((data != 0xFFFF) && (data != 0x0000)) {
+ ASC_DBG2(4, "asc_scan_method: data %x, type %d\n", data, type);
+ return (type);
+ }
+ }
+ }
+ ASC_DBG1(4, "asc_scan_method: type %d\n", type);
+ return (type);
}
/*
@@ -5090,78 +5139,82 @@ asc_scan_method(void))
*
* Return PCI_DEVICE_FOUND if found, otherwise return PCI_DEVICE_NOT_FOUND.
*/
-__initfunc(STATIC int
-asc_pci_find_dev(PCI_DEVICE *pciDevice))
-{
- PCI_DATA pciData;
- ushort vendorid, deviceid;
- uchar classcode, subclass;
- uchar lslot;
-
- ASC_DBG(3, "asc_pci_find_dev: begin\n");
- pciData.type = pciDevice->type;
- pciData.bus = pciDevice->busNumber;
- pciData.func = pciDevice->devFunc;
- lslot = pciDevice->startSlot;
- for (; lslot < pciDevice->endSlot; lslot++) {
- pciData.slot = lslot;
- pciData.offset = VENDORID_OFFSET;
- vendorid = asc_get_cfg_word(&pciData);
- ASC_DBG1(3, "asc_pci_find_dev: vendorid %x\n", vendorid);
- if (vendorid != 0xffff) {
- pciData.offset = DEVICEID_OFFSET;
- deviceid = asc_get_cfg_word(&pciData);
- ASC_DBG1(3, "asc_pci_find_dev: deviceid %x\n", deviceid);
- if ((vendorid == ASC_PCI_VENDORID) &&
- ((deviceid == ASC_PCI_DEVICE_ID_1100) ||
- (deviceid == ASC_PCI_DEVICE_ID_1200) ||
- (deviceid == ASC_PCI_DEVICE_ID_1300))) {
- pciDevice->slotFound = lslot;
- ASC_DBG(3, "asc_pci_find_dev: PCI_DEVICE_FOUND\n");
- return PCI_DEVICE_FOUND;
- } else {
- pciData.offset = SUBCLASS_OFFSET;
- subclass = asc_get_cfg_byte(&pciData);
- pciData.offset = CLASSCODE_OFFSET;
- classcode = asc_get_cfg_byte(&pciData);
- if ((classcode & PCI_BASE_CLASS_BRIDGE_DEVICE) &&
- (subclass & PCI_SUB_CLASS_PCI_TO_PCI_BRIDGE_CONTROLLER)) {
- pciDevice->bridge++;
- }
- ASC_DBG2(3, "asc_pci_find_dev: subclass %x, classcode %x\n",
- subclass, classcode);
- }
- }
- }
- return PCI_DEVICE_NOT_FOUND;
+ASC_INITFUNC(
+STATIC int
+asc_pci_find_dev(PCI_DEVICE *pciDevice)
+)
+{
+ PCI_DATA pciData;
+ ushort vendorid, deviceid;
+ uchar classcode, subclass;
+ uchar lslot;
+
+ ASC_DBG(3, "asc_pci_find_dev: begin\n");
+ pciData.type = pciDevice->type;
+ pciData.bus = pciDevice->busNumber;
+ pciData.func = pciDevice->devFunc;
+ lslot = pciDevice->startSlot;
+ for (; lslot < pciDevice->endSlot; lslot++) {
+ pciData.slot = lslot;
+ pciData.offset = VENDORID_OFFSET;
+ vendorid = asc_get_cfg_word(&pciData);
+ ASC_DBG1(3, "asc_pci_find_dev: vendorid %x\n", vendorid);
+ if (vendorid != 0xffff) {
+ pciData.offset = DEVICEID_OFFSET;
+ deviceid = asc_get_cfg_word(&pciData);
+ ASC_DBG1(3, "asc_pci_find_dev: deviceid %x\n", deviceid);
+ if ((vendorid == ASC_PCI_VENDORID) &&
+ ((deviceid == ASC_PCI_DEVICE_ID_1100) ||
+ (deviceid == ASC_PCI_DEVICE_ID_1200) ||
+ (deviceid == ASC_PCI_DEVICE_ID_1300))) {
+ pciDevice->slotFound = lslot;
+ ASC_DBG(3, "asc_pci_find_dev: PCI_DEVICE_FOUND\n");
+ return PCI_DEVICE_FOUND;
+ } else {
+ pciData.offset = SUBCLASS_OFFSET;
+ subclass = asc_get_cfg_byte(&pciData);
+ pciData.offset = CLASSCODE_OFFSET;
+ classcode = asc_get_cfg_byte(&pciData);
+ if ((classcode & PCI_BASE_CLASS_BRIDGE_DEVICE) &&
+ (subclass & PCI_SUB_CLASS_PCI_TO_PCI_BRIDGE_CONTROLLER)) {
+ pciDevice->bridge++;
+ }
+ ASC_DBG2(3, "asc_pci_find_dev: subclass %x, classcode %x\n",
+ subclass, classcode);
+ }
+ }
+ }
+ return PCI_DEVICE_NOT_FOUND;
}
/*
* Read PCI configuration data into 'pciConfig'.
*/
-__initfunc(STATIC void
-asc_get_pci_cfg(PCI_DEVICE *pciDevice, PCI_CONFIG_SPACE *pciConfig))
+ASC_INITFUNC(
+STATIC void
+asc_get_pci_cfg(PCI_DEVICE *pciDevice, PCI_CONFIG_SPACE *pciConfig)
+)
{
- PCI_DATA pciData;
- uchar counter;
- uchar *localConfig;
+ PCI_DATA pciData;
+ uchar counter;
+ uchar *localConfig;
- ASC_DBG1(4, "asc_get_pci_cfg: slot found - %d\n ",
- pciDevice->slotFound);
+ ASC_DBG1(4, "asc_get_pci_cfg: slot found - %d\n ",
+ pciDevice->slotFound);
- pciData.type = pciDevice->type;
- pciData.bus = pciDevice->busNumber;
- pciData.slot = pciDevice->slotFound;
- pciData.func = pciDevice->devFunc;
- localConfig = (uchar *) pciConfig;
+ pciData.type = pciDevice->type;
+ pciData.bus = pciDevice->busNumber;
+ pciData.slot = pciDevice->slotFound;
+ pciData.func = pciDevice->devFunc;
+ localConfig = (uchar *) pciConfig;
- for (counter = 0; counter < sizeof(PCI_CONFIG_SPACE); counter++) {
- pciData.offset = counter;
- *localConfig = asc_get_cfg_byte(&pciData);
- ASC_DBG1(4, "asc_get_pci_cfg: byte %x\n", *localConfig);
- localConfig++;
- }
- ASC_DBG1(4, "asc_get_pci_cfg: counter %d\n", counter);
+ for (counter = 0; counter < sizeof(PCI_CONFIG_SPACE); counter++) {
+ pciData.offset = counter;
+ *localConfig = asc_get_cfg_byte(&pciData);
+ ASC_DBG1(4, "asc_get_pci_cfg: byte %x\n", *localConfig);
+ localConfig++;
+ }
+ ASC_DBG1(4, "asc_get_pci_cfg: counter %d\n", counter);
}
/*
@@ -5169,80 +5222,82 @@ asc_get_pci_cfg(PCI_DEVICE *pciDevice, PCI_CONFIG_SPACE *pciConfig))
*
* The configuration mechanism is checked for the correct access method.
*/
-__initfunc(STATIC ushort
-asc_get_cfg_word(PCI_DATA *pciData))
-{
- ushort tmp;
- ulong address;
- ulong lbus = pciData->bus;
- ulong lslot = pciData->slot;
- ulong lfunc = pciData->func;
- uchar t2CFA, t2CF8;
- ulong t1CF8, t1CFC;
-
- ASC_DBG4(4, "asc_get_cfg_word: type %d, bus %lu, slot %lu, func %lu\n",
- pciData->type, lbus, lslot, lfunc);
-
- /*
- * Check type of configuration mechanism.
- */
- if (pciData->type == 2) {
- /*
- * Save registers to be restored later.
- */
- t2CFA = inp(0xCFA); /* save PCI bus register */
- t2CF8 = inp(0xCF8); /* save config space enable register */
-
- /*
- * Write the bus and enable registers.
- */
- /* set for type 1 cycle, if needed */
- outp(0xCFA, pciData->bus);
- /* set the function number */
- outp(0xCF8, 0x10 | (pciData->func << 1)) ;
-
- /*
- * Read the configuration space type 2 locations.
- */
- tmp = (ushort) inpw(0xC000 | ((pciData->slot << 8) + pciData->offset));
-
- outp(0xCFA, t2CFA); /* save PCI bus register */
- outp(0xCF8, t2CF8); /* save config space enable register */
- } else {
- /*
- * Type 1 or 3 configuration mechanism.
- *
- * Save the CONFIG_ADDRESS and CONFIG_DATA register values.
- */
- t1CF8 = inpl(0xCF8);
- t1CFC = inpl(0xCFC);
-
- /*
- * enable <31>, bus = <23:16>, slot = <15:11>,
- * func = <10:8>, reg = <7:2>
- */
- address = (ulong) ((lbus << 16) | (lslot << 11) |
- (lfunc << 8) | (pciData->offset & 0xFC) | 0x80000000L);
-
- /*
- * Write out the address to CONFIG_ADDRESS.
- */
- outpl(0xCF8, address);
-
- /*
- * Read in word from CONFIG_DATA.
- */
- tmp = (ushort) ((inpl(0xCFC) >>
- ((pciData->offset & 2) * 8)) & 0xFFFF);
-
- /*
- * Restore registers.
- */
- outpl(0xCF8, t1CF8);
- outpl(0xCFC, t1CFC);
- }
- ASC_DBG1(4, "asc_get_cfg_word: config data: %x\n", tmp);
- return tmp;
+ASC_INITFUNC(
+STATIC ushort
+asc_get_cfg_word(PCI_DATA *pciData)
+)
+{
+ ushort tmp;
+ ulong address;
+ ulong lbus = pciData->bus;
+ ulong lslot = pciData->slot;
+ ulong lfunc = pciData->func;
+ uchar t2CFA, t2CF8;
+ ulong t1CF8, t1CFC;
+
+ ASC_DBG4(4, "asc_get_cfg_word: type %d, bus %lu, slot %lu, func %lu\n",
+ pciData->type, lbus, lslot, lfunc);
+
+ /*
+ * Check type of configuration mechanism.
+ */
+ if (pciData->type == 2) {
+ /*
+ * Save registers to be restored later.
+ */
+ t2CFA = inp(0xCFA); /* save PCI bus register */
+ t2CF8 = inp(0xCF8); /* save config space enable register */
+
+ /*
+ * Write the bus and enable registers.
+ */
+ /* set for type 1 cycle, if needed */
+ outp(0xCFA, pciData->bus);
+ /* set the function number */
+ outp(0xCF8, 0x10 | (pciData->func << 1)) ;
+
+ /*
+ * Read the configuration space type 2 locations.
+ */
+ tmp = (ushort) inpw(0xC000 | ((pciData->slot << 8) + pciData->offset));
+
+ outp(0xCFA, t2CFA); /* save PCI bus register */
+ outp(0xCF8, t2CF8); /* save config space enable register */
+ } else {
+ /*
+ * Type 1 or 3 configuration mechanism.
+ *
+ * Save the CONFIG_ADDRESS and CONFIG_DATA register values.
+ */
+ t1CF8 = inpl(0xCF8);
+ t1CFC = inpl(0xCFC);
+
+ /*
+ * enable <31>, bus = <23:16>, slot = <15:11>,
+ * func = <10:8>, reg = <7:2>
+ */
+ address = (ulong) ((lbus << 16) | (lslot << 11) |
+ (lfunc << 8) | (pciData->offset & 0xFC) | 0x80000000L);
+
+ /*
+ * Write out the address to CONFIG_ADDRESS.
+ */
+ outpl(0xCF8, address);
+
+ /*
+ * Read in word from CONFIG_DATA.
+ */
+ tmp = (ushort) ((inpl(0xCFC) >>
+ ((pciData->offset & 2) * 8)) & 0xFFFF);
+
+ /*
+ * Restore registers.
+ */
+ outpl(0xCF8, t1CF8);
+ outpl(0xCFC, t1CFC);
+ }
+ ASC_DBG1(4, "asc_get_cfg_word: config data: %x\n", tmp);
+ return tmp;
}
/*
@@ -5250,162 +5305,166 @@ asc_get_cfg_word(PCI_DATA *pciData))
*
* The configuration mechanism is checked for the correct access method.
*/
-__initfunc(STATIC uchar
-asc_get_cfg_byte(PCI_DATA *pciData))
-{
- uchar tmp;
- ulong address;
- ulong lbus = pciData->bus, lslot = pciData->slot, lfunc = pciData->func;
- uchar t2CFA, t2CF8;
- ulong t1CF8, t1CFC;
-
- ASC_DBG1(4, "asc_get_cfg_byte: type: %d\n", pciData->type);
-
- /*
- * Check type of configuration mechanism.
- */
- if (pciData->type == 2) {
- /*
- * Save registers to be restored later.
- */
- t2CFA = inp(0xCFA); /* save PCI bus register */
- t2CF8 = inp(0xCF8); /* save config space enable register */
-
- /*
- * Write the bus and enable registers.
- */
- /* set for type 1 cycle, if needed */
- outp(0xCFA, pciData->bus);
- /* set the function number */
- outp(0xCF8, 0x10 | (pciData->func << 1));
-
- /*
- * Read configuration space type 2 locations.
- */
- tmp = inp(0xC000 | ((pciData->slot << 8) + pciData->offset));
-
- /*
- * Restore registers.
- */
- outp(0xCF8, t2CF8); /* restore the enable register */
- outp(0xCFA, t2CFA); /* restore PCI bus register */
- } else {
- /*
- * Type 1 or 3 configuration mechanism.
- *
- * Save CONFIG_ADDRESS and CONFIG_DATA register values.
- */
- t1CF8 = inpl(0xCF8);
- t1CFC = inpl(0xCFC);
-
- /*
- * enable <31>, bus = <23:16>, slot = <15:11>, func = <10:8>,
- * reg = <7:2>
- */
- address = (ulong) ((lbus << 16) | (lslot << 11) |
- (lfunc << 8) | (pciData->offset & 0xFC) | 0x80000000L);
-
- /*
- * Write out address to CONFIG_ADDRESS.
- */
- outpl(0xCF8, address);
-
- /*
- * Read in word from CONFIG_DATA.
- */
- tmp = (uchar) ((inpl(0xCFC) >> ((pciData->offset & 3) * 8)) & 0xFF);
-
- /*
- * Restore registers.
- */
- outpl(0xCF8, t1CF8);
- outpl(0xCFC, t1CFC);
- }
- ASC_DBG1(4, "asc_get_cfg_byte: config data: %x\n", tmp);
- return tmp;
+ASC_INITFUNC(
+STATIC uchar
+asc_get_cfg_byte(PCI_DATA *pciData)
+)
+{
+ uchar tmp;
+ ulong address;
+ ulong lbus = pciData->bus, lslot = pciData->slot, lfunc = pciData->func;
+ uchar t2CFA, t2CF8;
+ ulong t1CF8, t1CFC;
+
+ ASC_DBG1(4, "asc_get_cfg_byte: type: %d\n", pciData->type);
+
+ /*
+ * Check type of configuration mechanism.
+ */
+ if (pciData->type == 2) {
+ /*
+ * Save registers to be restored later.
+ */
+ t2CFA = inp(0xCFA); /* save PCI bus register */
+ t2CF8 = inp(0xCF8); /* save config space enable register */
+
+ /*
+ * Write the bus and enable registers.
+ */
+ /* set for type 1 cycle, if needed */
+ outp(0xCFA, pciData->bus);
+ /* set the function number */
+ outp(0xCF8, 0x10 | (pciData->func << 1));
+
+ /*
+ * Read configuration space type 2 locations.
+ */
+ tmp = inp(0xC000 | ((pciData->slot << 8) + pciData->offset));
+
+ /*
+ * Restore registers.
+ */
+ outp(0xCF8, t2CF8); /* restore the enable register */
+ outp(0xCFA, t2CFA); /* restore PCI bus register */
+ } else {
+ /*
+ * Type 1 or 3 configuration mechanism.
+ *
+ * Save CONFIG_ADDRESS and CONFIG_DATA register values.
+ */
+ t1CF8 = inpl(0xCF8);
+ t1CFC = inpl(0xCFC);
+
+ /*
+ * enable <31>, bus = <23:16>, slot = <15:11>, func = <10:8>,
+ * reg = <7:2>
+ */
+ address = (ulong) ((lbus << 16) | (lslot << 11) |
+ (lfunc << 8) | (pciData->offset & 0xFC) | 0x80000000L);
+
+ /*
+ * Write out address to CONFIG_ADDRESS.
+ */
+ outpl(0xCF8, address);
+
+ /*
+ * Read in word from CONFIG_DATA.
+ */
+ tmp = (uchar) ((inpl(0xCFC) >> ((pciData->offset & 3) * 8)) & 0xFF);
+
+ /*
+ * Restore registers.
+ */
+ outpl(0xCF8, t1CF8);
+ outpl(0xCFC, t1CFC);
+ }
+ ASC_DBG1(4, "asc_get_cfg_byte: config data: %x\n", tmp);
+ return tmp;
}
/*
* Write a byte to the PCI configuration space.
*/
-__initfunc(void
-asc_put_cfg_byte(PCI_DATA *pciData, uchar byte_data))
-{
- ulong tmpl;
- ulong address;
- ulong lbus = pciData->bus, lslot = pciData->slot, lfunc = pciData->func;
- uchar t2CFA, t2CF8;
- ulong t1CF8, t1CFC;
-
- ASC_DBG2(4, "asc_put_cfg_byte: type: %d, byte_data %x\n",
- pciData->type, byte_data);
-
- /*
- * Check type of configuration mechanism.
- */
- if (pciData->type == 2) {
-
- /*
- * Save registers to be restored later.
- */
- t2CFA = inp(0xCFA); /* save PCI bus register */
- t2CF8 = inp(0xCF8); /* save config space enable register */
-
- /*
- * Write bus and enable registers.
- */
- outp(0xCFA, pciData->bus);
-
- /*
- * Set the function number.
- */
- outp(0xCF8, 0x10 | (pciData->func << 1));
-
- /*
- * Write the configuration space type 2 locations.
- */
- outp(0xC000 | ((pciData->slot << 8) + pciData->offset), byte_data);
-
- /*
- * Restore registers.
- */
- outp(0xCF8, t2CF8); /* restore the enable register */
- outp(0xCFA, t2CFA); /* restore PCI bus register */
- } else {
-
- /*
- * Type 1 or 3 configuration mechanism.
- *
- * Save the CONFIG_ADDRESS and CONFIG_DATA register values.
- */
- t1CF8 = inpl(0xCF8);
- t1CFC = inpl(0xCFC);
-
- /*
- * enable <31>, bus = <23:16>, slot = <15:11>, func = <10:8>,
- * reg = <7:2>
- */
- address = (ulong) ((lbus << 16) | (lslot << 11) | (lfunc << 8) |
- (pciData->offset & 0xFC) | 0x80000000L);
- /*
- * Write out address to CONFIG_ADDRESS.
- */
- outpl(0xCF8, address);
-
- /*
- * Write double word to CONFIG_DATA preserving the bytes
- * in the double not written.
- */
- tmpl = inpl(0xCFC) & ~(0xFF << ((pciData->offset & 3) * 8));
- outpl(0xCFC, tmpl | (byte_data << ((pciData->offset & 3) * 8)));
-
- /*
- * Restore registers.
- */
- outpl(0xCF8, t1CF8);
- outpl(0xCFC, t1CFC);
- }
- ASC_DBG(4, "asc_put_cfg_byte: end\n");
+ASC_INITFUNC(
+STATIC void
+asc_put_cfg_byte(PCI_DATA *pciData, uchar byte_data)
+)
+{
+ ulong tmpl;
+ ulong address;
+ ulong lbus = pciData->bus, lslot = pciData->slot, lfunc = pciData->func;
+ uchar t2CFA, t2CF8;
+ ulong t1CF8, t1CFC;
+
+ ASC_DBG2(4, "asc_put_cfg_byte: type: %d, byte_data %x\n",
+ pciData->type, byte_data);
+
+ /*
+ * Check type of configuration mechanism.
+ */
+ if (pciData->type == 2) {
+
+ /*
+ * Save registers to be restored later.
+ */
+ t2CFA = inp(0xCFA); /* save PCI bus register */
+ t2CF8 = inp(0xCF8); /* save config space enable register */
+
+ /*
+ * Write bus and enable registers.
+ */
+ outp(0xCFA, pciData->bus);
+
+ /*
+ * Set the function number.
+ */
+ outp(0xCF8, 0x10 | (pciData->func << 1));
+
+ /*
+ * Write the configuration space type 2 locations.
+ */
+ outp(0xC000 | ((pciData->slot << 8) + pciData->offset), byte_data);
+
+ /*
+ * Restore registers.
+ */
+ outp(0xCF8, t2CF8); /* restore the enable register */
+ outp(0xCFA, t2CFA); /* restore PCI bus register */
+ } else {
+
+ /*
+ * Type 1 or 3 configuration mechanism.
+ *
+ * Save the CONFIG_ADDRESS and CONFIG_DATA register values.
+ */
+ t1CF8 = inpl(0xCF8);
+ t1CFC = inpl(0xCFC);
+
+ /*
+ * enable <31>, bus = <23:16>, slot = <15:11>, func = <10:8>,
+ * reg = <7:2>
+ */
+ address = (ulong) ((lbus << 16) | (lslot << 11) | (lfunc << 8) |
+ (pciData->offset & 0xFC) | 0x80000000L);
+ /*
+ * Write out address to CONFIG_ADDRESS.
+ */
+ outpl(0xCF8, address);
+
+ /*
+ * Write double word to CONFIG_DATA preserving the bytes
+ * in the double not written.
+ */
+ tmpl = inpl(0xCFC) & ~(0xFF << ((pciData->offset & 3) * 8));
+ outpl(0xCFC, tmpl | (byte_data << ((pciData->offset & 3) * 8)));
+
+ /*
+ * Restore registers.
+ */
+ outpl(0xCF8, t1CF8);
+ outpl(0xCFC, t1CFC);
+ }
+ ASC_DBG(4, "asc_put_cfg_byte: end\n");
}
/*
@@ -5416,51 +5475,51 @@ asc_put_cfg_byte(PCI_DATA *pciData, uchar byte_data))
*
* 'REQPNEXT(reqp)' returns reqp's next pointer.
*/
-void
+STATIC void
asc_enqueue(asc_queue_t *ascq, REQP reqp, int flag)
{
- int tid;
-
- ASC_DBG3(2, "asc_enqueue: ascq %x, reqp %x, flag %d\n",
- (unsigned) ascq, (unsigned) reqp, flag);
- ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
- ASC_ASSERT(reqp != NULL);
- ASC_ASSERT(flag == ASC_FRONT || flag == ASC_BACK);
- tid = REQPTID(reqp);
- ASC_ASSERT(tid >= 0 && tid <= ASC_MAX_TID);
- if (flag == ASC_FRONT) {
- REQPNEXT(reqp) = ascq->q_first[tid];
- ascq->q_first[tid] = reqp;
- /* If the queue was empty, set the last pointer. */
- if (ascq->q_last[tid] == NULL) {
- ascq->q_last[tid] = reqp;
- }
- } else { /* ASC_BACK */
- if (ascq->q_last[tid] != NULL) {
- REQPNEXT(ascq->q_last[tid]) = reqp;
- }
- ascq->q_last[tid] = reqp;
- REQPNEXT(reqp) = NULL;
- /* If the queue was empty, set the first pointer. */
- if (ascq->q_first[tid] == NULL) {
- ascq->q_first[tid] = reqp;
- }
- }
- /* The queue has at least one entry, set its bit. */
- ascq->q_tidmask |= ASC_TIX_TO_TARGET_ID(tid);
+ int tid;
+
+ ASC_DBG3(2, "asc_enqueue: ascq %x, reqp %x, flag %d\n",
+ (unsigned) ascq, (unsigned) reqp, flag);
+ ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
+ ASC_ASSERT(reqp != NULL);
+ ASC_ASSERT(flag == ASC_FRONT || flag == ASC_BACK);
+ tid = REQPTID(reqp);
+ ASC_ASSERT(tid >= 0 && tid <= ASC_MAX_TID);
+ if (flag == ASC_FRONT) {
+ REQPNEXT(reqp) = ascq->q_first[tid];
+ ascq->q_first[tid] = reqp;
+ /* If the queue was empty, set the last pointer. */
+ if (ascq->q_last[tid] == NULL) {
+ ascq->q_last[tid] = reqp;
+ }
+ } else { /* ASC_BACK */
+ if (ascq->q_last[tid] != NULL) {
+ REQPNEXT(ascq->q_last[tid]) = reqp;
+ }
+ ascq->q_last[tid] = reqp;
+ REQPNEXT(reqp) = NULL;
+ /* If the queue was empty, set the first pointer. */
+ if (ascq->q_first[tid] == NULL) {
+ ascq->q_first[tid] = reqp;
+ }
+ }
+ /* The queue has at least one entry, set its bit. */
+ ascq->q_tidmask |= ASC_TIX_TO_TARGET_ID(tid);
#ifdef ADVANSYS_STATS
- /* Maintain request queue statistics. */
- ascq->q_tot_cnt[tid]++;
- ascq->q_cur_cnt[tid]++;
- if (ascq->q_cur_cnt[tid] > ascq->q_max_cnt[tid]) {
- ascq->q_max_cnt[tid] = ascq->q_cur_cnt[tid];
- ASC_DBG2(1, "asc_enqueue: new q_max_cnt[%d] %d\n",
- tid, ascq->q_max_cnt[tid]);
- }
- REQPTIME(reqp) = REQTIMESTAMP();
+ /* Maintain request queue statistics. */
+ ascq->q_tot_cnt[tid]++;
+ ascq->q_cur_cnt[tid]++;
+ if (ascq->q_cur_cnt[tid] > ascq->q_max_cnt[tid]) {
+ ascq->q_max_cnt[tid] = ascq->q_cur_cnt[tid];
+ ASC_DBG2(1, "asc_enqueue: new q_max_cnt[%d] %d\n",
+ tid, ascq->q_max_cnt[tid]);
+ }
+ REQPTIME(reqp) = REQTIMESTAMP();
#endif /* ADVANSYS_STATS */
- ASC_DBG1(1, "asc_enqueue: reqp %x\n", (unsigned) reqp);
- return;
+ ASC_DBG1(1, "asc_enqueue: reqp %x\n", (unsigned) reqp);
+ return;
}
/*
@@ -5470,32 +5529,32 @@ asc_enqueue(asc_queue_t *ascq, REQP reqp, int flag)
*
* 'REQPNEXT(reqp)' returns reqp's next pointer.
*/
-REQP
+STATIC REQP
asc_dequeue(asc_queue_t *ascq, int tid)
{
- REQP reqp;
-
- ASC_DBG2(1, "asc_dequeue: ascq %x, tid %d\n", (unsigned) ascq, tid);
- ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
- ASC_ASSERT(tid >= 0 && tid <= ASC_MAX_TID);
- if ((reqp = ascq->q_first[tid]) != NULL) {
- ASC_ASSERT(ascq->q_tidmask & ASC_TIX_TO_TARGET_ID(tid));
- ascq->q_first[tid] = REQPNEXT(reqp);
- /* If the queue is empty, clear its bit and the last pointer. */
- if (ascq->q_first[tid] == NULL) {
- ascq->q_tidmask &= ~ASC_TIX_TO_TARGET_ID(tid);
- ASC_ASSERT(ascq->q_last[tid] == reqp);
- ascq->q_last[tid] = NULL;
- }
+ REQP reqp;
+
+ ASC_DBG2(1, "asc_dequeue: ascq %x, tid %d\n", (unsigned) ascq, tid);
+ ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
+ ASC_ASSERT(tid >= 0 && tid <= ASC_MAX_TID);
+ if ((reqp = ascq->q_first[tid]) != NULL) {
+ ASC_ASSERT(ascq->q_tidmask & ASC_TIX_TO_TARGET_ID(tid));
+ ascq->q_first[tid] = REQPNEXT(reqp);
+ /* If the queue is empty, clear its bit and the last pointer. */
+ if (ascq->q_first[tid] == NULL) {
+ ascq->q_tidmask &= ~ASC_TIX_TO_TARGET_ID(tid);
+ ASC_ASSERT(ascq->q_last[tid] == reqp);
+ ascq->q_last[tid] = NULL;
+ }
#ifdef ADVANSYS_STATS
- /* Maintain request queue statistics. */
- ascq->q_cur_cnt[tid]--;
- ASC_ASSERT(ascq->q_cur_cnt[tid] >= 0);
- REQTIMESTAT("asc_dequeue", ascq, reqp, tid);
+ /* Maintain request queue statistics. */
+ ascq->q_cur_cnt[tid]--;
+ ASC_ASSERT(ascq->q_cur_cnt[tid] >= 0);
+ REQTIMESTAT("asc_dequeue", ascq, reqp, tid);
#endif /* ADVANSYS_STATS */
- }
- ASC_DBG1(1, "asc_dequeue: reqp %x\n", (unsigned) reqp);
- return reqp;
+ }
+ ASC_DBG1(1, "asc_dequeue: reqp %x\n", (unsigned) reqp);
+ return reqp;
}
/*
@@ -5518,75 +5577,75 @@ asc_dequeue(asc_queue_t *ascq, int tid)
* Unfortunately collecting queuing time statistics adds overhead to
* the function that isn't inherent to the function's algorithm.
*/
-REQP
+STATIC REQP
asc_dequeue_list(asc_queue_t *ascq, REQP *lastpp, int tid)
{
- REQP firstp, lastp;
- int i;
-
- ASC_DBG2(1, "asc_dequeue_list: ascq %x, tid %d\n", (unsigned) ascq, tid);
- ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
- ASC_ASSERT((tid == ASC_TID_ALL) || (tid >= 0 && tid <= ASC_MAX_TID));
-
- /*
- * If 'tid' is not ASC_TID_ALL, return requests only for
- * the specified 'tid'. If 'tid' is ASC_TID_ALL, return all
- * requests for all tids.
- */
- if (tid != ASC_TID_ALL) {
- /* Return all requests for the specified 'tid'. */
- if ((ascq->q_tidmask & ASC_TIX_TO_TARGET_ID(tid)) == 0) {
- /* List is empty; Set first and last return pointers to NULL. */
- firstp = lastp = NULL;
- } else {
- firstp = ascq->q_first[tid];
- lastp = ascq->q_last[tid];
- ascq->q_first[tid] = ascq->q_last[tid] = NULL;
- ascq->q_tidmask &= ~ASC_TIX_TO_TARGET_ID(tid);
+ REQP firstp, lastp;
+ int i;
+
+ ASC_DBG2(1, "asc_dequeue_list: ascq %x, tid %d\n", (unsigned) ascq, tid);
+ ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
+ ASC_ASSERT((tid == ASC_TID_ALL) || (tid >= 0 && tid <= ASC_MAX_TID));
+
+ /*
+ * If 'tid' is not ASC_TID_ALL, return requests only for
+ * the specified 'tid'. If 'tid' is ASC_TID_ALL, return all
+ * requests for all tids.
+ */
+ if (tid != ASC_TID_ALL) {
+ /* Return all requests for the specified 'tid'. */
+ if ((ascq->q_tidmask & ASC_TIX_TO_TARGET_ID(tid)) == 0) {
+ /* List is empty; Set first and last return pointers to NULL. */
+ firstp = lastp = NULL;
+ } else {
+ firstp = ascq->q_first[tid];
+ lastp = ascq->q_last[tid];
+ ascq->q_first[tid] = ascq->q_last[tid] = NULL;
+ ascq->q_tidmask &= ~ASC_TIX_TO_TARGET_ID(tid);
#ifdef ADVANSYS_STATS
- {
- REQP reqp;
- ascq->q_cur_cnt[tid] = 0;
- for (reqp = firstp; reqp; reqp = REQPNEXT(reqp)) {
- REQTIMESTAT("asc_dequeue_list", ascq, reqp, tid);
- }
- }
+ {
+ REQP reqp;
+ ascq->q_cur_cnt[tid] = 0;
+ for (reqp = firstp; reqp; reqp = REQPNEXT(reqp)) {
+ REQTIMESTAT("asc_dequeue_list", ascq, reqp, tid);
+ }
+ }
#endif /* ADVANSYS_STATS */
- }
- } else {
- /* Return all requests for all tids. */
- firstp = lastp = NULL;
- for (i = 0; i <= ASC_MAX_TID; i++) {
- if (ascq->q_tidmask & ASC_TIX_TO_TARGET_ID(i)) {
- if (firstp == NULL) {
- firstp = ascq->q_first[i];
- lastp = ascq->q_last[i];
- } else {
- ASC_ASSERT(lastp != NULL);
- REQPNEXT(lastp) = ascq->q_first[i];
- lastp = ascq->q_last[i];
- }
- ascq->q_first[i] = ascq->q_last[i] = NULL;
- ascq->q_tidmask &= ~ASC_TIX_TO_TARGET_ID(i);
+ }
+ } else {
+ /* Return all requests for all tids. */
+ firstp = lastp = NULL;
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ if (ascq->q_tidmask & ASC_TIX_TO_TARGET_ID(i)) {
+ if (firstp == NULL) {
+ firstp = ascq->q_first[i];
+ lastp = ascq->q_last[i];
+ } else {
+ ASC_ASSERT(lastp != NULL);
+ REQPNEXT(lastp) = ascq->q_first[i];
+ lastp = ascq->q_last[i];
+ }
+ ascq->q_first[i] = ascq->q_last[i] = NULL;
+ ascq->q_tidmask &= ~ASC_TIX_TO_TARGET_ID(i);
#ifdef ADVANSYS_STATS
- ascq->q_cur_cnt[i] = 0;
+ ascq->q_cur_cnt[i] = 0;
#endif /* ADVANSYS_STATS */
- }
- }
+ }
+ }
#ifdef ADVANSYS_STATS
- {
- REQP reqp;
- for (reqp = firstp; reqp; reqp = REQPNEXT(reqp)) {
- REQTIMESTAT("asc_dequeue_list", ascq, reqp, reqp->target);
- }
- }
+ {
+ REQP reqp;
+ for (reqp = firstp; reqp; reqp = REQPNEXT(reqp)) {
+ REQTIMESTAT("asc_dequeue_list", ascq, reqp, reqp->target);
+ }
+ }
#endif /* ADVANSYS_STATS */
- }
- if (lastpp) {
- *lastpp = lastp;
- }
- ASC_DBG1(1, "asc_dequeue_list: firstp %x\n", (unsigned) firstp);
- return firstp;
+ }
+ if (lastpp) {
+ *lastpp = lastp;
+ }
+ ASC_DBG1(1, "asc_dequeue_list: firstp %x\n", (unsigned) firstp);
+ return firstp;
}
/*
@@ -5599,98 +5658,98 @@ asc_dequeue_list(asc_queue_t *ascq, REQP *lastpp, int tid)
* Return ASC_TRUE if the command was found and removed,
* otherwise return ASC_FALSE.
*/
-int
+STATIC int
asc_rmqueue(asc_queue_t *ascq, REQP reqp)
{
- REQP currp, prevp;
- int tid;
- int ret = ASC_FALSE;
-
- ASC_DBG2(1, "asc_rmqueue: ascq %x, reqp %x\n",
- (unsigned) ascq, (unsigned) reqp);
- ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
- ASC_ASSERT(reqp != NULL);
-
- tid = REQPTID(reqp);
- ASC_ASSERT(tid >= 0 && tid <= ASC_MAX_TID);
-
- /*
- * Handle the common case of 'reqp' being the first
- * entry on the queue.
- */
- if (reqp == ascq->q_first[tid]) {
- ret = ASC_TRUE;
- ascq->q_first[tid] = REQPNEXT(reqp);
- /* If the queue is now empty, clear its bit and the last pointer. */
- if (ascq->q_first[tid] == NULL) {
- ascq->q_tidmask &= ~ASC_TIX_TO_TARGET_ID(tid);
- ASC_ASSERT(ascq->q_last[tid] == reqp);
- ascq->q_last[tid] = NULL;
- }
- } else if (ascq->q_first[tid] != NULL) {
- ASC_ASSERT(ascq->q_last[tid] != NULL);
- /*
- * Because the case of 'reqp' being the first entry has been
- * handled above and it is known the queue is not empty, if
- * 'reqp' is found on the queue it is guaranteed the queue will
- * not become empty and that 'q_first[tid]' will not be changed.
- *
- * Set 'prevp' to the first entry, 'currp' to the second entry,
- * and search for 'reqp'.
- */
- for (prevp = ascq->q_first[tid], currp = REQPNEXT(prevp);
- currp; prevp = currp, currp = REQPNEXT(currp)) {
- if (currp == reqp) {
- ret = ASC_TRUE;
- REQPNEXT(prevp) = REQPNEXT(currp);
- REQPNEXT(reqp) = NULL;
- if (ascq->q_last[tid] == reqp) {
- ascq->q_last[tid] = prevp;
- }
- break;
- }
- }
- }
+ REQP currp, prevp;
+ int tid;
+ int ret = ASC_FALSE;
+
+ ASC_DBG2(1, "asc_rmqueue: ascq %x, reqp %x\n",
+ (unsigned) ascq, (unsigned) reqp);
+ ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
+ ASC_ASSERT(reqp != NULL);
+
+ tid = REQPTID(reqp);
+ ASC_ASSERT(tid >= 0 && tid <= ASC_MAX_TID);
+
+ /*
+ * Handle the common case of 'reqp' being the first
+ * entry on the queue.
+ */
+ if (reqp == ascq->q_first[tid]) {
+ ret = ASC_TRUE;
+ ascq->q_first[tid] = REQPNEXT(reqp);
+ /* If the queue is now empty, clear its bit and the last pointer. */
+ if (ascq->q_first[tid] == NULL) {
+ ascq->q_tidmask &= ~ASC_TIX_TO_TARGET_ID(tid);
+ ASC_ASSERT(ascq->q_last[tid] == reqp);
+ ascq->q_last[tid] = NULL;
+ }
+ } else if (ascq->q_first[tid] != NULL) {
+ ASC_ASSERT(ascq->q_last[tid] != NULL);
+ /*
+ * Because the case of 'reqp' being the first entry has been
+ * handled above and it is known the queue is not empty, if
+ * 'reqp' is found on the queue it is guaranteed the queue will
+ * not become empty and that 'q_first[tid]' will not be changed.
+ *
+ * Set 'prevp' to the first entry, 'currp' to the second entry,
+ * and search for 'reqp'.
+ */
+ for (prevp = ascq->q_first[tid], currp = REQPNEXT(prevp);
+ currp; prevp = currp, currp = REQPNEXT(currp)) {
+ if (currp == reqp) {
+ ret = ASC_TRUE;
+ REQPNEXT(prevp) = REQPNEXT(currp);
+ REQPNEXT(reqp) = NULL;
+ if (ascq->q_last[tid] == reqp) {
+ ascq->q_last[tid] = prevp;
+ }
+ break;
+ }
+ }
+ }
#ifdef ADVANSYS_STATS
- /* Maintain request queue statistics. */
- if (ret == ASC_TRUE) {
- ascq->q_cur_cnt[tid]--;
- REQTIMESTAT("asc_rmqueue", ascq, reqp, tid);
- }
- ASC_ASSERT(ascq->q_cur_cnt[tid] >= 0);
+ /* Maintain request queue statistics. */
+ if (ret == ASC_TRUE) {
+ ascq->q_cur_cnt[tid]--;
+ REQTIMESTAT("asc_rmqueue", ascq, reqp, tid);
+ }
+ ASC_ASSERT(ascq->q_cur_cnt[tid] >= 0);
#endif /* ADVANSYS_STATS */
- ASC_DBG2(1, "asc_rmqueue: reqp %x, ret %d\n", (unsigned) reqp, ret);
- return ret;
+ ASC_DBG2(1, "asc_rmqueue: reqp %x, ret %d\n", (unsigned) reqp, ret);
+ return ret;
}
/*
* If the specified 'REQP' is queued on the specified queue for
* the specified target device, return ASC_TRUE.
*/
-int
+STATIC int
asc_isqueued(asc_queue_t *ascq, REQP reqp)
{
- REQP treqp;
- int tid;
- int ret = ASC_FALSE;
+ REQP treqp;
+ int tid;
+ int ret = ASC_FALSE;
- ASC_DBG2(1, "asc_isqueued: ascq %x, reqp %x\n",
- (unsigned) ascq, (unsigned) reqp);
- ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
- ASC_ASSERT(reqp != NULL);
+ ASC_DBG2(1, "asc_isqueued: ascq %x, reqp %x\n",
+ (unsigned) ascq, (unsigned) reqp);
+ ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
+ ASC_ASSERT(reqp != NULL);
- tid = REQPTID(reqp);
- ASC_ASSERT(tid >= 0 && tid <= ASC_MAX_TID);
+ tid = REQPTID(reqp);
+ ASC_ASSERT(tid >= 0 && tid <= ASC_MAX_TID);
- for (treqp = ascq->q_first[tid]; treqp; treqp = REQPNEXT(treqp)) {
- ASC_ASSERT(ascq->q_tidmask & ASC_TIX_TO_TARGET_ID(tid));
- if (treqp == reqp) {
- ret = ASC_TRUE;
- break;
- }
- }
- ASC_DBG1(1, "asc_isqueued: ret %x\n", ret);
- return ret;
+ for (treqp = ascq->q_first[tid]; treqp; treqp = REQPNEXT(treqp)) {
+ ASC_ASSERT(ascq->q_tidmask & ASC_TIX_TO_TARGET_ID(tid));
+ if (treqp == reqp) {
+ ret = ASC_TRUE;
+ break;
+ }
+ }
+ ASC_DBG1(1, "asc_isqueued: ret %x\n", ret);
+ return ret;
}
/*
@@ -5698,37 +5757,38 @@ asc_isqueued(asc_queue_t *ascq, REQP reqp)
*
* Calls asc_execute_scsi_cmnd() to execute a REQP/Scsi_Cmnd.
*/
-void
+STATIC void
asc_execute_queue(asc_queue_t *ascq)
{
- ASC_SCSI_BIT_ID_TYPE scan_tidmask;
- REQP reqp;
- int i;
-
- ASC_DBG1(1, "asc_execute_queue: ascq %x\n", (unsigned) ascq);
- ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
- /*
- * Execute queued commands for devices attached to
- * the current board in round-robin fashion.
- */
- scan_tidmask = ascq->q_tidmask;
- do {
- for (i = 0; i <= ASC_MAX_TID; i++) {
- if (scan_tidmask & ASC_TIX_TO_TARGET_ID(i)) {
- if ((reqp = asc_dequeue(ascq, i)) == NULL) {
- scan_tidmask &= ~ASC_TIX_TO_TARGET_ID(i);
- } else if (asc_execute_scsi_cmnd((Scsi_Cmnd *) reqp)
- == ASC_BUSY) {
- scan_tidmask &= ~ASC_TIX_TO_TARGET_ID(i);
- /* Put the request back at front of the list. */
- asc_enqueue(ascq, reqp, ASC_FRONT);
- }
- }
- }
- } while (scan_tidmask);
- return;
+ ASC_SCSI_BIT_ID_TYPE scan_tidmask;
+ REQP reqp;
+ int i;
+
+ ASC_DBG1(1, "asc_execute_queue: ascq %x\n", (unsigned) ascq);
+ ASC_ASSERT(interrupts_enabled() == ASC_FALSE);
+ /*
+ * Execute queued commands for devices attached to
+ * the current board in round-robin fashion.
+ */
+ scan_tidmask = ascq->q_tidmask;
+ do {
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ if (scan_tidmask & ASC_TIX_TO_TARGET_ID(i)) {
+ if ((reqp = asc_dequeue(ascq, i)) == NULL) {
+ scan_tidmask &= ~ASC_TIX_TO_TARGET_ID(i);
+ } else if (asc_execute_scsi_cmnd((Scsi_Cmnd *) reqp)
+ == ASC_BUSY) {
+ scan_tidmask &= ~ASC_TIX_TO_TARGET_ID(i);
+ /* Put the request back at front of the list. */
+ asc_enqueue(ascq, reqp, ASC_FRONT);
+ }
+ }
+ }
+ } while (scan_tidmask);
+ return;
}
+#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
/*
* asc_prt_board_devices()
*
@@ -5743,35 +5803,35 @@ asc_execute_queue(asc_queue_t *ascq)
STATIC int
asc_prt_board_devices(struct Scsi_Host *shp, char *cp, int cplen)
{
- asc_board_t *boardp;
- int leftlen;
- int totlen;
- int len;
- int i;
+ asc_board_t *boardp;
+ int leftlen;
+ int totlen;
+ int len;
+ int i;
- boardp = ASC_BOARDP(shp);
- leftlen = cplen;
- totlen = len = 0;
+ boardp = ASC_BOARDP(shp);
+ leftlen = cplen;
+ totlen = len = 0;
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
"\nDevice Information for AdvanSys SCSI Host %d:\n", shp->host_no);
- ASC_PRT_NEXT();
-
- len = asc_prt_line(cp, leftlen, "Target Ids Detected:");
- ASC_PRT_NEXT();
- for (i = 0; i <= ASC_MAX_TID; i++) {
- if (boardp->asc_dvc_cfg.chip_scsi_id == i) {
- continue;
- } else if (boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) {
- len = asc_prt_line(cp, leftlen, " %d,", i);
- ASC_PRT_NEXT();
- }
- }
- len = asc_prt_line(cp, leftlen, " (%d=Host Adapter)\n",
- boardp->asc_dvc_cfg.chip_scsi_id);
- ASC_PRT_NEXT();
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen, "Target Ids Detected:");
+ ASC_PRT_NEXT();
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ if (boardp->asc_dvc_cfg.chip_scsi_id == i) {
+ continue;
+ } else if (boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) {
+ len = asc_prt_line(cp, leftlen, " %d,", i);
+ ASC_PRT_NEXT();
+ }
+ }
+ len = asc_prt_line(cp, leftlen, " (%d=Host Adapter)\n",
+ boardp->asc_dvc_cfg.chip_scsi_id);
+ ASC_PRT_NEXT();
- return totlen;
+ return totlen;
}
/*
@@ -5788,83 +5848,83 @@ asc_prt_board_devices(struct Scsi_Host *shp, char *cp, int cplen)
STATIC int
asc_prt_board_eeprom(struct Scsi_Host *shp, char *cp, int cplen)
{
- asc_board_t *boardp;
- ASC_DVC_VAR *asc_dvc_varp;
- int leftlen;
- int totlen;
- int len;
- ASCEEP_CONFIG *ep;
- int i;
- int isa_dma_speed[] = { 10, 8, 7, 6, 5, 4, 3, 2 };
+ asc_board_t *boardp;
+ ASC_DVC_VAR *asc_dvc_varp;
+ int leftlen;
+ int totlen;
+ int len;
+ ASCEEP_CONFIG *ep;
+ int i;
+ int isa_dma_speed[] = { 10, 8, 7, 6, 5, 4, 3, 2 };
- boardp = ASC_BOARDP(shp);
- asc_dvc_varp = &boardp->asc_dvc_var;
- ep = &boardp->eep_config;
+ boardp = ASC_BOARDP(shp);
+ asc_dvc_varp = &boardp->asc_dvc_var;
+ ep = &boardp->eep_config;
- leftlen = cplen;
- totlen = len = 0;
+ leftlen = cplen;
+ totlen = len = 0;
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
"\nEEPROM Settings for AdvanSys SCSI Host %d:\n", shp->host_no);
- ASC_PRT_NEXT();
+ ASC_PRT_NEXT();
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
" Host SCSI ID: %u, Host Queue Size: %u, Device Queue Size: %u\n",
- ep->chip_scsi_id, ep->max_total_qng, ep->max_tag_qng);
- ASC_PRT_NEXT();
+ ep->chip_scsi_id, ep->max_total_qng, ep->max_tag_qng);
+ ASC_PRT_NEXT();
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
" Disconnects: ");
- ASC_PRT_NEXT();
- for (i = 0; i <= ASC_MAX_TID; i++) {
- len = asc_prt_line(cp, leftlen, " %d:%c",
- i, (ep->disc_enable & ASC_TIX_TO_TARGET_ID(i)) ? 'Y' : 'N');
- ASC_PRT_NEXT();
- }
- len = asc_prt_line(cp, leftlen, "\n");
- ASC_PRT_NEXT();
-
- len = asc_prt_line(cp, leftlen,
+ ASC_PRT_NEXT();
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ len = asc_prt_line(cp, leftlen, " %d:%c",
+ i, (ep->disc_enable & ASC_TIX_TO_TARGET_ID(i)) ? 'Y' : 'N');
+ ASC_PRT_NEXT();
+ }
+ len = asc_prt_line(cp, leftlen, "\n");
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen,
" Command Queuing: ");
- ASC_PRT_NEXT();
- for (i = 0; i <= ASC_MAX_TID; i++) {
- len = asc_prt_line(cp, leftlen, " %d:%c",
- i, (ep->use_cmd_qng & ASC_TIX_TO_TARGET_ID(i)) ? 'Y' : 'N');
- ASC_PRT_NEXT();
- }
- len = asc_prt_line(cp, leftlen, "\n");
- ASC_PRT_NEXT();
-
- len = asc_prt_line(cp, leftlen,
+ ASC_PRT_NEXT();
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ len = asc_prt_line(cp, leftlen, " %d:%c",
+ i, (ep->use_cmd_qng & ASC_TIX_TO_TARGET_ID(i)) ? 'Y' : 'N');
+ ASC_PRT_NEXT();
+ }
+ len = asc_prt_line(cp, leftlen, "\n");
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen,
" Start Motor: ");
- ASC_PRT_NEXT();
- for (i = 0; i <= ASC_MAX_TID; i++) {
- len = asc_prt_line(cp, leftlen, " %d:%c",
- i, (ep->start_motor & ASC_TIX_TO_TARGET_ID(i)) ? 'Y' : 'N');
- ASC_PRT_NEXT();
- }
- len = asc_prt_line(cp, leftlen, "\n");
- ASC_PRT_NEXT();
-
- len = asc_prt_line(cp, leftlen,
+ ASC_PRT_NEXT();
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ len = asc_prt_line(cp, leftlen, " %d:%c",
+ i, (ep->start_motor & ASC_TIX_TO_TARGET_ID(i)) ? 'Y' : 'N');
+ ASC_PRT_NEXT();
+ }
+ len = asc_prt_line(cp, leftlen, "\n");
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen,
" Synchronous Transfer:");
- ASC_PRT_NEXT();
- for (i = 0; i <= ASC_MAX_TID; i++) {
- len = asc_prt_line(cp, leftlen, " %d:%c",
- i, (ep->init_sdtr & ASC_TIX_TO_TARGET_ID(i)) ? 'Y' : 'N');
- ASC_PRT_NEXT();
- }
- len = asc_prt_line(cp, leftlen, "\n");
- ASC_PRT_NEXT();
-
- if (asc_dvc_varp->bus_type & ASC_IS_ISA) {
- len = asc_prt_line(cp, leftlen,
+ ASC_PRT_NEXT();
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ len = asc_prt_line(cp, leftlen, " %d:%c",
+ i, (ep->init_sdtr & ASC_TIX_TO_TARGET_ID(i)) ? 'Y' : 'N');
+ ASC_PRT_NEXT();
+ }
+ len = asc_prt_line(cp, leftlen, "\n");
+ ASC_PRT_NEXT();
+
+ if (asc_dvc_varp->bus_type & ASC_IS_ISA) {
+ len = asc_prt_line(cp, leftlen,
" Host ISA DMA speed: %d MB/S\n",
- isa_dma_speed[ep->isa_dma_speed]);
- ASC_PRT_NEXT();
- }
+ isa_dma_speed[ep->isa_dma_speed]);
+ ASC_PRT_NEXT();
+ }
- return totlen;
+ return totlen;
}
/*
@@ -5879,111 +5939,111 @@ asc_prt_board_eeprom(struct Scsi_Host *shp, char *cp, int cplen)
STATIC int
asc_prt_driver_conf(struct Scsi_Host *shp, char *cp, int cplen)
{
- asc_board_t *boardp;
- int leftlen;
- int totlen;
- int len;
+ asc_board_t *boardp;
+ int leftlen;
+ int totlen;
+ int len;
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
- int i;
+ int i;
#endif /* version >= v1.3.89 */
- boardp = ASC_BOARDP(shp);
+ boardp = ASC_BOARDP(shp);
- leftlen = cplen;
- totlen = len = 0;
+ leftlen = cplen;
+ totlen = len = 0;
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
"\nLinux Driver Configuration and Information for AdvanSys SCSI Host %d:\n",
- shp->host_no);
- ASC_PRT_NEXT();
+ shp->host_no);
+ ASC_PRT_NEXT();
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(1,3,89)
" host_busy %u, last_reset %u, max_id %u, max_lun %u\n",
- shp->host_busy, shp->last_reset, shp->max_id, shp->max_lun);
+ shp->host_busy, shp->last_reset, shp->max_id, shp->max_lun);
#else /* version >= v1.3.89 */
" host_busy %u, last_reset %u, max_id %u, max_lun %u, max_channel %u\n",
- shp->host_busy, shp->last_reset, shp->max_id, shp->max_lun,
- shp->max_channel);
+ shp->host_busy, shp->last_reset, shp->max_id, shp->max_lun,
+ shp->max_channel);
#endif /* version >= v1.3.89 */
- ASC_PRT_NEXT();
-
- len = asc_prt_line(cp, leftlen,
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen,
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(1,3,57)
" can_queue %d, this_id %d, sg_tablesize %u, cmd_per_lun %u\n",
- shp->can_queue, shp->this_id, shp->sg_tablesize, shp->cmd_per_lun);
+ shp->can_queue, shp->this_id, shp->sg_tablesize, shp->cmd_per_lun);
#else /* version >= v1.3.57 */
" unique_id %d, can_queue %d, this_id %d, sg_tablesize %u, cmd_per_lun %u\n",
- shp->unique_id, shp->can_queue, shp->this_id, shp->sg_tablesize,
- shp->cmd_per_lun);
+ shp->unique_id, shp->can_queue, shp->this_id, shp->sg_tablesize,
+ shp->cmd_per_lun);
#endif /* version >= v1.3.57 */
- ASC_PRT_NEXT();
+ ASC_PRT_NEXT();
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(1,3,57)
" unchecked_isa_dma %d, loaded_as_module %d\n",
- shp->unchecked_isa_dma, shp->loaded_as_module);
+ shp->unchecked_isa_dma, shp->loaded_as_module);
#else /* version >= v1.3.57 */
" unchecked_isa_dma %d, use_clustering %d, loaded_as_module %d\n",
- shp->unchecked_isa_dma, shp->use_clustering, shp->loaded_as_module);
+ shp->unchecked_isa_dma, shp->use_clustering, shp->loaded_as_module);
#endif /* version >= v1.3.57 */
- ASC_PRT_NEXT();
+ ASC_PRT_NEXT();
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
" flags %x, last_reset %x, jiffies %x\n",
- ASC_BOARDP(shp)->flags, ASC_BOARDP(shp)->last_reset, jiffies);
- ASC_PRT_NEXT();
+ ASC_BOARDP(shp)->flags, ASC_BOARDP(shp)->last_reset, jiffies);
+ ASC_PRT_NEXT();
#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
" queue_depth: ");
- ASC_PRT_NEXT();
- for (i = 0; i <= ASC_MAX_TID; i++) {
- if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
- ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
- continue;
- }
- len = asc_prt_line(cp, leftlen, " %d:%d",
- i, boardp->device[i]->queue_depth);
- ASC_PRT_NEXT();
- }
- len = asc_prt_line(cp, leftlen, "\n");
- ASC_PRT_NEXT();
+ ASC_PRT_NEXT();
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
+ ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
+ continue;
+ }
+ len = asc_prt_line(cp, leftlen, " %d:%d",
+ i, boardp->device[i]->queue_depth);
+ ASC_PRT_NEXT();
+ }
+ len = asc_prt_line(cp, leftlen, "\n");
+ ASC_PRT_NEXT();
#endif /* version >= v1.3.89 */
#if ASC_QUEUE_FLOW_CONTROL
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
" queue_curr_depth:");
- ASC_PRT_NEXT();
- for (i = 0; i <= ASC_MAX_TID; i++) {
- if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
- ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
- continue;
- }
- len = asc_prt_line(cp, leftlen, " %d:%d",
- i, boardp->device[i]->queue_curr_depth);
- ASC_PRT_NEXT();
- }
- len = asc_prt_line(cp, leftlen, "\n");
- ASC_PRT_NEXT();
-
- len = asc_prt_line(cp, leftlen,
+ ASC_PRT_NEXT();
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
+ ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
+ continue;
+ }
+ len = asc_prt_line(cp, leftlen, " %d:%d",
+ i, boardp->device[i]->queue_curr_depth);
+ ASC_PRT_NEXT();
+ }
+ len = asc_prt_line(cp, leftlen, "\n");
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen,
" queue_count: ");
- ASC_PRT_NEXT();
- for (i = 0; i <= ASC_MAX_TID; i++) {
- if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
- ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
- continue;
- }
- len = asc_prt_line(cp, leftlen, " %d:%d",
- i, boardp->device[i]->queue_count);
- ASC_PRT_NEXT();
- }
- len = asc_prt_line(cp, leftlen, "\n");
- ASC_PRT_NEXT();
+ ASC_PRT_NEXT();
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
+ ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
+ continue;
+ }
+ len = asc_prt_line(cp, leftlen, " %d:%d",
+ i, boardp->device[i]->queue_count);
+ ASC_PRT_NEXT();
+ }
+ len = asc_prt_line(cp, leftlen, "\n");
+ ASC_PRT_NEXT();
#endif /* ASC_QUEUE_FLOW_CONTROL */
- return totlen;
+ return totlen;
}
/*
@@ -6000,125 +6060,150 @@ asc_prt_driver_conf(struct Scsi_Host *shp, char *cp, int cplen)
STATIC int
asc_prt_board_info(struct Scsi_Host *shp, char *cp, int cplen)
{
- asc_board_t *boardp;
- int leftlen;
- int totlen;
- int len;
- ASC_DVC_VAR *v;
- ASC_DVC_CFG *c;
- int i;
+ asc_board_t *boardp;
+ int leftlen;
+ int totlen;
+ int len;
+ ASC_DVC_VAR *v;
+ ASC_DVC_CFG *c;
+ int i;
- boardp = ASC_BOARDP(shp);
- v = &boardp->asc_dvc_var;
- c = &boardp->asc_dvc_cfg;
+ boardp = ASC_BOARDP(shp);
+ v = &boardp->asc_dvc_var;
+ c = &boardp->asc_dvc_cfg;
- leftlen = cplen;
- totlen = len = 0;
+ leftlen = cplen;
+ totlen = len = 0;
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
"\nAsc Library Configuration and Statistics for AdvanSys SCSI Host %d:\n",
- shp->host_no);
- ASC_PRT_NEXT();
+ shp->host_no);
+ ASC_PRT_NEXT();
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
" chip_version %u, lib_version %u, lib_serial_no %u, mcode_date %u\n",
- c->chip_version, c->lib_version, c->lib_serial_no, c->mcode_date);
- ASC_PRT_NEXT();
+ c->chip_version, c->lib_version, c->lib_serial_no, c->mcode_date);
+ ASC_PRT_NEXT();
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
" mcode_version %u, err_code %u\n",
- c->mcode_version, v->err_code);
- ASC_PRT_NEXT();
+ c->mcode_version, v->err_code);
+ ASC_PRT_NEXT();
- /* Current number of commands waiting for the host. */
- len = asc_prt_line(cp, leftlen,
+ /* Current number of commands waiting for the host. */
+ len = asc_prt_line(cp, leftlen,
" Total Command Pending: %d\n", v->cur_total_qng);
- ASC_PRT_NEXT();
+ ASC_PRT_NEXT();
- len = asc_prt_line(cp, leftlen,
-" Synchronous Transfer: ");
- ASC_PRT_NEXT();
- for (i = 0; i <= ASC_MAX_TID; i++) {
- if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
- ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
- continue;
- }
- len = asc_prt_line(cp, leftlen, " %d:%c",
- i, (v->sdtr_done & ASC_TIX_TO_TARGET_ID(i)) ? 'Y' : 'N');
- ASC_PRT_NEXT();
- }
- len = asc_prt_line(cp, leftlen, "\n");
- ASC_PRT_NEXT();
-
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
" Command Queuing: ");
- ASC_PRT_NEXT();
- for (i = 0; i <= ASC_MAX_TID; i++) {
- if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
- ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
- continue;
- }
- len = asc_prt_line(cp, leftlen, " %d:%c",
- i, (v->use_tagged_qng & ASC_TIX_TO_TARGET_ID(i)) ? 'Y' : 'N');
- ASC_PRT_NEXT();
- }
- len = asc_prt_line(cp, leftlen, "\n");
- ASC_PRT_NEXT();
-
- /* Current number of commands waiting for a device. */
- len = asc_prt_line(cp, leftlen,
+ ASC_PRT_NEXT();
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
+ ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
+ continue;
+ }
+ len = asc_prt_line(cp, leftlen, " %d:%c",
+ i, (v->use_tagged_qng & ASC_TIX_TO_TARGET_ID(i)) ? 'Y' : 'N');
+ ASC_PRT_NEXT();
+ }
+ len = asc_prt_line(cp, leftlen, "\n");
+ ASC_PRT_NEXT();
+
+ /* Current number of commands waiting for a device. */
+ len = asc_prt_line(cp, leftlen,
" Command Queue Pending: ");
- ASC_PRT_NEXT();
- for (i = 0; i <= ASC_MAX_TID; i++) {
- if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
- ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
- continue;
- }
- len = asc_prt_line(cp, leftlen, " %d:%u", i, v->cur_dvc_qng[i]);
- ASC_PRT_NEXT();
- }
- len = asc_prt_line(cp, leftlen, "\n");
- ASC_PRT_NEXT();
-
- /* Current limit on number of commands that can be sent to a device. */
- len = asc_prt_line(cp, leftlen,
+ ASC_PRT_NEXT();
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
+ ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
+ continue;
+ }
+ len = asc_prt_line(cp, leftlen, " %d:%u", i, v->cur_dvc_qng[i]);
+ ASC_PRT_NEXT();
+ }
+ len = asc_prt_line(cp, leftlen, "\n");
+ ASC_PRT_NEXT();
+
+ /* Current limit on number of commands that can be sent to a device. */
+ len = asc_prt_line(cp, leftlen,
" Command Queue Limit: ");
- ASC_PRT_NEXT();
- for (i = 0; i <= ASC_MAX_TID; i++) {
- if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
- ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
- continue;
- }
- len = asc_prt_line(cp, leftlen, " %d:%u", i, v->max_dvc_qng[i]);
- ASC_PRT_NEXT();
- }
- len = asc_prt_line(cp, leftlen, "\n");
- ASC_PRT_NEXT();
-
- /* Indicate whether the device has returned queue full status. */
- len = asc_prt_line(cp, leftlen,
+ ASC_PRT_NEXT();
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
+ ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
+ continue;
+ }
+ len = asc_prt_line(cp, leftlen, " %d:%u", i, v->max_dvc_qng[i]);
+ ASC_PRT_NEXT();
+ }
+ len = asc_prt_line(cp, leftlen, "\n");
+ ASC_PRT_NEXT();
+
+ /* Indicate whether the device has returned queue full status. */
+ len = asc_prt_line(cp, leftlen,
" Command Queue Full: ");
- ASC_PRT_NEXT();
- for (i = 0; i <= ASC_MAX_TID; i++) {
- if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
- ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
- continue;
- }
- if (boardp->queue_full & ASC_TIX_TO_TARGET_ID(i)) {
- len = asc_prt_line(cp, leftlen, " %d:Y-%d",
- i, boardp->queue_full_cnt[i]);
- } else {
- len = asc_prt_line(cp, leftlen, " %d:N", i);
- }
- ASC_PRT_NEXT();
- }
- len = asc_prt_line(cp, leftlen, "\n");
- ASC_PRT_NEXT();
-
- return totlen;
+ ASC_PRT_NEXT();
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
+ ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
+ continue;
+ }
+ if (boardp->queue_full & ASC_TIX_TO_TARGET_ID(i)) {
+ len = asc_prt_line(cp, leftlen, " %d:Y-%d",
+ i, boardp->queue_full_cnt[i]);
+ } else {
+ len = asc_prt_line(cp, leftlen, " %d:N", i);
+ }
+ ASC_PRT_NEXT();
+ }
+ len = asc_prt_line(cp, leftlen, "\n");
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen,
+" Synchronous Transfer: ");
+ ASC_PRT_NEXT();
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
+ ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
+ continue;
+ }
+ len = asc_prt_line(cp, leftlen, " %d:%c",
+ i, (v->sdtr_done & ASC_TIX_TO_TARGET_ID(i)) ? 'Y' : 'N');
+ ASC_PRT_NEXT();
+ }
+ len = asc_prt_line(cp, leftlen, "\n");
+ ASC_PRT_NEXT();
+
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ uchar syn_period_ix;
+
+ if ((boardp->asc_dvc_cfg.chip_scsi_id == i) ||
+ ((boardp->init_tidmask & ASC_TIX_TO_TARGET_ID(i)) == 0)) {
+ continue;
+ }
+ if ((v->sdtr_done & ASC_TIX_TO_TARGET_ID(i)) == 0) {
+ continue;
+ }
+ syn_period_ix = (boardp->sdtr_data[i] >> 4) & (v->max_sdtr_index - 1);
+ len = asc_prt_line(cp, leftlen, " %d:", i);
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen,
+ " Transfer Period Factor: %d (%d.%d Mhz),",
+ v->sdtr_period_tbl[syn_period_ix],
+ 250 / v->sdtr_period_tbl[syn_period_ix],
+ ASC_TENTHS(250, v->sdtr_period_tbl[syn_period_ix]));
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen, " REQ/ACK Offset: %d\n",
+ boardp->sdtr_data[i] & ASC_SYN_MAX_OFFSET);
+ ASC_PRT_NEXT();
+ }
+
+ return totlen;
}
-#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,0)
/*
* asc_proc_copy()
*
@@ -6127,30 +6212,29 @@ asc_prt_board_info(struct Scsi_Host *shp, char *cp, int cplen)
*/
STATIC int
asc_proc_copy(off_t advoffset, off_t offset, char *curbuf, int leftlen,
- char *cp, int cplen)
-{
- int cnt = 0;
-
- ASC_DBG3(2, "asc_proc_copy: offset %d, advoffset %d, cplen %d\n",
- (unsigned) offset, (unsigned) advoffset, cplen);
- if (offset <= advoffset) {
- /* Read offset below current offset, copy everything. */
- cnt = ASC_MIN(cplen, leftlen);
- ASC_DBG3(2, "asc_proc_copy: curbuf %x, cp %x, cnt %d\n",
- (unsigned) curbuf, (unsigned) cp, cnt);
- memcpy(curbuf, cp, cnt);
- } else if (offset < advoffset + cplen) {
- /* Read offset within current range, partial copy. */
- cnt = (advoffset + cplen) - offset;
- cp = (cp + cplen) - cnt;
- cnt = ASC_MIN(cnt, leftlen);
- ASC_DBG3(2, "asc_proc_copy: curbuf %x, cp %x, cnt %d\n",
- (unsigned) curbuf, (unsigned) cp, cnt);
- memcpy(curbuf, cp, cnt);
- }
- return cnt;
+ char *cp, int cplen)
+{
+ int cnt = 0;
+
+ ASC_DBG3(2, "asc_proc_copy: offset %d, advoffset %d, cplen %d\n",
+ (unsigned) offset, (unsigned) advoffset, cplen);
+ if (offset <= advoffset) {
+ /* Read offset below current offset, copy everything. */
+ cnt = ASC_MIN(cplen, leftlen);
+ ASC_DBG3(2, "asc_proc_copy: curbuf %x, cp %x, cnt %d\n",
+ (unsigned) curbuf, (unsigned) cp, cnt);
+ memcpy(curbuf, cp, cnt);
+ } else if (offset < advoffset + cplen) {
+ /* Read offset within current range, partial copy. */
+ cnt = (advoffset + cplen) - offset;
+ cp = (cp + cplen) - cnt;
+ cnt = ASC_MIN(cnt, leftlen);
+ ASC_DBG3(2, "asc_proc_copy: curbuf %x, cp %x, cnt %d\n",
+ (unsigned) curbuf, (unsigned) cp, cnt);
+ memcpy(curbuf, cp, cnt);
+ }
+ return cnt;
}
-#endif /* version >= v1.3.0 */
/*
* asc_prt_line()
@@ -6163,26 +6247,27 @@ asc_proc_copy(off_t advoffset, off_t offset, char *curbuf, int leftlen,
* Note: If any single line is greater than ASC_PRTLINE_SIZE bytes the stack
* will be corrupted. 's[]' is defined to be ASC_PRTLINE_SIZE bytes.
*/
-int
+STATIC int
asc_prt_line(char *buf, int buflen, char *fmt, ...)
{
- va_list args;
- int ret;
- char s[ASC_PRTLINE_SIZE];
-
- va_start(args, fmt);
- ret = vsprintf(s, fmt, args);
- ASC_ASSERT(ret < ASC_PRTLINE_SIZE);
- if (buf == NULL) {
- (void) printk(s);
- ret = 0;
- } else {
- ret = ASC_MIN(buflen, ret);
- memcpy(buf, s, ret);
- }
- va_end(args);
- return ret;
+ va_list args;
+ int ret;
+ char s[ASC_PRTLINE_SIZE];
+
+ va_start(args, fmt);
+ ret = vsprintf(s, fmt, args);
+ ASC_ASSERT(ret < ASC_PRTLINE_SIZE);
+ if (buf == NULL) {
+ (void) printk(s);
+ ret = 0;
+ } else {
+ ret = ASC_MIN(buflen, ret);
+ memcpy(buf, s, ret);
+ }
+ va_end(args);
+ return ret;
}
+#endif /* version >= v1.3.0 */
/*
@@ -6195,70 +6280,48 @@ asc_prt_line(char *buf, int buflen, char *fmt, ...)
* from a timer interrupt, because this function may be
* called when interrupts are disabled.
*/
-void
+STATIC void
DvcSleepMilliSecond(ulong n)
{
- ulong i;
-
- ASC_DBG1(4, "DvcSleepMilliSecond: %lu\n", n);
- for (i = 0; i < n; i++) {
- udelay(1000);
- }
-}
+ ulong i;
-void
-DvcDisplayString(uchar *s)
-{
- printk(s);
+ ASC_DBG1(4, "DvcSleepMilliSecond: %lu\n", n);
+ for (i = 0; i < n; i++) {
+ udelay(1000);
+ }
}
-int
+STATIC int
DvcEnterCritical(void)
{
- int flags;
+ int flags;
- save_flags(flags);
- cli();
- return flags;
+ save_flags(flags);
+ cli();
+ return flags;
}
-void
+STATIC void
DvcLeaveCritical(int flags)
{
- restore_flags(flags);
-}
-
-/*
- * Convert a virtual address to a bus address.
- */
-ulong
-DvcGetPhyAddr(uchar *buf_addr, ulong buf_len)
-{
- ulong bus_addr;
-
-#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(2,0,0)
- bus_addr = (ulong) buf_addr;
-#else /* version >= v2.0.0 */
- bus_addr = virt_to_bus(buf_addr);
-#endif /* version >= v2.0.0 */
- return bus_addr;
+ restore_flags(flags);
}
-ulong
+STATIC ulong
DvcGetSGList(ASC_DVC_VAR *asc_dvc_sg, uchar *buf_addr, ulong buf_len,
- ASC_SG_HEAD *asc_sg_head_ptr)
+ ASC_SG_HEAD *asc_sg_head_ptr)
{
- ulong buf_size;
+ ulong buf_size;
- buf_size = buf_len;
- asc_sg_head_ptr->entry_cnt = 1;
+ buf_size = buf_len;
+ asc_sg_head_ptr->entry_cnt = 1;
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(2,0,0)
- asc_sg_head_ptr->sg_list[0].addr = (ulong) buf_addr;
+ asc_sg_head_ptr->sg_list[0].addr = (ulong) buf_addr;
#else /* version >= v2.0.0 */
- asc_sg_head_ptr->sg_list[0].addr = virt_to_bus(buf_addr);
+ asc_sg_head_ptr->sg_list[0].addr = virt_to_bus(buf_addr);
#endif /* version >= v2.0.0 */
- asc_sg_head_ptr->sg_list[0].bytes = buf_size;
- return buf_size;
+ asc_sg_head_ptr->sg_list[0].bytes = buf_size;
+ return buf_size;
}
/*
@@ -6266,24 +6329,24 @@ DvcGetSGList(ASC_DVC_VAR *asc_dvc_sg, uchar *buf_addr, ulong buf_len,
* DvcPutScsiQ(PortAddr iop_base, ushort s_addr, ushort *outbuf, int words)
*
* Calling/Exit State:
- * none
+ * none
*
* Description:
- * Output an ASC_SCSI_Q structure to the chip
+ * Output an ASC_SCSI_Q structure to the chip
*/
-void
+STATIC void
DvcPutScsiQ(PortAddr iop_base, ushort s_addr, ushort *outbuf, int words)
{
- int i;
+ int i;
- ASC_DBG_PRT_HEX(2, "DvcPutScsiQ", (uchar *) outbuf, 2 * words);
- AscSetChipLramAddr(iop_base, s_addr);
- for (i = 0; i < words; i++, outbuf++) {
- if (i == 2 || i == 10) {
- continue;
- }
- AscSetChipLramDataNoSwap(iop_base, *outbuf);
- }
+ ASC_DBG_PRT_HEX(2, "DvcPutScsiQ", (uchar *) outbuf, 2 * words);
+ AscSetChipLramAddr(iop_base, s_addr);
+ for (i = 0; i < words; i++, outbuf++) {
+ if (i == 2 || i == 10) {
+ continue;
+ }
+ AscSetChipLramDataNoSwap(iop_base, *outbuf);
+ }
}
/*
@@ -6291,60 +6354,60 @@ DvcPutScsiQ(PortAddr iop_base, ushort s_addr, ushort *outbuf, int words)
* DvcGetQinfo(PortAddr iop_base, ushort s_addr, ushort *inbuf, int words)
*
* Calling/Exit State:
- * none
+ * none
*
* Description:
- * Input an ASC_QDONE_INFO structure from the chip
+ * Input an ASC_QDONE_INFO structure from the chip
*/
-void
+STATIC void
DvcGetQinfo(PortAddr iop_base, ushort s_addr, ushort *inbuf, int words)
{
- int i;
+ int i;
- AscSetChipLramAddr(iop_base, s_addr);
- for (i = 0; i < words; i++, inbuf++) {
- if (i == 5) {
- continue;
- }
- *inbuf = AscGetChipLramDataNoSwap(iop_base);
- }
- ASC_DBG_PRT_HEX(2, "DvcGetQinfo", (uchar *) inbuf, 2 * words);
+ AscSetChipLramAddr(iop_base, s_addr);
+ for (i = 0; i < words; i++, inbuf++) {
+ if (i == 5) {
+ continue;
+ }
+ *inbuf = AscGetChipLramDataNoSwap(iop_base);
+ }
+ ASC_DBG_PRT_HEX(2, "DvcGetQinfo", (uchar *) inbuf, 2 * words);
}
/*
- * void DvcOutPortWords(ushort iop_base, ushort &outbuf, int words)
+ * void DvcOutPortWords(ushort iop_base, ushort &outbuf, int words)
*
* Calling/Exit State:
- * none
+ * none
*
* Description:
- * output a buffer to an i/o port address
+ * output a buffer to an i/o port address
*/
-void
+STATIC void
DvcOutPortWords(ushort iop_base, ushort *outbuf, int words)
{
- int i;
+ int i;
- for (i = 0; i < words; i++, outbuf++)
- outpw(iop_base, *outbuf);
+ for (i = 0; i < words; i++, outbuf++)
+ outpw(iop_base, *outbuf);
}
/*
- * void DvcInPortWords(ushort iop_base, ushort &outbuf, int words)
+ * void DvcInPortWords(ushort iop_base, ushort &outbuf, int words)
*
* Calling/Exit State:
- * none
+ * none
*
* Description:
- * input a buffer from an i/o port address
+ * input a buffer from an i/o port address
*/
-void
+STATIC void
DvcInPortWords(ushort iop_base, ushort *inbuf, int words)
{
- int i;
+ int i;
- for (i = 0; i < words; i++, inbuf++)
- *inbuf = inpw(iop_base);
+ for (i = 0; i < words; i++, inbuf++)
+ *inbuf = inpw(iop_base);
}
@@ -6352,36 +6415,38 @@ DvcInPortWords(ushort iop_base, ushort *inbuf, int words)
* void DvcOutPortDWords(PortAddr port, ulong *pdw, int dwords)
*
* Calling/Exit State:
- * none
+ * none
*
* Description:
- * output a buffer of 32-bit integers to an i/o port address in
+ * output a buffer of 32-bit integers to an i/o port address in
* 16 bit integer units
*/
-void
+STATIC void
DvcOutPortDWords(PortAddr port, ulong *pdw, int dwords)
{
- int i;
- int words;
- ushort *pw;
+ int i;
+ int words;
+ ushort *pw;
- pw = (ushort *) pdw;
- words = dwords << 1;
- for(i = 0; i < words; i++, pw++) {
- outpw(port, *pw);
- }
- return;
+ pw = (ushort *) pdw;
+ words = dwords << 1;
+ for(i = 0; i < words; i++, pw++) {
+ outpw(port, *pw);
+ }
+ return;
}
/*
* Read a PCI configuration byte.
*/
-__initfunc(uchar
-DvcReadPCIConfigByte(
+ASC_INITFUNC(
+STATIC uchar
+DvcReadPCIConfigByte(
ASC_DVC_VAR asc_ptr_type *asc_dvc,
- ushort offset ))
+ ushort offset)
+)
{
- PCI_DATA pciData;
+ PCI_DATA pciData;
pciData.bus = ASC_PCI_ID2BUS(asc_dvc->cfg->pci_slot_info);
pciData.slot = ASC_PCI_ID2DEV(asc_dvc->cfg->pci_slot_info);
@@ -6394,13 +6459,15 @@ DvcReadPCIConfigByte(
/*
* Write a PCI configuration byte.
*/
-__initfunc(void
+ASC_INITFUNC(
+STATIC void
DvcWritePCIConfigByte(
ASC_DVC_VAR asc_ptr_type *asc_dvc,
ushort offset,
- uchar byte_data ))
+ uchar byte_data)
+)
{
- PCI_DATA pciData;
+ PCI_DATA pciData;
pciData.bus = ASC_PCI_ID2BUS(asc_dvc->cfg->pci_slot_info);
pciData.slot = ASC_PCI_ID2DEV(asc_dvc->cfg->pci_slot_info);
@@ -6414,47 +6481,49 @@ DvcWritePCIConfigByte(
* Return the BIOS address of the adapter at the specified
* I/O port and with the specified bus type.
*/
-__initfunc(ushort
+ASC_INITFUNC(
+STATIC ushort
AscGetChipBiosAddress(
PortAddr iop_base,
ushort bus_type
- ))
+)
+)
{
ushort cfg_lsw ;
ushort bios_addr ;
- /*
- * The PCI BIOS is re-located by the motherboard BIOS. Because
- * of this the driver can not determine where a PCI BIOS is
- * loaded and executes.
- */
- if ( bus_type & ASC_IS_PCI )
- {
- return( 0 );
- }
-
- if( ( bus_type & ASC_IS_EISA ) != 0 )
+ /*
+ * The PCI BIOS is re-located by the motherboard BIOS. Because
+ * of this the driver can not determine where a PCI BIOS is
+ * loaded and executes.
+ */
+ if (bus_type & ASC_IS_PCI)
{
- cfg_lsw = AscGetEisaChipCfg( iop_base ) ;
+ return(0);
+ }
+
+ if((bus_type & ASC_IS_EISA) != 0)
+ {
+ cfg_lsw = AscGetEisaChipCfg(iop_base) ;
cfg_lsw &= 0x000F ;
- bios_addr = ( ushort )( ASC_BIOS_MIN_ADDR +
- ( cfg_lsw * ASC_BIOS_BANK_SIZE ) ) ;
- return( bios_addr ) ;
+ bios_addr = (ushort)(ASC_BIOS_MIN_ADDR +
+ (cfg_lsw * ASC_BIOS_BANK_SIZE)) ;
+ return(bios_addr) ;
}/* if */
- cfg_lsw = AscGetChipCfgLsw( iop_base ) ;
+ cfg_lsw = AscGetChipCfgLsw(iop_base) ;
/*
* ISA PnP uses the top bit as the 32K BIOS flag
*/
- if ( bus_type == ASC_IS_ISAPNP )
+ if (bus_type == ASC_IS_ISAPNP)
{
cfg_lsw &= 0x7FFF;
}/* if */
- bios_addr = ( ushort )( ( ( cfg_lsw >> 12 ) * ASC_BIOS_BANK_SIZE ) +
- ASC_BIOS_MIN_ADDR ) ;
- return( bios_addr ) ;
+ bios_addr = (ushort)(((cfg_lsw >> 12) * ASC_BIOS_BANK_SIZE) +
+ ASC_BIOS_MIN_ADDR) ;
+ return(bios_addr) ;
}
@@ -6475,123 +6544,123 @@ AscGetChipBiosAddress(
STATIC int
asc_prt_board_stats(struct Scsi_Host *shp, char *cp, int cplen)
{
- int leftlen;
- int totlen;
- int len;
- struct asc_stats *s;
- int i;
- asc_queue_t *active;
- asc_queue_t *waiting;
+ int leftlen;
+ int totlen;
+ int len;
+ struct asc_stats *s;
+ int i;
+ asc_queue_t *active;
+ asc_queue_t *waiting;
- leftlen = cplen;
- totlen = len = 0;
+ leftlen = cplen;
+ totlen = len = 0;
- s = &ASC_BOARDP(shp)->asc_stats;
- len = asc_prt_line(cp, leftlen,
+ s = &ASC_BOARDP(shp)->asc_stats;
+ len = asc_prt_line(cp, leftlen,
"\nLinux Driver Statistics for AdvanSys SCSI Host %d:\n", shp->host_no);
- ASC_PRT_NEXT();
-
- len = asc_prt_line(cp, leftlen,
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen,
" command %lu, queuecommand %lu, abort %lu, reset %lu, biosparam %lu\n",
- s->command, s->queuecommand, s->abort, s->reset, s->biosparam);
- ASC_PRT_NEXT();
+ s->command, s->queuecommand, s->abort, s->reset, s->biosparam);
+ ASC_PRT_NEXT();
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
" check_interrupt %lu, interrupt %lu, callback %lu, done %lu\n",
- s->check_interrupt, s->interrupt, s->callback, s->done);
- ASC_PRT_NEXT();
+ s->check_interrupt, s->interrupt, s->callback, s->done);
+ ASC_PRT_NEXT();
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
" asc_noerror %lu, asc_busy %lu, asc_error %lu, asc_unknown %lu\n",
- s->asc_noerror, s->asc_busy, s->asc_error, s->asc_unknown);
- ASC_PRT_NEXT();
-
- /*
- * Display data transfer statistics.
- */
- if (s->cont_cnt > 0) {
- len = asc_prt_line(cp, leftlen, " cont_cnt %lu, ", s->cont_cnt);
- ASC_PRT_NEXT();
-
- len = asc_prt_line(cp, leftlen, "cont_xfer %lu.%01lu kb ",
- s->cont_xfer/2,
- ASC_TENTHS(s->cont_xfer, 2));
- ASC_PRT_NEXT();
-
- /* Contiguous transfer average size */
- len = asc_prt_line(cp, leftlen, "avg_xfer %lu.%01lu kb\n",
- (s->cont_xfer/2)/s->cont_cnt,
- ASC_TENTHS((s->cont_xfer/2), s->cont_cnt));
- ASC_PRT_NEXT();
- }
-
- if (s->sg_cnt > 0) {
-
- len = asc_prt_line(cp, leftlen, " sg_cnt %lu, sg_elem %lu, ",
- s->sg_cnt, s->sg_elem);
- ASC_PRT_NEXT();
-
- len = asc_prt_line(cp, leftlen, "sg_xfer %lu.%01lu kb\n",
- s->sg_xfer/2,
- ASC_TENTHS(s->sg_xfer, 2));
- ASC_PRT_NEXT();
-
- /* Scatter gather transfer statistics */
- len = asc_prt_line(cp, leftlen, " avg_num_elem %lu.%01lu, ",
- s->sg_elem/s->sg_cnt,
- ASC_TENTHS(s->sg_elem, s->sg_cnt));
- ASC_PRT_NEXT();
-
- len = asc_prt_line(cp, leftlen, "avg_elem_size %lu.%01lu kb, ",
- (s->sg_xfer/2)/s->sg_elem,
- ASC_TENTHS((s->sg_xfer/2), s->sg_elem));
- ASC_PRT_NEXT();
-
- len = asc_prt_line(cp, leftlen, "avg_xfer_size %lu.%01lu kb\n",
- (s->sg_xfer/2)/s->sg_cnt,
- ASC_TENTHS((s->sg_xfer/2), s->sg_cnt));
- ASC_PRT_NEXT();
- }
-
- /*
- * Display request queuing statistics.
- */
- len = asc_prt_line(cp, leftlen,
+ s->asc_noerror, s->asc_busy, s->asc_error, s->asc_unknown);
+ ASC_PRT_NEXT();
+
+ /*
+ * Display data transfer statistics.
+ */
+ if (s->cont_cnt > 0) {
+ len = asc_prt_line(cp, leftlen, " cont_cnt %lu, ", s->cont_cnt);
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen, "cont_xfer %lu.%01lu kb ",
+ s->cont_xfer/2,
+ ASC_TENTHS(s->cont_xfer, 2));
+ ASC_PRT_NEXT();
+
+ /* Contiguous transfer average size */
+ len = asc_prt_line(cp, leftlen, "avg_xfer %lu.%01lu kb\n",
+ (s->cont_xfer/2)/s->cont_cnt,
+ ASC_TENTHS((s->cont_xfer/2), s->cont_cnt));
+ ASC_PRT_NEXT();
+ }
+
+ if (s->sg_cnt > 0) {
+
+ len = asc_prt_line(cp, leftlen, " sg_cnt %lu, sg_elem %lu, ",
+ s->sg_cnt, s->sg_elem);
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen, "sg_xfer %lu.%01lu kb\n",
+ s->sg_xfer/2,
+ ASC_TENTHS(s->sg_xfer, 2));
+ ASC_PRT_NEXT();
+
+ /* Scatter gather transfer statistics */
+ len = asc_prt_line(cp, leftlen, " avg_num_elem %lu.%01lu, ",
+ s->sg_elem/s->sg_cnt,
+ ASC_TENTHS(s->sg_elem, s->sg_cnt));
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen, "avg_elem_size %lu.%01lu kb, ",
+ (s->sg_xfer/2)/s->sg_elem,
+ ASC_TENTHS((s->sg_xfer/2), s->sg_elem));
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen, "avg_xfer_size %lu.%01lu kb\n",
+ (s->sg_xfer/2)/s->sg_cnt,
+ ASC_TENTHS((s->sg_xfer/2), s->sg_cnt));
+ ASC_PRT_NEXT();
+ }
+
+ /*
+ * Display request queuing statistics.
+ */
+ len = asc_prt_line(cp, leftlen,
" Active and Waiting Request Queues (time unit: %d HZ):\n", HZ);
- ASC_PRT_NEXT();
+ ASC_PRT_NEXT();
- active = &ASC_BOARDP(shp)->active;
- waiting = &ASC_BOARDP(shp)->waiting;
- for (i = 0; i < ASC_MAX_TID + 1; i++) {
- if (active->q_tot_cnt[i] > 0 || waiting->q_tot_cnt[i] > 0) {
- len = asc_prt_line(cp, leftlen, " target %d\n", i);
- ASC_PRT_NEXT();
+ active = &ASC_BOARDP(shp)->active;
+ waiting = &ASC_BOARDP(shp)->waiting;
+ for (i = 0; i < ASC_MAX_TID + 1; i++) {
+ if (active->q_tot_cnt[i] > 0 || waiting->q_tot_cnt[i] > 0) {
+ len = asc_prt_line(cp, leftlen, " target %d\n", i);
+ ASC_PRT_NEXT();
- len = asc_prt_line(cp, leftlen,
+ len = asc_prt_line(cp, leftlen,
" active: cnt [cur %d, max %d, tot %u], time [min %d, max %d, avg %lu.%01lu]\n",
- active->q_cur_cnt[i], active->q_max_cnt[i],
- active->q_tot_cnt[i],
- active->q_min_tim[i], active->q_max_tim[i],
- (active->q_tot_cnt[i] == 0) ? 0 :
- (active->q_tot_tim[i]/active->q_tot_cnt[i]),
- (active->q_tot_cnt[i] == 0) ? 0 :
- ASC_TENTHS(active->q_tot_tim[i], active->q_tot_cnt[i]));
- ASC_PRT_NEXT();
-
- len = asc_prt_line(cp, leftlen,
+ active->q_cur_cnt[i], active->q_max_cnt[i],
+ active->q_tot_cnt[i],
+ active->q_min_tim[i], active->q_max_tim[i],
+ (active->q_tot_cnt[i] == 0) ? 0 :
+ (active->q_tot_tim[i]/active->q_tot_cnt[i]),
+ (active->q_tot_cnt[i] == 0) ? 0 :
+ ASC_TENTHS(active->q_tot_tim[i], active->q_tot_cnt[i]));
+ ASC_PRT_NEXT();
+
+ len = asc_prt_line(cp, leftlen,
" waiting: cnt [cur %d, max %d, tot %u], time [min %u, max %u, avg %lu.%01lu]\n",
- waiting->q_cur_cnt[i], waiting->q_max_cnt[i],
- waiting->q_tot_cnt[i],
- waiting->q_min_tim[i], waiting->q_max_tim[i],
- (waiting->q_tot_cnt[i] == 0) ? 0 :
- (waiting->q_tot_tim[i]/waiting->q_tot_cnt[i]),
- (waiting->q_tot_cnt[i] == 0) ? 0 :
- ASC_TENTHS(waiting->q_tot_tim[i], waiting->q_tot_cnt[i]));
- ASC_PRT_NEXT();
- }
- }
-
- return totlen;
+ waiting->q_cur_cnt[i], waiting->q_max_cnt[i],
+ waiting->q_tot_cnt[i],
+ waiting->q_min_tim[i], waiting->q_max_tim[i],
+ (waiting->q_tot_cnt[i] == 0) ? 0 :
+ (waiting->q_tot_tim[i]/waiting->q_tot_cnt[i]),
+ (waiting->q_tot_cnt[i] == 0) ? 0 :
+ ASC_TENTHS(waiting->q_tot_tim[i], waiting->q_tot_cnt[i]));
+ ASC_PRT_NEXT();
+ }
+ }
+
+ return totlen;
}
#endif /* ADVANSYS_STATS */
@@ -6602,32 +6671,32 @@ asc_prt_board_stats(struct Scsi_Host *shp, char *cp, int cplen)
STATIC void
asc_prt_scsi_host(struct Scsi_Host *s)
{
- printk("Scsi_Host at addr %x\n", (unsigned) s);
- printk(
+ printk("Scsi_Host at addr %x\n", (unsigned) s);
+ printk(
" next %x, extra_bytes %u, host_busy %u, host_no %d, last_reset %d,\n",
- (unsigned) s->next, s->extra_bytes, s->host_busy, s->host_no,
- (unsigned) s->last_reset);
+ (unsigned) s->next, s->extra_bytes, s->host_busy, s->host_no,
+ (unsigned) s->last_reset);
- printk(
+ printk(
" host_wait %x, host_queue %x, hostt %x, block %x,\n",
- (unsigned) s->host_wait, (unsigned) s->host_queue,
- (unsigned) s->hostt, (unsigned) s->block);
+ (unsigned) s->host_wait, (unsigned) s->host_queue,
+ (unsigned) s->hostt, (unsigned) s->block);
- printk(
+ printk(
" wish_block %d, base %x, io_port %d, n_io_port %d, irq %d, dma_channel %d,\n",
- s->wish_block, (unsigned) s->base, s->io_port, s->n_io_port,
- s->irq, s->dma_channel);
+ s->wish_block, (unsigned) s->base, s->io_port, s->n_io_port,
+ s->irq, s->dma_channel);
- printk(
+ printk(
" this_id %d, can_queue %d,\n", s->this_id, s->can_queue);
- printk(
+ printk(
" cmd_per_lun %d, sg_tablesize %d, unchecked_isa_dma %d, loaded_as_module %d\n",
- s->cmd_per_lun, s->sg_tablesize, s->unchecked_isa_dma,
- s->loaded_as_module);
+ s->cmd_per_lun, s->sg_tablesize, s->unchecked_isa_dma,
+ s->loaded_as_module);
- asc_prt_dvc_var(&ASC_BOARDP(s)->asc_dvc_var);
- asc_prt_dvc_cfg(&ASC_BOARDP(s)->asc_dvc_cfg);
+ asc_prt_dvc_var(&ASC_BOARDP(s)->asc_dvc_var);
+ asc_prt_dvc_cfg(&ASC_BOARDP(s)->asc_dvc_cfg);
}
/*
@@ -6636,52 +6705,52 @@ asc_prt_scsi_host(struct Scsi_Host *s)
STATIC void
asc_prt_scsi_cmnd(Scsi_Cmnd *s)
{
- printk("Scsi_Cmnd at addr %x\n", (unsigned) s);
+ printk("Scsi_Cmnd at addr %x\n", (unsigned) s);
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(1,3,0)
- printk(
+ printk(
" host %x, device %x, target %u, lun %u\n",
- (unsigned) s->host, (unsigned) s->device, s->target, s->lun);
+ (unsigned) s->host, (unsigned) s->device, s->target, s->lun);
#else /* version >= v1.3.0 */
- printk(
+ printk(
" host %x, device %x, target %u, lun %u, channel %u,\n",
- (unsigned) s->host, (unsigned) s->device, s->target, s->lun,
- s->channel);
+ (unsigned) s->host, (unsigned) s->device, s->target, s->lun,
+ s->channel);
#endif /* version >= v1.3.0 */
- asc_prt_hex(" CDB", s->cmnd, s->cmd_len);
+ asc_prt_hex(" CDB", s->cmnd, s->cmd_len);
- printk(
+ printk(
" use_sg %u, sglist_len %u, abort_reason %x\n",
- s->use_sg, s->sglist_len, s->abort_reason);
+ s->use_sg, s->sglist_len, s->abort_reason);
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(1,3,89)
- printk(
+ printk(
" retries %d, allowed %d\n",
- s->retries, s->allowed);
+ s->retries, s->allowed);
#else /* version >= v1.3.89 */
- printk(
+ printk(
" serial_number %x, serial_number_at_timeout %x, retries %d, allowed %d\n",
- (unsigned) s->serial_number, (unsigned) s->serial_number_at_timeout,
- s->retries, s->allowed);
+ (unsigned) s->serial_number, (unsigned) s->serial_number_at_timeout,
+ s->retries, s->allowed);
#endif /* version >= v1.3.89 */
- printk(
+ printk(
" timeout_per_command %d, timeout_total %d, timeout %d\n",
- s->timeout_per_command, s->timeout_total, s->timeout);
+ s->timeout_per_command, s->timeout_total, s->timeout);
- printk(
+ printk(
" internal_timeout %u, flags %u, this_count %d\n",
- s->internal_timeout, s->flags, s->this_count);
+ s->internal_timeout, s->flags, s->this_count);
- printk(
+ printk(
" scsi_done %x, done %x, host_scribble %x, result %x\n",
- (unsigned) s->scsi_done, (unsigned) s->done,
- (unsigned) s->host_scribble, s->result);
+ (unsigned) s->scsi_done, (unsigned) s->done,
+ (unsigned) s->host_scribble, s->result);
- printk(
+ printk(
" tag %u, pid %u\n",
- (unsigned) s->tag, (unsigned) s->pid);
+ (unsigned) s->tag, (unsigned) s->pid);
}
/*
@@ -6690,40 +6759,40 @@ asc_prt_scsi_cmnd(Scsi_Cmnd *s)
STATIC void
asc_prt_dvc_var(ASC_DVC_VAR *h)
{
- printk("ASC_DVC_VAR at addr %x\n", (unsigned) h);
+ printk("ASC_DVC_VAR at addr %x\n", (unsigned) h);
- printk(
+ printk(
" iop_base %x, err_code %x, dvc_cntl %x, bug_fix_cntl %d,\n",
- h->iop_base, h->err_code, h->dvc_cntl, h->bug_fix_cntl);
+ h->iop_base, h->err_code, h->dvc_cntl, h->bug_fix_cntl);
- printk(
+ printk(
" bus_type %d, isr_callback %x, exe_callback %x, init_sdtr %x,\n",
- h->bus_type, (unsigned) h->isr_callback, (unsigned) h->exe_callback,
- (unsigned) h->init_sdtr);
+ h->bus_type, (unsigned) h->isr_callback, (unsigned) h->exe_callback,
+ (unsigned) h->init_sdtr);
- printk(
+ printk(
" sdtr_done %x, use_tagged_qng %x, unit_not_ready %x, chip_no %x,\n",
- (unsigned) h->sdtr_done, (unsigned) h->use_tagged_qng,
- (unsigned) h->unit_not_ready, (unsigned) h->chip_no);
-
- printk(
+ (unsigned) h->sdtr_done, (unsigned) h->use_tagged_qng,
+ (unsigned) h->unit_not_ready, (unsigned) h->chip_no);
+
+ printk(
" queue_full_or_busy %x, start_motor %x, scsi_reset_wait %x, irq_no %x,\n",
- (unsigned) h->queue_full_or_busy, (unsigned) h->start_motor,
- (unsigned) h->scsi_reset_wait, (unsigned) h->irq_no);
+ (unsigned) h->queue_full_or_busy, (unsigned) h->start_motor,
+ (unsigned) h->scsi_reset_wait, (unsigned) h->irq_no);
- printk(
+ printk(
" is_in_int %x, max_total_qng %x, cur_total_qng %x, in_critical_cnt %x,\n",
- (unsigned) h->is_in_int, (unsigned) h->max_total_qng,
- (unsigned) h->cur_total_qng, (unsigned) h->in_critical_cnt);
+ (unsigned) h->is_in_int, (unsigned) h->max_total_qng,
+ (unsigned) h->cur_total_qng, (unsigned) h->in_critical_cnt);
- printk(
+ printk(
" last_q_shortage %x, init_state %x, no_scam %x, pci_fix_asyn_xfer %x,\n",
- (unsigned) h->last_q_shortage, (unsigned) h->init_state,
- (unsigned) h->no_scam, (unsigned) h->pci_fix_asyn_xfer);
+ (unsigned) h->last_q_shortage, (unsigned) h->init_state,
+ (unsigned) h->no_scam, (unsigned) h->pci_fix_asyn_xfer);
- printk(
+ printk(
" cfg %x, saved_ptr2func %x\n",
- (unsigned) h->cfg, (unsigned) h->saved_ptr2func);
+ (unsigned) h->cfg, (unsigned) h->saved_ptr2func);
}
/*
@@ -6732,24 +6801,24 @@ asc_prt_dvc_var(ASC_DVC_VAR *h)
STATIC void
asc_prt_dvc_cfg(ASC_DVC_CFG *h)
{
- printk("ASC_DVC_CFG at addr %x\n", (unsigned) h);
+ printk("ASC_DVC_CFG at addr %x\n", (unsigned) h);
- printk(
+ printk(
" can_tagged_qng %x, cmd_qng_enabled %x, disc_enable %x, res %x,\n",
- h->can_tagged_qng, h->cmd_qng_enabled, h->disc_enable, h->res);
+ h->can_tagged_qng, h->cmd_qng_enabled, h->disc_enable, h->res);
- printk(
+ printk(
" chip_scsi_id %d, isa_dma_speed %d, isa_dma_channel %d, chip_version %d,\n",
- h->chip_scsi_id, h->isa_dma_speed, h->isa_dma_channel,
- h->chip_version);
+ h->chip_scsi_id, h->isa_dma_speed, h->isa_dma_channel,
+ h->chip_version);
- printk(
+ printk(
" pci_device_id %d, lib_serial_no %d, lib_version %d, mcode_date %d,\n",
- h->pci_device_id, h->lib_serial_no, h->lib_version, h->mcode_date);
+ h->pci_device_id, h->lib_serial_no, h->lib_version, h->mcode_date);
- printk(
+ printk(
" mcode_version %d, overrun_buf %x\n",
- h->mcode_version, (unsigned) h->overrun_buf);
+ h->mcode_version, (unsigned) h->overrun_buf);
}
/*
@@ -6758,36 +6827,36 @@ asc_prt_dvc_cfg(ASC_DVC_CFG *h)
STATIC void
asc_prt_scsi_q(ASC_SCSI_Q *q)
{
- ASC_SG_HEAD *sgp;
- int i;
+ ASC_SG_HEAD *sgp;
+ int i;
- printk("ASC_SCSI_Q at addr %x\n", (unsigned) q);
+ printk("ASC_SCSI_Q at addr %x\n", (unsigned) q);
- printk(
+ printk(
" target_ix %u, target_lun %u, srb_ptr %x, tag_code %u,\n",
- q->q2.target_ix, q->q1.target_lun,
- (unsigned) q->q2.srb_ptr, q->q2.tag_code);
+ q->q2.target_ix, q->q1.target_lun,
+ (unsigned) q->q2.srb_ptr, q->q2.tag_code);
- printk(
+ printk(
" data_addr %x, data_cnt %lu, sense_addr %x, sense_len %u,\n",
- (unsigned) q->q1.data_addr, q->q1.data_cnt,
- (unsigned) q->q1.sense_addr, q->q1.sense_len);
+ (unsigned) q->q1.data_addr, q->q1.data_cnt,
+ (unsigned) q->q1.sense_addr, q->q1.sense_len);
- printk(
+ printk(
" cdbptr %x, cdb_len %u, sg_head %x, sg_queue_cnt %u\n",
- (unsigned) q->cdbptr, q->q2.cdb_len,
- (unsigned) q->sg_head, q->q1.sg_queue_cnt);
-
- if (q->sg_head) {
- sgp = q->sg_head;
- printk("ASC_SG_HEAD at addr %x\n", (unsigned) sgp);
- printk(" entry_cnt %u, queue_cnt %u\n", sgp->entry_cnt, sgp->queue_cnt);
- for (i = 0; i < sgp->entry_cnt; i++) {
- printk(" [%u]: addr %x, bytes %lu\n",
- i, (unsigned) sgp->sg_list[i].addr, sgp->sg_list[i].bytes);
- }
+ (unsigned) q->cdbptr, q->q2.cdb_len,
+ (unsigned) q->sg_head, q->q1.sg_queue_cnt);
+
+ if (q->sg_head) {
+ sgp = q->sg_head;
+ printk("ASC_SG_HEAD at addr %x\n", (unsigned) sgp);
+ printk(" entry_cnt %u, queue_cnt %u\n", sgp->entry_cnt, sgp->queue_cnt);
+ for (i = 0; i < sgp->entry_cnt; i++) {
+ printk(" [%u]: addr %x, bytes %lu\n",
+ i, (unsigned) sgp->sg_list[i].addr, sgp->sg_list[i].bytes);
+ }
- }
+ }
}
/*
@@ -6796,14 +6865,14 @@ asc_prt_scsi_q(ASC_SCSI_Q *q)
STATIC void
asc_prt_qdone_info(ASC_QDONE_INFO *q)
{
- printk("ASC_QDONE_INFO at addr %x\n", (unsigned) q);
- printk(
+ printk("ASC_QDONE_INFO at addr %x\n", (unsigned) q);
+ printk(
" srb_ptr %x, target_ix %u, cdb_len %u, tag_code %u, done_stat %x\n",
- (unsigned) q->d2.srb_ptr, q->d2.target_ix, q->d2.cdb_len,
- q->d2.tag_code, q->d3.done_stat);
- printk(
+ (unsigned) q->d2.srb_ptr, q->d2.target_ix, q->d2.cdb_len,
+ q->d2.tag_code, q->d3.done_stat);
+ printk(
" host_stat %x, scsi_stat %x, scsi_msg %x\n",
- q->d3.host_stat, q->d3.scsi_stat, q->d3.scsi_msg);
+ q->d3.host_stat, q->d3.scsi_stat, q->d3.scsi_msg);
}
/*
@@ -6815,54 +6884,56 @@ asc_prt_qdone_info(ASC_QDONE_INFO *q)
STATIC void
asc_prt_hex(char *f, uchar *s, int l)
{
- int i;
- int j;
- int k;
- int m;
-
- printk("%s: (%d bytes)\n", f, l);
-
- for (i = 0; i < l; i += 32) {
-
- /* Display a maximum of 8 double-words per line. */
- if ((k = (l - i) / 4) >= 8) {
- k = 8;
- m = 0;
- } else {
- m = (l - i) % 4 ;
- }
-
- for (j = 0; j < k; j++) {
- printk(" %2.2X%2.2X%2.2X%2.2X",
- (unsigned) s[i+(j*4)], (unsigned) s[i+(j*4)+1],
- (unsigned) s[i+(j*4)+2], (unsigned) s[i+(j*4)+3]);
- }
-
- switch (m) {
- case 0:
- default:
- break;
- case 1:
- printk(" %2.2X",
- (unsigned) s[i+(j*4)]);
- break;
- case 2:
- printk(" %2.2X%2.2X",
- (unsigned) s[i+(j*4)],
- (unsigned) s[i+(j*4)+1]);
- break;
- case 3:
- printk(" %2.2X%2.2X%2.2X",
- (unsigned) s[i+(j*4)+1],
- (unsigned) s[i+(j*4)+2],
- (unsigned) s[i+(j*4)+3]);
- break;
- }
-
- printk("\n");
- }
+ int i;
+ int j;
+ int k;
+ int m;
+
+ printk("%s: (%d bytes)\n", f, l);
+
+ for (i = 0; i < l; i += 32) {
+
+ /* Display a maximum of 8 double-words per line. */
+ if ((k = (l - i) / 4) >= 8) {
+ k = 8;
+ m = 0;
+ } else {
+ m = (l - i) % 4 ;
+ }
+
+ for (j = 0; j < k; j++) {
+ printk(" %2.2X%2.2X%2.2X%2.2X",
+ (unsigned) s[i+(j*4)], (unsigned) s[i+(j*4)+1],
+ (unsigned) s[i+(j*4)+2], (unsigned) s[i+(j*4)+3]);
+ }
+
+ switch (m) {
+ case 0:
+ default:
+ break;
+ case 1:
+ printk(" %2.2X",
+ (unsigned) s[i+(j*4)]);
+ break;
+ case 2:
+ printk(" %2.2X%2.2X",
+ (unsigned) s[i+(j*4)],
+ (unsigned) s[i+(j*4)+1]);
+ break;
+ case 3:
+ printk(" %2.2X%2.2X%2.2X",
+ (unsigned) s[i+(j*4)+1],
+ (unsigned) s[i+(j*4)+2],
+ (unsigned) s[i+(j*4)+3]);
+ break;
+ }
+
+ printk("\n");
+ }
}
+#endif /* ADVANSYS_DEBUG */
+#ifdef ADVANSYS_ASSERT
/*
* interrupts_enabled()
*
@@ -6871,4075 +6942,4088 @@ asc_prt_hex(char *f, uchar *s, int l)
STATIC int
interrupts_enabled(void)
{
- int flags;
+ int flags;
- save_flags(flags);
- if (flags & 0x0200) {
- return ASC_TRUE;
- } else {
- return ASC_FALSE;
- }
+ save_flags(flags);
+ if (flags & 0x0200) {
+ return ASC_TRUE;
+ } else {
+ return ASC_FALSE;
+ }
}
-
-#endif /* ADVANSYS_DEBUG */
+#endif /* ADVANSYS_ASSERT */
/*
* --- Asc Library Functions
*/
-ushort
+ASC_INITFUNC(
+STATIC ushort
AscGetEisaChipCfg(
- PortAddr iop_base
+ PortAddr iop_base
+)
)
{
- PortAddr eisa_cfg_iop;
- eisa_cfg_iop = (PortAddr) ASC_GET_EISA_SLOT(iop_base) |
- (PortAddr) (ASC_EISA_CFG_IOP_MASK);
- return (inpw(eisa_cfg_iop));
+ PortAddr eisa_cfg_iop;
+ eisa_cfg_iop = (PortAddr) ASC_GET_EISA_SLOT(iop_base) |
+ (PortAddr) (ASC_EISA_CFG_IOP_MASK);
+ return (inpw(eisa_cfg_iop));
}
-uchar
+ASC_INITFUNC(
+STATIC uchar
AscSetChipScsiID(
- PortAddr iop_base,
- uchar new_host_id
+ PortAddr iop_base,
+ uchar new_host_id
+)
)
{
- ushort cfg_lsw;
- if (AscGetChipScsiID(iop_base) == new_host_id) {
- return (new_host_id);
- }
- cfg_lsw = AscGetChipCfgLsw(iop_base);
- cfg_lsw &= 0xF8FF;
- cfg_lsw |= (ushort) ((new_host_id & ASC_MAX_TID) << 8);
- AscSetChipCfgLsw(iop_base, cfg_lsw);
- return (AscGetChipScsiID(iop_base));
+ ushort cfg_lsw;
+ if (AscGetChipScsiID(iop_base) == new_host_id) {
+ return (new_host_id);
+ }
+ cfg_lsw = AscGetChipCfgLsw(iop_base);
+ cfg_lsw &= 0xF8FF;
+ cfg_lsw |= (ushort) ((new_host_id & ASC_MAX_TID) << 8);
+ AscSetChipCfgLsw(iop_base, cfg_lsw);
+ return (AscGetChipScsiID(iop_base));
}
-uchar
+ASC_INITFUNC(
+STATIC uchar
AscGetChipScsiCtrl(
- PortAddr iop_base
+ PortAddr iop_base
+)
)
{
- uchar sc;
- AscSetBank(iop_base, 1);
- sc = inp(iop_base + IOP_REG_SC);
- AscSetBank(iop_base, 0);
- return (sc);
+ uchar sc;
+ AscSetBank(iop_base, 1);
+ sc = inp(iop_base + IOP_REG_SC);
+ AscSetBank(iop_base, 0);
+ return (sc);
}
-__initfunc(uchar
+ASC_INITFUNC(
+STATIC uchar
AscGetChipVersion(
- PortAddr iop_base,
- ushort bus_type
-))
-{
- if ((bus_type & ASC_IS_EISA) != 0) {
- PortAddr eisa_iop;
- uchar revision;
- eisa_iop = (PortAddr) ASC_GET_EISA_SLOT(iop_base) |
- (PortAddr) ASC_EISA_REV_IOP_MASK;
- revision = inp(eisa_iop);
- return ((uchar) ((ASC_CHIP_MIN_VER_EISA - 1) + revision));
- }
- return (AscGetChipVerNo(iop_base));
-}
-
-ushort
+ PortAddr iop_base,
+ ushort bus_type
+)
+)
+{
+ if ((bus_type & ASC_IS_EISA) != 0) {
+ PortAddr eisa_iop;
+ uchar revision;
+ eisa_iop = (PortAddr) ASC_GET_EISA_SLOT(iop_base) |
+ (PortAddr) ASC_EISA_REV_IOP_MASK;
+ revision = inp(eisa_iop);
+ return ((uchar) ((ASC_CHIP_MIN_VER_EISA - 1) + revision));
+ }
+ return (AscGetChipVerNo(iop_base));
+}
+
+ASC_INITFUNC(
+STATIC ushort
AscGetChipBusType(
- PortAddr iop_base
-)
-{
- ushort chip_ver;
- chip_ver = AscGetChipVerNo(iop_base);
- if (
- (chip_ver >= ASC_CHIP_MIN_VER_VL)
- && (chip_ver <= ASC_CHIP_MAX_VER_VL)
- ) {
- if (
- ((iop_base & 0x0C30) == 0x0C30)
- || ((iop_base & 0x0C50) == 0x0C50)
- ) {
- return (ASC_IS_EISA);
- }
- return (ASC_IS_VL);
- }
- if ((chip_ver >= ASC_CHIP_MIN_VER_ISA) &&
- (chip_ver <= ASC_CHIP_MAX_VER_ISA)) {
- if (chip_ver >= ASC_CHIP_MIN_VER_ISA_PNP) {
- return (ASC_IS_ISAPNP);
- }
- return (ASC_IS_ISA);
- } else if ((chip_ver >= ASC_CHIP_MIN_VER_PCI) &&
- (chip_ver <= ASC_CHIP_MAX_VER_PCI)) {
- return (ASC_IS_PCI);
- }
- return (0);
-}
-
-__initfunc(ulong
+ PortAddr iop_base
+)
+)
+{
+ ushort chip_ver;
+ chip_ver = AscGetChipVerNo(iop_base);
+ if (
+ (chip_ver >= ASC_CHIP_MIN_VER_VL)
+ && (chip_ver <= ASC_CHIP_MAX_VER_VL)
+) {
+ if (
+ ((iop_base & 0x0C30) == 0x0C30)
+ || ((iop_base & 0x0C50) == 0x0C50)
+) {
+ return (ASC_IS_EISA);
+ }
+ return (ASC_IS_VL);
+ }
+ if ((chip_ver >= ASC_CHIP_MIN_VER_ISA) &&
+ (chip_ver <= ASC_CHIP_MAX_VER_ISA)) {
+ if (chip_ver >= ASC_CHIP_MIN_VER_ISA_PNP) {
+ return (ASC_IS_ISAPNP);
+ }
+ return (ASC_IS_ISA);
+ } else if ((chip_ver >= ASC_CHIP_MIN_VER_PCI) &&
+ (chip_ver <= ASC_CHIP_MAX_VER_PCI)) {
+ return (ASC_IS_PCI);
+ }
+ return (0);
+}
+
+ASC_INITFUNC(
+STATIC ulong
AscLoadMicroCode(
- PortAddr iop_base,
- ushort s_addr,
- ushort dosfar * mcode_buf,
- ushort mcode_size
-))
-{
- ulong chksum;
- ushort mcode_word_size;
- ushort mcode_chksum;
- mcode_word_size = (ushort) (mcode_size >> 1);
- AscMemWordSetLram(iop_base, s_addr, 0, mcode_word_size);
- AscMemWordCopyToLram(iop_base, s_addr, mcode_buf, mcode_word_size);
- chksum = AscMemSumLramWord(iop_base, s_addr, mcode_word_size);
- mcode_chksum = (ushort) AscMemSumLramWord(iop_base,
- (ushort) ASC_CODE_SEC_BEG,
- (ushort) ((mcode_size - s_addr - (ushort) ASC_CODE_SEC_BEG) / 2));
- AscWriteLramWord(iop_base, ASCV_MCODE_CHKSUM_W, mcode_chksum);
- AscWriteLramWord(iop_base, ASCV_MCODE_SIZE_W, mcode_size);
- return (chksum);
-}
-
-__initfunc(int
+ PortAddr iop_base,
+ ushort s_addr,
+ ushort *mcode_buf,
+ ushort mcode_size
+)
+)
+{
+ ulong chksum;
+ ushort mcode_word_size;
+ ushort mcode_chksum;
+ mcode_word_size = (ushort) (mcode_size >> 1);
+ AscMemWordSetLram(iop_base, s_addr, 0, mcode_word_size);
+ AscMemWordCopyToLram(iop_base, s_addr, mcode_buf, mcode_word_size);
+ chksum = AscMemSumLramWord(iop_base, s_addr, mcode_word_size);
+ mcode_chksum = (ushort) AscMemSumLramWord(iop_base,
+ (ushort) ASC_CODE_SEC_BEG,
+ (ushort) ((mcode_size - s_addr - (ushort) ASC_CODE_SEC_BEG) / 2));
+ AscWriteLramWord(iop_base, ASCV_MCODE_CHKSUM_W, mcode_chksum);
+ AscWriteLramWord(iop_base, ASCV_MCODE_SIZE_W, mcode_size);
+ return (chksum);
+}
+
+ASC_INITFUNC(
+STATIC int
AscFindSignature(
- PortAddr iop_base
-))
+ PortAddr iop_base
+)
+)
{
- ushort sig_word;
- if (AscGetChipSignatureByte(iop_base) == (uchar) ASC_1000_ID1B) {
- sig_word = AscGetChipSignatureWord(iop_base);
- if ((sig_word == (ushort) ASC_1000_ID0W) ||
- (sig_word == (ushort) ASC_1000_ID0W_FIX)) {
- return (1);
- }
- }
- return (0);
+ ushort sig_word;
+ if (AscGetChipSignatureByte(iop_base) == (uchar) ASC_1000_ID1B) {
+ sig_word = AscGetChipSignatureWord(iop_base);
+ if ((sig_word == (ushort) ASC_1000_ID0W) ||
+ (sig_word == (ushort) ASC_1000_ID0W_FIX)) {
+ return (1);
+ }
+ }
+ return (0);
}
-uchar _isa_pnp_inited = 0;
-PortAddr _asc_def_iop_base[ASC_IOADR_TABLE_MAX_IX] =
+STATIC uchar _isa_pnp_inited ASC_INITDATA = 0;
+STATIC PortAddr _asc_def_iop_base[ASC_IOADR_TABLE_MAX_IX] ASC_INITDATA =
{
- 0x100, ASC_IOADR_1, 0x120, ASC_IOADR_2, 0x140, ASC_IOADR_3, ASC_IOADR_4,
- ASC_IOADR_5, ASC_IOADR_6, ASC_IOADR_7, ASC_IOADR_8
+ 0x100, ASC_IOADR_1, 0x120, ASC_IOADR_2, 0x140, ASC_IOADR_3, ASC_IOADR_4,
+ ASC_IOADR_5, ASC_IOADR_6, ASC_IOADR_7, ASC_IOADR_8
};
-__initfunc(PortAddr
+ASC_INITFUNC(
+STATIC PortAddr
AscSearchIOPortAddr(
- PortAddr iop_beg,
- ushort bus_type
-))
-{
- if (bus_type & ASC_IS_VL) {
- while ((iop_beg = AscSearchIOPortAddr11(iop_beg)) != 0) {
- if (AscGetChipVersion(iop_beg, bus_type) <= ASC_CHIP_MAX_VER_VL) {
- return (iop_beg);
- }
- }
- return (0);
- }
- if (bus_type & ASC_IS_ISA) {
- if (_isa_pnp_inited == 0) {
- AscSetISAPNPWaitForKey();
- _isa_pnp_inited++;
- }
- while ((iop_beg = AscSearchIOPortAddr11(iop_beg)) != 0) {
- if ((AscGetChipVersion(iop_beg, bus_type) & ASC_CHIP_VER_ISA_BIT) != 0) {
- return (iop_beg);
- }
- }
- return (0);
- }
- if (bus_type & ASC_IS_EISA) {
- if ((iop_beg = AscSearchIOPortAddrEISA(iop_beg)) != 0) {
- return (iop_beg);
- }
- return (0);
- }
- return (0);
-}
-
-__initfunc(PortAddr
-AscSearchIOPortAddr11(
- PortAddr s_addr
-))
-{
- int i;
- PortAddr iop_base;
- for (i = 0; i < ASC_IOADR_TABLE_MAX_IX; i++) {
- if (_asc_def_iop_base[i] > s_addr) {
- break;
- }
- }
- for (; i < ASC_IOADR_TABLE_MAX_IX; i++) {
- iop_base = _asc_def_iop_base[i];
- if (check_region(iop_base, ASC_IOADR_GAP) != 0) {
- ASC_DBG1(1,
- "AscSearchIOPortAddr11: check_region() failed I/O port %x\n",
- iop_base);
- continue;
- }
- ASC_DBG1(1, "AscSearchIOPortAddr11: probing I/O port %x\n", iop_base);
- if (AscFindSignature(iop_base)) {
- return (iop_base);
- }
- }
- return (0);
+ PortAddr iop_beg,
+ ushort bus_type
+)
+)
+{
+ if (bus_type & ASC_IS_VL) {
+ while ((iop_beg = AscSearchIOPortAddr11(iop_beg)) != 0) {
+ if (AscGetChipVersion(iop_beg, bus_type) <= ASC_CHIP_MAX_VER_VL) {
+ return (iop_beg);
+ }
+ }
+ return (0);
+ }
+ if (bus_type & ASC_IS_ISA) {
+ if (_isa_pnp_inited == 0) {
+ AscSetISAPNPWaitForKey();
+ _isa_pnp_inited++;
+ }
+ while ((iop_beg = AscSearchIOPortAddr11(iop_beg)) != 0) {
+ if ((AscGetChipVersion(iop_beg, bus_type) & ASC_CHIP_VER_ISA_BIT) != 0) {
+ return (iop_beg);
+ }
+ }
+ return (0);
+ }
+ if (bus_type & ASC_IS_EISA) {
+ if ((iop_beg = AscSearchIOPortAddrEISA(iop_beg)) != 0) {
+ return (iop_beg);
+ }
+ return (0);
+ }
+ return (0);
}
-void
-AscToggleIRQAct(
- PortAddr iop_base
+ASC_INITFUNC(
+STATIC PortAddr
+AscSearchIOPortAddr11(
+ PortAddr s_addr
+)
)
{
- AscSetChipStatus(iop_base, CIW_IRQ_ACT);
- AscSetChipStatus(iop_base, 0);
- return;
+ int i;
+ PortAddr iop_base;
+ for (i = 0; i < ASC_IOADR_TABLE_MAX_IX; i++) {
+ if (_asc_def_iop_base[i] > s_addr) {
+ break;
+ }
+ }
+ for (; i < ASC_IOADR_TABLE_MAX_IX; i++) {
+ iop_base = _asc_def_iop_base[i];
+ if (check_region(iop_base, ASC_IOADR_GAP) != 0) {
+ ASC_DBG1(1,
+ "AscSearchIOPortAddr11: check_region() failed I/O port %x\n",
+ iop_base);
+ continue;
+ }
+ ASC_DBG1(1, "AscSearchIOPortAddr11: probing I/O port %x\n", iop_base);
+ if (AscFindSignature(iop_base)) {
+ return (iop_base);
+ }
+ }
+ return (0);
}
-#if CC_INIT_INQ_DISPLAY
-uchar _hextbl_[16] =
+ASC_INITFUNC(
+STATIC void
+AscToggleIRQAct(
+ PortAddr iop_base
+)
+)
{
- '0', '1', '2', '3', '4', '5', '6', '7', '8', '9',
- 'A', 'B', 'C', 'D', 'E', 'F'
-};
-#endif
+ AscSetChipStatus(iop_base, CIW_IRQ_ACT);
+ AscSetChipStatus(iop_base, 0);
+ return;
+}
-__initfunc(void
+ASC_INITFUNC(
+STATIC void
AscSetISAPNPWaitForKey(
- void))
+ void)
+)
{
- outp(ASC_ISA_PNP_PORT_ADDR, 0x02);
- outp(ASC_ISA_PNP_PORT_WRITE, 0x02);
- return;
+ outp(ASC_ISA_PNP_PORT_ADDR, 0x02);
+ outp(ASC_ISA_PNP_PORT_WRITE, 0x02);
+ return;
}
-uchar
+ASC_INITFUNC(
+STATIC uchar
AscGetChipIRQ(
- PortAddr iop_base,
- ushort bus_type
-)
-{
- ushort cfg_lsw;
- uchar chip_irq;
- if ((bus_type & ASC_IS_EISA) != 0) {
- cfg_lsw = AscGetEisaChipCfg(iop_base);
- chip_irq = (uchar) (((cfg_lsw >> 8) & 0x07) + 10);
- if ((chip_irq == 13) || (chip_irq > 15)) {
- return (0);
- }
- return (chip_irq);
- }
- if ((bus_type & ASC_IS_VL) != 0) {
- cfg_lsw = AscGetChipCfgLsw(iop_base);
- chip_irq = (uchar) (((cfg_lsw >> 2) & 0x07));
- if ((chip_irq == 0) ||
- (chip_irq == 4) ||
- (chip_irq == 7)) {
- return (0);
- }
+ PortAddr iop_base,
+ ushort bus_type
+)
+)
+{
+ ushort cfg_lsw;
+ uchar chip_irq;
+ if ((bus_type & ASC_IS_EISA) != 0) {
+ cfg_lsw = AscGetEisaChipCfg(iop_base);
+ chip_irq = (uchar) (((cfg_lsw >> 8) & 0x07) + 10);
+ if ((chip_irq == 13) || (chip_irq > 15)) {
+ return (0);
+ }
+ return (chip_irq);
+ }
+ if ((bus_type & ASC_IS_VL) != 0) {
+ cfg_lsw = AscGetChipCfgLsw(iop_base);
+ chip_irq = (uchar) (((cfg_lsw >> 2) & 0x07));
+ if ((chip_irq == 0) ||
+ (chip_irq == 4) ||
+ (chip_irq == 7)) {
+ return (0);
+ }
#if CC_PLEXTOR_VL
- if (chip_irq == 5) {
- return (9);
- }
+ if (chip_irq == 5) {
+ return (9);
+ }
#endif
- return ((uchar) (chip_irq + (ASC_MIN_IRQ_NO - 1)));
- }
- cfg_lsw = AscGetChipCfgLsw(iop_base);
- chip_irq = (uchar) (((cfg_lsw >> 2) & 0x03));
- if (chip_irq == 3)
- chip_irq += (uchar) 2;
- return ((uchar) (chip_irq + ASC_MIN_IRQ_NO));
+ return ((uchar) (chip_irq + (ASC_MIN_IRQ_NO - 1)));
+ }
+ cfg_lsw = AscGetChipCfgLsw(iop_base);
+ chip_irq = (uchar) (((cfg_lsw >> 2) & 0x03));
+ if (chip_irq == 3)
+ chip_irq += (uchar) 2;
+ return ((uchar) (chip_irq + ASC_MIN_IRQ_NO));
}
-uchar
+ASC_INITFUNC(
+STATIC uchar
AscSetChipIRQ(
- PortAddr iop_base,
- uchar irq_no,
- ushort bus_type
+ PortAddr iop_base,
+ uchar irq_no,
+ ushort bus_type
+)
)
{
- ushort cfg_lsw;
- if ((bus_type & ASC_IS_VL) != 0) {
- if (irq_no != 0) {
+ ushort cfg_lsw;
+ if ((bus_type & ASC_IS_VL) != 0) {
+ if (irq_no != 0) {
#if CC_PLEXTOR_VL
- if (irq_no == 9) {
- irq_no = 14;
- }
+ if (irq_no == 9) {
+ irq_no = 14;
+ }
#endif
- if ((irq_no < ASC_MIN_IRQ_NO) || (irq_no > ASC_MAX_IRQ_NO)) {
- irq_no = 0;
- } else {
- irq_no -= (uchar) ((ASC_MIN_IRQ_NO - 1));
- }
- }
- cfg_lsw = (ushort) (AscGetChipCfgLsw(iop_base) & 0xFFE3);
- cfg_lsw |= (ushort) 0x0010;
- AscSetChipCfgLsw(iop_base, cfg_lsw);
- AscToggleIRQAct(iop_base);
- cfg_lsw = (ushort) (AscGetChipCfgLsw(iop_base) & 0xFFE0);
- cfg_lsw |= (ushort) ((irq_no & 0x07) << 2);
- AscSetChipCfgLsw(iop_base, cfg_lsw);
- AscToggleIRQAct(iop_base);
- return (AscGetChipIRQ(iop_base, bus_type));
- }
- if ((bus_type & (ASC_IS_ISA)) != 0) {
- if (irq_no == 15)
- irq_no -= (uchar) 2;
- irq_no -= (uchar) ASC_MIN_IRQ_NO;
- cfg_lsw = (ushort) (AscGetChipCfgLsw(iop_base) & 0xFFF3);
- cfg_lsw |= (ushort) ((irq_no & 0x03) << 2);
- AscSetChipCfgLsw(iop_base, cfg_lsw);
- return (AscGetChipIRQ(iop_base, bus_type));
- }
- return (0);
+ if ((irq_no < ASC_MIN_IRQ_NO) || (irq_no > ASC_MAX_IRQ_NO)) {
+ irq_no = 0;
+ } else {
+ irq_no -= (uchar) ((ASC_MIN_IRQ_NO - 1));
+ }
+ }
+ cfg_lsw = (ushort) (AscGetChipCfgLsw(iop_base) & 0xFFE3);
+ cfg_lsw |= (ushort) 0x0010;
+ AscSetChipCfgLsw(iop_base, cfg_lsw);
+ AscToggleIRQAct(iop_base);
+ cfg_lsw = (ushort) (AscGetChipCfgLsw(iop_base) & 0xFFE0);
+ cfg_lsw |= (ushort) ((irq_no & 0x07) << 2);
+ AscSetChipCfgLsw(iop_base, cfg_lsw);
+ AscToggleIRQAct(iop_base);
+ return (AscGetChipIRQ(iop_base, bus_type));
+ }
+ if ((bus_type & (ASC_IS_ISA)) != 0) {
+ if (irq_no == 15)
+ irq_no -= (uchar) 2;
+ irq_no -= (uchar) ASC_MIN_IRQ_NO;
+ cfg_lsw = (ushort) (AscGetChipCfgLsw(iop_base) & 0xFFF3);
+ cfg_lsw |= (ushort) ((irq_no & 0x03) << 2);
+ AscSetChipCfgLsw(iop_base, cfg_lsw);
+ return (AscGetChipIRQ(iop_base, bus_type));
+ }
+ return (0);
}
-void
+ASC_INITFUNC(
+STATIC void
AscEnableIsaDma(
- uchar dma_channel
+ uchar dma_channel
+)
)
{
- if (dma_channel < 4) {
- outp(0x000B, (ushort) (0xC0 | dma_channel));
- outp(0x000A, dma_channel);
- } else if (dma_channel < 8) {
- outp(0x00D6, (ushort) (0xC0 | (dma_channel - 4)));
- outp(0x00D4, (ushort) (dma_channel - 4));
- }
- return;
+ if (dma_channel < 4) {
+ outp(0x000B, (ushort) (0xC0 | dma_channel));
+ outp(0x000A, dma_channel);
+ } else if (dma_channel < 8) {
+ outp(0x00D6, (ushort) (0xC0 | (dma_channel - 4)));
+ outp(0x00D4, (ushort) (dma_channel - 4));
+ }
+ return;
}
-int
+STATIC int
AscIsrChipHalted(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc
-)
-{
- SDTR_XMSG sdtr_xmsg;
- SDTR_XMSG out_msg;
- ushort halt_q_addr;
- int sdtr_accept;
- ushort int_halt_code;
- ASC_SCSI_BIT_ID_TYPE scsi_busy;
- ASC_SCSI_BIT_ID_TYPE target_id;
- PortAddr iop_base;
- uchar tag_code;
- uchar q_status;
- uchar halt_qp;
- uchar sdtr_data = 0;
- uchar target_ix;
- uchar q_cntl, tid_no;
- uchar cur_dvc_qng;
- uchar asyn_sdtr;
- uchar scsi_status;
- iop_base = asc_dvc->iop_base;
- int_halt_code = AscReadLramWord(iop_base, ASCV_HALTCODE_W);
- halt_qp = AscReadLramByte(iop_base, ASCV_CURCDB_B);
- halt_q_addr = ASC_QNO_TO_QADDR(halt_qp);
- target_ix = AscReadLramByte(iop_base,
- (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_TARGET_IX));
- q_cntl = AscReadLramByte(iop_base,
- (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_CNTL));
- tid_no = ASC_TIX_TO_TID(target_ix);
- target_id = (uchar) ASC_TID_TO_TARGET_ID(tid_no);
- if (asc_dvc->pci_fix_asyn_xfer & target_id) {
- asyn_sdtr = ASYN_SDTR_DATA_FIX_PCI_REV_AB;
- } else {
- asyn_sdtr = 0;
- }
- if (int_halt_code == ASC_HALT_DISABLE_ASYN_USE_SYN_FIX) {
- if (asc_dvc->pci_fix_asyn_xfer & target_id) {
- AscSetChipSDTR(iop_base, 0, tid_no);
- }
- AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
- return (0);
- } else if (int_halt_code == ASC_HALT_ENABLE_ASYN_USE_SYN_FIX) {
- if (asc_dvc->pci_fix_asyn_xfer & target_id) {
- AscSetChipSDTR(iop_base, asyn_sdtr, tid_no);
- }
- AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
- return (0);
- } else if (int_halt_code == ASC_HALT_EXTMSG_IN) {
- AscMemWordCopyFromLram(iop_base,
- ASCV_MSGIN_BEG,
- (ushort dosfar *) & sdtr_xmsg,
- (ushort) (sizeof (SDTR_XMSG) >> 1));
- if (
- (sdtr_xmsg.msg_type == MS_EXTEND)
- && (sdtr_xmsg.msg_len == MS_SDTR_LEN)
- ) {
- sdtr_accept = TRUE;
- if (sdtr_xmsg.msg_req == MS_SDTR_CODE) {
- if (
- (sdtr_xmsg.req_ack_offset > ASC_SYN_MAX_OFFSET)
- ) {
- sdtr_accept = FALSE;
- sdtr_xmsg.req_ack_offset = ASC_SYN_MAX_OFFSET;
- }
- if (
- (sdtr_xmsg.xfer_period < asc_dvc->sdtr_period_tbl[asc_dvc->host_init_sdtr_index])
- || (sdtr_xmsg.xfer_period > asc_dvc->sdtr_period_tbl[asc_dvc->max_sdtr_index])
- ) {
- sdtr_accept = FALSE;
- sdtr_xmsg.xfer_period = asc_dvc->sdtr_period_tbl[ asc_dvc->host_init_sdtr_index ] ;
- }
- if (sdtr_accept) {
- sdtr_data = AscCalSDTRData(asc_dvc, sdtr_xmsg.xfer_period,
- sdtr_xmsg.req_ack_offset);
- if ((sdtr_data == 0xFF)) {
- q_cntl |= QC_MSG_OUT;
- asc_dvc->init_sdtr &= ~target_id;
- asc_dvc->sdtr_done &= ~target_id;
- AscSetChipSDTR(iop_base, asyn_sdtr, tid_no);
- }
- }
- if (sdtr_xmsg.req_ack_offset == 0) {
- q_cntl &= ~QC_MSG_OUT;
- asc_dvc->init_sdtr &= ~target_id;
- asc_dvc->sdtr_done &= ~target_id;
- AscSetChipSDTR(iop_base, asyn_sdtr, tid_no);
- } else {
- if (
- sdtr_accept
- && (q_cntl & QC_MSG_OUT)
- ) {
- q_cntl &= ~QC_MSG_OUT;
- asc_dvc->sdtr_done |= target_id;
- asc_dvc->init_sdtr |= target_id;
- asc_dvc->pci_fix_asyn_xfer &= ~target_id;
- sdtr_data = AscCalSDTRData(asc_dvc,
- sdtr_xmsg.xfer_period, sdtr_xmsg.req_ack_offset);
- AscSetChipSDTR(iop_base, sdtr_data, tid_no);
- } else {
- q_cntl |= QC_MSG_OUT;
- AscMsgOutSDTR(asc_dvc,
- sdtr_xmsg.xfer_period,
- sdtr_xmsg.req_ack_offset);
- asc_dvc->pci_fix_asyn_xfer &= ~target_id;
- sdtr_data = AscCalSDTRData(asc_dvc,
- sdtr_xmsg.xfer_period, sdtr_xmsg.req_ack_offset);
- AscSetChipSDTR(iop_base, sdtr_data, tid_no);
- asc_dvc->sdtr_done |= target_id;
- asc_dvc->init_sdtr |= target_id;
- }
- }
- AscWriteLramByte(iop_base,
- (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_CNTL),
- q_cntl);
- AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
- return (0);
- }
- }
- } else if (int_halt_code == ASC_HALT_CHK_CONDITION) {
- q_cntl |= QC_REQ_SENSE;
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+{
+ EXT_MSG ext_msg;
+ EXT_MSG out_msg;
+ ushort halt_q_addr;
+ int sdtr_accept;
+ ushort int_halt_code;
+ ASC_SCSI_BIT_ID_TYPE scsi_busy;
+ ASC_SCSI_BIT_ID_TYPE target_id;
+ PortAddr iop_base;
+ uchar tag_code;
+ uchar q_status;
+ uchar halt_qp;
+ uchar sdtr_data;
+ uchar target_ix;
+ uchar q_cntl, tid_no;
+ uchar cur_dvc_qng;
+ uchar asyn_sdtr;
+ uchar scsi_status;
+ asc_board_t *boardp;
+
+ ASC_ASSERT(asc_dvc->drv_ptr != 0);
+ boardp = (asc_board_t *) asc_dvc->drv_ptr;
+
+ iop_base = asc_dvc->iop_base;
+ int_halt_code = AscReadLramWord(iop_base, ASCV_HALTCODE_W);
+
+ halt_qp = AscReadLramByte(iop_base, ASCV_CURCDB_B);
+ halt_q_addr = ASC_QNO_TO_QADDR(halt_qp);
+ target_ix = AscReadLramByte(iop_base,
+ (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_TARGET_IX));
+ q_cntl = AscReadLramByte(iop_base,
+ (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_CNTL));
+ tid_no = ASC_TIX_TO_TID(target_ix);
+ target_id = (uchar) ASC_TID_TO_TARGET_ID(tid_no);
+ if (asc_dvc->pci_fix_asyn_xfer & target_id) {
+
+ asyn_sdtr = ASYN_SDTR_DATA_FIX_PCI_REV_AB;
+ } else {
+ asyn_sdtr = 0;
+ }
+ if (int_halt_code == ASC_HALT_DISABLE_ASYN_USE_SYN_FIX) {
+ if (asc_dvc->pci_fix_asyn_xfer & target_id) {
+ AscSetChipSDTR(iop_base, 0, tid_no);
+ boardp->sdtr_data[tid_no] = 0;
+ }
+ AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
+ return (0);
+ } else if (int_halt_code == ASC_HALT_ENABLE_ASYN_USE_SYN_FIX) {
+ if (asc_dvc->pci_fix_asyn_xfer & target_id) {
+ AscSetChipSDTR(iop_base, asyn_sdtr, tid_no);
+ boardp->sdtr_data[tid_no] = asyn_sdtr;
+ }
+ AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
+ return (0);
+ } else if (int_halt_code == ASC_HALT_EXTMSG_IN) {
+
+ AscMemWordCopyFromLram(iop_base,
+ ASCV_MSGIN_BEG,
+ (ushort *) & ext_msg,
+ (ushort) (sizeof (EXT_MSG) >> 1));
+
+ if (ext_msg.msg_type == MS_EXTEND &&
+ ext_msg.msg_req == MS_SDTR_CODE &&
+ ext_msg.msg_len == MS_SDTR_LEN) {
+ sdtr_accept = TRUE;
+ if ((ext_msg.req_ack_offset > ASC_SYN_MAX_OFFSET)) {
+
+ sdtr_accept = FALSE;
+ ext_msg.req_ack_offset = ASC_SYN_MAX_OFFSET;
+ }
+ if ((ext_msg.xfer_period <
+ asc_dvc->sdtr_period_tbl[asc_dvc->host_init_sdtr_index]) ||
+ (ext_msg.xfer_period >
+ asc_dvc->sdtr_period_tbl[asc_dvc->max_sdtr_index])) {
+ sdtr_accept = FALSE;
+ ext_msg.xfer_period =
+ asc_dvc->sdtr_period_tbl[asc_dvc->host_init_sdtr_index];
+ }
+ if (sdtr_accept) {
+ sdtr_data = AscCalSDTRData(asc_dvc, ext_msg.xfer_period,
+ ext_msg.req_ack_offset);
+ if ((sdtr_data == 0xFF)) {
+
+ q_cntl |= QC_MSG_OUT;
+ asc_dvc->init_sdtr &= ~target_id;
+ asc_dvc->sdtr_done &= ~target_id;
+ AscSetChipSDTR(iop_base, asyn_sdtr, tid_no);
+ boardp->sdtr_data[tid_no] = asyn_sdtr;
+ }
+ }
+ if (ext_msg.req_ack_offset == 0) {
+
+ q_cntl &= ~QC_MSG_OUT;
+ asc_dvc->init_sdtr &= ~target_id;
+ asc_dvc->sdtr_done &= ~target_id;
+ AscSetChipSDTR(iop_base, asyn_sdtr, tid_no);
+ } else {
+ if (sdtr_accept && (q_cntl & QC_MSG_OUT)) {
+
+ q_cntl &= ~QC_MSG_OUT;
+ asc_dvc->sdtr_done |= target_id;
+ asc_dvc->init_sdtr |= target_id;
+ asc_dvc->pci_fix_asyn_xfer &= ~target_id;
+ sdtr_data = AscCalSDTRData(asc_dvc, ext_msg.xfer_period,
+ ext_msg.req_ack_offset);
+ AscSetChipSDTR(iop_base, sdtr_data, tid_no);
+ boardp->sdtr_data[tid_no] = sdtr_data;
+ } else {
+
+ q_cntl |= QC_MSG_OUT;
+ AscMsgOutSDTR(asc_dvc,
+ ext_msg.xfer_period,
+ ext_msg.req_ack_offset);
+ asc_dvc->pci_fix_asyn_xfer &= ~target_id;
+ sdtr_data = AscCalSDTRData(asc_dvc, ext_msg.xfer_period,
+ ext_msg.req_ack_offset);
+ AscSetChipSDTR(iop_base, sdtr_data, tid_no);
+ boardp->sdtr_data[tid_no] = sdtr_data;
+ asc_dvc->sdtr_done |= target_id;
+ asc_dvc->init_sdtr |= target_id;
+ }
+ }
+
+ AscWriteLramByte(iop_base,
+ (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_CNTL),
+ q_cntl);
+ AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
+ return (0);
+ } else if (ext_msg.msg_type == MS_EXTEND &&
+ ext_msg.msg_req == MS_WDTR_CODE &&
+ ext_msg.msg_len == MS_WDTR_LEN) {
+
+ ext_msg.wdtr_width = 0;
+ AscMemWordCopyToLram(iop_base,
+ ASCV_MSGOUT_BEG,
+ (ushort *) & ext_msg,
+ (ushort) (sizeof (EXT_MSG) >> 1));
+ q_cntl |= QC_MSG_OUT;
+ AscWriteLramByte(iop_base,
+ (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_CNTL),
+ q_cntl);
+ AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
+ return (0);
+ } else {
+
+ ext_msg.msg_type = M1_MSG_REJECT;
+ AscMemWordCopyToLram(iop_base,
+ ASCV_MSGOUT_BEG,
+ (ushort *) & ext_msg,
+ (ushort) (sizeof (EXT_MSG) >> 1));
+ q_cntl |= QC_MSG_OUT;
+ AscWriteLramByte(iop_base,
+ (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_CNTL),
+ q_cntl);
+ AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
+ return (0);
+ }
+ } else if (int_halt_code == ASC_HALT_CHK_CONDITION) {
+
+ q_cntl |= QC_REQ_SENSE;
+
#if CC_CHK_COND_REDO_SDTR
- if (((asc_dvc->init_sdtr & target_id) != 0) &&
- ((asc_dvc->sdtr_done & target_id) != 0)) {
- asc_dvc->sdtr_done &= ~target_id;
- sdtr_data = AscGetMCodeInitSDTRAtID(iop_base, tid_no);
- q_cntl |= QC_MSG_OUT;
- AscMsgOutSDTR(asc_dvc,
- asc_dvc->sdtr_period_tbl[(sdtr_data >> 4) & (uchar) (asc_dvc->max_sdtr_index - 1)],
- (uchar) (sdtr_data & (uchar) ASC_SYN_MAX_OFFSET));
- }
+ if ((asc_dvc->init_sdtr & target_id) != 0) {
+
+ asc_dvc->sdtr_done &= ~target_id;
+
+ sdtr_data = AscGetMCodeInitSDTRAtID(iop_base, tid_no);
+ q_cntl |= QC_MSG_OUT;
+ AscMsgOutSDTR(asc_dvc,
+ asc_dvc->sdtr_period_tbl[(sdtr_data >> 4) &
+ (uchar) (asc_dvc->max_sdtr_index - 1)],
+ (uchar) (sdtr_data & (uchar) ASC_SYN_MAX_OFFSET));
+ }
#endif
- AscWriteLramByte(iop_base,
- (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_CNTL),
- q_cntl);
- tag_code = AscReadLramByte(iop_base,
- (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_TAG_CODE));
- tag_code &= 0xDC;
- if (
- (asc_dvc->pci_fix_asyn_xfer & target_id)
- && !(asc_dvc->pci_fix_asyn_xfer_always & target_id)
- ) {
- tag_code |= (ASC_TAG_FLAG_DISABLE_DISCONNECT
- | ASC_TAG_FLAG_DISABLE_ASYN_USE_SYN_FIX);
- }
- AscWriteLramByte(iop_base,
- (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_TAG_CODE),
- tag_code);
- q_status = AscReadLramByte(iop_base,
- (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_STATUS));
- q_status |= (QS_READY | QS_BUSY);
- AscWriteLramByte(iop_base,
- (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_STATUS),
- q_status);
- scsi_busy = AscReadLramByte(iop_base,
- (ushort) ASCV_SCSIBUSY_B);
- scsi_busy &= ~target_id;
- AscWriteLramByte(iop_base, (ushort) ASCV_SCSIBUSY_B, scsi_busy);
- AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
- return (0);
- } else if (int_halt_code == ASC_HALT_SDTR_REJECTED) {
- AscMemWordCopyFromLram(iop_base,
- ASCV_MSGOUT_BEG,
- (ushort dosfar *) & out_msg,
- (ushort) (sizeof (SDTR_XMSG) >> 1));
- if ((out_msg.msg_type == MS_EXTEND) &&
- (out_msg.msg_len == MS_SDTR_LEN) &&
- (out_msg.msg_req == MS_SDTR_CODE)) {
- asc_dvc->init_sdtr &= ~target_id;
- asc_dvc->sdtr_done &= ~target_id;
- AscSetChipSDTR(iop_base, asyn_sdtr, tid_no);
- } else {
- }
- q_cntl &= ~QC_MSG_OUT;
- AscWriteLramByte(iop_base,
- (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_CNTL),
- q_cntl);
- AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
- return (0);
- } else if (int_halt_code == ASC_HALT_SS_QUEUE_FULL) {
- scsi_status = AscReadLramByte(iop_base,
- (ushort) ((ushort) halt_q_addr + (ushort) ASC_SCSIQ_SCSI_STATUS));
- cur_dvc_qng = AscReadLramByte(iop_base,
- (ushort) ((ushort) ASC_QADR_BEG + (ushort) target_ix));
- if ((cur_dvc_qng > 0) &&
- (asc_dvc->cur_dvc_qng[tid_no] > 0)) {
- scsi_busy = AscReadLramByte(iop_base,
- (ushort) ASCV_SCSIBUSY_B);
- scsi_busy |= target_id;
- AscWriteLramByte(iop_base,
- (ushort) ASCV_SCSIBUSY_B, scsi_busy);
- asc_dvc->queue_full_or_busy |= target_id;
- if (scsi_status == SS_QUEUE_FULL) {
- if (cur_dvc_qng > ASC_MIN_TAGGED_CMD) {
- cur_dvc_qng -= 1;
- asc_dvc->max_dvc_qng[tid_no] = cur_dvc_qng;
- AscWriteLramByte(iop_base,
- (ushort) ((ushort) ASCV_MAX_DVC_QNG_BEG + (ushort) tid_no),
- cur_dvc_qng);
- }
- {
- asc_board_t *boardp;
- boardp = (asc_board_t *) asc_dvc->drv_ptr;
-
- /*
- * Set the device queue depth to the number of
- * active requests when the QUEUE FULL condition
- * was encountered.
- */
- boardp->queue_full |= target_id;
- boardp->queue_full_cnt[tid_no] = cur_dvc_qng;
+
+ AscWriteLramByte(iop_base,
+ (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_CNTL),
+ q_cntl);
+
+ tag_code = AscReadLramByte(iop_base,
+ (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_TAG_CODE));
+ tag_code &= 0xDC;
+ if (
+ (asc_dvc->pci_fix_asyn_xfer & target_id)
+ && !(asc_dvc->pci_fix_asyn_xfer_always & target_id)
+) {
+
+ tag_code |= (ASC_TAG_FLAG_DISABLE_DISCONNECT
+ | ASC_TAG_FLAG_DISABLE_ASYN_USE_SYN_FIX);
+
+ }
+ AscWriteLramByte(iop_base,
+ (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_TAG_CODE),
+ tag_code);
+
+ q_status = AscReadLramByte(iop_base,
+ (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_STATUS));
+ q_status |= (QS_READY | QS_BUSY);
+ AscWriteLramByte(iop_base,
+ (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_STATUS),
+ q_status);
+
+ scsi_busy = AscReadLramByte(iop_base,
+ (ushort) ASCV_SCSIBUSY_B);
+ scsi_busy &= ~target_id;
+ AscWriteLramByte(iop_base, (ushort) ASCV_SCSIBUSY_B, scsi_busy);
+
+ AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
+ return (0);
+ } else if (int_halt_code == ASC_HALT_SDTR_REJECTED) {
+
+ AscMemWordCopyFromLram(iop_base,
+ ASCV_MSGOUT_BEG,
+ (ushort *) & out_msg,
+ (ushort) (sizeof (EXT_MSG) >> 1));
+
+ if ((out_msg.msg_type == MS_EXTEND) &&
+ (out_msg.msg_len == MS_SDTR_LEN) &&
+ (out_msg.msg_req == MS_SDTR_CODE)) {
+
+ asc_dvc->init_sdtr &= ~target_id;
+ asc_dvc->sdtr_done &= ~target_id;
+ AscSetChipSDTR(iop_base, asyn_sdtr, tid_no);
+ boardp->sdtr_data[tid_no] = asyn_sdtr;
+ }
+ q_cntl &= ~QC_MSG_OUT;
+ AscWriteLramByte(iop_base,
+ (ushort) (halt_q_addr + (ushort) ASC_SCSIQ_B_CNTL),
+ q_cntl);
+ AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
+ return (0);
+ } else if (int_halt_code == ASC_HALT_SS_QUEUE_FULL) {
+
+ scsi_status = AscReadLramByte(iop_base,
+ (ushort) ((ushort) halt_q_addr + (ushort) ASC_SCSIQ_SCSI_STATUS));
+ cur_dvc_qng = AscReadLramByte(iop_base,
+ (ushort) ((ushort) ASC_QADR_BEG + (ushort) target_ix));
+ if ((cur_dvc_qng > 0) &&
+ (asc_dvc->cur_dvc_qng[tid_no] > 0)) {
+
+ scsi_busy = AscReadLramByte(iop_base,
+ (ushort) ASCV_SCSIBUSY_B);
+ scsi_busy |= target_id;
+ AscWriteLramByte(iop_base,
+ (ushort) ASCV_SCSIBUSY_B, scsi_busy);
+ asc_dvc->queue_full_or_busy |= target_id;
+
+ if (scsi_status == SS_QUEUE_FULL) {
+ if (cur_dvc_qng > ASC_MIN_TAGGED_CMD) {
+ cur_dvc_qng -= 1;
+ asc_dvc->max_dvc_qng[tid_no] = cur_dvc_qng;
+
+ AscWriteLramByte(iop_base,
+ (ushort) ((ushort) ASCV_MAX_DVC_QNG_BEG +
+ (ushort) tid_no),
+ cur_dvc_qng);
+
+ /*
+ * Set the device queue depth to the number of
+ * active requests when the QUEUE FULL condition
+ * was encountered.
+ */
+ boardp->queue_full |= target_id;
+ boardp->queue_full_cnt[tid_no] = cur_dvc_qng;
#if ASC_QUEUE_FLOW_CONTROL
- if (boardp->device[tid_no]->queue_curr_depth > cur_dvc_qng) {
- boardp->device[tid_no]->queue_curr_depth = cur_dvc_qng;
- }
+ if (boardp->device[tid_no]->queue_curr_depth >
+ cur_dvc_qng) {
+ boardp->device[tid_no]->queue_curr_depth =
+ cur_dvc_qng;
+ }
#endif /* ASC_QUEUE_FLOW_CONTROL */
- }
- }
- }
- AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
- return (0);
- }
- return (0);
+ }
+ }
+ }
+ AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
+ return (0);
+ }
+ return (0);
}
-uchar
+STATIC uchar
_AscCopyLramScsiDoneQ(
- PortAddr iop_base,
- ushort q_addr,
- REG ASC_QDONE_INFO dosfar * scsiq,
- ulong max_dma_count
-)
-{
- ushort _val;
- uchar sg_queue_cnt;
- DvcGetQinfo(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_DONE_INFO_BEG),
- (ushort dosfar *) scsiq,
- (ushort) ((sizeof (ASC_SCSIQ_2) + sizeof (ASC_SCSIQ_3)) / 2));
+ PortAddr iop_base,
+ ushort q_addr,
+ REG ASC_QDONE_INFO * scsiq,
+ ulong max_dma_count
+)
+{
+ ushort _val;
+ uchar sg_queue_cnt;
+ DvcGetQinfo(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_DONE_INFO_BEG),
+ (ushort *) scsiq,
+ (ushort) ((sizeof (ASC_SCSIQ_2) + sizeof (ASC_SCSIQ_3)) / 2));
#if !CC_LITTLE_ENDIAN_HOST
- AscAdjEndianQDoneInfo(scsiq);
+ AscAdjEndianQDoneInfo(scsiq);
#endif
- _val = AscReadLramWord(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_B_STATUS));
- scsiq->q_status = (uchar) _val;
- scsiq->q_no = (uchar) (_val >> 8);
- _val = AscReadLramWord(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_B_CNTL));
- scsiq->cntl = (uchar) _val;
- sg_queue_cnt = (uchar) (_val >> 8);
- _val = AscReadLramWord(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_B_SENSE_LEN));
- scsiq->sense_len = (uchar) _val;
- scsiq->extra_bytes = (uchar) (_val >> 8);
- scsiq->remain_bytes = AscReadLramDWord(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_DW_REMAIN_XFER_CNT));
- scsiq->remain_bytes &= max_dma_count;
- return (sg_queue_cnt);
+ _val = AscReadLramWord(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_B_STATUS));
+ scsiq->q_status = (uchar) _val;
+ scsiq->q_no = (uchar) (_val >> 8);
+ _val = AscReadLramWord(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_B_CNTL));
+ scsiq->cntl = (uchar) _val;
+ sg_queue_cnt = (uchar) (_val >> 8);
+ _val = AscReadLramWord(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_B_SENSE_LEN));
+ scsiq->sense_len = (uchar) _val;
+ scsiq->extra_bytes = (uchar) (_val >> 8);
+ scsiq->remain_bytes = AscReadLramWord(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_DW_REMAIN_XFER_CNT));
+ scsiq->remain_bytes &= max_dma_count;
+ return (sg_queue_cnt);
}
-int
+STATIC int
AscIsrQDone(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc
-)
-{
- uchar next_qp;
- uchar n_q_used;
- uchar sg_list_qp;
- uchar sg_queue_cnt;
- uchar q_cnt;
- uchar done_q_tail;
- uchar tid_no;
-#if CC_LINK_BUSY_Q
- uchar exe_tid_no;
-#endif
- ASC_SCSI_BIT_ID_TYPE scsi_busy;
- ASC_SCSI_BIT_ID_TYPE target_id;
- PortAddr iop_base;
- ushort q_addr;
- ushort sg_q_addr;
- uchar cur_target_qng;
- ASC_QDONE_INFO scsiq_buf;
- REG ASC_QDONE_INFO dosfar *scsiq;
- int false_overrun;
- ASC_ISR_CALLBACK asc_isr_callback;
-#if CC_LINK_BUSY_Q
- ushort n_busy_q_done;
-#endif
- iop_base = asc_dvc->iop_base;
- asc_isr_callback = (ASC_ISR_CALLBACK) asc_dvc->isr_callback;
- n_q_used = 1;
- scsiq = (ASC_QDONE_INFO dosfar *) & scsiq_buf;
- done_q_tail = (uchar) AscGetVarDoneQTail(iop_base);
- q_addr = ASC_QNO_TO_QADDR(done_q_tail);
- next_qp = AscReadLramByte(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_B_FWD));
- if (next_qp != ASC_QLINK_END) {
- AscPutVarDoneQTail(iop_base, next_qp);
- q_addr = ASC_QNO_TO_QADDR(next_qp);
- sg_queue_cnt = _AscCopyLramScsiDoneQ(iop_base, q_addr, scsiq, asc_dvc->max_dma_count);
- AscWriteLramByte(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_B_STATUS),
- (uchar) (scsiq->q_status & (uchar) ~ (QS_READY | QS_ABORTED)));
- tid_no = ASC_TIX_TO_TID(scsiq->d2.target_ix);
- target_id = ASC_TIX_TO_TARGET_ID(scsiq->d2.target_ix);
- if ((scsiq->cntl & QC_SG_HEAD) != 0) {
- sg_q_addr = q_addr;
- sg_list_qp = next_qp;
- for (q_cnt = 0; q_cnt < sg_queue_cnt; q_cnt++) {
- sg_list_qp = AscReadLramByte(iop_base,
- (ushort) (sg_q_addr + (ushort) ASC_SCSIQ_B_FWD));
- sg_q_addr = ASC_QNO_TO_QADDR(sg_list_qp);
- if (sg_list_qp == ASC_QLINK_END) {
- AscSetLibErrorCode(asc_dvc, ASCQ_ERR_SG_Q_LINKS);
- scsiq->d3.done_stat = QD_WITH_ERROR;
- scsiq->d3.host_stat = QHSTA_D_QDONE_SG_LIST_CORRUPTED;
- goto FATAL_ERR_QDONE;
- }
- AscWriteLramByte(iop_base,
- (ushort) (sg_q_addr + (ushort) ASC_SCSIQ_B_STATUS),
- QS_FREE);
- }
- n_q_used = sg_queue_cnt + 1;
- AscPutVarDoneQTail(iop_base, sg_list_qp);
- }
- if (asc_dvc->queue_full_or_busy & target_id) {
- cur_target_qng = AscReadLramByte(iop_base,
- (ushort) ((ushort) ASC_QADR_BEG + (ushort) scsiq->d2.target_ix));
- if (cur_target_qng < asc_dvc->max_dvc_qng[tid_no]) {
- scsi_busy = AscReadLramByte(iop_base,
- (ushort) ASCV_SCSIBUSY_B);
- scsi_busy &= ~target_id;
- AscWriteLramByte(iop_base,
- (ushort) ASCV_SCSIBUSY_B, scsi_busy);
- asc_dvc->queue_full_or_busy &= ~target_id;
- }
- }
- if (asc_dvc->cur_total_qng >= n_q_used) {
- asc_dvc->cur_total_qng -= n_q_used;
- if (asc_dvc->cur_dvc_qng[tid_no] != 0) {
- asc_dvc->cur_dvc_qng[tid_no]--;
- }
- } else {
- AscSetLibErrorCode(asc_dvc, ASCQ_ERR_CUR_QNG);
- scsiq->d3.done_stat = QD_WITH_ERROR;
- goto FATAL_ERR_QDONE;
- }
- if ((scsiq->d2.srb_ptr == 0UL) ||
- ((scsiq->q_status & QS_ABORTED) != 0)) {
- return (0x11);
- } else if (scsiq->q_status == QS_DONE) {
- false_overrun = FALSE;
- if (scsiq->extra_bytes != 0) {
- scsiq->remain_bytes += (ulong) scsiq->extra_bytes;
- }
- if (scsiq->d3.done_stat == QD_WITH_ERROR) {
- if (scsiq->d3.host_stat == QHSTA_M_DATA_OVER_RUN) {
- if ((scsiq->cntl & (QC_DATA_IN | QC_DATA_OUT)) == 0) {
- scsiq->d3.done_stat = QD_NO_ERROR;
- scsiq->d3.host_stat = QHSTA_NO_ERROR;
- } else if (false_overrun) {
- scsiq->d3.done_stat = QD_NO_ERROR;
- scsiq->d3.host_stat = QHSTA_NO_ERROR;
- }
- } else if (scsiq->d3.host_stat == QHSTA_M_HUNG_REQ_SCSI_BUS_RESET) {
- AscStopChip(iop_base);
- AscSetChipControl(iop_base, (uchar) (CC_SCSI_RESET | CC_HALT));
- DvcDelayNanoSecond(asc_dvc, 30000);
- AscSetChipControl(iop_base, CC_HALT);
- AscSetChipStatus(iop_base, CIW_CLR_SCSI_RESET_INT);
- AscSetChipStatus(iop_base, 0);
- AscSetChipControl(iop_base, 0);
- }
- }
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+{
+ uchar next_qp;
+ uchar n_q_used;
+ uchar sg_list_qp;
+ uchar sg_queue_cnt;
+ uchar q_cnt;
+ uchar done_q_tail;
+ uchar tid_no;
+ ASC_SCSI_BIT_ID_TYPE scsi_busy;
+ ASC_SCSI_BIT_ID_TYPE target_id;
+ PortAddr iop_base;
+ ushort q_addr;
+ ushort sg_q_addr;
+ uchar cur_target_qng;
+ ASC_QDONE_INFO scsiq_buf;
+ REG ASC_QDONE_INFO *scsiq;
+ int false_overrun;
+ ASC_ISR_CALLBACK asc_isr_callback;
+ iop_base = asc_dvc->iop_base;
+ asc_isr_callback = (ASC_ISR_CALLBACK) asc_dvc->isr_callback;
+ n_q_used = 1;
+ scsiq = (ASC_QDONE_INFO *) & scsiq_buf;
+ done_q_tail = (uchar) AscGetVarDoneQTail(iop_base);
+ q_addr = ASC_QNO_TO_QADDR(done_q_tail);
+ next_qp = AscReadLramByte(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_B_FWD));
+ if (next_qp != ASC_QLINK_END) {
+ AscPutVarDoneQTail(iop_base, next_qp);
+ q_addr = ASC_QNO_TO_QADDR(next_qp);
+ sg_queue_cnt = _AscCopyLramScsiDoneQ(iop_base, q_addr, scsiq,
+ asc_dvc->max_dma_count);
+ AscWriteLramByte(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_B_STATUS),
+ (uchar) (scsiq->q_status & (uchar) ~ (QS_READY | QS_ABORTED)));
+ tid_no = ASC_TIX_TO_TID(scsiq->d2.target_ix);
+ target_id = ASC_TIX_TO_TARGET_ID(scsiq->d2.target_ix);
+ if ((scsiq->cntl & QC_SG_HEAD) != 0) {
+ sg_q_addr = q_addr;
+ sg_list_qp = next_qp;
+ for (q_cnt = 0; q_cnt < sg_queue_cnt; q_cnt++) {
+ sg_list_qp = AscReadLramByte(iop_base,
+ (ushort) (sg_q_addr + (ushort) ASC_SCSIQ_B_FWD));
+ sg_q_addr = ASC_QNO_TO_QADDR(sg_list_qp);
+ if (sg_list_qp == ASC_QLINK_END) {
+ AscSetLibErrorCode(asc_dvc, ASCQ_ERR_SG_Q_LINKS);
+ scsiq->d3.done_stat = QD_WITH_ERROR;
+ scsiq->d3.host_stat = QHSTA_D_QDONE_SG_LIST_CORRUPTED;
+ goto FATAL_ERR_QDONE;
+ }
+ AscWriteLramByte(iop_base,
+ (ushort) (sg_q_addr + (ushort) ASC_SCSIQ_B_STATUS),
+ QS_FREE);
+ }
+ n_q_used = sg_queue_cnt + 1;
+ AscPutVarDoneQTail(iop_base, sg_list_qp);
+ }
+ if (asc_dvc->queue_full_or_busy & target_id) {
+ cur_target_qng = AscReadLramByte(iop_base,
+ (ushort) ((ushort) ASC_QADR_BEG + (ushort) scsiq->d2.target_ix));
+ if (cur_target_qng < asc_dvc->max_dvc_qng[tid_no]) {
+ scsi_busy = AscReadLramByte(iop_base,
+ (ushort) ASCV_SCSIBUSY_B);
+ scsi_busy &= ~target_id;
+ AscWriteLramByte(iop_base,
+ (ushort) ASCV_SCSIBUSY_B, scsi_busy);
+ asc_dvc->queue_full_or_busy &= ~target_id;
+ }
+ }
+ if (asc_dvc->cur_total_qng >= n_q_used) {
+ asc_dvc->cur_total_qng -= n_q_used;
+ if (asc_dvc->cur_dvc_qng[tid_no] != 0) {
+ asc_dvc->cur_dvc_qng[tid_no]--;
+ }
+ } else {
+ AscSetLibErrorCode(asc_dvc, ASCQ_ERR_CUR_QNG);
+ scsiq->d3.done_stat = QD_WITH_ERROR;
+ goto FATAL_ERR_QDONE;
+ }
+ if ((scsiq->d2.srb_ptr == 0UL) ||
+ ((scsiq->q_status & QS_ABORTED) != 0)) {
+ return (0x11);
+ } else if (scsiq->q_status == QS_DONE) {
+ false_overrun = FALSE;
+ if (scsiq->extra_bytes != 0) {
+ scsiq->remain_bytes += (ulong) scsiq->extra_bytes;
+ }
+ if (scsiq->d3.done_stat == QD_WITH_ERROR) {
+ if (scsiq->d3.host_stat == QHSTA_M_DATA_OVER_RUN) {
+ if ((scsiq->cntl & (QC_DATA_IN | QC_DATA_OUT)) == 0) {
+ scsiq->d3.done_stat = QD_NO_ERROR;
+ scsiq->d3.host_stat = QHSTA_NO_ERROR;
+ } else if (false_overrun) {
+ scsiq->d3.done_stat = QD_NO_ERROR;
+ scsiq->d3.host_stat = QHSTA_NO_ERROR;
+ }
+ } else if (scsiq->d3.host_stat ==
+ QHSTA_M_HUNG_REQ_SCSI_BUS_RESET) {
+ AscStopChip(iop_base);
+ AscSetChipControl(iop_base,
+ (uchar) (CC_SCSI_RESET | CC_HALT));
+ DvcDelayNanoSecond(asc_dvc, 30000);
+ AscSetChipControl(iop_base, CC_HALT);
+ AscSetChipStatus(iop_base, CIW_CLR_SCSI_RESET_INT);
+ AscSetChipStatus(iop_base, 0);
+ AscSetChipControl(iop_base, 0);
+ }
+ }
#if CC_CLEAR_LRAM_SRB_PTR
- AscWriteLramDWord(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_D_SRBPTR),
- asc_dvc->int_count);
-#endif
- if ((scsiq->cntl & QC_NO_CALLBACK) == 0) {
- (*asc_isr_callback) (asc_dvc, scsiq);
- } else {
- if ((AscReadLramByte(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_CDB_BEG)) ==
- SCSICMD_StartStopUnit)) {
- asc_dvc->unit_not_ready &= ~target_id;
- if (scsiq->d3.done_stat != QD_NO_ERROR) {
- asc_dvc->start_motor &= ~target_id;
- }
- }
- }
-#if CC_LINK_BUSY_Q
- n_busy_q_done = AscIsrExeBusyQueue(asc_dvc, tid_no);
- if (n_busy_q_done == 0) {
- exe_tid_no = (uint) tid_no + 1;
- while (TRUE) {
- if (exe_tid_no > ASC_MAX_TID)
- exe_tid_no = 0;
- if (exe_tid_no == (uint) tid_no)
- break;
- n_busy_q_done = AscIsrExeBusyQueue(asc_dvc, exe_tid_no);
- if (n_busy_q_done != 0)
- break;
- exe_tid_no++;
- }
- }
- if (n_busy_q_done == 0xFFFF)
- return (0x80);
-#endif
- return (1);
- } else {
- AscSetLibErrorCode(asc_dvc, ASCQ_ERR_Q_STATUS);
- FATAL_ERR_QDONE:
- if ((scsiq->cntl & QC_NO_CALLBACK) == 0) {
- (*asc_isr_callback) (asc_dvc, scsiq);
- }
- return (0x80);
- }
- }
- return (0);
-}
-
-#if CC_LINK_BUSY_Q
+ AscWriteLramDWord(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_D_SRBPTR),
+ asc_dvc->int_count);
#endif
+ if ((scsiq->cntl & QC_NO_CALLBACK) == 0) {
+ (*asc_isr_callback) (asc_dvc, scsiq);
+ } else {
+ if ((AscReadLramByte(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_CDB_BEG)) ==
+ SCSICMD_StartStopUnit)) {
+ asc_dvc->unit_not_ready &= ~target_id;
+ if (scsiq->d3.done_stat != QD_NO_ERROR) {
+ asc_dvc->start_motor &= ~target_id;
+ }
+ }
+ }
+ return (1);
+ } else {
+ AscSetLibErrorCode(asc_dvc, ASCQ_ERR_Q_STATUS);
+ FATAL_ERR_QDONE:
+ if ((scsiq->cntl & QC_NO_CALLBACK) == 0) {
+ (*asc_isr_callback) (asc_dvc, scsiq);
+ }
+ return (0x80);
+ }
+ }
+ return (0);
+}
-int
+STATIC int
AscISR(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc
-)
-{
- ASC_CS_TYPE chipstat;
- PortAddr iop_base;
- ushort saved_ram_addr;
- uchar ctrl_reg;
- uchar saved_ctrl_reg;
- int int_pending;
- int status;
- uchar host_flag;
- iop_base = asc_dvc->iop_base;
- int_pending = FALSE;
- if (((asc_dvc->init_state & ASC_INIT_STATE_END_LOAD_MC) == 0)
- || (asc_dvc->isr_callback == 0)
- ) {
- return (ERR);
- }
- if (asc_dvc->in_critical_cnt != 0) {
- AscSetLibErrorCode(asc_dvc, ASCQ_ERR_ISR_ON_CRITICAL);
- return (ERR);
- }
- if (asc_dvc->is_in_int) {
- AscSetLibErrorCode(asc_dvc, ASCQ_ERR_ISR_RE_ENTRY);
- return (ERR);
- }
- asc_dvc->is_in_int = TRUE;
- ctrl_reg = AscGetChipControl(iop_base);
- saved_ctrl_reg = ctrl_reg & (~(CC_SCSI_RESET | CC_CHIP_RESET |
- CC_SINGLE_STEP | CC_DIAG | CC_TEST));
- chipstat = AscGetChipStatus(iop_base);
- if (chipstat & CSW_SCSI_RESET_LATCH) {
- if (
- !(asc_dvc->bus_type & (ASC_IS_VL | ASC_IS_EISA))
- ) {
- int_pending = TRUE;
- asc_dvc->sdtr_done = 0;
- saved_ctrl_reg &= (uchar) (~CC_HALT);
- while (AscGetChipStatus(iop_base) & CSW_SCSI_RESET_ACTIVE) ;
- AscSetChipControl(iop_base, (CC_CHIP_RESET | CC_HALT));
- AscSetChipControl(iop_base, CC_HALT);
- AscSetChipStatus(iop_base, CIW_CLR_SCSI_RESET_INT);
- AscSetChipStatus(iop_base, 0);
- chipstat = AscGetChipStatus(iop_base);
- }
- }
- saved_ram_addr = AscGetChipLramAddr(iop_base);
- host_flag = AscReadLramByte(iop_base, ASCV_HOST_FLAG_B) & (uchar) (~ASC_HOST_FLAG_IN_ISR);
- AscWriteLramByte(iop_base, ASCV_HOST_FLAG_B,
- (uchar) (host_flag | (uchar) ASC_HOST_FLAG_IN_ISR));
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+{
+ ASC_CS_TYPE chipstat;
+ PortAddr iop_base;
+ ushort saved_ram_addr;
+ uchar ctrl_reg;
+ uchar saved_ctrl_reg;
+ int int_pending;
+ int status;
+ uchar host_flag;
+ iop_base = asc_dvc->iop_base;
+ int_pending = FALSE;
+ if (((asc_dvc->init_state & ASC_INIT_STATE_END_LOAD_MC) == 0)
+ || (asc_dvc->isr_callback == 0)
+) {
+ return (ERR);
+ }
+ if (asc_dvc->in_critical_cnt != 0) {
+ AscSetLibErrorCode(asc_dvc, ASCQ_ERR_ISR_ON_CRITICAL);
+ return (ERR);
+ }
+ if (asc_dvc->is_in_int) {
+ AscSetLibErrorCode(asc_dvc, ASCQ_ERR_ISR_RE_ENTRY);
+ return (ERR);
+ }
+ asc_dvc->is_in_int = TRUE;
+ ctrl_reg = AscGetChipControl(iop_base);
+ saved_ctrl_reg = ctrl_reg & (~(CC_SCSI_RESET | CC_CHIP_RESET |
+ CC_SINGLE_STEP | CC_DIAG | CC_TEST));
+ chipstat = AscGetChipStatus(iop_base);
+ if (chipstat & CSW_SCSI_RESET_LATCH) {
+ if (!(asc_dvc->bus_type & (ASC_IS_VL | ASC_IS_EISA))) {
+ int_pending = TRUE;
+ asc_dvc->sdtr_done = 0;
+ saved_ctrl_reg &= (uchar) (~CC_HALT);
+ while (AscGetChipStatus(iop_base) & CSW_SCSI_RESET_ACTIVE) ;
+ AscSetChipControl(iop_base, (CC_CHIP_RESET | CC_HALT));
+ AscSetChipControl(iop_base, CC_HALT);
+ AscSetChipStatus(iop_base, CIW_CLR_SCSI_RESET_INT);
+ AscSetChipStatus(iop_base, 0);
+ chipstat = AscGetChipStatus(iop_base);
+ }
+ }
+ saved_ram_addr = AscGetChipLramAddr(iop_base);
+ host_flag = AscReadLramByte(iop_base,
+ ASCV_HOST_FLAG_B) & (uchar) (~ASC_HOST_FLAG_IN_ISR);
+ AscWriteLramByte(iop_base, ASCV_HOST_FLAG_B,
+ (uchar) (host_flag | (uchar) ASC_HOST_FLAG_IN_ISR));
#if CC_ASCISR_CHECK_INT_PENDING
- if ((chipstat & CSW_INT_PENDING)
- || (int_pending)
- ) {
- AscAckInterrupt(iop_base);
+ if ((chipstat & CSW_INT_PENDING)
+ || (int_pending)
+) {
+ AscAckInterrupt(iop_base);
#endif
- int_pending = TRUE;
- if ((chipstat & CSW_HALTED) &&
- (ctrl_reg & CC_SINGLE_STEP)) {
- if (AscIsrChipHalted(asc_dvc) == ERR) {
- goto ISR_REPORT_QDONE_FATAL_ERROR;
- } else {
- saved_ctrl_reg &= (uchar) (~CC_HALT);
- }
- } else {
- ISR_REPORT_QDONE_FATAL_ERROR:
- if ((asc_dvc->dvc_cntl & ASC_CNTL_INT_MULTI_Q) != 0) {
- while (((status = AscIsrQDone(asc_dvc)) & 0x01) != 0) {
- }
- } else {
- do {
- if ((status = AscIsrQDone(asc_dvc)) == 1) {
- break;
- }
- } while (status == 0x11);
- }
- if ((status & 0x80) != 0)
- int_pending = ERR;
- }
+ int_pending = TRUE;
+ if ((chipstat & CSW_HALTED) &&
+ (ctrl_reg & CC_SINGLE_STEP)) {
+ if (AscIsrChipHalted(asc_dvc) == ERR) {
+ goto ISR_REPORT_QDONE_FATAL_ERROR;
+ } else {
+ saved_ctrl_reg &= (uchar) (~CC_HALT);
+ }
+ } else {
+ ISR_REPORT_QDONE_FATAL_ERROR:
+ if ((asc_dvc->dvc_cntl & ASC_CNTL_INT_MULTI_Q) != 0) {
+ while (((status = AscIsrQDone(asc_dvc)) & 0x01) != 0) {
+ }
+ } else {
+ do {
+ if ((status = AscIsrQDone(asc_dvc)) == 1) {
+ break;
+ }
+ } while (status == 0x11);
+ }
+ if ((status & 0x80) != 0)
+ int_pending = ERR;
+ }
#if CC_ASCISR_CHECK_INT_PENDING
- }
+ }
#endif
- AscWriteLramByte(iop_base, ASCV_HOST_FLAG_B, host_flag);
- AscSetChipLramAddr(iop_base, saved_ram_addr);
- AscSetChipControl(iop_base, saved_ctrl_reg);
- asc_dvc->is_in_int = FALSE;
- return (int_pending);
+ AscWriteLramByte(iop_base, ASCV_HOST_FLAG_B, host_flag);
+ AscSetChipLramAddr(iop_base, saved_ram_addr);
+ AscSetChipControl(iop_base, saved_ctrl_reg);
+ asc_dvc->is_in_int = FALSE;
+ return (int_pending);
}
-int
+STATIC int
AscScsiSetupCmdQ(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_REQ_Q dosfar * scsiq,
- uchar dosfar * buf_addr,
- ulong buf_len
-)
-{
- ulong phy_addr;
- scsiq->r1.cntl = 0;
- scsiq->r1.sg_queue_cnt = 0;
- scsiq->r1.q_no = 0;
- scsiq->r1.extra_bytes = 0;
- scsiq->r3.scsi_stat = 0;
- scsiq->r3.scsi_msg = 0;
- scsiq->r3.host_stat = 0;
- scsiq->r3.done_stat = 0;
- scsiq->r2.vm_id = 0;
- scsiq->r1.data_cnt = buf_len;
- scsiq->cdbptr = (uchar dosfar *) scsiq->cdb;
- scsiq->sense_ptr = (uchar dosfar *) scsiq->sense ;
- scsiq->r1.sense_len = ASC_MIN_SENSE_LEN ;
- scsiq->r2.tag_code = (uchar) M2_QTAG_MSG_SIMPLE;
- scsiq->r2.flag = (uchar) ASC_FLAG_SCSIQ_REQ;
- scsiq->r2.srb_ptr = (ulong) scsiq;
- scsiq->r1.status = (uchar) QS_READY;
- scsiq->r1.data_addr = 0L;
- if (buf_len != 0L) {
- if ((phy_addr = AscGetOnePhyAddr(asc_dvc,
- (uchar dosfar *) buf_addr, scsiq->r1.data_cnt)) == 0L) {
- return (ERR);
- }
- scsiq->r1.data_addr = phy_addr;
- }
- if ((phy_addr = AscGetOnePhyAddr(asc_dvc,
- (uchar dosfar *) scsiq->sense_ptr,
- (ulong) scsiq->r1.sense_len )) == 0L) {
- return (ERR);
- }
- scsiq->r1.sense_addr = phy_addr ;
- return (0);
-}
-
-uchar _mcode_buf[ ] __initdata = {
- 0x01, 0x03, 0x01, 0x19, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x0F, 0x0F, 0x0F, 0x0F, 0x0F, 0x0F, 0x0F, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0x10, 0x0D, 0x09, 0x05, 0x01, 0x00, 0x00, 0x00, 0x00, 0xFF, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x00, 0xFF, 0x80, 0xFF, 0xFF, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
- 0x00, 0x00, 0x00, 0x23, 0x00, 0x21, 0x00, 0x00, 0x00, 0x07, 0x00, 0xFF, 0x00, 0x00, 0x00, 0x00,
- 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xDC, 0x88, 0x00, 0x00, 0x00, 0x00,
- 0x80, 0x73, 0x48, 0x04, 0x36, 0x00, 0x00, 0xA2, 0xC2, 0x00, 0x80, 0x73, 0x03, 0x23, 0x36, 0x40,
- 0xB6, 0x00, 0x36, 0x00, 0x05, 0xD6, 0x0C, 0xD2, 0x12, 0xDA, 0x00, 0xA2, 0xC2, 0x00, 0x92, 0x80,
- 0x18, 0x98, 0x50, 0x00, 0xF5, 0x00, 0x42, 0x98, 0xDF, 0x23, 0x36, 0x60, 0xB6, 0x00, 0x92, 0x80,
- 0x4F, 0x00, 0xF5, 0x00, 0x42, 0x98, 0xEF, 0x23, 0x36, 0x60, 0xB6, 0x00, 0x92, 0x80, 0x80, 0x62,
- 0x92, 0x80, 0x00, 0x46, 0x17, 0xEE, 0x13, 0xEA, 0x02, 0x01, 0x09, 0xD8, 0xCD, 0x04, 0x4D, 0x00,
- 0x00, 0xA3, 0xD6, 0x00, 0xA0, 0x97, 0x7F, 0x23, 0x04, 0x61, 0x84, 0x01, 0xCC, 0x84, 0xD2, 0xC1,
- 0x80, 0x73, 0xCD, 0x04, 0x4D, 0x00, 0x00, 0xA3, 0xE2, 0x01, 0xA0, 0x97, 0xCE, 0x81, 0x00, 0x33,
- 0x02, 0x00, 0xBA, 0x88, 0x80, 0x73, 0x80, 0x77, 0x00, 0x01, 0x01, 0xA1, 0x02, 0x01, 0x4F, 0x00,
- 0x7E, 0x97, 0x07, 0xA6, 0x0C, 0x01, 0x00, 0x33, 0x03, 0x00, 0xBA, 0x88, 0x03, 0x03, 0x03, 0xDE,
- 0x00, 0x33, 0x05, 0x00, 0xBA, 0x88, 0xCE, 0x00, 0x69, 0x60, 0xCE, 0x00, 0x02, 0x03, 0x4A, 0x60,
- 0x00, 0xA2, 0x80, 0x01, 0x80, 0x63, 0x07, 0xA6, 0x2C, 0x01, 0x80, 0x81, 0x03, 0x03, 0x80, 0x63,
- 0xE2, 0x00, 0x07, 0xA6, 0x3C, 0x01, 0x00, 0x33, 0x04, 0x00, 0xBA, 0x88, 0x03, 0x07, 0x02, 0x01,
- 0x04, 0xCA, 0x0D, 0x23, 0x62, 0x98, 0x4D, 0x04, 0xEA, 0x84, 0x05, 0xD8, 0x0D, 0x23, 0x62, 0x98,
- 0xCD, 0x04, 0x15, 0x23, 0xF0, 0x88, 0xFB, 0x23, 0x02, 0x61, 0x82, 0x01, 0x80, 0x63, 0x02, 0x03,
- 0x06, 0xA3, 0x6A, 0x01, 0x00, 0x33, 0x0A, 0x00, 0xBA, 0x88, 0x4E, 0x00, 0x07, 0xA3, 0x76, 0x01,
- 0x00, 0x33, 0x0B, 0x00, 0xBA, 0x88, 0xCD, 0x04, 0x36, 0x2D, 0x00, 0x33, 0x1A, 0x00, 0xBA, 0x88,
- 0x50, 0x04, 0x90, 0x81, 0x06, 0xAB, 0x8A, 0x01, 0x90, 0x81, 0x4E, 0x00, 0x07, 0xA3, 0x9A, 0x01,
- 0x50, 0x00, 0x00, 0xA3, 0x44, 0x01, 0x00, 0x05, 0x84, 0x81, 0x40, 0x97, 0x02, 0x01, 0x05, 0xC6,
- 0x04, 0x23, 0xA0, 0x01, 0x15, 0x23, 0xA1, 0x01, 0xC6, 0x81, 0xFD, 0x23, 0x02, 0x61, 0x82, 0x01,
- 0x0A, 0xDA, 0x4A, 0x00, 0x06, 0x61, 0x00, 0xA0, 0xBC, 0x01, 0x80, 0x63, 0xCD, 0x04, 0x36, 0x2D,
- 0x00, 0x33, 0x1B, 0x00, 0xBA, 0x88, 0x06, 0x23, 0x62, 0x98, 0xCD, 0x04, 0xCC, 0x84, 0x06, 0x01,
- 0x00, 0xA2, 0xDC, 0x01, 0x57, 0x60, 0x00, 0xA0, 0xE2, 0x01, 0xCC, 0x84, 0x80, 0x23, 0xA0, 0x01,
- 0xCC, 0x84, 0x80, 0x73, 0x4B, 0x00, 0x06, 0x61, 0x00, 0xA2, 0x08, 0x02, 0x04, 0x01, 0x0C, 0xDE,
- 0x02, 0x01, 0x03, 0xCC, 0x4F, 0x00, 0x7E, 0x97, 0x04, 0x82, 0x08, 0x23, 0x02, 0x41, 0x82, 0x01,
- 0x4F, 0x00, 0x5C, 0x97, 0x48, 0x04, 0x84, 0x80, 0xEA, 0x97, 0x00, 0x46, 0x56, 0x00, 0x03, 0xC0,
- 0x01, 0x23, 0xE8, 0x00, 0x81, 0x73, 0x06, 0x29, 0x03, 0x42, 0x06, 0xE2, 0x03, 0xEE, 0x67, 0xEB,
- 0x11, 0x23, 0xF0, 0x88, 0xFE, 0x97, 0xF4, 0x80, 0x80, 0x73, 0x80, 0x77, 0x06, 0xA6, 0x36, 0x02,
- 0x00, 0x33, 0x31, 0x00, 0xBA, 0x88, 0x04, 0x01, 0x03, 0xD8, 0xAC, 0x98, 0x36, 0x96, 0x48, 0x82,
- 0xC6, 0x95, 0x80, 0x67, 0x83, 0x03, 0x80, 0x63, 0xB6, 0x2D, 0x02, 0xA6, 0x72, 0x02, 0x07, 0xA6,
- 0x60, 0x02, 0x06, 0xA6, 0x64, 0x02, 0x03, 0xA6, 0x68, 0x02, 0x00, 0x33, 0x10, 0x00, 0xBA, 0x88,
- 0x62, 0x95, 0x4A, 0x82, 0x2C, 0x96, 0x4A, 0x82, 0x04, 0x23, 0xA0, 0x01, 0x14, 0x23, 0xA1, 0x01,
- 0x22, 0x84, 0x04, 0x01, 0x0C, 0xDC, 0xE0, 0x23, 0x25, 0x61, 0xEF, 0x00, 0x14, 0x01, 0x4F, 0x04,
- 0xA8, 0x01, 0x6F, 0x00, 0xA5, 0x01, 0x03, 0x23, 0xA4, 0x01, 0x06, 0x23, 0x9C, 0x01, 0x24, 0x2B,
- 0x1C, 0x01, 0x02, 0xA6, 0xA4, 0x02, 0x07, 0xA6, 0x60, 0x02, 0x06, 0xA6, 0x64, 0x02, 0x00, 0x33,
- 0x12, 0x00, 0xBA, 0x88, 0x00, 0x0E, 0x80, 0x63, 0x00, 0x43, 0x00, 0xA0, 0x92, 0x02, 0x4D, 0x04,
- 0x04, 0x01, 0x0B, 0xDC, 0xE7, 0x23, 0x04, 0x61, 0x84, 0x01, 0x10, 0x31, 0x12, 0x35, 0x14, 0x01,
- 0xEC, 0x00, 0x6C, 0x38, 0x00, 0x3F, 0x00, 0x00, 0xE4, 0x82, 0x18, 0x23, 0x04, 0x61, 0x18, 0xA0,
- 0xDC, 0x02, 0x04, 0x01, 0x98, 0xC8, 0x00, 0x33, 0x1F, 0x00, 0xBA, 0x88, 0x08, 0x31, 0x0A, 0x35,
- 0x0C, 0x39, 0x0E, 0x3D, 0x78, 0x98, 0xB6, 0x2D, 0x01, 0xA6, 0x0E, 0x03, 0x00, 0xA6, 0x0E, 0x03,
- 0x07, 0xA6, 0x06, 0x03, 0x06, 0xA6, 0x0A, 0x03, 0x03, 0xA6, 0x06, 0x04, 0x02, 0xA6, 0x72, 0x02,
- 0x00, 0x33, 0x33, 0x00, 0xBA, 0x88, 0x62, 0x95, 0xE8, 0x82, 0x2C, 0x96, 0xE8, 0x82, 0x7C, 0x98,
- 0x80, 0x42, 0x78, 0x98, 0x60, 0xE4, 0x04, 0x01, 0x29, 0xC8, 0x31, 0x05, 0x07, 0x01, 0x00, 0xA2,
- 0x4E, 0x03, 0x00, 0x43, 0x87, 0x01, 0x05, 0x05, 0x80, 0x98, 0x78, 0x98, 0x00, 0xA6, 0x10, 0x03,
- 0x07, 0xA6, 0x46, 0x03, 0x03, 0xA6, 0x22, 0x04, 0x06, 0xA6, 0x4A, 0x03, 0x01, 0xA6, 0x10, 0x03,
- 0x00, 0x33, 0x25, 0x00, 0xBA, 0x88, 0x62, 0x95, 0x2C, 0x83, 0x2C, 0x96, 0x2C, 0x83, 0x04, 0x01,
- 0x0C, 0xCE, 0x03, 0xC8, 0x00, 0x33, 0x42, 0x00, 0xBA, 0x88, 0x00, 0x01, 0x05, 0x05, 0xFF, 0xA2,
- 0x6C, 0x03, 0xB1, 0x01, 0x08, 0x23, 0xB2, 0x01, 0x28, 0x83, 0x05, 0x05, 0x15, 0x01, 0x00, 0xA2,
- 0x8C, 0x03, 0xEC, 0x00, 0x6E, 0x00, 0x95, 0x01, 0x6C, 0x38, 0x00, 0x3F, 0x00, 0x00, 0x01, 0xA6,
- 0x88, 0x03, 0x00, 0xA6, 0x88, 0x03, 0xFC, 0x83, 0x80, 0x42, 0x78, 0x98, 0x01, 0xA6, 0x96, 0x03,
- 0x00, 0xA6, 0xAE, 0x03, 0xFC, 0x83, 0xA0, 0x98, 0x80, 0x42, 0x01, 0xA6, 0x96, 0x03, 0x07, 0xA6,
- 0xA4, 0x03, 0xC6, 0x83, 0x62, 0x95, 0x9A, 0x83, 0x00, 0x33, 0x2F, 0x00, 0xBA, 0x88, 0xA0, 0x98,
- 0x80, 0x42, 0x00, 0xA6, 0xAE, 0x03, 0x07, 0xA6, 0xBC, 0x03, 0xC6, 0x83, 0x62, 0x95, 0xB2, 0x83,
- 0x00, 0x33, 0x26, 0x00, 0xBA, 0x88, 0x38, 0x2B, 0x80, 0x32, 0x80, 0x36, 0x04, 0x23, 0xA0, 0x01,
- 0x12, 0x23, 0xA1, 0x01, 0xFC, 0x83, 0x04, 0xF0, 0x80, 0x6B, 0x00, 0x33, 0x20, 0x00, 0xBA, 0x88,
- 0x03, 0xA6, 0xFA, 0x03, 0x07, 0xA6, 0xF2, 0x03, 0x06, 0xA6, 0xF6, 0x03, 0x00, 0x33, 0x17, 0x00,
- 0xBA, 0x88, 0x62, 0x95, 0xE0, 0x83, 0x2C, 0x96, 0xE0, 0x83, 0x06, 0x84, 0x04, 0xF0, 0x80, 0x6B,
- 0x00, 0x33, 0x20, 0x00, 0xBA, 0x88, 0xB6, 0x2D, 0x03, 0xA6, 0x22, 0x04, 0x07, 0xA6, 0x1A, 0x04,
- 0x06, 0xA6, 0x1E, 0x04, 0x00, 0x33, 0x30, 0x00, 0xBA, 0x88, 0x62, 0x95, 0x06, 0x84, 0x2C, 0x96,
- 0x06, 0x84, 0x1D, 0x01, 0x06, 0xCC, 0x00, 0x33, 0x00, 0x84, 0xC0, 0x20, 0x00, 0x23, 0xEA, 0x00,
- 0x81, 0x62, 0xA2, 0x0D, 0x80, 0x63, 0x07, 0xA6, 0x40, 0x04, 0x00, 0x33, 0x18, 0x00, 0xBA, 0x88,
- 0x03, 0x03, 0x80, 0x63, 0xA3, 0x01, 0x07, 0xA4, 0x4A, 0x04, 0x23, 0x01, 0x00, 0xA2, 0x6C, 0x04,
- 0x0A, 0xA0, 0x5C, 0x04, 0xE0, 0x00, 0x00, 0x33, 0x1D, 0x00, 0xBA, 0x88, 0x0B, 0xA0, 0x68, 0x04,
- 0xE0, 0x00, 0x00, 0x33, 0x1E, 0x00, 0xBA, 0x88, 0x42, 0x23, 0xF0, 0x88, 0x00, 0x23, 0x22, 0xA3,
- 0xCC, 0x04, 0x08, 0x23, 0x22, 0xA3, 0x88, 0x04, 0x28, 0x23, 0x22, 0xA3, 0x94, 0x04, 0x02, 0x23,
- 0x22, 0xA3, 0xAA, 0x04, 0x42, 0x23, 0xF0, 0x88, 0x4A, 0x00, 0x06, 0x61, 0x00, 0xA0, 0x94, 0x04,
- 0x45, 0x23, 0xF0, 0x88, 0xFE, 0x97, 0x00, 0xA2, 0xA6, 0x04, 0xAC, 0x98, 0x00, 0x33, 0x00, 0x82,
- 0xC0, 0x20, 0x81, 0x62, 0xF0, 0x81, 0x47, 0x23, 0xF0, 0x88, 0x04, 0x01, 0x0B, 0xDE, 0xFE, 0x97,
- 0xAC, 0x98, 0x00, 0x33, 0x00, 0x81, 0xC0, 0x20, 0x81, 0x62, 0x14, 0x01, 0x00, 0xA0, 0x08, 0x02,
- 0x43, 0x23, 0xF0, 0x88, 0x04, 0x23, 0xA0, 0x01, 0x44, 0x23, 0xA1, 0x01, 0x80, 0x73, 0x4D, 0x00,
- 0x03, 0xA3, 0xDA, 0x04, 0x00, 0x33, 0x27, 0x00, 0xBA, 0x88, 0x04, 0x01, 0x04, 0xDC, 0x02, 0x23,
- 0xA2, 0x01, 0x04, 0x23, 0xA0, 0x01, 0xFE, 0x97, 0x0C, 0x95, 0x4B, 0x00, 0xF6, 0x00, 0x4F, 0x04,
- 0x4F, 0x00, 0x00, 0xA3, 0x08, 0x05, 0x00, 0x05, 0x76, 0x00, 0x06, 0x61, 0x00, 0xA2, 0x02, 0x05,
- 0xF0, 0x84, 0x40, 0x97, 0xCD, 0x04, 0x0A, 0x85, 0x48, 0x04, 0x84, 0x80, 0x02, 0x01, 0x03, 0xDA,
- 0x80, 0x23, 0x82, 0x01, 0x1A, 0x85, 0x02, 0x23, 0xA0, 0x01, 0x4A, 0x00, 0x06, 0x61, 0x00, 0xA2,
- 0x26, 0x05, 0x1D, 0x01, 0x04, 0xD6, 0xFF, 0x23, 0x86, 0x41, 0x4B, 0x60, 0xCB, 0x00, 0xFF, 0x23,
- 0x80, 0x01, 0x49, 0x00, 0x81, 0x01, 0x04, 0x01, 0x02, 0xC8, 0x30, 0x01, 0x80, 0x01, 0xF7, 0x04,
- 0x03, 0x01, 0x49, 0x04, 0x80, 0x01, 0xC9, 0x00, 0x00, 0x05, 0x00, 0x01, 0xFF, 0xA0, 0x46, 0x05,
- 0x77, 0x04, 0x01, 0x23, 0xEA, 0x00, 0x5D, 0x00, 0xFE, 0xC7, 0x00, 0x62, 0x00, 0x23, 0xEA, 0x00,
- 0x00, 0x63, 0x07, 0xA4, 0xC4, 0x05, 0x03, 0x03, 0x02, 0xA0, 0x74, 0x05, 0xC0, 0x85, 0x00, 0x33,
- 0x2D, 0x00, 0xBA, 0x88, 0x04, 0xA0, 0x9A, 0x05, 0x80, 0x63, 0x4A, 0x00, 0x06, 0x61, 0x00, 0xA2,
- 0x86, 0x05, 0x1D, 0x01, 0x06, 0xD6, 0x02, 0x23, 0x02, 0x41, 0x82, 0x01, 0x50, 0x00, 0x5C, 0x97,
- 0xEA, 0x84, 0x04, 0x23, 0x02, 0x41, 0x82, 0x01, 0xEA, 0x84, 0x08, 0xA0, 0xA0, 0x05, 0xC0, 0x85,
- 0x03, 0xA0, 0xA6, 0x05, 0xC0, 0x85, 0x01, 0xA0, 0xB2, 0x05, 0x88, 0x00, 0x80, 0x63, 0xB0, 0x96,
- 0x62, 0x85, 0x07, 0xA0, 0xBE, 0x05, 0x06, 0x23, 0x62, 0x98, 0x48, 0x23, 0xF0, 0x88, 0xC0, 0x86,
- 0x80, 0x63, 0x62, 0x85, 0x00, 0x63, 0x4A, 0x00, 0x06, 0x61, 0x00, 0xA2, 0x02, 0x06, 0x1D, 0x01,
- 0x18, 0xD4, 0xC0, 0x23, 0x07, 0x41, 0x83, 0x03, 0x80, 0x63, 0x06, 0xA6, 0xE4, 0x05, 0x00, 0x33,
- 0x37, 0x00, 0xBA, 0x88, 0x1D, 0x01, 0x02, 0xD6, 0x46, 0x23, 0xF0, 0x88, 0x63, 0x60, 0x83, 0x03,
- 0x80, 0x63, 0x06, 0xA6, 0xFC, 0x05, 0x00, 0x33, 0x38, 0x00, 0xBA, 0x88, 0xEF, 0x04, 0x6F, 0x00,
- 0x00, 0x63, 0x4B, 0x00, 0x06, 0x41, 0xCB, 0x00, 0x52, 0x00, 0x06, 0x61, 0x00, 0xA2, 0x1A, 0x06,
- 0x1D, 0x01, 0x03, 0xCA, 0xC0, 0x23, 0x07, 0x41, 0x00, 0x63, 0x1D, 0x01, 0x04, 0xCC, 0x00, 0x33,
- 0x00, 0x83, 0xC0, 0x20, 0x81, 0x62, 0x80, 0x23, 0x07, 0x41, 0x00, 0x63, 0x80, 0x67, 0x08, 0x23,
- 0x83, 0x03, 0x80, 0x63, 0x00, 0x63, 0x06, 0xA6, 0x48, 0x06, 0x07, 0xA6, 0x9C, 0x06, 0x02, 0xA6,
- 0xF4, 0x06, 0x00, 0x33, 0x39, 0x00, 0xBA, 0x88, 0x00, 0x00, 0x01, 0xA0, 0x0E, 0x07, 0xC6, 0x95,
- 0x83, 0x03, 0x80, 0x63, 0x06, 0xA6, 0x5C, 0x06, 0x07, 0xA6, 0x9C, 0x06, 0x00, 0x00, 0x01, 0xA0,
- 0x0E, 0x07, 0x00, 0x2B, 0x40, 0x0E, 0x80, 0x63, 0x01, 0x00, 0x06, 0xA6, 0x78, 0x06, 0x07, 0xA6,
- 0x9C, 0x06, 0x00, 0x33, 0x3A, 0x00, 0xBA, 0x88, 0x40, 0x0E, 0x80, 0x63, 0x00, 0x43, 0x00, 0xA0,
- 0x6A, 0x06, 0x06, 0xA6, 0x90, 0x06, 0x07, 0xA6, 0x9C, 0x06, 0x00, 0x33, 0x3B, 0x00, 0xBA, 0x88,
- 0x80, 0x67, 0x40, 0x0E, 0x80, 0x63, 0x07, 0xA6, 0x9C, 0x06, 0x00, 0x63, 0x03, 0x03, 0x80, 0x63,
- 0x88, 0x00, 0x01, 0xA2, 0xB0, 0x06, 0x07, 0xA2, 0xF4, 0x06, 0x00, 0x33, 0x35, 0x00, 0xBA, 0x88,
- 0x07, 0xA6, 0xBA, 0x06, 0x00, 0x33, 0x2A, 0x00, 0xBA, 0x88, 0x03, 0x03, 0x03, 0xA2, 0xC6, 0x06,
- 0x07, 0x23, 0x80, 0x00, 0x00, 0x87, 0x80, 0x63, 0x89, 0x00, 0x0A, 0x2B, 0x07, 0xA6, 0xD6, 0x06,
- 0x00, 0x33, 0x29, 0x00, 0xBA, 0x88, 0x00, 0x43, 0x00, 0xA2, 0xE2, 0x06, 0xC0, 0x0E, 0x80, 0x63,
- 0xCC, 0x86, 0xC0, 0x0E, 0x00, 0x33, 0x00, 0x80, 0xC0, 0x20, 0x81, 0x62, 0x04, 0x01, 0x08, 0xDA,
- 0x80, 0x63, 0x00, 0x63, 0x80, 0x67, 0x00, 0x33, 0x00, 0x40, 0xC0, 0x20, 0x81, 0x62, 0x00, 0x63,
- 0x80, 0x7B, 0x80, 0x63, 0x06, 0xA6, 0x54, 0x06, 0x00, 0x33, 0x2C, 0x00, 0xBA, 0x88, 0x0C, 0xA2,
- 0x28, 0x07, 0xC6, 0x95, 0x83, 0x03, 0x80, 0x63, 0x06, 0xA6, 0x26, 0x07, 0x07, 0xA6, 0x9C, 0x06,
- 0x00, 0x33, 0x3D, 0x00, 0xBA, 0x88, 0x00, 0x00, 0x80, 0x67, 0x83, 0x03, 0x80, 0x63, 0x0C, 0xA0,
- 0x3E, 0x07, 0x07, 0xA6, 0x9C, 0x06, 0xBF, 0x23, 0x04, 0x61, 0x84, 0x01, 0xCC, 0x84, 0x00, 0x63,
- 0xF0, 0x04, 0x01, 0x01, 0xF1, 0x00, 0x00, 0x01, 0xF2, 0x00, 0x01, 0x05, 0x80, 0x01, 0x72, 0x04,
- 0x71, 0x00, 0x81, 0x01, 0x70, 0x04, 0x80, 0x05, 0x81, 0x05, 0x00, 0x63, 0xF0, 0x04, 0xF2, 0x00,
- 0x72, 0x04, 0x01, 0x01, 0xF1, 0x00, 0x70, 0x00, 0x81, 0x01, 0x70, 0x04, 0x71, 0x00, 0x81, 0x01,
- 0x72, 0x00, 0x80, 0x01, 0x71, 0x04, 0x70, 0x00, 0x80, 0x01, 0x70, 0x04, 0x00, 0x63, 0xF0, 0x04,
- 0xF2, 0x00, 0x72, 0x04, 0x00, 0x01, 0xF1, 0x00, 0x70, 0x00, 0x80, 0x01, 0x70, 0x04, 0x71, 0x00,
- 0x80, 0x01, 0x72, 0x00, 0x81, 0x01, 0x71, 0x04, 0x70, 0x00, 0x81, 0x01, 0x70, 0x04, 0x00, 0x63,
- 0x00, 0x23, 0xB3, 0x01, 0x83, 0x05, 0xA3, 0x01, 0xA2, 0x01, 0xA1, 0x01, 0x01, 0x23, 0xA0, 0x01,
- 0x00, 0x01, 0xC8, 0x00, 0x03, 0xA1, 0xBE, 0x07, 0x00, 0x33, 0x07, 0x00, 0xBA, 0x88, 0x80, 0x05,
- 0x81, 0x05, 0x04, 0x01, 0x11, 0xC8, 0x48, 0x00, 0xB0, 0x01, 0xB1, 0x01, 0x08, 0x23, 0xB2, 0x01,
- 0x05, 0x01, 0x48, 0x04, 0x00, 0x43, 0x00, 0xA2, 0xDE, 0x07, 0x00, 0x05, 0xD4, 0x87, 0x00, 0x01,
- 0xC8, 0x00, 0xFF, 0x23, 0x80, 0x01, 0x05, 0x05, 0x00, 0x63, 0xF7, 0x04, 0x1A, 0x09, 0xF6, 0x08,
- 0x6E, 0x04, 0x00, 0x02, 0x80, 0x43, 0x76, 0x08, 0x80, 0x02, 0x77, 0x04, 0x00, 0x63, 0xF7, 0x04,
- 0x1A, 0x09, 0xF6, 0x08, 0x6E, 0x04, 0x00, 0x02, 0x00, 0xA0, 0x0E, 0x08, 0x10, 0x88, 0x00, 0x43,
- 0x76, 0x08, 0x80, 0x02, 0x77, 0x04, 0x00, 0x63, 0xF3, 0x04, 0x00, 0x23, 0xF4, 0x00, 0x74, 0x00,
- 0x80, 0x43, 0xF4, 0x00, 0xCF, 0x40, 0x00, 0xA2, 0x3E, 0x08, 0x74, 0x04, 0x02, 0x01, 0xF7, 0xC9,
- 0xF6, 0xD9, 0x00, 0x01, 0x01, 0xA1, 0x1E, 0x08, 0xFE, 0x97, 0x0C, 0x95, 0x1E, 0x88, 0x73, 0x04,
- 0x00, 0x63, 0xF3, 0x04, 0x75, 0x04, 0x54, 0x88, 0x02, 0x01, 0x04, 0xD8, 0x40, 0x97, 0xFE, 0x97,
- 0x0C, 0x95, 0x44, 0x88, 0x75, 0x00, 0x00, 0xA3, 0x5E, 0x08, 0x00, 0x05, 0x48, 0x88, 0x73, 0x04,
- 0x00, 0x63, 0x80, 0x7B, 0x80, 0x63, 0x06, 0xA6, 0x70, 0x08, 0x00, 0x33, 0x3E, 0x00, 0xBA, 0x88,
- 0x80, 0x67, 0x83, 0x03, 0x80, 0x63, 0x00, 0x63, 0x38, 0x2B, 0x96, 0x88, 0x38, 0x2B, 0x8C, 0x88,
- 0x32, 0x09, 0x31, 0x05, 0x8C, 0x98, 0x05, 0x05, 0xB2, 0x09, 0x00, 0x63, 0x00, 0x32, 0x00, 0x36,
- 0x00, 0x3A, 0x00, 0x3E, 0x00, 0x63, 0x80, 0x32, 0x80, 0x36, 0x80, 0x3A, 0x80, 0x3E, 0x00, 0x63,
- 0x38, 0x2B, 0x40, 0x32, 0x40, 0x36, 0x40, 0x3A, 0x40, 0x3E, 0x00, 0x63, 0x5A, 0x20, 0xC9, 0x40,
- 0x00, 0xA0, 0xAC, 0x08, 0x5D, 0x00, 0xFE, 0xC3, 0x00, 0x63, 0x80, 0x73, 0xE6, 0x20, 0x02, 0x23,
- 0xE8, 0x00, 0x82, 0x73, 0xFF, 0xFD, 0x80, 0x73, 0x13, 0x23, 0xF0, 0x88, 0x66, 0x20, 0xC0, 0x20,
- 0x04, 0x23, 0xA0, 0x01, 0xA1, 0x23, 0xA1, 0x01, 0x81, 0x62, 0xDA, 0x88, 0x80, 0x73, 0x80, 0x77,
- 0x68, 0x00, 0x00, 0xA2, 0x80, 0x00, 0x03, 0xC2, 0xF1, 0xC7, 0x41, 0x23, 0xF0, 0x88, 0x11, 0x23,
- 0xA1, 0x01, 0x04, 0x23, 0xA0, 0x01, 0xCC, 0x84,
-} ;
-
-ushort _mcode_size = sizeof(_mcode_buf);
-ulong _mcode_chksum = 0x012BA2FAUL ;
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_REQ_Q * scsiq,
+ uchar * buf_addr,
+ ulong buf_len
+)
+{
+ ulong phy_addr;
+ scsiq->r1.cntl = 0;
+ scsiq->r1.sg_queue_cnt = 0;
+ scsiq->r1.q_no = 0;
+ scsiq->r1.extra_bytes = 0;
+ scsiq->r3.scsi_stat = 0;
+ scsiq->r3.scsi_msg = 0;
+ scsiq->r3.host_stat = 0;
+ scsiq->r3.done_stat = 0;
+ scsiq->r2.vm_id = 0;
+ scsiq->r1.data_cnt = buf_len;
+ scsiq->cdbptr = (uchar *) scsiq->cdb;
+ scsiq->sense_ptr = (uchar *) scsiq->sense ;
+ scsiq->r1.sense_len = ASC_MIN_SENSE_LEN ;
+ scsiq->r2.tag_code = (uchar) M2_QTAG_MSG_SIMPLE;
+ scsiq->r2.flag = (uchar) ASC_FLAG_SCSIQ_REQ;
+ scsiq->r2.srb_ptr = (ulong) scsiq;
+ scsiq->r1.status = (uchar) QS_READY;
+ scsiq->r1.data_addr = 0L;
+ if (buf_len != 0L) {
+ if ((phy_addr = AscGetOnePhyAddr(asc_dvc,
+ (uchar *) buf_addr, scsiq->r1.data_cnt)) == 0L) {
+ return (ERR);
+ }
+ scsiq->r1.data_addr = phy_addr;
+ }
+ if ((phy_addr = AscGetOnePhyAddr(asc_dvc,
+ (uchar *) scsiq->sense_ptr,
+ (ulong) scsiq->r1.sense_len)) == 0L) {
+ return (ERR);
+ }
+ scsiq->r1.sense_addr = phy_addr ;
+ return (0);
+}
+
+STATIC uchar _mcode_buf[] ASC_INITDATA =
+{
+ 0x01, 0x03, 0x01, 0x19, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x0F, 0x0F, 0x0F, 0x0F, 0x0F, 0x0F, 0x0F, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x00, 0x79, 0x0D, 0x09, 0x05, 0x01, 0x00, 0x00, 0x00, 0x00, 0xFF, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x00, 0xFF, 0x80, 0xFF, 0xFF, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+ 0x00, 0x00, 0x00, 0x23, 0x00, 0x22, 0x00, 0x00, 0x00, 0x07, 0x00, 0xFF, 0x00, 0x00, 0x00, 0x00,
+ 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xCC, 0x88, 0x00, 0x00, 0x00, 0x00,
+ 0x80, 0x73, 0x48, 0x04, 0x36, 0x00, 0x00, 0xA2, 0xC2, 0x00, 0x80, 0x73, 0x03, 0x23, 0x36, 0x40,
+ 0xB6, 0x00, 0x36, 0x00, 0x05, 0xD6, 0x0C, 0xD2, 0x12, 0xDA, 0x00, 0xA2, 0xC2, 0x00, 0x92, 0x80,
+ 0x08, 0x98, 0x50, 0x00, 0xF5, 0x00, 0x32, 0x98, 0xDF, 0x23, 0x36, 0x60, 0xB6, 0x00, 0x92, 0x80,
+ 0x4F, 0x00, 0xF5, 0x00, 0x32, 0x98, 0xEF, 0x23, 0x36, 0x60, 0xB6, 0x00, 0x92, 0x80, 0x80, 0x62,
+ 0x92, 0x80, 0x00, 0x46, 0x17, 0xEE, 0x13, 0xEA, 0x02, 0x01, 0x09, 0xD8, 0xCD, 0x04, 0x4D, 0x00,
+ 0x00, 0xA3, 0xD6, 0x00, 0x90, 0x97, 0x7F, 0x23, 0x04, 0x61, 0x84, 0x01, 0xD8, 0x84, 0xD2, 0xC1,
+ 0x80, 0x73, 0xCD, 0x04, 0x4D, 0x00, 0x00, 0xA3, 0xE2, 0x01, 0x90, 0x97, 0xCE, 0x81, 0x00, 0x33,
+ 0x02, 0x00, 0xAA, 0x88, 0x80, 0x73, 0x80, 0x77, 0x00, 0x01, 0x01, 0xA1, 0x02, 0x01, 0x4F, 0x00,
+ 0x6E, 0x97, 0x07, 0xA6, 0x0C, 0x01, 0x00, 0x33, 0x03, 0x00, 0xAA, 0x88, 0x03, 0x03, 0x03, 0xDE,
+ 0x00, 0x33, 0x05, 0x00, 0xAA, 0x88, 0xCE, 0x00, 0x69, 0x60, 0xCE, 0x00, 0x02, 0x03, 0x4A, 0x60,
+ 0x00, 0xA2, 0x80, 0x01, 0x80, 0x63, 0x07, 0xA6, 0x2C, 0x01, 0x80, 0x81, 0x03, 0x03, 0x80, 0x63,
+ 0xE2, 0x00, 0x07, 0xA6, 0x3C, 0x01, 0x00, 0x33, 0x04, 0x00, 0xAA, 0x88, 0x03, 0x07, 0x02, 0x01,
+ 0x04, 0xCA, 0x0D, 0x23, 0x52, 0x98, 0x4D, 0x04, 0xF6, 0x84, 0x05, 0xD8, 0x0D, 0x23, 0x52, 0x98,
+ 0xCD, 0x04, 0x15, 0x23, 0xE0, 0x88, 0xFB, 0x23, 0x02, 0x61, 0x82, 0x01, 0x80, 0x63, 0x02, 0x03,
+ 0x06, 0xA3, 0x6A, 0x01, 0x00, 0x33, 0x0A, 0x00, 0xAA, 0x88, 0x4E, 0x00, 0x07, 0xA3, 0x76, 0x01,
+ 0x00, 0x33, 0x0B, 0x00, 0xAA, 0x88, 0xCD, 0x04, 0x36, 0x2D, 0x00, 0x33, 0x1A, 0x00, 0xAA, 0x88,
+ 0x50, 0x04, 0x90, 0x81, 0x06, 0xAB, 0x8A, 0x01, 0x90, 0x81, 0x4E, 0x00, 0x07, 0xA3, 0x9A, 0x01,
+ 0x50, 0x00, 0x00, 0xA3, 0x44, 0x01, 0x00, 0x05, 0x84, 0x81, 0x30, 0x97, 0x02, 0x01, 0x05, 0xC6,
+ 0x04, 0x23, 0xA0, 0x01, 0x15, 0x23, 0xA1, 0x01, 0xC6, 0x81, 0xFD, 0x23, 0x02, 0x61, 0x82, 0x01,
+ 0x0A, 0xDA, 0x4A, 0x00, 0x06, 0x61, 0x00, 0xA0, 0xBC, 0x01, 0x80, 0x63, 0xCD, 0x04, 0x36, 0x2D,
+ 0x00, 0x33, 0x1B, 0x00, 0xAA, 0x88, 0x06, 0x23, 0x52, 0x98, 0xCD, 0x04, 0xD8, 0x84, 0x06, 0x01,
+ 0x00, 0xA2, 0xDC, 0x01, 0x57, 0x60, 0x00, 0xA0, 0xE2, 0x01, 0xD8, 0x84, 0x80, 0x23, 0xA0, 0x01,
+ 0xD8, 0x84, 0x80, 0x73, 0x4B, 0x00, 0x06, 0x61, 0x00, 0xA2, 0x08, 0x02, 0x04, 0x01, 0x0C, 0xDE,
+ 0x02, 0x01, 0x03, 0xCC, 0x4F, 0x00, 0x6E, 0x97, 0x04, 0x82, 0x08, 0x23, 0x02, 0x41, 0x82, 0x01,
+ 0x4F, 0x00, 0x4C, 0x97, 0x48, 0x04, 0x84, 0x80, 0xDA, 0x97, 0x00, 0x46, 0x56, 0x00, 0x03, 0xC0,
+ 0x01, 0x23, 0xE8, 0x00, 0x81, 0x73, 0x06, 0x29, 0x03, 0x42, 0x06, 0xE2, 0x03, 0xEE, 0x67, 0xEB,
+ 0x11, 0x23, 0xE0, 0x88, 0xEE, 0x97, 0xF4, 0x80, 0x80, 0x73, 0x80, 0x77, 0x06, 0xA6, 0x36, 0x02,
+ 0x00, 0x33, 0x31, 0x00, 0xAA, 0x88, 0x04, 0x01, 0x03, 0xD8, 0x9C, 0x98, 0x44, 0x96, 0x48, 0x82,
+ 0xD4, 0x95, 0x80, 0x67, 0x83, 0x03, 0x80, 0x63, 0xB6, 0x2D, 0x02, 0xA6, 0x72, 0x02, 0x07, 0xA6,
+ 0x60, 0x02, 0x06, 0xA6, 0x64, 0x02, 0x03, 0xA6, 0x68, 0x02, 0x00, 0x33, 0x10, 0x00, 0xAA, 0x88,
+ 0x6E, 0x95, 0x4A, 0x82, 0x3A, 0x96, 0x4A, 0x82, 0x04, 0x23, 0xA0, 0x01, 0x14, 0x23, 0xA1, 0x01,
+ 0x2E, 0x84, 0x04, 0x01, 0x0C, 0xDC, 0xE0, 0x23, 0x25, 0x61, 0xEF, 0x00, 0x14, 0x01, 0x4F, 0x04,
+ 0xA8, 0x01, 0x6F, 0x00, 0xA5, 0x01, 0x03, 0x23, 0xA4, 0x01, 0x06, 0x23, 0x9C, 0x01, 0x24, 0x2B,
+ 0x1C, 0x01, 0x02, 0xA6, 0xB0, 0x02, 0x07, 0xA6, 0x60, 0x02, 0x06, 0xA6, 0x64, 0x02, 0x03, 0xA6,
+ 0x12, 0x04, 0x01, 0xA6, 0xBA, 0x02, 0x00, 0xA6, 0xBA, 0x02, 0x00, 0x33, 0x12, 0x00, 0xAA, 0x88,
+ 0x00, 0x0E, 0x80, 0x63, 0x00, 0x43, 0x00, 0xA0, 0x92, 0x02, 0x4D, 0x04, 0x04, 0x01, 0x0B, 0xDC,
+ 0xE7, 0x23, 0x04, 0x61, 0x84, 0x01, 0x10, 0x31, 0x12, 0x35, 0x14, 0x01, 0xEC, 0x00, 0x6C, 0x38,
+ 0x00, 0x3F, 0x00, 0x00, 0xF0, 0x82, 0x18, 0x23, 0x04, 0x61, 0x18, 0xA0, 0xE8, 0x02, 0x04, 0x01,
+ 0x98, 0xC8, 0x00, 0x33, 0x1F, 0x00, 0xAA, 0x88, 0x08, 0x31, 0x0A, 0x35, 0x0C, 0x39, 0x0E, 0x3D,
+ 0x68, 0x98, 0xB6, 0x2D, 0x01, 0xA6, 0x1A, 0x03, 0x00, 0xA6, 0x1A, 0x03, 0x07, 0xA6, 0x12, 0x03,
+ 0x06, 0xA6, 0x16, 0x03, 0x03, 0xA6, 0x12, 0x04, 0x02, 0xA6, 0x72, 0x02, 0x00, 0x33, 0x33, 0x00,
+ 0xAA, 0x88, 0x6E, 0x95, 0xF4, 0x82, 0x3A, 0x96, 0xF4, 0x82, 0x6C, 0x98, 0x80, 0x42, 0x68, 0x98,
+ 0x60, 0xE4, 0x04, 0x01, 0x29, 0xC8, 0x31, 0x05, 0x07, 0x01, 0x00, 0xA2, 0x5A, 0x03, 0x00, 0x43,
+ 0x87, 0x01, 0x05, 0x05, 0x70, 0x98, 0x68, 0x98, 0x00, 0xA6, 0x1C, 0x03, 0x07, 0xA6, 0x52, 0x03,
+ 0x03, 0xA6, 0x2E, 0x04, 0x06, 0xA6, 0x56, 0x03, 0x01, 0xA6, 0x1C, 0x03, 0x00, 0x33, 0x25, 0x00,
+ 0xAA, 0x88, 0x6E, 0x95, 0x38, 0x83, 0x3A, 0x96, 0x38, 0x83, 0x04, 0x01, 0x0C, 0xCE, 0x03, 0xC8,
+ 0x00, 0x33, 0x42, 0x00, 0xAA, 0x88, 0x00, 0x01, 0x05, 0x05, 0xFF, 0xA2, 0x78, 0x03, 0xB1, 0x01,
+ 0x08, 0x23, 0xB2, 0x01, 0x34, 0x83, 0x05, 0x05, 0x15, 0x01, 0x00, 0xA2, 0x98, 0x03, 0xEC, 0x00,
+ 0x6E, 0x00, 0x95, 0x01, 0x6C, 0x38, 0x00, 0x3F, 0x00, 0x00, 0x01, 0xA6, 0x94, 0x03, 0x00, 0xA6,
+ 0x94, 0x03, 0x08, 0x84, 0x80, 0x42, 0x68, 0x98, 0x01, 0xA6, 0xA2, 0x03, 0x00, 0xA6, 0xBA, 0x03,
+ 0x08, 0x84, 0x90, 0x98, 0x80, 0x42, 0x01, 0xA6, 0xA2, 0x03, 0x07, 0xA6, 0xB0, 0x03, 0xD2, 0x83,
+ 0x6E, 0x95, 0xA6, 0x83, 0x00, 0x33, 0x2F, 0x00, 0xAA, 0x88, 0x90, 0x98, 0x80, 0x42, 0x00, 0xA6,
+ 0xBA, 0x03, 0x07, 0xA6, 0xC8, 0x03, 0xD2, 0x83, 0x6E, 0x95, 0xBE, 0x83, 0x00, 0x33, 0x26, 0x00,
+ 0xAA, 0x88, 0x38, 0x2B, 0x80, 0x32, 0x80, 0x36, 0x04, 0x23, 0xA0, 0x01, 0x12, 0x23, 0xA1, 0x01,
+ 0x08, 0x84, 0x04, 0xF0, 0x80, 0x6B, 0x00, 0x33, 0x20, 0x00, 0xAA, 0x88, 0x03, 0xA6, 0x06, 0x04,
+ 0x07, 0xA6, 0xFE, 0x03, 0x06, 0xA6, 0x02, 0x04, 0x00, 0x33, 0x17, 0x00, 0xAA, 0x88, 0x6E, 0x95,
+ 0xEC, 0x83, 0x3A, 0x96, 0xEC, 0x83, 0x12, 0x84, 0x04, 0xF0, 0x80, 0x6B, 0x00, 0x33, 0x20, 0x00,
+ 0xAA, 0x88, 0xB6, 0x2D, 0x03, 0xA6, 0x2E, 0x04, 0x07, 0xA6, 0x26, 0x04, 0x06, 0xA6, 0x2A, 0x04,
+ 0x00, 0x33, 0x30, 0x00, 0xAA, 0x88, 0x6E, 0x95, 0x12, 0x84, 0x3A, 0x96, 0x12, 0x84, 0x1D, 0x01,
+ 0x06, 0xCC, 0x00, 0x33, 0x00, 0x84, 0xC0, 0x20, 0x00, 0x23, 0xEA, 0x00, 0x81, 0x62, 0xA2, 0x0D,
+ 0x80, 0x63, 0x07, 0xA6, 0x4C, 0x04, 0x00, 0x33, 0x18, 0x00, 0xAA, 0x88, 0x03, 0x03, 0x80, 0x63,
+ 0xA3, 0x01, 0x07, 0xA4, 0x56, 0x04, 0x23, 0x01, 0x00, 0xA2, 0x78, 0x04, 0x0A, 0xA0, 0x68, 0x04,
+ 0xE0, 0x00, 0x00, 0x33, 0x1D, 0x00, 0xAA, 0x88, 0x0B, 0xA0, 0x74, 0x04, 0xE0, 0x00, 0x00, 0x33,
+ 0x1E, 0x00, 0xAA, 0x88, 0x42, 0x23, 0xE0, 0x88, 0x00, 0x23, 0x22, 0xA3, 0xD8, 0x04, 0x08, 0x23,
+ 0x22, 0xA3, 0x94, 0x04, 0x28, 0x23, 0x22, 0xA3, 0xA0, 0x04, 0x02, 0x23, 0x22, 0xA3, 0xB6, 0x04,
+ 0x42, 0x23, 0xE0, 0x88, 0x4A, 0x00, 0x06, 0x61, 0x00, 0xA0, 0xA0, 0x04, 0x45, 0x23, 0xE0, 0x88,
+ 0xEE, 0x97, 0x00, 0xA2, 0xB2, 0x04, 0x9C, 0x98, 0x00, 0x33, 0x00, 0x82, 0xC0, 0x20, 0x81, 0x62,
+ 0xF0, 0x81, 0x47, 0x23, 0xE0, 0x88, 0x04, 0x01, 0x0B, 0xDE, 0xEE, 0x97, 0x9C, 0x98, 0x00, 0x33,
+ 0x00, 0x81, 0xC0, 0x20, 0x81, 0x62, 0x14, 0x01, 0x00, 0xA0, 0x08, 0x02, 0x43, 0x23, 0xE0, 0x88,
+ 0x04, 0x23, 0xA0, 0x01, 0x44, 0x23, 0xA1, 0x01, 0x80, 0x73, 0x4D, 0x00, 0x03, 0xA3, 0xE6, 0x04,
+ 0x00, 0x33, 0x27, 0x00, 0xAA, 0x88, 0x04, 0x01, 0x04, 0xDC, 0x02, 0x23, 0xA2, 0x01, 0x04, 0x23,
+ 0xA0, 0x01, 0xEE, 0x97, 0x18, 0x95, 0x4B, 0x00, 0xF6, 0x00, 0x4F, 0x04, 0x4F, 0x00, 0x00, 0xA3,
+ 0x14, 0x05, 0x00, 0x05, 0x76, 0x00, 0x06, 0x61, 0x00, 0xA2, 0x0E, 0x05, 0xFC, 0x84, 0x30, 0x97,
+ 0xCD, 0x04, 0x16, 0x85, 0x48, 0x04, 0x84, 0x80, 0x02, 0x01, 0x03, 0xDA, 0x80, 0x23, 0x82, 0x01,
+ 0x26, 0x85, 0x02, 0x23, 0xA0, 0x01, 0x4A, 0x00, 0x06, 0x61, 0x00, 0xA2, 0x32, 0x05, 0x1D, 0x01,
+ 0x04, 0xD6, 0xFF, 0x23, 0x86, 0x41, 0x4B, 0x60, 0xCB, 0x00, 0xFF, 0x23, 0x80, 0x01, 0x49, 0x00,
+ 0x81, 0x01, 0x04, 0x01, 0x02, 0xC8, 0x30, 0x01, 0x80, 0x01, 0xF7, 0x04, 0x03, 0x01, 0x49, 0x04,
+ 0x80, 0x01, 0xC9, 0x00, 0x00, 0x05, 0x00, 0x01, 0xFF, 0xA0, 0x52, 0x05, 0x77, 0x04, 0x01, 0x23,
+ 0xEA, 0x00, 0x5D, 0x00, 0xFE, 0xC7, 0x00, 0x62, 0x00, 0x23, 0xEA, 0x00, 0x00, 0x63, 0x07, 0xA4,
+ 0xD2, 0x05, 0x03, 0x03, 0x02, 0xA0, 0x80, 0x05, 0xCE, 0x85, 0x00, 0x33, 0x2D, 0x00, 0xAA, 0x88,
+ 0x04, 0xA0, 0xA6, 0x05, 0x80, 0x63, 0x4A, 0x00, 0x06, 0x61, 0x00, 0xA2, 0x92, 0x05, 0x1D, 0x01,
+ 0x06, 0xD6, 0x02, 0x23, 0x02, 0x41, 0x82, 0x01, 0x50, 0x00, 0x4C, 0x97, 0xF6, 0x84, 0x04, 0x23,
+ 0x02, 0x41, 0x82, 0x01, 0xF6, 0x84, 0x08, 0xA0, 0xAC, 0x05, 0xCE, 0x85, 0x03, 0xA0, 0xB2, 0x05,
+ 0xCE, 0x85, 0x01, 0xA0, 0xBC, 0x05, 0x88, 0x00, 0x80, 0x63, 0xAA, 0x86, 0x07, 0xA0, 0xC8, 0x05,
+ 0x06, 0x23, 0x52, 0x98, 0x48, 0x23, 0xE0, 0x88, 0x07, 0x23, 0x80, 0x00, 0xF0, 0x86, 0x80, 0x63,
+ 0x6E, 0x85, 0x00, 0x63, 0x4A, 0x00, 0x06, 0x61, 0x00, 0xA2, 0x10, 0x06, 0x1D, 0x01, 0x18, 0xD4,
+ 0xC0, 0x23, 0x07, 0x41, 0x83, 0x03, 0x80, 0x63, 0x06, 0xA6, 0xF2, 0x05, 0x00, 0x33, 0x37, 0x00,
+ 0xAA, 0x88, 0x1D, 0x01, 0x02, 0xD6, 0x46, 0x23, 0xE0, 0x88, 0x63, 0x60, 0x83, 0x03, 0x80, 0x63,
+ 0x06, 0xA6, 0x0A, 0x06, 0x00, 0x33, 0x38, 0x00, 0xAA, 0x88, 0xEF, 0x04, 0x6F, 0x00, 0x00, 0x63,
+ 0x4B, 0x00, 0x06, 0x41, 0xCB, 0x00, 0x52, 0x00, 0x06, 0x61, 0x00, 0xA2, 0x28, 0x06, 0x1D, 0x01,
+ 0x03, 0xCA, 0xC0, 0x23, 0x07, 0x41, 0x00, 0x63, 0x1D, 0x01, 0x04, 0xCC, 0x00, 0x33, 0x00, 0x83,
+ 0xC0, 0x20, 0x81, 0x62, 0x80, 0x23, 0x07, 0x41, 0x00, 0x63, 0x80, 0x67, 0x08, 0x23, 0x83, 0x03,
+ 0x80, 0x63, 0x00, 0x63, 0x06, 0xA6, 0x56, 0x06, 0x07, 0xA6, 0x6E, 0x05, 0x02, 0xA6, 0xE4, 0x06,
+ 0x00, 0x33, 0x39, 0x00, 0xAA, 0x88, 0x00, 0x00, 0x01, 0xA0, 0xFE, 0x06, 0xD4, 0x95, 0x83, 0x03,
+ 0x80, 0x63, 0x06, 0xA6, 0x6A, 0x06, 0x07, 0xA6, 0x6E, 0x05, 0x00, 0x00, 0x01, 0xA0, 0xFE, 0x06,
+ 0x00, 0x2B, 0x40, 0x0E, 0x80, 0x63, 0x01, 0x00, 0x06, 0xA6, 0x86, 0x06, 0x07, 0xA6, 0x6E, 0x05,
+ 0x00, 0x33, 0x3A, 0x00, 0xAA, 0x88, 0x40, 0x0E, 0x80, 0x63, 0x00, 0x43, 0x00, 0xA0, 0x78, 0x06,
+ 0x06, 0xA6, 0x9E, 0x06, 0x07, 0xA6, 0x6E, 0x05, 0x00, 0x33, 0x3B, 0x00, 0xAA, 0x88, 0x80, 0x67,
+ 0x40, 0x0E, 0x80, 0x63, 0x07, 0xA6, 0x6E, 0x05, 0x00, 0x63, 0x07, 0xA6, 0xB4, 0x06, 0x00, 0x33,
+ 0x2A, 0x00, 0xAA, 0x88, 0x03, 0x03, 0x80, 0x63, 0x89, 0x00, 0x0A, 0x2B, 0x07, 0xA6, 0xC6, 0x06,
+ 0x00, 0x33, 0x29, 0x00, 0xAA, 0x88, 0x00, 0x43, 0x00, 0xA2, 0xD2, 0x06, 0xC0, 0x0E, 0x80, 0x63,
+ 0xBC, 0x86, 0xC0, 0x0E, 0x00, 0x33, 0x00, 0x80, 0xC0, 0x20, 0x81, 0x62, 0x04, 0x01, 0x08, 0xDA,
+ 0x80, 0x63, 0x6E, 0x85, 0x80, 0x67, 0x00, 0x33, 0x00, 0x40, 0xC0, 0x20, 0x81, 0x62, 0x00, 0x63,
+ 0x80, 0x7B, 0x80, 0x63, 0x06, 0xA6, 0x62, 0x06, 0x00, 0x33, 0x2C, 0x00, 0xAA, 0x88, 0x0C, 0xA2,
+ 0x18, 0x07, 0xD4, 0x95, 0x83, 0x03, 0x80, 0x63, 0x06, 0xA6, 0x16, 0x07, 0x07, 0xA6, 0x6E, 0x05,
+ 0x00, 0x33, 0x3D, 0x00, 0xAA, 0x88, 0x00, 0x00, 0x80, 0x67, 0x83, 0x03, 0x80, 0x63, 0x0C, 0xA0,
+ 0x2E, 0x07, 0x07, 0xA6, 0x6E, 0x05, 0xBF, 0x23, 0x04, 0x61, 0x84, 0x01, 0xD8, 0x84, 0x00, 0x63,
+ 0xF0, 0x04, 0x01, 0x01, 0xF1, 0x00, 0x00, 0x01, 0xF2, 0x00, 0x01, 0x05, 0x80, 0x01, 0x72, 0x04,
+ 0x71, 0x00, 0x81, 0x01, 0x70, 0x04, 0x80, 0x05, 0x81, 0x05, 0x00, 0x63, 0xF0, 0x04, 0xF2, 0x00,
+ 0x72, 0x04, 0x01, 0x01, 0xF1, 0x00, 0x70, 0x00, 0x81, 0x01, 0x70, 0x04, 0x71, 0x00, 0x81, 0x01,
+ 0x72, 0x00, 0x80, 0x01, 0x71, 0x04, 0x70, 0x00, 0x80, 0x01, 0x70, 0x04, 0x00, 0x63, 0xF0, 0x04,
+ 0xF2, 0x00, 0x72, 0x04, 0x00, 0x01, 0xF1, 0x00, 0x70, 0x00, 0x80, 0x01, 0x70, 0x04, 0x71, 0x00,
+ 0x80, 0x01, 0x72, 0x00, 0x81, 0x01, 0x71, 0x04, 0x70, 0x00, 0x81, 0x01, 0x70, 0x04, 0x00, 0x63,
+ 0x00, 0x23, 0xB3, 0x01, 0x83, 0x05, 0xA3, 0x01, 0xA2, 0x01, 0xA1, 0x01, 0x01, 0x23, 0xA0, 0x01,
+ 0x00, 0x01, 0xC8, 0x00, 0x03, 0xA1, 0xAE, 0x07, 0x00, 0x33, 0x07, 0x00, 0xAA, 0x88, 0x80, 0x05,
+ 0x81, 0x05, 0x04, 0x01, 0x11, 0xC8, 0x48, 0x00, 0xB0, 0x01, 0xB1, 0x01, 0x08, 0x23, 0xB2, 0x01,
+ 0x05, 0x01, 0x48, 0x04, 0x00, 0x43, 0x00, 0xA2, 0xCE, 0x07, 0x00, 0x05, 0xC4, 0x87, 0x00, 0x01,
+ 0xC8, 0x00, 0xFF, 0x23, 0x80, 0x01, 0x05, 0x05, 0x00, 0x63, 0xF7, 0x04, 0x1A, 0x09, 0xF6, 0x08,
+ 0x6E, 0x04, 0x00, 0x02, 0x80, 0x43, 0x76, 0x08, 0x80, 0x02, 0x77, 0x04, 0x00, 0x63, 0xF7, 0x04,
+ 0x1A, 0x09, 0xF6, 0x08, 0x6E, 0x04, 0x00, 0x02, 0x00, 0xA0, 0xFE, 0x07, 0x00, 0x88, 0x00, 0x43,
+ 0x76, 0x08, 0x80, 0x02, 0x77, 0x04, 0x00, 0x63, 0xF3, 0x04, 0x00, 0x23, 0xF4, 0x00, 0x74, 0x00,
+ 0x80, 0x43, 0xF4, 0x00, 0xCF, 0x40, 0x00, 0xA2, 0x2E, 0x08, 0x74, 0x04, 0x02, 0x01, 0xF7, 0xC9,
+ 0xF6, 0xD9, 0x00, 0x01, 0x01, 0xA1, 0x0E, 0x08, 0xEE, 0x97, 0x18, 0x95, 0x0E, 0x88, 0x73, 0x04,
+ 0x00, 0x63, 0xF3, 0x04, 0x75, 0x04, 0x44, 0x88, 0x02, 0x01, 0x04, 0xD8, 0x30, 0x97, 0xEE, 0x97,
+ 0x18, 0x95, 0x34, 0x88, 0x75, 0x00, 0x00, 0xA3, 0x4E, 0x08, 0x00, 0x05, 0x38, 0x88, 0x73, 0x04,
+ 0x00, 0x63, 0x80, 0x7B, 0x80, 0x63, 0x06, 0xA6, 0x60, 0x08, 0x00, 0x33, 0x3E, 0x00, 0xAA, 0x88,
+ 0x80, 0x67, 0x83, 0x03, 0x80, 0x63, 0x00, 0x63, 0x38, 0x2B, 0x86, 0x88, 0x38, 0x2B, 0x7C, 0x88,
+ 0x32, 0x09, 0x31, 0x05, 0x7C, 0x98, 0x05, 0x05, 0xB2, 0x09, 0x00, 0x63, 0x00, 0x32, 0x00, 0x36,
+ 0x00, 0x3A, 0x00, 0x3E, 0x00, 0x63, 0x80, 0x32, 0x80, 0x36, 0x80, 0x3A, 0x80, 0x3E, 0x00, 0x63,
+ 0x38, 0x2B, 0x40, 0x32, 0x40, 0x36, 0x40, 0x3A, 0x40, 0x3E, 0x00, 0x63, 0x5A, 0x20, 0xC9, 0x40,
+ 0x00, 0xA0, 0x9C, 0x08, 0x5D, 0x00, 0xFE, 0xC3, 0x00, 0x63, 0x80, 0x73, 0xE6, 0x20, 0x02, 0x23,
+ 0xE8, 0x00, 0x82, 0x73, 0xFF, 0xFD, 0x80, 0x73, 0x13, 0x23, 0xE0, 0x88, 0x66, 0x20, 0xC0, 0x20,
+ 0x04, 0x23, 0xA0, 0x01, 0xA1, 0x23, 0xA1, 0x01, 0x81, 0x62, 0xCA, 0x88, 0x80, 0x73, 0x80, 0x77,
+ 0x68, 0x00, 0x00, 0xA2, 0x80, 0x00, 0x03, 0xC2, 0xF1, 0xC7, 0x41, 0x23, 0xE0, 0x88, 0x11, 0x23,
+ 0xA1, 0x01, 0x04, 0x23, 0xA0, 0x01, 0xD8, 0x84,
+};
+
+STATIC ushort _mcode_size ASC_INITDATA = sizeof(_mcode_buf);
+STATIC ulong _mcode_chksum ASC_INITDATA = 0x01297F32UL;
#define ASC_SYN_OFFSET_ONE_DISABLE_LIST 16
-uchar _syn_offset_one_disable_cmd[ASC_SYN_OFFSET_ONE_DISABLE_LIST] =
-{
- SCSICMD_Inquiry,
- SCSICMD_RequestSense,
- SCSICMD_ReadCapacity,
- SCSICMD_ReadTOC,
- SCSICMD_ModeSelect6,
- SCSICMD_ModeSense6,
- SCSICMD_ModeSelect10,
- SCSICMD_ModeSense10,
- 0xFF,
- 0xFF,
- 0xFF,
- 0xFF,
- 0xFF,
- 0xFF,
- 0xFF,
- 0xFF
+STATIC uchar _syn_offset_one_disable_cmd[ASC_SYN_OFFSET_ONE_DISABLE_LIST] =
+{
+ SCSICMD_Inquiry,
+ SCSICMD_RequestSense,
+ SCSICMD_ReadCapacity,
+ SCSICMD_ReadTOC,
+ SCSICMD_ModeSelect6,
+ SCSICMD_ModeSense6,
+ SCSICMD_ModeSelect10,
+ SCSICMD_ModeSense10,
+ 0xFF,
+ 0xFF,
+ 0xFF,
+ 0xFF,
+ 0xFF,
+ 0xFF,
+ 0xFF,
+ 0xFF
};
-int
+STATIC int
AscExeScsiQueue(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_Q dosfar * scsiq
-)
-{
- PortAddr iop_base;
- int last_int_level;
- int sta;
- int n_q_required;
- int disable_syn_offset_one_fix;
- int i;
- ulong addr;
- ASC_EXE_CALLBACK asc_exe_callback;
- ushort sg_entry_cnt = 0;
- ushort sg_entry_cnt_minus_one = 0;
- uchar target_ix;
- uchar tid_no;
- uchar sdtr_data;
- uchar extra_bytes;
- uchar scsi_cmd;
- uchar disable_cmd;
- ASC_SG_HEAD dosfar *sg_head;
- ulong data_cnt;
-#if CC_LINK_BUSY_Q
- ASC_SCSI_Q dosfar *scsiq_tail;
- ASC_SCSI_Q dosfar *scsiq_next;
- ASC_SCSI_Q dosfar *scsiq_prev;
-#endif
- iop_base = asc_dvc->iop_base;
- sg_head = scsiq->sg_head;
- asc_exe_callback = (ASC_EXE_CALLBACK) asc_dvc->exe_callback;
- if (asc_dvc->err_code != 0)
- return (ERR);
- if (scsiq == (ASC_SCSI_Q dosfar *) 0L) {
- AscSetLibErrorCode(asc_dvc, ASCQ_ERR_SCSIQ_NULL_PTR);
- return (ERR);
- }
- scsiq->q1.q_no = 0;
- if ((scsiq->q2.tag_code & ASC_TAG_FLAG_EXTRA_BYTES) == 0) {
- scsiq->q1.extra_bytes = 0;
- }
- sta = 0;
- target_ix = scsiq->q2.target_ix;
- tid_no = ASC_TIX_TO_TID(target_ix);
- n_q_required = 1;
- if (scsiq->cdbptr[0] == SCSICMD_RequestSense) {
- if (((asc_dvc->init_sdtr & scsiq->q1.target_id) != 0) &&
- ((asc_dvc->sdtr_done & scsiq->q1.target_id) != 0)) {
- sdtr_data = AscGetMCodeInitSDTRAtID(iop_base, tid_no);
- AscMsgOutSDTR(asc_dvc,
- asc_dvc->sdtr_period_tbl[(sdtr_data >> 4) & (uchar) (asc_dvc->max_sdtr_index - 1)],
- (uchar) (sdtr_data & (uchar) ASC_SYN_MAX_OFFSET));
- scsiq->q1.cntl |= (QC_MSG_OUT | QC_URGENT);
- }
- }
- last_int_level = DvcEnterCritical();
- if (asc_dvc->in_critical_cnt != 0) {
- DvcLeaveCritical(last_int_level);
- AscSetLibErrorCode(asc_dvc, ASCQ_ERR_CRITICAL_RE_ENTRY);
- return (ERR);
- }
- asc_dvc->in_critical_cnt++;
- if ((scsiq->q1.cntl & QC_SG_HEAD) != 0) {
- if ((sg_entry_cnt = sg_head->entry_cnt) == 0) {
- asc_dvc->in_critical_cnt--;
- DvcLeaveCritical(last_int_level);
- return (ERR);
- }
- if (sg_entry_cnt > ASC_MAX_SG_LIST) {
- return (ERR);
- }
- if (sg_entry_cnt == 1) {
- scsiq->q1.data_addr = sg_head->sg_list[0].addr;
- scsiq->q1.data_cnt = sg_head->sg_list[0].bytes;
- scsiq->q1.cntl &= ~(QC_SG_HEAD | QC_SG_SWAP_QUEUE);
- } else {
-#if CC_CHK_AND_COALESCE_SG_LIST
- AscCoalesceSgList(scsiq);
- sg_entry_cnt = sg_head->entry_cnt;
-#endif
- }
- sg_entry_cnt_minus_one = sg_entry_cnt - 1;
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_Q * scsiq
+)
+{
+ PortAddr iop_base;
+ int last_int_level;
+ int sta;
+ int n_q_required;
+ int disable_syn_offset_one_fix;
+ int i;
+ ulong addr;
+ ASC_EXE_CALLBACK asc_exe_callback;
+ ushort sg_entry_cnt = 0;
+ ushort sg_entry_cnt_minus_one = 0;
+ uchar target_ix;
+ uchar tid_no;
+ uchar sdtr_data;
+ uchar extra_bytes;
+ uchar scsi_cmd;
+ uchar disable_cmd;
+ ASC_SG_HEAD *sg_head;
+ ulong data_cnt;
+ iop_base = asc_dvc->iop_base;
+ sg_head = scsiq->sg_head;
+ asc_exe_callback = (ASC_EXE_CALLBACK) asc_dvc->exe_callback;
+ if (asc_dvc->err_code != 0)
+ return (ERR);
+ if (scsiq == (ASC_SCSI_Q *) 0L) {
+ AscSetLibErrorCode(asc_dvc, ASCQ_ERR_SCSIQ_NULL_PTR);
+ return (ERR);
+ }
+ scsiq->q1.q_no = 0;
+ if ((scsiq->q2.tag_code & ASC_TAG_FLAG_EXTRA_BYTES) == 0) {
+ scsiq->q1.extra_bytes = 0;
+ }
+ sta = 0;
+ target_ix = scsiq->q2.target_ix;
+ tid_no = ASC_TIX_TO_TID(target_ix);
+ n_q_required = 1;
+ if (scsiq->cdbptr[0] == SCSICMD_RequestSense) {
+ if ((asc_dvc->init_sdtr & scsiq->q1.target_id) != 0) {
+ asc_dvc->sdtr_done &= ~scsiq->q1.target_id ;
+ sdtr_data = AscGetMCodeInitSDTRAtID(iop_base, tid_no);
+ AscMsgOutSDTR(asc_dvc,
+ asc_dvc->sdtr_period_tbl[(sdtr_data >> 4) &
+ (uchar) (asc_dvc->max_sdtr_index - 1)],
+ (uchar) (sdtr_data & (uchar) ASC_SYN_MAX_OFFSET));
+ scsiq->q1.cntl |= (QC_MSG_OUT | QC_URGENT);
+ }
+ }
+ last_int_level = DvcEnterCritical();
+ if (asc_dvc->in_critical_cnt != 0) {
+ DvcLeaveCritical(last_int_level);
+ AscSetLibErrorCode(asc_dvc, ASCQ_ERR_CRITICAL_RE_ENTRY);
+ return (ERR);
+ }
+ asc_dvc->in_critical_cnt++;
+ if ((scsiq->q1.cntl & QC_SG_HEAD) != 0) {
+ if ((sg_entry_cnt = sg_head->entry_cnt) == 0) {
+ asc_dvc->in_critical_cnt--;
+ DvcLeaveCritical(last_int_level);
+ return (ERR);
+ }
+ if (sg_entry_cnt > ASC_MAX_SG_LIST) {
+ return (ERR);
+ }
+ if (sg_entry_cnt == 1) {
+ scsiq->q1.data_addr = sg_head->sg_list[0].addr;
+ scsiq->q1.data_cnt = sg_head->sg_list[0].bytes;
+ scsiq->q1.cntl &= ~(QC_SG_HEAD | QC_SG_SWAP_QUEUE);
+ }
+ sg_entry_cnt_minus_one = sg_entry_cnt - 1;
#if CC_DEBUG_SG_LIST
- if (asc_dvc->bus_type & (ASC_IS_ISA | ASC_IS_VL | ASC_IS_EISA)) {
- for (i = 0; i < sg_entry_cnt_minus_one; i++) {
- addr = sg_head->sg_list[i].addr + sg_head->sg_list[i].bytes;
- if (((ushort) addr & 0x0003) != 0) {
- asc_dvc->in_critical_cnt--;
- DvcLeaveCritical(last_int_level);
- AscSetLibErrorCode(asc_dvc, ASCQ_ERR_SG_LIST_ODD_ADDRESS);
- return (ERR);
- }
- }
- }
-#endif
- }
- scsi_cmd = scsiq->cdbptr[0];
- disable_syn_offset_one_fix = FALSE;
- if (
- (asc_dvc->pci_fix_asyn_xfer & scsiq->q1.target_id)
- && !(asc_dvc->pci_fix_asyn_xfer_always & scsiq->q1.target_id)
- ) {
- if (scsiq->q1.cntl & QC_SG_HEAD) {
- data_cnt = 0;
- for (i = 0; i < sg_entry_cnt; i++) {
- data_cnt += sg_head->sg_list[i].bytes;
- }
- } else {
- data_cnt = scsiq->q1.data_cnt;
- }
- if (data_cnt != 0UL) {
- if (data_cnt < 512UL) {
- disable_syn_offset_one_fix = TRUE;
- } else {
- for (i = 0; i < ASC_SYN_OFFSET_ONE_DISABLE_LIST; i++) {
- disable_cmd = _syn_offset_one_disable_cmd[i];
- if (disable_cmd == 0xFF) {
- break;
- }
- if (scsi_cmd == disable_cmd) {
- disable_syn_offset_one_fix = TRUE;
- break;
- }
- }
- }
- }
- }
- if (disable_syn_offset_one_fix) {
- scsiq->q2.tag_code &= ~M2_QTAG_MSG_SIMPLE;
- scsiq->q2.tag_code |= (ASC_TAG_FLAG_DISABLE_ASYN_USE_SYN_FIX |
- ASC_TAG_FLAG_DISABLE_DISCONNECT);
- } else {
- scsiq->q2.tag_code &= 0x23;
- }
- if ((scsiq->q1.cntl & QC_SG_HEAD) != 0) {
- if (asc_dvc->bug_fix_cntl) {
- if (asc_dvc->bug_fix_cntl & ASC_BUG_FIX_IF_NOT_DWB) {
- if (
- (scsi_cmd == SCSICMD_Read6)
- || (scsi_cmd == SCSICMD_Read10)
- ) {
- addr = sg_head->sg_list[sg_entry_cnt_minus_one].addr +
- sg_head->sg_list[sg_entry_cnt_minus_one].bytes;
- extra_bytes = (uchar) ((ushort) addr & 0x0003);
- if ((extra_bytes != 0) && ((scsiq->q2.tag_code & ASC_TAG_FLAG_EXTRA_BYTES) == 0)) {
- scsiq->q2.tag_code |= ASC_TAG_FLAG_EXTRA_BYTES;
- scsiq->q1.extra_bytes = extra_bytes;
- sg_head->sg_list[sg_entry_cnt_minus_one].bytes -= (ulong) extra_bytes;
- }
- }
- }
- }
- sg_head->entry_to_copy = sg_head->entry_cnt;
- n_q_required = AscSgListToQueue(sg_entry_cnt);
-#if CC_LINK_BUSY_Q
- scsiq_next = (ASC_SCSI_Q dosfar *) asc_dvc->scsiq_busy_head[tid_no];
- if (scsiq_next != (ASC_SCSI_Q dosfar *) 0L) {
- goto link_scisq_to_busy_list;
- }
-#endif
- if (
- (AscGetNumOfFreeQueue(asc_dvc, target_ix, n_q_required)
- >= (uint) n_q_required) ||
- ((scsiq->q1.cntl & QC_URGENT) != 0)
- ) {
- if ((sta = AscSendScsiQueue(asc_dvc, scsiq,
- n_q_required)) == 1) {
- asc_dvc->in_critical_cnt--;
- if (asc_exe_callback != 0) {
- (*asc_exe_callback) (asc_dvc, scsiq);
- }
- DvcLeaveCritical(last_int_level);
- return (sta);
- }
- }
- } else {
- if (asc_dvc->bug_fix_cntl) {
- if (asc_dvc->bug_fix_cntl & ASC_BUG_FIX_IF_NOT_DWB) {
- if (
- (scsi_cmd == SCSICMD_Read6)
- || (scsi_cmd == SCSICMD_Read10)
- ) {
- addr = scsiq->q1.data_addr + scsiq->q1.data_cnt;
- extra_bytes = (uchar) ((ushort) addr & 0x0003);
- if ((extra_bytes != 0) && ((scsiq->q2.tag_code & ASC_TAG_FLAG_EXTRA_BYTES) == 0)) {
- if (((ushort) scsiq->q1.data_cnt & 0x01FF) == 0) {
- scsiq->q2.tag_code |= ASC_TAG_FLAG_EXTRA_BYTES;
- scsiq->q1.data_cnt -= (ulong) extra_bytes;
- scsiq->q1.extra_bytes = extra_bytes;
- }
- }
- }
- }
- }
- n_q_required = 1;
-#if CC_LINK_BUSY_Q
- scsiq_next = (ASC_SCSI_Q dosfar *) asc_dvc->scsiq_busy_head[tid_no];
- if (scsiq_next != (ASC_SCSI_Q dosfar *) 0L) {
- goto link_scisq_to_busy_list;
- }
+ if (asc_dvc->bus_type & (ASC_IS_ISA | ASC_IS_VL | ASC_IS_EISA)) {
+ for (i = 0; i < sg_entry_cnt_minus_one; i++) {
+ addr = sg_head->sg_list[i].addr + sg_head->sg_list[i].bytes;
+ if (((ushort) addr & 0x0003) != 0) {
+ asc_dvc->in_critical_cnt--;
+ DvcLeaveCritical(last_int_level);
+ AscSetLibErrorCode(asc_dvc, ASCQ_ERR_SG_LIST_ODD_ADDRESS);
+ return (ERR);
+ }
+ }
+ }
#endif
- if ((AscGetNumOfFreeQueue(asc_dvc, target_ix, 1) >= 1) ||
- ((scsiq->q1.cntl & QC_URGENT) != 0)) {
- if ((sta = AscSendScsiQueue(asc_dvc, scsiq,
- n_q_required)) == 1) {
- asc_dvc->in_critical_cnt--;
- if (asc_exe_callback != 0) {
- (*asc_exe_callback) (asc_dvc, scsiq);
- }
- DvcLeaveCritical(last_int_level);
- return (sta);
- }
- }
- }
-#if CC_LINK_BUSY_Q
- if (sta == 0) {
- link_scisq_to_busy_list:
- scsiq->ext.q_required = n_q_required;
- if (scsiq_next == (ASC_SCSI_Q dosfar *) 0L) {
- asc_dvc->scsiq_busy_head[tid_no] = (ASC_SCSI_Q dosfar *) scsiq;
- asc_dvc->scsiq_busy_tail[tid_no] = (ASC_SCSI_Q dosfar *) scsiq;
- scsiq->ext.next = (ASC_SCSI_Q dosfar *) 0L;
- scsiq->ext.join = (ASC_SCSI_Q dosfar *) 0L;
- scsiq->q1.status = QS_BUSY;
- sta = 1;
- } else {
- scsiq_tail = (ASC_SCSI_Q dosfar *) asc_dvc->scsiq_busy_tail[tid_no];
- if (scsiq_tail->ext.next == (ASC_SCSI_Q dosfar *) 0L) {
- if ((scsiq->q1.cntl & QC_URGENT) != 0) {
- asc_dvc->scsiq_busy_head[tid_no] = (ASC_SCSI_Q dosfar *) scsiq;
- scsiq->ext.next = scsiq_next;
- scsiq->ext.join = (ASC_SCSI_Q dosfar *) 0L;
- } else {
- if (scsiq->ext.cntl & QCX_SORT) {
- do {
- scsiq_prev = scsiq_next;
- scsiq_next = scsiq_next->ext.next;
- if (scsiq->ext.lba < scsiq_prev->ext.lba)
- break;
- } while (scsiq_next != (ASC_SCSI_Q dosfar *) 0L);
- scsiq_prev->ext.next = scsiq;
- scsiq->ext.next = scsiq_next;
- if (scsiq_next == (ASC_SCSI_Q dosfar *) 0L) {
- asc_dvc->scsiq_busy_tail[tid_no] = (ASC_SCSI_Q dosfar *) scsiq;
- }
- scsiq->ext.join = (ASC_SCSI_Q dosfar *) 0L;
- } else {
- scsiq_tail->ext.next = (ASC_SCSI_Q dosfar *) scsiq;
- asc_dvc->scsiq_busy_tail[tid_no] = (ASC_SCSI_Q dosfar *) scsiq;
- scsiq->ext.next = (ASC_SCSI_Q dosfar *) 0L;
- scsiq->ext.join = (ASC_SCSI_Q dosfar *) 0L;
- }
- }
- scsiq->q1.status = QS_BUSY;
- sta = 1;
- } else {
- AscSetLibErrorCode(asc_dvc, ASCQ_ERR_SCSIQ_BAD_NEXT_PTR);
- sta = ERR;
- }
- }
- }
-#endif
- asc_dvc->in_critical_cnt--;
- DvcLeaveCritical(last_int_level);
- return (sta);
+ }
+ scsi_cmd = scsiq->cdbptr[0];
+ disable_syn_offset_one_fix = FALSE;
+ if ((asc_dvc->pci_fix_asyn_xfer & scsiq->q1.target_id) &&
+ !(asc_dvc->pci_fix_asyn_xfer_always & scsiq->q1.target_id)) {
+ if (scsiq->q1.cntl & QC_SG_HEAD) {
+ data_cnt = 0;
+ for (i = 0; i < sg_entry_cnt; i++) {
+ data_cnt += sg_head->sg_list[i].bytes;
+ }
+ } else {
+ data_cnt = scsiq->q1.data_cnt;
+ }
+ if (data_cnt != 0UL) {
+ if (data_cnt < 512UL) {
+ disable_syn_offset_one_fix = TRUE;
+ } else {
+ for (i = 0; i < ASC_SYN_OFFSET_ONE_DISABLE_LIST; i++) {
+ disable_cmd = _syn_offset_one_disable_cmd[i];
+ if (disable_cmd == 0xFF) {
+ break;
+ }
+ if (scsi_cmd == disable_cmd) {
+ disable_syn_offset_one_fix = TRUE;
+ break;
+ }
+ }
+ }
+ }
+ }
+ if (disable_syn_offset_one_fix) {
+ scsiq->q2.tag_code &= ~M2_QTAG_MSG_SIMPLE;
+ scsiq->q2.tag_code |= (ASC_TAG_FLAG_DISABLE_ASYN_USE_SYN_FIX |
+ ASC_TAG_FLAG_DISABLE_DISCONNECT);
+ } else {
+ scsiq->q2.tag_code &= 0x23;
+ }
+ if ((scsiq->q1.cntl & QC_SG_HEAD) != 0) {
+ if (asc_dvc->bug_fix_cntl) {
+ if (asc_dvc->bug_fix_cntl & ASC_BUG_FIX_IF_NOT_DWB) {
+ if ((scsi_cmd == SCSICMD_Read6) ||
+ (scsi_cmd == SCSICMD_Read10)) {
+ addr = sg_head->sg_list[sg_entry_cnt_minus_one].addr +
+ sg_head->sg_list[sg_entry_cnt_minus_one].bytes;
+ extra_bytes = (uchar) ((ushort) addr & 0x0003);
+ if ((extra_bytes != 0) &&
+ ((scsiq->q2.tag_code & ASC_TAG_FLAG_EXTRA_BYTES)
+ == 0)) {
+ scsiq->q2.tag_code |= ASC_TAG_FLAG_EXTRA_BYTES;
+ scsiq->q1.extra_bytes = extra_bytes;
+ sg_head->sg_list[sg_entry_cnt_minus_one].bytes -=
+ (ulong) extra_bytes;
+ }
+ }
+ }
+ }
+ sg_head->entry_to_copy = sg_head->entry_cnt;
+ n_q_required = AscSgListToQueue(sg_entry_cnt);
+ if ((AscGetNumOfFreeQueue(asc_dvc, target_ix, n_q_required) >=
+ (uint) n_q_required) || ((scsiq->q1.cntl & QC_URGENT) != 0)) {
+ if ((sta = AscSendScsiQueue(asc_dvc, scsiq,
+ n_q_required)) == 1) {
+ asc_dvc->in_critical_cnt--;
+ if (asc_exe_callback != 0) {
+ (*asc_exe_callback) (asc_dvc, scsiq);
+ }
+ DvcLeaveCritical(last_int_level);
+ return (sta);
+ }
+ }
+ } else {
+ if (asc_dvc->bug_fix_cntl) {
+ if (asc_dvc->bug_fix_cntl & ASC_BUG_FIX_IF_NOT_DWB) {
+ if ((scsi_cmd == SCSICMD_Read6) ||
+ (scsi_cmd == SCSICMD_Read10)) {
+ addr = scsiq->q1.data_addr + scsiq->q1.data_cnt;
+ extra_bytes = (uchar) ((ushort) addr & 0x0003);
+ if ((extra_bytes != 0) &&
+ ((scsiq->q2.tag_code & ASC_TAG_FLAG_EXTRA_BYTES)
+ == 0)) {
+ if (((ushort) scsiq->q1.data_cnt & 0x01FF) == 0) {
+ scsiq->q2.tag_code |= ASC_TAG_FLAG_EXTRA_BYTES;
+ scsiq->q1.data_cnt -= (ulong) extra_bytes;
+ scsiq->q1.extra_bytes = extra_bytes;
+ }
+ }
+ }
+ }
+ }
+ n_q_required = 1;
+ if ((AscGetNumOfFreeQueue(asc_dvc, target_ix, 1) >= 1) ||
+ ((scsiq->q1.cntl & QC_URGENT) != 0)) {
+ if ((sta = AscSendScsiQueue(asc_dvc, scsiq,
+ n_q_required)) == 1) {
+ asc_dvc->in_critical_cnt--;
+ if (asc_exe_callback != 0) {
+ (*asc_exe_callback) (asc_dvc, scsiq);
+ }
+ DvcLeaveCritical(last_int_level);
+ return (sta);
+ }
+ }
+ }
+ asc_dvc->in_critical_cnt--;
+ DvcLeaveCritical(last_int_level);
+ return (sta);
}
-int
+STATIC int
AscSendScsiQueue(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_Q dosfar * scsiq,
- uchar n_q_required
-)
-{
- PortAddr iop_base;
- uchar free_q_head;
- uchar next_qp;
- uchar tid_no;
- uchar target_ix;
- int sta;
- iop_base = asc_dvc->iop_base;
- target_ix = scsiq->q2.target_ix;
- tid_no = ASC_TIX_TO_TID(target_ix);
- sta = 0;
- free_q_head = (uchar) AscGetVarFreeQHead(iop_base);
- if (n_q_required > 1) {
- if ((next_qp = AscAllocMultipleFreeQueue(iop_base,
- free_q_head, (uchar) (n_q_required)))
- != (uchar) ASC_QLINK_END) {
- asc_dvc->last_q_shortage = 0;
- scsiq->sg_head->queue_cnt = n_q_required - 1;
- scsiq->q1.q_no = free_q_head;
- if ((sta = AscPutReadySgListQueue(asc_dvc, scsiq,
- free_q_head)) == 1) {
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_Q * scsiq,
+ uchar n_q_required
+)
+{
+ PortAddr iop_base;
+ uchar free_q_head;
+ uchar next_qp;
+ uchar tid_no;
+ uchar target_ix;
+ int sta;
+ iop_base = asc_dvc->iop_base;
+ target_ix = scsiq->q2.target_ix;
+ tid_no = ASC_TIX_TO_TID(target_ix);
+ sta = 0;
+ free_q_head = (uchar) AscGetVarFreeQHead(iop_base);
+ if (n_q_required > 1) {
+ if ((next_qp = AscAllocMultipleFreeQueue(iop_base,
+ free_q_head, (uchar) (n_q_required)))
+ != (uchar) ASC_QLINK_END) {
+ asc_dvc->last_q_shortage = 0;
+ scsiq->sg_head->queue_cnt = n_q_required - 1;
+ scsiq->q1.q_no = free_q_head;
+ if ((sta = AscPutReadySgListQueue(asc_dvc, scsiq,
+ free_q_head)) == 1) {
#if CC_WRITE_IO_COUNT
- asc_dvc->req_count++;
+ asc_dvc->req_count++;
#endif
- AscPutVarFreeQHead(iop_base, next_qp);
- asc_dvc->cur_total_qng += (uchar) (n_q_required);
- asc_dvc->cur_dvc_qng[tid_no]++;
- }
- return (sta);
- }
- } else if (n_q_required == 1) {
- if ((next_qp = AscAllocFreeQueue(iop_base,
- free_q_head)) != ASC_QLINK_END) {
- scsiq->q1.q_no = free_q_head;
- if ((sta = AscPutReadyQueue(asc_dvc, scsiq,
- free_q_head)) == 1) {
+ AscPutVarFreeQHead(iop_base, next_qp);
+ asc_dvc->cur_total_qng += (uchar) (n_q_required);
+ asc_dvc->cur_dvc_qng[tid_no]++;
+ }
+ return (sta);
+ }
+ } else if (n_q_required == 1) {
+ if ((next_qp = AscAllocFreeQueue(iop_base,
+ free_q_head)) != ASC_QLINK_END) {
+ scsiq->q1.q_no = free_q_head;
+ if ((sta = AscPutReadyQueue(asc_dvc, scsiq,
+ free_q_head)) == 1) {
#if CC_WRITE_IO_COUNT
- asc_dvc->req_count++;
+ asc_dvc->req_count++;
#endif
- AscPutVarFreeQHead(iop_base, next_qp);
- asc_dvc->cur_total_qng++;
- asc_dvc->cur_dvc_qng[tid_no]++;
- }
- return (sta);
- }
- }
- return (sta);
+ AscPutVarFreeQHead(iop_base, next_qp);
+ asc_dvc->cur_total_qng++;
+ asc_dvc->cur_dvc_qng[tid_no]++;
+ }
+ return (sta);
+ }
+ }
+ return (sta);
}
-int
+STATIC int
AscSgListToQueue(
- int sg_list
+ int sg_list
)
{
- int n_sg_list_qs;
- n_sg_list_qs = ((sg_list - 1) / ASC_SG_LIST_PER_Q);
- if (((sg_list - 1) % ASC_SG_LIST_PER_Q) != 0)
- n_sg_list_qs++;
- return (n_sg_list_qs + 1);
+ int n_sg_list_qs;
+ n_sg_list_qs = ((sg_list - 1) / ASC_SG_LIST_PER_Q);
+ if (((sg_list - 1) % ASC_SG_LIST_PER_Q) != 0)
+ n_sg_list_qs++;
+ return (n_sg_list_qs + 1);
}
-uint
+STATIC uint
AscGetNumOfFreeQueue(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- uchar target_ix,
- uchar n_qs
-)
-{
- uint cur_used_qs;
- uint cur_free_qs;
- ASC_SCSI_BIT_ID_TYPE target_id;
- uchar tid_no;
- target_id = ASC_TIX_TO_TARGET_ID(target_ix);
- tid_no = ASC_TIX_TO_TID(target_ix);
- if ((asc_dvc->unit_not_ready & target_id) ||
- (asc_dvc->queue_full_or_busy & target_id)) {
- return (0);
- }
- if (n_qs == 1) {
- cur_used_qs = (uint) asc_dvc->cur_total_qng +
- (uint) asc_dvc->last_q_shortage +
- (uint) ASC_MIN_FREE_Q;
- } else {
- cur_used_qs = (uint) asc_dvc->cur_total_qng +
- (uint) ASC_MIN_FREE_Q;
- }
- if ((uint) (cur_used_qs + n_qs) <= (uint) asc_dvc->max_total_qng) {
- cur_free_qs = (uint) asc_dvc->max_total_qng - cur_used_qs;
- if (asc_dvc->cur_dvc_qng[tid_no] >=
- asc_dvc->max_dvc_qng[tid_no]) {
- return (0);
- }
- return (cur_free_qs);
- }
- if (n_qs > 1) {
- if ((n_qs > asc_dvc->last_q_shortage) && ( n_qs <= ( asc_dvc->max_total_qng - ASC_MIN_FREE_Q ))) {
- asc_dvc->last_q_shortage = n_qs;
- }
- }
- return (0);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ uchar target_ix,
+ uchar n_qs
+)
+{
+ uint cur_used_qs;
+ uint cur_free_qs;
+ ASC_SCSI_BIT_ID_TYPE target_id;
+ uchar tid_no;
+ target_id = ASC_TIX_TO_TARGET_ID(target_ix);
+ tid_no = ASC_TIX_TO_TID(target_ix);
+ if ((asc_dvc->unit_not_ready & target_id) ||
+ (asc_dvc->queue_full_or_busy & target_id)) {
+ return (0);
+ }
+ if (n_qs == 1) {
+ cur_used_qs = (uint) asc_dvc->cur_total_qng +
+ (uint) asc_dvc->last_q_shortage +
+ (uint) ASC_MIN_FREE_Q;
+ } else {
+ cur_used_qs = (uint) asc_dvc->cur_total_qng +
+ (uint) ASC_MIN_FREE_Q;
+ }
+ if ((uint) (cur_used_qs + n_qs) <= (uint) asc_dvc->max_total_qng) {
+ cur_free_qs = (uint) asc_dvc->max_total_qng - cur_used_qs;
+ if (asc_dvc->cur_dvc_qng[tid_no] >=
+ asc_dvc->max_dvc_qng[tid_no]) {
+ return (0);
+ }
+ return (cur_free_qs);
+ }
+ if (n_qs > 1) {
+ if ((n_qs > asc_dvc->last_q_shortage) && (n_qs <= (asc_dvc->max_total_qng - ASC_MIN_FREE_Q))) {
+ asc_dvc->last_q_shortage = n_qs;
+ }
+ }
+ return (0);
}
-int
+STATIC int
AscPutReadyQueue(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_Q dosfar * scsiq,
- uchar q_no
-)
-{
- ushort q_addr;
- uchar tid_no;
- uchar sdtr_data;
- uchar syn_period_ix;
- uchar syn_offset;
- PortAddr iop_base;
- iop_base = asc_dvc->iop_base;
- if (((asc_dvc->init_sdtr & scsiq->q1.target_id) != 0) &&
- ((asc_dvc->sdtr_done & scsiq->q1.target_id) == 0)) {
- tid_no = ASC_TIX_TO_TID(scsiq->q2.target_ix);
- sdtr_data = AscGetMCodeInitSDTRAtID(iop_base, tid_no);
- syn_period_ix = (sdtr_data >> 4) & (asc_dvc->max_sdtr_index - 1);
- syn_offset = sdtr_data & ASC_SYN_MAX_OFFSET;
- AscMsgOutSDTR(asc_dvc,
- asc_dvc->sdtr_period_tbl[syn_period_ix],
- syn_offset);
- scsiq->q1.cntl |= QC_MSG_OUT;
- }
- q_addr = ASC_QNO_TO_QADDR(q_no);
- if ((scsiq->q1.target_id & asc_dvc->use_tagged_qng) == 0) {
- scsiq->q2.tag_code &= ~M2_QTAG_MSG_SIMPLE;
- }
- scsiq->q1.status = QS_FREE;
- AscMemWordCopyToLram(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_CDB_BEG),
- (ushort dosfar *) scsiq->cdbptr,
- (ushort) ((ushort) scsiq->q2.cdb_len >> 1));
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_Q * scsiq,
+ uchar q_no
+)
+{
+ ushort q_addr;
+ uchar tid_no;
+ uchar sdtr_data;
+ uchar syn_period_ix;
+ uchar syn_offset;
+ PortAddr iop_base;
+ iop_base = asc_dvc->iop_base;
+ if (((asc_dvc->init_sdtr & scsiq->q1.target_id) != 0) &&
+ ((asc_dvc->sdtr_done & scsiq->q1.target_id) == 0)) {
+ tid_no = ASC_TIX_TO_TID(scsiq->q2.target_ix);
+ sdtr_data = AscGetMCodeInitSDTRAtID(iop_base, tid_no);
+ syn_period_ix = (sdtr_data >> 4) & (asc_dvc->max_sdtr_index - 1);
+ syn_offset = sdtr_data & ASC_SYN_MAX_OFFSET;
+ AscMsgOutSDTR(asc_dvc,
+ asc_dvc->sdtr_period_tbl[syn_period_ix],
+ syn_offset);
+ scsiq->q1.cntl |= QC_MSG_OUT;
+ }
+ q_addr = ASC_QNO_TO_QADDR(q_no);
+ if ((scsiq->q1.target_id & asc_dvc->use_tagged_qng) == 0) {
+ scsiq->q2.tag_code &= ~M2_QTAG_MSG_SIMPLE;
+ }
+ scsiq->q1.status = QS_FREE;
+ AscMemWordCopyToLram(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_CDB_BEG),
+ (ushort *) scsiq->cdbptr,
+ (ushort) ((ushort) scsiq->q2.cdb_len >> 1));
#if !CC_LITTLE_ENDIAN_HOST
- AscAdjEndianScsiQ(scsiq);
+ AscAdjEndianScsiQ(scsiq);
#endif
- DvcPutScsiQ(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_CPY_BEG),
- (ushort dosfar *) & scsiq->q1.cntl,
- (ushort) ((((sizeof (ASC_SCSIQ_1) + sizeof (ASC_SCSIQ_2)) / 2) - 1)));
+ DvcPutScsiQ(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_CPY_BEG),
+ (ushort *) & scsiq->q1.cntl,
+ (ushort) ((((sizeof (ASC_SCSIQ_1) + sizeof (ASC_SCSIQ_2)) / 2) - 1)));
#if CC_WRITE_IO_COUNT
- AscWriteLramWord(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_W_REQ_COUNT),
- (ushort) asc_dvc->req_count);
+ AscWriteLramWord(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_W_REQ_COUNT),
+ (ushort) asc_dvc->req_count);
#endif
#if CC_VERIFY_LRAM_COPY
- if ((asc_dvc->dvc_cntl & ASC_CNTL_NO_VERIFY_COPY) == 0) {
- if (AscMemWordCmpToLram(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_CDB_BEG),
- (ushort dosfar *) scsiq->cdbptr,
- (ushort) (scsiq->q2.cdb_len >> 1)) != 0) {
- AscSetLibErrorCode(asc_dvc, ASCQ_ERR_LOCAL_MEM);
- return (ERR);
- }
- if (AscMemWordCmpToLram(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_CPY_BEG),
- (ushort dosfar *) & scsiq->q1.cntl,
- (ushort) (((sizeof (ASC_SCSIQ_1) + sizeof (ASC_SCSIQ_2)) / 2) - 1))
- != 0) {
- AscSetLibErrorCode(asc_dvc, ASCQ_ERR_LOCAL_MEM);
- return (ERR);
- }
- }
+ if ((asc_dvc->dvc_cntl & ASC_CNTL_NO_VERIFY_COPY) == 0) {
+ if (AscMemWordCmpToLram(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_CDB_BEG),
+ (ushort *) scsiq->cdbptr,
+ (ushort) (scsiq->q2.cdb_len >> 1)) != 0) {
+ AscSetLibErrorCode(asc_dvc, ASCQ_ERR_LOCAL_MEM);
+ return (ERR);
+ }
+ if (AscMemWordCmpToLram(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_CPY_BEG),
+ (ushort *) & scsiq->q1.cntl,
+ (ushort) (((sizeof (ASC_SCSIQ_1) + sizeof (ASC_SCSIQ_2)) / 2) - 1))
+ != 0) {
+ AscSetLibErrorCode(asc_dvc, ASCQ_ERR_LOCAL_MEM);
+ return (ERR);
+ }
+ }
#endif
#if CC_CLEAR_DMA_REMAIN
- AscWriteLramDWord(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_DW_REMAIN_XFER_ADDR), 0UL);
- AscWriteLramDWord(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_DW_REMAIN_XFER_CNT), 0UL);
+ AscWriteLramDWord(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_DW_REMAIN_XFER_ADDR), 0UL);
+ AscWriteLramDWord(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_DW_REMAIN_XFER_CNT), 0UL);
#endif
- AscWriteLramWord(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_B_STATUS),
- (ushort) (((ushort) scsiq->q1.q_no << 8) | (ushort) QS_READY));
- return (1);
+ AscWriteLramWord(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_B_STATUS),
+ (ushort) (((ushort) scsiq->q1.q_no << 8) | (ushort) QS_READY));
+ return (1);
}
-int
+STATIC int
AscPutReadySgListQueue(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_Q dosfar * scsiq,
- uchar q_no
-)
-{
- int sta;
- int i;
- ASC_SG_HEAD dosfar *sg_head;
- ASC_SG_LIST_Q scsi_sg_q;
- ulong saved_data_addr;
- ulong saved_data_cnt;
- PortAddr iop_base;
- ushort sg_list_dwords;
- ushort sg_index;
- ushort sg_entry_cnt;
- ushort q_addr;
- uchar next_qp;
- iop_base = asc_dvc->iop_base;
- sg_head = scsiq->sg_head;
- saved_data_addr = scsiq->q1.data_addr;
- saved_data_cnt = scsiq->q1.data_cnt;
- scsiq->q1.data_addr = sg_head->sg_list[0].addr;
- scsiq->q1.data_cnt = sg_head->sg_list[0].bytes;
- sg_entry_cnt = sg_head->entry_cnt - 1;
- if (sg_entry_cnt != 0) {
- scsiq->q1.cntl |= QC_SG_HEAD;
- q_addr = ASC_QNO_TO_QADDR(q_no);
- sg_index = 1;
- scsiq->q1.sg_queue_cnt = sg_head->queue_cnt;
- scsi_sg_q.sg_head_qp = q_no;
- scsi_sg_q.cntl = QCSG_SG_XFER_LIST;
- for (i = 0; i < sg_head->queue_cnt; i++) {
- scsi_sg_q.seq_no = i + 1;
- if (sg_entry_cnt > ASC_SG_LIST_PER_Q) {
- sg_list_dwords = (uchar) (ASC_SG_LIST_PER_Q * 2);
- sg_entry_cnt -= ASC_SG_LIST_PER_Q;
- if (i == 0) {
- scsi_sg_q.sg_list_cnt = ASC_SG_LIST_PER_Q;
- scsi_sg_q.sg_cur_list_cnt = ASC_SG_LIST_PER_Q;
- } else {
- scsi_sg_q.sg_list_cnt = ASC_SG_LIST_PER_Q - 1;
- scsi_sg_q.sg_cur_list_cnt = ASC_SG_LIST_PER_Q - 1;
- }
- } else {
- scsi_sg_q.cntl |= QCSG_SG_XFER_END;
- sg_list_dwords = sg_entry_cnt << 1;
- if (i == 0) {
- scsi_sg_q.sg_list_cnt = sg_entry_cnt;
- scsi_sg_q.sg_cur_list_cnt = sg_entry_cnt;
- } else {
- scsi_sg_q.sg_list_cnt = sg_entry_cnt - 1;
- scsi_sg_q.sg_cur_list_cnt = sg_entry_cnt - 1;
- }
- sg_entry_cnt = 0;
- }
- next_qp = AscReadLramByte(iop_base,
- (ushort) (q_addr + ASC_SCSIQ_B_FWD));
- scsi_sg_q.q_no = next_qp;
- q_addr = ASC_QNO_TO_QADDR(next_qp);
- AscMemWordCopyToLram(iop_base,
- (ushort) (q_addr + ASC_SCSIQ_SGHD_CPY_BEG),
- (ushort dosfar *) & scsi_sg_q,
- (ushort) (sizeof (ASC_SG_LIST_Q) >> 1));
- AscMemDWordCopyToLram(iop_base,
- (ushort) (q_addr + ASC_SGQ_LIST_BEG),
- (ulong dosfar *) & sg_head->sg_list[sg_index],
- (ushort) sg_list_dwords);
- sg_index += ASC_SG_LIST_PER_Q;
- }
- } else {
- scsiq->q1.cntl &= ~QC_SG_HEAD;
- }
- sta = AscPutReadyQueue(asc_dvc, scsiq, q_no);
- scsiq->q1.data_addr = saved_data_addr;
- scsiq->q1.data_cnt = saved_data_cnt;
- return (sta);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_Q * scsiq,
+ uchar q_no
+)
+{
+ int sta;
+ int i;
+ ASC_SG_HEAD *sg_head;
+ ASC_SG_LIST_Q scsi_sg_q;
+ ulong saved_data_addr;
+ ulong saved_data_cnt;
+ PortAddr iop_base;
+ ushort sg_list_dwords;
+ ushort sg_index;
+ ushort sg_entry_cnt;
+ ushort q_addr;
+ uchar next_qp;
+ iop_base = asc_dvc->iop_base;
+ sg_head = scsiq->sg_head;
+ saved_data_addr = scsiq->q1.data_addr;
+ saved_data_cnt = scsiq->q1.data_cnt;
+ scsiq->q1.data_addr = sg_head->sg_list[0].addr;
+ scsiq->q1.data_cnt = sg_head->sg_list[0].bytes;
+ sg_entry_cnt = sg_head->entry_cnt - 1;
+ if (sg_entry_cnt != 0) {
+ scsiq->q1.cntl |= QC_SG_HEAD;
+ q_addr = ASC_QNO_TO_QADDR(q_no);
+ sg_index = 1;
+ scsiq->q1.sg_queue_cnt = sg_head->queue_cnt;
+ scsi_sg_q.sg_head_qp = q_no;
+ scsi_sg_q.cntl = QCSG_SG_XFER_LIST;
+ for (i = 0; i < sg_head->queue_cnt; i++) {
+ scsi_sg_q.seq_no = i + 1;
+ if (sg_entry_cnt > ASC_SG_LIST_PER_Q) {
+ sg_list_dwords = (uchar) (ASC_SG_LIST_PER_Q * 2);
+ sg_entry_cnt -= ASC_SG_LIST_PER_Q;
+ if (i == 0) {
+ scsi_sg_q.sg_list_cnt = ASC_SG_LIST_PER_Q;
+ scsi_sg_q.sg_cur_list_cnt = ASC_SG_LIST_PER_Q;
+ } else {
+ scsi_sg_q.sg_list_cnt = ASC_SG_LIST_PER_Q - 1;
+ scsi_sg_q.sg_cur_list_cnt = ASC_SG_LIST_PER_Q - 1;
+ }
+ } else {
+ scsi_sg_q.cntl |= QCSG_SG_XFER_END;
+ sg_list_dwords = sg_entry_cnt << 1;
+ if (i == 0) {
+ scsi_sg_q.sg_list_cnt = sg_entry_cnt;
+ scsi_sg_q.sg_cur_list_cnt = sg_entry_cnt;
+ } else {
+ scsi_sg_q.sg_list_cnt = sg_entry_cnt - 1;
+ scsi_sg_q.sg_cur_list_cnt = sg_entry_cnt - 1;
+ }
+ sg_entry_cnt = 0;
+ }
+ next_qp = AscReadLramByte(iop_base,
+ (ushort) (q_addr + ASC_SCSIQ_B_FWD));
+ scsi_sg_q.q_no = next_qp;
+ q_addr = ASC_QNO_TO_QADDR(next_qp);
+ AscMemWordCopyToLram(iop_base,
+ (ushort) (q_addr + ASC_SCSIQ_SGHD_CPY_BEG),
+ (ushort *) & scsi_sg_q,
+ (ushort) (sizeof (ASC_SG_LIST_Q) >> 1));
+ AscMemDWordCopyToLram(iop_base,
+ (ushort) (q_addr + ASC_SGQ_LIST_BEG),
+ (ulong *) & sg_head->sg_list[sg_index],
+ (ushort) sg_list_dwords);
+ sg_index += ASC_SG_LIST_PER_Q;
+ }
+ } else {
+ scsiq->q1.cntl &= ~QC_SG_HEAD;
+ }
+ sta = AscPutReadyQueue(asc_dvc, scsiq, q_no);
+ scsiq->q1.data_addr = saved_data_addr;
+ scsiq->q1.data_cnt = saved_data_cnt;
+ return (sta);
}
-int
+STATIC int
AscAbortSRB(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- ulong srb_ptr
-)
-{
- int sta;
- ASC_SCSI_BIT_ID_TYPE saved_unit_not_ready;
- PortAddr iop_base;
- iop_base = asc_dvc->iop_base;
- sta = ERR;
- saved_unit_not_ready = asc_dvc->unit_not_ready;
- asc_dvc->unit_not_ready = 0xFF;
- AscWaitISRDone(asc_dvc);
- if (AscStopQueueExe(iop_base) == 1) {
- if (AscRiscHaltedAbortSRB(asc_dvc, srb_ptr) == 1) {
- sta = 1;
- AscCleanUpBusyQueue(iop_base);
- AscStartQueueExe(iop_base);
- } else {
- sta = 0;
- AscStartQueueExe(iop_base);
- }
- }
- asc_dvc->unit_not_ready = saved_unit_not_ready;
- return (sta);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ ulong srb_ptr
+)
+{
+ int sta;
+ ASC_SCSI_BIT_ID_TYPE saved_unit_not_ready;
+ PortAddr iop_base;
+ iop_base = asc_dvc->iop_base;
+ sta = ERR;
+ saved_unit_not_ready = asc_dvc->unit_not_ready;
+ asc_dvc->unit_not_ready = 0xFF;
+ AscWaitISRDone(asc_dvc);
+ if (AscStopQueueExe(iop_base) == 1) {
+ if (AscRiscHaltedAbortSRB(asc_dvc, srb_ptr) == 1) {
+ sta = 1;
+ AscCleanUpBusyQueue(iop_base);
+ AscStartQueueExe(iop_base);
+ } else {
+ sta = 0;
+ AscStartQueueExe(iop_base);
+ }
+ }
+ asc_dvc->unit_not_ready = saved_unit_not_ready;
+ return (sta);
}
-int
+#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
+STATIC int
AscResetDevice(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- uchar target_ix
-)
-{
- PortAddr iop_base;
- int sta;
- uchar tid_no;
- ASC_SCSI_BIT_ID_TYPE target_id;
- int i;
- ASC_SCSI_REQ_Q scsiq_buf;
- ASC_SCSI_REQ_Q dosfar *scsiq;
- uchar dosfar *buf;
- ASC_SCSI_BIT_ID_TYPE saved_unit_not_ready;
- iop_base = asc_dvc->iop_base;
- tid_no = ASC_TIX_TO_TID(target_ix);
- target_id = ASC_TID_TO_TARGET_ID(tid_no);
- saved_unit_not_ready = asc_dvc->unit_not_ready;
- asc_dvc->unit_not_ready = target_id;
- sta = ERR;
- AscWaitTixISRDone(asc_dvc, target_ix);
- if (AscStopQueueExe(iop_base) == 1) {
- if (AscRiscHaltedAbortTIX(asc_dvc, target_ix) == 1) {
- AscCleanUpBusyQueue(iop_base);
- AscStartQueueExe(iop_base);
- AscWaitTixISRDone(asc_dvc, target_ix);
- sta = TRUE;
- scsiq = (ASC_SCSI_REQ_Q dosfar *) & scsiq_buf;
- buf = (uchar dosfar *) & scsiq_buf;
- for (i = 0; i < sizeof (ASC_SCSI_REQ_Q); i++) {
- *buf++ = 0x00;
- }
- scsiq->r1.status = (uchar) QS_READY;
- scsiq->r2.cdb_len = 6;
- scsiq->r2.tag_code = M2_QTAG_MSG_SIMPLE;
- scsiq->r1.target_id = target_id;
- scsiq->r2.target_ix = ASC_TIDLUN_TO_IX(tid_no, 0);
- scsiq->cdbptr = (uchar dosfar *) scsiq->cdb;
- scsiq->r1.cntl = QC_NO_CALLBACK | QC_MSG_OUT | QC_URGENT;
- AscWriteLramByte(asc_dvc->iop_base, ASCV_MSGOUT_BEG,
- M1_BUS_DVC_RESET);
- asc_dvc->unit_not_ready &= ~target_id;
- asc_dvc->sdtr_done |= target_id;
- if (AscExeScsiQueue(asc_dvc, (ASC_SCSI_Q dosfar *) scsiq)
- == 1) {
- asc_dvc->unit_not_ready = target_id;
- DvcSleepMilliSecond(1000);
- _AscWaitQDone(iop_base, (ASC_SCSI_Q dosfar *) scsiq);
- if (AscStopQueueExe(iop_base) == 1) {
- AscCleanUpDiscQueue(iop_base);
- AscStartQueueExe(iop_base);
- if (asc_dvc->pci_fix_asyn_xfer & target_id) {
- AscSetRunChipSynRegAtID(iop_base, tid_no,
- ASYN_SDTR_DATA_FIX_PCI_REV_AB);
- }
- AscWaitTixISRDone(asc_dvc, target_ix);
- }
- } else {
- sta = 0;
- }
- asc_dvc->sdtr_done &= ~target_id;
- } else {
- sta = ERR;
- AscStartQueueExe(iop_base);
- }
- }
- asc_dvc->unit_not_ready = saved_unit_not_ready;
- return (sta);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ uchar target_ix
+)
+{
+ PortAddr iop_base;
+ int sta;
+ uchar tid_no;
+ ASC_SCSI_BIT_ID_TYPE target_id;
+ int i;
+ ASC_SCSI_REQ_Q scsiq_buf;
+ ASC_SCSI_REQ_Q *scsiq;
+ uchar *buf;
+ ASC_SCSI_BIT_ID_TYPE saved_unit_not_ready;
+ iop_base = asc_dvc->iop_base;
+ tid_no = ASC_TIX_TO_TID(target_ix);
+ target_id = ASC_TID_TO_TARGET_ID(tid_no);
+ saved_unit_not_ready = asc_dvc->unit_not_ready;
+ asc_dvc->unit_not_ready = target_id;
+ sta = ERR;
+ AscWaitTixISRDone(asc_dvc, target_ix);
+ if (AscStopQueueExe(iop_base) == 1) {
+ if (AscRiscHaltedAbortTIX(asc_dvc, target_ix) == 1) {
+ AscCleanUpBusyQueue(iop_base);
+ AscStartQueueExe(iop_base);
+ AscWaitTixISRDone(asc_dvc, target_ix);
+ sta = TRUE;
+ scsiq = (ASC_SCSI_REQ_Q *) & scsiq_buf;
+ buf = (uchar *) & scsiq_buf;
+ for (i = 0; i < sizeof (ASC_SCSI_REQ_Q); i++) {
+ *buf++ = 0x00;
+ }
+ scsiq->r1.status = (uchar) QS_READY;
+ scsiq->r2.cdb_len = 6;
+ scsiq->r2.tag_code = M2_QTAG_MSG_SIMPLE;
+ scsiq->r1.target_id = target_id;
+ scsiq->r2.target_ix = ASC_TIDLUN_TO_IX(tid_no, 0);
+ scsiq->cdbptr = (uchar *) scsiq->cdb;
+ scsiq->r1.cntl = QC_NO_CALLBACK | QC_MSG_OUT | QC_URGENT;
+ AscWriteLramByte(asc_dvc->iop_base, ASCV_MSGOUT_BEG,
+ M1_BUS_DVC_RESET);
+ asc_dvc->unit_not_ready &= ~target_id;
+ asc_dvc->sdtr_done |= target_id;
+ if (AscExeScsiQueue(asc_dvc, (ASC_SCSI_Q *) scsiq)
+ == 1) {
+ asc_dvc->unit_not_ready = target_id;
+ DvcSleepMilliSecond(1000);
+ _AscWaitQDone(iop_base, (ASC_SCSI_Q *) scsiq);
+ if (AscStopQueueExe(iop_base) == 1) {
+ AscCleanUpDiscQueue(iop_base);
+ AscStartQueueExe(iop_base);
+ if (asc_dvc->pci_fix_asyn_xfer & target_id) {
+ AscSetRunChipSynRegAtID(iop_base, tid_no,
+ ASYN_SDTR_DATA_FIX_PCI_REV_AB);
+ }
+ AscWaitTixISRDone(asc_dvc, target_ix);
+ }
+ } else {
+ sta = 0;
+ }
+ asc_dvc->sdtr_done &= ~target_id;
+ } else {
+ sta = ERR;
+ AscStartQueueExe(iop_base);
+ }
+ }
+ asc_dvc->unit_not_ready = saved_unit_not_ready;
+ return (sta);
}
+#endif /* version >= v1.3.89 */
-int
+STATIC int
AscResetSB(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc
-)
-{
- int sta;
- int i;
- PortAddr iop_base;
- iop_base = asc_dvc->iop_base;
- asc_dvc->unit_not_ready = 0xFF;
- sta = TRUE;
- AscWaitISRDone(asc_dvc);
- AscStopQueueExe(iop_base);
- asc_dvc->sdtr_done = 0;
- AscResetChipAndScsiBus(iop_base);
- DvcSleepMilliSecond((ulong) ((ushort) asc_dvc->scsi_reset_wait * 1000));
- AscReInitLram(asc_dvc);
- for (i = 0; i <= ASC_MAX_TID; i++) {
- asc_dvc->cur_dvc_qng[i] = 0;
- if (asc_dvc->pci_fix_asyn_xfer & (ASC_SCSI_BIT_ID_TYPE) (0x01 << i)) {
- AscSetChipSynRegAtID(iop_base, i, ASYN_SDTR_DATA_FIX_PCI_REV_AB);
- }
- }
- asc_dvc->err_code = 0;
- AscSetPCAddr(iop_base, ASC_MCODE_START_ADDR);
- if (AscGetPCAddr(iop_base) != ASC_MCODE_START_ADDR) {
- sta = ERR;
- }
- if (AscStartChip(iop_base) == 0) {
- sta = ERR;
- }
- AscStartQueueExe(iop_base);
- asc_dvc->unit_not_ready = 0;
- asc_dvc->queue_full_or_busy = 0;
- return (sta);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+{
+ int sta;
+ int i;
+ PortAddr iop_base;
+ iop_base = asc_dvc->iop_base;
+ asc_dvc->unit_not_ready = 0xFF;
+ sta = TRUE;
+ AscWaitISRDone(asc_dvc);
+ AscStopQueueExe(iop_base);
+ asc_dvc->sdtr_done = 0;
+ AscResetChipAndScsiBus(iop_base);
+ DvcSleepMilliSecond((ulong) ((ushort) asc_dvc->scsi_reset_wait * 1000));
+ AscReInitLram(asc_dvc);
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ asc_dvc->cur_dvc_qng[i] = 0;
+ if (asc_dvc->pci_fix_asyn_xfer & (ASC_SCSI_BIT_ID_TYPE) (0x01 << i)) {
+ AscSetChipSynRegAtID(iop_base, i, ASYN_SDTR_DATA_FIX_PCI_REV_AB);
+ }
+ }
+ asc_dvc->err_code = 0;
+ AscSetPCAddr(iop_base, ASC_MCODE_START_ADDR);
+ if (AscGetPCAddr(iop_base) != ASC_MCODE_START_ADDR) {
+ sta = ERR;
+ }
+ if (AscStartChip(iop_base) == 0) {
+ sta = ERR;
+ }
+ AscStartQueueExe(iop_base);
+ asc_dvc->unit_not_ready = 0;
+ asc_dvc->queue_full_or_busy = 0;
+ return (sta);
}
-int
+STATIC int
AscSetRunChipSynRegAtID(
- PortAddr iop_base,
- uchar tid_no,
- uchar sdtr_data
+ PortAddr iop_base,
+ uchar tid_no,
+ uchar sdtr_data
)
{
- int sta = FALSE;
- if (AscHostReqRiscHalt(iop_base)) {
- sta = AscSetChipSynRegAtID(iop_base, tid_no, sdtr_data);
- AscStartChip(iop_base);
- return (sta);
- }
- return (sta);
+ int sta = FALSE;
+ if (AscHostReqRiscHalt(iop_base)) {
+ sta = AscSetChipSynRegAtID(iop_base, tid_no, sdtr_data);
+ AscStartChip(iop_base);
+ return (sta);
+ }
+ return (sta);
}
-int
+STATIC int
AscSetChipSynRegAtID(
- PortAddr iop_base,
- uchar id,
- uchar sdtr_data
-)
-{
- ASC_SCSI_BIT_ID_TYPE org_id;
- int i;
- int sta;
- sta = TRUE;
- AscSetBank(iop_base, 1);
- org_id = AscReadChipDvcID(iop_base);
- for (i = 0; i <= ASC_MAX_TID; i++) {
- if (org_id == (0x01 << i))
- break;
- }
- org_id = i;
- AscWriteChipDvcID(iop_base, id);
- if (AscReadChipDvcID(iop_base) == (0x01 << id)) {
- AscSetBank(iop_base, 0);
- AscSetChipSyn(iop_base, sdtr_data);
- if (AscGetChipSyn(iop_base) != sdtr_data) {
- sta = FALSE;
- }
- } else {
- sta = FALSE;
- }
- AscSetBank(iop_base, 1);
- AscWriteChipDvcID(iop_base, org_id);
- AscSetBank(iop_base, 0);
- return (sta);
+ PortAddr iop_base,
+ uchar id,
+ uchar sdtr_data
+)
+{
+ ASC_SCSI_BIT_ID_TYPE org_id;
+ int i;
+ int sta;
+ sta = TRUE;
+ AscSetBank(iop_base, 1);
+ org_id = AscReadChipDvcID(iop_base);
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ if (org_id == (0x01 << i))
+ break;
+ }
+ org_id = i;
+ AscWriteChipDvcID(iop_base, id);
+ if (AscReadChipDvcID(iop_base) == (0x01 << id)) {
+ AscSetBank(iop_base, 0);
+ AscSetChipSyn(iop_base, sdtr_data);
+ if (AscGetChipSyn(iop_base) != sdtr_data) {
+ sta = FALSE;
+ }
+ } else {
+ sta = FALSE;
+ }
+ AscSetBank(iop_base, 1);
+ AscWriteChipDvcID(iop_base, org_id);
+ AscSetBank(iop_base, 0);
+ return (sta);
}
-int
+STATIC int
AscReInitLram(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc
)
{
- AscInitLram(asc_dvc);
- AscInitQLinkVar(asc_dvc);
- return (0);
+ AscInitLram(asc_dvc);
+ AscInitQLinkVar(asc_dvc);
+ return (0);
}
-ushort
+STATIC ushort
AscInitLram(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc
-)
-{
- uchar i;
- ushort s_addr;
- PortAddr iop_base;
- ushort warn_code;
- iop_base = asc_dvc->iop_base;
- warn_code = 0;
- AscMemWordSetLram(iop_base, ASC_QADR_BEG, 0,
- (ushort) (((int) (asc_dvc->max_total_qng + 2 + 1) * 64) >> 1)
- );
- i = ASC_MIN_ACTIVE_QNO;
- s_addr = ASC_QADR_BEG + ASC_QBLK_SIZE;
- AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_FWD),
- (uchar) (i + 1));
- AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_BWD),
- (uchar) (asc_dvc->max_total_qng));
- AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_QNO),
- (uchar) i);
- i++;
- s_addr += ASC_QBLK_SIZE;
- for (; i < asc_dvc->max_total_qng; i++, s_addr += ASC_QBLK_SIZE) {
- AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_FWD),
- (uchar) (i + 1));
- AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_BWD),
- (uchar) (i - 1));
- AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_QNO),
- (uchar) i);
- }
- AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_FWD),
- (uchar) ASC_QLINK_END);
- AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_BWD),
- (uchar) (asc_dvc->max_total_qng - 1));
- AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_QNO),
- (uchar) asc_dvc->max_total_qng);
- i++;
- s_addr += ASC_QBLK_SIZE;
- for (; i <= (uchar) (asc_dvc->max_total_qng + 3);
- i++, s_addr += ASC_QBLK_SIZE) {
- AscWriteLramByte(iop_base,
- (ushort) (s_addr + (ushort) ASC_SCSIQ_B_FWD), i);
- AscWriteLramByte(iop_base,
- (ushort) (s_addr + (ushort) ASC_SCSIQ_B_BWD), i);
- AscWriteLramByte(iop_base,
- (ushort) (s_addr + (ushort) ASC_SCSIQ_B_QNO), i);
- }
- return (warn_code);
-}
-
-ushort
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+{
+ uchar i;
+ ushort s_addr;
+ PortAddr iop_base;
+ ushort warn_code;
+ iop_base = asc_dvc->iop_base;
+ warn_code = 0;
+ AscMemWordSetLram(iop_base, ASC_QADR_BEG, 0,
+ (ushort) (((int) (asc_dvc->max_total_qng + 2 + 1) * 64) >> 1)
+);
+ i = ASC_MIN_ACTIVE_QNO;
+ s_addr = ASC_QADR_BEG + ASC_QBLK_SIZE;
+ AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_FWD),
+ (uchar) (i + 1));
+ AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_BWD),
+ (uchar) (asc_dvc->max_total_qng));
+ AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_QNO),
+ (uchar) i);
+ i++;
+ s_addr += ASC_QBLK_SIZE;
+ for (; i < asc_dvc->max_total_qng; i++, s_addr += ASC_QBLK_SIZE) {
+ AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_FWD),
+ (uchar) (i + 1));
+ AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_BWD),
+ (uchar) (i - 1));
+ AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_QNO),
+ (uchar) i);
+ }
+ AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_FWD),
+ (uchar) ASC_QLINK_END);
+ AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_BWD),
+ (uchar) (asc_dvc->max_total_qng - 1));
+ AscWriteLramByte(iop_base, (ushort) (s_addr + ASC_SCSIQ_B_QNO),
+ (uchar) asc_dvc->max_total_qng);
+ i++;
+ s_addr += ASC_QBLK_SIZE;
+ for (; i <= (uchar) (asc_dvc->max_total_qng + 3);
+ i++, s_addr += ASC_QBLK_SIZE) {
+ AscWriteLramByte(iop_base,
+ (ushort) (s_addr + (ushort) ASC_SCSIQ_B_FWD), i);
+ AscWriteLramByte(iop_base,
+ (ushort) (s_addr + (ushort) ASC_SCSIQ_B_BWD), i);
+ AscWriteLramByte(iop_base,
+ (ushort) (s_addr + (ushort) ASC_SCSIQ_B_QNO), i);
+ }
+ return (warn_code);
+}
+
+STATIC ushort
AscInitQLinkVar(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc
-)
-{
- PortAddr iop_base;
- int i;
- ushort lram_addr;
- iop_base = asc_dvc->iop_base;
- AscPutRiscVarFreeQHead(iop_base, 1);
- AscPutRiscVarDoneQTail(iop_base, asc_dvc->max_total_qng);
- AscPutVarFreeQHead(iop_base, 1);
- AscPutVarDoneQTail(iop_base, asc_dvc->max_total_qng);
- AscWriteLramByte(iop_base, ASCV_BUSY_QHEAD_B,
- (uchar) ((int) asc_dvc->max_total_qng + 1));
- AscWriteLramByte(iop_base, ASCV_DISC1_QHEAD_B,
- (uchar) ((int) asc_dvc->max_total_qng + 2));
- AscWriteLramByte(iop_base, (ushort) ASCV_TOTAL_READY_Q_B,
- asc_dvc->max_total_qng);
- AscWriteLramWord(iop_base, ASCV_ASCDVC_ERR_CODE_W, 0);
- AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
- AscWriteLramByte(iop_base, ASCV_STOP_CODE_B, 0);
- AscWriteLramByte(iop_base, ASCV_SCSIBUSY_B, 0);
- AscWriteLramByte(iop_base, ASCV_WTM_FLAG_B, 0);
- AscPutQDoneInProgress(iop_base, 0);
- lram_addr = ASC_QADR_BEG;
- for (i = 0; i < 32; i++, lram_addr += 2) {
- AscWriteLramWord(iop_base, lram_addr, 0);
- }
- return (0);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+{
+ PortAddr iop_base;
+ int i;
+ ushort lram_addr;
+ iop_base = asc_dvc->iop_base;
+ AscPutRiscVarFreeQHead(iop_base, 1);
+ AscPutRiscVarDoneQTail(iop_base, asc_dvc->max_total_qng);
+ AscPutVarFreeQHead(iop_base, 1);
+ AscPutVarDoneQTail(iop_base, asc_dvc->max_total_qng);
+ AscWriteLramByte(iop_base, ASCV_BUSY_QHEAD_B,
+ (uchar) ((int) asc_dvc->max_total_qng + 1));
+ AscWriteLramByte(iop_base, ASCV_DISC1_QHEAD_B,
+ (uchar) ((int) asc_dvc->max_total_qng + 2));
+ AscWriteLramByte(iop_base, (ushort) ASCV_TOTAL_READY_Q_B,
+ asc_dvc->max_total_qng);
+ AscWriteLramWord(iop_base, ASCV_ASCDVC_ERR_CODE_W, 0);
+ AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0);
+ AscWriteLramByte(iop_base, ASCV_STOP_CODE_B, 0);
+ AscWriteLramByte(iop_base, ASCV_SCSIBUSY_B, 0);
+ AscWriteLramByte(iop_base, ASCV_WTM_FLAG_B, 0);
+ AscPutQDoneInProgress(iop_base, 0);
+ lram_addr = ASC_QADR_BEG;
+ for (i = 0; i < 32; i++, lram_addr += 2) {
+ AscWriteLramWord(iop_base, lram_addr, 0);
+ }
+ return (0);
}
-int
+STATIC int
AscSetLibErrorCode(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- ushort err_code
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ ushort err_code
)
{
- if (asc_dvc->err_code == 0) {
- asc_dvc->err_code = err_code;
- AscWriteLramWord(asc_dvc->iop_base, ASCV_ASCDVC_ERR_CODE_W,
- err_code);
- }
- return (err_code);
+ if (asc_dvc->err_code == 0) {
+ asc_dvc->err_code = err_code;
+ AscWriteLramWord(asc_dvc->iop_base, ASCV_ASCDVC_ERR_CODE_W,
+ err_code);
+ }
+ return (err_code);
}
-int
+#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
+STATIC int
_AscWaitQDone(
- PortAddr iop_base,
- REG ASC_SCSI_Q dosfar * scsiq
-)
-{
- ushort q_addr;
- uchar q_status;
- int count = 0;
- while (scsiq->q1.q_no == 0) ;
- q_addr = ASC_QNO_TO_QADDR(scsiq->q1.q_no);
- do {
- q_status = AscReadLramByte(iop_base, q_addr + ASC_SCSIQ_B_STATUS);
- DvcSleepMilliSecond(100L);
- if (count++ > 30) {
- return (0);
- }
- } while ((q_status & QS_READY) != 0);
- return (1);
-}
-
-uchar
+ PortAddr iop_base,
+ REG ASC_SCSI_Q * scsiq
+)
+{
+ ushort q_addr;
+ uchar q_status;
+ int count = 0;
+ while (scsiq->q1.q_no == 0) ;
+ q_addr = ASC_QNO_TO_QADDR(scsiq->q1.q_no);
+ do {
+ q_status = AscReadLramByte(iop_base, q_addr + ASC_SCSIQ_B_STATUS);
+ DvcSleepMilliSecond(100L);
+ if (count++ > 30) {
+ return (0);
+ }
+ } while ((q_status & QS_READY) != 0);
+ return (1);
+}
+#endif /* version >= v1.3.89 */
+
+STATIC uchar
AscMsgOutSDTR(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- uchar sdtr_period,
- uchar sdtr_offset
-)
-{
- SDTR_XMSG sdtr_buf;
- uchar sdtr_period_index;
- PortAddr iop_base;
- iop_base = asc_dvc->iop_base;
- sdtr_buf.msg_type = MS_EXTEND;
- sdtr_buf.msg_len = MS_SDTR_LEN;
- sdtr_buf.msg_req = MS_SDTR_CODE;
- sdtr_buf.xfer_period = sdtr_period;
- sdtr_offset &= ASC_SYN_MAX_OFFSET;
- sdtr_buf.req_ack_offset = sdtr_offset;
- if ((sdtr_period_index =
- AscGetSynPeriodIndex(asc_dvc, sdtr_period)) <=
- asc_dvc->max_sdtr_index) {
- AscMemWordCopyToLram(iop_base,
- ASCV_MSGOUT_BEG,
- (ushort dosfar *) & sdtr_buf, SYN_XMSG_WLEN);
- return ((sdtr_period_index << 4) | sdtr_offset);
- } else {
- sdtr_buf.req_ack_offset = 0;
- AscMemWordCopyToLram(iop_base,
- ASCV_MSGOUT_BEG,
- (ushort dosfar *) & sdtr_buf, SYN_XMSG_WLEN);
- return (0);
- }
-}
-
-uchar
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ uchar sdtr_period,
+ uchar sdtr_offset
+)
+{
+ EXT_MSG sdtr_buf;
+ uchar sdtr_period_index;
+ PortAddr iop_base;
+
+ iop_base = asc_dvc->iop_base;
+ sdtr_buf.msg_type = MS_EXTEND;
+ sdtr_buf.msg_len = MS_SDTR_LEN;
+ sdtr_buf.msg_req = MS_SDTR_CODE;
+ sdtr_buf.xfer_period = sdtr_period;
+ sdtr_offset &= ASC_SYN_MAX_OFFSET;
+ sdtr_buf.req_ack_offset = sdtr_offset;
+ if ((sdtr_period_index =
+ AscGetSynPeriodIndex(asc_dvc, sdtr_period)) <=
+ asc_dvc->max_sdtr_index) {
+ AscMemWordCopyToLram(iop_base,
+ ASCV_MSGOUT_BEG,
+ (ushort *) & sdtr_buf,
+ (ushort) (sizeof (EXT_MSG) >> 1));
+ return ((sdtr_period_index << 4) | sdtr_offset);
+ } else {
+
+ sdtr_buf.req_ack_offset = 0;
+ AscMemWordCopyToLram(iop_base,
+ ASCV_MSGOUT_BEG,
+ (ushort *) & sdtr_buf,
+ (ushort) (sizeof (EXT_MSG) >> 1));
+ return (0);
+ }
+}
+
+STATIC uchar
AscCalSDTRData(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- uchar sdtr_period,
- uchar syn_offset
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ uchar sdtr_period,
+ uchar syn_offset
)
{
- uchar byte;
- uchar sdtr_period_ix;
- sdtr_period_ix = AscGetSynPeriodIndex(asc_dvc, sdtr_period);
- if (
- (sdtr_period_ix > asc_dvc->max_sdtr_index)
- ) {
- return (0xFF);
- }
- byte = (sdtr_period_ix << 4) | (syn_offset & ASC_SYN_MAX_OFFSET);
- return (byte);
+ uchar byte;
+ uchar sdtr_period_ix;
+ sdtr_period_ix = AscGetSynPeriodIndex(asc_dvc, sdtr_period);
+ if (
+ (sdtr_period_ix > asc_dvc->max_sdtr_index)
+) {
+ return (0xFF);
+ }
+ byte = (sdtr_period_ix << 4) | (syn_offset & ASC_SYN_MAX_OFFSET);
+ return (byte);
}
-void
+STATIC void
AscSetChipSDTR(
- PortAddr iop_base,
- uchar sdtr_data,
- uchar tid_no
+ PortAddr iop_base,
+ uchar sdtr_data,
+ uchar tid_no
)
{
- AscSetChipSynRegAtID(iop_base, tid_no, sdtr_data);
- AscPutMCodeSDTRDoneAtID(iop_base, tid_no, sdtr_data);
- return;
+ AscSetChipSynRegAtID(iop_base, tid_no, sdtr_data);
+ AscPutMCodeSDTRDoneAtID(iop_base, tid_no, sdtr_data);
+ return;
}
-uchar
+STATIC uchar
AscGetSynPeriodIndex(
- ASC_DVC_VAR asc_ptr_type * asc_dvc,
- ruchar syn_time
-)
-{
- ruchar *period_table;
- int max_index;
- int min_index;
- int i;
- period_table = asc_dvc->sdtr_period_tbl;
- max_index = (int) asc_dvc->max_sdtr_index;
- min_index = ( int )asc_dvc->host_init_sdtr_index ;
- if (
- (syn_time <= period_table[max_index])
- ) {
- for (i = min_index; i < (max_index - 1); i++) {
- if (syn_time <= period_table[i]) {
- return ((uchar) i);
- }
- }
- return ((uchar) max_index);
- } else {
- return ((uchar) (max_index + 1));
- }
-}
-
-uchar
+ ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ ruchar syn_time
+)
+{
+ ruchar *period_table;
+ int max_index;
+ int min_index;
+ int i;
+ period_table = asc_dvc->sdtr_period_tbl;
+ max_index = (int) asc_dvc->max_sdtr_index;
+ min_index = (int)asc_dvc->host_init_sdtr_index ;
+ if ((syn_time <= period_table[max_index])) {
+ for (i = min_index; i < (max_index - 1); i++) {
+ if (syn_time <= period_table[i]) {
+ return ((uchar) i);
+ }
+ }
+ return ((uchar) max_index);
+ } else {
+ return ((uchar) (max_index + 1));
+ }
+}
+
+STATIC uchar
AscAllocFreeQueue(
- PortAddr iop_base,
- uchar free_q_head
-)
-{
- ushort q_addr;
- uchar next_qp;
- uchar q_status;
- q_addr = ASC_QNO_TO_QADDR(free_q_head);
- q_status = (uchar) AscReadLramByte(iop_base,
- (ushort) (q_addr + ASC_SCSIQ_B_STATUS));
- next_qp = AscReadLramByte(iop_base,
- (ushort) (q_addr + ASC_SCSIQ_B_FWD));
- if (
- ((q_status & QS_READY) == 0)
- && (next_qp != ASC_QLINK_END)
- ) {
- return (next_qp);
- }
- return (ASC_QLINK_END);
-}
-
-uchar
+ PortAddr iop_base,
+ uchar free_q_head
+)
+{
+ ushort q_addr;
+ uchar next_qp;
+ uchar q_status;
+ q_addr = ASC_QNO_TO_QADDR(free_q_head);
+ q_status = (uchar) AscReadLramByte(iop_base,
+ (ushort) (q_addr + ASC_SCSIQ_B_STATUS));
+ next_qp = AscReadLramByte(iop_base,
+ (ushort) (q_addr + ASC_SCSIQ_B_FWD));
+ if (((q_status & QS_READY) == 0) && (next_qp != ASC_QLINK_END)) {
+ return (next_qp);
+ }
+ return (ASC_QLINK_END);
+}
+
+STATIC uchar
AscAllocMultipleFreeQueue(
- PortAddr iop_base,
- uchar free_q_head,
- uchar n_free_q
+ PortAddr iop_base,
+ uchar free_q_head,
+ uchar n_free_q
)
{
- uchar i;
- for (i = 0; i < n_free_q; i++) {
- if ((free_q_head = AscAllocFreeQueue(iop_base, free_q_head))
- == ASC_QLINK_END) {
- return (ASC_QLINK_END);
- }
- }
- return (free_q_head);
+ uchar i;
+ for (i = 0; i < n_free_q; i++) {
+ if ((free_q_head = AscAllocFreeQueue(iop_base, free_q_head))
+ == ASC_QLINK_END) {
+ return (ASC_QLINK_END);
+ }
+ }
+ return (free_q_head);
}
-int
+STATIC int
AscRiscHaltedAbortSRB(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- ulong srb_ptr
-)
-{
- PortAddr iop_base;
- ushort q_addr;
- uchar q_no;
- ASC_QDONE_INFO scsiq_buf;
- ASC_QDONE_INFO dosfar *scsiq;
- ASC_ISR_CALLBACK asc_isr_callback;
- int last_int_level;
- iop_base = asc_dvc->iop_base;
- asc_isr_callback = (ASC_ISR_CALLBACK) asc_dvc->isr_callback;
- last_int_level = DvcEnterCritical();
- scsiq = (ASC_QDONE_INFO dosfar *) & scsiq_buf;
-#if CC_LINK_BUSY_Q
- _AscAbortSrbBusyQueue(asc_dvc, scsiq, srb_ptr);
-#endif
- for (q_no = ASC_MIN_ACTIVE_QNO; q_no <= asc_dvc->max_total_qng;
- q_no++) {
- q_addr = ASC_QNO_TO_QADDR(q_no);
- scsiq->d2.srb_ptr = AscReadLramDWord(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_D_SRBPTR));
- if (scsiq->d2.srb_ptr == srb_ptr) {
- _AscCopyLramScsiDoneQ(iop_base, q_addr, scsiq, asc_dvc->max_dma_count);
- if (
- ((scsiq->q_status & QS_READY) != 0)
- && ((scsiq->q_status & QS_ABORTED) == 0)
- && ((scsiq->cntl & QCSG_SG_XFER_LIST) == 0)
- ) {
- scsiq->q_status |= QS_ABORTED;
- scsiq->d3.done_stat = QD_ABORTED_BY_HOST;
- AscWriteLramDWord(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_D_SRBPTR),
- 0L);
- AscWriteLramByte(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_B_STATUS),
- scsiq->q_status);
- (*asc_isr_callback) (asc_dvc, scsiq);
- return (1);
- }
- }
- }
- DvcLeaveCritical(last_int_level);
- return (0);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ ulong srb_ptr
+)
+{
+ PortAddr iop_base;
+ ushort q_addr;
+ uchar q_no;
+ ASC_QDONE_INFO scsiq_buf;
+ ASC_QDONE_INFO *scsiq;
+ ASC_ISR_CALLBACK asc_isr_callback;
+ int last_int_level;
+ iop_base = asc_dvc->iop_base;
+ asc_isr_callback = (ASC_ISR_CALLBACK) asc_dvc->isr_callback;
+ last_int_level = DvcEnterCritical();
+ scsiq = (ASC_QDONE_INFO *) & scsiq_buf;
+ for (q_no = ASC_MIN_ACTIVE_QNO; q_no <= asc_dvc->max_total_qng;
+ q_no++) {
+ q_addr = ASC_QNO_TO_QADDR(q_no);
+ scsiq->d2.srb_ptr = AscReadLramDWord(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_D_SRBPTR));
+ if (scsiq->d2.srb_ptr == srb_ptr) {
+ _AscCopyLramScsiDoneQ(iop_base, q_addr, scsiq, asc_dvc->max_dma_count);
+ if (((scsiq->q_status & QS_READY) != 0)
+ && ((scsiq->q_status & QS_ABORTED) == 0)
+ && ((scsiq->cntl & QCSG_SG_XFER_LIST) == 0)) {
+ scsiq->q_status |= QS_ABORTED;
+ scsiq->d3.done_stat = QD_ABORTED_BY_HOST;
+ AscWriteLramDWord(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_D_SRBPTR),
+ 0L);
+ AscWriteLramByte(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_B_STATUS),
+ scsiq->q_status);
+ (*asc_isr_callback) (asc_dvc, scsiq);
+ return (1);
+ }
+ }
+ }
+ DvcLeaveCritical(last_int_level);
+ return (0);
}
-int
+#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
+STATIC int
AscRiscHaltedAbortTIX(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- uchar target_ix
-)
-{
- PortAddr iop_base;
- ushort q_addr;
- uchar q_no;
- ASC_QDONE_INFO scsiq_buf;
- ASC_QDONE_INFO dosfar *scsiq;
- ASC_ISR_CALLBACK asc_isr_callback;
- int last_int_level;
-#if CC_LINK_BUSY_Q
- uchar tid_no;
-#endif
- iop_base = asc_dvc->iop_base;
- asc_isr_callback = (ASC_ISR_CALLBACK) asc_dvc->isr_callback;
- last_int_level = DvcEnterCritical();
- scsiq = (ASC_QDONE_INFO dosfar *) & scsiq_buf;
-#if CC_LINK_BUSY_Q
- tid_no = ASC_TIX_TO_TID(target_ix);
- _AscAbortTidBusyQueue(asc_dvc, scsiq, tid_no);
-#endif
- for (q_no = ASC_MIN_ACTIVE_QNO; q_no <= asc_dvc->max_total_qng;
- q_no++) {
- q_addr = ASC_QNO_TO_QADDR(q_no);
- _AscCopyLramScsiDoneQ(iop_base, q_addr, scsiq, asc_dvc->max_dma_count);
- if (
- ((scsiq->q_status & QS_READY) != 0)
- && ((scsiq->q_status & QS_ABORTED) == 0)
- && ((scsiq->cntl & QCSG_SG_XFER_LIST) == 0)
- ) {
- if (scsiq->d2.target_ix == target_ix) {
- scsiq->q_status |= QS_ABORTED;
- scsiq->d3.done_stat = QD_ABORTED_BY_HOST;
- AscWriteLramDWord(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_D_SRBPTR),
- 0L);
- AscWriteLramByte(iop_base,
- (ushort) (q_addr + (ushort) ASC_SCSIQ_B_STATUS),
- scsiq->q_status);
- (*asc_isr_callback) (asc_dvc, scsiq);
- }
- }
- }
- DvcLeaveCritical(last_int_level);
- return (1);
-}
-
-#if CC_LINK_BUSY_Q
-
-#endif
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ uchar target_ix
+)
+{
+ PortAddr iop_base;
+ ushort q_addr;
+ uchar q_no;
+ ASC_QDONE_INFO scsiq_buf;
+ ASC_QDONE_INFO *scsiq;
+ ASC_ISR_CALLBACK asc_isr_callback;
+ int last_int_level;
+ iop_base = asc_dvc->iop_base;
+ asc_isr_callback = (ASC_ISR_CALLBACK) asc_dvc->isr_callback;
+ last_int_level = DvcEnterCritical();
+ scsiq = (ASC_QDONE_INFO *) & scsiq_buf;
+ for (q_no = ASC_MIN_ACTIVE_QNO; q_no <= asc_dvc->max_total_qng;
+ q_no++) {
+ q_addr = ASC_QNO_TO_QADDR(q_no);
+ _AscCopyLramScsiDoneQ(iop_base, q_addr, scsiq, asc_dvc->max_dma_count);
+ if (((scsiq->q_status & QS_READY) != 0) &&
+ ((scsiq->q_status & QS_ABORTED) == 0) &&
+ ((scsiq->cntl & QCSG_SG_XFER_LIST) == 0)) {
+ if (scsiq->d2.target_ix == target_ix) {
+ scsiq->q_status |= QS_ABORTED;
+ scsiq->d3.done_stat = QD_ABORTED_BY_HOST;
+ AscWriteLramDWord(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_D_SRBPTR),
+ 0L);
+ AscWriteLramByte(iop_base,
+ (ushort) (q_addr + (ushort) ASC_SCSIQ_B_STATUS),
+ scsiq->q_status);
+ (*asc_isr_callback) (asc_dvc, scsiq);
+ }
+ }
+ }
+ DvcLeaveCritical(last_int_level);
+ return (1);
+}
+#endif /* version >= v1.3.89 */
-int
+STATIC int
AscHostReqRiscHalt(
- PortAddr iop_base
-)
-{
- int count = 0;
- int sta = 0;
- uchar saved_stop_code;
- if (AscIsChipHalted(iop_base))
- return (1);
- saved_stop_code = AscReadLramByte(iop_base, ASCV_STOP_CODE_B);
- AscWriteLramByte(iop_base, ASCV_STOP_CODE_B,
- ASC_STOP_HOST_REQ_RISC_HALT | ASC_STOP_REQ_RISC_STOP
- );
- do {
- if (AscIsChipHalted(iop_base)) {
- sta = 1;
- break;
- }
- DvcSleepMilliSecond(100);
- } while (count++ < 20);
- AscWriteLramByte(iop_base, ASCV_STOP_CODE_B, saved_stop_code);
- return (sta);
+ PortAddr iop_base
+)
+{
+ int count = 0;
+ int sta = 0;
+ uchar saved_stop_code;
+ if (AscIsChipHalted(iop_base))
+ return (1);
+ saved_stop_code = AscReadLramByte(iop_base, ASCV_STOP_CODE_B);
+ AscWriteLramByte(iop_base, ASCV_STOP_CODE_B,
+ ASC_STOP_HOST_REQ_RISC_HALT | ASC_STOP_REQ_RISC_STOP
+);
+ do {
+ if (AscIsChipHalted(iop_base)) {
+ sta = 1;
+ break;
+ }
+ DvcSleepMilliSecond(100);
+ } while (count++ < 20);
+ AscWriteLramByte(iop_base, ASCV_STOP_CODE_B, saved_stop_code);
+ return (sta);
}
-int
+STATIC int
AscStopQueueExe(
- PortAddr iop_base
-)
-{
- int count;
- count = 0;
- if (AscReadLramByte(iop_base, ASCV_STOP_CODE_B) == 0) {
- AscWriteLramByte(iop_base, ASCV_STOP_CODE_B,
- ASC_STOP_REQ_RISC_STOP);
- do {
- if (
- AscReadLramByte(iop_base, ASCV_STOP_CODE_B) &
- ASC_STOP_ACK_RISC_STOP) {
- return (1);
- }
- DvcSleepMilliSecond(100);
- } while (count++ < 20);
- }
- return (0);
+ PortAddr iop_base
+)
+{
+ int count;
+ count = 0;
+ if (AscReadLramByte(iop_base, ASCV_STOP_CODE_B) == 0) {
+ AscWriteLramByte(iop_base, ASCV_STOP_CODE_B,
+ ASC_STOP_REQ_RISC_STOP);
+ do {
+ if (
+ AscReadLramByte(iop_base, ASCV_STOP_CODE_B) &
+ ASC_STOP_ACK_RISC_STOP) {
+ return (1);
+ }
+ DvcSleepMilliSecond(100);
+ } while (count++ < 20);
+ }
+ return (0);
}
-int
+STATIC int
AscStartQueueExe(
- PortAddr iop_base
+ PortAddr iop_base
)
{
- if (AscReadLramByte(iop_base, ASCV_STOP_CODE_B) != 0) {
- AscWriteLramByte(iop_base, ASCV_STOP_CODE_B, 0);
- }
- return (1);
+ if (AscReadLramByte(iop_base, ASCV_STOP_CODE_B) != 0) {
+ AscWriteLramByte(iop_base, ASCV_STOP_CODE_B, 0);
+ }
+ return (1);
}
-int
+STATIC int
AscCleanUpBusyQueue(
- PortAddr iop_base
+ PortAddr iop_base
)
{
- int count;
- uchar stop_code;
- count = 0;
- if (AscReadLramByte(iop_base, ASCV_STOP_CODE_B) != 0) {
- AscWriteLramByte(iop_base, ASCV_STOP_CODE_B,
- ASC_STOP_CLEAN_UP_BUSY_Q);
- do {
- stop_code = AscReadLramByte(iop_base, ASCV_STOP_CODE_B);
- if ((stop_code & ASC_STOP_CLEAN_UP_BUSY_Q) == 0)
- break;
- DvcSleepMilliSecond(100);
- } while (count++ < 20);
- }
- return (1);
+ int count;
+ uchar stop_code;
+ count = 0;
+ if (AscReadLramByte(iop_base, ASCV_STOP_CODE_B) != 0) {
+ AscWriteLramByte(iop_base, ASCV_STOP_CODE_B,
+ ASC_STOP_CLEAN_UP_BUSY_Q);
+ do {
+ stop_code = AscReadLramByte(iop_base, ASCV_STOP_CODE_B);
+ if ((stop_code & ASC_STOP_CLEAN_UP_BUSY_Q) == 0)
+ break;
+ DvcSleepMilliSecond(100);
+ } while (count++ < 20);
+ }
+ return (1);
}
-int
+#if LINUX_VERSION_CODE >= ASC_LINUX_VERSION(1,3,89)
+STATIC int
AscCleanUpDiscQueue(
- PortAddr iop_base
+ PortAddr iop_base
)
{
- int count;
- uchar stop_code;
- count = 0;
- if (AscReadLramByte(iop_base, ASCV_STOP_CODE_B) != 0) {
- AscWriteLramByte(iop_base, ASCV_STOP_CODE_B,
- ASC_STOP_CLEAN_UP_DISC_Q);
- do {
- stop_code = AscReadLramByte(iop_base, ASCV_STOP_CODE_B);
- if ((stop_code & ASC_STOP_CLEAN_UP_DISC_Q) == 0)
- break;
- DvcSleepMilliSecond(100);
- } while (count++ < 20);
- }
- return (1);
+ int count;
+ uchar stop_code;
+ count = 0;
+ if (AscReadLramByte(iop_base, ASCV_STOP_CODE_B) != 0) {
+ AscWriteLramByte(iop_base, ASCV_STOP_CODE_B,
+ ASC_STOP_CLEAN_UP_DISC_Q);
+ do {
+ stop_code = AscReadLramByte(iop_base, ASCV_STOP_CODE_B);
+ if ((stop_code & ASC_STOP_CLEAN_UP_DISC_Q) == 0)
+ break;
+ DvcSleepMilliSecond(100);
+ } while (count++ < 20);
+ }
+ return (1);
}
+#endif /* version >= v1.3.89 */
-int
+STATIC int
AscWaitTixISRDone(
- ASC_DVC_VAR asc_ptr_type * asc_dvc,
- uchar target_ix
+ ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ uchar target_ix
)
{
- uchar cur_req;
- uchar tid_no;
- tid_no = ASC_TIX_TO_TID(target_ix);
- while (TRUE) {
- if ((cur_req = asc_dvc->cur_dvc_qng[tid_no]) == 0) {
- break;
- }
- DvcSleepMilliSecond(1000L);
- if (asc_dvc->cur_dvc_qng[tid_no] == cur_req) {
- break;
- }
- }
- return (1);
+ uchar cur_req;
+ uchar tid_no;
+ tid_no = ASC_TIX_TO_TID(target_ix);
+ while (TRUE) {
+ if ((cur_req = asc_dvc->cur_dvc_qng[tid_no]) == 0) {
+ break;
+ }
+ DvcSleepMilliSecond(1000L);
+ if (asc_dvc->cur_dvc_qng[tid_no] == cur_req) {
+ break;
+ }
+ }
+ return (1);
}
-int
+STATIC int
AscWaitISRDone(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc
)
{
- int tid;
- for (tid = 0; tid <= ASC_MAX_TID; tid++) {
- AscWaitTixISRDone(asc_dvc, ASC_TID_TO_TIX(tid));
- }
- return (1);
+ int tid;
+ for (tid = 0; tid <= ASC_MAX_TID; tid++) {
+ AscWaitTixISRDone(asc_dvc, ASC_TID_TO_TIX(tid));
+ }
+ return (1);
}
-ulong
+STATIC ulong
AscGetOnePhyAddr(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- uchar dosfar * buf_addr,
- ulong buf_size
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ uchar * buf_addr,
+ ulong buf_size
)
{
- ASC_MIN_SG_HEAD sg_head;
- sg_head.entry_cnt = ASC_MIN_SG_LIST;
- if (DvcGetSGList(asc_dvc, (uchar dosfar *) buf_addr,
- buf_size, (ASC_SG_HEAD dosfar *) & sg_head) != buf_size) {
- return (0L);
- }
- if (sg_head.entry_cnt > 1) {
- return (0L);
- }
- return (sg_head.sg_list[0].addr);
+ ASC_MIN_SG_HEAD sg_head;
+ sg_head.entry_cnt = ASC_MIN_SG_LIST;
+ if (DvcGetSGList(asc_dvc, (uchar *) buf_addr,
+ buf_size, (ASC_SG_HEAD *) & sg_head) != buf_size) {
+ return (0L);
+ }
+ if (sg_head.entry_cnt > 1) {
+ return (0L);
+ }
+ return (sg_head.sg_list[0].addr);
}
-void
+STATIC void
DvcDelayNanoSecond(
- ASC_DVC_VAR asc_ptr_type * asc_dvc,
- ulong nano_sec
+ ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ ulong nano_sec
)
{
- ulong loop;
- PortAddr iop_base;
- iop_base = asc_dvc->iop_base;
- loop = nano_sec / 90;
- loop++;
- while (loop-- != 0) {
- inp(iop_base);
- }
- return;
+ ulong loop;
+ PortAddr iop_base;
+ iop_base = asc_dvc->iop_base;
+ loop = nano_sec / 90;
+ loop++;
+ while (loop-- != 0) {
+ inp(iop_base);
+ }
+ return;
}
-__initfunc(ulong
+ASC_INITFUNC(
+STATIC ulong
AscGetEisaProductID(
- PortAddr iop_base
-))
+ PortAddr iop_base
+)
+)
{
- PortAddr eisa_iop;
- ushort product_id_high, product_id_low;
- ulong product_id;
- eisa_iop = ASC_GET_EISA_SLOT(iop_base) | ASC_EISA_PID_IOP_MASK;
- product_id_low = inpw(eisa_iop);
- product_id_high = inpw(eisa_iop + 2);
- product_id = ((ulong) product_id_high << 16) | (ulong) product_id_low;
- return (product_id);
+ PortAddr eisa_iop;
+ ushort product_id_high, product_id_low;
+ ulong product_id;
+ eisa_iop = ASC_GET_EISA_SLOT(iop_base) | ASC_EISA_PID_IOP_MASK;
+ product_id_low = inpw(eisa_iop);
+ product_id_high = inpw(eisa_iop + 2);
+ product_id = ((ulong) product_id_high << 16) | (ulong) product_id_low;
+ return (product_id);
}
-__initfunc(PortAddr
+ASC_INITFUNC(
+STATIC PortAddr
AscSearchIOPortAddrEISA(
- PortAddr iop_base
-))
-{
- ulong eisa_product_id;
- if (iop_base == 0) {
- iop_base = ASC_EISA_MIN_IOP_ADDR;
- } else {
- if (iop_base == ASC_EISA_MAX_IOP_ADDR)
- return (0);
- if ((iop_base & 0x0050) == 0x0050) {
- iop_base += ASC_EISA_BIG_IOP_GAP;
- } else {
- iop_base += ASC_EISA_SMALL_IOP_GAP;
- }
- }
- while (iop_base <= ASC_EISA_MAX_IOP_ADDR) {
- eisa_product_id = AscGetEisaProductID(iop_base);
- if (
- (eisa_product_id == ASC_EISA_ID_740)
- || (eisa_product_id == ASC_EISA_ID_750)
- ) {
- if (AscFindSignature(iop_base)) {
- inpw(iop_base + 4);
- return (iop_base);
- }
- }
- if (iop_base == ASC_EISA_MAX_IOP_ADDR)
- return (0);
- if ((iop_base & 0x0050) == 0x0050) {
- iop_base += ASC_EISA_BIG_IOP_GAP;
- } else {
- iop_base += ASC_EISA_SMALL_IOP_GAP;
- }
- }
- return (0);
+ PortAddr iop_base
+)
+)
+{
+ ulong eisa_product_id;
+ if (iop_base == 0) {
+ iop_base = ASC_EISA_MIN_IOP_ADDR;
+ } else {
+ if (iop_base == ASC_EISA_MAX_IOP_ADDR)
+ return (0);
+ if ((iop_base & 0x0050) == 0x0050) {
+ iop_base += ASC_EISA_BIG_IOP_GAP;
+ } else {
+ iop_base += ASC_EISA_SMALL_IOP_GAP;
+ }
+ }
+ while (iop_base <= ASC_EISA_MAX_IOP_ADDR) {
+ eisa_product_id = AscGetEisaProductID(iop_base);
+ if ((eisa_product_id == ASC_EISA_ID_740) ||
+ (eisa_product_id == ASC_EISA_ID_750)) {
+ if (AscFindSignature(iop_base)) {
+ inpw(iop_base + 4);
+ return (iop_base);
+ }
+ }
+ if (iop_base == ASC_EISA_MAX_IOP_ADDR)
+ return (0);
+ if ((iop_base & 0x0050) == 0x0050) {
+ iop_base += ASC_EISA_BIG_IOP_GAP;
+ } else {
+ iop_base += ASC_EISA_SMALL_IOP_GAP;
+ }
+ }
+ return (0);
}
-int
+STATIC int
AscStartChip(
- PortAddr iop_base
+ PortAddr iop_base
)
{
- AscSetChipControl(iop_base, 0);
- if ((AscGetChipStatus(iop_base) & CSW_HALTED) != 0) {
- return (0);
- }
- return (1);
+ AscSetChipControl(iop_base, 0);
+ if ((AscGetChipStatus(iop_base) & CSW_HALTED) != 0) {
+ return (0);
+ }
+ return (1);
}
-int
+STATIC int
AscStopChip(
- PortAddr iop_base
+ PortAddr iop_base
)
{
- uchar cc_val;
- cc_val = AscGetChipControl(iop_base) & (~(CC_SINGLE_STEP | CC_TEST | CC_DIAG));
- AscSetChipControl(iop_base, (uchar) (cc_val | CC_HALT));
- AscSetChipIH(iop_base, INS_HALT);
- AscSetChipIH(iop_base, INS_RFLAG_WTM);
- if ((AscGetChipStatus(iop_base) & CSW_HALTED) == 0) {
- return (0);
- }
- return (1);
+ uchar cc_val;
+ cc_val = AscGetChipControl(iop_base) & (~(CC_SINGLE_STEP | CC_TEST | CC_DIAG));
+ AscSetChipControl(iop_base, (uchar) (cc_val | CC_HALT));
+ AscSetChipIH(iop_base, INS_HALT);
+ AscSetChipIH(iop_base, INS_RFLAG_WTM);
+ if ((AscGetChipStatus(iop_base) & CSW_HALTED) == 0) {
+ return (0);
+ }
+ return (1);
}
-int
+STATIC int
AscIsChipHalted(
- PortAddr iop_base
+ PortAddr iop_base
)
{
- if ((AscGetChipStatus(iop_base) & CSW_HALTED) != 0) {
- if ((AscGetChipControl(iop_base) & CC_HALT) != 0) {
- return (1);
- }
- }
- return (0);
+ if ((AscGetChipStatus(iop_base) & CSW_HALTED) != 0) {
+ if ((AscGetChipControl(iop_base) & CC_HALT) != 0) {
+ return (1);
+ }
+ }
+ return (0);
}
-void
+STATIC void
AscSetChipIH(
- PortAddr iop_base,
- ushort ins_code
+ PortAddr iop_base,
+ ushort ins_code
)
{
- AscSetBank(iop_base, 1);
- AscWriteChipIH(iop_base, ins_code);
- AscSetBank(iop_base, 0);
- return;
+ AscSetBank(iop_base, 1);
+ AscWriteChipIH(iop_base, ins_code);
+ AscSetBank(iop_base, 0);
+ return;
}
-void
+STATIC void
AscAckInterrupt(
- PortAddr iop_base
-)
-{
- uchar host_flag;
- uchar risc_flag;
- ushort loop;
- loop = 0;
- do {
- risc_flag = AscReadLramByte(iop_base, ASCV_RISC_FLAG_B);
- if (loop++ > 0x7FFF) {
- break;
- }
- } while ((risc_flag & ASC_RISC_FLAG_GEN_INT) != 0);
- host_flag = AscReadLramByte(iop_base, ASCV_HOST_FLAG_B) & (~ASC_HOST_FLAG_ACK_INT);
- AscWriteLramByte(iop_base, ASCV_HOST_FLAG_B,
- (uchar) (host_flag | ASC_HOST_FLAG_ACK_INT));
- AscSetChipStatus(iop_base, CIW_INT_ACK);
- loop = 0;
- while (AscGetChipStatus(iop_base) & CSW_INT_PENDING) {
- AscSetChipStatus(iop_base, CIW_INT_ACK);
- if (loop++ > 3) {
- break;
- }
- }
- AscWriteLramByte(iop_base, ASCV_HOST_FLAG_B, host_flag);
- return;
+ PortAddr iop_base
+)
+{
+ uchar host_flag;
+ uchar risc_flag;
+ ushort loop;
+ loop = 0;
+ do {
+ risc_flag = AscReadLramByte(iop_base, ASCV_RISC_FLAG_B);
+ if (loop++ > 0x7FFF) {
+ break;
+ }
+ } while ((risc_flag & ASC_RISC_FLAG_GEN_INT) != 0);
+ host_flag = AscReadLramByte(iop_base, ASCV_HOST_FLAG_B) & (~ASC_HOST_FLAG_ACK_INT);
+ AscWriteLramByte(iop_base, ASCV_HOST_FLAG_B,
+ (uchar) (host_flag | ASC_HOST_FLAG_ACK_INT));
+ AscSetChipStatus(iop_base, CIW_INT_ACK);
+ loop = 0;
+ while (AscGetChipStatus(iop_base) & CSW_INT_PENDING) {
+ AscSetChipStatus(iop_base, CIW_INT_ACK);
+ if (loop++ > 3) {
+ break;
+ }
+ }
+ AscWriteLramByte(iop_base, ASCV_HOST_FLAG_B, host_flag);
+ return;
}
-void
+STATIC void
AscDisableInterrupt(
- PortAddr iop_base
+ PortAddr iop_base
)
{
- ushort cfg;
- cfg = AscGetChipCfgLsw(iop_base);
- AscSetChipCfgLsw(iop_base, cfg & (~ASC_CFG0_HOST_INT_ON));
- return;
+ ushort cfg;
+ cfg = AscGetChipCfgLsw(iop_base);
+ AscSetChipCfgLsw(iop_base, cfg & (~ASC_CFG0_HOST_INT_ON));
+ return;
}
-void
+STATIC void
AscEnableInterrupt(
- PortAddr iop_base
+ PortAddr iop_base
)
{
- ushort cfg;
- cfg = AscGetChipCfgLsw(iop_base);
- AscSetChipCfgLsw(iop_base, cfg | ASC_CFG0_HOST_INT_ON);
- return;
+ ushort cfg;
+ cfg = AscGetChipCfgLsw(iop_base);
+ AscSetChipCfgLsw(iop_base, cfg | ASC_CFG0_HOST_INT_ON);
+ return;
}
-void
+STATIC void
AscSetBank(
- PortAddr iop_base,
- uchar bank
+ PortAddr iop_base,
+ uchar bank
)
{
- uchar val;
- val = AscGetChipControl(iop_base) &
- (~(CC_SINGLE_STEP | CC_TEST | CC_DIAG | CC_SCSI_RESET | CC_CHIP_RESET));
- if (bank == 1) {
- val |= CC_BANK_ONE;
- } else if (bank == 2) {
- val |= CC_DIAG | CC_BANK_ONE;
- } else {
- val &= ~CC_BANK_ONE;
- }
- AscSetChipControl(iop_base, val);
- return;
+ uchar val;
+ val = AscGetChipControl(iop_base) &
+ (~(CC_SINGLE_STEP | CC_TEST | CC_DIAG | CC_SCSI_RESET | CC_CHIP_RESET));
+ if (bank == 1) {
+ val |= CC_BANK_ONE;
+ } else if (bank == 2) {
+ val |= CC_DIAG | CC_BANK_ONE;
+ } else {
+ val &= ~CC_BANK_ONE;
+ }
+ AscSetChipControl(iop_base, val);
+ return;
}
-int
+STATIC int
AscResetChipAndScsiBus(
- PortAddr iop_base
+ PortAddr iop_base
)
{
- while (AscGetChipStatus(iop_base) & CSW_SCSI_RESET_ACTIVE) ;
- AscStopChip(iop_base);
- AscSetChipControl(iop_base, CC_CHIP_RESET | CC_SCSI_RESET | CC_HALT);
- DvcSleepMilliSecond(200);
- AscSetChipIH(iop_base, INS_RFLAG_WTM);
- AscSetChipIH(iop_base, INS_HALT);
- AscSetChipControl(iop_base, CC_CHIP_RESET | CC_HALT);
- AscSetChipControl(iop_base, CC_HALT);
- DvcSleepMilliSecond(200);
- AscSetChipStatus(iop_base, CIW_CLR_SCSI_RESET_INT);
- AscSetChipStatus(iop_base, 0);
- return (AscIsChipHalted(iop_base));
-}
-
-
-
-ulong
+ while (AscGetChipStatus(iop_base) & CSW_SCSI_RESET_ACTIVE) ;
+ AscStopChip(iop_base);
+ AscSetChipControl(iop_base, CC_CHIP_RESET | CC_SCSI_RESET | CC_HALT);
+ DvcSleepMilliSecond(200);
+ AscSetChipIH(iop_base, INS_RFLAG_WTM);
+ AscSetChipIH(iop_base, INS_HALT);
+ AscSetChipControl(iop_base, CC_CHIP_RESET | CC_HALT);
+ AscSetChipControl(iop_base, CC_HALT);
+ DvcSleepMilliSecond(200);
+ AscSetChipStatus(iop_base, CIW_CLR_SCSI_RESET_INT);
+ AscSetChipStatus(iop_base, 0);
+ return (AscIsChipHalted(iop_base));
+}
+
+ASC_INITFUNC(
+STATIC ulong
AscGetMaxDmaCount(
- ushort bus_type
+ ushort bus_type
+)
)
{
- if (bus_type & ASC_IS_ISA)
- return (ASC_MAX_ISA_DMA_COUNT);
- else if (bus_type & (ASC_IS_EISA | ASC_IS_VL))
- return (ASC_MAX_VL_DMA_COUNT);
- return (ASC_MAX_PCI_DMA_COUNT);
+ if (bus_type & ASC_IS_ISA)
+ return (ASC_MAX_ISA_DMA_COUNT);
+ else if (bus_type & (ASC_IS_EISA | ASC_IS_VL))
+ return (ASC_MAX_VL_DMA_COUNT);
+ return (ASC_MAX_PCI_DMA_COUNT);
}
-ushort
+ASC_INITFUNC(
+STATIC ushort
AscGetIsaDmaChannel(
- PortAddr iop_base
+ PortAddr iop_base
+)
)
{
- ushort channel;
- channel = AscGetChipCfgLsw(iop_base) & 0x0003;
- if (channel == 0x03)
- return (0);
- else if (channel == 0x00)
- return (7);
- return (channel + 4);
+ ushort channel;
+ channel = AscGetChipCfgLsw(iop_base) & 0x0003;
+ if (channel == 0x03)
+ return (0);
+ else if (channel == 0x00)
+ return (7);
+ return (channel + 4);
}
-ushort
+ASC_INITFUNC(
+STATIC ushort
AscSetIsaDmaChannel(
- PortAddr iop_base,
- ushort dma_channel
-)
-{
- ushort cfg_lsw;
- uchar value;
- if ((dma_channel >= 5) && (dma_channel <= 7)) {
- if (dma_channel == 7)
- value = 0x00;
- else
- value = dma_channel - 4;
- cfg_lsw = AscGetChipCfgLsw(iop_base) & 0xFFFC;
- cfg_lsw |= value;
- AscSetChipCfgLsw(iop_base, cfg_lsw);
- return (AscGetIsaDmaChannel(iop_base));
- }
- return (0);
-}
-
-uchar
+ PortAddr iop_base,
+ ushort dma_channel
+)
+)
+{
+ ushort cfg_lsw;
+ uchar value;
+ if ((dma_channel >= 5) && (dma_channel <= 7)) {
+ if (dma_channel == 7)
+ value = 0x00;
+ else
+ value = dma_channel - 4;
+ cfg_lsw = AscGetChipCfgLsw(iop_base) & 0xFFFC;
+ cfg_lsw |= value;
+ AscSetChipCfgLsw(iop_base, cfg_lsw);
+ return (AscGetIsaDmaChannel(iop_base));
+ }
+ return (0);
+}
+
+ASC_INITFUNC(
+STATIC uchar
AscSetIsaDmaSpeed(
- PortAddr iop_base,
- uchar speed_value
+ PortAddr iop_base,
+ uchar speed_value
+)
)
{
- speed_value &= 0x07;
- AscSetBank(iop_base, 1);
- AscWriteChipDmaSpeed(iop_base, speed_value);
- AscSetBank(iop_base, 0);
- return (AscGetIsaDmaSpeed(iop_base));
+ speed_value &= 0x07;
+ AscSetBank(iop_base, 1);
+ AscWriteChipDmaSpeed(iop_base, speed_value);
+ AscSetBank(iop_base, 0);
+ return (AscGetIsaDmaSpeed(iop_base));
}
-uchar
+ASC_INITFUNC(
+STATIC uchar
AscGetIsaDmaSpeed(
- PortAddr iop_base
+ PortAddr iop_base
+)
+)
+{
+ uchar speed_value;
+ AscSetBank(iop_base, 1);
+ speed_value = AscReadChipDmaSpeed(iop_base);
+ speed_value &= 0x07;
+ AscSetBank(iop_base, 0);
+ return (speed_value);
+}
+
+ASC_INITFUNC(
+STATIC ushort
+AscReadPCIConfigWord(
+ ASC_DVC_VAR asc_ptr_type *asc_dvc,
+ ushort pci_config_offset)
)
{
- uchar speed_value;
- AscSetBank(iop_base, 1);
- speed_value = AscReadChipDmaSpeed(iop_base);
- speed_value &= 0x07;
- AscSetBank(iop_base, 0);
- return (speed_value);
+ uchar lsb, msb;
+
+ lsb = DvcReadPCIConfigByte(asc_dvc, pci_config_offset);
+ msb = DvcReadPCIConfigByte(asc_dvc, pci_config_offset + 1);
+ return ((ushort) ((msb << 8) | lsb));
}
-__initfunc(ushort
+ASC_INITFUNC(
+STATIC ushort
AscInitGetConfig(
- ASC_DVC_VAR asc_ptr_type * asc_dvc
-))
-{
- ushort warn_code;
- warn_code = 0;
- asc_dvc->init_state = ASC_INIT_STATE_BEG_GET_CFG;
- if (asc_dvc->err_code != 0)
- return (UW_ERR);
- if (AscFindSignature(asc_dvc->iop_base)) {
- warn_code |= AscInitAscDvcVar(asc_dvc);
-#if CC_INCLUDE_EEP_CONFIG
- if (asc_dvc->init_state & ASC_INIT_STATE_WITHOUT_EEP) {
- warn_code |= AscInitWithoutEEP(asc_dvc);
- } else {
- warn_code |= AscInitFromEEP(asc_dvc);
- }
-#else
- warn_code |= AscInitWithoutEEP(asc_dvc);
-#endif
- asc_dvc->init_state |= ASC_INIT_STATE_END_GET_CFG;
- if (asc_dvc->scsi_reset_wait > ASC_MAX_SCSI_RESET_WAIT) {
- asc_dvc->scsi_reset_wait = ASC_MAX_SCSI_RESET_WAIT;
- }
- } else {
- asc_dvc->err_code = ASC_IERR_BAD_SIGNATURE;
- }
- return (warn_code);
+ ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+)
+{
+ ushort warn_code;
+ PortAddr iop_base;
+ ushort PCIDeviceID;
+ ushort PCIVendorID;
+ uchar PCIRevisionID;
+ uchar prevCmdRegBits;
+
+ warn_code = 0;
+ iop_base = asc_dvc->iop_base;
+ asc_dvc->init_state = ASC_INIT_STATE_BEG_GET_CFG;
+ if (asc_dvc->err_code != 0) {
+ return (UW_ERR);
+ }
+ if (asc_dvc->bus_type == ASC_IS_PCI) {
+ PCIVendorID = AscReadPCIConfigWord(asc_dvc,
+ AscPCIConfigVendorIDRegister);
+
+ PCIDeviceID = AscReadPCIConfigWord(asc_dvc,
+ AscPCIConfigDeviceIDRegister);
+
+ PCIRevisionID = DvcReadPCIConfigByte(asc_dvc,
+ AscPCIConfigRevisionIDRegister);
+
+ if (PCIVendorID != ASC_PCI_VENDORID) {
+ warn_code |= ASC_WARN_SET_PCI_CONFIG_SPACE;
+ }
+ prevCmdRegBits = DvcReadPCIConfigByte(asc_dvc,
+ AscPCIConfigCommandRegister);
+
+ if ((prevCmdRegBits & AscPCICmdRegBits_IOMemBusMaster) !=
+ AscPCICmdRegBits_IOMemBusMaster) {
+ DvcWritePCIConfigByte(asc_dvc,
+ AscPCIConfigCommandRegister,
+ (prevCmdRegBits |
+ AscPCICmdRegBits_IOMemBusMaster));
+
+ if ((DvcReadPCIConfigByte(asc_dvc,
+ AscPCIConfigCommandRegister)
+ & AscPCICmdRegBits_IOMemBusMaster)
+ != AscPCICmdRegBits_IOMemBusMaster) {
+ warn_code |= ASC_WARN_SET_PCI_CONFIG_SPACE;
+ }
+ }
+ if ((PCIDeviceID == ASC_PCI_DEVICEID_1200A) ||
+ (PCIDeviceID == ASC_PCI_DEVICEID_1200B)) {
+ DvcWritePCIConfigByte(asc_dvc,
+ AscPCIConfigLatencyTimer, 0x00);
+ if (DvcReadPCIConfigByte(asc_dvc, AscPCIConfigLatencyTimer)
+ != 0x00) {
+ warn_code |= ASC_WARN_SET_PCI_CONFIG_SPACE;
+ }
+ } else if (PCIDeviceID == ASC_PCI_DEVICEID_ULTRA) {
+ if (DvcReadPCIConfigByte(asc_dvc,
+ AscPCIConfigLatencyTimer) < 0x20) {
+ DvcWritePCIConfigByte(asc_dvc,
+ AscPCIConfigLatencyTimer, 0x20);
+
+ if (DvcReadPCIConfigByte(asc_dvc,
+ AscPCIConfigLatencyTimer) < 0x20) {
+ warn_code |= ASC_WARN_SET_PCI_CONFIG_SPACE;
+ }
+ }
+ }
+ }
+
+ if (AscFindSignature(iop_base)) {
+ warn_code |= AscInitAscDvcVar(asc_dvc);
+ warn_code |= AscInitFromEEP(asc_dvc);
+ asc_dvc->init_state |= ASC_INIT_STATE_END_GET_CFG;
+ if (asc_dvc->scsi_reset_wait > ASC_MAX_SCSI_RESET_WAIT) {
+ asc_dvc->scsi_reset_wait = ASC_MAX_SCSI_RESET_WAIT;
+ }
+ } else {
+ asc_dvc->err_code = ASC_IERR_BAD_SIGNATURE;
+ }
+ return(warn_code);
}
-__initfunc(ushort
+ASC_INITFUNC(
+STATIC ushort
AscInitSetConfig(
- ASC_DVC_VAR asc_ptr_type * asc_dvc
-))
-{
- ushort warn_code;
- warn_code = 0;
- asc_dvc->init_state |= ASC_INIT_STATE_BEG_SET_CFG;
- if (asc_dvc->err_code != 0)
- return (UW_ERR);
- if (AscFindSignature(asc_dvc->iop_base)) {
- warn_code |= AscInitFromAscDvcVar(asc_dvc);
- asc_dvc->init_state |= ASC_INIT_STATE_END_SET_CFG;
- } else {
- asc_dvc->err_code = ASC_IERR_BAD_SIGNATURE;
- }
- return (warn_code);
-}
-
-__initfunc(ushort
+ ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+)
+{
+ ushort warn_code;
+ warn_code = 0;
+ asc_dvc->init_state |= ASC_INIT_STATE_BEG_SET_CFG;
+ if (asc_dvc->err_code != 0)
+ return (UW_ERR);
+ if (AscFindSignature(asc_dvc->iop_base)) {
+ warn_code |= AscInitFromAscDvcVar(asc_dvc);
+ asc_dvc->init_state |= ASC_INIT_STATE_END_SET_CFG;
+ } else {
+ asc_dvc->err_code = ASC_IERR_BAD_SIGNATURE;
+ }
+ return (warn_code);
+}
+
+ASC_INITFUNC(
+STATIC ushort
AscInitFromAscDvcVar(
- ASC_DVC_VAR asc_ptr_type * asc_dvc
-))
-{
- PortAddr iop_base;
- ushort cfg_msw;
- ushort warn_code;
- ushort pci_device_id;
- iop_base = asc_dvc->iop_base;
- pci_device_id = asc_dvc->cfg->pci_device_id;
- warn_code = 0;
- cfg_msw = AscGetChipCfgMsw(iop_base);
- if ((cfg_msw & ASC_CFG_MSW_CLR_MASK) != 0) {
- cfg_msw &= (~(ASC_CFG_MSW_CLR_MASK));
- warn_code |= ASC_WARN_CFG_MSW_RECOVER;
- AscSetChipCfgMsw(iop_base, cfg_msw);
- }
- if ((asc_dvc->cfg->cmd_qng_enabled & asc_dvc->cfg->disc_enable) !=
- asc_dvc->cfg->cmd_qng_enabled) {
- asc_dvc->cfg->disc_enable = asc_dvc->cfg->cmd_qng_enabled;
- warn_code |= ASC_WARN_CMD_QNG_CONFLICT;
- }
- if (AscGetChipStatus(iop_base) & CSW_AUTO_CONFIG) {
- warn_code |= ASC_WARN_AUTO_CONFIG;
- }
- if ((asc_dvc->bus_type & (ASC_IS_ISA | ASC_IS_VL)) != 0) {
- if (AscSetChipIRQ(iop_base, asc_dvc->irq_no, asc_dvc->bus_type)
- != asc_dvc->irq_no) {
- asc_dvc->err_code |= ASC_IERR_SET_IRQ_NO;
- }
- }
- if (asc_dvc->bus_type & ASC_IS_PCI) {
+ ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+)
+{
+ PortAddr iop_base;
+ ushort cfg_msw;
+ ushort warn_code;
+ ushort pci_device_id;
+ iop_base = asc_dvc->iop_base;
+ pci_device_id = asc_dvc->cfg->pci_device_id;
+ warn_code = 0;
+ cfg_msw = AscGetChipCfgMsw(iop_base);
+ if ((cfg_msw & ASC_CFG_MSW_CLR_MASK) != 0) {
+ cfg_msw &= (~(ASC_CFG_MSW_CLR_MASK));
+ warn_code |= ASC_WARN_CFG_MSW_RECOVER;
+ AscSetChipCfgMsw(iop_base, cfg_msw);
+ }
+ if ((asc_dvc->cfg->cmd_qng_enabled & asc_dvc->cfg->disc_enable) !=
+ asc_dvc->cfg->cmd_qng_enabled) {
+ asc_dvc->cfg->disc_enable = asc_dvc->cfg->cmd_qng_enabled;
+ warn_code |= ASC_WARN_CMD_QNG_CONFLICT;
+ }
+ if (AscGetChipStatus(iop_base) & CSW_AUTO_CONFIG) {
+ warn_code |= ASC_WARN_AUTO_CONFIG;
+ }
+ if ((asc_dvc->bus_type & (ASC_IS_ISA | ASC_IS_VL)) != 0) {
+ if (AscSetChipIRQ(iop_base, asc_dvc->irq_no, asc_dvc->bus_type)
+ != asc_dvc->irq_no) {
+ asc_dvc->err_code |= ASC_IERR_SET_IRQ_NO;
+ }
+ }
+ if (asc_dvc->bus_type & ASC_IS_PCI) {
#if CC_DISABLE_PCI_PARITY_INT
- cfg_msw &= 0xFFC0;
- AscSetChipCfgMsw(iop_base, cfg_msw);
+ cfg_msw &= 0xFFC0;
+ AscSetChipCfgMsw(iop_base, cfg_msw);
#endif
- if ((asc_dvc->bus_type & ASC_IS_PCI_ULTRA) == ASC_IS_PCI_ULTRA) {
- } else {
- if ((pci_device_id == ASC_PCI_DEVICE_ID_REV_A) ||
- (pci_device_id == ASC_PCI_DEVICE_ID_REV_B)) {
- asc_dvc->bug_fix_cntl |= ASC_BUG_FIX_IF_NOT_DWB;
- asc_dvc->bug_fix_cntl |= ASC_BUG_FIX_ASYN_USE_SYN;
-#if CC_SET_PCI_LATENCY_TIMER_ZERO
- DvcWritePCIConfigByte(asc_dvc,
- AscPCIConfigCommandRegister,
- AscPCICmdRegBits_BusMastering
- );
- if ((DvcReadPCIConfigByte(asc_dvc,
- AscPCIConfigCommandRegister
- )
- & AscPCICmdRegBits_BusMastering)
- != AscPCICmdRegBits_BusMastering) {
- warn_code |= ASC_WARN_SET_PCI_CONFIG_SPACE;
- }
- DvcWritePCIConfigByte(asc_dvc,
- AscPCIConfigLatencyTimer,
- 0x00
- );
- if (DvcReadPCIConfigByte(asc_dvc,
- AscPCIConfigLatencyTimer
- ) != 0x00) {
- warn_code |= ASC_WARN_SET_PCI_CONFIG_SPACE;
- }
-#endif
- }
- }
- } else if (asc_dvc->bus_type == ASC_IS_ISAPNP) {
- if (AscGetChipVersion(iop_base, asc_dvc->bus_type)
- == ASC_CHIP_VER_ASYN_BUG) {
- asc_dvc->bug_fix_cntl |= ASC_BUG_FIX_ASYN_USE_SYN;
- }
- }
- if (AscSetChipScsiID(iop_base, asc_dvc->cfg->chip_scsi_id) !=
- asc_dvc->cfg->chip_scsi_id) {
- asc_dvc->err_code |= ASC_IERR_SET_SCSI_ID;
- }
- if (asc_dvc->bus_type & ASC_IS_ISA) {
- AscSetIsaDmaChannel(iop_base, asc_dvc->cfg->isa_dma_channel);
- AscSetIsaDmaSpeed(iop_base, asc_dvc->cfg->isa_dma_speed);
- }
- return (warn_code);
-}
-
-__initfunc(ushort
+ if ((asc_dvc->bus_type & ASC_IS_PCI_ULTRA) == ASC_IS_PCI_ULTRA) {
+ } else {
+ if ((pci_device_id == ASC_PCI_DEVICE_ID_REV_A) ||
+ (pci_device_id == ASC_PCI_DEVICE_ID_REV_B)) {
+ asc_dvc->bug_fix_cntl |= ASC_BUG_FIX_IF_NOT_DWB;
+ asc_dvc->bug_fix_cntl |= ASC_BUG_FIX_ASYN_USE_SYN;
+ }
+ }
+ } else if (asc_dvc->bus_type == ASC_IS_ISAPNP) {
+ if (AscGetChipVersion(iop_base, asc_dvc->bus_type)
+ == ASC_CHIP_VER_ASYN_BUG) {
+ asc_dvc->bug_fix_cntl |= ASC_BUG_FIX_ASYN_USE_SYN;
+ }
+ }
+ if (AscSetChipScsiID(iop_base, asc_dvc->cfg->chip_scsi_id) !=
+ asc_dvc->cfg->chip_scsi_id) {
+ asc_dvc->err_code |= ASC_IERR_SET_SCSI_ID;
+ }
+ if (asc_dvc->bus_type & ASC_IS_ISA) {
+ AscSetIsaDmaChannel(iop_base, asc_dvc->cfg->isa_dma_channel);
+ AscSetIsaDmaSpeed(iop_base, asc_dvc->cfg->isa_dma_speed);
+ }
+ return (warn_code);
+}
+
+ASC_INITFUNC(
+STATIC ushort
AscInitAsc1000Driver(
- ASC_DVC_VAR asc_ptr_type * asc_dvc
-))
-{
- ushort warn_code;
- PortAddr iop_base;
- extern ushort _mcode_size;
- extern ulong _mcode_chksum;
- extern uchar _mcode_buf[];
- iop_base = asc_dvc->iop_base;
- warn_code = 0;
- if ((asc_dvc->dvc_cntl & ASC_CNTL_RESET_SCSI) &&
- !(asc_dvc->init_state & ASC_INIT_RESET_SCSI_DONE)) {
- AscResetChipAndScsiBus(iop_base);
- DvcSleepMilliSecond((ulong) ((ushort) asc_dvc->scsi_reset_wait * 1000));
- }
- asc_dvc->init_state |= ASC_INIT_STATE_BEG_LOAD_MC;
- if (asc_dvc->err_code != 0)
- return (UW_ERR);
- if (!AscFindSignature(asc_dvc->iop_base)) {
- asc_dvc->err_code = ASC_IERR_BAD_SIGNATURE;
- return (warn_code);
- }
- AscDisableInterrupt(iop_base);
- warn_code |= AscInitLram(asc_dvc);
- if (asc_dvc->err_code != 0)
- return (UW_ERR);
- if (AscLoadMicroCode(iop_base, 0, (ushort dosfar *) _mcode_buf,
- _mcode_size) != _mcode_chksum) {
- asc_dvc->err_code |= ASC_IERR_MCODE_CHKSUM;
- return (warn_code);
- }
- warn_code |= AscInitMicroCodeVar(asc_dvc);
- asc_dvc->init_state |= ASC_INIT_STATE_END_LOAD_MC;
- AscEnableInterrupt(iop_base);
- return (warn_code);
-}
-
-__initfunc(ushort
+ ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+)
+{
+ ushort warn_code;
+ PortAddr iop_base;
+ extern ushort _mcode_size;
+ extern ulong _mcode_chksum;
+ extern uchar _mcode_buf[];
+ iop_base = asc_dvc->iop_base;
+ warn_code = 0;
+ if ((asc_dvc->dvc_cntl & ASC_CNTL_RESET_SCSI) &&
+ !(asc_dvc->init_state & ASC_INIT_RESET_SCSI_DONE)) {
+ AscResetChipAndScsiBus(iop_base);
+ DvcSleepMilliSecond((ulong) ((ushort) asc_dvc->scsi_reset_wait * 1000));
+ }
+ asc_dvc->init_state |= ASC_INIT_STATE_BEG_LOAD_MC;
+ if (asc_dvc->err_code != 0)
+ return (UW_ERR);
+ if (!AscFindSignature(asc_dvc->iop_base)) {
+ asc_dvc->err_code = ASC_IERR_BAD_SIGNATURE;
+ return (warn_code);
+ }
+ AscDisableInterrupt(iop_base);
+ warn_code |= AscInitLram(asc_dvc);
+ if (asc_dvc->err_code != 0)
+ return (UW_ERR);
+ if (AscLoadMicroCode(iop_base, 0, (ushort *) _mcode_buf,
+ _mcode_size) != _mcode_chksum) {
+ asc_dvc->err_code |= ASC_IERR_MCODE_CHKSUM;
+ return (warn_code);
+ }
+ warn_code |= AscInitMicroCodeVar(asc_dvc);
+ asc_dvc->init_state |= ASC_INIT_STATE_END_LOAD_MC;
+ AscEnableInterrupt(iop_base);
+ return (warn_code);
+}
+
+ASC_INITFUNC(
+STATIC ushort
AscInitAscDvcVar(
- ASC_DVC_VAR asc_ptr_type * asc_dvc
-))
-{
- int i;
- PortAddr iop_base;
- ushort warn_code;
- uchar chip_version;
- iop_base = asc_dvc->iop_base;
- warn_code = 0;
- asc_dvc->err_code = 0;
- if (
- (asc_dvc->bus_type &
- (ASC_IS_ISA | ASC_IS_PCI | ASC_IS_EISA | ASC_IS_VL)) == 0
- ) {
- asc_dvc->err_code |= ASC_IERR_NO_BUS_TYPE;
- }
- AscSetChipControl(iop_base, CC_HALT);
- AscSetChipStatus(iop_base, 0);
-#if CC_LINK_BUSY_Q
- for (i = 0; i <= ASC_MAX_TID; i++) {
- asc_dvc->scsiq_busy_head[i] = (ASC_SCSI_Q dosfar *) 0L;
- asc_dvc->scsiq_busy_tail[i] = (ASC_SCSI_Q dosfar *) 0L;
- }
-#endif
- asc_dvc->bug_fix_cntl = 0;
- asc_dvc->pci_fix_asyn_xfer = 0;
- asc_dvc->pci_fix_asyn_xfer_always = 0;
- asc_dvc->init_state = 0;
- asc_dvc->sdtr_done = 0;
- asc_dvc->cur_total_qng = 0;
- asc_dvc->is_in_int = 0;
- asc_dvc->in_critical_cnt = 0;
- asc_dvc->last_q_shortage = 0;
- asc_dvc->use_tagged_qng = 0;
- asc_dvc->no_scam = 0;
- asc_dvc->unit_not_ready = 0;
- asc_dvc->queue_full_or_busy = 0;
- asc_dvc->redo_scam = 0 ;
- asc_dvc->res2 = 0 ;
- asc_dvc->host_init_sdtr_index = 0 ;
- asc_dvc->res7 = 0 ;
- asc_dvc->res8 = 0 ;
- asc_dvc->cfg->can_tagged_qng = 0 ;
- asc_dvc->cfg->cmd_qng_enabled = 0;
- asc_dvc->dvc_cntl = ASC_DEF_DVC_CNTL;
- asc_dvc->init_sdtr = ASC_SCSI_WIDTH_BIT_SET;
- asc_dvc->max_total_qng = ASC_DEF_MAX_TOTAL_QNG;
- asc_dvc->scsi_reset_wait = 3;
- asc_dvc->start_motor = ASC_SCSI_WIDTH_BIT_SET;
- asc_dvc->max_dma_count = AscGetMaxDmaCount(asc_dvc->bus_type);
- asc_dvc->cfg->disc_enable = ASC_SCSI_WIDTH_BIT_SET;
- asc_dvc->cfg->chip_scsi_id = ASC_DEF_CHIP_SCSI_ID;
- asc_dvc->cfg->lib_serial_no = ASC_LIB_SERIAL_NUMBER;
- asc_dvc->cfg->lib_version = (ASC_LIB_VERSION_MAJOR << 8) |
- ASC_LIB_VERSION_MINOR;
- chip_version = AscGetChipVersion(iop_base, asc_dvc->bus_type);
- asc_dvc->cfg->chip_version = chip_version;
- asc_dvc->sdtr_period_tbl[0] = SYN_XFER_NS_0;
- asc_dvc->sdtr_period_tbl[1] = SYN_XFER_NS_1;
- asc_dvc->sdtr_period_tbl[2] = SYN_XFER_NS_2;
- asc_dvc->sdtr_period_tbl[3] = SYN_XFER_NS_3;
- asc_dvc->sdtr_period_tbl[4] = SYN_XFER_NS_4;
- asc_dvc->sdtr_period_tbl[5] = SYN_XFER_NS_5;
- asc_dvc->sdtr_period_tbl[6] = SYN_XFER_NS_6;
- asc_dvc->sdtr_period_tbl[7] = SYN_XFER_NS_7;
- asc_dvc->max_sdtr_index = 7;
- if (
- (asc_dvc->bus_type & ASC_IS_PCI) &&
- (chip_version >= ASC_CHIP_VER_1ST_PCI_ULTRA)
- ) {
- asc_dvc->sdtr_period_tbl[0] = SYN_ULTRA_XFER_NS_0;
- asc_dvc->sdtr_period_tbl[1] = SYN_ULTRA_XFER_NS_1;
- asc_dvc->sdtr_period_tbl[2] = SYN_ULTRA_XFER_NS_2;
- asc_dvc->sdtr_period_tbl[3] = SYN_ULTRA_XFER_NS_3;
- asc_dvc->sdtr_period_tbl[4] = SYN_ULTRA_XFER_NS_4;
- asc_dvc->sdtr_period_tbl[5] = SYN_ULTRA_XFER_NS_5;
- asc_dvc->sdtr_period_tbl[6] = SYN_ULTRA_XFER_NS_6;
- asc_dvc->sdtr_period_tbl[7] = SYN_ULTRA_XFER_NS_7;
- asc_dvc->sdtr_period_tbl[8] = SYN_ULTRA_XFER_NS_8;
- asc_dvc->sdtr_period_tbl[9] = SYN_ULTRA_XFER_NS_9;
- asc_dvc->sdtr_period_tbl[10] = SYN_ULTRA_XFER_NS_10;
- asc_dvc->sdtr_period_tbl[11] = SYN_ULTRA_XFER_NS_11;
- asc_dvc->sdtr_period_tbl[12] = SYN_ULTRA_XFER_NS_12;
- asc_dvc->sdtr_period_tbl[13] = SYN_ULTRA_XFER_NS_13;
- asc_dvc->sdtr_period_tbl[14] = SYN_ULTRA_XFER_NS_14;
- asc_dvc->sdtr_period_tbl[15] = SYN_ULTRA_XFER_NS_15;
- asc_dvc->max_sdtr_index = 15;
- AscSetExtraControl(iop_base, (SEC_ACTIVE_NEGATE | SEC_SLEW_RATE));
- asc_dvc->bus_type = ASC_IS_PCI_ULTRA;
- }
- asc_dvc->cfg->isa_dma_speed = ASC_DEF_ISA_DMA_SPEED;
- if (AscGetChipBusType(iop_base) == ASC_IS_ISAPNP) {
- AscSetChipIFC(iop_base, IFC_INIT_DEFAULT);
- asc_dvc->bus_type = ASC_IS_ISAPNP;
- }
- if ((asc_dvc->bus_type & ASC_IS_ISA) != 0) {
- asc_dvc->cfg->isa_dma_channel = (uchar) AscGetIsaDmaChannel(iop_base);
- }
- for (i = 0; i <= ASC_MAX_TID; i++) {
- asc_dvc->cur_dvc_qng[i] = 0;
- asc_dvc->max_dvc_qng[i] = ASC_MAX_SCSI1_QNG;
- asc_dvc->scsiq_busy_head[i] = (ASC_SCSI_Q dosfar *) 0L;
- asc_dvc->scsiq_busy_tail[i] = (ASC_SCSI_Q dosfar *) 0L;
- asc_dvc->cfg->max_tag_qng[i] = ASC_MAX_INRAM_TAG_QNG;
- }
- return (warn_code);
+ ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+)
+{
+ int i;
+ PortAddr iop_base;
+ ushort warn_code;
+ uchar chip_version;
+ iop_base = asc_dvc->iop_base;
+ warn_code = 0;
+ asc_dvc->err_code = 0;
+ if ((asc_dvc->bus_type &
+ (ASC_IS_ISA | ASC_IS_PCI | ASC_IS_EISA | ASC_IS_VL)) == 0) {
+ asc_dvc->err_code |= ASC_IERR_NO_BUS_TYPE;
+ }
+ AscSetChipControl(iop_base, CC_HALT);
+ AscSetChipStatus(iop_base, 0);
+ asc_dvc->bug_fix_cntl = 0;
+ asc_dvc->pci_fix_asyn_xfer = 0;
+ asc_dvc->pci_fix_asyn_xfer_always = 0;
+ asc_dvc->init_state = 0;
+ asc_dvc->sdtr_done = 0;
+ asc_dvc->cur_total_qng = 0;
+ asc_dvc->is_in_int = 0;
+ asc_dvc->in_critical_cnt = 0;
+ asc_dvc->last_q_shortage = 0;
+ asc_dvc->use_tagged_qng = 0;
+ asc_dvc->no_scam = 0;
+ asc_dvc->unit_not_ready = 0;
+ asc_dvc->queue_full_or_busy = 0;
+ asc_dvc->redo_scam = 0 ;
+ asc_dvc->res2 = 0 ;
+ asc_dvc->host_init_sdtr_index = 0 ;
+ asc_dvc->res7 = 0 ;
+ asc_dvc->res8 = 0 ;
+ asc_dvc->cfg->can_tagged_qng = 0 ;
+ asc_dvc->cfg->cmd_qng_enabled = 0;
+ asc_dvc->dvc_cntl = ASC_DEF_DVC_CNTL;
+ asc_dvc->init_sdtr = ASC_SCSI_WIDTH_BIT_SET;
+ asc_dvc->max_total_qng = ASC_DEF_MAX_TOTAL_QNG;
+ asc_dvc->scsi_reset_wait = 3;
+ asc_dvc->start_motor = ASC_SCSI_WIDTH_BIT_SET;
+ asc_dvc->max_dma_count = AscGetMaxDmaCount(asc_dvc->bus_type);
+ asc_dvc->cfg->disc_enable = ASC_SCSI_WIDTH_BIT_SET;
+ asc_dvc->cfg->chip_scsi_id = ASC_DEF_CHIP_SCSI_ID;
+ asc_dvc->cfg->lib_serial_no = ASC_LIB_SERIAL_NUMBER;
+ asc_dvc->cfg->lib_version = (ASC_LIB_VERSION_MAJOR << 8) |
+ ASC_LIB_VERSION_MINOR;
+ chip_version = AscGetChipVersion(iop_base, asc_dvc->bus_type);
+ asc_dvc->cfg->chip_version = chip_version;
+ asc_dvc->sdtr_period_tbl[0] = SYN_XFER_NS_0;
+ asc_dvc->sdtr_period_tbl[1] = SYN_XFER_NS_1;
+ asc_dvc->sdtr_period_tbl[2] = SYN_XFER_NS_2;
+ asc_dvc->sdtr_period_tbl[3] = SYN_XFER_NS_3;
+ asc_dvc->sdtr_period_tbl[4] = SYN_XFER_NS_4;
+ asc_dvc->sdtr_period_tbl[5] = SYN_XFER_NS_5;
+ asc_dvc->sdtr_period_tbl[6] = SYN_XFER_NS_6;
+ asc_dvc->sdtr_period_tbl[7] = SYN_XFER_NS_7;
+ asc_dvc->max_sdtr_index = 7;
+ if ((asc_dvc->bus_type & ASC_IS_PCI) &&
+ (chip_version >= ASC_CHIP_VER_PCI_ULTRA_3150)) {
+ asc_dvc->bus_type = ASC_IS_PCI_ULTRA;
+ asc_dvc->sdtr_period_tbl[0] = SYN_ULTRA_XFER_NS_0;
+ asc_dvc->sdtr_period_tbl[1] = SYN_ULTRA_XFER_NS_1;
+ asc_dvc->sdtr_period_tbl[2] = SYN_ULTRA_XFER_NS_2;
+ asc_dvc->sdtr_period_tbl[3] = SYN_ULTRA_XFER_NS_3;
+ asc_dvc->sdtr_period_tbl[4] = SYN_ULTRA_XFER_NS_4;
+ asc_dvc->sdtr_period_tbl[5] = SYN_ULTRA_XFER_NS_5;
+ asc_dvc->sdtr_period_tbl[6] = SYN_ULTRA_XFER_NS_6;
+ asc_dvc->sdtr_period_tbl[7] = SYN_ULTRA_XFER_NS_7;
+ asc_dvc->sdtr_period_tbl[8] = SYN_ULTRA_XFER_NS_8;
+ asc_dvc->sdtr_period_tbl[9] = SYN_ULTRA_XFER_NS_9;
+ asc_dvc->sdtr_period_tbl[10] = SYN_ULTRA_XFER_NS_10;
+ asc_dvc->sdtr_period_tbl[11] = SYN_ULTRA_XFER_NS_11;
+ asc_dvc->sdtr_period_tbl[12] = SYN_ULTRA_XFER_NS_12;
+ asc_dvc->sdtr_period_tbl[13] = SYN_ULTRA_XFER_NS_13;
+ asc_dvc->sdtr_period_tbl[14] = SYN_ULTRA_XFER_NS_14;
+ asc_dvc->sdtr_period_tbl[15] = SYN_ULTRA_XFER_NS_15;
+ asc_dvc->max_sdtr_index = 15;
+ if (chip_version == ASC_CHIP_VER_PCI_ULTRA_3150)
+ {
+ AscSetExtraControl(iop_base,
+ (SEC_ACTIVE_NEGATE | SEC_SLEW_RATE));
+ } else if (chip_version >= ASC_CHIP_VER_PCI_ULTRA_3050) {
+ AscSetExtraControl(iop_base,
+ (SEC_ACTIVE_NEGATE | SEC_ENABLE_FILTER));
+ }
+ }
+ if (asc_dvc->bus_type == ASC_IS_PCI) {
+ AscSetExtraControl(iop_base, (SEC_ACTIVE_NEGATE | SEC_SLEW_RATE));
+ }
+
+ asc_dvc->cfg->isa_dma_speed = ASC_DEF_ISA_DMA_SPEED;
+ if (AscGetChipBusType(iop_base) == ASC_IS_ISAPNP) {
+ AscSetChipIFC(iop_base, IFC_INIT_DEFAULT);
+ asc_dvc->bus_type = ASC_IS_ISAPNP;
+ }
+ if ((asc_dvc->bus_type & ASC_IS_ISA) != 0) {
+ asc_dvc->cfg->isa_dma_channel = (uchar) AscGetIsaDmaChannel(iop_base);
+ }
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ asc_dvc->cur_dvc_qng[i] = 0;
+ asc_dvc->max_dvc_qng[i] = ASC_MAX_SCSI1_QNG;
+ asc_dvc->scsiq_busy_head[i] = (ASC_SCSI_Q *) 0L;
+ asc_dvc->scsiq_busy_tail[i] = (ASC_SCSI_Q *) 0L;
+ asc_dvc->cfg->max_tag_qng[i] = ASC_MAX_INRAM_TAG_QNG;
+ }
+ return (warn_code);
}
#if CC_INCLUDE_EEP_CONFIG
-ushort
+ASC_INITFUNC(
+STATIC ushort
AscInitFromEEP(
- ASC_DVC_VAR asc_ptr_type * asc_dvc
-)
-{
- ASCEEP_CONFIG eep_config_buf;
- ASCEEP_CONFIG dosfar *eep_config;
- PortAddr iop_base;
- ushort chksum;
- ushort warn_code;
- ushort cfg_msw, cfg_lsw;
- int i;
- iop_base = asc_dvc->iop_base;
- warn_code = 0;
- AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0x00FE);
- AscStopQueueExe(iop_base);
- if ((AscStopChip(iop_base) == FALSE) ||
- (AscGetChipScsiCtrl(iop_base) != 0)) {
- asc_dvc->init_state |= ASC_INIT_RESET_SCSI_DONE;
- AscResetChipAndScsiBus(iop_base);
- DvcSleepMilliSecond((ulong) ((ushort) asc_dvc->scsi_reset_wait * 1000));
- }
- if (AscIsChipHalted(iop_base) == FALSE) {
- asc_dvc->err_code |= ASC_IERR_START_STOP_CHIP;
- return (warn_code);
- }
- AscSetPCAddr(iop_base, ASC_MCODE_START_ADDR);
- if (AscGetPCAddr(iop_base) != ASC_MCODE_START_ADDR) {
- asc_dvc->err_code |= ASC_IERR_SET_PC_ADDR;
- return (warn_code);
- }
- eep_config = (ASCEEP_CONFIG dosfar *) & eep_config_buf;
- cfg_msw = AscGetChipCfgMsw(iop_base);
- cfg_lsw = AscGetChipCfgLsw(iop_base);
- if ((cfg_msw & ASC_CFG_MSW_CLR_MASK) != 0) {
- cfg_msw &= (~(ASC_CFG_MSW_CLR_MASK));
- warn_code |= ASC_WARN_CFG_MSW_RECOVER;
- AscSetChipCfgMsw(iop_base, cfg_msw);
- }
- chksum = AscGetEEPConfig(iop_base, eep_config, asc_dvc->bus_type);
- eep_config->cfg_msw &= (~(ASC_CFG_MSW_CLR_MASK));
- if (AscGetChipStatus(iop_base) & CSW_AUTO_CONFIG) {
- warn_code |= ASC_WARN_AUTO_CONFIG;
- if (asc_dvc->cfg->chip_version == 3) {
- if (eep_config->cfg_lsw != cfg_lsw) {
- warn_code |= ASC_WARN_EEPROM_RECOVER;
- eep_config->cfg_lsw = AscGetChipCfgLsw(iop_base);
- }
- if (eep_config->cfg_msw != cfg_msw) {
- warn_code |= ASC_WARN_EEPROM_RECOVER;
- eep_config->cfg_msw = AscGetChipCfgMsw(iop_base);
- }
- }
- }
- eep_config->cfg_lsw |= ASC_CFG0_HOST_INT_ON;
- if (chksum != eep_config->chksum) {
- warn_code |= ASC_WARN_EEPROM_CHKSUM;
- }
- asc_dvc->init_sdtr = eep_config->init_sdtr;
- asc_dvc->cfg->disc_enable = eep_config->disc_enable;
- asc_dvc->cfg->cmd_qng_enabled = eep_config->use_cmd_qng;
- asc_dvc->cfg->isa_dma_speed = eep_config->isa_dma_speed;
- asc_dvc->start_motor = eep_config->start_motor;
- asc_dvc->dvc_cntl = eep_config->cntl;
- asc_dvc->no_scam = eep_config->no_scam;
- if (!AscTestExternalLram(asc_dvc)) {
- if (
- ((asc_dvc->bus_type & ASC_IS_PCI_ULTRA) == ASC_IS_PCI_ULTRA)
- ) {
- eep_config->max_total_qng = ASC_MAX_PCI_ULTRA_INRAM_TOTAL_QNG;
- eep_config->max_tag_qng = ASC_MAX_PCI_ULTRA_INRAM_TAG_QNG;
- } else {
- eep_config->cfg_msw |= 0x0800;
- cfg_msw |= 0x0800;
- AscSetChipCfgMsw(iop_base, cfg_msw);
- eep_config->max_total_qng = ASC_MAX_PCI_INRAM_TOTAL_QNG;
- eep_config->max_tag_qng = ASC_MAX_INRAM_TAG_QNG;
- }
- } else {
- }
- if (eep_config->max_total_qng < ASC_MIN_TOTAL_QNG) {
- eep_config->max_total_qng = ASC_MIN_TOTAL_QNG;
- }
- if (eep_config->max_total_qng > ASC_MAX_TOTAL_QNG) {
- eep_config->max_total_qng = ASC_MAX_TOTAL_QNG;
- }
- if (eep_config->max_tag_qng > eep_config->max_total_qng) {
- eep_config->max_tag_qng = eep_config->max_total_qng;
- }
- if (eep_config->max_tag_qng < ASC_MIN_TAG_Q_PER_DVC) {
- eep_config->max_tag_qng = ASC_MIN_TAG_Q_PER_DVC;
- }
- asc_dvc->max_total_qng = eep_config->max_total_qng;
- if ((eep_config->use_cmd_qng & eep_config->disc_enable) !=
- eep_config->use_cmd_qng) {
- eep_config->disc_enable = eep_config->use_cmd_qng;
- warn_code |= ASC_WARN_CMD_QNG_CONFLICT;
- }
- if (asc_dvc->bus_type & (ASC_IS_ISA | ASC_IS_VL | ASC_IS_EISA)) {
- asc_dvc->irq_no = AscGetChipIRQ(iop_base, asc_dvc->bus_type);
- }
- eep_config->chip_scsi_id &= ASC_MAX_TID;
- asc_dvc->cfg->chip_scsi_id = eep_config->chip_scsi_id;
- if (((asc_dvc->bus_type & ASC_IS_PCI_ULTRA ) == ASC_IS_PCI_ULTRA ) &&
- !(asc_dvc->dvc_cntl & ASC_CNTL_SDTR_ENABLE_ULTRA)) {
- asc_dvc->host_init_sdtr_index = ASC_SDTR_ULTRA_PCI_10MB_INDEX;
- }
-
- for (i = 0; i <= ASC_MAX_TID; i++) {
+ ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+)
+{
+ ASCEEP_CONFIG eep_config_buf;
+ ASCEEP_CONFIG *eep_config;
+ PortAddr iop_base;
+ ushort chksum;
+ ushort warn_code;
+ ushort cfg_msw, cfg_lsw;
+ int i;
+ iop_base = asc_dvc->iop_base;
+ warn_code = 0;
+ AscWriteLramWord(iop_base, ASCV_HALTCODE_W, 0x00FE);
+ AscStopQueueExe(iop_base);
+ if ((AscStopChip(iop_base) == FALSE) ||
+ (AscGetChipScsiCtrl(iop_base) != 0)) {
+ asc_dvc->init_state |= ASC_INIT_RESET_SCSI_DONE;
+ AscResetChipAndScsiBus(iop_base);
+ DvcSleepMilliSecond((ulong) ((ushort) asc_dvc->scsi_reset_wait * 1000));
+ }
+ if (AscIsChipHalted(iop_base) == FALSE) {
+ asc_dvc->err_code |= ASC_IERR_START_STOP_CHIP;
+ return (warn_code);
+ }
+ AscSetPCAddr(iop_base, ASC_MCODE_START_ADDR);
+ if (AscGetPCAddr(iop_base) != ASC_MCODE_START_ADDR) {
+ asc_dvc->err_code |= ASC_IERR_SET_PC_ADDR;
+ return (warn_code);
+ }
+ eep_config = (ASCEEP_CONFIG *) & eep_config_buf;
+ cfg_msw = AscGetChipCfgMsw(iop_base);
+ cfg_lsw = AscGetChipCfgLsw(iop_base);
+ if ((cfg_msw & ASC_CFG_MSW_CLR_MASK) != 0) {
+ cfg_msw &= (~(ASC_CFG_MSW_CLR_MASK));
+ warn_code |= ASC_WARN_CFG_MSW_RECOVER;
+ AscSetChipCfgMsw(iop_base, cfg_msw);
+ }
+ chksum = AscGetEEPConfig(iop_base, eep_config, asc_dvc->bus_type);
+ eep_config->cfg_msw &= (~(ASC_CFG_MSW_CLR_MASK));
+ if (AscGetChipStatus(iop_base) & CSW_AUTO_CONFIG) {
+ warn_code |= ASC_WARN_AUTO_CONFIG;
+ if (asc_dvc->cfg->chip_version == 3) {
+ if (eep_config->cfg_lsw != cfg_lsw) {
+ warn_code |= ASC_WARN_EEPROM_RECOVER;
+ eep_config->cfg_lsw = AscGetChipCfgLsw(iop_base);
+ }
+ if (eep_config->cfg_msw != cfg_msw) {
+ warn_code |= ASC_WARN_EEPROM_RECOVER;
+ eep_config->cfg_msw = AscGetChipCfgMsw(iop_base);
+ }
+ }
+ }
+ eep_config->cfg_lsw |= ASC_CFG0_HOST_INT_ON;
+ if (chksum != eep_config->chksum) {
+ warn_code |= ASC_WARN_EEPROM_CHKSUM;
+ }
+ asc_dvc->init_sdtr = eep_config->init_sdtr;
+ asc_dvc->cfg->disc_enable = eep_config->disc_enable;
+ asc_dvc->cfg->cmd_qng_enabled = eep_config->use_cmd_qng;
+ asc_dvc->cfg->isa_dma_speed = eep_config->isa_dma_speed;
+ asc_dvc->start_motor = eep_config->start_motor;
+ asc_dvc->dvc_cntl = eep_config->cntl;
+ asc_dvc->no_scam = eep_config->no_scam;
+ if (!AscTestExternalLram(asc_dvc)) {
+ if (((asc_dvc->bus_type & ASC_IS_PCI_ULTRA) == ASC_IS_PCI_ULTRA)) {
+ eep_config->max_total_qng = ASC_MAX_PCI_ULTRA_INRAM_TOTAL_QNG;
+ eep_config->max_tag_qng = ASC_MAX_PCI_ULTRA_INRAM_TAG_QNG;
+ } else {
+ eep_config->cfg_msw |= 0x0800;
+ cfg_msw |= 0x0800;
+ AscSetChipCfgMsw(iop_base, cfg_msw);
+ eep_config->max_total_qng = ASC_MAX_PCI_INRAM_TOTAL_QNG;
+ eep_config->max_tag_qng = ASC_MAX_INRAM_TAG_QNG;
+ }
+ } else {
+ }
+ if (eep_config->max_total_qng < ASC_MIN_TOTAL_QNG) {
+ eep_config->max_total_qng = ASC_MIN_TOTAL_QNG;
+ }
+ if (eep_config->max_total_qng > ASC_MAX_TOTAL_QNG) {
+ eep_config->max_total_qng = ASC_MAX_TOTAL_QNG;
+ }
+ if (eep_config->max_tag_qng > eep_config->max_total_qng) {
+ eep_config->max_tag_qng = eep_config->max_total_qng;
+ }
+ if (eep_config->max_tag_qng < ASC_MIN_TAG_Q_PER_DVC) {
+ eep_config->max_tag_qng = ASC_MIN_TAG_Q_PER_DVC;
+ }
+ asc_dvc->max_total_qng = eep_config->max_total_qng;
+ if ((eep_config->use_cmd_qng & eep_config->disc_enable) !=
+ eep_config->use_cmd_qng) {
+ eep_config->disc_enable = eep_config->use_cmd_qng;
+ warn_code |= ASC_WARN_CMD_QNG_CONFLICT;
+ }
+ if (asc_dvc->bus_type & (ASC_IS_ISA | ASC_IS_VL | ASC_IS_EISA)) {
+ asc_dvc->irq_no = AscGetChipIRQ(iop_base, asc_dvc->bus_type);
+ }
+ eep_config->chip_scsi_id &= ASC_MAX_TID;
+ asc_dvc->cfg->chip_scsi_id = eep_config->chip_scsi_id;
+ if (((asc_dvc->bus_type & ASC_IS_PCI_ULTRA) == ASC_IS_PCI_ULTRA) &&
+ !(asc_dvc->dvc_cntl & ASC_CNTL_SDTR_ENABLE_ULTRA)) {
+ asc_dvc->host_init_sdtr_index = ASC_SDTR_ULTRA_PCI_10MB_INDEX;
+ }
+
+ for (i = 0; i <= ASC_MAX_TID; i++) {
#if CC_TMP_USE_EEP_SDTR
- asc_dvc->cfg->sdtr_period_offset[i] = eep_config->dos_int13_table[i];
+ asc_dvc->cfg->sdtr_period_offset[i] = eep_config->dos_int13_table[i];
#endif
- asc_dvc->dos_int13_table[i] = eep_config->dos_int13_table[i];
- asc_dvc->cfg->max_tag_qng[i] = eep_config->max_tag_qng;
- asc_dvc->cfg->sdtr_period_offset[i] =
- (uchar) (ASC_DEF_SDTR_OFFSET |
- (asc_dvc->host_init_sdtr_index << 4));
- }
- eep_config->cfg_msw = AscGetChipCfgMsw(iop_base);
+ asc_dvc->dos_int13_table[i] = eep_config->dos_int13_table[i];
+ asc_dvc->cfg->max_tag_qng[i] = eep_config->max_tag_qng;
+ asc_dvc->cfg->sdtr_period_offset[i] =
+ (uchar) (ASC_DEF_SDTR_OFFSET |
+ (asc_dvc->host_init_sdtr_index << 4));
+ }
+ eep_config->cfg_msw = AscGetChipCfgMsw(iop_base);
#if CC_CHK_FIX_EEP_CONTENT
- if (AscSetEEPConfig(iop_base, eep_config, asc_dvc->bus_type) != 0) {
- asc_dvc->err_code |= ASC_IERR_WRITE_EEPROM;
- }
+ if (AscSetEEPConfig(iop_base, eep_config, asc_dvc->bus_type) != 0) {
+ asc_dvc->err_code |= ASC_IERR_WRITE_EEPROM;
+ }
#endif
- return (warn_code);
+ return (warn_code);
}
#endif
-ushort
-AscInitWithoutEEP(
- ASC_DVC_VAR asc_ptr_type * asc_dvc
-)
-{
- PortAddr iop_base;
- ushort warn_code;
- ushort cfg_msw;
- int i;
- iop_base = asc_dvc->iop_base;
- warn_code = 0;
- cfg_msw = AscGetChipCfgMsw(iop_base);
- if ((cfg_msw & ASC_CFG_MSW_CLR_MASK) != 0) {
- cfg_msw &= (~(ASC_CFG_MSW_CLR_MASK));
- warn_code |= ASC_WARN_CFG_MSW_RECOVER;
- AscSetChipCfgMsw(iop_base, cfg_msw);
- }
- if (!AscTestExternalLram(asc_dvc)) {
- if (((asc_dvc->bus_type & ASC_IS_PCI_ULTRA) == ASC_IS_PCI_ULTRA)) {
- asc_dvc->max_total_qng = ASC_MAX_PCI_ULTRA_INRAM_TOTAL_QNG ;
- for( i = 0 ; i <= ASC_MAX_TID ; i++ ) {
- asc_dvc->cfg->max_tag_qng[ i ] = ASC_MAX_PCI_ULTRA_INRAM_TAG_QNG ;
- }
- } else {
- cfg_msw |= 0x0800;
- AscSetChipCfgMsw(iop_base, cfg_msw);
- asc_dvc->max_total_qng = ASC_MAX_PCI_INRAM_TOTAL_QNG;
- for (i = 0 ; i <= ASC_MAX_TID ; i++) {
- asc_dvc->cfg->max_tag_qng[ i ] = ASC_MAX_INRAM_TAG_QNG;
- }
- }
- }
- if (asc_dvc->bus_type & (ASC_IS_ISA | ASC_IS_VL | ASC_IS_EISA)) {
- asc_dvc->irq_no = AscGetChipIRQ(iop_base, asc_dvc->bus_type);
- }
- return (warn_code);
-}
-
-ushort
+ASC_INITFUNC(
+STATIC ushort
AscInitMicroCodeVar(
- ASC_DVC_VAR asc_ptr_type * asc_dvc
-)
-{
- int i;
- ushort warn_code;
- PortAddr iop_base;
- ulong phy_addr;
- iop_base = asc_dvc->iop_base;
- warn_code = 0;
- for (i = 0; i <= ASC_MAX_TID; i++) {
- AscPutMCodeInitSDTRAtID(iop_base, i,
- asc_dvc->cfg->sdtr_period_offset[i]
- );
- }
- AscInitQLinkVar(asc_dvc);
- AscWriteLramByte(iop_base, ASCV_DISC_ENABLE_B,
- asc_dvc->cfg->disc_enable);
- AscWriteLramByte(iop_base, ASCV_HOSTSCSI_ID_B,
- ASC_TID_TO_TARGET_ID(asc_dvc->cfg->chip_scsi_id));
- if ((phy_addr = AscGetOnePhyAddr(asc_dvc,
- (uchar dosfar *) asc_dvc->cfg->overrun_buf,
- ASC_OVERRUN_BSIZE)) == 0L) {
- asc_dvc->err_code |= ASC_IERR_GET_PHY_ADDR;
- } else {
- phy_addr = (phy_addr & 0xFFFFFFF8UL) + 8;
- AscWriteLramDWord(iop_base, ASCV_OVERRUN_PADDR_D, phy_addr);
- AscWriteLramDWord(iop_base, ASCV_OVERRUN_BSIZE_D,
- ASC_OVERRUN_BSIZE - 8);
- }
- asc_dvc->cfg->mcode_date = AscReadLramWord(iop_base,
- (ushort) ASCV_MC_DATE_W);
- asc_dvc->cfg->mcode_version = AscReadLramWord(iop_base,
- (ushort) ASCV_MC_VER_W);
- AscSetPCAddr(iop_base, ASC_MCODE_START_ADDR);
- if (AscGetPCAddr(iop_base) != ASC_MCODE_START_ADDR) {
- asc_dvc->err_code |= ASC_IERR_SET_PC_ADDR;
- return (warn_code);
- }
- if (AscStartChip(iop_base) != 1) {
- asc_dvc->err_code |= ASC_IERR_START_STOP_CHIP;
- return (warn_code);
- }
- return (warn_code);
-}
-
-void dosfar
+ ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+)
+{
+ int i;
+ ushort warn_code;
+ PortAddr iop_base;
+ ulong phy_addr;
+ iop_base = asc_dvc->iop_base;
+ warn_code = 0;
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ AscPutMCodeInitSDTRAtID(iop_base, i,
+ asc_dvc->cfg->sdtr_period_offset[i]
+);
+ }
+ AscInitQLinkVar(asc_dvc);
+ AscWriteLramByte(iop_base, ASCV_DISC_ENABLE_B,
+ asc_dvc->cfg->disc_enable);
+ AscWriteLramByte(iop_base, ASCV_HOSTSCSI_ID_B,
+ ASC_TID_TO_TARGET_ID(asc_dvc->cfg->chip_scsi_id));
+ if ((phy_addr = AscGetOnePhyAddr(asc_dvc,
+ (uchar *) asc_dvc->cfg->overrun_buf,
+ ASC_OVERRUN_BSIZE)) == 0L) {
+ asc_dvc->err_code |= ASC_IERR_GET_PHY_ADDR;
+ } else {
+ phy_addr = (phy_addr & 0xFFFFFFF8UL) + 8;
+ AscWriteLramDWord(iop_base, ASCV_OVERRUN_PADDR_D, phy_addr);
+ AscWriteLramDWord(iop_base, ASCV_OVERRUN_BSIZE_D,
+ ASC_OVERRUN_BSIZE - 8);
+ }
+ asc_dvc->cfg->mcode_date = AscReadLramWord(iop_base,
+ (ushort) ASCV_MC_DATE_W);
+ asc_dvc->cfg->mcode_version = AscReadLramWord(iop_base,
+ (ushort) ASCV_MC_VER_W);
+ AscSetPCAddr(iop_base, ASC_MCODE_START_ADDR);
+ if (AscGetPCAddr(iop_base) != ASC_MCODE_START_ADDR) {
+ asc_dvc->err_code |= ASC_IERR_SET_PC_ADDR;
+ return (warn_code);
+ }
+ if (AscStartChip(iop_base) != 1) {
+ asc_dvc->err_code |= ASC_IERR_START_STOP_CHIP;
+ return (warn_code);
+ }
+ return (warn_code);
+}
+
+STATIC void
AscInitPollIsrCallBack(
- ASC_DVC_VAR asc_ptr_type * asc_dvc,
- ASC_QDONE_INFO dosfar * scsi_done_q
-)
-{
- ASC_SCSI_REQ_Q dosfar *scsiq_req;
- ASC_ISR_CALLBACK asc_isr_callback;
- uchar cp_sen_len;
- uchar i;
- ASC_DBG(1, "AscInitPollIsrCallBack: begin\n");
- if ((scsi_done_q->d2.flag & ASC_FLAG_SCSIQ_REQ) != 0) {
- scsiq_req = (ASC_SCSI_REQ_Q dosfar *) scsi_done_q->d2.srb_ptr;
- scsiq_req->r3.done_stat = scsi_done_q->d3.done_stat;
- scsiq_req->r3.host_stat = scsi_done_q->d3.host_stat;
- scsiq_req->r3.scsi_stat = scsi_done_q->d3.scsi_stat;
- scsiq_req->r3.scsi_msg = scsi_done_q->d3.scsi_msg;
- ASC_DBG4(1, "AscInitPollIsrCallBack: done_stat %x, host_stat %x, scsi_stat %x, scsi_msg %x\n",
- scsi_done_q->d3.done_stat, scsi_done_q->d3.host_stat,
- scsi_done_q->d3.scsi_stat, scsi_done_q->d3.scsi_msg);
- if ((scsi_done_q->d3.scsi_stat == SS_CHK_CONDITION) &&
- (scsi_done_q->d3.host_stat == 0)) {
- cp_sen_len = (uchar) ASC_MIN_SENSE_LEN;
- if (scsiq_req->r1.sense_len < ASC_MIN_SENSE_LEN) {
- cp_sen_len = (uchar) scsiq_req->r1.sense_len;
- }
- for (i = 0; i < cp_sen_len; i++) {
- scsiq_req->sense[i] = scsiq_req->sense_ptr[i];
- }
- }
- } else {
- if (asc_dvc->isr_callback != 0) {
- asc_isr_callback = (ASC_ISR_CALLBACK) asc_dvc->isr_callback;
- (*asc_isr_callback) (asc_dvc, scsi_done_q);
- }
- }
- ASC_DBG(1, "AscInitPollIsrCallBack: end\n");
- return;
+ ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ ASC_QDONE_INFO * scsi_done_q
+)
+{
+ ASC_SCSI_REQ_Q *scsiq_req;
+ ASC_ISR_CALLBACK asc_isr_callback;
+ uchar cp_sen_len;
+ uchar i;
+ ASC_DBG(1, "AscInitPollIsrCallBack: begin\n");
+ if ((scsi_done_q->d2.flag & ASC_FLAG_SCSIQ_REQ) != 0) {
+ scsiq_req = (ASC_SCSI_REQ_Q *) scsi_done_q->d2.srb_ptr;
+ scsiq_req->r3.done_stat = scsi_done_q->d3.done_stat;
+ scsiq_req->r3.host_stat = scsi_done_q->d3.host_stat;
+ scsiq_req->r3.scsi_stat = scsi_done_q->d3.scsi_stat;
+ scsiq_req->r3.scsi_msg = scsi_done_q->d3.scsi_msg;
+ ASC_DBG4(1, "AscInitPollIsrCallBack: done_stat %x, host_stat %x, scsi_stat %x, scsi_msg %x\n",
+ scsi_done_q->d3.done_stat, scsi_done_q->d3.host_stat,
+ scsi_done_q->d3.scsi_stat, scsi_done_q->d3.scsi_msg);
+ if ((scsi_done_q->d3.scsi_stat == SS_CHK_CONDITION) &&
+ (scsi_done_q->d3.host_stat == 0)) {
+ cp_sen_len = (uchar) ASC_MIN_SENSE_LEN;
+ if (scsiq_req->r1.sense_len < ASC_MIN_SENSE_LEN) {
+ cp_sen_len = (uchar) scsiq_req->r1.sense_len;
+ }
+ for (i = 0; i < cp_sen_len; i++) {
+ scsiq_req->sense[i] = scsiq_req->sense_ptr[i];
+ }
+ }
+ } else {
+ if (asc_dvc->isr_callback != 0) {
+ asc_isr_callback = (ASC_ISR_CALLBACK) asc_dvc->isr_callback;
+ (*asc_isr_callback) (asc_dvc, scsi_done_q);
+ }
+ }
+ ASC_DBG(1, "AscInitPollIsrCallBack: end\n");
+ return;
}
-int
+ASC_INITFUNC(
+STATIC int
AscTestExternalLram(
- ASC_DVC_VAR asc_ptr_type * asc_dvc
-)
-{
- PortAddr iop_base;
- ushort q_addr;
- ushort saved_word;
- int sta;
- iop_base = asc_dvc->iop_base;
- sta = 0;
- q_addr = ASC_QNO_TO_QADDR(241);
- saved_word = AscReadLramWord(iop_base, q_addr);
- AscSetChipLramAddr(iop_base, q_addr);
- AscSetChipLramData(iop_base, 0x55AA);
- DvcSleepMilliSecond(10);
- AscSetChipLramAddr(iop_base, q_addr);
- if (AscGetChipLramData(iop_base) == 0x55AA) {
- sta = 1;
- AscWriteLramWord(iop_base, q_addr, saved_word);
- }
- return (sta);
+ ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+)
+{
+ PortAddr iop_base;
+ ushort q_addr;
+ ushort saved_word;
+ int sta;
+ iop_base = asc_dvc->iop_base;
+ sta = 0;
+ q_addr = ASC_QNO_TO_QADDR(241);
+ saved_word = AscReadLramWord(iop_base, q_addr);
+ AscSetChipLramAddr(iop_base, q_addr);
+ AscSetChipLramData(iop_base, 0x55AA);
+ DvcSleepMilliSecond(10);
+ AscSetChipLramAddr(iop_base, q_addr);
+ if (AscGetChipLramData(iop_base) == 0x55AA) {
+ sta = 1;
+ AscWriteLramWord(iop_base, q_addr, saved_word);
+ }
+ return (sta);
}
#if CC_INCLUDE_EEP_CONFIG
-int
+ASC_INITFUNC(
+STATIC int
AscWriteEEPCmdReg(
- PortAddr iop_base,
- uchar cmd_reg
-)
-{
- uchar read_back;
- int retry;
- retry = 0;
- while (TRUE) {
- AscSetChipEEPCmd(iop_base, cmd_reg);
- DvcSleepMilliSecond(1);
- read_back = AscGetChipEEPCmd(iop_base);
- if (read_back == cmd_reg) {
- return (1);
- }
- if (retry++ > ASC_EEP_MAX_RETRY) {
- return (0);
- }
- }
+ PortAddr iop_base,
+ uchar cmd_reg
+)
+)
+{
+ uchar read_back;
+ int retry;
+ retry = 0;
+ while (TRUE) {
+ AscSetChipEEPCmd(iop_base, cmd_reg);
+ DvcSleepMilliSecond(1);
+ read_back = AscGetChipEEPCmd(iop_base);
+ if (read_back == cmd_reg) {
+ return (1);
+ }
+ if (retry++ > ASC_EEP_MAX_RETRY) {
+ return (0);
+ }
+ }
}
-int
+ASC_INITFUNC(
+STATIC int
AscWriteEEPDataReg(
- PortAddr iop_base,
- ushort data_reg
-)
-{
- ushort read_back;
- int retry;
- retry = 0;
- while (TRUE) {
- AscSetChipEEPData(iop_base, data_reg);
- DvcSleepMilliSecond(1);
- read_back = AscGetChipEEPData(iop_base);
- if (read_back == data_reg) {
- return (1);
- }
- if (retry++ > ASC_EEP_MAX_RETRY) {
- return (0);
- }
- }
+ PortAddr iop_base,
+ ushort data_reg
+)
+)
+{
+ ushort read_back;
+ int retry;
+ retry = 0;
+ while (TRUE) {
+ AscSetChipEEPData(iop_base, data_reg);
+ DvcSleepMilliSecond(1);
+ read_back = AscGetChipEEPData(iop_base);
+ if (read_back == data_reg) {
+ return (1);
+ }
+ if (retry++ > ASC_EEP_MAX_RETRY) {
+ return (0);
+ }
+ }
}
-void
+ASC_INITFUNC(
+STATIC void
AscWaitEEPRead(
- void
+ void
+)
)
{
- DvcSleepMilliSecond(1);
- return;
+ DvcSleepMilliSecond(1);
+ return;
}
-void
+ASC_INITFUNC(
+STATIC void
AscWaitEEPWrite(
- void
+ void
+)
)
{
- DvcSleepMilliSecond(20);
- return;
+ DvcSleepMilliSecond(20);
+ return;
}
-ushort
+ASC_INITFUNC(
+STATIC ushort
AscReadEEPWord(
- PortAddr iop_base,
- uchar addr
+ PortAddr iop_base,
+ uchar addr
+)
)
{
- ushort read_wval;
- uchar cmd_reg;
- AscWriteEEPCmdReg(iop_base, ASC_EEP_CMD_WRITE_DISABLE);
- AscWaitEEPRead();
- cmd_reg = addr | ASC_EEP_CMD_READ;
- AscWriteEEPCmdReg(iop_base, cmd_reg);
- AscWaitEEPRead();
- read_wval = AscGetChipEEPData(iop_base);
- AscWaitEEPRead();
- return (read_wval);
+ ushort read_wval;
+ uchar cmd_reg;
+ AscWriteEEPCmdReg(iop_base, ASC_EEP_CMD_WRITE_DISABLE);
+ AscWaitEEPRead();
+ cmd_reg = addr | ASC_EEP_CMD_READ;
+ AscWriteEEPCmdReg(iop_base, cmd_reg);
+ AscWaitEEPRead();
+ read_wval = AscGetChipEEPData(iop_base);
+ AscWaitEEPRead();
+ return (read_wval);
}
-ushort
+ASC_INITFUNC(
+STATIC ushort
AscWriteEEPWord(
- PortAddr iop_base,
- uchar addr,
- ushort word_val
-)
-{
- ushort read_wval;
- read_wval = AscReadEEPWord(iop_base, addr);
- if (read_wval != word_val) {
- AscWriteEEPCmdReg(iop_base, ASC_EEP_CMD_WRITE_ABLE);
- AscWaitEEPRead();
- AscWriteEEPDataReg(iop_base, word_val);
- AscWaitEEPRead();
- AscWriteEEPCmdReg(iop_base,
- (uchar) ((uchar) ASC_EEP_CMD_WRITE | addr));
- AscWaitEEPWrite();
- AscWriteEEPCmdReg(iop_base, ASC_EEP_CMD_WRITE_DISABLE);
- AscWaitEEPRead();
- return (AscReadEEPWord(iop_base, addr));
- }
- return (read_wval);
-}
-
-ushort
+ PortAddr iop_base,
+ uchar addr,
+ ushort word_val
+)
+)
+{
+ ushort read_wval;
+ read_wval = AscReadEEPWord(iop_base, addr);
+ if (read_wval != word_val) {
+ AscWriteEEPCmdReg(iop_base, ASC_EEP_CMD_WRITE_ABLE);
+ AscWaitEEPRead();
+ AscWriteEEPDataReg(iop_base, word_val);
+ AscWaitEEPRead();
+ AscWriteEEPCmdReg(iop_base,
+ (uchar) ((uchar) ASC_EEP_CMD_WRITE | addr));
+ AscWaitEEPWrite();
+ AscWriteEEPCmdReg(iop_base, ASC_EEP_CMD_WRITE_DISABLE);
+ AscWaitEEPRead();
+ return (AscReadEEPWord(iop_base, addr));
+ }
+ return (read_wval);
+}
+
+ASC_INITFUNC(
+STATIC ushort
AscGetEEPConfig(
- PortAddr iop_base,
- ASCEEP_CONFIG dosfar * cfg_buf, ushort bus_type
-)
-{
- ushort wval;
- ushort sum;
- ushort dosfar *wbuf;
- int cfg_beg;
- int cfg_end;
- int s_addr;
- int isa_pnp_wsize;
- wbuf = (ushort dosfar *) cfg_buf;
- sum = 0;
- isa_pnp_wsize = 0;
- for (s_addr = 0; s_addr < (2 + isa_pnp_wsize); s_addr++, wbuf++) {
- wval = AscReadEEPWord(iop_base, (uchar) s_addr);
- sum += wval;
- *wbuf = wval;
- }
- if (bus_type & ASC_IS_VL) {
- cfg_beg = ASC_EEP_DVC_CFG_BEG_VL;
- cfg_end = ASC_EEP_MAX_DVC_ADDR_VL;
- } else {
- cfg_beg = ASC_EEP_DVC_CFG_BEG;
- cfg_end = ASC_EEP_MAX_DVC_ADDR;
- }
- for (s_addr = cfg_beg; s_addr <= (cfg_end - 1);
- s_addr++, wbuf++) {
- wval = AscReadEEPWord(iop_base, (uchar) s_addr);
- sum += wval;
- *wbuf = wval;
- }
- *wbuf = AscReadEEPWord(iop_base, (uchar) s_addr);
- return (sum);
+ PortAddr iop_base,
+ ASCEEP_CONFIG * cfg_buf, ushort bus_type
+)
+)
+{
+ ushort wval;
+ ushort sum;
+ ushort *wbuf;
+ int cfg_beg;
+ int cfg_end;
+ int s_addr;
+ int isa_pnp_wsize;
+ wbuf = (ushort *) cfg_buf;
+ sum = 0;
+ isa_pnp_wsize = 0;
+ for (s_addr = 0; s_addr < (2 + isa_pnp_wsize); s_addr++, wbuf++) {
+ wval = AscReadEEPWord(iop_base, (uchar) s_addr);
+ sum += wval;
+ *wbuf = wval;
+ }
+ if (bus_type & ASC_IS_VL) {
+ cfg_beg = ASC_EEP_DVC_CFG_BEG_VL;
+ cfg_end = ASC_EEP_MAX_DVC_ADDR_VL;
+ } else {
+ cfg_beg = ASC_EEP_DVC_CFG_BEG;
+ cfg_end = ASC_EEP_MAX_DVC_ADDR;
+ }
+ for (s_addr = cfg_beg; s_addr <= (cfg_end - 1);
+ s_addr++, wbuf++) {
+ wval = AscReadEEPWord(iop_base, (uchar) s_addr);
+ sum += wval;
+ *wbuf = wval;
+ }
+ *wbuf = AscReadEEPWord(iop_base, (uchar) s_addr);
+ return (sum);
}
#if CC_CHK_FIX_EEP_CONTENT
-int
+ASC_INITFUNC(
+STATIC int
AscSetEEPConfigOnce(
- PortAddr iop_base,
- ASCEEP_CONFIG dosfar * cfg_buf, ushort bus_type
-)
-{
- int n_error;
- ushort dosfar *wbuf;
- ushort sum;
- int s_addr;
- int cfg_beg;
- int cfg_end;
- wbuf = (ushort dosfar *) cfg_buf;
- n_error = 0;
- sum = 0;
- for (s_addr = 0; s_addr < 2; s_addr++, wbuf++) {
- sum += *wbuf;
- if (*wbuf != AscWriteEEPWord(iop_base, (uchar) s_addr, *wbuf)) {
- n_error++;
- }
- }
- if (bus_type & ASC_IS_VL) {
- cfg_beg = ASC_EEP_DVC_CFG_BEG_VL;
- cfg_end = ASC_EEP_MAX_DVC_ADDR_VL;
- } else {
- cfg_beg = ASC_EEP_DVC_CFG_BEG;
- cfg_end = ASC_EEP_MAX_DVC_ADDR;
- }
- for (s_addr = cfg_beg; s_addr <= (cfg_end - 1);
- s_addr++, wbuf++) {
- sum += *wbuf;
- if (*wbuf != AscWriteEEPWord(iop_base, (uchar) s_addr, *wbuf)) {
- n_error++;
- }
- }
- *wbuf = sum;
- if (sum != AscWriteEEPWord(iop_base, (uchar) s_addr, sum)) {
- n_error++;
- }
- wbuf = (ushort dosfar *) cfg_buf;
- for (s_addr = 0; s_addr < 2; s_addr++, wbuf++) {
- if (*wbuf != AscReadEEPWord(iop_base, (uchar) s_addr)) {
- n_error++;
- }
- }
- for (s_addr = cfg_beg; s_addr <= cfg_end;
- s_addr++, wbuf++) {
- if (*wbuf != AscReadEEPWord(iop_base, (uchar) s_addr)) {
- n_error++;
- }
- }
- return (n_error);
+ PortAddr iop_base,
+ ASCEEP_CONFIG * cfg_buf, ushort bus_type
+)
+)
+{
+ int n_error;
+ ushort *wbuf;
+ ushort sum;
+ int s_addr;
+ int cfg_beg;
+ int cfg_end;
+ wbuf = (ushort *) cfg_buf;
+ n_error = 0;
+ sum = 0;
+ for (s_addr = 0; s_addr < 2; s_addr++, wbuf++) {
+ sum += *wbuf;
+ if (*wbuf != AscWriteEEPWord(iop_base, (uchar) s_addr, *wbuf)) {
+ n_error++;
+ }
+ }
+ if (bus_type & ASC_IS_VL) {
+ cfg_beg = ASC_EEP_DVC_CFG_BEG_VL;
+ cfg_end = ASC_EEP_MAX_DVC_ADDR_VL;
+ } else {
+ cfg_beg = ASC_EEP_DVC_CFG_BEG;
+ cfg_end = ASC_EEP_MAX_DVC_ADDR;
+ }
+ for (s_addr = cfg_beg; s_addr <= (cfg_end - 1);
+ s_addr++, wbuf++) {
+ sum += *wbuf;
+ if (*wbuf != AscWriteEEPWord(iop_base, (uchar) s_addr, *wbuf)) {
+ n_error++;
+ }
+ }
+ *wbuf = sum;
+ if (sum != AscWriteEEPWord(iop_base, (uchar) s_addr, sum)) {
+ n_error++;
+ }
+ wbuf = (ushort *) cfg_buf;
+ for (s_addr = 0; s_addr < 2; s_addr++, wbuf++) {
+ if (*wbuf != AscReadEEPWord(iop_base, (uchar) s_addr)) {
+ n_error++;
+ }
+ }
+ for (s_addr = cfg_beg; s_addr <= cfg_end;
+ s_addr++, wbuf++) {
+ if (*wbuf != AscReadEEPWord(iop_base, (uchar) s_addr)) {
+ n_error++;
+ }
+ }
+ return (n_error);
}
-int
+ASC_INITFUNC(
+STATIC int
AscSetEEPConfig(
- PortAddr iop_base,
- ASCEEP_CONFIG dosfar * cfg_buf, ushort bus_type
-)
-{
- int retry;
- int n_error;
- retry = 0;
- while (TRUE) {
- if ((n_error = AscSetEEPConfigOnce(iop_base, cfg_buf,
- bus_type)) == 0) {
- break;
- }
- if (++retry > ASC_EEP_MAX_RETRY) {
- break;
- }
- }
- return (n_error);
+ PortAddr iop_base,
+ ASCEEP_CONFIG * cfg_buf, ushort bus_type
+)
+)
+{
+ int retry;
+ int n_error;
+
+ retry = 0;
+ while (TRUE) {
+ if ((n_error = AscSetEEPConfigOnce(iop_base, cfg_buf,
+ bus_type)) == 0) {
+ break;
+ }
+ if (++retry > ASC_EEP_MAX_RETRY) {
+ break;
+ }
+ }
+ return (n_error);
}
#endif
#endif
-int
+STATIC int
AscInitPollBegin(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc
)
{
- PortAddr iop_base;
- iop_base = asc_dvc->iop_base;
-#if CC_INIT_INQ_DISPLAY
- DvcDisplayString((uchar dosfar *) "\r\n");
-#endif
- AscDisableInterrupt(iop_base);
- asc_dvc->init_state |= ASC_INIT_STATE_BEG_INQUIRY;
- AscWriteLramByte(iop_base, ASCV_DISC_ENABLE_B, 0x00);
- asc_dvc->use_tagged_qng = 0;
- asc_dvc->cfg->can_tagged_qng = 0;
- asc_dvc->saved_ptr2func = (ulong) asc_dvc->isr_callback;
- asc_dvc->isr_callback = ASC_GET_PTR2FUNC(AscInitPollIsrCallBack);
- return (0);
+ PortAddr iop_base;
+ iop_base = asc_dvc->iop_base;
+ AscDisableInterrupt(iop_base);
+ asc_dvc->init_state |= ASC_INIT_STATE_BEG_INQUIRY;
+ AscWriteLramByte(iop_base, ASCV_DISC_ENABLE_B, 0x00);
+ asc_dvc->use_tagged_qng = 0;
+ asc_dvc->cfg->can_tagged_qng = 0;
+ asc_dvc->saved_ptr2func = (ulong) asc_dvc->isr_callback;
+ asc_dvc->isr_callback = ASC_GET_PTR2FUNC(AscInitPollIsrCallBack);
+ return (0);
}
-int
+STATIC int
AscInitPollEnd(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc
-)
-{
- PortAddr iop_base;
- rint i;
- iop_base = asc_dvc->iop_base;
- asc_dvc->isr_callback = (Ptr2Func) asc_dvc->saved_ptr2func;
- AscWriteLramByte(iop_base, ASCV_DISC_ENABLE_B,
- asc_dvc->cfg->disc_enable);
- AscWriteLramByte(iop_base, ASCV_USE_TAGGED_QNG_B,
- asc_dvc->use_tagged_qng);
- AscWriteLramByte(iop_base, ASCV_CAN_TAGGED_QNG_B,
- asc_dvc->cfg->can_tagged_qng);
- for (i = 0; i <= ASC_MAX_TID; i++) {
- AscWriteLramByte(iop_base,
- (ushort) ((ushort) ASCV_MAX_DVC_QNG_BEG + (ushort) i),
- asc_dvc->max_dvc_qng[i]);
- }
- AscAckInterrupt(iop_base);
- AscEnableInterrupt(iop_base);
-#if CC_INIT_INQ_DISPLAY
- DvcDisplayString((uchar dosfar *) "\r\n");
-#endif
- asc_dvc->init_state |= ASC_INIT_STATE_END_INQUIRY;
- return (0);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc
+)
+{
+ PortAddr iop_base;
+ rint i;
+ iop_base = asc_dvc->iop_base;
+ asc_dvc->isr_callback = (Ptr2Func) asc_dvc->saved_ptr2func;
+ AscWriteLramByte(iop_base, ASCV_DISC_ENABLE_B,
+ asc_dvc->cfg->disc_enable);
+ AscWriteLramByte(iop_base, ASCV_USE_TAGGED_QNG_B,
+ asc_dvc->use_tagged_qng);
+ AscWriteLramByte(iop_base, ASCV_CAN_TAGGED_QNG_B,
+ asc_dvc->cfg->can_tagged_qng);
+ for (i = 0; i <= ASC_MAX_TID; i++) {
+ AscWriteLramByte(iop_base,
+ (ushort) ((ushort) ASCV_MAX_DVC_QNG_BEG + (ushort) i),
+ asc_dvc->max_dvc_qng[i]);
+ }
+ AscAckInterrupt(iop_base);
+ AscEnableInterrupt(iop_base);
+ asc_dvc->init_state |= ASC_INIT_STATE_END_INQUIRY;
+ return (0);
}
-int _asc_wait_slow_device_ = FALSE;
+STATIC int _asc_wait_slow_device_ = FALSE;
-int
+STATIC int
AscInitPollTarget(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_REQ_Q dosfar * scsiq,
- REG ASC_SCSI_INQUIRY dosfar * inq,
- REG ASC_CAP_INFO dosfar * cap_info
-)
-{
- uchar tid_no, lun;
- uchar dvc_type;
- ASC_SCSI_BIT_ID_TYPE tid_bits;
- int dvc_found;
- int support_read_cap;
- int tmp_disable_init_sdtr;
- int sta;
- dvc_found = 0;
- tmp_disable_init_sdtr = FALSE;
- tid_bits = scsiq->r1.target_id;
- lun = scsiq->r1.target_lun;
- tid_no = ASC_TIX_TO_TID(scsiq->r2.target_ix);
- if (
- ((asc_dvc->init_sdtr & tid_bits) != 0)
- && ((asc_dvc->sdtr_done & tid_bits) == 0)
- ) {
- asc_dvc->init_sdtr &= ~tid_bits;
- tmp_disable_init_sdtr = TRUE;
- }
- ASC_DBG(1, "AscInitPollTarget: before PollScsiInquiry\n");
- if (
- PollScsiInquiry(asc_dvc, scsiq, (uchar dosfar *) inq,
- sizeof (ASC_SCSI_INQUIRY)) == 1
- ) {
- dvc_found = 1;
- support_read_cap = TRUE;
- dvc_type = inq->byte0.peri_dvc_type;
- if (dvc_type != SCSI_TYPE_UNKNOWN) {
- if (
- (dvc_type != SCSI_TYPE_DASD)
- && (dvc_type != SCSI_TYPE_WORM)
- && (dvc_type != SCSI_TYPE_CDROM)
- && (dvc_type != SCSI_TYPE_OPTMEM)
- ) {
- asc_dvc->start_motor &= ~tid_bits;
- support_read_cap = FALSE;
- }
- if (
- (dvc_type != SCSI_TYPE_DASD)
- || inq->byte1.rmb
- ) {
- if (!_asc_wait_slow_device_) {
- DvcSleepMilliSecond(3000 - ((int) tid_no * 250));
- _asc_wait_slow_device_ = TRUE;
- }
- }
-#if CC_INIT_INQ_DISPLAY
- AscDispInquiry(tid_no, lun, inq);
-#endif
- if (lun == 0) {
- if (
- (inq->byte3.rsp_data_fmt >= 2)
- || (inq->byte2.ansi_apr_ver >= 2)
- ) {
- if (inq->byte7.CmdQue) {
- asc_dvc->cfg->can_tagged_qng |= tid_bits;
- if (asc_dvc->cfg->cmd_qng_enabled & tid_bits) {
- asc_dvc->use_tagged_qng |= tid_bits;
- asc_dvc->max_dvc_qng[tid_no] = asc_dvc->cfg->max_tag_qng[tid_no];
- }
- }
- if (!inq->byte7.Sync) {
- asc_dvc->init_sdtr &= ~tid_bits;
- asc_dvc->sdtr_done &= ~tid_bits;
- } else if (tmp_disable_init_sdtr) {
- asc_dvc->init_sdtr |= tid_bits;
- }
- } else {
- asc_dvc->init_sdtr &= ~tid_bits;
- asc_dvc->sdtr_done &= ~tid_bits;
- asc_dvc->use_tagged_qng &= ~tid_bits;
- }
- }
- if (asc_dvc->bug_fix_cntl & ASC_BUG_FIX_ASYN_USE_SYN) {
- if (!(asc_dvc->init_sdtr & tid_bits)) {
- if (
- (dvc_type == SCSI_TYPE_CDROM)
- && (AscCompareString((uchar *) inq->vendor_id, (uchar *) "HP ", 3) == 0)
- ) {
- asc_dvc->pci_fix_asyn_xfer_always |= tid_bits;
- }
- asc_dvc->pci_fix_asyn_xfer |= tid_bits;
-#if CC_DISABLE_ASYN_FIX_WANGTEK_TAPE
- if (
- (dvc_type == SCSI_TYPE_SASD)
- && (AscCompareString((uchar *) inq->vendor_id, (uchar *) "WANGTEK ", 8) == 0)
- ) {
- asc_dvc->pci_fix_asyn_xfer &= ~tid_bits;
- }
-#endif
- if (asc_dvc->pci_fix_asyn_xfer & tid_bits) {
- AscSetRunChipSynRegAtID(asc_dvc->iop_base, tid_no,
- ASYN_SDTR_DATA_FIX_PCI_REV_AB);
- }
- }
- }
- sta = 1;
- ASC_DBG(1, "AscInitPollTarget: before InitTestUnitReady\n");
- sta = InitTestUnitReady(asc_dvc, scsiq);
- if (sta == 1) {
- if ((cap_info != 0L) && support_read_cap) {
- ASC_DBG(1,
- "AscInitPollTarget: before PollScsiReadCapacity\n");
- if (PollScsiReadCapacity(asc_dvc, scsiq,
- cap_info) != 1) {
- cap_info->lba = 0L;
- cap_info->blk_size = 0x0000;
- } else {
- }
- }
- }
- } else {
- asc_dvc->start_motor &= ~tid_bits;
- }
- }
- ASC_DBG1(1, "AscInitPollTarget: dvc_found %d\n", dvc_found);
- return (dvc_found);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_REQ_Q * scsiq,
+ REG ASC_SCSI_INQUIRY * inq,
+ REG ASC_CAP_INFO * cap_info
+)
+{
+ uchar tid_no, lun;
+ uchar dvc_type;
+ ASC_SCSI_BIT_ID_TYPE tid_bits;
+ int dvc_found;
+ int support_read_cap;
+ int tmp_disable_init_sdtr;
+ int sta;
+
+ dvc_found = 0;
+ tmp_disable_init_sdtr = FALSE;
+ tid_bits = scsiq->r1.target_id;
+ lun = scsiq->r1.target_lun;
+ tid_no = ASC_TIX_TO_TID(scsiq->r2.target_ix);
+ if (((asc_dvc->init_sdtr & tid_bits) != 0) &&
+ ((asc_dvc->sdtr_done & tid_bits) == 0)) {
+ asc_dvc->init_sdtr &= ~tid_bits;
+ tmp_disable_init_sdtr = TRUE;
+ }
+ ASC_DBG(1, "AscInitPollTarget: before PollScsiInquiry\n");
+ if (PollScsiInquiry(asc_dvc, scsiq, (uchar *) inq,
+ sizeof (ASC_SCSI_INQUIRY)) == 1) {
+ dvc_found = 1;
+ support_read_cap = TRUE;
+ dvc_type = inq->byte0.peri_dvc_type;
+ if (dvc_type != SCSI_TYPE_UNKNOWN) {
+ if ((dvc_type != SCSI_TYPE_DASD)
+ && (dvc_type != SCSI_TYPE_WORM)
+ && (dvc_type != SCSI_TYPE_CDROM)
+ && (dvc_type != SCSI_TYPE_OPTMEM)) {
+ asc_dvc->start_motor &= ~tid_bits;
+ support_read_cap = FALSE;
+ }
+ if ((dvc_type != SCSI_TYPE_DASD) || inq->byte1.rmb) {
+ if (!_asc_wait_slow_device_) {
+ DvcSleepMilliSecond(3000 - ((int) tid_no * 250));
+ _asc_wait_slow_device_ = TRUE;
+ }
+ }
+ if (lun == 0) {
+ if ((inq->byte3.rsp_data_fmt >= 2) ||
+ (inq->byte2.ansi_apr_ver >= 2)) {
+ if (inq->byte7.CmdQue) {
+ asc_dvc->cfg->can_tagged_qng |= tid_bits;
+ if (asc_dvc->cfg->cmd_qng_enabled & tid_bits) {
+ asc_dvc->use_tagged_qng |= tid_bits;
+ asc_dvc->max_dvc_qng[tid_no] = asc_dvc->cfg->max_tag_qng[tid_no];
+ }
+ }
+ if (!inq->byte7.Sync) {
+ asc_dvc->init_sdtr &= ~tid_bits;
+ asc_dvc->sdtr_done &= ~tid_bits;
+ } else if (tmp_disable_init_sdtr) {
+ asc_dvc->init_sdtr |= tid_bits;
+ }
+ } else {
+ asc_dvc->init_sdtr &= ~tid_bits;
+ asc_dvc->sdtr_done &= ~tid_bits;
+ asc_dvc->use_tagged_qng &= ~tid_bits;
+ }
+ }
+ if (asc_dvc->bug_fix_cntl & ASC_BUG_FIX_ASYN_USE_SYN) {
+ if (!(asc_dvc->init_sdtr & tid_bits)) {
+ if ((dvc_type == SCSI_TYPE_CDROM) &&
+ (AscCompareString((uchar *) inq->vendor_id,
+ (uchar *) "HP ", 3) == 0)) {
+ asc_dvc->pci_fix_asyn_xfer_always |= tid_bits;
+ }
+ asc_dvc->pci_fix_asyn_xfer |= tid_bits;
+ if ((dvc_type == SCSI_TYPE_PROC) || (dvc_type == SCSI_TYPE_SCANNER)) {
+ asc_dvc->pci_fix_asyn_xfer &= ~tid_bits;
+ }
+ if ((dvc_type == SCSI_TYPE_SASD) &&
+ (AscCompareString((uchar *) inq->vendor_id,
+ (uchar *) "TANDBERG", 8) == 0) &&
+ (AscCompareString((uchar *) inq->product_id,
+ (uchar *) " TDC 36", 7) == 0)) {
+ asc_dvc->pci_fix_asyn_xfer &= ~tid_bits;
+ }
+ if ((dvc_type == SCSI_TYPE_SASD) &&
+ (AscCompareString((uchar *) inq->vendor_id,
+ (uchar *) "WANGTEK ", 8) == 0)) {
+ asc_dvc->pci_fix_asyn_xfer &= ~tid_bits;
+ }
+
+ if ((dvc_type == SCSI_TYPE_CDROM) &&
+ (AscCompareString((uchar *)inq->vendor_id,
+ (uchar *)"NEC ", 8) == 0) &&
+ (AscCompareString((uchar *)inq->product_id,
+ (uchar *)"CD-ROM DRIVE ", 16) == 0)) {
+ asc_dvc->pci_fix_asyn_xfer &= ~tid_bits ;
+ }
+
+ if (asc_dvc->pci_fix_asyn_xfer & tid_bits) {
+ AscSetRunChipSynRegAtID(asc_dvc->iop_base, tid_no,
+ ASYN_SDTR_DATA_FIX_PCI_REV_AB);
+ }
+ }
+ }
+ sta = 1;
+ ASC_DBG(1, "AscInitPollTarget: before InitTestUnitReady\n");
+ sta = InitTestUnitReady(asc_dvc, scsiq);
+ if (sta == 1) {
+ if ((cap_info != 0L) && support_read_cap) {
+ ASC_DBG(1,
+ "AscInitPollTarget: before PollScsiReadCapacity\n");
+ if (PollScsiReadCapacity(asc_dvc, scsiq,
+ cap_info) != 1) {
+ cap_info->lba = 0L;
+ cap_info->blk_size = 0x0000;
+ } else {
+ }
+ }
+ }
+ } else {
+ asc_dvc->start_motor &= ~tid_bits;
+ }
+ } else if (tmp_disable_init_sdtr) {
+ asc_dvc->init_sdtr |= tid_bits;
+ }
+ ASC_DBG1(1, "AscInitPollTarget: dvc_found %d\n", dvc_found);
+ return (dvc_found);
}
-int
+STATIC int
PollQueueDone(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_REQ_Q dosfar * scsiq,
- int timeout_sec
-)
-{
- int status;
- int retry = 0;
-
- ASC_DBG1(1, "PollQueueDone: timeout_sec %d\n", timeout_sec);
- do {
- ASC_DBG(1, "PollQueueDone: before AscExeScsiQueue\n");
- if ((status = AscExeScsiQueue(asc_dvc,
- (ASC_SCSI_Q dosfar *) scsiq)) == 1) {
- ASC_DBG(1, "PollQueueDone: before AscPollQDone\n");
- if ((status = AscPollQDone(asc_dvc, scsiq,
- timeout_sec)) != 1) {
- ASC_DBG1(1, "PollQueueDone: status %x\n", status);
- if (status == 0x80) {
- if (retry++ > ASC_MAX_INIT_BUSY_RETRY) {
- break;
- }
- scsiq->r3.done_stat = 0;
- scsiq->r3.host_stat = 0;
- scsiq->r3.scsi_stat = 0;
- scsiq->r3.scsi_msg = 0;
- DvcSleepMilliSecond(2000);
- continue;
- }
- scsiq->r3.done_stat = 0;
- scsiq->r3.host_stat = 0;
- scsiq->r3.scsi_stat = 0;
- scsiq->r3.scsi_msg = 0;
- ASC_DBG(1, "PollQueueDone: before AscAbortSRB()\n");
- AscAbortSRB(asc_dvc, (ulong) scsiq);
- }
- ASC_DBG1(1, "PollQueueDone: status %x\n", status);
- ASC_DBG1(1, "PollQueueDone: done_stat %x\n", scsiq->r3.done_stat);
- return (scsiq->r3.done_stat);
- }
- ASC_DBG1(1, "PollQueueDone: status %x\n", status);
- DvcSleepMilliSecond(5);
- } while (((status == 0) || (status == 0x80)) &&
- retry++ < ASC_MAX_INIT_BUSY_RETRY);
- ASC_DBG1(1, "PollQueueDone: status %x\n", status);
- ASC_DBG(1, "PollQueueDone: done_stat QD_WITH_ERROR\n");
- return (scsiq->r3.done_stat = QD_WITH_ERROR);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_REQ_Q * scsiq,
+ int timeout_sec
+)
+{
+ int status;
+ int retry = 0;
+
+ ASC_DBG1(1, "PollQueueDone: timeout_sec %d\n", timeout_sec);
+ do {
+ ASC_DBG(1, "PollQueueDone: before AscExeScsiQueue\n");
+ if ((status = AscExeScsiQueue(asc_dvc,
+ (ASC_SCSI_Q *) scsiq)) == 1) {
+ ASC_DBG(1, "PollQueueDone: before AscPollQDone\n");
+ if ((status = AscPollQDone(asc_dvc, scsiq,
+ timeout_sec)) != 1) {
+ ASC_DBG1(1, "PollQueueDone: status %x\n", status);
+ if (status == 0x80) {
+ if (retry++ > ASC_MAX_INIT_BUSY_RETRY) {
+ break;
+ }
+ scsiq->r3.done_stat = 0;
+ scsiq->r3.host_stat = 0;
+ scsiq->r3.scsi_stat = 0;
+ scsiq->r3.scsi_msg = 0;
+ DvcSleepMilliSecond(2000);
+ continue;
+ }
+ scsiq->r3.done_stat = 0;
+ scsiq->r3.host_stat = 0;
+ scsiq->r3.scsi_stat = 0;
+ scsiq->r3.scsi_msg = 0;
+ ASC_DBG(1, "PollQueueDone: before AscAbortSRB()\n");
+ AscAbortSRB(asc_dvc, (ulong) scsiq);
+ }
+ ASC_DBG1(1, "PollQueueDone: status %x\n", status);
+ ASC_DBG1(1, "PollQueueDone: done_stat %x\n", scsiq->r3.done_stat);
+ return (scsiq->r3.done_stat);
+ }
+ ASC_DBG1(1, "PollQueueDone: status %x\n", status);
+ DvcSleepMilliSecond(5);
+ } while (((status == 0) || (status == 0x80)) &&
+ retry++ < ASC_MAX_INIT_BUSY_RETRY);
+ ASC_DBG1(1, "PollQueueDone: status %x\n", status);
+ ASC_DBG(1, "PollQueueDone: done_stat QD_WITH_ERROR\n");
+ return (scsiq->r3.done_stat = QD_WITH_ERROR);
}
-int
+STATIC int
PollScsiInquiry(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_REQ_Q dosfar * scsiq,
- uchar dosfar * buf,
- int buf_len
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_REQ_Q * scsiq,
+ uchar * buf,
+ int buf_len
)
{
- if (AscScsiInquiry(asc_dvc, scsiq, buf, buf_len) == ERR) {
- return (scsiq->r3.done_stat = QD_WITH_ERROR);
- }
- return (PollQueueDone(asc_dvc, (ASC_SCSI_REQ_Q dosfar *) scsiq, 4));
+ if (AscScsiInquiry(asc_dvc, scsiq, buf, buf_len) == ERR) {
+ return (scsiq->r3.done_stat = QD_WITH_ERROR);
+ }
+ return (PollQueueDone(asc_dvc, (ASC_SCSI_REQ_Q *) scsiq, 4));
}
-int
+STATIC int
PollScsiStartUnit(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_REQ_Q dosfar * scsiq
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_REQ_Q * scsiq
)
{
- if (AscScsiStartStopUnit(asc_dvc, scsiq, 1) == ERR) {
- return (scsiq->r3.done_stat = QD_WITH_ERROR);
- }
- return (PollQueueDone(asc_dvc, (ASC_SCSI_REQ_Q dosfar *) scsiq, 40));
+ if (AscScsiStartStopUnit(asc_dvc, scsiq, 1) == ERR) {
+ return (scsiq->r3.done_stat = QD_WITH_ERROR);
+ }
+ return (PollQueueDone(asc_dvc, (ASC_SCSI_REQ_Q *) scsiq, 40));
}
-int
+STATIC int
PollScsiReadCapacity(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_REQ_Q dosfar * scsiq,
- REG ASC_CAP_INFO dosfar * cap_info
-)
-{
- ASC_CAP_INFO scsi_cap_info;
- int status;
- if (AscScsiReadCapacity(asc_dvc, scsiq,
- (uchar dosfar *) & scsi_cap_info) == ERR) {
- return (scsiq->r3.done_stat = QD_WITH_ERROR);
- }
- status = PollQueueDone(asc_dvc, (ASC_SCSI_REQ_Q dosfar *) scsiq, 8);
- if (status == 1) {
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_REQ_Q * scsiq,
+ REG ASC_CAP_INFO * cap_info
+)
+{
+ ASC_CAP_INFO scsi_cap_info;
+ int status;
+ if (AscScsiReadCapacity(asc_dvc, scsiq,
+ (uchar *) & scsi_cap_info) == ERR) {
+ return (scsiq->r3.done_stat = QD_WITH_ERROR);
+ }
+ status = PollQueueDone(asc_dvc, (ASC_SCSI_REQ_Q *) scsiq, 8);
+ if (status == 1) {
#if CC_LITTLE_ENDIAN_HOST
- cap_info->lba = (ulong) * swapfarbuf4((uchar dosfar *) & scsi_cap_info.lba);
- cap_info->blk_size = (ulong) * swapfarbuf4((uchar dosfar *) & scsi_cap_info.blk_size);
+ cap_info->lba = (ulong) * swapfarbuf4((uchar *) & scsi_cap_info.lba);
+ cap_info->blk_size = (ulong) * swapfarbuf4((uchar *) & scsi_cap_info.blk_size);
#else
- cap_info->lba = scsi_cap_info.lba;
- cap_info->blk_size = scsi_cap_info.blk_size;
+ cap_info->lba = scsi_cap_info.lba;
+ cap_info->blk_size = scsi_cap_info.blk_size;
#endif
- return (scsiq->r3.done_stat);
- }
- return (scsiq->r3.done_stat = QD_WITH_ERROR);
+ return (scsiq->r3.done_stat);
+ }
+ return (scsiq->r3.done_stat = QD_WITH_ERROR);
}
-ulong dosfar *
+STATIC ulong *
swapfarbuf4(
- uchar dosfar * buf
+ uchar *buf
)
{
- uchar tmp;
+ uchar tmp;
- tmp = buf[3];
- buf[3] = buf[0];
- buf[0] = tmp;
+ tmp = buf[3];
+ buf[3] = buf[0];
+ buf[0] = tmp;
- tmp = buf[1];
- buf[1] = buf[2];
- buf[2] = tmp;
+ tmp = buf[1];
+ buf[1] = buf[2];
+ buf[2] = tmp;
- return ((ulong dosfar *) buf);
+ return ((ulong *) buf);
}
-int
+STATIC int
PollScsiTestUnitReady(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_REQ_Q dosfar * scsiq
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_REQ_Q * scsiq
)
{
- if (AscScsiTestUnitReady(asc_dvc, scsiq) == ERR) {
- return (scsiq->r3.done_stat = QD_WITH_ERROR);
- }
- return (PollQueueDone(asc_dvc, (ASC_SCSI_REQ_Q dosfar *) scsiq, 12));
+ if (AscScsiTestUnitReady(asc_dvc, scsiq) == ERR) {
+ return (scsiq->r3.done_stat = QD_WITH_ERROR);
+ }
+ return (PollQueueDone(asc_dvc, (ASC_SCSI_REQ_Q *) scsiq, 12));
}
-int
+STATIC int
InitTestUnitReady(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_REQ_Q dosfar * scsiq
-)
-{
- ASC_SCSI_BIT_ID_TYPE tid_bits;
- int retry;
- ASC_REQ_SENSE dosfar *sen;
- retry = 0;
- tid_bits = scsiq->r1.target_id;
- while (retry++ < 4) {
- PollScsiTestUnitReady(asc_dvc, scsiq);
- if (scsiq->r3.done_stat == 0x01) {
- return (1);
- } else if (scsiq->r3.done_stat == QD_WITH_ERROR) {
- DvcSleepMilliSecond(200);
- sen = (ASC_REQ_SENSE dosfar *) scsiq->sense_ptr;
- if ((scsiq->r3.scsi_stat == SS_CHK_CONDITION) &&
- ((sen->err_code & 0x70) != 0)) {
- if (sen->sense_key == SCSI_SENKEY_NOT_READY) {
- if (asc_dvc->start_motor & tid_bits) {
- if (PollScsiStartUnit(asc_dvc, scsiq) == 1) {
- retry = 0;
- continue;
- } else {
- asc_dvc->start_motor &= ~tid_bits;
- break;
- }
- } else {
- DvcSleepMilliSecond(5000);
- }
- } else if (sen->sense_key == SCSI_SENKEY_ATTENTION) {
- DvcSleepMilliSecond( ( ulong )( 500L*retry ) ) ;
- } else {
- DvcSleepMilliSecond( 500 ) ;
- break;
- }
- } else {
- break;
- }
- } else if (scsiq->r3.done_stat == QD_ABORTED_BY_HOST) {
- break;
- } else {
- break;
- }
- }
- return (0);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_REQ_Q * scsiq
+)
+{
+ ASC_SCSI_BIT_ID_TYPE tid_bits;
+ int retry;
+ ASC_REQ_SENSE *sen;
+ retry = 0;
+ tid_bits = scsiq->r1.target_id;
+ while (retry++ < 4) {
+ PollScsiTestUnitReady(asc_dvc, scsiq);
+ if (scsiq->r3.done_stat == 0x01) {
+ return (1);
+ } else if (scsiq->r3.done_stat == QD_WITH_ERROR) {
+ DvcSleepMilliSecond(200);
+ sen = (ASC_REQ_SENSE *) scsiq->sense_ptr;
+ if ((scsiq->r3.scsi_stat == SS_CHK_CONDITION) &&
+ ((sen->err_code & 0x70) != 0)) {
+ if (sen->sense_key == SCSI_SENKEY_NOT_READY) {
+ if (asc_dvc->start_motor & tid_bits) {
+ if (PollScsiStartUnit(asc_dvc, scsiq) == 1) {
+ retry = 0;
+ continue;
+ } else {
+ asc_dvc->start_motor &= ~tid_bits;
+ break;
+ }
+ } else {
+ DvcSleepMilliSecond(5000);
+ }
+ } else if (sen->sense_key == SCSI_SENKEY_ATTENTION) {
+ DvcSleepMilliSecond((ulong)(500L*retry)) ;
+ } else {
+ DvcSleepMilliSecond(500) ;
+ break;
+ }
+ } else {
+ break;
+ }
+ } else if (scsiq->r3.done_stat == QD_ABORTED_BY_HOST) {
+ break;
+ } else {
+ break;
+ }
+ }
+ return (0);
}
-int
+STATIC int
AscPollQDone(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_REQ_Q dosfar * scsiq,
- int timeout_sec
-)
-{
- int loop, loop_end;
- int sta;
- PortAddr iop_base;
- iop_base = asc_dvc->iop_base;
- loop = 0;
- loop_end = timeout_sec * 100;
- sta = 1;
- while (TRUE) {
- if (asc_dvc->err_code != 0) {
- scsiq->r3.done_stat = QD_WITH_ERROR;
- ASC_DBG1(1, "AscPollQDone: err_code %x\n", asc_dvc->err_code);
- sta = ERR;
- break;
- }
- if (scsiq->r3.done_stat != QD_IN_PROGRESS) {
- if ((scsiq->r3.done_stat == QD_WITH_ERROR) &&
- (scsiq->r3.scsi_stat == SS_TARGET_BUSY)) {
- sta = 0x80;
- }
- break;
- }
- DvcSleepMilliSecond(10);
- if (loop++ > loop_end) {
- ASC_DBG(1, "AscPollQDone: loop finished\n");
- sta = 0;
- break;
- }
- if (AscIsChipHalted(iop_base)) {
- ASC_DBG(1, "AscPollQDone: AscIsChipHalted()\n");
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_REQ_Q * scsiq,
+ int timeout_sec
+)
+{
+ int loop, loop_end;
+ int sta;
+ PortAddr iop_base;
+ iop_base = asc_dvc->iop_base;
+ loop = 0;
+ loop_end = timeout_sec * 100;
+ sta = 1;
+ while (TRUE) {
+ if (asc_dvc->err_code != 0) {
+ scsiq->r3.done_stat = QD_WITH_ERROR;
+ ASC_DBG1(1, "AscPollQDone: err_code %x\n", asc_dvc->err_code);
+ sta = ERR;
+ break;
+ }
+ if (scsiq->r3.done_stat != QD_IN_PROGRESS) {
+ if ((scsiq->r3.done_stat == QD_WITH_ERROR) &&
+ (scsiq->r3.scsi_stat == SS_TARGET_BUSY)) {
+ sta = 0x80;
+ }
+ break;
+ }
+ DvcSleepMilliSecond(10);
+ if (loop++ > loop_end) {
+ ASC_DBG(1, "AscPollQDone: loop finished\n");
+ sta = 0;
+ break;
+ }
+ if (AscIsChipHalted(iop_base)) {
+ ASC_DBG(1, "AscPollQDone: AscIsChipHalted()\n");
#if !CC_ASCISR_CHECK_INT_PENDING
- AscAckInterrupt(iop_base);
+ AscAckInterrupt(iop_base);
#endif
- AscISR(asc_dvc);
- loop = 0;
- } else {
- if (AscIsIntPending(iop_base)) {
- ASC_DBG(1, "AscPollQDone: AscIsIntPending()\n");
+ AscISR(asc_dvc);
+ loop = 0;
+ } else {
+ if (AscIsIntPending(iop_base)) {
+ ASC_DBG(1, "AscPollQDone: AscIsIntPending()\n");
#if !CC_ASCISR_CHECK_INT_PENDING
- AscAckInterrupt(iop_base);
+ AscAckInterrupt(iop_base);
#endif
- AscISR(asc_dvc);
- }
- }
- }
- return (sta);
+ AscISR(asc_dvc);
+ }
+ }
+ }
+ return (sta);
}
-int
+STATIC int
AscCompareString(
- ruchar * str1,
- ruchar * str2,
- int len
+ ruchar * str1,
+ ruchar * str2,
+ int len
)
{
- int i;
- int diff;
- for (i = 0; i < len; i++) {
- diff = (int) (str1[i] - str2[i]);
- if (diff != 0)
- return (diff);
- }
- return (0);
+ int i;
+ int diff;
+ for (i = 0; i < len; i++) {
+ diff = (int) (str1[i] - str2[i]);
+ if (diff != 0)
+ return (diff);
+ }
+ return (0);
}
-uchar
+STATIC uchar
AscReadLramByte(
- PortAddr iop_base,
- ushort addr
+ PortAddr iop_base,
+ ushort addr
)
{
- uchar byte_data;
- ushort word_data;
- if (isodd_word(addr)) {
- AscSetChipLramAddr(iop_base, addr - 1);
- word_data = AscGetChipLramData(iop_base);
- byte_data = (uchar) ((word_data >> 8) & 0xFF);
- } else {
- AscSetChipLramAddr(iop_base, addr);
- word_data = AscGetChipLramData(iop_base);
- byte_data = (uchar) (word_data & 0xFF);
- }
- return (byte_data);
+ uchar byte_data;
+ ushort word_data;
+ if (isodd_word(addr)) {
+ AscSetChipLramAddr(iop_base, addr - 1);
+ word_data = AscGetChipLramData(iop_base);
+ byte_data = (uchar) ((word_data >> 8) & 0xFF);
+ } else {
+ AscSetChipLramAddr(iop_base, addr);
+ word_data = AscGetChipLramData(iop_base);
+ byte_data = (uchar) (word_data & 0xFF);
+ }
+ return (byte_data);
}
-ushort
+STATIC ushort
AscReadLramWord(
- PortAddr iop_base,
- ushort addr
+ PortAddr iop_base,
+ ushort addr
)
{
- ushort word_data;
- AscSetChipLramAddr(iop_base, addr);
- word_data = AscGetChipLramData(iop_base);
- return (word_data);
+ ushort word_data;
+ AscSetChipLramAddr(iop_base, addr);
+ word_data = AscGetChipLramData(iop_base);
+ return (word_data);
}
-ulong
+STATIC ulong
AscReadLramDWord(
- PortAddr iop_base,
- ushort addr
+ PortAddr iop_base,
+ ushort addr
)
{
- ushort val_low, val_high;
- ulong dword_data;
- AscSetChipLramAddr(iop_base, addr);
- val_low = AscGetChipLramData(iop_base);
- val_high = AscGetChipLramData(iop_base);
- dword_data = ((ulong) val_high << 16) | (ulong) val_low;
- return (dword_data);
+ ushort val_low, val_high;
+ ulong dword_data;
+ AscSetChipLramAddr(iop_base, addr);
+ val_low = AscGetChipLramData(iop_base);
+ val_high = AscGetChipLramData(iop_base);
+ dword_data = ((ulong) val_high << 16) | (ulong) val_low;
+ return (dword_data);
}
-void
+STATIC void
AscWriteLramWord(
- PortAddr iop_base,
- ushort addr,
- ushort word_val
+ PortAddr iop_base,
+ ushort addr,
+ ushort word_val
)
{
- AscSetChipLramAddr(iop_base, addr);
- AscSetChipLramData(iop_base, word_val);
- return;
+ AscSetChipLramAddr(iop_base, addr);
+ AscSetChipLramData(iop_base, word_val);
+ return;
}
-void
+STATIC void
AscWriteLramDWord(
- PortAddr iop_base,
- ushort addr,
- ulong dword_val
+ PortAddr iop_base,
+ ushort addr,
+ ulong dword_val
)
{
- ushort word_val;
- AscSetChipLramAddr(iop_base, addr);
- word_val = (ushort) dword_val;
- AscSetChipLramData(iop_base, word_val);
- word_val = (ushort) (dword_val >> 16);
- AscSetChipLramData(iop_base, word_val);
- return;
+ ushort word_val;
+ AscSetChipLramAddr(iop_base, addr);
+ word_val = (ushort) dword_val;
+ AscSetChipLramData(iop_base, word_val);
+ word_val = (ushort) (dword_val >> 16);
+ AscSetChipLramData(iop_base, word_val);
+ return;
}
-void
+STATIC void
AscWriteLramByte(
- PortAddr iop_base,
- ushort addr,
- uchar byte_val
+ PortAddr iop_base,
+ ushort addr,
+ uchar byte_val
)
{
- ushort word_data;
- if (isodd_word(addr)) {
- addr--;
- word_data = AscReadLramWord(iop_base, addr);
- word_data &= 0x00FF;
- word_data |= (((ushort) byte_val << 8) & 0xFF00);
- } else {
- word_data = AscReadLramWord(iop_base, addr);
- word_data &= 0xFF00;
- word_data |= ((ushort) byte_val & 0x00FF);
- }
- AscWriteLramWord(iop_base, addr, word_data);
- return;
+ ushort word_data;
+ if (isodd_word(addr)) {
+ addr--;
+ word_data = AscReadLramWord(iop_base, addr);
+ word_data &= 0x00FF;
+ word_data |= (((ushort) byte_val << 8) & 0xFF00);
+ } else {
+ word_data = AscReadLramWord(iop_base, addr);
+ word_data &= 0xFF00;
+ word_data |= ((ushort) byte_val & 0x00FF);
+ }
+ AscWriteLramWord(iop_base, addr, word_data);
+ return;
}
-
-
-
-void
+STATIC void
AscMemWordCopyToLram(
- PortAddr iop_base,
- ushort s_addr,
- ushort dosfar * s_buffer,
- int words
+ PortAddr iop_base,
+ ushort s_addr,
+ ushort * s_buffer,
+ int words
)
{
- AscSetChipLramAddr(iop_base, s_addr);
- DvcOutPortWords(iop_base + IOP_RAM_DATA, s_buffer, words);
- return;
+ AscSetChipLramAddr(iop_base, s_addr);
+ DvcOutPortWords(iop_base + IOP_RAM_DATA, s_buffer, words);
+ return;
}
-void
+STATIC void
AscMemDWordCopyToLram(
- PortAddr iop_base,
- ushort s_addr,
- ulong dosfar * s_buffer,
- int dwords
+ PortAddr iop_base,
+ ushort s_addr,
+ ulong * s_buffer,
+ int dwords
)
{
- AscSetChipLramAddr(iop_base, s_addr);
- DvcOutPortDWords(iop_base + IOP_RAM_DATA, s_buffer, dwords);
- return;
+ AscSetChipLramAddr(iop_base, s_addr);
+ DvcOutPortDWords(iop_base + IOP_RAM_DATA, s_buffer, dwords);
+ return;
}
-void
+STATIC void
AscMemWordCopyFromLram(
- PortAddr iop_base,
- ushort s_addr,
- ushort dosfar * d_buffer,
- int words
+ PortAddr iop_base,
+ ushort s_addr,
+ ushort * d_buffer,
+ int words
)
{
- AscSetChipLramAddr(iop_base, s_addr);
- DvcInPortWords(iop_base + IOP_RAM_DATA, d_buffer, words);
- return;
+ AscSetChipLramAddr(iop_base, s_addr);
+ DvcInPortWords(iop_base + IOP_RAM_DATA, d_buffer, words);
+ return;
}
-ulong
+STATIC ulong
AscMemSumLramWord(
- PortAddr iop_base,
- ushort s_addr,
- rint words
+ PortAddr iop_base,
+ ushort s_addr,
+ rint words
)
{
- ulong sum;
- int i;
- sum = 0L;
- for (i = 0; i < words; i++, s_addr += 2) {
- sum += AscReadLramWord(iop_base, s_addr);
- }
- return (sum);
+ ulong sum;
+ int i;
+ sum = 0L;
+ for (i = 0; i < words; i++, s_addr += 2) {
+ sum += AscReadLramWord(iop_base, s_addr);
+ }
+ return (sum);
}
-void
+STATIC void
AscMemWordSetLram(
- PortAddr iop_base,
- ushort s_addr,
- ushort set_wval,
- rint words
+ PortAddr iop_base,
+ ushort s_addr,
+ ushort set_wval,
+ rint words
)
{
- rint i;
- AscSetChipLramAddr(iop_base, s_addr);
- for (i = 0; i < words; i++) {
- AscSetChipLramData(iop_base, set_wval);
- }
- return;
+ rint i;
+ AscSetChipLramAddr(iop_base, s_addr);
+ for (i = 0; i < words; i++) {
+ AscSetChipLramData(iop_base, set_wval);
+ }
+ return;
}
-int
+STATIC int
AscScsiInquiry(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_REQ_Q dosfar * scsiq,
- uchar dosfar * buf,
- int buf_len
-)
-{
- if (AscScsiSetupCmdQ(asc_dvc, scsiq, buf,
- (ulong) buf_len) == ERR) {
- return (scsiq->r3.done_stat = QD_WITH_ERROR);
- }
- scsiq->cdb[0] = (uchar) SCSICMD_Inquiry;
- scsiq->cdb[1] = scsiq->r1.target_lun << 5;
- scsiq->cdb[2] = 0;
- scsiq->cdb[3] = 0;
- scsiq->cdb[4] = buf_len;
- scsiq->cdb[5] = 0;
- scsiq->r2.cdb_len = 6;
- return (0);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_REQ_Q * scsiq,
+ uchar * buf,
+ int buf_len
+)
+{
+ if (AscScsiSetupCmdQ(asc_dvc, scsiq, buf,
+ (ulong) buf_len) == ERR) {
+ return (scsiq->r3.done_stat = QD_WITH_ERROR);
+ }
+ scsiq->cdb[0] = (uchar) SCSICMD_Inquiry;
+ scsiq->cdb[1] = scsiq->r1.target_lun << 5;
+ scsiq->cdb[2] = 0;
+ scsiq->cdb[3] = 0;
+ scsiq->cdb[4] = buf_len;
+ scsiq->cdb[5] = 0;
+ scsiq->r2.cdb_len = 6;
+ return (0);
}
-int
+STATIC int
AscScsiReadCapacity(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_REQ_Q dosfar * scsiq,
- uchar dosfar * info
-)
-{
- if (AscScsiSetupCmdQ(asc_dvc, scsiq, info, 8L) == ERR) {
- return (scsiq->r3.done_stat = QD_WITH_ERROR);
- }
- scsiq->cdb[0] = (uchar) SCSICMD_ReadCapacity;
- scsiq->cdb[1] = scsiq->r1.target_lun << 5;
- scsiq->cdb[2] = 0;
- scsiq->cdb[3] = 0;
- scsiq->cdb[4] = 0;
- scsiq->cdb[5] = 0;
- scsiq->cdb[6] = 0;
- scsiq->cdb[7] = 0;
- scsiq->cdb[8] = 0;
- scsiq->cdb[9] = 0;
- scsiq->r2.cdb_len = 10;
- return (0);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_REQ_Q * scsiq,
+ uchar * info
+)
+{
+ if (AscScsiSetupCmdQ(asc_dvc, scsiq, info, 8L) == ERR) {
+ return (scsiq->r3.done_stat = QD_WITH_ERROR);
+ }
+ scsiq->cdb[0] = (uchar) SCSICMD_ReadCapacity;
+ scsiq->cdb[1] = scsiq->r1.target_lun << 5;
+ scsiq->cdb[2] = 0;
+ scsiq->cdb[3] = 0;
+ scsiq->cdb[4] = 0;
+ scsiq->cdb[5] = 0;
+ scsiq->cdb[6] = 0;
+ scsiq->cdb[7] = 0;
+ scsiq->cdb[8] = 0;
+ scsiq->cdb[9] = 0;
+ scsiq->r2.cdb_len = 10;
+ return (0);
}
-int
+STATIC int
AscScsiTestUnitReady(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_REQ_Q dosfar * scsiq
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_REQ_Q * scsiq
)
{
- if (AscScsiSetupCmdQ(asc_dvc, scsiq, FNULLPTR,
- (ulong) 0L) == ERR) {
- return (scsiq->r3.done_stat = QD_WITH_ERROR);
- }
- scsiq->r1.cntl = (uchar) ASC_SCSIDIR_NODATA;
- scsiq->cdb[0] = (uchar) SCSICMD_TestUnitReady;
- scsiq->cdb[1] = scsiq->r1.target_lun << 5;
- scsiq->cdb[2] = 0;
- scsiq->cdb[3] = 0;
- scsiq->cdb[4] = 0;
- scsiq->cdb[5] = 0;
- scsiq->r2.cdb_len = 6;
- return (0);
+ if (AscScsiSetupCmdQ(asc_dvc, scsiq, FNULLPTR,
+ (ulong) 0L) == ERR) {
+ return (scsiq->r3.done_stat = QD_WITH_ERROR);
+ }
+ scsiq->r1.cntl = (uchar) ASC_SCSIDIR_NODATA;
+ scsiq->cdb[0] = (uchar) SCSICMD_TestUnitReady;
+ scsiq->cdb[1] = scsiq->r1.target_lun << 5;
+ scsiq->cdb[2] = 0;
+ scsiq->cdb[3] = 0;
+ scsiq->cdb[4] = 0;
+ scsiq->cdb[5] = 0;
+ scsiq->r2.cdb_len = 6;
+ return (0);
}
-int
+STATIC int
AscScsiStartStopUnit(
- REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
- REG ASC_SCSI_REQ_Q dosfar * scsiq,
- uchar op_mode
-)
-{
- if (AscScsiSetupCmdQ(asc_dvc, scsiq, FNULLPTR, (ulong) 0L) == ERR) {
- return (scsiq->r3.done_stat = QD_WITH_ERROR);
- }
- scsiq->r1.cntl = (uchar) ASC_SCSIDIR_NODATA;
- scsiq->cdb[0] = (uchar) SCSICMD_StartStopUnit;
- scsiq->cdb[1] = scsiq->r1.target_lun << 5;
- scsiq->cdb[2] = 0;
- scsiq->cdb[3] = 0;
- scsiq->cdb[4] = op_mode;
- scsiq->cdb[5] = 0;
- scsiq->r2.cdb_len = 6;
- return (0);
+ REG ASC_DVC_VAR asc_ptr_type * asc_dvc,
+ REG ASC_SCSI_REQ_Q * scsiq,
+ uchar op_mode
+)
+{
+ if (AscScsiSetupCmdQ(asc_dvc, scsiq, FNULLPTR, (ulong) 0L) == ERR) {
+ return (scsiq->r3.done_stat = QD_WITH_ERROR);
+ }
+ scsiq->r1.cntl = (uchar) ASC_SCSIDIR_NODATA;
+ scsiq->cdb[0] = (uchar) SCSICMD_StartStopUnit;
+ scsiq->cdb[1] = scsiq->r1.target_lun << 5;
+ scsiq->cdb[2] = 0;
+ scsiq->cdb[3] = 0;
+ scsiq->cdb[4] = op_mode;
+ scsiq->cdb[5] = 0;
+ scsiq->r2.cdb_len = 6;
+ return (0);
}
diff --git a/drivers/scsi/advansys.h b/drivers/scsi/advansys.h
index 22f028f5c..6cf629921 100644
--- a/drivers/scsi/advansys.h
+++ b/drivers/scsi/advansys.h
@@ -1,18 +1,23 @@
-/* $Id: advansys.h,v 1.5 1997/01/19 23:07:10 davem Exp $ */
+/* $Id: advansys.h,v 1997/05/28 00:23:06 bobf Exp bobf $ */
+
/*
* advansys.h - Linux Host Driver for AdvanSys SCSI Adapters
- *
- * Copyright (c) 1995-1996 Advanced System Products, Inc.
+ *
+ * Copyright (c) 1995-1997 Advanced System Products, Inc.
+ * All Rights Reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that redistributions of source
* code retain the above copyright notice and this comment without
* modification.
*
- * The latest version of this driver is available at the AdvanSys
- * FTP and BBS sites listed below.
+ * There is an AdvanSys Linux WWW page at:
+ * http://www.advansys.com/linux.html
+ *
+ * The latest version of the AdvanSys driver is available at:
+ * ftp://ftp.advansys.com/pub/linux
*
- * Please send questions, comments, and bug reports to:
+ * Please send questions, comments, bug reports to:
* bobf@advansys.com (Bob Frey)
*/
@@ -20,7 +25,7 @@
#define _ADVANSYS_H
/* Convert Linux Version, Patch-level, Sub-level to LINUX_VERSION_CODE. */
-#define ASC_LINUX_VERSION(V, P, S) (((V) * 65536) + ((P) * 256) + (S))
+#define ASC_LINUX_VERSION(V, P, S) (((V) * 65536) + ((P) * 256) + (S))
#ifndef LINUX_VERSION_CODE
#include <linux/version.h>
@@ -56,84 +61,86 @@ void advansys_setup(char *, int *);
*/
#if LINUX_VERSION_CODE < ASC_LINUX_VERSION(1,3,0)
#define ADVANSYS { \
- NULL, /* struct SHT *next */ \
- NULL, /* struct module *module */ \
- "advansys", /* char *name */ \
- advansys_detect, /* int (*detect)(struct SHT *) */ \
- advansys_release, /* int (*release)(struct Scsi_Host *) */ \
- advansys_info, /* const char *(*info)(struct Scsi_Host *) */ \
- advansys_command, /* int (*command)(Scsi_Cmnd *) */ \
- advansys_queuecommand, \
- /* int (*queuecommand)(Scsi_Cmnd *, void (*done)(Scsi_Cmnd *)) */ \
- advansys_abort, /* int (*abort)(Scsi_Cmnd *) */ \
- advansys_reset, /* int (*reset)(Scsi_Cmnd *) */ \
- NULL, /* int (*slave_attach)(int, int) */ \
- advansys_biosparam, /* int (* bios_param)(Disk *, int, int []) */ \
- /* \
- * The following fields are set per adapter in advansys_detect(). \
- */ \
- 0, /* int can_queue */ \
- 0, /* int this_id */ \
- 0, /* short unsigned int sg_tablesize */ \
- 0, /* short cmd_per_lun */ \
- 0, /* unsigned char present */ \
- /* \
- * Because the driver may control an ISA adapter 'unchecked_isa_dma' \
- * must be set. The flag will be cleared in advansys_detect for non-ISA \
- * adapters. Refer to the comment in scsi_module.c for more information. \
- */ \
- 1, /* unsigned unchecked_isa_dma:1 */ \
- /* \
- * All adapters controlled by this driver are capable of large \
- * scatter-gather lists. According to the mid-level SCSI documentation \
- * this obviates any performance gain provided by setting \
- * 'use_clustering'. But empirically while CPU utilization is increased \
- * by enabling clustering, I/O throughput increases as well. \
- */ \
- ENABLE_CLUSTERING, /* unsigned use_clustering:1 */ \
+ NULL, /* struct SHT *next */ \
+ NULL, /* int *usage_count */ \
+ "advansys", /* char *name */ \
+ advansys_detect, /* int (*detect)(struct SHT *) */ \
+ advansys_release, /* int (*release)(struct Scsi_Host *) */ \
+ advansys_info, /* const char *(*info)(struct Scsi_Host *) */ \
+ advansys_command, /* int (*command)(Scsi_Cmnd *) */ \
+ advansys_queuecommand, \
+ /* int (*queuecommand)(Scsi_Cmnd *, void (*done)(Scsi_Cmnd *)) */ \
+ advansys_abort, /* int (*abort)(Scsi_Cmnd *) */ \
+ advansys_reset, /* int (*reset)(Scsi_Cmnd *) */ \
+ NULL, /* int (*slave_attach)(int, int) */ \
+ advansys_biosparam, /* int (* bios_param)(Disk *, int, int []) */ \
+ /* \
+ * The following fields are set per adapter in advansys_detect(). \
+ */ \
+ 0, /* int can_queue */ \
+ 0, /* int this_id */ \
+ 0, /* short unsigned int sg_tablesize */ \
+ 0, /* short cmd_per_lun */ \
+ 0, /* unsigned char present */ \
+ /* \
+ * Because the driver may control an ISA adapter 'unchecked_isa_dma' \
+ * must be set. The flag will be cleared in advansys_detect for non-ISA \
+ * adapters. Refer to the comment in scsi_module.c for more information. \
+ */ \
+ 1, /* unsigned unchecked_isa_dma:1 */ \
+ /* \
+ * All adapters controlled by this driver are capable of large \
+ * scatter-gather lists. According to the mid-level SCSI documentation \
+ * this obviates any performance gain provided by setting \
+ * 'use_clustering'. But empirically while CPU utilization is increased \
+ * by enabling clustering, I/O throughput increases as well. \
+ */ \
+ ENABLE_CLUSTERING, /* unsigned use_clustering:1 */ \
}
#else /* version >= v1.3.0 */
#define ADVANSYS { \
- NULL, /* struct SHT *next */ \
- NULL, /* struct module *module */ \
- &proc_scsi_advansys, /* struct proc_dir_entry *proc_dir */ \
- advansys_proc_info, \
- /* int (*proc_info)(char *, char **, off_t, int, int, int) */ \
- "advansys", /* const char *name */ \
- advansys_detect, /* int (*detect)(struct SHT *) */ \
- advansys_release, /* int (*release)(struct Scsi_Host *) */ \
- advansys_info, /* const char *(*info)(struct Scsi_Host *) */ \
- advansys_command, /* int (*command)(Scsi_Cmnd *) */ \
- advansys_queuecommand, \
- /* int (*queuecommand)(Scsi_Cmnd *, void (*done)(Scsi_Cmnd *)) */ \
- advansys_abort, /* int (*abort)(Scsi_Cmnd *) */ \
- advansys_reset, \
- /* version < v1.3.89 int (*reset)(Scsi_Cmnd *) */ \
- /* version >= v1.3.89 int (*reset)(Scsi_Cmnd *, unsigned int) */ \
- NULL, /* int (*slave_attach)(int, int) */ \
- advansys_biosparam, /* int (* bios_param)(Disk *, kdev_t, int []) */ \
- /* \
- * The following fields are set per adapter in advansys_detect(). \
- */ \
- 0, /* int can_queue */ \
- 0, /* int this_id */ \
- 0, /* short unsigned int sg_tablesize */ \
- 0, /* short cmd_per_lun */ \
- 0, /* unsigned char present */ \
- /* \
- * Because the driver may control an ISA adapter 'unchecked_isa_dma' \
- * must be set. The flag will be cleared in advansys_detect for non-ISA \
- * adapters. Refer to the comment in scsi_module.c for more information. \
- */ \
- 1, /* unsigned unchecked_isa_dma:1 */ \
- /* \
- * All adapters controlled by this driver are capable of large \
- * scatter-gather lists. According to the mid-level SCSI documentation \
- * this obviates any performance gain provided by setting \
- * 'use_clustering'. But empirically while CPU utilization is increased \
- * by enabling clustering, I/O throughput increases as well. \
- */ \
- ENABLE_CLUSTERING, /* unsigned use_clustering:1 */ \
+ NULL, /* struct SHT *next */ \
+ NULL, \
+ /* version < v2.1.23 long *usage_count */ \
+ /* version >= v2.1.23 struct module * */ \
+ &proc_scsi_advansys, /* struct proc_dir_entry *proc_dir */ \
+ advansys_proc_info, \
+ /* int (*proc_info)(char *, char **, off_t, int, int, int) */ \
+ "advansys", /* const char *name */ \
+ advansys_detect, /* int (*detect)(struct SHT *) */ \
+ advansys_release, /* int (*release)(struct Scsi_Host *) */ \
+ advansys_info, /* const char *(*info)(struct Scsi_Host *) */ \
+ advansys_command, /* int (*command)(Scsi_Cmnd *) */ \
+ advansys_queuecommand, \
+ /* int (*queuecommand)(Scsi_Cmnd *, void (*done)(Scsi_Cmnd *)) */ \
+ advansys_abort, /* int (*abort)(Scsi_Cmnd *) */ \
+ advansys_reset, \
+ /* version < v1.3.89 int (*reset)(Scsi_Cmnd *) */ \
+ /* version >= v1.3.89 int (*reset)(Scsi_Cmnd *, unsigned int) */ \
+ NULL, /* int (*slave_attach)(int, int) */ \
+ advansys_biosparam, /* int (* bios_param)(Disk *, kdev_t, int []) */ \
+ /* \
+ * The following fields are set per adapter in advansys_detect(). \
+ */ \
+ 0, /* int can_queue */ \
+ 0, /* int this_id */ \
+ 0, /* short unsigned int sg_tablesize */ \
+ 0, /* short cmd_per_lun */ \
+ 0, /* unsigned char present */ \
+ /* \
+ * Because the driver may control an ISA adapter 'unchecked_isa_dma' \
+ * must be set. The flag will be cleared in advansys_detect for non-ISA \
+ * adapters. Refer to the comment in scsi_module.c for more information. \
+ */ \
+ 1, /* unsigned unchecked_isa_dma:1 */ \
+ /* \
+ * All adapters controlled by this driver are capable of large \
+ * scatter-gather lists. According to the mid-level SCSI documentation \
+ * this obviates any performance gain provided by setting \
+ * 'use_clustering'. But empirically while CPU utilization is increased \
+ * by enabling clustering, I/O throughput increases as well. \
+ */ \
+ ENABLE_CLUSTERING, /* unsigned use_clustering:1 */ \
}
#endif /* version >= v1.3.0 */
#endif /* _ADVANSYS_H */
diff --git a/drivers/scsi/g_NCR5380.c b/drivers/scsi/g_NCR5380.c
index 96e4a0eca..5bffb2762 100644
--- a/drivers/scsi/g_NCR5380.c
+++ b/drivers/scsi/g_NCR5380.c
@@ -617,10 +617,8 @@ int generic_NCR5380_proc_info(char* buffer, char** start, off_t offset, int leng
unsigned char status;
int i;
struct Scsi_Host *scsi_ptr;
- Scsi_Device *dev;
Scsi_Cmnd *ptr;
struct NCR5380_hostdata *hostdata;
- extern const char *const scsi_device_types[MAX_SCSI_DEVICE_CODE];
cli();
diff --git a/drivers/scsi/qlogicpti.c b/drivers/scsi/qlogicpti.c
index e9d80501f..5e14ea594 100644
--- a/drivers/scsi/qlogicpti.c
+++ b/drivers/scsi/qlogicpti.c
@@ -976,6 +976,7 @@ static int qlogicpti_return_status(struct Status_Entry *sts)
host_status = DID_ERROR;
break;
case CS_RESET_OCCURRED:
+ case CS_BUS_RESET:
host_status = DID_RESET;
break;
case CS_ABORTED:
@@ -1105,7 +1106,7 @@ int qlogicpti_abort(Scsi_Cmnd *Cmnd)
struct qlogicpti *qpti = (struct qlogicpti *) host->hostdata;
int return_status = SCSI_ABORT_SUCCESS;
- printk(KERN_EMERG "qlogicpti : Aborting cmd for tgt[%d] lun[%d]\n",
+ printk(KERN_WARNING "qlogicpti : Aborting cmd for tgt[%d] lun[%d]\n",
(int)Cmnd->target, (int)Cmnd->lun);
qlogicpti_disable_irqs(qpti->qregs);
param[0] = MBOX_ABORT;
@@ -1128,7 +1129,7 @@ int qlogicpti_reset(Scsi_Cmnd *Cmnd, unsigned int reset_flags)
struct qlogicpti *qpti = (struct qlogicpti *) host->hostdata;
int return_status = SCSI_RESET_SUCCESS;
- printk(KERN_EMERG "qlogicpti : Resetting SCSI bus!\n");
+ printk(KERN_WARNING "qlogicpti : Resetting SCSI bus!\n");
qlogicpti_disable_irqs(qpti->qregs);
param[0] = MBOX_BUS_RESET;
param[1] = qpti->host_param.bus_reset_delay;
diff --git a/drivers/scsi/qlogicpti.h b/drivers/scsi/qlogicpti.h
index e08a9f734..dc60c4be4 100644
--- a/drivers/scsi/qlogicpti.h
+++ b/drivers/scsi/qlogicpti.h
@@ -328,6 +328,7 @@ struct Status_Entry {
#define CS_ID_MSG_FAILED 0x0013
#define CS_UNEXP_BUS_FREE 0x0014
#define CS_DATA_UNDERRUN 0x0015
+#define CS_BUS_RESET 0x001c
/* status entry state flag definitions */
#define SF_GOT_BUS 0x0100
diff --git a/drivers/scsi/scsi.h b/drivers/scsi/scsi.h
index c447f8658..023a1c448 100644
--- a/drivers/scsi/scsi.h
+++ b/drivers/scsi/scsi.h
@@ -24,6 +24,7 @@
#include <linux/random.h>
#include <asm/hardirq.h>
+#include <asm/io.h>
/*
* Some defs, in case these are not defined elsewhere.
@@ -221,7 +222,7 @@ extern int scsi_dev_init (void);
#ifdef __mc68000__
#include <asm/pgtable.h>
#define CONTIGUOUS_BUFFERS(X,Y) \
- (VTOP((X)->b_data+(X)->b_size-1)+1 == VTOP((Y)->b_data))
+ (virt_to_phys((X)->b_data+(X)->b_size-1)+1==virt_to_phys((Y)->b_data))
#else
#define CONTIGUOUS_BUFFERS(X,Y) ((X->b_data+X->b_size) == Y->b_data)
#endif
diff --git a/drivers/sound/configure.c b/drivers/sound/configure.c
index ee6830b2a..6b50a3aa5 100644
--- a/drivers/sound/configure.c
+++ b/drivers/sound/configure.c
@@ -145,7 +145,7 @@ hw_entry hw_table[] =
char *questions[] =
{
"ProAudioSpectrum 16 support",
- "100% Sound Blaster compatibles (SB16/32/64, ESS, Jazz16) support",
+ "100%% Sound Blaster compatibles (SB16/32/64, ESS, Jazz16) support",
"Generic OPL2/OPL3 FM synthesizer support",
"Gravis Ultrasound support",
"MPU-401 support (NOT for SB16)",