2019-05-19 20:08:20 +08:00
|
|
|
// SPDX-License-Identifier: GPL-2.0-only
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Copyright (C) 1997 Wu Ching Chen
|
|
|
|
* 2.1.x update (C) 1998 Krzysztof G. Baranowski
|
2008-10-27 23:16:36 +08:00
|
|
|
* 2.5.x update (C) 2002 Red Hat
|
|
|
|
* 2.6.x update (C) 2004 Red Hat
|
2005-04-17 06:20:36 +08:00
|
|
|
*
|
|
|
|
* Marcelo Tosatti <marcelo@conectiva.com.br> : SMP fixes
|
|
|
|
*
|
|
|
|
* Wu Ching Chen : NULL pointer fixes 2000/06/02
|
|
|
|
* support atp876 chip
|
|
|
|
* enable 32 bit fifo transfer
|
|
|
|
* support cdrom & remove device run ultra speed
|
|
|
|
* fix disconnect bug 2000/12/21
|
|
|
|
* support atp880 chip lvd u160 2001/05/15
|
|
|
|
* fix prd table bug 2001/09/12 (7.1)
|
|
|
|
*
|
|
|
|
* atp885 support add by ACARD Hao Ping Lian 2005/01/05
|
|
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/interrupt.h>
|
|
|
|
#include <linux/kernel.h>
|
|
|
|
#include <linux/types.h>
|
|
|
|
#include <linux/string.h>
|
|
|
|
#include <linux/ioport.h>
|
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/proc_fs.h>
|
|
|
|
#include <linux/spinlock.h>
|
|
|
|
#include <linux/pci.h>
|
|
|
|
#include <linux/blkdev.h>
|
2006-03-28 17:56:48 +08:00
|
|
|
#include <linux/dma-mapping.h>
|
include cleanup: Update gfp.h and slab.h includes to prepare for breaking implicit slab.h inclusion from percpu.h
percpu.h is included by sched.h and module.h and thus ends up being
included when building most .c files. percpu.h includes slab.h which
in turn includes gfp.h making everything defined by the two files
universally available and complicating inclusion dependencies.
percpu.h -> slab.h dependency is about to be removed. Prepare for
this change by updating users of gfp and slab facilities include those
headers directly instead of assuming availability. As this conversion
needs to touch large number of source files, the following script is
used as the basis of conversion.
http://userweb.kernel.org/~tj/misc/slabh-sweep.py
The script does the followings.
* Scan files for gfp and slab usages and update includes such that
only the necessary includes are there. ie. if only gfp is used,
gfp.h, if slab is used, slab.h.
* When the script inserts a new include, it looks at the include
blocks and try to put the new include such that its order conforms
to its surrounding. It's put in the include block which contains
core kernel includes, in the same order that the rest are ordered -
alphabetical, Christmas tree, rev-Xmas-tree or at the end if there
doesn't seem to be any matching order.
* If the script can't find a place to put a new include (mostly
because the file doesn't have fitting include block), it prints out
an error message indicating which .h file needs to be added to the
file.
The conversion was done in the following steps.
1. The initial automatic conversion of all .c files updated slightly
over 4000 files, deleting around 700 includes and adding ~480 gfp.h
and ~3000 slab.h inclusions. The script emitted errors for ~400
files.
2. Each error was manually checked. Some didn't need the inclusion,
some needed manual addition while adding it to implementation .h or
embedding .c file was more appropriate for others. This step added
inclusions to around 150 files.
3. The script was run again and the output was compared to the edits
from #2 to make sure no file was left behind.
4. Several build tests were done and a couple of problems were fixed.
e.g. lib/decompress_*.c used malloc/free() wrappers around slab
APIs requiring slab.h to be added manually.
5. The script was run on all .h files but without automatically
editing them as sprinkling gfp.h and slab.h inclusions around .h
files could easily lead to inclusion dependency hell. Most gfp.h
inclusion directives were ignored as stuff from gfp.h was usually
wildly available and often used in preprocessor macros. Each
slab.h inclusion directive was examined and added manually as
necessary.
6. percpu.h was updated not to include slab.h.
7. Build test were done on the following configurations and failures
were fixed. CONFIG_GCOV_KERNEL was turned off for all tests (as my
distributed build env didn't work with gcov compiles) and a few
more options had to be turned off depending on archs to make things
build (like ipr on powerpc/64 which failed due to missing writeq).
* x86 and x86_64 UP and SMP allmodconfig and a custom test config.
* powerpc and powerpc64 SMP allmodconfig
* sparc and sparc64 SMP allmodconfig
* ia64 SMP allmodconfig
* s390 SMP allmodconfig
* alpha SMP allmodconfig
* um on x86_64 SMP allmodconfig
8. percpu.h modifications were reverted so that it could be applied as
a separate patch and serve as bisection point.
Given the fact that I had only a couple of failures from tests on step
6, I'm fairly confident about the coverage of this conversion patch.
If there is a breakage, it's likely to be something in one of the arch
headers which should be easily discoverable easily on most builds of
the specific arch.
Signed-off-by: Tejun Heo <tj@kernel.org>
Guess-its-ok-by: Christoph Lameter <cl@linux-foundation.org>
Cc: Ingo Molnar <mingo@redhat.com>
Cc: Lee Schermerhorn <Lee.Schermerhorn@hp.com>
2010-03-24 16:04:11 +08:00
|
|
|
#include <linux/slab.h>
|
2005-04-17 06:20:36 +08:00
|
|
|
#include <asm/io.h>
|
|
|
|
|
|
|
|
#include <scsi/scsi.h>
|
|
|
|
#include <scsi/scsi_cmnd.h>
|
|
|
|
#include <scsi/scsi_device.h>
|
|
|
|
#include <scsi/scsi_host.h>
|
|
|
|
|
|
|
|
#include "atp870u.h"
|
|
|
|
|
|
|
|
static struct scsi_host_template atp870u_template;
|
|
|
|
static void send_s870(struct atp_unit *dev,unsigned char c);
|
2021-01-13 17:04:30 +08:00
|
|
|
static void atp_is(struct atp_unit *dev, unsigned char c, bool wide_chip,
|
|
|
|
unsigned char lvdmode);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2015-11-18 02:23:54 +08:00
|
|
|
static inline void atp_writeb_base(struct atp_unit *atp, u8 reg, u8 val)
|
|
|
|
{
|
|
|
|
outb(val, atp->baseport + reg);
|
|
|
|
}
|
|
|
|
|
2015-11-18 02:24:07 +08:00
|
|
|
static inline void atp_writew_base(struct atp_unit *atp, u8 reg, u16 val)
|
|
|
|
{
|
|
|
|
outw(val, atp->baseport + reg);
|
|
|
|
}
|
|
|
|
|
2015-11-18 02:23:54 +08:00
|
|
|
static inline void atp_writeb_io(struct atp_unit *atp, u8 channel, u8 reg, u8 val)
|
|
|
|
{
|
|
|
|
outb(val, atp->ioport[channel] + reg);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void atp_writew_io(struct atp_unit *atp, u8 channel, u8 reg, u16 val)
|
|
|
|
{
|
|
|
|
outw(val, atp->ioport[channel] + reg);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void atp_writeb_pci(struct atp_unit *atp, u8 channel, u8 reg, u8 val)
|
|
|
|
{
|
|
|
|
outb(val, atp->pciport[channel] + reg);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline void atp_writel_pci(struct atp_unit *atp, u8 channel, u8 reg, u32 val)
|
|
|
|
{
|
|
|
|
outl(val, atp->pciport[channel] + reg);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline u8 atp_readb_base(struct atp_unit *atp, u8 reg)
|
|
|
|
{
|
|
|
|
return inb(atp->baseport + reg);
|
|
|
|
}
|
|
|
|
|
2015-11-18 02:24:07 +08:00
|
|
|
static inline u16 atp_readw_base(struct atp_unit *atp, u8 reg)
|
|
|
|
{
|
|
|
|
return inw(atp->baseport + reg);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline u32 atp_readl_base(struct atp_unit *atp, u8 reg)
|
|
|
|
{
|
|
|
|
return inl(atp->baseport + reg);
|
|
|
|
}
|
|
|
|
|
2015-11-18 02:23:54 +08:00
|
|
|
static inline u8 atp_readb_io(struct atp_unit *atp, u8 channel, u8 reg)
|
|
|
|
{
|
|
|
|
return inb(atp->ioport[channel] + reg);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline u16 atp_readw_io(struct atp_unit *atp, u8 channel, u8 reg)
|
|
|
|
{
|
|
|
|
return inw(atp->ioport[channel] + reg);
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline u8 atp_readb_pci(struct atp_unit *atp, u8 channel, u8 reg)
|
|
|
|
{
|
|
|
|
return inb(atp->pciport[channel] + reg);
|
|
|
|
}
|
|
|
|
|
2015-11-18 02:24:21 +08:00
|
|
|
static inline bool is880(struct atp_unit *atp)
|
|
|
|
{
|
|
|
|
return atp->pdev->device == ATP880_DEVID1 ||
|
|
|
|
atp->pdev->device == ATP880_DEVID2;
|
|
|
|
}
|
|
|
|
|
|
|
|
static inline bool is885(struct atp_unit *atp)
|
|
|
|
{
|
|
|
|
return atp->pdev->device == ATP885_DEVID;
|
|
|
|
}
|
|
|
|
|
IRQ: Maintain regs pointer globally rather than passing to IRQ handlers
Maintain a per-CPU global "struct pt_regs *" variable which can be used instead
of passing regs around manually through all ~1800 interrupt handlers in the
Linux kernel.
The regs pointer is used in few places, but it potentially costs both stack
space and code to pass it around. On the FRV arch, removing the regs parameter
from all the genirq function results in a 20% speed up of the IRQ exit path
(ie: from leaving timer_interrupt() to leaving do_IRQ()).
Where appropriate, an arch may override the generic storage facility and do
something different with the variable. On FRV, for instance, the address is
maintained in GR28 at all times inside the kernel as part of general exception
handling.
Having looked over the code, it appears that the parameter may be handed down
through up to twenty or so layers of functions. Consider a USB character
device attached to a USB hub, attached to a USB controller that posts its
interrupts through a cascaded auxiliary interrupt controller. A character
device driver may want to pass regs to the sysrq handler through the input
layer which adds another few layers of parameter passing.
I've build this code with allyesconfig for x86_64 and i386. I've runtested the
main part of the code on FRV and i386, though I can't test most of the drivers.
I've also done partial conversion for powerpc and MIPS - these at least compile
with minimal configurations.
This will affect all archs. Mostly the changes should be relatively easy.
Take do_IRQ(), store the regs pointer at the beginning, saving the old one:
struct pt_regs *old_regs = set_irq_regs(regs);
And put the old one back at the end:
set_irq_regs(old_regs);
Don't pass regs through to generic_handle_irq() or __do_IRQ().
In timer_interrupt(), this sort of change will be necessary:
- update_process_times(user_mode(regs));
- profile_tick(CPU_PROFILING, regs);
+ update_process_times(user_mode(get_irq_regs()));
+ profile_tick(CPU_PROFILING);
I'd like to move update_process_times()'s use of get_irq_regs() into itself,
except that i386, alone of the archs, uses something other than user_mode().
Some notes on the interrupt handling in the drivers:
(*) input_dev() is now gone entirely. The regs pointer is no longer stored in
the input_dev struct.
(*) finish_unlinks() in drivers/usb/host/ohci-q.c needs checking. It does
something different depending on whether it's been supplied with a regs
pointer or not.
(*) Various IRQ handler function pointers have been moved to type
irq_handler_t.
Signed-Off-By: David Howells <dhowells@redhat.com>
(cherry picked from 1b16e7ac850969f38b375e511e3fa2f474a33867 commit)
2006-10-05 21:55:46 +08:00
|
|
|
static irqreturn_t atp870u_intr_handle(int irq, void *dev_id)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
unsigned long flags;
|
2015-11-18 02:23:47 +08:00
|
|
|
unsigned short int id;
|
2005-04-17 06:20:36 +08:00
|
|
|
unsigned char i, j, c, target_id, lun,cmdp;
|
|
|
|
unsigned char *prd;
|
|
|
|
struct scsi_cmnd *workreq;
|
|
|
|
unsigned long adrcnt, k;
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
unsigned long l;
|
|
|
|
#endif
|
|
|
|
struct Scsi_Host *host = dev_id;
|
|
|
|
struct atp_unit *dev = (struct atp_unit *)&host->hostdata;
|
|
|
|
|
|
|
|
for (c = 0; c < 2; c++) {
|
2015-11-18 02:23:54 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x1f);
|
2005-04-17 06:20:36 +08:00
|
|
|
if ((j & 0x80) != 0)
|
2015-11-18 02:23:49 +08:00
|
|
|
break;
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->in_int[c] = 0;
|
|
|
|
}
|
2015-11-18 02:23:49 +08:00
|
|
|
if ((j & 0x80) == 0)
|
|
|
|
return IRQ_NONE;
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
2005-04-17 06:20:36 +08:00
|
|
|
printk("atp870u_intr_handle enter\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->in_int[c] = 1;
|
2015-11-18 02:23:54 +08:00
|
|
|
cmdp = atp_readb_io(dev, c, 0x10);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (dev->working[c] != 0) {
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev)) {
|
2015-11-18 02:23:54 +08:00
|
|
|
if ((atp_readb_io(dev, c, 0x16) & 0x80) == 0)
|
2021-01-13 17:04:30 +08:00
|
|
|
atp_writeb_io(dev, c, 0x16,
|
|
|
|
(atp_readb_io(dev, c, 0x16) | 0x80));
|
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
if ((atp_readb_pci(dev, c, 0x00) & 0x08) != 0)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
for (k=0; k < 1000; k++) {
|
2015-11-18 02:23:54 +08:00
|
|
|
if ((atp_readb_pci(dev, c, 2) & 0x08) == 0)
|
2015-11-18 02:23:49 +08:00
|
|
|
break;
|
2015-11-18 02:23:54 +08:00
|
|
|
if ((atp_readb_pci(dev, c, 2) & 0x01) == 0)
|
2015-11-18 02:23:49 +08:00
|
|
|
break;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_pci(dev, c, 0, 0x00);
|
2021-01-13 17:04:30 +08:00
|
|
|
|
2015-11-18 02:23:54 +08:00
|
|
|
i = atp_readb_io(dev, c, 0x17);
|
2021-01-13 17:04:30 +08:00
|
|
|
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev))
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_pci(dev, c, 2, 0x06);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2015-11-18 02:23:54 +08:00
|
|
|
target_id = atp_readb_io(dev, c, 0x15);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Remap wide devices onto id numbers
|
|
|
|
*/
|
|
|
|
|
|
|
|
if ((target_id & 0x40) != 0) {
|
|
|
|
target_id = (target_id & 0x07) | 0x08;
|
|
|
|
} else {
|
|
|
|
target_id &= 0x07;
|
|
|
|
}
|
|
|
|
|
|
|
|
if ((j & 0x40) != 0) {
|
|
|
|
if (dev->last_cmd[c] == 0xff) {
|
|
|
|
dev->last_cmd[c] = target_id;
|
|
|
|
}
|
|
|
|
dev->last_cmd[c] |= 0x40;
|
|
|
|
}
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev))
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->r1f[c][target_id] |= j;
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("atp870u_intr_handle status = %x\n",i);
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
if (i == 0x85) {
|
|
|
|
if ((dev->last_cmd[c] & 0xf0) != 0x40) {
|
|
|
|
dev->last_cmd[c] = 0xff;
|
|
|
|
}
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev)) {
|
2005-04-17 06:20:36 +08:00
|
|
|
adrcnt = 0;
|
2021-01-13 17:04:30 +08:00
|
|
|
((unsigned char *) &adrcnt)[2] =
|
|
|
|
atp_readb_io(dev, c, 0x12);
|
|
|
|
((unsigned char *) &adrcnt)[1] =
|
|
|
|
atp_readb_io(dev, c, 0x13);
|
|
|
|
((unsigned char *) &adrcnt)[0] =
|
|
|
|
atp_readb_io(dev, c, 0x14);
|
2019-01-22 23:10:30 +08:00
|
|
|
if (dev->id[c][target_id].last_len != adrcnt) {
|
|
|
|
k = dev->id[c][target_id].last_len;
|
2021-01-13 17:04:30 +08:00
|
|
|
k -= adrcnt;
|
|
|
|
dev->id[c][target_id].tran_len = k;
|
2019-01-22 23:10:30 +08:00
|
|
|
dev->id[c][target_id].last_len = adrcnt;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
#ifdef ED_DBGP
|
2021-01-13 17:04:30 +08:00
|
|
|
printk("dev->id[c][target_id].last_len = %d "
|
|
|
|
"dev->id[c][target_id].tran_len = %d\n",
|
|
|
|
dev->id[c][target_id].last_len,
|
|
|
|
dev->id[c][target_id].tran_len);
|
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Flip wide
|
2021-01-13 17:04:30 +08:00
|
|
|
*/
|
2005-04-17 06:20:36 +08:00
|
|
|
if (dev->wide_id[c] != 0) {
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x1b, 0x01);
|
|
|
|
while ((atp_readb_io(dev, c, 0x1b) & 0x01) != 0x01)
|
|
|
|
atp_writeb_io(dev, c, 0x1b, 0x01);
|
2021-01-13 17:04:30 +08:00
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Issue more commands
|
|
|
|
*/
|
2021-01-13 17:04:30 +08:00
|
|
|
spin_lock_irqsave(dev->host->host_lock, flags);
|
|
|
|
if (((dev->quhd[c] != dev->quend[c]) ||
|
|
|
|
(dev->last_cmd[c] != 0xff)) &&
|
2005-04-17 06:20:36 +08:00
|
|
|
(dev->in_snd[c] == 0)) {
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("Call sent_s870\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
send_s870(dev,c);
|
|
|
|
}
|
|
|
|
spin_unlock_irqrestore(dev->host->host_lock, flags);
|
|
|
|
/*
|
|
|
|
* Done
|
|
|
|
*/
|
|
|
|
dev->in_int[c] = 0;
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("Status 0x85 return\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2015-11-18 02:23:49 +08:00
|
|
|
return IRQ_HANDLED;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
if (i == 0x40) {
|
|
|
|
dev->last_cmd[c] |= 0x40;
|
|
|
|
dev->in_int[c] = 0;
|
2015-11-18 02:23:49 +08:00
|
|
|
return IRQ_HANDLED;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
if (i == 0x21) {
|
|
|
|
if ((dev->last_cmd[c] & 0xf0) != 0x40) {
|
|
|
|
dev->last_cmd[c] = 0xff;
|
|
|
|
}
|
|
|
|
adrcnt = 0;
|
2021-01-13 17:04:30 +08:00
|
|
|
((unsigned char *) &adrcnt)[2] =
|
|
|
|
atp_readb_io(dev, c, 0x12);
|
|
|
|
((unsigned char *) &adrcnt)[1] =
|
|
|
|
atp_readb_io(dev, c, 0x13);
|
|
|
|
((unsigned char *) &adrcnt)[0] =
|
|
|
|
atp_readb_io(dev, c, 0x14);
|
2005-04-17 06:20:36 +08:00
|
|
|
k = dev->id[c][target_id].last_len;
|
|
|
|
k -= adrcnt;
|
|
|
|
dev->id[c][target_id].tran_len = k;
|
|
|
|
dev->id[c][target_id].last_len = adrcnt;
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x10, 0x41);
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->in_int[c] = 0;
|
2015-11-18 02:23:49 +08:00
|
|
|
return IRQ_HANDLED;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev)) {
|
2005-04-17 06:20:36 +08:00
|
|
|
if ((i == 0x4c) || (i == 0x4d) || (i == 0x8c) || (i == 0x8d)) {
|
2021-01-13 17:04:30 +08:00
|
|
|
if ((i == 0x4c) || (i == 0x8c))
|
|
|
|
i=0x48;
|
|
|
|
else
|
|
|
|
i=0x49;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
if ((i == 0x80) || (i == 0x8f)) {
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk(KERN_DEBUG "Device reselect\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
lun = 0;
|
2015-11-18 02:23:54 +08:00
|
|
|
if (cmdp == 0x44 || i == 0x80)
|
|
|
|
lun = atp_readb_io(dev, c, 0x1d) & 0x07;
|
|
|
|
else {
|
2005-04-17 06:20:36 +08:00
|
|
|
if ((dev->last_cmd[c] & 0xf0) != 0x40) {
|
|
|
|
dev->last_cmd[c] = 0xff;
|
|
|
|
}
|
|
|
|
if (cmdp == 0x41) {
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("cmdp = 0x41\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
adrcnt = 0;
|
2021-01-13 17:04:30 +08:00
|
|
|
((unsigned char *) &adrcnt)[2] =
|
|
|
|
atp_readb_io(dev, c, 0x12);
|
|
|
|
((unsigned char *) &adrcnt)[1] =
|
|
|
|
atp_readb_io(dev, c, 0x13);
|
|
|
|
((unsigned char *) &adrcnt)[0] =
|
|
|
|
atp_readb_io(dev, c, 0x14);
|
2005-04-17 06:20:36 +08:00
|
|
|
k = dev->id[c][target_id].last_len;
|
|
|
|
k -= adrcnt;
|
|
|
|
dev->id[c][target_id].tran_len = k;
|
|
|
|
dev->id[c][target_id].last_len = adrcnt;
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->in_int[c] = 0;
|
2015-11-18 02:23:49 +08:00
|
|
|
return IRQ_HANDLED;
|
2005-04-17 06:20:36 +08:00
|
|
|
} else {
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("cmdp != 0x41\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x10, 0x46);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->id[c][target_id].dirct = 0x00;
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x12, 0x00);
|
|
|
|
atp_writeb_io(dev, c, 0x13, 0x00);
|
|
|
|
atp_writeb_io(dev, c, 0x14, 0x00);
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->in_int[c] = 0;
|
2015-11-18 02:23:49 +08:00
|
|
|
return IRQ_HANDLED;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
if (dev->last_cmd[c] != 0xff) {
|
|
|
|
dev->last_cmd[c] |= 0x40;
|
|
|
|
}
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev)) {
|
2015-11-18 02:23:54 +08:00
|
|
|
j = atp_readb_base(dev, 0x29) & 0xfe;
|
|
|
|
atp_writeb_base(dev, 0x29, j);
|
2015-11-18 02:23:39 +08:00
|
|
|
} else
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x10, 0x45);
|
2015-11-18 02:23:39 +08:00
|
|
|
|
2015-11-18 02:23:54 +08:00
|
|
|
target_id = atp_readb_io(dev, c, 0x16);
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Remap wide identifiers
|
|
|
|
*/
|
|
|
|
if ((target_id & 0x10) != 0) {
|
|
|
|
target_id = (target_id & 0x07) | 0x08;
|
|
|
|
} else {
|
|
|
|
target_id &= 0x07;
|
|
|
|
}
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev))
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x10, 0x45);
|
2005-04-17 06:20:36 +08:00
|
|
|
workreq = dev->id[c][target_id].curr_req;
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
2005-10-25 06:04:36 +08:00
|
|
|
scmd_printk(KERN_DEBUG, workreq, "CDB");
|
|
|
|
for (l = 0; l < workreq->cmd_len; l++)
|
2005-04-17 06:20:36 +08:00
|
|
|
printk(KERN_DEBUG " %x",workreq->cmnd[l]);
|
2005-10-25 06:04:36 +08:00
|
|
|
printk("\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
|
|
|
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x0f, lun);
|
|
|
|
atp_writeb_io(dev, c, 0x11, dev->id[c][target_id].devsp);
|
2005-04-17 06:20:36 +08:00
|
|
|
adrcnt = dev->id[c][target_id].tran_len;
|
|
|
|
k = dev->id[c][target_id].last_len;
|
|
|
|
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x12, ((unsigned char *) &k)[2]);
|
|
|
|
atp_writeb_io(dev, c, 0x13, ((unsigned char *) &k)[1]);
|
|
|
|
atp_writeb_io(dev, c, 0x14, ((unsigned char *) &k)[0]);
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("k %x, k[0] 0x%x k[1] 0x%x k[2] 0x%x\n", k,
|
|
|
|
atp_readb_io(dev, c, 0x14),
|
|
|
|
atp_readb_io(dev, c, 0x13),
|
|
|
|
atp_readb_io(dev, c, 0x12));
|
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
/* Remap wide */
|
|
|
|
j = target_id;
|
|
|
|
if (target_id > 7) {
|
|
|
|
j = (j & 0x07) | 0x40;
|
|
|
|
}
|
|
|
|
/* Add direction */
|
|
|
|
j |= dev->id[c][target_id].dirct;
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x15, j);
|
|
|
|
atp_writeb_io(dev, c, 0x16, 0x80);
|
2021-01-13 17:04:30 +08:00
|
|
|
|
|
|
|
/* enable 32 bit fifo transfer */
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev)) {
|
2015-11-18 02:23:54 +08:00
|
|
|
i = atp_readb_pci(dev, c, 1) & 0xf3;
|
2021-01-13 17:04:30 +08:00
|
|
|
//j=workreq->cmnd[0];
|
2021-01-13 17:04:49 +08:00
|
|
|
if ((workreq->cmnd[0] == READ_6) ||
|
|
|
|
(workreq->cmnd[0] == READ_10) ||
|
|
|
|
(workreq->cmnd[0] == WRITE_6) ||
|
|
|
|
(workreq->cmnd[0] == WRITE_10)) {
|
2005-04-17 06:20:36 +08:00
|
|
|
i |= 0x0c;
|
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_pci(dev, c, 1, i);
|
2015-11-18 02:24:21 +08:00
|
|
|
} else if (is880(dev)) {
|
2021-01-13 17:04:49 +08:00
|
|
|
if ((workreq->cmnd[0] == READ_6) ||
|
|
|
|
(workreq->cmnd[0] == READ_10) ||
|
|
|
|
(workreq->cmnd[0] == WRITE_6) ||
|
|
|
|
(workreq->cmnd[0] == WRITE_10))
|
2021-01-13 17:04:30 +08:00
|
|
|
atp_writeb_base(dev, 0x3b,
|
|
|
|
(atp_readb_base(dev, 0x3b) & 0x3f) | 0xc0);
|
2015-11-18 02:23:54 +08:00
|
|
|
else
|
2021-01-13 17:04:30 +08:00
|
|
|
atp_writeb_base(dev, 0x3b,
|
|
|
|
atp_readb_base(dev, 0x3b) & 0x3f);
|
|
|
|
} else {
|
2021-01-13 17:04:49 +08:00
|
|
|
if ((workreq->cmnd[0] == READ_6) ||
|
|
|
|
(workreq->cmnd[0] == READ_10) ||
|
|
|
|
(workreq->cmnd[0] == WRITE_6) ||
|
|
|
|
(workreq->cmnd[0] == WRITE_10))
|
2021-01-13 17:04:30 +08:00
|
|
|
atp_writeb_base(dev, 0x3a,
|
|
|
|
(atp_readb_base(dev, 0x3a) & 0xf3) | 0x08);
|
2015-11-18 02:23:54 +08:00
|
|
|
else
|
2021-01-13 17:04:30 +08:00
|
|
|
atp_writeb_base(dev, 0x3a,
|
|
|
|
atp_readb_base(dev, 0x3a) & 0xf3);
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
j = 0;
|
|
|
|
id = 1;
|
|
|
|
id = id << target_id;
|
|
|
|
/*
|
|
|
|
* Is this a wide device
|
|
|
|
*/
|
|
|
|
if ((id & dev->wide_id[c]) != 0) {
|
|
|
|
j |= 0x01;
|
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x1b, j);
|
|
|
|
while ((atp_readb_io(dev, c, 0x1b) & 0x01) != j)
|
|
|
|
atp_writeb_io(dev, c, 0x1b, j);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (dev->id[c][target_id].last_len == 0) {
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->in_int[c] = 0;
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("dev->id[c][target_id].last_len = 0\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2015-11-18 02:23:49 +08:00
|
|
|
return IRQ_HANDLED;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("target_id = %d adrcnt = %d\n",target_id,adrcnt);
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
prd = dev->id[c][target_id].prd_pos;
|
|
|
|
while (adrcnt != 0) {
|
|
|
|
id = ((unsigned short int *)prd)[2];
|
|
|
|
if (id == 0) {
|
|
|
|
k = 0x10000;
|
|
|
|
} else {
|
|
|
|
k = id;
|
|
|
|
}
|
|
|
|
if (k > adrcnt) {
|
2021-01-13 17:04:30 +08:00
|
|
|
((unsigned short int *)prd)[2] =
|
|
|
|
(unsigned short int)(k - adrcnt);
|
2005-04-17 06:20:36 +08:00
|
|
|
((unsigned long *)prd)[0] += adrcnt;
|
|
|
|
adrcnt = 0;
|
|
|
|
dev->id[c][target_id].prd_pos = prd;
|
|
|
|
} else {
|
|
|
|
adrcnt -= k;
|
|
|
|
dev->id[c][target_id].prdaddr += 0x08;
|
|
|
|
prd += 0x08;
|
|
|
|
if (adrcnt == 0) {
|
|
|
|
dev->id[c][target_id].prd_pos = prd;
|
|
|
|
}
|
2021-01-13 17:04:30 +08:00
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writel_pci(dev, c, 0x04, dev->id[c][target_id].prdaddr);
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef ED_DBGP
|
2021-01-13 17:04:30 +08:00
|
|
|
printk("dev->id[%d][%d].prdaddr 0x%8x\n",
|
|
|
|
c, target_id, dev->id[c][target_id].prdaddr);
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
2015-11-18 02:24:21 +08:00
|
|
|
if (!is885(dev)) {
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_pci(dev, c, 2, 0x06);
|
|
|
|
atp_writeb_pci(dev, c, 2, 0x00);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
/*
|
|
|
|
* Check transfer direction
|
|
|
|
*/
|
|
|
|
if (dev->id[c][target_id].dirct != 0) {
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
|
|
|
atp_writeb_pci(dev, c, 0, 0x01);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->in_int[c] = 0;
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("status 0x80 return dirct != 0\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2015-11-18 02:23:49 +08:00
|
|
|
return IRQ_HANDLED;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
|
|
|
atp_writeb_pci(dev, c, 0, 0x09);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->in_int[c] = 0;
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("status 0x80 return dirct = 0\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2015-11-18 02:23:49 +08:00
|
|
|
return IRQ_HANDLED;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Current scsi request on this target
|
|
|
|
*/
|
|
|
|
|
|
|
|
workreq = dev->id[c][target_id].curr_req;
|
|
|
|
|
2015-11-18 02:23:49 +08:00
|
|
|
if (i == 0x42 || i == 0x16) {
|
2005-04-17 06:20:36 +08:00
|
|
|
if ((dev->last_cmd[c] & 0xf0) != 0x40) {
|
|
|
|
dev->last_cmd[c] = 0xff;
|
|
|
|
}
|
2015-11-18 02:23:49 +08:00
|
|
|
if (i == 0x16) {
|
2015-11-18 02:23:54 +08:00
|
|
|
workreq->result = atp_readb_io(dev, c, 0x0f);
|
2015-11-18 02:24:21 +08:00
|
|
|
if (((dev->r1f[c][target_id] & 0x10) != 0) && is885(dev)) {
|
2015-11-18 02:23:49 +08:00
|
|
|
printk(KERN_WARNING "AEC67162 CRC ERROR !\n");
|
2021-01-13 17:04:49 +08:00
|
|
|
workreq->result = SAM_STAT_CHECK_CONDITION;
|
2015-11-18 02:23:49 +08:00
|
|
|
}
|
|
|
|
} else
|
2021-01-13 17:04:49 +08:00
|
|
|
workreq->result = SAM_STAT_CHECK_CONDITION;
|
2015-11-18 02:23:49 +08:00
|
|
|
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev)) {
|
2015-11-18 02:23:54 +08:00
|
|
|
j = atp_readb_base(dev, 0x29) | 0x01;
|
|
|
|
atp_writeb_base(dev, 0x29, j);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
/*
|
|
|
|
* Complete the command
|
|
|
|
*/
|
2007-09-10 02:06:23 +08:00
|
|
|
scsi_dma_unmap(workreq);
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
spin_lock_irqsave(dev->host->host_lock, flags);
|
2021-10-08 04:28:18 +08:00
|
|
|
scsi_done(workreq);
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("workreq->scsi_done\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Clear it off the queue
|
|
|
|
*/
|
|
|
|
dev->id[c][target_id].curr_req = NULL;
|
|
|
|
dev->working[c]--;
|
|
|
|
spin_unlock_irqrestore(dev->host->host_lock, flags);
|
|
|
|
/*
|
|
|
|
* Take it back wide
|
|
|
|
*/
|
|
|
|
if (dev->wide_id[c] != 0) {
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x1b, 0x01);
|
|
|
|
while ((atp_readb_io(dev, c, 0x1b) & 0x01) != 0x01)
|
|
|
|
atp_writeb_io(dev, c, 0x1b, 0x01);
|
2021-01-13 17:04:30 +08:00
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* If there is stuff to send and nothing going then send it
|
|
|
|
*/
|
|
|
|
spin_lock_irqsave(dev->host->host_lock, flags);
|
2021-01-13 17:04:30 +08:00
|
|
|
if (((dev->last_cmd[c] != 0xff) ||
|
|
|
|
(dev->quhd[c] != dev->quend[c])) &&
|
2005-04-17 06:20:36 +08:00
|
|
|
(dev->in_snd[c] == 0)) {
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("Call sent_s870(scsi_done)\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
send_s870(dev,c);
|
|
|
|
}
|
|
|
|
spin_unlock_irqrestore(dev->host->host_lock, flags);
|
|
|
|
dev->in_int[c] = 0;
|
2015-11-18 02:23:49 +08:00
|
|
|
return IRQ_HANDLED;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
if ((dev->last_cmd[c] & 0xf0) != 0x40) {
|
|
|
|
dev->last_cmd[c] = 0xff;
|
|
|
|
}
|
|
|
|
if (i == 0x4f) {
|
|
|
|
i = 0x89;
|
|
|
|
}
|
|
|
|
i &= 0x0f;
|
|
|
|
if (i == 0x09) {
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writel_pci(dev, c, 4, dev->id[c][target_id].prdaddr);
|
|
|
|
atp_writeb_pci(dev, c, 2, 0x06);
|
|
|
|
atp_writeb_pci(dev, c, 2, 0x00);
|
|
|
|
atp_writeb_io(dev, c, 0x10, 0x41);
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev)) {
|
2005-04-17 06:20:36 +08:00
|
|
|
k = dev->id[c][target_id].last_len;
|
2021-01-13 17:04:30 +08:00
|
|
|
atp_writeb_io(dev, c, 0x12,
|
|
|
|
((unsigned char *) (&k))[2]);
|
|
|
|
atp_writeb_io(dev, c, 0x13,
|
|
|
|
((unsigned char *) (&k))[1]);
|
|
|
|
atp_writeb_io(dev, c, 0x14,
|
|
|
|
((unsigned char *) (&k))[0]);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->id[c][target_id].dirct = 0x00;
|
|
|
|
} else {
|
|
|
|
dev->id[c][target_id].dirct = 0x00;
|
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
|
|
|
atp_writeb_pci(dev, c, 0, 0x09);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->in_int[c] = 0;
|
2015-11-18 02:23:49 +08:00
|
|
|
return IRQ_HANDLED;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
if (i == 0x08) {
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writel_pci(dev, c, 4, dev->id[c][target_id].prdaddr);
|
|
|
|
atp_writeb_pci(dev, c, 2, 0x06);
|
|
|
|
atp_writeb_pci(dev, c, 2, 0x00);
|
|
|
|
atp_writeb_io(dev, c, 0x10, 0x41);
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev)) {
|
2005-04-17 06:20:36 +08:00
|
|
|
k = dev->id[c][target_id].last_len;
|
2021-01-13 17:04:30 +08:00
|
|
|
atp_writeb_io(dev, c, 0x12,
|
|
|
|
((unsigned char *) (&k))[2]);
|
|
|
|
atp_writeb_io(dev, c, 0x13,
|
|
|
|
((unsigned char *) (&k))[1]);
|
|
|
|
atp_writeb_io(dev, c, 0x14,
|
|
|
|
((unsigned char *) (&k))[0]);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2021-01-13 17:04:30 +08:00
|
|
|
atp_writeb_io(dev, c, 0x15,
|
|
|
|
atp_readb_io(dev, c, 0x15) | 0x20);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->id[c][target_id].dirct = 0x20;
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
|
|
|
atp_writeb_pci(dev, c, 0, 0x01);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->in_int[c] = 0;
|
2015-11-18 02:23:49 +08:00
|
|
|
return IRQ_HANDLED;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
if (i == 0x0a)
|
|
|
|
atp_writeb_io(dev, c, 0x10, 0x30);
|
|
|
|
else
|
|
|
|
atp_writeb_io(dev, c, 0x10, 0x46);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->id[c][target_id].dirct = 0x00;
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x12, 0x00);
|
|
|
|
atp_writeb_io(dev, c, 0x13, 0x00);
|
|
|
|
atp_writeb_io(dev, c, 0x14, 0x00);
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2015-11-18 02:23:49 +08:00
|
|
|
dev->in_int[c] = 0;
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
return IRQ_HANDLED;
|
|
|
|
}
|
|
|
|
/**
|
2021-03-12 17:47:34 +08:00
|
|
|
* atp870u_queuecommand_lck - Queue SCSI command
|
2005-04-17 06:20:36 +08:00
|
|
|
* @req_p: request block
|
|
|
|
* @done: completion function
|
|
|
|
*
|
|
|
|
* Queue a command to the ATP queue. Called with the host lock held.
|
|
|
|
*/
|
2021-10-08 04:46:14 +08:00
|
|
|
static int atp870u_queuecommand_lck(struct scsi_cmnd *req_p)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2021-10-08 04:46:14 +08:00
|
|
|
void (*done)(struct scsi_cmnd *) = scsi_done;
|
2005-04-17 06:20:36 +08:00
|
|
|
unsigned char c;
|
2015-11-18 02:23:40 +08:00
|
|
|
unsigned int m;
|
2005-04-17 06:20:36 +08:00
|
|
|
struct atp_unit *dev;
|
|
|
|
struct Scsi_Host *host;
|
|
|
|
|
2005-10-25 06:05:09 +08:00
|
|
|
c = scmd_channel(req_p);
|
2005-04-17 06:20:36 +08:00
|
|
|
req_p->sense_buffer[0]=0;
|
2007-09-10 02:06:23 +08:00
|
|
|
scsi_set_resid(req_p, 0);
|
2005-10-25 06:05:09 +08:00
|
|
|
if (scmd_channel(req_p) > 1) {
|
2021-01-13 17:04:49 +08:00
|
|
|
req_p->result = DID_BAD_TARGET << 16;
|
2005-04-17 06:20:36 +08:00
|
|
|
done(req_p);
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("atp870u_queuecommand : req_p->device->channel > 1\n");
|
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
host = req_p->device->host;
|
|
|
|
dev = (struct atp_unit *)&host->hostdata;
|
|
|
|
|
|
|
|
m = 1;
|
2005-10-25 06:05:09 +08:00
|
|
|
m = m << scmd_id(req_p);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Fake a timeout for missing targets
|
|
|
|
*/
|
|
|
|
|
|
|
|
if ((m & dev->active_id[c]) == 0) {
|
2021-01-13 17:04:49 +08:00
|
|
|
req_p->result = DID_BAD_TARGET << 16;
|
2005-04-17 06:20:36 +08:00
|
|
|
done(req_p);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Count new command
|
|
|
|
*/
|
|
|
|
dev->quend[c]++;
|
|
|
|
if (dev->quend[c] >= qcnt) {
|
|
|
|
dev->quend[c] = 0;
|
|
|
|
}
|
2021-01-13 17:04:30 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Check queue state
|
|
|
|
*/
|
|
|
|
if (dev->quhd[c] == dev->quend[c]) {
|
|
|
|
if (dev->quend[c] == 0) {
|
|
|
|
dev->quend[c] = qcnt;
|
|
|
|
}
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
2005-04-17 06:20:36 +08:00
|
|
|
printk("atp870u_queuecommand : dev->quhd[c] == dev->quend[c]\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->quend[c]--;
|
2021-01-13 17:04:49 +08:00
|
|
|
req_p->result = DID_BUS_BUSY << 16;
|
2021-01-13 17:04:30 +08:00
|
|
|
done(req_p);
|
2005-04-17 06:20:36 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
dev->quereq[c][dev->quend[c]] = req_p;
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("dev->ioport[c] = %x atp_readb_io(dev, c, 0x1c) = %x "
|
|
|
|
"dev->in_int[%d] = %d dev->in_snd[%d] = %d\n",
|
|
|
|
dev->ioport[c], atp_readb_io(dev, c, 0x1c), c,
|
|
|
|
dev->in_int[c],c,dev->in_snd[c]);
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
2021-01-13 17:04:30 +08:00
|
|
|
if ((atp_readb_io(dev, c, 0x1c) == 0) &&
|
|
|
|
(dev->in_int[c] == 0) &&
|
|
|
|
(dev->in_snd[c] == 0)) {
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("Call sent_s870(atp870u_queuecommand)\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
send_s870(dev,c);
|
|
|
|
}
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
2005-04-17 06:20:36 +08:00
|
|
|
printk("atp870u_queuecommand : exit\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2010-11-16 15:10:29 +08:00
|
|
|
static DEF_SCSI_QCMD(atp870u_queuecommand)
|
|
|
|
|
2021-03-12 17:47:34 +08:00
|
|
|
/*
|
2005-04-17 06:20:36 +08:00
|
|
|
* send_s870 - send a command to the controller
|
|
|
|
*
|
|
|
|
* On entry there is work queued to be done. We move some of that work to the
|
2021-01-13 17:04:30 +08:00
|
|
|
* controller itself.
|
2005-04-17 06:20:36 +08:00
|
|
|
*
|
|
|
|
* Caller holds the host lock.
|
|
|
|
*/
|
2021-03-12 17:47:34 +08:00
|
|
|
static void send_s870(struct atp_unit *dev, unsigned char c)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2015-11-18 02:23:50 +08:00
|
|
|
struct scsi_cmnd *workreq = NULL;
|
2005-04-17 06:20:36 +08:00
|
|
|
unsigned int i;//,k;
|
|
|
|
unsigned char j, target_id;
|
|
|
|
unsigned char *prd;
|
2015-11-18 02:23:48 +08:00
|
|
|
unsigned short int w;
|
2005-04-17 06:20:36 +08:00
|
|
|
unsigned long l, bttl = 0;
|
|
|
|
unsigned long sg_count;
|
|
|
|
|
|
|
|
if (dev->in_snd[c] != 0) {
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
2005-04-17 06:20:36 +08:00
|
|
|
printk("cmnd in_snd\n");
|
|
|
|
#endif
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("Sent_s870 enter\n");
|
|
|
|
#endif
|
|
|
|
dev->in_snd[c] = 1;
|
|
|
|
if ((dev->last_cmd[c] != 0xff) && ((dev->last_cmd[c] & 0x40) != 0)) {
|
|
|
|
dev->last_cmd[c] &= 0x0f;
|
|
|
|
workreq = dev->id[c][dev->last_cmd[c]].curr_req;
|
2015-11-18 02:23:50 +08:00
|
|
|
if (!workreq) {
|
|
|
|
dev->last_cmd[c] = 0xff;
|
|
|
|
if (dev->quhd[c] == dev->quend[c]) {
|
|
|
|
dev->in_snd[c] = 0;
|
|
|
|
return;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
}
|
2015-11-18 02:23:50 +08:00
|
|
|
if (!workreq) {
|
|
|
|
if ((dev->last_cmd[c] != 0xff) && (dev->working[c] != 0)) {
|
|
|
|
dev->in_snd[c] = 0;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
dev->working[c]++;
|
|
|
|
j = dev->quhd[c];
|
|
|
|
dev->quhd[c]++;
|
|
|
|
if (dev->quhd[c] >= qcnt)
|
|
|
|
dev->quhd[c] = 0;
|
|
|
|
workreq = dev->quereq[c][dev->quhd[c]];
|
|
|
|
if (dev->id[c][scmd_id(workreq)].curr_req != NULL) {
|
|
|
|
dev->quhd[c] = j;
|
|
|
|
dev->working[c]--;
|
|
|
|
dev->in_snd[c] = 0;
|
|
|
|
return;
|
|
|
|
}
|
2005-10-25 06:05:09 +08:00
|
|
|
dev->id[c][scmd_id(workreq)].curr_req = workreq;
|
|
|
|
dev->last_cmd[c] = scmd_id(workreq);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2021-01-13 17:04:30 +08:00
|
|
|
if ((atp_readb_io(dev, c, 0x1f) & 0xb0) != 0 ||
|
|
|
|
atp_readb_io(dev, c, 0x1c) != 0) {
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef ED_DBGP
|
2015-11-18 02:23:50 +08:00
|
|
|
printk("Abort to Send\n");
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
2015-11-18 02:23:50 +08:00
|
|
|
dev->last_cmd[c] |= 0x40;
|
|
|
|
dev->in_snd[c] = 0;
|
|
|
|
return;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("OK to Send\n");
|
2005-10-25 06:05:09 +08:00
|
|
|
scmd_printk(KERN_DEBUG, workreq, "CDB");
|
2005-04-17 06:20:36 +08:00
|
|
|
for(i=0;i<workreq->cmd_len;i++) {
|
|
|
|
printk(" %x",workreq->cmnd[i]);
|
|
|
|
}
|
2005-10-25 06:05:09 +08:00
|
|
|
printk("\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2007-09-10 02:06:23 +08:00
|
|
|
l = scsi_bufflen(workreq);
|
|
|
|
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev)) {
|
2015-11-18 02:23:54 +08:00
|
|
|
j = atp_readb_base(dev, 0x29) & 0xfe;
|
|
|
|
atp_writeb_base(dev, 0x29, j);
|
2005-10-25 06:05:09 +08:00
|
|
|
dev->r1f[c][scmd_id(workreq)] = 0;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2021-01-13 17:04:30 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
if (workreq->cmnd[0] == READ_CAPACITY) {
|
2007-09-10 02:06:23 +08:00
|
|
|
if (l > 8)
|
|
|
|
l = 8;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2021-01-13 17:04:49 +08:00
|
|
|
if (workreq->cmnd[0] == TEST_UNIT_READY) {
|
2007-09-10 02:06:23 +08:00
|
|
|
l = 0;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
j = 0;
|
2005-10-25 06:05:09 +08:00
|
|
|
target_id = scmd_id(workreq);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Wide ?
|
|
|
|
*/
|
|
|
|
w = 1;
|
|
|
|
w = w << target_id;
|
|
|
|
if ((w & dev->wide_id[c]) != 0) {
|
|
|
|
j |= 0x01;
|
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x1b, j);
|
|
|
|
while ((atp_readb_io(dev, c, 0x1b) & 0x01) != j) {
|
|
|
|
atp_writeb_pci(dev, c, 0x1b, j);
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("send_s870 while loop 1\n");
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
/*
|
|
|
|
* Write the command
|
|
|
|
*/
|
|
|
|
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x00, workreq->cmd_len);
|
|
|
|
atp_writeb_io(dev, c, 0x01, 0x2c);
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev))
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x02, 0x7f);
|
|
|
|
else
|
|
|
|
atp_writeb_io(dev, c, 0x02, 0xcf);
|
|
|
|
for (i = 0; i < workreq->cmd_len; i++)
|
|
|
|
atp_writeb_io(dev, c, 0x03 + i, workreq->cmnd[i]);
|
|
|
|
atp_writeb_io(dev, c, 0x0f, workreq->device->lun);
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Write the target
|
|
|
|
*/
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x11, dev->id[c][target_id].devsp);
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("dev->id[%d][%d].devsp = %2x\n",c,target_id,
|
|
|
|
dev->id[c][target_id].devsp);
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
2007-09-10 02:06:23 +08:00
|
|
|
|
|
|
|
sg_count = scsi_dma_map(workreq);
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Write transfer size
|
|
|
|
*/
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x12, ((unsigned char *) (&l))[2]);
|
|
|
|
atp_writeb_io(dev, c, 0x13, ((unsigned char *) (&l))[1]);
|
|
|
|
atp_writeb_io(dev, c, 0x14, ((unsigned char *) (&l))[0]);
|
2021-01-13 17:04:30 +08:00
|
|
|
j = target_id;
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->id[c][j].last_len = l;
|
|
|
|
dev->id[c][j].tran_len = 0;
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
2005-04-17 06:20:36 +08:00
|
|
|
printk("dev->id[%2d][%2d].last_len = %d\n",c,j,dev->id[c][j].last_len);
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
/*
|
|
|
|
* Flip the wide bits
|
|
|
|
*/
|
|
|
|
if ((j & 0x08) != 0) {
|
|
|
|
j = (j & 0x07) | 0x40;
|
|
|
|
}
|
|
|
|
/*
|
|
|
|
* Check transfer direction
|
|
|
|
*/
|
2015-11-18 02:23:54 +08:00
|
|
|
if (workreq->sc_data_direction == DMA_TO_DEVICE)
|
|
|
|
atp_writeb_io(dev, c, 0x15, j | 0x20);
|
|
|
|
else
|
|
|
|
atp_writeb_io(dev, c, 0x15, j);
|
|
|
|
atp_writeb_io(dev, c, 0x16, atp_readb_io(dev, c, 0x16) | 0x80);
|
|
|
|
atp_writeb_io(dev, c, 0x16, 0x80);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->id[c][target_id].dirct = 0;
|
|
|
|
if (l == 0) {
|
2015-11-18 02:23:54 +08:00
|
|
|
if (atp_readb_io(dev, c, 0x1c) == 0) {
|
2005-04-17 06:20:36 +08:00
|
|
|
#ifdef ED_DBGP
|
2021-01-13 17:04:30 +08:00
|
|
|
printk("change SCSI_CMD_REG 0x08\n");
|
|
|
|
#endif
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
|
|
|
} else
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->last_cmd[c] |= 0x40;
|
|
|
|
dev->in_snd[c] = 0;
|
|
|
|
return;
|
|
|
|
}
|
|
|
|
prd = dev->id[c][target_id].prd_table;
|
|
|
|
dev->id[c][target_id].prd_pos = prd;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Now write the request list. Either as scatter/gather or as
|
|
|
|
* a linear chain.
|
|
|
|
*/
|
|
|
|
|
2007-09-10 02:06:23 +08:00
|
|
|
if (l) {
|
|
|
|
struct scatterlist *sgpnt;
|
2005-04-17 06:20:36 +08:00
|
|
|
i = 0;
|
2007-09-10 02:06:23 +08:00
|
|
|
scsi_for_each_sg(workreq, sgpnt, sg_count, j) {
|
|
|
|
bttl = sg_dma_address(sgpnt);
|
|
|
|
l=sg_dma_len(sgpnt);
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
2007-09-10 02:06:23 +08:00
|
|
|
printk("1. bttl %x, l %x\n",bttl, l);
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2007-09-10 02:06:23 +08:00
|
|
|
while (l > 0x10000) {
|
2005-04-17 06:20:36 +08:00
|
|
|
(((u16 *) (prd))[i + 3]) = 0x0000;
|
|
|
|
(((u16 *) (prd))[i + 2]) = 0x0000;
|
|
|
|
(((u32 *) (prd))[i >> 1]) = cpu_to_le32(bttl);
|
|
|
|
l -= 0x10000;
|
|
|
|
bttl += 0x10000;
|
|
|
|
i += 0x04;
|
|
|
|
}
|
|
|
|
(((u32 *) (prd))[i >> 1]) = cpu_to_le32(bttl);
|
|
|
|
(((u16 *) (prd))[i + 2]) = cpu_to_le16(l);
|
|
|
|
(((u16 *) (prd))[i + 3]) = 0;
|
2021-01-13 17:04:30 +08:00
|
|
|
i += 0x04;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2021-01-13 17:04:30 +08:00
|
|
|
(((u16 *) (prd))[i - 1]) = cpu_to_le16(0x8000);
|
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("prd %4x %4x %4x %4x\n",
|
|
|
|
(((unsigned short int *)prd)[0]),
|
|
|
|
(((unsigned short int *)prd)[1]),
|
|
|
|
(((unsigned short int *)prd)[2]),
|
|
|
|
(((unsigned short int *)prd)[3]));
|
2005-04-17 06:20:36 +08:00
|
|
|
printk("2. bttl %x, l %x\n",bttl, l);
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("send_s870: prdaddr_2 0x%8x target_id %d\n",
|
|
|
|
dev->id[c][target_id].prdaddr,target_id);
|
|
|
|
#endif
|
2005-09-15 21:59:36 +08:00
|
|
|
dev->id[c][target_id].prdaddr = dev->id[c][target_id].prd_bus;
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writel_pci(dev, c, 4, dev->id[c][target_id].prdaddr);
|
|
|
|
atp_writeb_pci(dev, c, 2, 0x06);
|
|
|
|
atp_writeb_pci(dev, c, 2, 0x00);
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev)) {
|
2015-11-18 02:23:54 +08:00
|
|
|
j = atp_readb_pci(dev, c, 1) & 0xf3;
|
2021-01-13 17:04:49 +08:00
|
|
|
if ((workreq->cmnd[0] == READ_6) ||
|
|
|
|
(workreq->cmnd[0] == READ_10) ||
|
|
|
|
(workreq->cmnd[0] == WRITE_6) ||
|
|
|
|
(workreq->cmnd[0] == WRITE_10)) {
|
2021-01-13 17:04:30 +08:00
|
|
|
j |= 0x0c;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_pci(dev, c, 1, j);
|
2015-11-18 02:24:21 +08:00
|
|
|
} else if (is880(dev)) {
|
2021-01-13 17:04:49 +08:00
|
|
|
if ((workreq->cmnd[0] == READ_6) ||
|
|
|
|
(workreq->cmnd[0] == READ_10) ||
|
|
|
|
(workreq->cmnd[0] == WRITE_6) ||
|
|
|
|
(workreq->cmnd[0] == WRITE_10))
|
2021-01-13 17:04:30 +08:00
|
|
|
atp_writeb_base(dev, 0x3b,
|
|
|
|
(atp_readb_base(dev, 0x3b) & 0x3f) | 0xc0);
|
2015-11-18 02:23:54 +08:00
|
|
|
else
|
2021-01-13 17:04:30 +08:00
|
|
|
atp_writeb_base(dev, 0x3b,
|
|
|
|
atp_readb_base(dev, 0x3b) & 0x3f);
|
|
|
|
} else {
|
2021-01-13 17:04:49 +08:00
|
|
|
if ((workreq->cmnd[0] == READ_6) ||
|
|
|
|
(workreq->cmnd[0] == READ_10) ||
|
|
|
|
(workreq->cmnd[0] == WRITE_6) ||
|
|
|
|
(workreq->cmnd[0] == WRITE_10))
|
2021-01-13 17:04:30 +08:00
|
|
|
atp_writeb_base(dev, 0x3a,
|
|
|
|
(atp_readb_base(dev, 0x3a) & 0xf3) | 0x08);
|
2015-11-18 02:23:54 +08:00
|
|
|
else
|
2021-01-13 17:04:30 +08:00
|
|
|
atp_writeb_base(dev, 0x3a,
|
|
|
|
atp_readb_base(dev, 0x3a) & 0xf3);
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
if(workreq->sc_data_direction == DMA_TO_DEVICE) {
|
|
|
|
dev->id[c][target_id].dirct = 0x20;
|
2015-11-18 02:23:54 +08:00
|
|
|
if (atp_readb_io(dev, c, 0x1c) == 0) {
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
|
|
|
atp_writeb_pci(dev, c, 0, 0x01);
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
2005-04-17 06:20:36 +08:00
|
|
|
printk( "start DMA(to target)\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
} else {
|
|
|
|
dev->last_cmd[c] |= 0x40;
|
|
|
|
}
|
|
|
|
dev->in_snd[c] = 0;
|
|
|
|
return;
|
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
if (atp_readb_io(dev, c, 0x1c) == 0) {
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
|
|
|
atp_writeb_pci(dev, c, 0, 0x09);
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
2005-04-17 06:20:36 +08:00
|
|
|
printk( "start DMA(to host)\n");
|
2021-01-13 17:04:30 +08:00
|
|
|
#endif
|
2005-04-17 06:20:36 +08:00
|
|
|
} else {
|
|
|
|
dev->last_cmd[c] |= 0x40;
|
|
|
|
}
|
|
|
|
dev->in_snd[c] = 0;
|
|
|
|
return;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
static unsigned char fun_scam(struct atp_unit *dev, unsigned short int *val)
|
|
|
|
{
|
|
|
|
unsigned short int i, k;
|
|
|
|
unsigned char j;
|
|
|
|
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writew_io(dev, 0, 0x1c, *val);
|
2005-04-17 06:20:36 +08:00
|
|
|
for (i = 0; i < 10; i++) { /* stable >= bus settle delay(400 ns) */
|
2015-11-18 02:23:54 +08:00
|
|
|
k = atp_readw_io(dev, 0, 0x1c);
|
2005-04-17 06:20:36 +08:00
|
|
|
j = (unsigned char) (k >> 8);
|
2015-11-18 02:23:51 +08:00
|
|
|
if ((k & 0x8000) != 0) /* DB7 all release? */
|
|
|
|
i = 0;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
*val |= 0x4000; /* assert DB6 */
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writew_io(dev, 0, 0x1c, *val);
|
2005-04-17 06:20:36 +08:00
|
|
|
*val &= 0xdfff; /* assert DB5 */
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writew_io(dev, 0, 0x1c, *val);
|
2005-04-17 06:20:36 +08:00
|
|
|
for (i = 0; i < 10; i++) { /* stable >= bus settle delay(400 ns) */
|
2015-11-18 02:23:54 +08:00
|
|
|
if ((atp_readw_io(dev, 0, 0x1c) & 0x2000) != 0) /* DB5 all release? */
|
2015-11-18 02:23:51 +08:00
|
|
|
i = 0;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
*val |= 0x8000; /* no DB4-0, assert DB7 */
|
|
|
|
*val &= 0xe0ff;
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writew_io(dev, 0, 0x1c, *val);
|
2005-04-17 06:20:36 +08:00
|
|
|
*val &= 0xbfff; /* release DB6 */
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writew_io(dev, 0, 0x1c, *val);
|
2005-04-17 06:20:36 +08:00
|
|
|
for (i = 0; i < 10; i++) { /* stable >= bus settle delay(400 ns) */
|
2015-11-18 02:23:54 +08:00
|
|
|
if ((atp_readw_io(dev, 0, 0x1c) & 0x4000) != 0) /* DB6 all release? */
|
2015-11-18 02:23:51 +08:00
|
|
|
i = 0;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
return j;
|
|
|
|
}
|
|
|
|
|
2015-11-18 02:24:24 +08:00
|
|
|
static void tscam(struct Scsi_Host *host, bool wide_chip, u8 scam_on)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
|
|
|
|
|
|
|
unsigned char i, j, k;
|
|
|
|
unsigned long n;
|
|
|
|
unsigned short int m, assignid_map, val;
|
|
|
|
unsigned char mbuf[33], quintet[2];
|
|
|
|
struct atp_unit *dev = (struct atp_unit *)&host->hostdata;
|
|
|
|
static unsigned char g2q_tab[8] = {
|
|
|
|
0x38, 0x31, 0x32, 0x2b, 0x34, 0x2d, 0x2e, 0x27
|
|
|
|
};
|
|
|
|
|
|
|
|
/* I can't believe we need this before we've even done anything. Remove it
|
|
|
|
* and see if anyone bitches.
|
|
|
|
for (i = 0; i < 0x10; i++) {
|
|
|
|
udelay(0xffff);
|
|
|
|
}
|
|
|
|
*/
|
|
|
|
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, 0, 1, 0x08);
|
|
|
|
atp_writeb_io(dev, 0, 2, 0x7f);
|
|
|
|
atp_writeb_io(dev, 0, 0x11, 0x20);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2015-11-18 02:24:24 +08:00
|
|
|
if ((scam_on & 0x40) == 0) {
|
2005-04-17 06:20:36 +08:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
m = 1;
|
|
|
|
m <<= dev->host_id[0];
|
|
|
|
j = 16;
|
2015-11-18 02:24:19 +08:00
|
|
|
if (!wide_chip) {
|
2005-04-17 06:20:36 +08:00
|
|
|
m |= 0xff00;
|
|
|
|
j = 8;
|
|
|
|
}
|
|
|
|
assignid_map = m;
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, 0, 0x02, 0x02); /* 2*2=4ms,3EH 2/32*3E=3.9ms */
|
|
|
|
atp_writeb_io(dev, 0, 0x03, 0);
|
|
|
|
atp_writeb_io(dev, 0, 0x04, 0);
|
|
|
|
atp_writeb_io(dev, 0, 0x05, 0);
|
|
|
|
atp_writeb_io(dev, 0, 0x06, 0);
|
|
|
|
atp_writeb_io(dev, 0, 0x07, 0);
|
|
|
|
atp_writeb_io(dev, 0, 0x08, 0);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
for (i = 0; i < j; i++) {
|
|
|
|
m = 1;
|
|
|
|
m = m << i;
|
|
|
|
if ((m & assignid_map) != 0) {
|
|
|
|
continue;
|
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, 0, 0x0f, 0);
|
|
|
|
atp_writeb_io(dev, 0, 0x12, 0);
|
|
|
|
atp_writeb_io(dev, 0, 0x13, 0);
|
|
|
|
atp_writeb_io(dev, 0, 0x14, 0);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (i > 7) {
|
|
|
|
k = (i & 0x07) | 0x40;
|
|
|
|
} else {
|
|
|
|
k = i;
|
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, 0, 0x15, k);
|
2015-11-18 02:24:19 +08:00
|
|
|
if (wide_chip)
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, 0, 0x1b, 0x01);
|
|
|
|
else
|
|
|
|
atp_writeb_io(dev, 0, 0x1b, 0x00);
|
2015-11-18 02:23:52 +08:00
|
|
|
do {
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, 0, 0x18, 0x09);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2015-11-18 02:23:54 +08:00
|
|
|
while ((atp_readb_io(dev, 0, 0x1f) & 0x80) == 0x00)
|
2015-11-18 02:23:52 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:54 +08:00
|
|
|
k = atp_readb_io(dev, 0, 0x17);
|
2015-11-18 02:23:52 +08:00
|
|
|
if ((k == 0x85) || (k == 0x42))
|
|
|
|
break;
|
|
|
|
if (k != 0x16)
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, 0, 0x10, 0x41);
|
2015-11-18 02:23:52 +08:00
|
|
|
} while (k != 0x16);
|
|
|
|
if ((k == 0x85) || (k == 0x42))
|
|
|
|
continue;
|
2005-04-17 06:20:36 +08:00
|
|
|
assignid_map |= m;
|
|
|
|
|
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writeb_io(dev, 0, 0x02, 0x7f);
|
|
|
|
atp_writeb_io(dev, 0, 0x1b, 0x02);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2015-11-18 02:24:08 +08:00
|
|
|
udelay(2);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
val = 0x0080; /* bsy */
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writew_io(dev, 0, 0x1c, val);
|
2005-04-17 06:20:36 +08:00
|
|
|
val |= 0x0040; /* sel */
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writew_io(dev, 0, 0x1c, val);
|
2005-04-17 06:20:36 +08:00
|
|
|
val |= 0x0004; /* msg */
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writew_io(dev, 0, 0x1c, val);
|
2015-11-18 02:24:08 +08:00
|
|
|
udelay(2); /* 2 deskew delay(45ns*2=90ns) */
|
2005-04-17 06:20:36 +08:00
|
|
|
val &= 0x007f; /* no bsy */
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writew_io(dev, 0, 0x1c, val);
|
2018-07-27 17:13:17 +08:00
|
|
|
msleep(128);
|
2005-04-17 06:20:36 +08:00
|
|
|
val &= 0x00fb; /* after 1ms no msg */
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writew_io(dev, 0, 0x1c, val);
|
|
|
|
while ((atp_readb_io(dev, 0, 0x1c) & 0x04) != 0)
|
2015-11-18 02:23:52 +08:00
|
|
|
;
|
2015-11-18 02:24:08 +08:00
|
|
|
udelay(2);
|
2005-04-17 06:20:36 +08:00
|
|
|
udelay(100);
|
2015-11-18 02:23:53 +08:00
|
|
|
for (n = 0; n < 0x30000; n++)
|
2015-11-18 02:23:54 +08:00
|
|
|
if ((atp_readb_io(dev, 0, 0x1c) & 0x80) != 0) /* bsy ? */
|
2015-11-18 02:23:53 +08:00
|
|
|
break;
|
|
|
|
if (n < 0x30000)
|
|
|
|
for (n = 0; n < 0x30000; n++)
|
2015-11-18 02:23:54 +08:00
|
|
|
if ((atp_readb_io(dev, 0, 0x1c) & 0x81) == 0x0081) {
|
2015-11-18 02:24:08 +08:00
|
|
|
udelay(2);
|
2015-11-18 02:23:53 +08:00
|
|
|
val |= 0x8003; /* io,cd,db7 */
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writew_io(dev, 0, 0x1c, val);
|
2015-11-18 02:24:08 +08:00
|
|
|
udelay(2);
|
2015-11-18 02:23:53 +08:00
|
|
|
val &= 0x00bf; /* no sel */
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_writew_io(dev, 0, 0x1c, val);
|
2015-11-18 02:24:08 +08:00
|
|
|
udelay(2);
|
2015-11-18 02:23:53 +08:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
while (1) {
|
2012-10-05 08:11:25 +08:00
|
|
|
/*
|
|
|
|
* The funny division into multiple delays is to accomodate
|
|
|
|
* arches like ARM where udelay() multiplies its argument by
|
|
|
|
* a large number to initialize a loop counter. To avoid
|
|
|
|
* overflow, the maximum supported udelay is 2000 microseconds.
|
|
|
|
*
|
|
|
|
* XXX it would be more polite to find a way to use msleep()
|
|
|
|
*/
|
|
|
|
mdelay(2);
|
|
|
|
udelay(48);
|
2015-11-18 02:23:54 +08:00
|
|
|
if ((atp_readb_io(dev, 0, 0x1c) & 0x80) == 0x00) { /* bsy ? */
|
|
|
|
atp_writew_io(dev, 0, 0x1c, 0);
|
|
|
|
atp_writeb_io(dev, 0, 0x1b, 0);
|
|
|
|
atp_writeb_io(dev, 0, 0x15, 0);
|
|
|
|
atp_writeb_io(dev, 0, 0x18, 0x09);
|
|
|
|
while ((atp_readb_io(dev, 0, 0x1f) & 0x80) == 0)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:54 +08:00
|
|
|
atp_readb_io(dev, 0, 0x17);
|
2005-04-17 06:20:36 +08:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
val &= 0x00ff; /* synchronization */
|
|
|
|
val |= 0x3f00;
|
|
|
|
fun_scam(dev, &val);
|
2015-11-18 02:24:08 +08:00
|
|
|
udelay(2);
|
2005-04-17 06:20:36 +08:00
|
|
|
val &= 0x00ff; /* isolation */
|
|
|
|
val |= 0x2000;
|
|
|
|
fun_scam(dev, &val);
|
2015-11-18 02:24:08 +08:00
|
|
|
udelay(2);
|
2005-04-17 06:20:36 +08:00
|
|
|
i = 8;
|
|
|
|
j = 0;
|
2015-11-18 02:23:53 +08:00
|
|
|
|
|
|
|
while (1) {
|
2015-11-18 02:23:54 +08:00
|
|
|
if ((atp_readw_io(dev, 0, 0x1c) & 0x2000) == 0)
|
2015-11-18 02:23:53 +08:00
|
|
|
continue;
|
2015-11-18 02:24:08 +08:00
|
|
|
udelay(2);
|
2015-11-18 02:23:53 +08:00
|
|
|
val &= 0x00ff; /* get ID_STRING */
|
|
|
|
val |= 0x2000;
|
|
|
|
k = fun_scam(dev, &val);
|
|
|
|
if ((k & 0x03) == 0)
|
|
|
|
break;
|
|
|
|
mbuf[j] <<= 0x01;
|
|
|
|
mbuf[j] &= 0xfe;
|
|
|
|
if ((k & 0x02) != 0)
|
|
|
|
mbuf[j] |= 0x01;
|
|
|
|
i--;
|
|
|
|
if (i > 0)
|
|
|
|
continue;
|
|
|
|
j++;
|
|
|
|
i = 8;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2015-11-18 02:23:53 +08:00
|
|
|
/* isolation complete.. */
|
2005-04-17 06:20:36 +08:00
|
|
|
/* mbuf[32]=0;
|
|
|
|
printk(" \n%x %x %x %s\n ",assignid_map,mbuf[0],mbuf[1],&mbuf[2]); */
|
|
|
|
i = 15;
|
|
|
|
j = mbuf[0];
|
2011-03-31 09:57:33 +08:00
|
|
|
if ((j & 0x20) != 0) { /* bit5=1:ID up to 7 */
|
2005-04-17 06:20:36 +08:00
|
|
|
i = 7;
|
|
|
|
}
|
2015-11-18 02:23:53 +08:00
|
|
|
if ((j & 0x06) != 0) { /* IDvalid? */
|
|
|
|
k = mbuf[1];
|
|
|
|
while (1) {
|
|
|
|
m = 1;
|
|
|
|
m <<= k;
|
|
|
|
if ((m & assignid_map) == 0)
|
|
|
|
break;
|
|
|
|
if (k > 0)
|
|
|
|
k--;
|
|
|
|
else
|
|
|
|
break;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2015-11-18 02:23:53 +08:00
|
|
|
if ((m & assignid_map) != 0) { /* srch from max acceptable ID# */
|
|
|
|
k = i; /* max acceptable ID# */
|
|
|
|
while (1) {
|
|
|
|
m = 1;
|
|
|
|
m <<= k;
|
|
|
|
if ((m & assignid_map) == 0)
|
|
|
|
break;
|
|
|
|
if (k > 0)
|
|
|
|
k--;
|
|
|
|
else
|
|
|
|
break;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2015-11-18 02:23:53 +08:00
|
|
|
/* k=binID#, */
|
2005-04-17 06:20:36 +08:00
|
|
|
assignid_map |= m;
|
|
|
|
if (k < 8) {
|
|
|
|
quintet[0] = 0x38; /* 1st dft ID<8 */
|
|
|
|
} else {
|
|
|
|
quintet[0] = 0x31; /* 1st ID>=8 */
|
|
|
|
}
|
|
|
|
k &= 0x07;
|
|
|
|
quintet[1] = g2q_tab[k];
|
|
|
|
|
|
|
|
val &= 0x00ff; /* AssignID 1stQuintet,AH=001xxxxx */
|
|
|
|
m = quintet[0] << 8;
|
|
|
|
val |= m;
|
|
|
|
fun_scam(dev, &val);
|
|
|
|
val &= 0x00ff; /* AssignID 2ndQuintet,AH=001xxxxx */
|
|
|
|
m = quintet[1] << 8;
|
|
|
|
val |= m;
|
|
|
|
fun_scam(dev, &val);
|
|
|
|
|
2015-11-18 02:23:53 +08:00
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
static void atp870u_free_tables(struct Scsi_Host *host)
|
|
|
|
{
|
|
|
|
struct atp_unit *atp_dev = (struct atp_unit *)&host->hostdata;
|
|
|
|
int j, k;
|
|
|
|
for (j=0; j < 2; j++) {
|
|
|
|
for (k = 0; k < 16; k++) {
|
|
|
|
if (!atp_dev->id[j][k].prd_table)
|
|
|
|
continue;
|
2021-01-13 17:04:30 +08:00
|
|
|
dma_free_coherent(&atp_dev->pdev->dev, 1024,
|
|
|
|
atp_dev->id[j][k].prd_table,
|
|
|
|
atp_dev->id[j][k].prd_bus);
|
2005-04-17 06:20:36 +08:00
|
|
|
atp_dev->id[j][k].prd_table = NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
static int atp870u_init_tables(struct Scsi_Host *host)
|
|
|
|
{
|
|
|
|
struct atp_unit *atp_dev = (struct atp_unit *)&host->hostdata;
|
|
|
|
int c,k;
|
|
|
|
for(c=0;c < 2;c++) {
|
2021-01-13 17:04:30 +08:00
|
|
|
for(k=0;k<16;k++) {
|
|
|
|
atp_dev->id[c][k].prd_table =
|
|
|
|
dma_alloc_coherent(&atp_dev->pdev->dev, 1024,
|
|
|
|
&(atp_dev->id[c][k].prd_bus),
|
|
|
|
GFP_KERNEL);
|
|
|
|
if (!atp_dev->id[c][k].prd_table) {
|
|
|
|
printk("atp870u_init_tables fail\n");
|
2005-04-17 06:20:36 +08:00
|
|
|
atp870u_free_tables(host);
|
|
|
|
return -ENOMEM;
|
|
|
|
}
|
2005-09-15 21:59:36 +08:00
|
|
|
atp_dev->id[c][k].prdaddr = atp_dev->id[c][k].prd_bus;
|
2005-04-17 06:20:36 +08:00
|
|
|
atp_dev->id[c][k].devsp=0x20;
|
|
|
|
atp_dev->id[c][k].devtype = 0x7f;
|
2021-01-13 17:04:30 +08:00
|
|
|
atp_dev->id[c][k].curr_req = NULL;
|
|
|
|
}
|
|
|
|
|
|
|
|
atp_dev->active_id[c] = 0;
|
|
|
|
atp_dev->wide_id[c] = 0;
|
|
|
|
atp_dev->host_id[c] = 0x07;
|
|
|
|
atp_dev->quhd[c] = 0;
|
|
|
|
atp_dev->quend[c] = 0;
|
|
|
|
atp_dev->last_cmd[c] = 0xff;
|
|
|
|
atp_dev->in_snd[c] = 0;
|
|
|
|
atp_dev->in_int[c] = 0;
|
|
|
|
|
|
|
|
for (k = 0; k < qcnt; k++) {
|
|
|
|
atp_dev->quereq[c][k] = NULL;
|
|
|
|
}
|
|
|
|
for (k = 0; k < 16; k++) {
|
2005-04-17 06:20:36 +08:00
|
|
|
atp_dev->id[c][k].curr_req = NULL;
|
|
|
|
atp_dev->sp[c][k] = 0x04;
|
2021-01-13 17:04:30 +08:00
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2015-11-18 02:24:10 +08:00
|
|
|
static void atp_set_host_id(struct atp_unit *atp, u8 c, u8 host_id)
|
|
|
|
{
|
|
|
|
atp_writeb_io(atp, c, 0, host_id | 0x08);
|
|
|
|
atp_writeb_io(atp, c, 0x18, 0);
|
|
|
|
while ((atp_readb_io(atp, c, 0x1f) & 0x80) == 0)
|
|
|
|
mdelay(1);
|
|
|
|
atp_readb_io(atp, c, 0x17);
|
|
|
|
atp_writeb_io(atp, c, 1, 8);
|
|
|
|
atp_writeb_io(atp, c, 2, 0x7f);
|
|
|
|
atp_writeb_io(atp, c, 0x11, 0x20);
|
|
|
|
}
|
|
|
|
|
2015-11-18 02:24:28 +08:00
|
|
|
static void atp870_init(struct Scsi_Host *shpnt)
|
|
|
|
{
|
|
|
|
struct atp_unit *atpdev = shost_priv(shpnt);
|
|
|
|
struct pci_dev *pdev = atpdev->pdev;
|
|
|
|
unsigned char k, host_id;
|
|
|
|
u8 scam_on;
|
|
|
|
bool wide_chip =
|
|
|
|
(pdev->device == PCI_DEVICE_ID_ARTOP_AEC7610 &&
|
|
|
|
pdev->revision == 4) ||
|
|
|
|
(pdev->device == PCI_DEVICE_ID_ARTOP_AEC7612UW) ||
|
|
|
|
(pdev->device == PCI_DEVICE_ID_ARTOP_AEC7612SUW);
|
|
|
|
|
|
|
|
pci_read_config_byte(pdev, 0x49, &host_id);
|
|
|
|
|
2021-01-13 17:04:30 +08:00
|
|
|
dev_info(&pdev->dev, "ACARD AEC-671X PCI Ultra/W SCSI-2/3 "
|
|
|
|
"Host Adapter: IO:%lx, IRQ:%d.\n",
|
2015-11-18 02:24:28 +08:00
|
|
|
shpnt->io_port, shpnt->irq);
|
|
|
|
|
|
|
|
atpdev->ioport[0] = shpnt->io_port;
|
|
|
|
atpdev->pciport[0] = shpnt->io_port + 0x20;
|
|
|
|
host_id &= 0x07;
|
|
|
|
atpdev->host_id[0] = host_id;
|
|
|
|
scam_on = atp_readb_pci(atpdev, 0, 2);
|
|
|
|
atpdev->global_map[0] = atp_readb_base(atpdev, 0x2d);
|
|
|
|
atpdev->ultra_map[0] = atp_readw_base(atpdev, 0x2e);
|
|
|
|
|
|
|
|
if (atpdev->ultra_map[0] == 0) {
|
|
|
|
scam_on = 0x00;
|
|
|
|
atpdev->global_map[0] = 0x20;
|
|
|
|
atpdev->ultra_map[0] = 0xffff;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (pdev->revision > 0x07) /* check if atp876 chip */
|
|
|
|
atp_writeb_base(atpdev, 0x3e, 0x00); /* enable terminator */
|
|
|
|
|
|
|
|
k = (atp_readb_base(atpdev, 0x3a) & 0xf3) | 0x10;
|
|
|
|
atp_writeb_base(atpdev, 0x3a, k);
|
|
|
|
atp_writeb_base(atpdev, 0x3a, k & 0xdf);
|
2018-07-27 17:13:17 +08:00
|
|
|
msleep(32);
|
2015-11-18 02:24:28 +08:00
|
|
|
atp_writeb_base(atpdev, 0x3a, k);
|
2018-07-27 17:13:17 +08:00
|
|
|
msleep(32);
|
2015-11-18 02:24:28 +08:00
|
|
|
atp_set_host_id(atpdev, 0, host_id);
|
|
|
|
|
|
|
|
tscam(shpnt, wide_chip, scam_on);
|
|
|
|
atp_writeb_base(atpdev, 0x3a, atp_readb_base(atpdev, 0x3a) | 0x10);
|
|
|
|
atp_is(atpdev, 0, wide_chip, 0);
|
|
|
|
atp_writeb_base(atpdev, 0x3a, atp_readb_base(atpdev, 0x3a) & 0xef);
|
|
|
|
atp_writeb_base(atpdev, 0x3b, atp_readb_base(atpdev, 0x3b) | 0x20);
|
|
|
|
shpnt->max_id = wide_chip ? 16 : 8;
|
|
|
|
shpnt->this_id = host_id;
|
|
|
|
}
|
|
|
|
|
2015-11-18 02:24:26 +08:00
|
|
|
static void atp880_init(struct Scsi_Host *shpnt)
|
|
|
|
{
|
|
|
|
struct atp_unit *atpdev = shost_priv(shpnt);
|
|
|
|
struct pci_dev *pdev = atpdev->pdev;
|
|
|
|
unsigned char k, m, host_id;
|
|
|
|
unsigned int n;
|
|
|
|
|
|
|
|
pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 0x80);
|
|
|
|
|
|
|
|
atpdev->ioport[0] = shpnt->io_port + 0x40;
|
|
|
|
atpdev->pciport[0] = shpnt->io_port + 0x28;
|
|
|
|
|
|
|
|
host_id = atp_readb_base(atpdev, 0x39) >> 4;
|
|
|
|
|
2021-01-13 17:04:30 +08:00
|
|
|
dev_info(&pdev->dev, "ACARD AEC-67160 PCI Ultra3 LVD "
|
|
|
|
"Host Adapter: IO:%lx, IRQ:%d.\n",
|
2015-11-18 02:24:26 +08:00
|
|
|
shpnt->io_port, shpnt->irq);
|
|
|
|
atpdev->host_id[0] = host_id;
|
|
|
|
|
|
|
|
atpdev->global_map[0] = atp_readb_base(atpdev, 0x35);
|
|
|
|
atpdev->ultra_map[0] = atp_readw_base(atpdev, 0x3c);
|
|
|
|
|
|
|
|
n = 0x3f09;
|
|
|
|
while (n < 0x4000) {
|
|
|
|
m = 0;
|
|
|
|
atp_writew_base(atpdev, 0x34, n);
|
|
|
|
n += 0x0002;
|
|
|
|
if (atp_readb_base(atpdev, 0x30) == 0xff)
|
|
|
|
break;
|
|
|
|
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x30);
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x31);
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x32);
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x33);
|
|
|
|
atp_writew_base(atpdev, 0x34, n);
|
|
|
|
n += 0x0002;
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x30);
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x31);
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x32);
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x33);
|
|
|
|
atp_writew_base(atpdev, 0x34, n);
|
|
|
|
n += 0x0002;
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x30);
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x31);
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x32);
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x33);
|
|
|
|
atp_writew_base(atpdev, 0x34, n);
|
|
|
|
n += 0x0002;
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x30);
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x31);
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x32);
|
|
|
|
atpdev->sp[0][m++] = atp_readb_base(atpdev, 0x33);
|
|
|
|
n += 0x0018;
|
|
|
|
}
|
|
|
|
atp_writew_base(atpdev, 0x34, 0);
|
|
|
|
atpdev->ultra_map[0] = 0;
|
|
|
|
atpdev->async[0] = 0;
|
|
|
|
for (k = 0; k < 16; k++) {
|
|
|
|
n = 1 << k;
|
|
|
|
if (atpdev->sp[0][k] > 1)
|
|
|
|
atpdev->ultra_map[0] |= n;
|
|
|
|
else
|
|
|
|
if (atpdev->sp[0][k] == 0)
|
|
|
|
atpdev->async[0] |= n;
|
|
|
|
}
|
|
|
|
atpdev->async[0] = ~(atpdev->async[0]);
|
|
|
|
atp_writeb_base(atpdev, 0x35, atpdev->global_map[0]);
|
|
|
|
|
|
|
|
k = atp_readb_base(atpdev, 0x38) & 0x80;
|
|
|
|
atp_writeb_base(atpdev, 0x38, k);
|
|
|
|
atp_writeb_base(atpdev, 0x3b, 0x20);
|
2018-07-27 17:13:17 +08:00
|
|
|
msleep(32);
|
2015-11-18 02:24:26 +08:00
|
|
|
atp_writeb_base(atpdev, 0x3b, 0);
|
2018-07-27 17:13:17 +08:00
|
|
|
msleep(32);
|
2015-11-18 02:24:26 +08:00
|
|
|
atp_readb_io(atpdev, 0, 0x1b);
|
|
|
|
atp_readb_io(atpdev, 0, 0x17);
|
|
|
|
|
|
|
|
atp_set_host_id(atpdev, 0, host_id);
|
|
|
|
|
|
|
|
tscam(shpnt, true, atp_readb_base(atpdev, 0x22));
|
|
|
|
atp_is(atpdev, 0, true, atp_readb_base(atpdev, 0x3f) & 0x40);
|
|
|
|
atp_writeb_base(atpdev, 0x38, 0xb0);
|
|
|
|
shpnt->max_id = 16;
|
|
|
|
shpnt->this_id = host_id;
|
|
|
|
}
|
|
|
|
|
2015-11-18 02:24:27 +08:00
|
|
|
static void atp885_init(struct Scsi_Host *shpnt)
|
|
|
|
{
|
|
|
|
struct atp_unit *atpdev = shost_priv(shpnt);
|
|
|
|
struct pci_dev *pdev = atpdev->pdev;
|
|
|
|
unsigned char k, m, c;
|
|
|
|
unsigned int n;
|
|
|
|
unsigned char setupdata[2][16];
|
|
|
|
|
2021-01-13 17:04:30 +08:00
|
|
|
dev_info(&pdev->dev, "ACARD AEC-67162 PCI Ultra3 LVD "
|
|
|
|
"Host Adapter: IO:%lx, IRQ:%d.\n",
|
2015-11-18 02:24:27 +08:00
|
|
|
shpnt->io_port, shpnt->irq);
|
|
|
|
|
|
|
|
atpdev->ioport[0] = shpnt->io_port + 0x80;
|
|
|
|
atpdev->ioport[1] = shpnt->io_port + 0xc0;
|
|
|
|
atpdev->pciport[0] = shpnt->io_port + 0x40;
|
|
|
|
atpdev->pciport[1] = shpnt->io_port + 0x50;
|
|
|
|
|
|
|
|
c = atp_readb_base(atpdev, 0x29);
|
|
|
|
atp_writeb_base(atpdev, 0x29, c | 0x04);
|
|
|
|
|
|
|
|
n = 0x1f80;
|
|
|
|
while (n < 0x2000) {
|
|
|
|
atp_writew_base(atpdev, 0x3c, n);
|
|
|
|
if (atp_readl_base(atpdev, 0x38) == 0xffffffff)
|
|
|
|
break;
|
|
|
|
for (m = 0; m < 2; m++) {
|
|
|
|
atpdev->global_map[m] = 0;
|
|
|
|
for (k = 0; k < 4; k++) {
|
|
|
|
atp_writew_base(atpdev, 0x3c, n++);
|
2021-01-13 17:04:30 +08:00
|
|
|
((u32 *)&setupdata[m][0])[k] =
|
|
|
|
atp_readl_base(atpdev, 0x38);
|
2015-11-18 02:24:27 +08:00
|
|
|
}
|
|
|
|
for (k = 0; k < 4; k++) {
|
|
|
|
atp_writew_base(atpdev, 0x3c, n++);
|
2021-01-13 17:04:30 +08:00
|
|
|
((u32 *)&atpdev->sp[m][0])[k] =
|
|
|
|
atp_readl_base(atpdev, 0x38);
|
2015-11-18 02:24:27 +08:00
|
|
|
}
|
|
|
|
n += 8;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
c = atp_readb_base(atpdev, 0x29);
|
|
|
|
atp_writeb_base(atpdev, 0x29, c & 0xfb);
|
|
|
|
for (c = 0; c < 2; c++) {
|
|
|
|
atpdev->ultra_map[c] = 0;
|
|
|
|
atpdev->async[c] = 0;
|
|
|
|
for (k = 0; k < 16; k++) {
|
|
|
|
n = 1 << k;
|
|
|
|
if (atpdev->sp[c][k] > 1)
|
|
|
|
atpdev->ultra_map[c] |= n;
|
|
|
|
else
|
|
|
|
if (atpdev->sp[c][k] == 0)
|
|
|
|
atpdev->async[c] |= n;
|
|
|
|
}
|
|
|
|
atpdev->async[c] = ~(atpdev->async[c]);
|
|
|
|
|
|
|
|
if (atpdev->global_map[c] == 0) {
|
|
|
|
k = setupdata[c][1];
|
|
|
|
if ((k & 0x40) != 0)
|
|
|
|
atpdev->global_map[c] |= 0x20;
|
|
|
|
k &= 0x07;
|
|
|
|
atpdev->global_map[c] |= k;
|
|
|
|
if ((setupdata[c][2] & 0x04) != 0)
|
|
|
|
atpdev->global_map[c] |= 0x08;
|
|
|
|
atpdev->host_id[c] = setupdata[c][0] & 0x07;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
k = atp_readb_base(atpdev, 0x28) & 0x8f;
|
|
|
|
k |= 0x10;
|
|
|
|
atp_writeb_base(atpdev, 0x28, k);
|
|
|
|
atp_writeb_pci(atpdev, 0, 1, 0x80);
|
|
|
|
atp_writeb_pci(atpdev, 1, 1, 0x80);
|
2018-07-27 17:13:17 +08:00
|
|
|
msleep(100);
|
2015-11-18 02:24:27 +08:00
|
|
|
atp_writeb_pci(atpdev, 0, 1, 0);
|
|
|
|
atp_writeb_pci(atpdev, 1, 1, 0);
|
2018-07-27 17:13:17 +08:00
|
|
|
msleep(1000);
|
2015-11-18 02:24:27 +08:00
|
|
|
atp_readb_io(atpdev, 0, 0x1b);
|
|
|
|
atp_readb_io(atpdev, 0, 0x17);
|
|
|
|
atp_readb_io(atpdev, 1, 0x1b);
|
|
|
|
atp_readb_io(atpdev, 1, 0x17);
|
|
|
|
|
|
|
|
k = atpdev->host_id[0];
|
|
|
|
if (k > 7)
|
|
|
|
k = (k & 0x07) | 0x40;
|
|
|
|
atp_set_host_id(atpdev, 0, k);
|
|
|
|
|
|
|
|
k = atpdev->host_id[1];
|
|
|
|
if (k > 7)
|
|
|
|
k = (k & 0x07) | 0x40;
|
|
|
|
atp_set_host_id(atpdev, 1, k);
|
|
|
|
|
2018-07-27 17:13:17 +08:00
|
|
|
msleep(600); /* this delay used to be called tscam_885() */
|
2015-11-18 02:24:27 +08:00
|
|
|
dev_info(&pdev->dev, "Scanning Channel A SCSI Device ...\n");
|
|
|
|
atp_is(atpdev, 0, true, atp_readb_io(atpdev, 0, 0x1b) >> 7);
|
|
|
|
atp_writeb_io(atpdev, 0, 0x16, 0x80);
|
|
|
|
dev_info(&pdev->dev, "Scanning Channel B SCSI Device ...\n");
|
|
|
|
atp_is(atpdev, 1, true, atp_readb_io(atpdev, 1, 0x1b) >> 7);
|
|
|
|
atp_writeb_io(atpdev, 1, 0x16, 0x80);
|
|
|
|
k = atp_readb_base(atpdev, 0x28) & 0xcf;
|
|
|
|
k |= 0xc0;
|
|
|
|
atp_writeb_base(atpdev, 0x28, k);
|
|
|
|
k = atp_readb_base(atpdev, 0x1f) | 0x80;
|
|
|
|
atp_writeb_base(atpdev, 0x1f, k);
|
|
|
|
k = atp_readb_base(atpdev, 0x29) | 0x01;
|
|
|
|
atp_writeb_base(atpdev, 0x29, k);
|
|
|
|
shpnt->max_id = 16;
|
|
|
|
shpnt->max_lun = (atpdev->global_map[0] & 0x07) + 1;
|
|
|
|
shpnt->max_channel = 1;
|
|
|
|
shpnt->this_id = atpdev->host_id[0];
|
|
|
|
}
|
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
/* return non-zero on detection */
|
|
|
|
static int atp870u_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
|
|
|
|
{
|
|
|
|
struct Scsi_Host *shpnt = NULL;
|
2015-11-18 02:24:17 +08:00
|
|
|
struct atp_unit *atpdev;
|
|
|
|
int err;
|
2006-06-28 13:01:28 +08:00
|
|
|
|
2015-11-18 02:24:18 +08:00
|
|
|
if (ent->device == PCI_DEVICE_ID_ARTOP_AEC7610 && pdev->revision < 2) {
|
|
|
|
dev_err(&pdev->dev, "ATP850S chips (AEC6710L/F cards) are not supported.\n");
|
|
|
|
return -ENODEV;
|
|
|
|
}
|
|
|
|
|
2015-11-18 02:24:17 +08:00
|
|
|
err = pci_enable_device(pdev);
|
|
|
|
if (err)
|
|
|
|
goto fail;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2018-10-11 00:14:14 +08:00
|
|
|
if (dma_set_mask(&pdev->dev, DMA_BIT_MASK(32))) {
|
2021-01-13 17:04:30 +08:00
|
|
|
printk(KERN_ERR "atp870u: DMA mask required but not available.\n");
|
|
|
|
err = -EIO;
|
|
|
|
goto disable_device;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2015-11-18 02:24:22 +08:00
|
|
|
err = pci_request_regions(pdev, "atp870u");
|
|
|
|
if (err)
|
|
|
|
goto disable_device;
|
|
|
|
pci_set_master(pdev);
|
|
|
|
|
2021-01-13 17:04:30 +08:00
|
|
|
err = -ENOMEM;
|
2015-11-18 02:24:17 +08:00
|
|
|
shpnt = scsi_host_alloc(&atp870u_template, sizeof(struct atp_unit));
|
|
|
|
if (!shpnt)
|
2015-11-18 02:24:22 +08:00
|
|
|
goto release_region;
|
2015-11-18 02:24:17 +08:00
|
|
|
|
|
|
|
atpdev = shost_priv(shpnt);
|
|
|
|
|
|
|
|
atpdev->host = shpnt;
|
|
|
|
atpdev->pdev = pdev;
|
|
|
|
pci_set_drvdata(pdev, atpdev);
|
|
|
|
|
2015-11-18 02:24:20 +08:00
|
|
|
shpnt->io_port = pci_resource_start(pdev, 0);
|
|
|
|
shpnt->io_port &= 0xfffffff8;
|
|
|
|
shpnt->n_io_port = pci_resource_len(pdev, 0);
|
|
|
|
atpdev->baseport = shpnt->io_port;
|
|
|
|
shpnt->unique_id = shpnt->io_port;
|
|
|
|
shpnt->irq = pdev->irq;
|
2006-06-28 13:01:28 +08:00
|
|
|
|
2015-11-18 02:24:25 +08:00
|
|
|
err = atp870u_init_tables(shpnt);
|
|
|
|
if (err) {
|
|
|
|
dev_err(&pdev->dev, "Unable to allocate tables for Acard controller\n");
|
|
|
|
goto unregister;
|
|
|
|
}
|
|
|
|
|
2015-11-18 02:24:26 +08:00
|
|
|
if (is880(atpdev))
|
|
|
|
atp880_init(shpnt);
|
2015-11-18 02:24:27 +08:00
|
|
|
else if (is885(atpdev))
|
|
|
|
atp885_init(shpnt);
|
2015-11-18 02:24:28 +08:00
|
|
|
else
|
|
|
|
atp870_init(shpnt);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2015-11-18 02:24:23 +08:00
|
|
|
err = request_irq(shpnt->irq, atp870u_intr_handle, IRQF_SHARED, "atp870u", shpnt);
|
|
|
|
if (err) {
|
|
|
|
dev_err(&pdev->dev, "Unable to allocate IRQ %d.\n", shpnt->irq);
|
|
|
|
goto free_tables;
|
|
|
|
}
|
|
|
|
|
|
|
|
err = scsi_add_host(shpnt, &pdev->dev);
|
|
|
|
if (err)
|
|
|
|
goto scsi_add_fail;
|
|
|
|
scsi_scan_host(shpnt);
|
|
|
|
|
|
|
|
return 0;
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
scsi_add_fail:
|
2015-11-18 02:24:20 +08:00
|
|
|
free_irq(shpnt->irq, shpnt);
|
2005-04-17 06:20:36 +08:00
|
|
|
free_tables:
|
|
|
|
atp870u_free_tables(shpnt);
|
|
|
|
unregister:
|
|
|
|
scsi_host_put(shpnt);
|
2015-11-18 02:24:22 +08:00
|
|
|
release_region:
|
|
|
|
pci_release_regions(pdev);
|
2015-11-18 02:24:17 +08:00
|
|
|
disable_device:
|
|
|
|
pci_disable_device(pdev);
|
|
|
|
fail:
|
|
|
|
return err;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
/* The abort command does not leave the device in a clean state where
|
|
|
|
it is available to be used again. Until this gets worked out, we will
|
|
|
|
leave it commented out. */
|
|
|
|
|
|
|
|
static int atp870u_abort(struct scsi_cmnd * SCpnt)
|
|
|
|
{
|
|
|
|
unsigned char j, k, c;
|
|
|
|
struct scsi_cmnd *workrequ;
|
2021-01-13 17:04:30 +08:00
|
|
|
struct atp_unit *dev;
|
2005-04-17 06:20:36 +08:00
|
|
|
struct Scsi_Host *host;
|
|
|
|
host = SCpnt->device->host;
|
|
|
|
|
|
|
|
dev = (struct atp_unit *)&host->hostdata;
|
2005-10-25 06:05:09 +08:00
|
|
|
c = scmd_channel(SCpnt);
|
2005-04-17 06:20:36 +08:00
|
|
|
printk(" atp870u: abort Channel = %x \n", c);
|
|
|
|
printk("working=%x last_cmd=%x ", dev->working[c], dev->last_cmd[c]);
|
|
|
|
printk(" quhdu=%x quendu=%x ", dev->quhd[c], dev->quend[c]);
|
|
|
|
for (j = 0; j < 0x18; j++) {
|
2015-11-18 02:23:54 +08:00
|
|
|
printk(" r%2x=%2x", j, atp_readb_io(dev, c, j));
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2015-11-18 02:23:54 +08:00
|
|
|
printk(" r1c=%2x", atp_readb_io(dev, c, 0x1c));
|
|
|
|
printk(" r1f=%2x in_snd=%2x ", atp_readb_io(dev, c, 0x1f), dev->in_snd[c]);
|
|
|
|
printk(" d00=%2x", atp_readb_pci(dev, c, 0x00));
|
|
|
|
printk(" d02=%2x", atp_readb_pci(dev, c, 0x02));
|
2005-04-17 06:20:36 +08:00
|
|
|
for(j=0;j<16;j++) {
|
|
|
|
if (dev->id[c][j].curr_req != NULL) {
|
|
|
|
workrequ = dev->id[c][j].curr_req;
|
|
|
|
printk("\n que cdb= ");
|
|
|
|
for (k=0; k < workrequ->cmd_len; k++) {
|
|
|
|
printk(" %2x ",workrequ->cmnd[k]);
|
|
|
|
}
|
|
|
|
printk(" last_lenu= %x ",(unsigned int)dev->id[c][j].last_len);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
return SUCCESS;
|
|
|
|
}
|
|
|
|
|
|
|
|
static const char *atp870u_info(struct Scsi_Host *notused)
|
|
|
|
{
|
|
|
|
static char buffer[128];
|
|
|
|
|
|
|
|
strcpy(buffer, "ACARD AEC-6710/6712/67160 PCI Ultra/W/LVD SCSI-3 Adapter Driver V2.6+ac ");
|
|
|
|
|
|
|
|
return buffer;
|
|
|
|
}
|
|
|
|
|
2013-03-31 15:26:26 +08:00
|
|
|
static int atp870u_show_info(struct seq_file *m, struct Scsi_Host *HBAptr)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2014-12-03 07:10:53 +08:00
|
|
|
seq_puts(m, "ACARD AEC-671X Driver Version: 2.6+ac\n\n"
|
|
|
|
"Adapter Configuration:\n");
|
2013-03-31 15:26:26 +08:00
|
|
|
seq_printf(m, " Base IO: %#.4lx\n", HBAptr->io_port);
|
|
|
|
seq_printf(m, " IRQ: %d\n", HBAptr->irq);
|
|
|
|
return 0;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static int atp870u_biosparam(struct scsi_device *disk, struct block_device *dev,
|
|
|
|
sector_t capacity, int *ip)
|
|
|
|
{
|
|
|
|
int heads, sectors, cylinders;
|
|
|
|
|
|
|
|
heads = 64;
|
|
|
|
sectors = 32;
|
|
|
|
cylinders = (unsigned long)capacity / (heads * sectors);
|
|
|
|
if (cylinders > 1024) {
|
|
|
|
heads = 255;
|
|
|
|
sectors = 63;
|
|
|
|
cylinders = (unsigned long)capacity / (heads * sectors);
|
|
|
|
}
|
|
|
|
ip[0] = heads;
|
|
|
|
ip[1] = sectors;
|
|
|
|
ip[2] = cylinders;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void atp870u_remove (struct pci_dev *pdev)
|
2021-01-13 17:04:30 +08:00
|
|
|
{
|
2005-04-17 06:20:36 +08:00
|
|
|
struct atp_unit *devext = pci_get_drvdata(pdev);
|
|
|
|
struct Scsi_Host *pshost = devext->host;
|
2021-01-13 17:04:30 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
scsi_remove_host(pshost);
|
|
|
|
free_irq(pshost->irq, pshost);
|
2015-11-18 02:24:22 +08:00
|
|
|
pci_release_regions(pdev);
|
|
|
|
pci_disable_device(pdev);
|
2005-04-17 06:20:36 +08:00
|
|
|
atp870u_free_tables(pshost);
|
|
|
|
scsi_host_put(pshost);
|
|
|
|
}
|
|
|
|
MODULE_LICENSE("GPL");
|
|
|
|
|
|
|
|
static struct scsi_host_template atp870u_template = {
|
|
|
|
.module = THIS_MODULE,
|
2021-01-13 17:04:30 +08:00
|
|
|
.name = "atp870u" /* name */,
|
2005-04-17 06:20:36 +08:00
|
|
|
.proc_name = "atp870u",
|
2013-03-31 15:26:26 +08:00
|
|
|
.show_info = atp870u_show_info,
|
2021-01-13 17:04:30 +08:00
|
|
|
.info = atp870u_info /* info */,
|
|
|
|
.queuecommand = atp870u_queuecommand /* queuecommand */,
|
|
|
|
.eh_abort_handler = atp870u_abort /* abort */,
|
|
|
|
.bios_param = atp870u_biosparam /* biosparm */,
|
|
|
|
.can_queue = qcnt /* can_queue */,
|
|
|
|
.this_id = 7 /* SCSI ID */,
|
|
|
|
.sg_tablesize = ATP870U_SCATTER /*SG_ALL*/,
|
2005-04-17 06:20:36 +08:00
|
|
|
.max_sectors = ATP870U_MAX_SECTORS,
|
|
|
|
};
|
|
|
|
|
|
|
|
static struct pci_device_id atp870u_id_table[] = {
|
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_ARTOP, ATP885_DEVID) },
|
2021-01-13 17:04:30 +08:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_ARTOP, ATP880_DEVID1) },
|
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_ARTOP, ATP880_DEVID2) },
|
2005-04-17 06:20:36 +08:00
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7610) },
|
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612UW) },
|
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612U) },
|
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612S) },
|
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612D) },
|
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_AEC7612SUW) },
|
|
|
|
{ PCI_DEVICE(PCI_VENDOR_ID_ARTOP, PCI_DEVICE_ID_ARTOP_8060) },
|
|
|
|
{ 0, },
|
|
|
|
};
|
|
|
|
|
|
|
|
MODULE_DEVICE_TABLE(pci, atp870u_id_table);
|
|
|
|
|
|
|
|
static struct pci_driver atp870u_driver = {
|
|
|
|
.id_table = atp870u_id_table,
|
|
|
|
.name = "atp870u",
|
|
|
|
.probe = atp870u_probe,
|
2012-12-22 05:08:55 +08:00
|
|
|
.remove = atp870u_remove,
|
2005-04-17 06:20:36 +08:00
|
|
|
};
|
|
|
|
|
2015-11-18 02:24:13 +08:00
|
|
|
module_pci_driver(atp870u_driver);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2021-01-13 17:04:30 +08:00
|
|
|
static void atp_is(struct atp_unit *dev, unsigned char c, bool wide_chip,
|
|
|
|
unsigned char lvdmode)
|
2005-04-17 06:20:36 +08:00
|
|
|
{
|
2015-11-18 02:24:00 +08:00
|
|
|
unsigned char i, j, k, rmb, n;
|
2005-04-17 06:20:36 +08:00
|
|
|
unsigned short int m;
|
|
|
|
static unsigned char mbuf[512];
|
2015-11-18 02:23:58 +08:00
|
|
|
static unsigned char satn[9] = { 0, 0, 0, 0, 0, 0, 0, 6, 6 };
|
|
|
|
static unsigned char inqd[9] = { 0x12, 0, 0, 0, 0x24, 0, 0, 0x24, 6 };
|
|
|
|
static unsigned char synn[6] = { 0x80, 1, 3, 1, 0x19, 0x0e };
|
|
|
|
unsigned char synu[6] = { 0x80, 1, 3, 1, 0x0a, 0x0e };
|
|
|
|
static unsigned char synw[6] = { 0x80, 1, 3, 1, 0x19, 0x0e };
|
atp870u: Add remaining 870 support to is885()
Add remaining 870 support to is885():
- different synw, no synuw
- synu[4] = 0x0c
- atp_writeb_io(dev, c, 0x04, 0x00); instead of
atp_writeb_io(dev, c, 0x14, 0x00); (isn't that a bug?)
- atp_writeb_io(dev, c, 0x14, 0xff); instead of
atp_writeb_io(dev, c, 0x14, 0x06);
- different mbuf[3] and mbuf[4] checks
Signed-off-by: Ondrej Zary <linux@rainbow-software.org>
Reviewed-by: Hannes Reinicke <hare@suse.de>
Acked-by: Christoph Hellwig <hch@lst.de>
Signed-off-by: Martin K. Petersen <martin.petersen@oracle.com>
2015-11-18 02:24:03 +08:00
|
|
|
static unsigned char synw_870[6] = { 0x80, 1, 3, 1, 0x0c, 0x07 };
|
2015-11-18 02:23:58 +08:00
|
|
|
unsigned char synuw[6] = { 0x80, 1, 3, 1, 0x0a, 0x0e };
|
|
|
|
static unsigned char wide[6] = { 0x80, 1, 2, 3, 1, 0 };
|
|
|
|
static unsigned char u3[9] = { 0x80, 1, 6, 4, 0x09, 00, 0x0e, 0x01, 0x02 };
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
for (i = 0; i < 16; i++) {
|
2015-11-18 02:24:02 +08:00
|
|
|
if (!wide_chip && (i > 7))
|
|
|
|
break;
|
2005-04-17 06:20:36 +08:00
|
|
|
m = 1;
|
|
|
|
m = m << i;
|
|
|
|
if ((m & dev->active_id[c]) != 0) {
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
if (i == dev->host_id[c]) {
|
|
|
|
printk(KERN_INFO " ID: %2d Host Adapter\n", dev->host_id[c]);
|
|
|
|
continue;
|
|
|
|
}
|
2015-11-18 02:24:02 +08:00
|
|
|
atp_writeb_io(dev, c, 0x1b, wide_chip ? 0x01 : 0x00);
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 1, 0x08);
|
|
|
|
atp_writeb_io(dev, c, 2, 0x7f);
|
|
|
|
atp_writeb_io(dev, c, 3, satn[0]);
|
|
|
|
atp_writeb_io(dev, c, 4, satn[1]);
|
|
|
|
atp_writeb_io(dev, c, 5, satn[2]);
|
|
|
|
atp_writeb_io(dev, c, 6, satn[3]);
|
|
|
|
atp_writeb_io(dev, c, 7, satn[4]);
|
|
|
|
atp_writeb_io(dev, c, 8, satn[5]);
|
|
|
|
atp_writeb_io(dev, c, 0x0f, 0);
|
|
|
|
atp_writeb_io(dev, c, 0x11, dev->id[c][i].devsp);
|
|
|
|
atp_writeb_io(dev, c, 0x12, 0);
|
|
|
|
atp_writeb_io(dev, c, 0x13, satn[6]);
|
|
|
|
atp_writeb_io(dev, c, 0x14, satn[7]);
|
2005-04-17 06:20:36 +08:00
|
|
|
j = i;
|
|
|
|
if ((j & 0x08) != 0) {
|
|
|
|
j = (j & 0x07) | 0x40;
|
|
|
|
}
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x15, j);
|
|
|
|
atp_writeb_io(dev, c, 0x18, satn[8]);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0x00)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
|
|
|
if (atp_readb_io(dev, c, 0x17) != 0x11 && atp_readb_io(dev, c, 0x17) != 0x8e)
|
2005-04-17 06:20:36 +08:00
|
|
|
continue;
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while (atp_readb_io(dev, c, 0x17) != 0x8e)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->active_id[c] |= m;
|
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x10, 0x30);
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev) || is880(dev))
|
atp870u: Add remaining 870 support to is885()
Add remaining 870 support to is885():
- different synw, no synuw
- synu[4] = 0x0c
- atp_writeb_io(dev, c, 0x04, 0x00); instead of
atp_writeb_io(dev, c, 0x14, 0x00); (isn't that a bug?)
- atp_writeb_io(dev, c, 0x14, 0xff); instead of
atp_writeb_io(dev, c, 0x14, 0x06);
- different mbuf[3] and mbuf[4] checks
Signed-off-by: Ondrej Zary <linux@rainbow-software.org>
Reviewed-by: Hannes Reinicke <hare@suse.de>
Acked-by: Christoph Hellwig <hch@lst.de>
Signed-off-by: Martin K. Petersen <martin.petersen@oracle.com>
2015-11-18 02:24:03 +08:00
|
|
|
atp_writeb_io(dev, c, 0x14, 0x00);
|
|
|
|
else /* result of is870() merge - is this a bug? */
|
|
|
|
atp_writeb_io(dev, c, 0x04, 0x00);
|
2005-04-17 06:20:36 +08:00
|
|
|
|
|
|
|
phase_cmd:
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0x00)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j != 0x16) {
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x10, 0x41);
|
2005-04-17 06:20:36 +08:00
|
|
|
goto phase_cmd;
|
|
|
|
}
|
|
|
|
sel_ok:
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 3, inqd[0]);
|
|
|
|
atp_writeb_io(dev, c, 4, inqd[1]);
|
|
|
|
atp_writeb_io(dev, c, 5, inqd[2]);
|
|
|
|
atp_writeb_io(dev, c, 6, inqd[3]);
|
|
|
|
atp_writeb_io(dev, c, 7, inqd[4]);
|
|
|
|
atp_writeb_io(dev, c, 8, inqd[5]);
|
|
|
|
atp_writeb_io(dev, c, 0x0f, 0);
|
|
|
|
atp_writeb_io(dev, c, 0x11, dev->id[c][i].devsp);
|
|
|
|
atp_writeb_io(dev, c, 0x12, 0);
|
|
|
|
atp_writeb_io(dev, c, 0x13, inqd[6]);
|
|
|
|
atp_writeb_io(dev, c, 0x14, inqd[7]);
|
|
|
|
atp_writeb_io(dev, c, 0x18, inqd[8]);
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0x00)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
|
|
|
if (atp_readb_io(dev, c, 0x17) != 0x11 && atp_readb_io(dev, c, 0x17) != 0x8e)
|
2005-04-17 06:20:36 +08:00
|
|
|
continue;
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while (atp_readb_io(dev, c, 0x17) != 0x8e)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:24:02 +08:00
|
|
|
if (wide_chip)
|
|
|
|
atp_writeb_io(dev, c, 0x1b, 0x00);
|
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
2005-04-17 06:20:36 +08:00
|
|
|
j = 0;
|
|
|
|
rd_inq_data:
|
2015-11-18 02:23:57 +08:00
|
|
|
k = atp_readb_io(dev, c, 0x1f);
|
2005-04-17 06:20:36 +08:00
|
|
|
if ((k & 0x01) != 0) {
|
2015-11-18 02:23:57 +08:00
|
|
|
mbuf[j++] = atp_readb_io(dev, c, 0x19);
|
2005-04-17 06:20:36 +08:00
|
|
|
goto rd_inq_data;
|
|
|
|
}
|
|
|
|
if ((k & 0x80) == 0) {
|
|
|
|
goto rd_inq_data;
|
|
|
|
}
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j == 0x16) {
|
|
|
|
goto inq_ok;
|
|
|
|
}
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x10, 0x46);
|
|
|
|
atp_writeb_io(dev, c, 0x12, 0);
|
|
|
|
atp_writeb_io(dev, c, 0x13, 0);
|
|
|
|
atp_writeb_io(dev, c, 0x14, 0);
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0x00)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
|
|
|
if (atp_readb_io(dev, c, 0x17) != 0x16)
|
2005-04-17 06:20:36 +08:00
|
|
|
goto sel_ok;
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
inq_ok:
|
|
|
|
mbuf[36] = 0;
|
2015-11-18 02:23:58 +08:00
|
|
|
printk(KERN_INFO " ID: %2d %s\n", i, &mbuf[8]);
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->id[c][i].devtype = mbuf[0];
|
|
|
|
rmb = mbuf[1];
|
|
|
|
n = mbuf[7];
|
2015-11-18 02:24:02 +08:00
|
|
|
if (!wide_chip)
|
|
|
|
goto not_wide;
|
2005-04-17 06:20:36 +08:00
|
|
|
if ((mbuf[7] & 0x60) == 0) {
|
|
|
|
goto not_wide;
|
|
|
|
}
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev) || is880(dev)) {
|
2015-11-18 02:24:02 +08:00
|
|
|
if ((i < 8) && ((dev->global_map[c] & 0x20) == 0))
|
|
|
|
goto not_wide;
|
|
|
|
} else { /* result of is870() merge - is this a bug? */
|
|
|
|
if ((dev->global_map[c] & 0x20) == 0)
|
|
|
|
goto not_wide;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
if (lvdmode == 0) {
|
2015-11-18 02:23:58 +08:00
|
|
|
goto chg_wide;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
2015-11-18 02:23:58 +08:00
|
|
|
if (dev->sp[c][i] != 0x04) // force u2
|
|
|
|
{
|
|
|
|
goto chg_wide;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x1b, 0x01);
|
|
|
|
atp_writeb_io(dev, c, 3, satn[0]);
|
|
|
|
atp_writeb_io(dev, c, 4, satn[1]);
|
|
|
|
atp_writeb_io(dev, c, 5, satn[2]);
|
|
|
|
atp_writeb_io(dev, c, 6, satn[3]);
|
|
|
|
atp_writeb_io(dev, c, 7, satn[4]);
|
|
|
|
atp_writeb_io(dev, c, 8, satn[5]);
|
|
|
|
atp_writeb_io(dev, c, 0x0f, 0);
|
|
|
|
atp_writeb_io(dev, c, 0x11, dev->id[c][i].devsp);
|
|
|
|
atp_writeb_io(dev, c, 0x12, 0);
|
|
|
|
atp_writeb_io(dev, c, 0x13, satn[6]);
|
|
|
|
atp_writeb_io(dev, c, 0x14, satn[7]);
|
|
|
|
atp_writeb_io(dev, c, 0x18, satn[8]);
|
|
|
|
|
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0x00)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
|
|
|
if (atp_readb_io(dev, c, 0x17) != 0x11 && atp_readb_io(dev, c, 0x17) != 0x8e)
|
2005-04-17 06:20:36 +08:00
|
|
|
continue;
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while (atp_readb_io(dev, c, 0x17) != 0x8e)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
try_u3:
|
|
|
|
j = 0;
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x14, 0x09);
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x20);
|
2015-11-18 02:23:46 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0) {
|
|
|
|
if ((atp_readb_io(dev, c, 0x1f) & 0x01) != 0)
|
|
|
|
atp_writeb_io(dev, c, 0x19, u3[j++]);
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
|
|
|
}
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x17) & 0x80) == 0x00)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17) & 0x0f;
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j == 0x0f) {
|
|
|
|
goto u3p_in;
|
|
|
|
}
|
|
|
|
if (j == 0x0a) {
|
|
|
|
goto u3p_cmd;
|
|
|
|
}
|
|
|
|
if (j == 0x0e) {
|
|
|
|
goto try_u3;
|
|
|
|
}
|
|
|
|
continue;
|
|
|
|
u3p_out:
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x18, 0x20);
|
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0) {
|
|
|
|
if ((atp_readb_io(dev, c, 0x1f) & 0x01) != 0)
|
|
|
|
atp_writeb_io(dev, c, 0x19, 0);
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
|
|
|
}
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17) & 0x0f;
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j == 0x0f) {
|
|
|
|
goto u3p_in;
|
|
|
|
}
|
|
|
|
if (j == 0x0a) {
|
|
|
|
goto u3p_cmd;
|
|
|
|
}
|
|
|
|
if (j == 0x0e) {
|
|
|
|
goto u3p_out;
|
|
|
|
}
|
|
|
|
continue;
|
|
|
|
u3p_in:
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x14, 0x09);
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x20);
|
2005-04-17 06:20:36 +08:00
|
|
|
k = 0;
|
|
|
|
u3p_in1:
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x1f);
|
2005-04-17 06:20:36 +08:00
|
|
|
if ((j & 0x01) != 0) {
|
2015-11-18 02:23:57 +08:00
|
|
|
mbuf[k++] = atp_readb_io(dev, c, 0x19);
|
2005-04-17 06:20:36 +08:00
|
|
|
goto u3p_in1;
|
|
|
|
}
|
|
|
|
if ((j & 0x80) == 0x00) {
|
|
|
|
goto u3p_in1;
|
|
|
|
}
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17) & 0x0f;
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j == 0x0f) {
|
|
|
|
goto u3p_in;
|
|
|
|
}
|
|
|
|
if (j == 0x0a) {
|
|
|
|
goto u3p_cmd;
|
|
|
|
}
|
|
|
|
if (j == 0x0e) {
|
|
|
|
goto u3p_out;
|
|
|
|
}
|
|
|
|
continue;
|
|
|
|
u3p_cmd:
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x10, 0x30);
|
|
|
|
atp_writeb_io(dev, c, 0x14, 0x00);
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0x00);
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j != 0x16) {
|
|
|
|
if (j == 0x4e) {
|
|
|
|
goto u3p_out;
|
|
|
|
}
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
if (mbuf[0] != 0x01) {
|
|
|
|
goto chg_wide;
|
|
|
|
}
|
|
|
|
if (mbuf[1] != 0x06) {
|
|
|
|
goto chg_wide;
|
|
|
|
}
|
|
|
|
if (mbuf[2] != 0x04) {
|
|
|
|
goto chg_wide;
|
|
|
|
}
|
|
|
|
if (mbuf[3] == 0x09) {
|
|
|
|
m = 1;
|
|
|
|
m = m << i;
|
|
|
|
dev->wide_id[c] |= m;
|
|
|
|
dev->id[c][i].devsp = 0xce;
|
2021-01-13 17:04:30 +08:00
|
|
|
#ifdef ED_DBGP
|
|
|
|
printk("dev->id[%2d][%2d].devsp = %2x\n",
|
|
|
|
c, i, dev->id[c][i].devsp);
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
chg_wide:
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x1b, 0x01);
|
|
|
|
atp_writeb_io(dev, c, 3, satn[0]);
|
|
|
|
atp_writeb_io(dev, c, 4, satn[1]);
|
|
|
|
atp_writeb_io(dev, c, 5, satn[2]);
|
|
|
|
atp_writeb_io(dev, c, 6, satn[3]);
|
|
|
|
atp_writeb_io(dev, c, 7, satn[4]);
|
|
|
|
atp_writeb_io(dev, c, 8, satn[5]);
|
|
|
|
atp_writeb_io(dev, c, 0x0f, 0);
|
|
|
|
atp_writeb_io(dev, c, 0x11, dev->id[c][i].devsp);
|
|
|
|
atp_writeb_io(dev, c, 0x12, 0);
|
|
|
|
atp_writeb_io(dev, c, 0x13, satn[6]);
|
|
|
|
atp_writeb_io(dev, c, 0x14, satn[7]);
|
|
|
|
atp_writeb_io(dev, c, 0x18, satn[8]);
|
|
|
|
|
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0x00)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2021-01-13 17:04:30 +08:00
|
|
|
if (atp_readb_io(dev, c, 0x17) != 0x11 &&
|
|
|
|
atp_readb_io(dev, c, 0x17) != 0x8e)
|
2005-04-17 06:20:36 +08:00
|
|
|
continue;
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while (atp_readb_io(dev, c, 0x17) != 0x8e)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
try_wide:
|
|
|
|
j = 0;
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x14, 0x05);
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x20);
|
2015-11-18 02:23:46 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0) {
|
|
|
|
if ((atp_readb_io(dev, c, 0x1f) & 0x01) != 0)
|
|
|
|
atp_writeb_io(dev, c, 0x19, wide[j++]);
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
|
|
|
}
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x17) & 0x80) == 0x00)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17) & 0x0f;
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j == 0x0f) {
|
|
|
|
goto widep_in;
|
|
|
|
}
|
|
|
|
if (j == 0x0a) {
|
|
|
|
goto widep_cmd;
|
|
|
|
}
|
|
|
|
if (j == 0x0e) {
|
|
|
|
goto try_wide;
|
|
|
|
}
|
|
|
|
continue;
|
|
|
|
widep_out:
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x18, 0x20);
|
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0) {
|
|
|
|
if ((atp_readb_io(dev, c, 0x1f) & 0x01) != 0)
|
|
|
|
atp_writeb_io(dev, c, 0x19, 0);
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
|
|
|
}
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17) & 0x0f;
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j == 0x0f) {
|
|
|
|
goto widep_in;
|
|
|
|
}
|
|
|
|
if (j == 0x0a) {
|
|
|
|
goto widep_cmd;
|
|
|
|
}
|
|
|
|
if (j == 0x0e) {
|
|
|
|
goto widep_out;
|
|
|
|
}
|
|
|
|
continue;
|
|
|
|
widep_in:
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x14, 0xff);
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x20);
|
2005-04-17 06:20:36 +08:00
|
|
|
k = 0;
|
|
|
|
widep_in1:
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x1f);
|
2005-04-17 06:20:36 +08:00
|
|
|
if ((j & 0x01) != 0) {
|
2015-11-18 02:23:57 +08:00
|
|
|
mbuf[k++] = atp_readb_io(dev, c, 0x19);
|
2005-04-17 06:20:36 +08:00
|
|
|
goto widep_in1;
|
|
|
|
}
|
|
|
|
if ((j & 0x80) == 0x00) {
|
|
|
|
goto widep_in1;
|
|
|
|
}
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17) & 0x0f;
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j == 0x0f) {
|
|
|
|
goto widep_in;
|
|
|
|
}
|
|
|
|
if (j == 0x0a) {
|
|
|
|
goto widep_cmd;
|
|
|
|
}
|
|
|
|
if (j == 0x0e) {
|
|
|
|
goto widep_out;
|
|
|
|
}
|
|
|
|
continue;
|
|
|
|
widep_cmd:
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x10, 0x30);
|
|
|
|
atp_writeb_io(dev, c, 0x14, 0x00);
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0x00)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j != 0x16) {
|
|
|
|
if (j == 0x4e) {
|
|
|
|
goto widep_out;
|
|
|
|
}
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
if (mbuf[0] != 0x01) {
|
|
|
|
goto not_wide;
|
|
|
|
}
|
|
|
|
if (mbuf[1] != 0x02) {
|
|
|
|
goto not_wide;
|
|
|
|
}
|
|
|
|
if (mbuf[2] != 0x03) {
|
|
|
|
goto not_wide;
|
|
|
|
}
|
|
|
|
if (mbuf[3] != 0x01) {
|
|
|
|
goto not_wide;
|
|
|
|
}
|
|
|
|
m = 1;
|
|
|
|
m = m << i;
|
|
|
|
dev->wide_id[c] |= m;
|
|
|
|
not_wide:
|
2021-01-13 17:04:30 +08:00
|
|
|
if ((dev->id[c][i].devtype == 0x00) ||
|
|
|
|
(dev->id[c][i].devtype == 0x07) ||
|
|
|
|
((dev->id[c][i].devtype == 0x05) && ((n & 0x10) != 0))) {
|
2005-04-17 06:20:36 +08:00
|
|
|
m = 1;
|
|
|
|
m = m << i;
|
|
|
|
if ((dev->async[c] & m) != 0) {
|
2015-11-18 02:23:58 +08:00
|
|
|
goto set_sync;
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
continue;
|
|
|
|
set_sync:
|
2015-11-18 02:24:21 +08:00
|
|
|
if ((!is885(dev) && !is880(dev)) || (dev->sp[c][i] == 0x02)) {
|
2015-11-18 02:23:58 +08:00
|
|
|
synu[4] = 0x0c;
|
|
|
|
synuw[4] = 0x0c;
|
2005-04-17 06:20:36 +08:00
|
|
|
} else {
|
2015-11-18 02:23:58 +08:00
|
|
|
if (dev->sp[c][i] >= 0x03) {
|
|
|
|
synu[4] = 0x0a;
|
|
|
|
synuw[4] = 0x0a;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
j = 0;
|
|
|
|
if ((m & dev->wide_id[c]) != 0) {
|
|
|
|
j |= 0x01;
|
|
|
|
}
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x1b, j);
|
|
|
|
atp_writeb_io(dev, c, 3, satn[0]);
|
|
|
|
atp_writeb_io(dev, c, 4, satn[1]);
|
|
|
|
atp_writeb_io(dev, c, 5, satn[2]);
|
|
|
|
atp_writeb_io(dev, c, 6, satn[3]);
|
|
|
|
atp_writeb_io(dev, c, 7, satn[4]);
|
|
|
|
atp_writeb_io(dev, c, 8, satn[5]);
|
|
|
|
atp_writeb_io(dev, c, 0x0f, 0);
|
|
|
|
atp_writeb_io(dev, c, 0x11, dev->id[c][i].devsp);
|
|
|
|
atp_writeb_io(dev, c, 0x12, 0);
|
|
|
|
atp_writeb_io(dev, c, 0x13, satn[6]);
|
|
|
|
atp_writeb_io(dev, c, 0x14, satn[7]);
|
|
|
|
atp_writeb_io(dev, c, 0x18, satn[8]);
|
|
|
|
|
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0x00)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2021-01-13 17:04:30 +08:00
|
|
|
if (atp_readb_io(dev, c, 0x17) != 0x11 &&
|
|
|
|
atp_readb_io(dev, c, 0x17) != 0x8e)
|
2005-04-17 06:20:36 +08:00
|
|
|
continue;
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while (atp_readb_io(dev, c, 0x17) != 0x8e)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2005-04-17 06:20:36 +08:00
|
|
|
try_sync:
|
|
|
|
j = 0;
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x14, 0x06);
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x20);
|
2015-11-18 02:23:46 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0) {
|
|
|
|
if ((atp_readb_io(dev, c, 0x1f) & 0x01) != 0) {
|
2005-04-17 06:20:36 +08:00
|
|
|
if ((m & dev->wide_id[c]) != 0) {
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev) || is880(dev)) {
|
atp870u: Add remaining 870 support to is885()
Add remaining 870 support to is885():
- different synw, no synuw
- synu[4] = 0x0c
- atp_writeb_io(dev, c, 0x04, 0x00); instead of
atp_writeb_io(dev, c, 0x14, 0x00); (isn't that a bug?)
- atp_writeb_io(dev, c, 0x14, 0xff); instead of
atp_writeb_io(dev, c, 0x14, 0x06);
- different mbuf[3] and mbuf[4] checks
Signed-off-by: Ondrej Zary <linux@rainbow-software.org>
Reviewed-by: Hannes Reinicke <hare@suse.de>
Acked-by: Christoph Hellwig <hch@lst.de>
Signed-off-by: Martin K. Petersen <martin.petersen@oracle.com>
2015-11-18 02:24:03 +08:00
|
|
|
if ((m & dev->ultra_map[c]) != 0) {
|
|
|
|
atp_writeb_io(dev, c, 0x19, synuw[j++]);
|
|
|
|
} else {
|
|
|
|
atp_writeb_io(dev, c, 0x19, synw[j++]);
|
|
|
|
}
|
|
|
|
} else
|
|
|
|
atp_writeb_io(dev, c, 0x19, synw_870[j++]);
|
2005-04-17 06:20:36 +08:00
|
|
|
} else {
|
|
|
|
if ((m & dev->ultra_map[c]) != 0) {
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x19, synu[j++]);
|
2005-04-17 06:20:36 +08:00
|
|
|
} else {
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x19, synn[j++]);
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x17) & 0x80) == 0x00)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17) & 0x0f;
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j == 0x0f) {
|
|
|
|
goto phase_ins;
|
|
|
|
}
|
|
|
|
if (j == 0x0a) {
|
|
|
|
goto phase_cmds;
|
|
|
|
}
|
|
|
|
if (j == 0x0e) {
|
|
|
|
goto try_sync;
|
|
|
|
}
|
|
|
|
continue;
|
|
|
|
phase_outs:
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x18, 0x20);
|
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0x00) {
|
|
|
|
if ((atp_readb_io(dev, c, 0x1f) & 0x01) != 0x00)
|
|
|
|
atp_writeb_io(dev, c, 0x19, 0x00);
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
|
|
|
}
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j == 0x85) {
|
|
|
|
goto tar_dcons;
|
|
|
|
}
|
|
|
|
j &= 0x0f;
|
|
|
|
if (j == 0x0f) {
|
|
|
|
goto phase_ins;
|
|
|
|
}
|
|
|
|
if (j == 0x0a) {
|
|
|
|
goto phase_cmds;
|
|
|
|
}
|
|
|
|
if (j == 0x0e) {
|
|
|
|
goto phase_outs;
|
|
|
|
}
|
|
|
|
continue;
|
|
|
|
phase_ins:
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev) || is880(dev))
|
atp870u: Add remaining 870 support to is885()
Add remaining 870 support to is885():
- different synw, no synuw
- synu[4] = 0x0c
- atp_writeb_io(dev, c, 0x04, 0x00); instead of
atp_writeb_io(dev, c, 0x14, 0x00); (isn't that a bug?)
- atp_writeb_io(dev, c, 0x14, 0xff); instead of
atp_writeb_io(dev, c, 0x14, 0x06);
- different mbuf[3] and mbuf[4] checks
Signed-off-by: Ondrej Zary <linux@rainbow-software.org>
Reviewed-by: Hannes Reinicke <hare@suse.de>
Acked-by: Christoph Hellwig <hch@lst.de>
Signed-off-by: Martin K. Petersen <martin.petersen@oracle.com>
2015-11-18 02:24:03 +08:00
|
|
|
atp_writeb_io(dev, c, 0x14, 0x06);
|
|
|
|
else
|
|
|
|
atp_writeb_io(dev, c, 0x14, 0xff);
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x18, 0x20);
|
2005-04-17 06:20:36 +08:00
|
|
|
k = 0;
|
|
|
|
phase_ins1:
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x1f);
|
2005-04-17 06:20:36 +08:00
|
|
|
if ((j & 0x01) != 0x00) {
|
2015-11-18 02:23:57 +08:00
|
|
|
mbuf[k++] = atp_readb_io(dev, c, 0x19);
|
2005-04-17 06:20:36 +08:00
|
|
|
goto phase_ins1;
|
|
|
|
}
|
|
|
|
if ((j & 0x80) == 0x00) {
|
|
|
|
goto phase_ins1;
|
|
|
|
}
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x17) & 0x80) == 0x00);
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j == 0x85) {
|
|
|
|
goto tar_dcons;
|
|
|
|
}
|
|
|
|
j &= 0x0f;
|
|
|
|
if (j == 0x0f) {
|
|
|
|
goto phase_ins;
|
|
|
|
}
|
|
|
|
if (j == 0x0a) {
|
|
|
|
goto phase_cmds;
|
|
|
|
}
|
|
|
|
if (j == 0x0e) {
|
|
|
|
goto phase_outs;
|
|
|
|
}
|
|
|
|
continue;
|
|
|
|
phase_cmds:
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x10, 0x30);
|
2005-04-17 06:20:36 +08:00
|
|
|
tar_dcons:
|
2015-11-18 02:23:57 +08:00
|
|
|
atp_writeb_io(dev, c, 0x14, 0x00);
|
|
|
|
atp_writeb_io(dev, c, 0x18, 0x08);
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
while ((atp_readb_io(dev, c, 0x1f) & 0x80) == 0x00)
|
2005-04-17 06:20:36 +08:00
|
|
|
cpu_relax();
|
2015-11-18 02:23:58 +08:00
|
|
|
|
2015-11-18 02:23:57 +08:00
|
|
|
j = atp_readb_io(dev, c, 0x17);
|
2005-04-17 06:20:36 +08:00
|
|
|
if (j != 0x16) {
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
if (mbuf[0] != 0x01) {
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
if (mbuf[1] != 0x03) {
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
if (mbuf[4] == 0x00) {
|
|
|
|
continue;
|
|
|
|
}
|
|
|
|
if (mbuf[3] > 0x64) {
|
|
|
|
continue;
|
|
|
|
}
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev) || is880(dev)) {
|
atp870u: Add remaining 870 support to is885()
Add remaining 870 support to is885():
- different synw, no synuw
- synu[4] = 0x0c
- atp_writeb_io(dev, c, 0x04, 0x00); instead of
atp_writeb_io(dev, c, 0x14, 0x00); (isn't that a bug?)
- atp_writeb_io(dev, c, 0x14, 0xff); instead of
atp_writeb_io(dev, c, 0x14, 0x06);
- different mbuf[3] and mbuf[4] checks
Signed-off-by: Ondrej Zary <linux@rainbow-software.org>
Reviewed-by: Hannes Reinicke <hare@suse.de>
Acked-by: Christoph Hellwig <hch@lst.de>
Signed-off-by: Martin K. Petersen <martin.petersen@oracle.com>
2015-11-18 02:24:03 +08:00
|
|
|
if (mbuf[4] > 0x0e) {
|
|
|
|
mbuf[4] = 0x0e;
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
if (mbuf[4] > 0x0c) {
|
|
|
|
mbuf[4] = 0x0c;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
}
|
|
|
|
dev->id[c][i].devsp = mbuf[4];
|
2015-11-18 02:24:21 +08:00
|
|
|
if (is885(dev) || is880(dev))
|
atp870u: Add remaining 870 support to is885()
Add remaining 870 support to is885():
- different synw, no synuw
- synu[4] = 0x0c
- atp_writeb_io(dev, c, 0x04, 0x00); instead of
atp_writeb_io(dev, c, 0x14, 0x00); (isn't that a bug?)
- atp_writeb_io(dev, c, 0x14, 0xff); instead of
atp_writeb_io(dev, c, 0x14, 0x06);
- different mbuf[3] and mbuf[4] checks
Signed-off-by: Ondrej Zary <linux@rainbow-software.org>
Reviewed-by: Hannes Reinicke <hare@suse.de>
Acked-by: Christoph Hellwig <hch@lst.de>
Signed-off-by: Martin K. Petersen <martin.petersen@oracle.com>
2015-11-18 02:24:03 +08:00
|
|
|
if (mbuf[3] < 0x0c) {
|
|
|
|
j = 0xb0;
|
|
|
|
goto set_syn_ok;
|
|
|
|
}
|
2005-04-17 06:20:36 +08:00
|
|
|
if ((mbuf[3] < 0x0d) && (rmb == 0)) {
|
|
|
|
j = 0xa0;
|
|
|
|
goto set_syn_ok;
|
|
|
|
}
|
|
|
|
if (mbuf[3] < 0x1a) {
|
|
|
|
j = 0x20;
|
|
|
|
goto set_syn_ok;
|
|
|
|
}
|
|
|
|
if (mbuf[3] < 0x33) {
|
|
|
|
j = 0x40;
|
|
|
|
goto set_syn_ok;
|
|
|
|
}
|
|
|
|
if (mbuf[3] < 0x4c) {
|
|
|
|
j = 0x50;
|
|
|
|
goto set_syn_ok;
|
|
|
|
}
|
|
|
|
j = 0x60;
|
2015-11-18 02:23:58 +08:00
|
|
|
set_syn_ok:
|
2005-04-17 06:20:36 +08:00
|
|
|
dev->id[c][i].devsp = (dev->id[c][i].devsp & 0x0f) | j;
|
2015-11-18 02:23:58 +08:00
|
|
|
#ifdef ED_DBGP
|
2021-01-13 17:04:30 +08:00
|
|
|
printk("dev->id[%2d][%2d].devsp = %2x\n",
|
|
|
|
c,i,dev->id[c][i].devsp);
|
2005-04-17 06:20:36 +08:00
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|