| File: | obj-scan-build/../linux/src/drivers/scsi/AM53C974.c |
| Location: | line 1455, column 8 |
| Description: | Value stored to 'ret' is never read |
| 1 | #include <linux/module.h> |
| 2 | |
| 3 | #include <linux/config.h> |
| 4 | #include <linux/delay.h> |
| 5 | #include <linux/signal.h> |
| 6 | #include <linux/sched.h> |
| 7 | #include <linux/errno.h> |
| 8 | #include <linux/bios32.h> |
| 9 | #include <linux/pci.h> |
| 10 | #include <linux/string.h> |
| 11 | #include <linux/blk.h> |
| 12 | |
| 13 | #include <asm/io.h> |
| 14 | #include <asm/system.h> |
| 15 | |
| 16 | #include "scsi.h" |
| 17 | #include "hosts.h" |
| 18 | #include "AM53C974.h" |
| 19 | #include "constants.h" |
| 20 | #include "sd.h" |
| 21 | |
| 22 | /* AM53/79C974 (PCscsi) driver release 0.5 |
| 23 | * |
| 24 | * The architecture and much of the code of this device |
| 25 | * driver was originally developed by Drew Eckhardt for |
| 26 | * the NCR5380. The following copyrights apply: |
| 27 | * For the architecture and all pieces of code which can also be found |
| 28 | * in the NCR5380 device driver: |
| 29 | * Copyright 1993, Drew Eckhardt |
| 30 | * Visionary Computing |
| 31 | * (Unix and Linux consulting and custom programming) |
| 32 | * drew@colorado.edu |
| 33 | * +1 (303) 666-5836 |
| 34 | * |
| 35 | * The AM53C974_nobios_detect code was originally developed by |
| 36 | * Robin Cutshaw (robin@xfree86.org) and is used here in a |
| 37 | * slightly modified form. |
| 38 | * |
| 39 | * For the remaining code: |
| 40 | * Copyright 1994, D. Frieauff |
| 41 | * EMail: fri@rsx42sun0.dofn.de |
| 42 | * Phone: x49-7545-8-2256 , x49-7541-42305 |
| 43 | */ |
| 44 | |
| 45 | #ifdef AM53C974_DEBUG |
| 46 | #define DEB(x) x |
| 47 | #ifdef AM53C974_DEBUG_KEYWAIT |
| 48 | #define KEYWAIT() AM53C974_keywait() |
| 49 | #else |
| 50 | #define KEYWAIT() |
| 51 | #endif |
| 52 | #ifdef AM53C974_DEBUG_INIT |
| 53 | #define DEB_INIT(x) x |
| 54 | #else |
| 55 | #define DEB_INIT(x) |
| 56 | #endif |
| 57 | #ifdef AM53C974_DEBUG_MSG |
| 58 | #define DEB_MSG(x) x |
| 59 | #else |
| 60 | #define DEB_MSG(x) |
| 61 | #endif |
| 62 | #ifdef AM53C974_DEB_RESEL |
| 63 | #define DEB_RESEL(x) x |
| 64 | #else |
| 65 | #define DEB_RESEL(x) |
| 66 | #endif |
| 67 | #ifdef AM53C974_DEBUG_QUEUE |
| 68 | #define DEB_QUEUE(x) x |
| 69 | #define LIST(x,y) {printk("LINE:%d Adding %p to %p\n", __LINE__69, (void*)(x), (void*)(y)); if ((x)==(y)) udelay(5)(__builtin_constant_p(5) ? __const_udelay((5) * 0x10c6ul) : __udelay (5)); } |
| 70 | #define REMOVE(w,x,y,z) {printk("LINE:%d Removing: %p->%p %p->%p \n", __LINE__70, (void*)(w), (void*)(x), (void*)(y), (void*)(z)); if ((x)==(y)) udelay(5)(__builtin_constant_p(5) ? __const_udelay((5) * 0x10c6ul) : __udelay (5)); } |
| 71 | #else |
| 72 | #define DEB_QUEUE(x) |
| 73 | #define LIST(x,y) |
| 74 | #define REMOVE(w,x,y,z) |
| 75 | #endif |
| 76 | #ifdef AM53C974_DEBUG_INFO |
| 77 | #define DEB_INFO(x) x |
| 78 | #else |
| 79 | #define DEB_INFO(x) |
| 80 | #endif |
| 81 | #ifdef AM53C974_DEBUG_LINKED |
| 82 | #define DEB_LINKED(x) x |
| 83 | #else |
| 84 | #define DEB_LINKED(x) |
| 85 | #endif |
| 86 | #ifdef AM53C974_DEBUG_INTR |
| 87 | #define DEB_INTR(x) x |
| 88 | #else |
| 89 | #define DEB_INTR(x) |
| 90 | #endif |
| 91 | #else |
| 92 | #define DEB_INIT(x) |
| 93 | #define DEB(x) |
| 94 | #define DEB_QUEUE(x) |
| 95 | #define LIST(x,y) |
| 96 | #define REMOVE(w,x,y,z) |
| 97 | #define DEB_INFO(x) |
| 98 | #define DEB_LINKED(x) |
| 99 | #define DEB_INTR(x) |
| 100 | #define DEB_MSG(x) |
| 101 | #define DEB_RESEL(x) |
| 102 | #define KEYWAIT() |
| 103 | #endif |
| 104 | #ifdef AM53C974_DEBUG_ABORT |
| 105 | #define DEB_ABORT(x)x x |
| 106 | #else |
| 107 | #define DEB_ABORT(x)x |
| 108 | #endif |
| 109 | |
| 110 | #ifdef VERBOSE_AM53C974_DEBUG |
| 111 | #define VDEB(x) x |
| 112 | #else |
| 113 | #define VDEB(x) |
| 114 | #endif |
| 115 | |
| 116 | #define INSIDE(x,l,h)( ((x) >= (l)) && ((x) <= (h)) ) ( ((x) >= (l)) && ((x) <= (h)) ) |
| 117 | |
| 118 | #ifdef AM53C974_DEBUG |
| 119 | static void AM53C974_print_pci(struct Scsi_Host *instance); |
| 120 | static void AM53C974_print_phase(struct Scsi_Host *instance); |
| 121 | static void AM53C974_print_queues(struct Scsi_Host *instance); |
| 122 | #endif /* AM53C974_DEBUG */ |
| 123 | static void AM53C974_print(struct Scsi_Host *instance); |
| 124 | static void AM53C974_keywait(void); |
| 125 | static int AM53C974_bios_detect(Scsi_Host_Template *tpnt); |
| 126 | static int AM53C974_nobios_detect(Scsi_Host_Template *tpnt); |
| 127 | static int AM53C974_init(Scsi_Host_Template *tpnt, pci_config_t pci_config); |
| 128 | static void AM53C974_config_after_reset(struct Scsi_Host *instance); |
| 129 | static __inline____inline__ __attribute__((always_inline)) void initialize_SCp(Scsi_Cmnd *cmd); |
| 130 | static __inline____inline__ __attribute__((always_inline)) void run_main(void); |
| 131 | static void AM53C974_main (void); |
| 132 | static void AM53C974_intr(int irq, void *dev_id, struct pt_regs *regs); |
| 133 | static void AM53C974_intr_disconnect(struct Scsi_Host *instance); |
| 134 | static int AM53C974_sync_neg(struct Scsi_Host *instance, int target, unsigned char *msg); |
| 135 | static __inline____inline__ __attribute__((always_inline)) void AM53C974_set_async(struct Scsi_Host *instance, int target); |
| 136 | static __inline____inline__ __attribute__((always_inline)) void AM53C974_set_sync(struct Scsi_Host *instance, int target); |
| 137 | static void AM53C974_information_transfer(struct Scsi_Host *instance, |
| 138 | unsigned char statreg, unsigned char isreg, |
| 139 | unsigned char instreg, unsigned char cfifo, |
| 140 | unsigned char dmastatus); |
| 141 | static int AM53C974_message(struct Scsi_Host *instance, Scsi_Cmnd *cmd, unsigned char msg); |
| 142 | static void AM53C974_select(struct Scsi_Host *instance, Scsi_Cmnd *cmd, int tag); |
| 143 | static void AM53C974_intr_reselect(struct Scsi_Host *instance, unsigned char statreg); |
| 144 | static __inline____inline__ __attribute__((always_inline)) void AM53C974_transfer_dma(struct Scsi_Host *instance, short dir, |
| 145 | unsigned long length, char *data); |
| 146 | static void AM53C974_dma_blast(struct Scsi_Host *instance, unsigned char dmastatus, |
| 147 | unsigned char statreg); |
| 148 | static void AM53C974_intr_bus_reset(struct Scsi_Host *instance); |
| 149 | |
| 150 | static struct Scsi_Host *first_instance = NULL((void *) 0); |
| 151 | static Scsi_Host_Template *the_template = NULL((void *) 0); |
| 152 | static struct Scsi_Host *first_host = NULL((void *) 0); /* Head of list of AMD boards */ |
| 153 | static volatile int main_running = 0; |
| 154 | static int commandline_current = 0; |
| 155 | override_t overrides[7] = { {-1, 0, 0, 0}, }; /* LILO overrides */ |
| 156 | |
| 157 | struct proc_dir_entry proc_scsi_am53c974 = { |
| 158 | PROC_SCSI_AM53C974, 8, "am53c974", |
| 159 | S_IFDIR0040000 | S_IRUGO(00400|00040|00004) | S_IXUGO(00100|00010|00001), 2 |
| 160 | }; |
| 161 | |
| 162 | #ifdef AM53C974_DEBUG |
| 163 | static int deb_stop = 1; |
| 164 | |
| 165 | /************************************************************************** |
| 166 | * Function : void AM53C974_print_pci(struct Scsi_Host *instance) |
| 167 | * |
| 168 | * Purpose : dump the PCI registers for debugging purposes |
| 169 | * |
| 170 | * Input : instance - which AM53C974 |
| 171 | **************************************************************************/ |
| 172 | static void AM53C974_print_pci(struct Scsi_Host *instance) |
| 173 | { |
| 174 | int i; |
| 175 | unsigned short vendor_id, device_id, command, status, scratch[8]; |
| 176 | unsigned long class_revision, base; |
| 177 | unsigned char irq, cache_line_size, latency_timer, header_type; |
| 178 | |
| 179 | AM53C974_PCIREG_OPEN()((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outbc((0xF1),(0xCF8)) : __outb((0xF1),(0xCF8))); ((__builtin_constant_p ((0xCFA)) && (0xCFA) < 256) ? __outbc((0),(0xCFA)) : __outb((0),(0xCFA))); |
| 180 | |
| 181 | for (i = 0; i < 8; i++) *(scratch + i) = AM53C974_PCIREG_READ_WORD(instance, PCI_SCRATCH_REG_0 + 2*i)( ((__builtin_constant_p(((0x40 + 2*i) + (instance)->io_port )) && ((0x40 + 2*i) + (instance)->io_port) < 256 ) ? __inwc((0x40 + 2*i) + (instance)->io_port) : __inw((0x40 + 2*i) + (instance)->io_port)) ); |
| 182 | vendor_id = AM53C974_PCIREG_READ_WORD(instance, PCI_VENDOR_ID)( ((__builtin_constant_p(((0x00) + (instance)->io_port)) && ((0x00) + (instance)->io_port) < 256) ? __inwc((0x00) + (instance)->io_port) : __inw((0x00) + (instance)->io_port )) ); |
| 183 | device_id = AM53C974_PCIREG_READ_WORD(instance, PCI_DEVICE_ID)( ((__builtin_constant_p(((0x02) + (instance)->io_port)) && ((0x02) + (instance)->io_port) < 256) ? __inwc((0x02) + (instance)->io_port) : __inw((0x02) + (instance)->io_port )) ); |
| 184 | command = AM53C974_PCIREG_READ_WORD(instance, PCI_COMMAND)( ((__builtin_constant_p(((0x04) + (instance)->io_port)) && ((0x04) + (instance)->io_port) < 256) ? __inwc((0x04) + (instance)->io_port) : __inw((0x04) + (instance)->io_port )) ); |
| 185 | status = AM53C974_PCIREG_READ_WORD(instance, PCI_STATUS)( ((__builtin_constant_p(((0x06) + (instance)->io_port)) && ((0x06) + (instance)->io_port) < 256) ? __inwc((0x06) + (instance)->io_port) : __inw((0x06) + (instance)->io_port )) ); |
| 186 | class_revision = AM53C974_PCIREG_READ_DWORD(instance, PCI_CLASS_REVISION)( ((__builtin_constant_p(((0x08) + (instance)->io_port)) && ((0x08) + (instance)->io_port) < 256) ? __inlc((0x08) + (instance)->io_port) : __inl((0x08) + (instance)->io_port )) ); |
| 187 | cache_line_size = AM53C974_PCIREG_READ_BYTE(instance, PCI_CACHE_LINE_SIZE)( ((__builtin_constant_p(((0x0c) + (instance)->io_port)) && ((0x0c) + (instance)->io_port) < 256) ? __inbc((0x0c) + (instance)->io_port) : __inb((0x0c) + (instance)->io_port )) ); |
| 188 | latency_timer = AM53C974_PCIREG_READ_BYTE(instance, PCI_LATENCY_TIMER)( ((__builtin_constant_p(((0x0d) + (instance)->io_port)) && ((0x0d) + (instance)->io_port) < 256) ? __inbc((0x0d) + (instance)->io_port) : __inb((0x0d) + (instance)->io_port )) ); |
| 189 | header_type = AM53C974_PCIREG_READ_BYTE(instance, PCI_HEADER_TYPE)( ((__builtin_constant_p(((0x0e) + (instance)->io_port)) && ((0x0e) + (instance)->io_port) < 256) ? __inbc((0x0e) + (instance)->io_port) : __inb((0x0e) + (instance)->io_port )) ); |
| 190 | base = AM53C974_PCIREG_READ_DWORD(instance, PCI_BASE_ADDRESS_0)( ((__builtin_constant_p(((0x10) + (instance)->io_port)) && ((0x10) + (instance)->io_port) < 256) ? __inlc((0x10) + (instance)->io_port) : __inl((0x10) + (instance)->io_port )) ); |
| 191 | irq = AM53C974_PCIREG_READ_BYTE(instance, PCI_INTERRUPT_LINE)( ((__builtin_constant_p(((0x3c) + (instance)->io_port)) && ((0x3c) + (instance)->io_port) < 256) ? __inbc((0x3c) + (instance)->io_port) : __inb((0x3c) + (instance)->io_port )) ); |
| 192 | |
| 193 | AM53C974_PCIREG_CLOSE()((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outbc((0),(0xCF8)) : __outb((0),(0xCF8))); |
| 194 | |
| 195 | |
| 196 | printk("------------- start of PCI register dump -------------\n"); |
| 197 | printk("PCI_VENDOR_ID: 0x%x\n", vendor_id); |
| 198 | printk("PCI_DEVICE_ID: 0x%x\n", device_id); |
| 199 | printk("PCI_COMMAND: 0x%x\n", command); |
| 200 | printk("PCI_STATUS: 0x%x\n", status); |
| 201 | printk("PCI_CLASS_REVISION: 0x%lx\n", class_revision); |
| 202 | printk("PCI_CACHE_LINE_SIZE: 0x%x\n", cache_line_size); |
| 203 | printk("PCI_LATENCY_TIMER: 0x%x\n", latency_timer); |
| 204 | printk("PCI_HEADER_TYPE: 0x%x\n", header_type); |
| 205 | printk("PCI_BASE_ADDRESS_0: 0x%lx\n", base); |
| 206 | printk("PCI_INTERRUPT_LINE: %d\n", irq); |
| 207 | for (i = 0; i < 8; i++) printk("PCI_SCRATCH_%d: 0x%x\n", i, scratch[i]); |
| 208 | printk("------------- end of PCI register dump -------------\n\n"); |
| 209 | } |
| 210 | |
| 211 | static struct { |
| 212 | unsigned char value; |
| 213 | char *name; |
| 214 | } phases[] = { |
| 215 | {PHASE_DATAOUT0x00, "DATAOUT"}, {PHASE_DATAIN0x01, "DATAIN"}, {PHASE_CMDOUT0x02, "CMDOUT"}, |
| 216 | {PHASE_STATIN0x03, "STATIN"}, {PHASE_MSGOUT0x06, "MSGOUT"}, {PHASE_MSGIN0x07, "MSGIN"}, |
| 217 | {PHASE_RES_00x04, "RESERVED 0"}, {PHASE_RES_10x05, "RESERVED 1"}}; |
| 218 | |
| 219 | /************************************************************************** |
| 220 | * Function : void AM53C974_print_phase(struct Scsi_Host *instance) |
| 221 | * |
| 222 | * Purpose : print the current SCSI phase for debugging purposes |
| 223 | * |
| 224 | * Input : instance - which AM53C974 |
| 225 | **************************************************************************/ |
| 226 | static void AM53C974_print_phase(struct Scsi_Host *instance) |
| 227 | { |
| 228 | AM53C974_local_declare()unsigned long io_port; |
| 229 | unsigned char statreg, latched; |
| 230 | int i; |
| 231 | AM53C974_setio(instance)io_port = instance->io_port; |
| 232 | |
| 233 | latched = (AM53C974_read_8(CNTLREG2)((__builtin_constant_p((io_port + (0x2C))) && (io_port + (0x2C)) < 256) ? __inbc(io_port + (0x2C)) : __inb(io_port + (0x2C)))) & CNTLREG2_ENF0x40; |
| 234 | statreg = AM53C974_read_8(STATREG)((__builtin_constant_p((io_port + (0x10))) && (io_port + (0x10)) < 256) ? __inbc(io_port + (0x10)) : __inb(io_port + (0x10))); |
| 235 | for (i = 0; (phases[i].value != PHASE_RES_10x05) && |
| 236 | (phases[i].value != (statreg & STATREG_PHASE0x07)); ++i); |
| 237 | if (latched) |
| 238 | printk("scsi%d : phase %s, latched at end of last command\n", instance->host_no, phases[i].name); |
| 239 | else |
| 240 | printk("scsi%d : phase %s, real time\n", instance->host_no, phases[i].name); |
| 241 | } |
| 242 | |
| 243 | /************************************************************************** |
| 244 | * Function : void AM53C974_print_queues(struct Scsi_Host *instance) |
| 245 | * |
| 246 | * Purpose : print commands in the various queues |
| 247 | * |
| 248 | * Inputs : instance - which AM53C974 |
| 249 | **************************************************************************/ |
| 250 | static void AM53C974_print_queues(struct Scsi_Host *instance) |
| 251 | { |
| 252 | struct AM53C974_hostdata *hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 253 | Scsi_Cmnd *ptr; |
| 254 | |
| 255 | printk("AM53C974: coroutine is%s running.\n", main_running ? "" : "n't"); |
| 256 | |
| 257 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 258 | |
| 259 | if (!hostdata->connected) { |
| 260 | printk ("scsi%d: no currently connected command\n", instance->host_no); } |
| 261 | else { |
| 262 | print_Scsi_Cmnd ((Scsi_Cmnd *)hostdata->connected); } |
| 263 | if (!hostdata->sel_cmd) { |
| 264 | printk ("scsi%d: no currently arbitrating command\n", instance->host_no); } |
| 265 | else { |
| 266 | print_Scsi_Cmnd ((Scsi_Cmnd *)hostdata->sel_cmd); } |
| 267 | |
| 268 | printk ("scsi%d: issue_queue ", instance->host_no); |
| 269 | if (!hostdata->issue_queue) |
| 270 | printk("empty\n"); |
| 271 | else { |
| 272 | printk(":\n"); |
| 273 | for (ptr = (Scsi_Cmnd *)hostdata->issue_queue; ptr; ptr = (Scsi_Cmnd *)ptr->host_scribble) |
| 274 | print_Scsi_Cmnd (ptr); } |
| 275 | |
| 276 | printk ("scsi%d: disconnected_queue ", instance->host_no); |
| 277 | if (!hostdata->disconnected_queue) |
| 278 | printk("empty\n"); |
| 279 | else { |
| 280 | printk(":\n"); |
| 281 | for (ptr = (Scsi_Cmnd *) hostdata->disconnected_queue; ptr; ptr = (Scsi_Cmnd *)ptr->host_scribble) |
| 282 | print_Scsi_Cmnd (ptr); } |
| 283 | |
| 284 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 285 | } |
| 286 | |
| 287 | #endif /* AM53C974_DEBUG */ |
| 288 | |
| 289 | /************************************************************************** |
| 290 | * Function : void AM53C974_print(struct Scsi_Host *instance) |
| 291 | * |
| 292 | * Purpose : dump the chip registers for debugging purposes |
| 293 | * |
| 294 | * Input : instance - which AM53C974 |
| 295 | **************************************************************************/ |
| 296 | static void AM53C974_print(struct Scsi_Host *instance) |
| 297 | { |
| 298 | AM53C974_local_declare()unsigned long io_port; |
| 299 | unsigned long ctcreg, dmastc, dmaspa, dmawbc, dmawac; |
| 300 | unsigned char cmdreg, statreg, isreg, cfireg, cntlreg[4], dmacmd, dmastatus; |
| 301 | AM53C974_setio(instance)io_port = instance->io_port; |
| 302 | |
| 303 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 304 | ctcreg = AM53C974_read_8(CTCHREG)((__builtin_constant_p((io_port + (0x38))) && (io_port + (0x38)) < 256) ? __inbc(io_port + (0x38)) : __inb(io_port + (0x38))) << 16; |
| 305 | ctcreg |= AM53C974_read_8(CTCMREG)((__builtin_constant_p((io_port + (0x04))) && (io_port + (0x04)) < 256) ? __inbc(io_port + (0x04)) : __inb(io_port + (0x04))) << 8; |
| 306 | ctcreg |= AM53C974_read_8(CTCLREG)((__builtin_constant_p((io_port + (0x00))) && (io_port + (0x00)) < 256) ? __inbc(io_port + (0x00)) : __inb(io_port + (0x00))); |
| 307 | cmdreg = AM53C974_read_8(CMDREG)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __inbc(io_port + (0x0C)) : __inb(io_port + (0x0C))); |
| 308 | statreg = AM53C974_read_8(STATREG)((__builtin_constant_p((io_port + (0x10))) && (io_port + (0x10)) < 256) ? __inbc(io_port + (0x10)) : __inb(io_port + (0x10))); |
| 309 | isreg = AM53C974_read_8(ISREG)((__builtin_constant_p((io_port + (0x18))) && (io_port + (0x18)) < 256) ? __inbc(io_port + (0x18)) : __inb(io_port + (0x18))); |
| 310 | cfireg = AM53C974_read_8(CFIREG)((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __inbc(io_port + (0x1C)) : __inb(io_port + (0x1C))); |
| 311 | cntlreg[0] = AM53C974_read_8(CNTLREG1)((__builtin_constant_p((io_port + (0x20))) && (io_port + (0x20)) < 256) ? __inbc(io_port + (0x20)) : __inb(io_port + (0x20))); |
| 312 | cntlreg[1] = AM53C974_read_8(CNTLREG2)((__builtin_constant_p((io_port + (0x2C))) && (io_port + (0x2C)) < 256) ? __inbc(io_port + (0x2C)) : __inb(io_port + (0x2C))); |
| 313 | cntlreg[2] = AM53C974_read_8(CNTLREG3)((__builtin_constant_p((io_port + (0x30))) && (io_port + (0x30)) < 256) ? __inbc(io_port + (0x30)) : __inb(io_port + (0x30))); |
| 314 | cntlreg[3] = AM53C974_read_8(CNTLREG4)((__builtin_constant_p((io_port + (0x34))) && (io_port + (0x34)) < 256) ? __inbc(io_port + (0x34)) : __inb(io_port + (0x34))); |
| 315 | dmacmd = AM53C974_read_8(DMACMD)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __inbc(io_port + (0x40)) : __inb(io_port + (0x40))); |
| 316 | dmastc = AM53C974_read_32(DMASTC)((__builtin_constant_p((io_port + (0x44))) && (io_port + (0x44)) < 256) ? __inlc(io_port + (0x44)) : __inl(io_port + (0x44))); |
| 317 | dmaspa = AM53C974_read_32(DMASPA)((__builtin_constant_p((io_port + (0x48))) && (io_port + (0x48)) < 256) ? __inlc(io_port + (0x48)) : __inl(io_port + (0x48))); |
| 318 | dmawbc = AM53C974_read_32(DMAWBC)((__builtin_constant_p((io_port + (0x4C))) && (io_port + (0x4C)) < 256) ? __inlc(io_port + (0x4C)) : __inl(io_port + (0x4C))); |
| 319 | dmawac = AM53C974_read_32(DMAWAC)((__builtin_constant_p((io_port + (0x50))) && (io_port + (0x50)) < 256) ? __inlc(io_port + (0x50)) : __inl(io_port + (0x50))); |
| 320 | dmastatus = AM53C974_read_8(DMASTATUS)((__builtin_constant_p((io_port + (0x54))) && (io_port + (0x54)) < 256) ? __inbc(io_port + (0x54)) : __inb(io_port + (0x54))); |
| 321 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 322 | |
| 323 | printk("AM53C974 register dump:\n"); |
| 324 | printk("IO base: 0x%04lx; CTCREG: 0x%04lx; CMDREG: 0x%02x; STATREG: 0x%02x; ISREG: 0x%02x\n", |
| 325 | io_port, ctcreg, cmdreg, statreg, isreg); |
| 326 | printk("CFIREG: 0x%02x; CNTLREG1-4: 0x%02x; 0x%02x; 0x%02x; 0x%02x\n", |
| 327 | cfireg, cntlreg[0], cntlreg[1], cntlreg[2], cntlreg[3]); |
| 328 | printk("DMACMD: 0x%02x; DMASTC: 0x%04lx; DMASPA: 0x%04lx\n", dmacmd, dmastc, dmaspa); |
| 329 | printk("DMAWBC: 0x%04lx; DMAWAC: 0x%04lx; DMASTATUS: 0x%02x\n", dmawbc, dmawac, dmastatus); |
| 330 | printk("---------------------------------------------------------\n"); |
| 331 | } |
| 332 | |
| 333 | /************************************************************************** |
| 334 | * Function : void AM53C974_keywait(void) |
| 335 | * |
| 336 | * Purpose : wait until a key is pressed, if it was the 'r' key leave singlestep mode; |
| 337 | * this function is used for debugging only |
| 338 | * |
| 339 | * Input : none |
| 340 | **************************************************************************/ |
| 341 | static void AM53C974_keywait(void) |
| 342 | { |
| 343 | #ifdef AM53C974_DEBUG |
| 344 | int key; |
| 345 | |
| 346 | if (!deb_stop) return; |
| 347 | #endif |
| 348 | |
| 349 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 350 | while ((inb_p(0x64)((__builtin_constant_p((0x64)) && (0x64) < 256) ? __inbc_p (0x64) : __inb_p(0x64)) & 0x01) != 0x01) ; |
| 351 | #ifdef AM53C974_DEBUG |
| 352 | key = inb(0x60)((__builtin_constant_p((0x60)) && (0x60) < 256) ? __inbc (0x60) : __inb(0x60)); |
| 353 | if (key == 0x93) deb_stop = 0; /* don't stop if 'r' was pressed */ |
| 354 | #endif |
| 355 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 356 | } |
| 357 | |
| 358 | /************************************************************************** |
| 359 | * Function : AM53C974_setup(char *str, int *ints) |
| 360 | * |
| 361 | * Purpose : LILO command line initialization of the overrides array, |
| 362 | * |
| 363 | * Inputs : str - unused, ints - array of integer parameters with ints[0] |
| 364 | * equal to the number of ints. |
| 365 | * |
| 366 | * NOTE : this function needs to be declared as an external function |
| 367 | * in init/main.c and included there in the bootsetups list |
| 368 | ***************************************************************************/ |
| 369 | void AM53C974_setup(char *str, int *ints) |
| 370 | { |
| 371 | if (ints[0] < 4) |
| 372 | printk("AM53C974_setup: wrong number of parameters;\n correct syntax is: AM53C974=host-scsi-id, target-scsi-id, max-rate, max-offset\n"); |
| 373 | else { |
| 374 | if (commandline_current < (sizeof(overrides) / sizeof(override_t))) { |
| 375 | if ((ints[1] < 0) || (ints[1] > 7) || |
| 376 | (ints[2] < 0) || (ints[2] > 7) || |
| 377 | (ints[1] == ints[2]) || |
| 378 | (ints[3] < (DEF_CLK40 / MAX_PERIOD13)) || (ints[3] > (DEF_CLK40 / MIN_PERIOD4)) || |
| 379 | (ints[4] < 0) || (ints[4] > MAX_OFFSET15)) |
| 380 | printk("AM53C974_setup: illegal parameter\n"); |
| 381 | else { |
| 382 | overrides[commandline_current].host_scsi_id = ints[1]; |
| 383 | overrides[commandline_current].target_scsi_id = ints[2]; |
| 384 | overrides[commandline_current].max_rate = ints[3]; |
| 385 | overrides[commandline_current].max_offset = ints[4]; |
| 386 | commandline_current++; } |
| 387 | } |
| 388 | else |
| 389 | printk("AM53C974_setup: too many overrides\n"); |
| 390 | } |
| 391 | } |
| 392 | |
| 393 | #if defined (CONFIG_PCI1) |
| 394 | /************************************************************************** |
| 395 | * Function : int AM53C974_bios_detect(Scsi_Host_Template *tpnt) |
| 396 | * |
| 397 | * Purpose : detects and initializes AM53C974 SCSI chips with PCI Bios |
| 398 | * |
| 399 | * Inputs : tpnt - host template |
| 400 | * |
| 401 | * Returns : number of host adapters detected |
| 402 | **************************************************************************/ |
| 403 | int AM53C974_bios_detect(Scsi_Host_Template *tpnt) |
| 404 | { |
| 405 | int count = 0; /* number of boards detected */ |
| 406 | int pci_index; |
| 407 | pci_config_t pci_config; |
| 408 | |
| 409 | for (pci_index = 0; pci_index <= 16; ++pci_index) { |
| 410 | unsigned char pci_bus, pci_device_fn; |
| 411 | if (pcibios_find_device(PCI_VENDOR_ID_AMD0x1022, PCI_DEVICE_ID_AMD_SCSI0x2020, pci_index, &pci_bus, &pci_device_fn) != 0) |
| 412 | break; |
| 413 | |
| 414 | pcibios_read_config_word(pci_bus, pci_device_fn, PCI_VENDOR_ID0x00, &pci_config._vendordv_id.dv.vendor); |
| 415 | pcibios_read_config_word(pci_bus, pci_device_fn, PCI_DEVICE_ID0x02, &pci_config._devicedv_id.dv.device); |
| 416 | pcibios_read_config_word(pci_bus, pci_device_fn, PCI_COMMAND0x04, &pci_config._commandstat_cmd.sc.command); |
| 417 | pcibios_read_config_word(pci_bus, pci_device_fn, PCI_STATUS0x06, &pci_config._statusstat_cmd.sc.status); |
| 418 | pcibios_read_config_dword(pci_bus, pci_device_fn, PCI_CLASS_REVISION0x08, &pci_config._class_revisionclass_rev.class_revision); |
| 419 | pcibios_read_config_byte(pci_bus, pci_device_fn, PCI_CACHE_LINE_SIZE0x0c, &pci_config._cache_line_sizebhlc.bhlc.cache_line_size); |
| 420 | pcibios_read_config_byte(pci_bus, pci_device_fn, PCI_LATENCY_TIMER0x0d, &pci_config._latency_timerbhlc.bhlc.latency_timer); |
| 421 | pcibios_read_config_byte(pci_bus, pci_device_fn, PCI_HEADER_TYPE0x0e, &pci_config._header_typebhlc.bhlc.header_type); |
| 422 | pcibios_read_config_byte(pci_bus, pci_device_fn, PCI_BIST0x0f, &pci_config._bistbhlc.bhlc.bist); |
| 423 | pcibios_read_config_dword(pci_bus, pci_device_fn, PCI_BASE_ADDRESS_00x10, &pci_config._base0); |
| 424 | pcibios_read_config_dword(pci_bus, pci_device_fn, PCI_BASE_ADDRESS_10x14, &pci_config._base1); |
| 425 | pcibios_read_config_dword(pci_bus, pci_device_fn, PCI_BASE_ADDRESS_20x18, &pci_config._base2); |
| 426 | pcibios_read_config_dword(pci_bus, pci_device_fn, PCI_BASE_ADDRESS_30x1c, &pci_config._base3); |
| 427 | pcibios_read_config_dword(pci_bus, pci_device_fn, PCI_BASE_ADDRESS_40x20, &pci_config._base4); |
| 428 | pcibios_read_config_dword(pci_bus, pci_device_fn, PCI_BASE_ADDRESS_50x24, &pci_config._base5); |
| 429 | pcibios_read_config_dword(pci_bus, pci_device_fn, PCI_ROM_ADDRESS0x30, &pci_config._baserom); |
| 430 | pcibios_read_config_byte(pci_bus, pci_device_fn, PCI_INTERRUPT_LINE0x3c, &pci_config._int_linemmii.mmii.int_line); |
| 431 | pcibios_read_config_byte(pci_bus, pci_device_fn, PCI_INTERRUPT_PIN0x3d, &pci_config._int_pinmmii.mmii.int_pin); |
| 432 | pcibios_read_config_byte(pci_bus, pci_device_fn, PCI_MIN_GNT0x3e, &pci_config._min_gntmmii.mmii.min_gnt); |
| 433 | pcibios_read_config_byte(pci_bus, pci_device_fn, PCI_MAX_LAT0x3f, &pci_config._max_latmmii.mmii.max_lat); |
| 434 | pci_config._pcibus = 0xFFFFFFFF; |
| 435 | pci_config._cardnum = 0xFFFFFFFF; |
| 436 | |
| 437 | /* check whether device is I/O mapped -- should be */ |
| 438 | if (!(pci_config._commandstat_cmd.sc.command & PCI_COMMAND_IO0x1)) continue; |
| 439 | |
| 440 | /* PCI Spec 2.1 states that it is either the driver's or the PCI card's responsibility |
| 441 | to set the PCI Master Enable Bit if needed. |
| 442 | (from Mark Stockton <marks@schooner.sys.hou.compaq.com>) */ |
| 443 | if (!(pci_config._commandstat_cmd.sc.command & PCI_COMMAND_MASTER0x4)) { |
| 444 | pci_config._commandstat_cmd.sc.command |= PCI_COMMAND_MASTER0x4; |
| 445 | printk("PCI Master Bit has not been set. Setting...\n"); |
| 446 | pcibios_write_config_word(pci_bus, pci_device_fn, PCI_COMMAND0x04, pci_config._commandstat_cmd.sc.command); } |
| 447 | |
| 448 | /* everything seems OK now, so initialize */ |
| 449 | if (AM53C974_init(tpnt, pci_config)) count++ ; |
| 450 | } |
| 451 | return (count); |
| 452 | } |
| 453 | #endif |
| 454 | |
| 455 | /************************************************************************** |
| 456 | * Function : int AM53C974_nobios_detect(Scsi_Host_Template *tpnt) |
| 457 | * |
| 458 | * Purpose : detects and initializes AM53C974 SCSI chips using PCI config 2 |
| 459 | * |
| 460 | * Inputs : tpnt - host template |
| 461 | * |
| 462 | * Returns : number of host adapters detected |
| 463 | * |
| 464 | * NOTE : This code assumes the controller on PCI bus 0. |
| 465 | * |
| 466 | * Origin: Robin Cutshaw (robin@xfree86.org) |
| 467 | **************************************************************************/ |
| 468 | int AM53C974_nobios_detect(Scsi_Host_Template *tpnt) |
| 469 | { |
| 470 | int count = 0; /* number of boards detected */ |
| 471 | pci_config_t pci_config; |
| 472 | |
| 473 | /* first try PCI config method 1 */ |
| 474 | for (pci_config._pcibus = 0; pci_config._pcibus < 0x10; pci_config._pcibus++) { |
| 475 | for (pci_config._cardnum = 0; pci_config._cardnum < 0x20; pci_config._cardnum++) { |
| 476 | unsigned long config_cmd; |
| 477 | config_cmd = 0x80000000 | (pci_config._pcibus<<16) | (pci_config._cardnum<<11); |
| 478 | |
| 479 | outl(config_cmd, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outlc((config_cmd),(0xCF8)) : __outl((config_cmd),(0xCF8)) ); /* ioreg 0 */ |
| 480 | pci_config._device_vendordv_id.device_vendor = inl(0xCFC)((__builtin_constant_p((0xCFC)) && (0xCFC) < 256) ? __inlc(0xCFC) : __inl(0xCFC)); |
| 481 | |
| 482 | if ((pci_config._vendordv_id.dv.vendor == PCI_VENDOR_ID_AMD0x1022) && (pci_config._devicedv_id.dv.device == PCI_DEVICE_ID_AMD_SCSI0x2020)) { |
| 483 | outl(config_cmd | PCI_COMMAND, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outlc((config_cmd | 0x04),(0xCF8)) : __outl((config_cmd | 0x04 ),(0xCF8))); pci_config._status_commandstat_cmd.status_command = inl(0xCFC)((__builtin_constant_p((0xCFC)) && (0xCFC) < 256) ? __inlc(0xCFC) : __inl(0xCFC)); |
| 484 | outl(config_cmd | PCI_CLASS_REVISION, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outlc((config_cmd | 0x08),(0xCF8)) : __outl((config_cmd | 0x08 ),(0xCF8))); pci_config._class_revisionclass_rev.class_revision = inl(0xCFC)((__builtin_constant_p((0xCFC)) && (0xCFC) < 256) ? __inlc(0xCFC) : __inl(0xCFC)); |
| 485 | outl(config_cmd | PCI_CACHE_LINE_SIZE, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outlc((config_cmd | 0x0c),(0xCF8)) : __outl((config_cmd | 0x0c ),(0xCF8))); pci_config._bist_header_latency_cachebhlc.bist_header_latency_cache = inl(0xCFC)((__builtin_constant_p((0xCFC)) && (0xCFC) < 256) ? __inlc(0xCFC) : __inl(0xCFC)); |
| 486 | outl(config_cmd | PCI_BASE_ADDRESS_0, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outlc((config_cmd | 0x10),(0xCF8)) : __outl((config_cmd | 0x10 ),(0xCF8))); pci_config._base0 = inl(0xCFC)((__builtin_constant_p((0xCFC)) && (0xCFC) < 256) ? __inlc(0xCFC) : __inl(0xCFC)); |
| 487 | outl(config_cmd | PCI_BASE_ADDRESS_1, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outlc((config_cmd | 0x14),(0xCF8)) : __outl((config_cmd | 0x14 ),(0xCF8))); pci_config._base1 = inl(0xCFC)((__builtin_constant_p((0xCFC)) && (0xCFC) < 256) ? __inlc(0xCFC) : __inl(0xCFC)); |
| 488 | outl(config_cmd | PCI_BASE_ADDRESS_2, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outlc((config_cmd | 0x18),(0xCF8)) : __outl((config_cmd | 0x18 ),(0xCF8))); pci_config._base2 = inl(0xCFC)((__builtin_constant_p((0xCFC)) && (0xCFC) < 256) ? __inlc(0xCFC) : __inl(0xCFC)); |
| 489 | outl(config_cmd | PCI_BASE_ADDRESS_3, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outlc((config_cmd | 0x1c),(0xCF8)) : __outl((config_cmd | 0x1c ),(0xCF8))); pci_config._base3 = inl(0xCFC)((__builtin_constant_p((0xCFC)) && (0xCFC) < 256) ? __inlc(0xCFC) : __inl(0xCFC)); |
| 490 | outl(config_cmd | PCI_BASE_ADDRESS_4, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outlc((config_cmd | 0x20),(0xCF8)) : __outl((config_cmd | 0x20 ),(0xCF8))); pci_config._base4 = inl(0xCFC)((__builtin_constant_p((0xCFC)) && (0xCFC) < 256) ? __inlc(0xCFC) : __inl(0xCFC)); |
| 491 | outl(config_cmd | PCI_BASE_ADDRESS_5, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outlc((config_cmd | 0x24),(0xCF8)) : __outl((config_cmd | 0x24 ),(0xCF8))); pci_config._base5 = inl(0xCFC)((__builtin_constant_p((0xCFC)) && (0xCFC) < 256) ? __inlc(0xCFC) : __inl(0xCFC)); |
| 492 | outl(config_cmd | PCI_ROM_ADDRESS, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outlc((config_cmd | 0x30),(0xCF8)) : __outl((config_cmd | 0x30 ),(0xCF8))); pci_config._baserom = inl(0xCFC)((__builtin_constant_p((0xCFC)) && (0xCFC) < 256) ? __inlc(0xCFC) : __inl(0xCFC)); |
| 493 | outl(config_cmd | PCI_INTERRUPT_LINE, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outlc((config_cmd | 0x3c),(0xCF8)) : __outl((config_cmd | 0x3c ),(0xCF8))); pci_config._max_min_ipin_ilinemmii.max_min_ipin_iline = inl(0xCFC)((__builtin_constant_p((0xCFC)) && (0xCFC) < 256) ? __inlc(0xCFC) : __inl(0xCFC)); |
| 494 | |
| 495 | /* check whether device is I/O mapped -- should be */ |
| 496 | if (!(pci_config._commandstat_cmd.sc.command & PCI_COMMAND_IO0x1)) continue; |
| 497 | |
| 498 | /* PCI Spec 2.1 states that it is either the driver's or the PCI card's responsibility |
| 499 | to set the PCI Master Enable Bit if needed. |
| 500 | From Mark Stockton <marks@schooner.sys.hou.compaq.com> */ |
| 501 | if (!(pci_config._commandstat_cmd.sc.command & PCI_COMMAND_MASTER0x4)) { |
| 502 | pci_config._commandstat_cmd.sc.command |= PCI_COMMAND_MASTER0x4; |
| 503 | printk("Config 1; PCI Master Bit has not been set. Setting...\n"); |
| 504 | outl(config_cmd | PCI_COMMAND, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outlc((config_cmd | 0x04),(0xCF8)) : __outl((config_cmd | 0x04 ),(0xCF8))); outw(pci_config._command, 0xCFC)((__builtin_constant_p((0xCFC)) && (0xCFC) < 256) ? __outwc((pci_config.stat_cmd.sc.command),(0xCFC)) : __outw(( pci_config.stat_cmd.sc.command),(0xCFC))); } |
| 505 | |
| 506 | /* everything seems OK now, so initialize */ |
| 507 | if (AM53C974_init(tpnt, pci_config)) count++ ; |
| 508 | } |
| 509 | } |
| 510 | } |
| 511 | outb(0, 0xCF8)((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outbc((0),(0xCF8)) : __outb((0),(0xCF8))); /* is this really necessary? */ |
| 512 | |
| 513 | /* try PCI config method 2, if no device was detected by method 1 */ |
| 514 | if (!count) { |
| 515 | AM53C974_PCIREG_OPEN()((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outbc((0xF1),(0xCF8)) : __outb((0xF1),(0xCF8))); ((__builtin_constant_p ((0xCFA)) && (0xCFA) < 256) ? __outbc((0),(0xCFA)) : __outb((0),(0xCFA))); |
| 516 | |
| 517 | pci_config._pcibus = 0xFFFFFFFF; |
| 518 | pci_config._cardnum = 0xFFFFFFFF; |
| 519 | |
| 520 | for (pci_config._ioaddr = 0xC000; pci_config._ioaddr < 0xD000; pci_config._ioaddr += 0x0100) { |
| 521 | pci_config._device_vendordv_id.device_vendor = inl(pci_config._ioaddr)((__builtin_constant_p((pci_config._ioaddr)) && (pci_config ._ioaddr) < 256) ? __inlc(pci_config._ioaddr) : __inl(pci_config ._ioaddr)); |
| 522 | |
| 523 | if ((pci_config._vendordv_id.dv.vendor == PCI_VENDOR_ID_AMD0x1022) && (pci_config._devicedv_id.dv.device == PCI_DEVICE_ID_AMD_SCSI0x2020)) { |
| 524 | pci_config._status_commandstat_cmd.status_command = inl(pci_config._ioaddr + PCI_COMMAND)((__builtin_constant_p((pci_config._ioaddr + 0x04)) && (pci_config._ioaddr + 0x04) < 256) ? __inlc(pci_config._ioaddr + 0x04) : __inl(pci_config._ioaddr + 0x04)); |
| 525 | pci_config._class_revisionclass_rev.class_revision = inl(pci_config._ioaddr + PCI_CLASS_REVISION)((__builtin_constant_p((pci_config._ioaddr + 0x08)) && (pci_config._ioaddr + 0x08) < 256) ? __inlc(pci_config._ioaddr + 0x08) : __inl(pci_config._ioaddr + 0x08)); |
| 526 | pci_config._bist_header_latency_cachebhlc.bist_header_latency_cache = inl(pci_config._ioaddr + PCI_CACHE_LINE_SIZE)((__builtin_constant_p((pci_config._ioaddr + 0x0c)) && (pci_config._ioaddr + 0x0c) < 256) ? __inlc(pci_config._ioaddr + 0x0c) : __inl(pci_config._ioaddr + 0x0c)); |
| 527 | pci_config._base0 = inl(pci_config._ioaddr + PCI_BASE_ADDRESS_0)((__builtin_constant_p((pci_config._ioaddr + 0x10)) && (pci_config._ioaddr + 0x10) < 256) ? __inlc(pci_config._ioaddr + 0x10) : __inl(pci_config._ioaddr + 0x10)); |
| 528 | pci_config._base1 = inl(pci_config._ioaddr + PCI_BASE_ADDRESS_1)((__builtin_constant_p((pci_config._ioaddr + 0x14)) && (pci_config._ioaddr + 0x14) < 256) ? __inlc(pci_config._ioaddr + 0x14) : __inl(pci_config._ioaddr + 0x14)); |
| 529 | pci_config._base2 = inl(pci_config._ioaddr + PCI_BASE_ADDRESS_2)((__builtin_constant_p((pci_config._ioaddr + 0x18)) && (pci_config._ioaddr + 0x18) < 256) ? __inlc(pci_config._ioaddr + 0x18) : __inl(pci_config._ioaddr + 0x18)); |
| 530 | pci_config._base3 = inl(pci_config._ioaddr + PCI_BASE_ADDRESS_3)((__builtin_constant_p((pci_config._ioaddr + 0x1c)) && (pci_config._ioaddr + 0x1c) < 256) ? __inlc(pci_config._ioaddr + 0x1c) : __inl(pci_config._ioaddr + 0x1c)); |
| 531 | pci_config._base4 = inl(pci_config._ioaddr + PCI_BASE_ADDRESS_4)((__builtin_constant_p((pci_config._ioaddr + 0x20)) && (pci_config._ioaddr + 0x20) < 256) ? __inlc(pci_config._ioaddr + 0x20) : __inl(pci_config._ioaddr + 0x20)); |
| 532 | pci_config._base5 = inl(pci_config._ioaddr + PCI_BASE_ADDRESS_5)((__builtin_constant_p((pci_config._ioaddr + 0x24)) && (pci_config._ioaddr + 0x24) < 256) ? __inlc(pci_config._ioaddr + 0x24) : __inl(pci_config._ioaddr + 0x24)); |
| 533 | pci_config._baserom = inl(pci_config._ioaddr + PCI_ROM_ADDRESS)((__builtin_constant_p((pci_config._ioaddr + 0x30)) && (pci_config._ioaddr + 0x30) < 256) ? __inlc(pci_config._ioaddr + 0x30) : __inl(pci_config._ioaddr + 0x30)); |
| 534 | pci_config._max_min_ipin_ilinemmii.max_min_ipin_iline = inl(pci_config._ioaddr + PCI_INTERRUPT_LINE)((__builtin_constant_p((pci_config._ioaddr + 0x3c)) && (pci_config._ioaddr + 0x3c) < 256) ? __inlc(pci_config._ioaddr + 0x3c) : __inl(pci_config._ioaddr + 0x3c)); |
| 535 | |
| 536 | /* check whether device is I/O mapped -- should be */ |
| 537 | if (!(pci_config._commandstat_cmd.sc.command & PCI_COMMAND_IO0x1)) continue; |
| 538 | |
| 539 | /* PCI Spec 2.1 states that it is either the driver's or the PCI card's responsibility |
| 540 | to set the PCI Master Enable Bit if needed. |
| 541 | From Mark Stockton <marks@schooner.sys.hou.compaq.com> */ |
| 542 | if (!(pci_config._commandstat_cmd.sc.command & PCI_COMMAND_MASTER0x4)) { |
| 543 | pci_config._commandstat_cmd.sc.command |= PCI_COMMAND_MASTER0x4; |
| 544 | printk("Config 2; PCI Master Bit has not been set. Setting...\n"); |
| 545 | outw(pci_config._command, pci_config._ioaddr + PCI_COMMAND)((__builtin_constant_p((pci_config._ioaddr + 0x04)) && (pci_config._ioaddr + 0x04) < 256) ? __outwc((pci_config. stat_cmd.sc.command),(pci_config._ioaddr + 0x04)) : __outw((pci_config .stat_cmd.sc.command),(pci_config._ioaddr + 0x04))); } |
| 546 | |
| 547 | /* everything seems OK now, so initialize */ |
| 548 | if (AM53C974_init(tpnt, pci_config)) count++ ; |
| 549 | } |
| 550 | } |
| 551 | AM53C974_PCIREG_CLOSE()((__builtin_constant_p((0xCF8)) && (0xCF8) < 256) ? __outbc((0),(0xCF8)) : __outb((0),(0xCF8))); |
| 552 | } |
| 553 | |
| 554 | return(count); |
| 555 | } |
| 556 | |
| 557 | /************************************************************************** |
| 558 | * Function : int AM53C974_detect(Scsi_Host_Template *tpnt) |
| 559 | * |
| 560 | * Purpose : detects and initializes AM53C974 SCSI chips |
| 561 | * |
| 562 | * Inputs : tpnt - host template |
| 563 | * |
| 564 | * Returns : number of host adapters detected |
| 565 | **************************************************************************/ |
| 566 | int AM53C974_detect(Scsi_Host_Template *tpnt) |
| 567 | { |
| 568 | int count; /* number of boards detected */ |
| 569 | |
| 570 | tpnt->proc_dir = &proc_scsi_am53c974; |
| 571 | |
| 572 | #if defined (CONFIG_PCI1) |
| 573 | if (pcibios_present()) |
| 574 | count = AM53C974_bios_detect(tpnt); |
| 575 | else |
| 576 | #endif |
| 577 | count = AM53C974_nobios_detect(tpnt); |
| 578 | return (count); |
| 579 | } |
| 580 | |
| 581 | /************************************************************************** |
| 582 | * Function : int AM53C974_init(Scsi_Host_Template *tpnt, pci_config_t pci_config) |
| 583 | * |
| 584 | * Purpose : initializes instance and corresponding AM53/79C974 chip, |
| 585 | * |
| 586 | * Inputs : tpnt - template, pci_config - PCI configuration, |
| 587 | * |
| 588 | * Returns : 1 on success, 0 on failure. |
| 589 | * |
| 590 | * NOTE: If no override for the controller's SCSI id is given and AM53C974_SCSI_ID |
| 591 | * is not defined we assume that the SCSI address of this controller is correctly |
| 592 | * set up by the BIOS (as reflected by contents of register CNTLREG1). |
| 593 | * This is the only BIOS assistance we need. |
| 594 | **************************************************************************/ |
| 595 | static int AM53C974_init(Scsi_Host_Template *tpnt, pci_config_t pci_config) |
| 596 | { |
| 597 | AM53C974_local_declare()unsigned long io_port; |
| 598 | int i, j; |
| 599 | struct Scsi_Host *instance, *search; |
| 600 | struct AM53C974_hostdata *hostdata; |
| 601 | |
| 602 | #ifdef AM53C974_OPTION_DEBUG_PROBE_ONLY |
| 603 | printk ("AM53C974: probe only enabled, aborting initialization\n"); |
| 604 | return 0; |
| 605 | #endif |
| 606 | |
| 607 | instance = scsi_register(tpnt, sizeof(struct AM53C974_hostdata)); |
| 608 | hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 609 | instance->base = NULL((void *) 0); |
| 610 | instance->io_port = pci_config._base0 & (pci_config._base0 & 0x1 ? |
| 611 | 0xFFFFFFFC : 0xFFFFFFF0); |
| 612 | instance->irq = pci_config._int_linemmii.mmii.int_line; |
| 613 | instance->dma_channel = -1; |
| 614 | AM53C974_setio(instance)io_port = instance->io_port; |
| 615 | |
| 616 | #ifdef AM53C974_SCSI_ID |
| 617 | instance->this_id = AM53C974_SCSI_ID; |
| 618 | AM53C974_write_8(CNTLREG1, instance->this_id & CNTLREG1_SID)((__builtin_constant_p((io_port + (0x20))) && (io_port + (0x20)) < 256) ? __outbc(((instance->this_id & 0x07 )),(io_port + (0x20))) : __outb(((instance->this_id & 0x07 )),(io_port + (0x20)))); |
| 619 | #else |
| 620 | instance->this_id = AM53C974_read_8(CNTLREG1)((__builtin_constant_p((io_port + (0x20))) && (io_port + (0x20)) < 256) ? __inbc(io_port + (0x20)) : __inb(io_port + (0x20))) & CNTLREG1_SID0x07; |
| 621 | if (instance->this_id != 7) |
| 622 | printk("scsi%d: WARNING: unusual hostadapter SCSI id %d; please verify!\n", |
| 623 | instance->host_no, instance->this_id); |
| 624 | #endif |
| 625 | |
| 626 | for (i = 0; i < sizeof(hostdata->msgout); i++) { |
| 627 | hostdata->msgout[i] = NOP0x08; |
| 628 | hostdata->last_message[i] = NOP0x08; } |
| 629 | for (i = 0; i < 8; i++) { |
| 630 | hostdata->busy[i] = 0; |
| 631 | hostdata->sync_per[i] = DEF_STP8; |
| 632 | hostdata->sync_off[i] = 0; |
| 633 | hostdata->sync_neg[i] = 0; |
| 634 | hostdata->sync_en[i] = DEFAULT_SYNC_NEGOTIATION_ENABLED0; |
| 635 | hostdata->max_rate[i] = DEFAULT_RATE5; |
| 636 | hostdata->max_offset[i] = DEFAULT_SYNC_OFFSET0; } |
| 637 | |
| 638 | /* overwrite defaults by LILO overrides */ |
| 639 | for (i = 0; i < commandline_current; i++) { |
| 640 | if (overrides[i].host_scsi_id == instance->this_id) { |
| 641 | j = overrides[i].target_scsi_id; |
| 642 | hostdata->sync_en[j] = 1; |
| 643 | hostdata->max_rate[j] = overrides[i].max_rate; |
| 644 | hostdata->max_offset[j] = overrides[i].max_offset; |
| 645 | } |
| 646 | } |
| 647 | |
| 648 | hostdata->sel_cmd = NULL((void *) 0); |
| 649 | hostdata->connected = NULL((void *) 0); |
| 650 | hostdata->issue_queue = NULL((void *) 0); |
| 651 | hostdata->disconnected_queue = NULL((void *) 0); |
| 652 | hostdata->in_reset = 0; |
| 653 | hostdata->aborted = 0; |
| 654 | hostdata->selecting = 0; |
| 655 | hostdata->disconnecting = 0; |
| 656 | hostdata->dma_busy = 0; |
| 657 | |
| 658 | /* Set up an interrupt handler if we aren't already sharing an IRQ with another board */ |
| 659 | for (search = first_host; |
| 660 | search && ( ((the_template != NULL((void *) 0)) && (search->hostt != the_template)) || |
| 661 | (search->irq != instance->irq) || (search == instance) ); |
| 662 | search = search->next); |
| 663 | if (!search) { |
| 664 | if (request_irq(instance->irq, AM53C974_intr, SA_INTERRUPT0x20000000, "AM53C974", NULL((void *) 0))) { |
| 665 | printk("scsi%d: IRQ%d not free, detaching\n", instance->host_no, instance->irq); |
| 666 | scsi_unregister(instance); |
| 667 | return 0; } |
| 668 | } |
| 669 | else { |
| 670 | printk("scsi%d: using interrupt handler previously installed for scsi%d\n", |
| 671 | instance->host_no, search->host_no); } |
| 672 | |
| 673 | if (!the_template) { |
| 674 | the_template = instance->hostt; |
| 675 | first_instance = instance; } |
| 676 | |
| 677 | /* do hard reset */ |
| 678 | AM53C974_write_8(CMDREG, CMDREG_RDEV)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x02)),(io_port + (0x0C))) : __outb(((0x02)),(io_port + (0x0C)))); /* reset device */ |
| 679 | udelay(5)(__builtin_constant_p(5) ? __const_udelay((5) * 0x10c6ul) : __udelay (5)); |
| 680 | AM53C974_write_8(CMDREG, CMDREG_NOP)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x00)),(io_port + (0x0C))) : __outb(((0x00)),(io_port + (0x0C)))); |
| 681 | AM53C974_write_8(CNTLREG1, CNTLREG1_DISR | instance->this_id)((__builtin_constant_p((io_port + (0x20))) && (io_port + (0x20)) < 256) ? __outbc(((0x40 | instance->this_id) ),(io_port + (0x20))) : __outb(((0x40 | instance->this_id) ),(io_port + (0x20)))); |
| 682 | AM53C974_write_8(CMDREG, CMDREG_RBUS)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x03)),(io_port + (0x0C))) : __outb(((0x03)),(io_port + (0x0C)))); /* reset SCSI bus */ |
| 683 | udelay(10)(__builtin_constant_p(10) ? __const_udelay((10) * 0x10c6ul) : __udelay(10)); |
| 684 | AM53C974_config_after_reset(instance); |
| 685 | udelay(500000)(__builtin_constant_p(500000) ? __const_udelay((500000) * 0x10c6ul ) : __udelay(500000)); |
| 686 | return(1); |
| 687 | } |
| 688 | |
| 689 | /********************************************************************* |
| 690 | * Function : AM53C974_config_after_reset(struct Scsi_Host *instance) * |
| 691 | * * |
| 692 | * Purpose : initializes chip registers after reset * |
| 693 | * * |
| 694 | * Inputs : instance - which AM53C974 * |
| 695 | * * |
| 696 | * Returns : nothing * |
| 697 | **********************************************************************/ |
| 698 | static void AM53C974_config_after_reset(struct Scsi_Host *instance) |
| 699 | { |
| 700 | AM53C974_local_declare()unsigned long io_port; |
| 701 | AM53C974_setio(instance)io_port = instance->io_port; |
| 702 | |
| 703 | /* clear SCSI FIFO */ |
| 704 | AM53C974_write_8(CMDREG, CMDREG_CFIFO)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x01)),(io_port + (0x0C))) : __outb(((0x01)),(io_port + (0x0C)))); |
| 705 | |
| 706 | /* configure device */ |
| 707 | AM53C974_write_8(STIMREG, DEF_SCSI_TIMEOUT)((__builtin_constant_p((io_port + (0x14))) && (io_port + (0x14)) < 256) ? __outbc(((245)),(io_port + (0x14))) : __outb (((245)),(io_port + (0x14)))); |
| 708 | AM53C974_write_8(STPREG, DEF_STP & STPREG_STP)((__builtin_constant_p((io_port + (0x18))) && (io_port + (0x18)) < 256) ? __outbc(((8 & 0x1F)),(io_port + (0x18 ))) : __outb(((8 & 0x1F)),(io_port + (0x18)))); |
| 709 | AM53C974_write_8(SOFREG, (DEF_SOF_RAD<<6) | (DEF_SOF_RAA<<4))((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __outbc((((0<<6) | (0<<4)) ),(io_port + (0x1C))) : __outb((((0<<6) | (0<<4)) ),(io_port + (0x1C)))); |
| 710 | AM53C974_write_8(CLKFREG, DEF_CLKF & CLKFREG_MASK)((__builtin_constant_p((io_port + (0x24))) && (io_port + (0x24)) < 256) ? __outbc(((0 & 0x07)),(io_port + (0x24 ))) : __outb(((0 & 0x07)),(io_port + (0x24)))); |
| 711 | AM53C974_write_8(CNTLREG1, (DEF_ETM<<7) | CNTLREG1_DISR | (DEF_PERE<<4) | instance->this_id)((__builtin_constant_p((io_port + (0x20))) && (io_port + (0x20)) < 256) ? __outbc((((0<<7) | 0x40 | (1<< 4) | instance->this_id)),(io_port + (0x20))) : __outb((((0 <<7) | 0x40 | (1<<4) | instance->this_id)),(io_port + (0x20)))); |
| 712 | AM53C974_write_8(CNTLREG2, (DEF_ENF<<6))((__builtin_constant_p((io_port + (0x2C))) && (io_port + (0x2C)) < 256) ? __outbc((((1<<6))),(io_port + (0x2C ))) : __outb((((1<<6))),(io_port + (0x2C)))); |
| 713 | AM53C974_write_8(CNTLREG3, (DEF_ADIDCHK<<7) | (DEF_FASTSCSI<<4) | (DEF_FASTCLK<<3))((__builtin_constant_p((io_port + (0x30))) && (io_port + (0x30)) < 256) ? __outbc((((0<<7) | (1<<4) | (1<<3))),(io_port + (0x30))) : __outb((((0<<7) | (1<<4) | (1<<3))),(io_port + (0x30)))); |
| 714 | AM53C974_write_8(CNTLREG4, (DEF_GLITCH<<6) | (DEF_PWD<<5) | (DEF_RAE<<3) | (DEF_RADE<<2) | CNTLREG4_RES)((__builtin_constant_p((io_port + (0x34))) && (io_port + (0x34)) < 256) ? __outbc((((1<<6) | (0<<5) | (0<<3) | (1<<2) | 0x10)),(io_port + (0x34))) : __outb ((((1<<6) | (0<<5) | (0<<3) | (1<<2) | 0x10)),(io_port + (0x34)))); |
| 715 | } |
| 716 | |
| 717 | /*********************************************************************** |
| 718 | * Function : const char *AM53C974_info(struct Scsi_Host *instance) * |
| 719 | * * |
| 720 | * Purpose : return device driver information * |
| 721 | * * |
| 722 | * Inputs : instance - which AM53C974 * |
| 723 | * * |
| 724 | * Returns : info string * |
| 725 | ************************************************************************/ |
| 726 | const char *AM53C974_info(struct Scsi_Host *instance) |
| 727 | { |
| 728 | static char info[100]; |
| 729 | |
| 730 | sprintflinux_sprintf(info, "AM53/79C974 PCscsi driver rev. %d.%d; host I/O address: 0x%x; irq: %d\n", |
| 731 | AM53C974_DRIVER_REVISION_MAJOR0, AM53C974_DRIVER_REVISION_MINOR5, |
| 732 | instance->io_port, instance->irq); |
| 733 | return (info); |
| 734 | } |
| 735 | |
| 736 | /************************************************************************** |
| 737 | * Function : int AM53C974_command (Scsi_Cmnd *SCpnt) * |
| 738 | * * |
| 739 | * Purpose : the unqueued SCSI command function, replaced by the * |
| 740 | * AM53C974_queue_command function * |
| 741 | * * |
| 742 | * Inputs : SCpnt - pointer to command structure * |
| 743 | * * |
| 744 | * Returns :status, see hosts.h for details * |
| 745 | ***************************************************************************/ |
| 746 | int AM53C974_command(Scsi_Cmnd *SCpnt) |
| 747 | { |
| 748 | DEB(printk("AM53C974_command called\n")); |
| 749 | return 0; |
| 750 | } |
| 751 | |
| 752 | /************************************************************************** |
| 753 | * Function : void initialize_SCp(Scsi_Cmnd *cmd) * |
| 754 | * * |
| 755 | * Purpose : initialize the saved data pointers for cmd to point to the * |
| 756 | * start of the buffer. * |
| 757 | * * |
| 758 | * Inputs : cmd - Scsi_Cmnd structure to have pointers reset. * |
| 759 | * * |
| 760 | * Returns : nothing * |
| 761 | **************************************************************************/ |
| 762 | static __inline____inline__ __attribute__((always_inline)) void initialize_SCp(Scsi_Cmnd *cmd) |
| 763 | { |
| 764 | if (cmd->use_sg) { |
| 765 | cmd->SCp.buffer = (struct scatterlist *)cmd->buffer; |
| 766 | cmd->SCp.buffers_residual = cmd->use_sg - 1; |
| 767 | cmd->SCp.ptr = (char *)cmd->SCp.buffer->address; |
| 768 | cmd->SCp.this_residual = cmd->SCp.buffer->length; } |
| 769 | else { |
| 770 | cmd->SCp.buffer = NULL((void *) 0); |
| 771 | cmd->SCp.buffers_residual = 0; |
| 772 | cmd->SCp.ptr = (char *)cmd->request_buffer; |
| 773 | cmd->SCp.this_residual = cmd->request_bufflen; } |
| 774 | } |
| 775 | |
| 776 | /************************************************************************** |
| 777 | * Function : run_main(void) * |
| 778 | * * |
| 779 | * Purpose : insure that the coroutine is running and will process our * |
| 780 | * request. main_running is checked/set here (in an inline * |
| 781 | * function rather than in AM53C974_main itself to reduce the * |
| 782 | * chances of stack overflow. * |
| 783 | * * |
| 784 | * * |
| 785 | * Inputs : none * |
| 786 | * * |
| 787 | * Returns : nothing * |
| 788 | **************************************************************************/ |
| 789 | static __inline____inline__ __attribute__((always_inline)) void run_main(void) |
| 790 | { |
| 791 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 792 | if (!main_running) { |
| 793 | /* main_running is cleared in AM53C974_main once it can't do |
| 794 | more work, and AM53C974_main exits with interrupts disabled. */ |
| 795 | main_running = 1; |
| 796 | AM53C974_main(); |
| 797 | sti()__asm__ __volatile__ ("sti": : :"memory"); } |
| 798 | else |
| 799 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 800 | } |
| 801 | |
| 802 | /************************************************************************** |
| 803 | * Function : int AM53C974_queue_command(Scsi_Cmnd *cmd, void (*done)(Scsi_Cmnd *)) |
| 804 | * |
| 805 | * Purpose : writes SCSI command into AM53C974 FIFO |
| 806 | * |
| 807 | * Inputs : cmd - SCSI command, done - function called on completion, with |
| 808 | * a pointer to the command descriptor. |
| 809 | * |
| 810 | * Returns : status, see hosts.h for details |
| 811 | * |
| 812 | * Side effects : |
| 813 | * cmd is added to the per instance issue_queue, with minor |
| 814 | * twiddling done to the host specific fields of cmd. If the |
| 815 | * main coroutine is not running, it is restarted. |
| 816 | **************************************************************************/ |
| 817 | int AM53C974_queue_command(Scsi_Cmnd *cmd, void (*done)(Scsi_Cmnd *)) |
| 818 | { |
| 819 | struct Scsi_Host *instance = cmd->host; |
| 820 | struct AM53C974_hostdata *hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 821 | Scsi_Cmnd *tmp; |
| 822 | |
| 823 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 824 | DEB_QUEUE(printk(SEPARATOR_LINE)); |
| 825 | DEB_QUEUE(printk("scsi%d: AM53C974_queue_command called\n", instance->host_no)); |
| 826 | DEB_QUEUE(printk("cmd=%02x target=%02x lun=%02x bufflen=%d use_sg = %02x\n", |
| 827 | cmd->cmnd[0], cmd->target, cmd->lun, cmd->request_bufflen, cmd->use_sg)); |
| 828 | |
| 829 | /* We use the host_scribble field as a pointer to the next command in a queue */ |
| 830 | cmd->host_scribble = NULL((void *) 0); |
| 831 | cmd->scsi_done = done; |
| 832 | cmd->result = 0; |
| 833 | cmd->device->disconnect = 0; |
| 834 | |
| 835 | /* Insert the cmd into the issue queue. Note that REQUEST SENSE |
| 836 | * commands are added to the head of the queue since any command will |
| 837 | * clear the contingent allegiance condition that exists and the |
| 838 | * sense data is only guaranteed to be valid while the condition exists. */ |
| 839 | if (!(hostdata->issue_queue) || (cmd->cmnd[0] == REQUEST_SENSE0x03)) { |
| 840 | LIST(cmd, hostdata->issue_queue); |
| 841 | cmd->host_scribble = (unsigned char *)hostdata->issue_queue; |
| 842 | hostdata->issue_queue = cmd; } |
| 843 | else { |
| 844 | for (tmp = (Scsi_Cmnd *)hostdata->issue_queue; tmp->host_scribble; |
| 845 | tmp = (Scsi_Cmnd *)tmp->host_scribble); |
| 846 | LIST(cmd, tmp); |
| 847 | tmp->host_scribble = (unsigned char *)cmd; } |
| 848 | |
| 849 | DEB_QUEUE(printk("scsi%d : command added to %s of queue\n", instance->host_no, |
| 850 | (cmd->cmnd[0] == REQUEST_SENSE) ? "head" : "tail")); |
| 851 | |
| 852 | /* Run the coroutine if it isn't already running. */ |
| 853 | run_main(); |
| 854 | return 0; |
| 855 | } |
| 856 | |
| 857 | /************************************************************************** |
| 858 | * Function : AM53C974_main (void) |
| 859 | * |
| 860 | * Purpose : AM53C974_main is a coroutine that runs as long as more work can |
| 861 | * be done on the AM53C974 host adapters in a system. Both |
| 862 | * AM53C974_queue_command() and AM53C974_intr() will try to start it |
| 863 | * in case it is not running. |
| 864 | * |
| 865 | * NOTE : AM53C974_main exits with interrupts *disabled*, the caller should |
| 866 | * reenable them. This prevents reentrancy and kernel stack overflow. |
| 867 | **************************************************************************/ |
| 868 | static void AM53C974_main(void) |
| 869 | { |
| 870 | AM53C974_local_declare()unsigned long io_port; |
| 871 | Scsi_Cmnd *tmp, *prev; |
| 872 | struct Scsi_Host *instance; |
| 873 | struct AM53C974_hostdata *hostdata; |
| 874 | int done; |
| 875 | |
| 876 | /* We run (with interrupts disabled) until we're sure that none of |
| 877 | * the host adapters have anything that can be done, at which point |
| 878 | * we set main_running to 0 and exit. */ |
| 879 | |
| 880 | do { |
| 881 | cli()__asm__ __volatile__ ("cli": : :"memory"); /* Freeze request queues */ |
| 882 | done = 1; |
| 883 | for (instance = first_instance; instance && instance->hostt == the_template; |
| 884 | instance = instance->next) { |
| 885 | hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 886 | AM53C974_setio(instance)io_port = instance->io_port; |
| 887 | /* start to select target if we are not connected and not in the |
| 888 | selection process */ |
| 889 | if (!hostdata->connected && !hostdata->sel_cmd) { |
| 890 | /* Search through the issue_queue for a command destined for a target |
| 891 | that is not busy. */ |
| 892 | for (tmp = (Scsi_Cmnd *)hostdata->issue_queue, prev = NULL((void *) 0); tmp; |
| 893 | prev = tmp, tmp = (Scsi_Cmnd *)tmp->host_scribble) { |
| 894 | /* When we find one, remove it from the issue queue. */ |
| 895 | if (!(hostdata->busy[tmp->target] & (1 << tmp->lun))) { |
| 896 | if (prev) { |
| 897 | REMOVE(prev, (Scsi_Cmnd *)(prev->host_scribble), tmp, |
| 898 | (Scsi_Cmnd *)(tmp->host_scribble)); |
| 899 | prev->host_scribble = tmp->host_scribble; } |
| 900 | else { |
| 901 | REMOVE(-1, hostdata->issue_queue, tmp, tmp->host_scribble); |
| 902 | hostdata->issue_queue = (Scsi_Cmnd *)tmp->host_scribble; } |
| 903 | tmp->host_scribble = NULL((void *) 0); |
| 904 | |
| 905 | /* go into selection mode, disable reselection and wait for |
| 906 | SO interrupt which will continue with the selection process */ |
| 907 | hostdata->selecting = 1; |
| 908 | hostdata->sel_cmd = tmp; |
| 909 | AM53C974_write_8(CMDREG, CMDREG_DSR)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x45)),(io_port + (0x0C))) : __outb(((0x45)),(io_port + (0x0C)))); |
| 910 | break; |
| 911 | } /* if target/lun is not busy */ |
| 912 | |
| 913 | } /* for */ |
| 914 | } /* if (!hostdata->connected) */ |
| 915 | else { |
| 916 | DEB(printk("main: connected; cmd = 0x%lx, sel_cmd = 0x%lx\n", |
| 917 | (long)hostdata->connected, (long)hostdata->sel_cmd)); |
| 918 | } |
| 919 | } /* for instance */ |
| 920 | } while (!done); |
| 921 | main_running = 0; |
| 922 | } |
| 923 | |
| 924 | /************************************************************************ |
| 925 | * Function : AM53C974_intr(int irq, void *dev_id, struct pt_regs *regs) * |
| 926 | * * |
| 927 | * Purpose : interrupt handler * |
| 928 | * * |
| 929 | * Inputs : irq - interrupt line, regs - ? * |
| 930 | * * |
| 931 | * Returns : nothing * |
| 932 | ************************************************************************/ |
| 933 | static void AM53C974_intr(int irq, void *dev_id, struct pt_regs *regs) |
| 934 | { |
| 935 | AM53C974_local_declare()unsigned long io_port; |
| 936 | struct Scsi_Host *instance; |
| 937 | struct AM53C974_hostdata *hostdata; |
| 938 | unsigned char cmdreg, dmastatus, statreg, isreg, instreg, cfifo; |
| 939 | |
| 940 | /* find AM53C974 hostadapter responsible for this interrupt */ |
| 941 | for (instance = first_instance; instance; instance = instance->next) |
| 942 | if ((instance->irq == irq) && (instance->hostt == the_template)) goto FOUND; |
| 943 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 944 | return; |
| 945 | |
| 946 | /* found; now decode and process */ |
| 947 | FOUND: |
| 948 | hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 949 | AM53C974_setio(instance)io_port = instance->io_port; |
| 950 | dmastatus = AM53C974_read_8(DMASTATUS)((__builtin_constant_p((io_port + (0x54))) && (io_port + (0x54)) < 256) ? __inbc(io_port + (0x54)) : __inb(io_port + (0x54))); |
| 951 | |
| 952 | DEB_INTR(printk(SEPARATOR_LINE)); |
| 953 | DEB_INTR(printk("AM53C974 interrupt; dmastatus=0x%02x\n", dmastatus)); |
| 954 | KEYWAIT(); |
| 955 | |
| 956 | /*** DMA related interrupts ***/ |
| 957 | if (hostdata->connected && (dmastatus & (DMASTATUS_ERROR0x02 | DMASTATUS_PWDN0x02 | |
| 958 | DMASTATUS_ABORT0x04))) { |
| 959 | /* DMA error or POWERDOWN */ |
| 960 | printk("scsi%d: DMA error or powerdown; dmastatus: 0x%02x\n", |
| 961 | instance->host_no, dmastatus); |
| 962 | #ifdef AM53C974_DEBUG |
| 963 | deb_stop = 1; |
| 964 | #endif |
| 965 | panic("scsi%d: cannot recover\n", instance->host_no); } |
| 966 | |
| 967 | if (hostdata->connected && (dmastatus & DMASTATUS_DONE0x08)) { |
| 968 | /* DMA transfer done */ |
| 969 | unsigned long residual; |
| 970 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 971 | if (!(AM53C974_read_8(DMACMD)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __inbc(io_port + (0x40)) : __inb(io_port + (0x40))) & DMACMD_DIR0x80)) { |
| 972 | do { |
| 973 | dmastatus = AM53C974_read_8(DMASTATUS)((__builtin_constant_p((io_port + (0x54))) && (io_port + (0x54)) < 256) ? __inbc(io_port + (0x54)) : __inb(io_port + (0x54))); |
| 974 | residual = AM53C974_read_8(CTCLREG)((__builtin_constant_p((io_port + (0x00))) && (io_port + (0x00)) < 256) ? __inbc(io_port + (0x00)) : __inb(io_port + (0x00))) | (AM53C974_read_8(CTCMREG)((__builtin_constant_p((io_port + (0x04))) && (io_port + (0x04)) < 256) ? __inbc(io_port + (0x04)) : __inb(io_port + (0x04))) << 8) | |
| 975 | (AM53C974_read_8(CTCHREG)((__builtin_constant_p((io_port + (0x38))) && (io_port + (0x38)) < 256) ? __inbc(io_port + (0x38)) : __inb(io_port + (0x38))) << 16); |
| 976 | residual += AM53C974_read_8(CFIREG)((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __inbc(io_port + (0x1C)) : __inb(io_port + (0x1C))) & CFIREG_CF0x1F; |
| 977 | } while (!(dmastatus & DMASTATUS_SCSIINT0x10) && residual); |
| 978 | residual = AM53C974_read_8(CTCLREG)((__builtin_constant_p((io_port + (0x00))) && (io_port + (0x00)) < 256) ? __inbc(io_port + (0x00)) : __inb(io_port + (0x00))) | (AM53C974_read_8(CTCMREG)((__builtin_constant_p((io_port + (0x04))) && (io_port + (0x04)) < 256) ? __inbc(io_port + (0x04)) : __inb(io_port + (0x04))) << 8) | |
| 979 | (AM53C974_read_8(CTCHREG)((__builtin_constant_p((io_port + (0x38))) && (io_port + (0x38)) < 256) ? __inbc(io_port + (0x38)) : __inb(io_port + (0x38))) << 16); |
| 980 | residual += AM53C974_read_8(CFIREG)((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __inbc(io_port + (0x1C)) : __inb(io_port + (0x1C))) & CFIREG_CF0x1F; |
| 981 | } |
| 982 | else |
| 983 | residual = 0; |
| 984 | hostdata->connected->SCp.ptr += hostdata->connected->SCp.this_residual - residual; |
| 985 | hostdata->connected->SCp.this_residual = residual; |
| 986 | |
| 987 | AM53C974_write_8(DMACMD, DMACMD_IDLE)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __outbc(((0x00)),(io_port + (0x40))) : __outb(((0x00)),(io_port + (0x40)))); |
| 988 | |
| 989 | /* if service request missed before, process it now (ugly) */ |
| 990 | if (hostdata->dma_busy) { |
| 991 | hostdata->dma_busy = 0; |
| 992 | cmdreg = AM53C974_read_8(CMDREG)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __inbc(io_port + (0x0C)) : __inb(io_port + (0x0C))); |
| 993 | statreg = AM53C974_read_8(STATREG)((__builtin_constant_p((io_port + (0x10))) && (io_port + (0x10)) < 256) ? __inbc(io_port + (0x10)) : __inb(io_port + (0x10))); |
| 994 | isreg = AM53C974_read_8(ISREG)((__builtin_constant_p((io_port + (0x18))) && (io_port + (0x18)) < 256) ? __inbc(io_port + (0x18)) : __inb(io_port + (0x18))); |
| 995 | instreg = AM53C974_read_8(INSTREG)((__builtin_constant_p((io_port + (0x14))) && (io_port + (0x14)) < 256) ? __inbc(io_port + (0x14)) : __inb(io_port + (0x14))); |
| 996 | cfifo = AM53C974_cfifo()(((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __inbc(io_port + (0x1C)) : __inb(io_port + (0x1C))) & 0x1F); |
| 997 | AM53C974_information_transfer(instance, statreg, isreg, instreg, cfifo, |
| 998 | dmastatus); } |
| 999 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 1000 | } |
| 1001 | |
| 1002 | if (!(dmastatus & DMASTATUS_SCSIINT0x10)) { |
| 1003 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 1004 | return; } |
| 1005 | |
| 1006 | /*** SCSI related interrupts ***/ |
| 1007 | cmdreg = AM53C974_read_8(CMDREG)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __inbc(io_port + (0x0C)) : __inb(io_port + (0x0C))); |
| 1008 | statreg = AM53C974_read_8(STATREG)((__builtin_constant_p((io_port + (0x10))) && (io_port + (0x10)) < 256) ? __inbc(io_port + (0x10)) : __inb(io_port + (0x10))); |
| 1009 | isreg = AM53C974_read_8(ISREG)((__builtin_constant_p((io_port + (0x18))) && (io_port + (0x18)) < 256) ? __inbc(io_port + (0x18)) : __inb(io_port + (0x18))); |
| 1010 | instreg = AM53C974_read_8(INSTREG)((__builtin_constant_p((io_port + (0x14))) && (io_port + (0x14)) < 256) ? __inbc(io_port + (0x14)) : __inb(io_port + (0x14))); |
| 1011 | cfifo = AM53C974_cfifo()(((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __inbc(io_port + (0x1C)) : __inb(io_port + (0x1C))) & 0x1F); |
| 1012 | |
| 1013 | DEB_INTR(printk("scsi%d: statreg: 0x%02x; isreg: 0x%02x; instreg: 0x%02x; cfifo: 0x%02x\n", |
| 1014 | instance->host_no, statreg, isreg, instreg, cfifo)); |
| 1015 | |
| 1016 | if (statreg & STATREG_PE0x20) { |
| 1017 | /* parity error */ |
| 1018 | #ifdef AM53C974_DEBUG |
| 1019 | deb_stop = 1; |
| 1020 | #endif |
| 1021 | printk("scsi%d : PARITY error\n", instance->host_no); |
| 1022 | if (hostdata->connected) hostdata->sync_off[hostdata->connected->target] = 0; /* setup asynchronous transfer */ |
| 1023 | hostdata->aborted = 1; } |
| 1024 | |
| 1025 | if (statreg & STATREG_IOE0x40) { |
| 1026 | /* illegal operation error */ |
| 1027 | #ifdef AM53C974_DEBUG |
| 1028 | deb_stop = 1; |
| 1029 | #endif |
| 1030 | printk("scsi%d : ILLEGAL OPERATION error\n", instance->host_no); |
| 1031 | printk("cmdreg: 0x%02x; dmacmd: 0x%02x; statreg: 0x%02x; \n" |
| 1032 | "isreg: 0x%02x; instreg: 0x%02x; cfifo: 0x%02x\n", |
| 1033 | cmdreg, AM53C974_read_8(DMACMD)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __inbc(io_port + (0x40)) : __inb(io_port + (0x40))), statreg, isreg, instreg, cfifo); } |
| 1034 | if (hostdata->in_reset && (instreg & INSTREG_SRST0x80)) { |
| 1035 | /* RESET INTERRUPT */ |
| 1036 | #ifdef AM53C974_DEBUG |
| 1037 | deb_stop = 1; |
| 1038 | #endif |
| 1039 | DEB(printk("Bus reset interrupt received\n")); |
| 1040 | AM53C974_intr_bus_reset(instance); |
| 1041 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 1042 | if (hostdata->connected) { |
| 1043 | hostdata->connected->result = DID_RESET0x08 << 16; |
| 1044 | hostdata->connected->scsi_done((Scsi_Cmnd *)hostdata->connected); |
| 1045 | hostdata->connected = NULL((void *) 0); } |
| 1046 | else { |
| 1047 | if (hostdata->sel_cmd) { |
| 1048 | hostdata->sel_cmd->result = DID_RESET0x08 << 16; |
| 1049 | hostdata->sel_cmd->scsi_done((Scsi_Cmnd *)hostdata->sel_cmd); |
| 1050 | hostdata->sel_cmd = NULL((void *) 0); } |
| 1051 | } |
| 1052 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 1053 | if (hostdata->in_reset == 1) goto EXIT; |
| 1054 | else return; |
| 1055 | } |
| 1056 | |
| 1057 | if (instreg & INSTREG_ICMD0x40) { |
| 1058 | /* INVALID COMMAND INTERRUPT */ |
| 1059 | #ifdef AM53C974_DEBUG |
| 1060 | deb_stop = 1; |
| 1061 | #endif |
| 1062 | printk("scsi%d: Invalid command interrupt\n", instance->host_no); |
| 1063 | printk("cmdreg: 0x%02x; dmacmd: 0x%02x; statreg: 0x%02x; dmastatus: 0x%02x; \n" |
| 1064 | "isreg: 0x%02x; instreg: 0x%02x; cfifo: 0x%02x\n", |
| 1065 | cmdreg, AM53C974_read_8(DMACMD)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __inbc(io_port + (0x40)) : __inb(io_port + (0x40))), statreg, dmastatus, isreg, instreg, cfifo); |
| 1066 | panic("scsi%d: cannot recover\n", instance->host_no); } |
| 1067 | |
| 1068 | if (instreg & INSTREG_DIS0x20) { |
| 1069 | /* DISCONNECT INTERRUPT */ |
| 1070 | DEB_INTR(printk("Disconnect interrupt received; ")); |
| 1071 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 1072 | AM53C974_intr_disconnect(instance); |
| 1073 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 1074 | goto EXIT; } |
| 1075 | |
| 1076 | if (instreg & INSTREG_RESEL0x04) { |
| 1077 | /* RESELECTION INTERRUPT */ |
| 1078 | DEB_INTR(printk("Reselection interrupt received\n")); |
| 1079 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 1080 | AM53C974_intr_reselect(instance, statreg); |
| 1081 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 1082 | goto EXIT; } |
| 1083 | |
| 1084 | if (instreg & INSTREG_SO0x08) { |
| 1085 | DEB_INTR(printk("Successful operation interrupt received\n")); |
| 1086 | if (hostdata->selecting) { |
| 1087 | DEB_INTR(printk("DSR completed, starting select\n")); |
| 1088 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 1089 | AM53C974_select(instance, (Scsi_Cmnd *)hostdata->sel_cmd, |
| 1090 | (hostdata->sel_cmd->cmnd[0] == REQUEST_SENSE0x03) ? |
| 1091 | TAG_NONE-2 : TAG_NEXT-1); |
| 1092 | hostdata->selecting = 0; |
| 1093 | AM53C974_set_sync(instance, hostdata->sel_cmd->target); |
| 1094 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 1095 | return; } |
| 1096 | |
| 1097 | if (hostdata->sel_cmd != NULL((void *) 0)) { |
| 1098 | if ( ((isreg & ISREG_IS0x07) != ISREG_OK_NO_STOP0x04) && |
| 1099 | ((isreg & ISREG_IS0x07) != ISREG_OK_STOP0x01) ) { |
| 1100 | /* UNSUCCESSFUL SELECTION */ |
| 1101 | DEB_INTR(printk("unsuccessful selection\n")); |
| 1102 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 1103 | hostdata->dma_busy = 0; |
| 1104 | LIST(hostdata->sel_cmd, hostdata->issue_queue); |
| 1105 | hostdata->sel_cmd->host_scribble = (unsigned char *)hostdata->issue_queue; |
| 1106 | hostdata->issue_queue = hostdata->sel_cmd; |
| 1107 | hostdata->sel_cmd = NULL((void *) 0); |
| 1108 | hostdata->selecting = 0; |
| 1109 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 1110 | goto EXIT; } |
| 1111 | else { |
| 1112 | /* SUCCESSFUL SELECTION */ |
| 1113 | DEB(printk("successful selection; cmd=0x%02lx\n", (long)hostdata->sel_cmd)); |
| 1114 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 1115 | hostdata->dma_busy = 0; |
| 1116 | hostdata->disconnecting = 0; |
| 1117 | hostdata->connected = hostdata->sel_cmd; |
| 1118 | hostdata->sel_cmd = NULL((void *) 0); |
| 1119 | hostdata->selecting = 0; |
| 1120 | #ifdef SCSI2 |
| 1121 | if (!hostdata->connected->device->tagged_queue) |
| 1122 | #endif |
| 1123 | hostdata->busy[hostdata->connected->target] |= (1 << hostdata->connected->lun); |
| 1124 | /* very strange -- use_sg is sometimes nonzero for request sense commands !! */ |
| 1125 | if ((hostdata->connected->cmnd[0] == REQUEST_SENSE0x03) && hostdata->connected->use_sg) { |
| 1126 | DEB(printk("scsi%d: REQUEST_SENSE command with nonzero use_sg\n", instance->host_no)); |
| 1127 | KEYWAIT(); |
| 1128 | hostdata->connected->use_sg = 0; } |
| 1129 | initialize_SCp((Scsi_Cmnd *)hostdata->connected); |
| 1130 | hostdata->connected->SCp.phase = PHASE_CMDOUT0x02; |
| 1131 | AM53C974_information_transfer(instance, statreg, isreg, instreg, cfifo, dmastatus); |
| 1132 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 1133 | return; } |
| 1134 | } |
| 1135 | else { |
| 1136 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 1137 | AM53C974_information_transfer(instance, statreg, isreg, instreg, cfifo, dmastatus); |
| 1138 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 1139 | return; } |
| 1140 | } |
| 1141 | |
| 1142 | if (instreg & INSTREG_SR0x10) { |
| 1143 | DEB_INTR(printk("Service request interrupt received, ")); |
| 1144 | if (hostdata->connected) { |
| 1145 | DEB_INTR(printk("calling information_transfer\n")); |
| 1146 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 1147 | AM53C974_information_transfer(instance, statreg, isreg, instreg, cfifo, dmastatus); |
| 1148 | sti()__asm__ __volatile__ ("sti": : :"memory"); } |
| 1149 | else { |
| 1150 | printk("scsi%d: weird: service request when no command connected\n", instance->host_no); |
| 1151 | AM53C974_write_8(CMDREG, CMDREG_CFIFO)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x01)),(io_port + (0x0C))) : __outb(((0x01)),(io_port + (0x0C)))); } /* clear FIFO */ |
| 1152 | return; |
| 1153 | } |
| 1154 | |
| 1155 | EXIT: |
| 1156 | DEB_INTR(printk("intr: starting main\n")); |
| 1157 | run_main(); |
| 1158 | DEB_INTR(printk("end of intr\n")); |
| 1159 | } |
| 1160 | |
| 1161 | /************************************************************************** |
| 1162 | * Function : AM53C974_intr_disconnect(struct Scsi_Host *instance) |
| 1163 | * |
| 1164 | * Purpose : manage target disconnection |
| 1165 | * |
| 1166 | * Inputs : instance -- which AM53C974 |
| 1167 | * |
| 1168 | * Returns : nothing |
| 1169 | **************************************************************************/ |
| 1170 | static void AM53C974_intr_disconnect(struct Scsi_Host *instance) |
| 1171 | { |
| 1172 | AM53C974_local_declare()unsigned long io_port; |
| 1173 | struct AM53C974_hostdata *hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 1174 | Scsi_Cmnd *cmd; |
| 1175 | AM53C974_setio(instance)io_port = instance->io_port; |
| 1176 | |
| 1177 | if (hostdata->sel_cmd != NULL((void *) 0)) { |
| 1178 | /* normal selection timeout, typical for nonexisting targets */ |
| 1179 | cmd = (Scsi_Cmnd *)hostdata->sel_cmd; |
| 1180 | DEB_INTR(printk("bad target\n")); |
| 1181 | cmd->result = DID_BAD_TARGET0x04 << 16; |
| 1182 | goto EXIT_FINISHED; } |
| 1183 | |
| 1184 | if (!hostdata->connected) { |
| 1185 | /* can happen if controller was reset, a device tried to reconnect, |
| 1186 | failed and disconnects now */ |
| 1187 | AM53C974_write_8(CMDREG, CMDREG_CFIFO)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x01)),(io_port + (0x0C))) : __outb(((0x01)),(io_port + (0x0C)))); |
| 1188 | return; } |
| 1189 | |
| 1190 | if (hostdata->disconnecting) { |
| 1191 | /* target sent disconnect message, so we are prepared */ |
| 1192 | cmd = (Scsi_Cmnd *)hostdata->connected; |
| 1193 | AM53C974_set_async(instance, cmd->target); |
| 1194 | DEB_INTR(printk("scsi%d : disc. from cmnd %d for ta %d, lun %d\n", |
| 1195 | instance->host_no, cmd->cmnd[0], cmd->target, cmd->lun)); |
| 1196 | if (cmd->device->disconnect) { |
| 1197 | /* target wants to reselect later */ |
| 1198 | DEB_INTR(printk("ok, re-enabling selection\n")); |
| 1199 | LIST(cmd,hostdata->disconnected_queue); |
| 1200 | cmd->host_scribble = (unsigned char *)hostdata->disconnected_queue; |
| 1201 | hostdata->disconnected_queue = cmd; |
| 1202 | DEB_QUEUE(printk("scsi%d : command for target %d lun %d this %d was moved from connected to" |
| 1203 | " the disconnected_queue\n", instance->host_no, cmd->target, |
| 1204 | cmd->lun, hostdata->disconnected_queue->SCp.this_residual)); |
| 1205 | DEB_QUEUE(AM53C974_print_queues(instance)); |
| 1206 | goto EXIT_UNFINISHED; } |
| 1207 | else { |
| 1208 | /* target does not want to reselect later, we are really finished */ |
| 1209 | #ifdef AM53C974_DEBUG |
| 1210 | if (cmd->cmnd[0] == REQUEST_SENSE0x03) { |
| 1211 | int i; |
| 1212 | printk("Request sense data dump:\n"); |
| 1213 | for (i = 0; i < cmd->request_bufflen; i++) { |
| 1214 | printk("%02x ", *((char *)(cmd->request_buffer) + i)); |
| 1215 | if (i && !(i % 16)) printk("\n"); } |
| 1216 | printk("\n"); } |
| 1217 | #endif |
| 1218 | goto EXIT_FINISHED; } /* !cmd->device->disconnect */ |
| 1219 | } /* if (hostdata->disconnecting) */ |
| 1220 | |
| 1221 | /* no disconnect message received; unexpected disconnection */ |
| 1222 | cmd = (Scsi_Cmnd *)hostdata->connected; |
| 1223 | if (cmd) { |
| 1224 | #ifdef AM53C974_DEBUG |
| 1225 | deb_stop = 1; |
| 1226 | #endif |
| 1227 | AM53C974_set_async(instance, cmd->target); |
| 1228 | printk("scsi%d: Unexpected disconnect; phase: %d; target: %d; this_residual: %d; buffers_residual: %d; message: %d\n", |
| 1229 | instance->host_no, cmd->SCp.phase, cmd->target, cmd->SCp.this_residual, cmd->SCp.buffers_residual, |
| 1230 | cmd->SCp.Message); |
| 1231 | printk("cmdreg: 0x%02x; statreg: 0x%02x; isreg: 0x%02x; cfifo: 0x%02x\n", |
| 1232 | AM53C974_read_8(CMDREG)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __inbc(io_port + (0x0C)) : __inb(io_port + (0x0C))), AM53C974_read_8(STATREG)((__builtin_constant_p((io_port + (0x10))) && (io_port + (0x10)) < 256) ? __inbc(io_port + (0x10)) : __inb(io_port + (0x10))), AM53C974_read_8(ISREG)((__builtin_constant_p((io_port + (0x18))) && (io_port + (0x18)) < 256) ? __inbc(io_port + (0x18)) : __inb(io_port + (0x18))), |
| 1233 | AM53C974_read_8(CFIREG)((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __inbc(io_port + (0x1C)) : __inb(io_port + (0x1C))) & CFIREG_CF0x1F); |
| 1234 | |
| 1235 | if ((hostdata->last_message[0] == EXTENDED_MESSAGE0x01) && |
| 1236 | (hostdata->last_message[2] == EXTENDED_SDTR0x01)) { |
| 1237 | /* sync. negotiation was aborted, setup asynchronous transfer with target */ |
| 1238 | hostdata->sync_off[cmd->target] = 0; } |
| 1239 | if (hostdata->aborted || hostdata->msgout[0] == ABORT0x06) |
| 1240 | cmd->result = DID_ABORT0x05 << 16; |
| 1241 | else |
| 1242 | cmd->result = DID_ERROR0x07 << 16; |
| 1243 | goto EXIT_FINISHED; } |
| 1244 | |
| 1245 | EXIT_FINISHED: |
| 1246 | hostdata->aborted = 0; |
| 1247 | hostdata->msgout[0] = NOP0x08; |
| 1248 | hostdata->sel_cmd = NULL((void *) 0); |
| 1249 | hostdata->connected = NULL((void *) 0); |
| 1250 | hostdata->selecting = 0; |
| 1251 | hostdata->disconnecting = 0; |
| 1252 | hostdata->dma_busy = 0; |
| 1253 | hostdata->busy[cmd->target] &= ~(1 << cmd->lun); |
| 1254 | AM53C974_write_8(CMDREG, CMDREG_CFIFO)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x01)),(io_port + (0x0C))) : __outb(((0x01)),(io_port + (0x0C)))); |
| 1255 | DEB(printk("disconnect; issue_queue: 0x%lx, disconnected_queue: 0x%lx\n", |
| 1256 | (long)hostdata->issue_queue, (long)hostdata->disconnected_queue)); |
| 1257 | cmd->scsi_done(cmd); |
| 1258 | |
| 1259 | if (!hostdata->selecting) { |
| 1260 | AM53C974_set_async(instance, cmd->target); |
| 1261 | AM53C974_write_8(CMDREG, CMDREG_ESR)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x44)),(io_port + (0x0C))) : __outb(((0x44)),(io_port + (0x0C)))); } /* allow reselect */ |
| 1262 | return; |
| 1263 | |
| 1264 | EXIT_UNFINISHED: |
| 1265 | hostdata->msgout[0] = NOP0x08; |
| 1266 | hostdata->sel_cmd = NULL((void *) 0); |
| 1267 | hostdata->connected = NULL((void *) 0); |
| 1268 | hostdata->aborted = 0; |
| 1269 | hostdata->selecting = 0; |
| 1270 | hostdata->disconnecting = 0; |
| 1271 | hostdata->dma_busy = 0; |
| 1272 | DEB(printk("disconnect; issue_queue: 0x%lx, disconnected_queue: 0x%lx\n", |
| 1273 | (long)hostdata->issue_queue, (long)hostdata->disconnected_queue)); |
| 1274 | if (!hostdata->selecting) { |
| 1275 | AM53C974_set_async(instance, cmd->target); |
| 1276 | AM53C974_write_8(CMDREG, CMDREG_ESR)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x44)),(io_port + (0x0C))) : __outb(((0x44)),(io_port + (0x0C)))); } /* allow reselect */ |
| 1277 | return; |
| 1278 | } |
| 1279 | |
| 1280 | /************************************************************************** |
| 1281 | * Function : int AM53C974_sync_neg(struct Scsi_Host *instance, int target, unsigned char *msg) |
| 1282 | * |
| 1283 | * Purpose : setup message string for sync. negotiation |
| 1284 | * |
| 1285 | * Inputs : instance -- which AM53C974 |
| 1286 | * target -- which SCSI target to deal with |
| 1287 | * msg -- input message string |
| 1288 | * |
| 1289 | * Returns : 0 if parameters accepted or 1 if not accepted |
| 1290 | * |
| 1291 | * Side effects: hostdata is changed |
| 1292 | * |
| 1293 | * Note: we assume here that fastclk is enabled |
| 1294 | **************************************************************************/ |
| 1295 | static int AM53C974_sync_neg(struct Scsi_Host *instance, int target, unsigned char *msg) |
| 1296 | { |
| 1297 | AM53C974_local_declare()unsigned long io_port; |
| 1298 | struct AM53C974_hostdata *hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 1299 | int period, offset, i, rate, rate_rem; |
| 1300 | AM53C974_setio(instance)io_port = instance->io_port; |
| 1301 | |
| 1302 | period = (DEF_CLK40 * msg[3] * 8 + 1000) / 2000; |
| 1303 | if (period < MIN_PERIOD4) { |
| 1304 | period = MIN_PERIOD4; |
| 1305 | hostdata->msgout[3] = period / 4; } |
| 1306 | else |
| 1307 | if (period > MAX_PERIOD13) { |
| 1308 | period = MAX_PERIOD13; |
| 1309 | hostdata->msgout[3] = period / 4; } |
| 1310 | else |
| 1311 | hostdata->msgout[3] = msg[3]; |
| 1312 | offset = msg[4]; |
| 1313 | if (offset > MAX_OFFSET15) offset = MAX_OFFSET15; |
| 1314 | hostdata->msgout[4] = offset; |
| 1315 | hostdata->sync_per[target] = period; |
| 1316 | hostdata->sync_off[target] = offset; |
| 1317 | for (i = 0; i < 3; i++) hostdata->msgout[i] = msg[i]; |
| 1318 | if ((hostdata->msgout[3] != msg[3]) || (msg[4] != offset)) return(1); |
| 1319 | |
| 1320 | rate = DEF_CLK40 / period; |
| 1321 | rate_rem = 10 * (DEF_CLK40 - period * rate) / period; |
| 1322 | |
| 1323 | if (offset) |
| 1324 | printk("\ntarget %d: rate=%d.%d Mhz, synchronous, sync offset=%d bytes\n", |
| 1325 | target, rate, rate_rem, offset); |
| 1326 | else |
| 1327 | printk("\ntarget %d: rate=%d.%d Mhz, asynchronous\n", target, rate, rate_rem); |
| 1328 | |
| 1329 | return(0); |
| 1330 | } |
| 1331 | |
| 1332 | /************************************************************************** |
| 1333 | * Function : AM53C974_set_async(struct Scsi_Host *instance, int target) |
| 1334 | * |
| 1335 | * Purpose : put controller into async. mode |
| 1336 | * |
| 1337 | * Inputs : instance -- which AM53C974 |
| 1338 | * target -- which SCSI target to deal with |
| 1339 | * |
| 1340 | * Returns : nothing |
| 1341 | **************************************************************************/ |
| 1342 | static __inline____inline__ __attribute__((always_inline)) void AM53C974_set_async(struct Scsi_Host *instance, int target) |
| 1343 | { |
| 1344 | AM53C974_local_declare()unsigned long io_port; |
| 1345 | struct AM53C974_hostdata *hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 1346 | AM53C974_setio(instance)io_port = instance->io_port; |
| 1347 | |
| 1348 | AM53C974_write_8(STPREG, hostdata->sync_per[target])((__builtin_constant_p((io_port + (0x18))) && (io_port + (0x18)) < 256) ? __outbc(((hostdata->sync_per[target ])),(io_port + (0x18))) : __outb(((hostdata->sync_per[target ])),(io_port + (0x18)))); |
| 1349 | AM53C974_write_8(SOFREG, (DEF_SOF_RAD<<6) | (DEF_SOF_RAA<<4))((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __outbc((((0<<6) | (0<<4)) ),(io_port + (0x1C))) : __outb((((0<<6) | (0<<4)) ),(io_port + (0x1C)))); |
| 1350 | } |
| 1351 | |
| 1352 | /************************************************************************** |
| 1353 | * Function : AM53C974_set_sync(struct Scsi_Host *instance, int target) |
| 1354 | * |
| 1355 | * Purpose : put controller into sync. mode |
| 1356 | * |
| 1357 | * Inputs : instance -- which AM53C974 |
| 1358 | * target -- which SCSI target to deal with |
| 1359 | * |
| 1360 | * Returns : nothing |
| 1361 | **************************************************************************/ |
| 1362 | static __inline____inline__ __attribute__((always_inline)) void AM53C974_set_sync(struct Scsi_Host *instance, int target) |
| 1363 | { |
| 1364 | AM53C974_local_declare()unsigned long io_port; |
| 1365 | struct AM53C974_hostdata *hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 1366 | AM53C974_setio(instance)io_port = instance->io_port; |
| 1367 | |
| 1368 | AM53C974_write_8(STPREG, hostdata->sync_per[target])((__builtin_constant_p((io_port + (0x18))) && (io_port + (0x18)) < 256) ? __outbc(((hostdata->sync_per[target ])),(io_port + (0x18))) : __outb(((hostdata->sync_per[target ])),(io_port + (0x18)))); |
| 1369 | AM53C974_write_8(SOFREG, (SOFREG_SO & hostdata->sync_off[target]) |((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __outbc((((0x0F & hostdata->sync_off [target]) | (0<<6) | (0<<4))),(io_port + (0x1C))) : __outb((((0x0F & hostdata->sync_off[target]) | (0<< 6) | (0<<4))),(io_port + (0x1C)))) |
| 1370 | (DEF_SOF_RAD<<6) | (DEF_SOF_RAA<<4))((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __outbc((((0x0F & hostdata->sync_off [target]) | (0<<6) | (0<<4))),(io_port + (0x1C))) : __outb((((0x0F & hostdata->sync_off[target]) | (0<< 6) | (0<<4))),(io_port + (0x1C)))); |
| 1371 | } |
| 1372 | |
| 1373 | /*********************************************************************** |
| 1374 | * Function : AM53C974_information_transfer(struct Scsi_Host *instance, * |
| 1375 | * unsigned char statreg, unsigned char isreg, * |
| 1376 | * unsigned char instreg, unsigned char cfifo, * |
| 1377 | * unsigned char dmastatus) * |
| 1378 | * * |
| 1379 | * Purpose : handle phase changes * |
| 1380 | * * |
| 1381 | * Inputs : instance - which AM53C974 * |
| 1382 | * statreg - status register * |
| 1383 | * isreg - internal state register * |
| 1384 | * instreg - interrupt status register * |
| 1385 | * cfifo - number of bytes in FIFO * |
| 1386 | * dmastatus - dma status register * |
| 1387 | * * |
| 1388 | * Returns : nothing * |
| 1389 | ************************************************************************/ |
| 1390 | static void AM53C974_information_transfer(struct Scsi_Host *instance, |
| 1391 | unsigned char statreg, unsigned char isreg, |
| 1392 | unsigned char instreg, unsigned char cfifo, |
| 1393 | unsigned char dmastatus) |
| 1394 | { |
| 1395 | AM53C974_local_declare()unsigned long io_port; |
| 1396 | struct AM53C974_hostdata *hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 1397 | Scsi_Cmnd *cmd = (Scsi_Cmnd *)hostdata->connected; |
| 1398 | int ret, i, len, residual=-1; |
| 1399 | AM53C974_setio(instance)io_port = instance->io_port; |
| 1400 | |
| 1401 | DEB_INFO(printk(SEPARATOR_LINE)); |
| 1402 | switch (statreg & STATREG_PHASE0x07) { /* scsi phase */ |
| 1403 | case PHASE_DATAOUT0x00: |
| 1404 | DEB_INFO(printk("Dataout phase; cmd=0x%lx, sel_cmd=0x%lx, this_residual=%d, buffers_residual=%d\n", |
| 1405 | (long)hostdata->connected, (long)hostdata->sel_cmd, cmd->SCp.this_residual, cmd->SCp.buffers_residual)); |
| 1406 | cmd->SCp.phase = PHASE_DATAOUT0x00; |
| 1407 | goto PHASE_DATA_IO; |
| 1408 | |
| 1409 | case PHASE_DATAIN0x01: |
| 1410 | DEB_INFO(printk("Datain phase; cmd=0x%lx, sel_cmd=0x%lx, this_residual=%d, buffers_residual=%d\n", |
| 1411 | (long)hostdata->connected, (long)hostdata->sel_cmd, cmd->SCp.this_residual, cmd->SCp.buffers_residual)); |
| 1412 | cmd->SCp.phase = PHASE_DATAIN0x01; |
| 1413 | PHASE_DATA_IO: |
| 1414 | if (hostdata->aborted) { |
| 1415 | AM53C974_write_8(DMACMD, DMACMD_IDLE)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __outbc(((0x00)),(io_port + (0x40))) : __outb(((0x00)),(io_port + (0x40)))); |
| 1416 | AM53C974_write_8(CMDREG, CMDREG_CFIFO)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x01)),(io_port + (0x0C))) : __outb(((0x01)),(io_port + (0x0C)))); |
| 1417 | AM53C974_write_8(CMDREG, CMDREG_SATN)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x1A)),(io_port + (0x0C))) : __outb(((0x1A)),(io_port + (0x0C)))); |
| 1418 | return; } |
| 1419 | if ((!cmd->SCp.this_residual) && cmd->SCp.buffers_residual) { |
| 1420 | cmd->SCp.buffer++; |
| 1421 | cmd->SCp.buffers_residual--; |
| 1422 | cmd->SCp.ptr = (unsigned char *)cmd->SCp.buffer->address; |
| 1423 | cmd->SCp.this_residual = cmd->SCp.buffer->length; } |
| 1424 | if (cmd->SCp.this_residual) { |
| 1425 | if (!(AM53C974_read_8(DMACMD)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __inbc(io_port + (0x40)) : __inb(io_port + (0x40))) & DMACMD_START0x03)) { |
| 1426 | hostdata->dma_busy = 0; |
| 1427 | AM53C974_transfer_dma(instance, statreg & STATREG_IO0x01, |
| 1428 | (unsigned long)cmd->SCp.this_residual, |
| 1429 | cmd->SCp.ptr); } |
| 1430 | else |
| 1431 | hostdata->dma_busy = 1; |
| 1432 | } |
| 1433 | return; |
| 1434 | |
| 1435 | case PHASE_MSGIN0x07: |
| 1436 | DEB_INFO(printk("Message-In phase; cmd=0x%lx, sel_cmd=0x%lx\n", |
| 1437 | (long)hostdata->connected, (long)hostdata->sel_cmd)); |
| 1438 | AM53C974_set_async(instance, cmd->target); |
| 1439 | if (cmd->SCp.phase == PHASE_DATAIN0x01) |
| 1440 | AM53C974_dma_blast(instance, dmastatus, statreg); |
| 1441 | if ((cmd->SCp.phase == PHASE_DATAOUT0x00) && (AM53C974_read_8(DMACMD)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __inbc(io_port + (0x40)) : __inb(io_port + (0x40))) & DMACMD_START0x03)) { |
| 1442 | AM53C974_write_8(DMACMD, DMACMD_IDLE)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __outbc(((0x00)),(io_port + (0x40))) : __outb(((0x00)),(io_port + (0x40)))); |
| 1443 | residual = cfifo + (AM53C974_read_8(CTCLREG)((__builtin_constant_p((io_port + (0x00))) && (io_port + (0x00)) < 256) ? __inbc(io_port + (0x00)) : __inb(io_port + (0x00))) | (AM53C974_read_8(CTCMREG)((__builtin_constant_p((io_port + (0x04))) && (io_port + (0x04)) < 256) ? __inbc(io_port + (0x04)) : __inb(io_port + (0x04))) << 8) | |
| 1444 | (AM53C974_read_8(CTCHREG)((__builtin_constant_p((io_port + (0x38))) && (io_port + (0x38)) < 256) ? __inbc(io_port + (0x38)) : __inb(io_port + (0x38))) << 16)); |
| 1445 | cmd->SCp.ptr += cmd->SCp.this_residual - residual; |
| 1446 | cmd->SCp.this_residual = residual; |
| 1447 | if (cfifo) { AM53C974_write_8(CMDREG, CMDREG_CFIFO)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x01)),(io_port + (0x0C))) : __outb(((0x01)),(io_port + (0x0C)))); cfifo = 0; } |
| 1448 | } |
| 1449 | if (cmd->SCp.phase == PHASE_STATIN0x03) { |
| 1450 | while ((AM53C974_read_8(CFIREG)((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __inbc(io_port + (0x1C)) : __inb(io_port + (0x1C))) & CFIREG_CF0x1F) < 2) ; |
| 1451 | cmd->SCp.Status = AM53C974_read_8(FFREG)((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __inbc(io_port + (0x08)) : __inb(io_port + (0x08))); |
| 1452 | cmd->SCp.Message = AM53C974_read_8(FFREG)((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __inbc(io_port + (0x08)) : __inb(io_port + (0x08))); |
| 1453 | DEB_INFO(printk("Message-In phase; status=0x%02x, message=0x%02x\n", |
| 1454 | cmd->SCp.Status, cmd->SCp.Message)); |
| 1455 | ret = AM53C974_message(instance, cmd, cmd->SCp.Message); } |
Value stored to 'ret' is never read | |
| 1456 | else { |
| 1457 | if (!cfifo) { |
| 1458 | AM53C974_write_8(CMDREG, CMDREG_IT)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x10)),(io_port + (0x0C))) : __outb(((0x10)),(io_port + (0x0C)))); |
| 1459 | AM53C974_poll_int(){ do { statreg = ((__builtin_constant_p((io_port + (0x10))) && (io_port + (0x10)) < 256) ? __inbc(io_port + (0x10)) : __inb (io_port + (0x10))); } while (!(statreg & 0x80)) ; ((__builtin_constant_p ((io_port + (0x14))) && (io_port + (0x14)) < 256) ? __inbc(io_port + (0x14)) : __inb(io_port + (0x14))) ; }; |
| 1460 | cmd->SCp.Message = AM53C974_read_8(FFREG)((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __inbc(io_port + (0x08)) : __inb(io_port + (0x08))); |
| 1461 | } |
| 1462 | ret = AM53C974_message(instance, cmd, cmd->SCp.Message); |
| 1463 | } |
| 1464 | cmd->SCp.phase = PHASE_MSGIN0x07; |
| 1465 | AM53C974_set_sync(instance, cmd->target); |
| 1466 | break; |
| 1467 | case PHASE_MSGOUT0x06: |
| 1468 | DEB_INFO(printk("Message-Out phase; cfifo=%d; msgout[0]=0x%02x\n", |
| 1469 | AM53C974_read_8(CFIREG) & CFIREG_CF, hostdata->msgout[0])); |
| 1470 | AM53C974_write_8(DMACMD, DMACMD_IDLE)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __outbc(((0x00)),(io_port + (0x40))) : __outb(((0x00)),(io_port + (0x40)))); |
| 1471 | AM53C974_set_async(instance, cmd->target); |
| 1472 | for (i = 0; i < sizeof(hostdata->last_message); i++) |
| 1473 | hostdata->last_message[i] = hostdata->msgout[i]; |
| 1474 | if ((hostdata->msgout[0] == 0) || INSIDE(hostdata->msgout[0], 0x02, 0x1F)( ((hostdata->msgout[0]) >= (0x02)) && ((hostdata ->msgout[0]) <= (0x1F)) ) || |
| 1475 | INSIDE(hostdata->msgout[0], 0x80, 0xFF)( ((hostdata->msgout[0]) >= (0x80)) && ((hostdata ->msgout[0]) <= (0xFF)) )) |
| 1476 | len = 1; |
| 1477 | else { |
| 1478 | if (hostdata->msgout[0] == EXTENDED_MESSAGE0x01) { |
| 1479 | #ifdef AM53C974_DEBUG_INFO |
| 1480 | printk("Extended message dump:\n"); |
| 1481 | for (i = 0; i < hostdata->msgout[1] + 2; i++) { |
| 1482 | printk("%02x ", hostdata->msgout[i]); |
| 1483 | if (i && !(i % 16)) printk("\n"); } |
| 1484 | printk("\n"); |
| 1485 | #endif |
| 1486 | len = hostdata->msgout[1] + 2; } |
| 1487 | else |
| 1488 | len = 2; |
| 1489 | } |
| 1490 | for (i = 0; i < len; i++) AM53C974_write_8(FFREG, hostdata->msgout[i])((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __outbc(((hostdata->msgout[i])),(io_port + (0x08))) : __outb(((hostdata->msgout[i])),(io_port + (0x08 )))); |
| 1491 | AM53C974_write_8(CMDREG, CMDREG_IT)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x10)),(io_port + (0x0C))) : __outb(((0x10)),(io_port + (0x0C)))); |
| 1492 | cmd->SCp.phase = PHASE_MSGOUT0x06; |
| 1493 | hostdata->msgout[0] = NOP0x08; |
| 1494 | AM53C974_set_sync(instance, cmd->target); |
| 1495 | break; |
| 1496 | |
| 1497 | case PHASE_CMDOUT0x02: |
| 1498 | DEB_INFO(printk("Command-Out phase\n")); |
| 1499 | AM53C974_set_async(instance, cmd->target); |
| 1500 | for (i = 0; i < cmd->cmd_len; i++) AM53C974_write_8(FFREG, cmd->cmnd[i])((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __outbc(((cmd->cmnd[i])),(io_port + (0x08))) : __outb(((cmd->cmnd[i])),(io_port + (0x08)))); |
| 1501 | AM53C974_write_8(CMDREG, CMDREG_IT)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x10)),(io_port + (0x0C))) : __outb(((0x10)),(io_port + (0x0C)))); |
| 1502 | cmd->SCp.phase = PHASE_CMDOUT0x02; |
| 1503 | AM53C974_set_sync(instance, cmd->target); |
| 1504 | break; |
| 1505 | |
| 1506 | case PHASE_STATIN0x03: |
| 1507 | DEB_INFO(printk("Status phase\n")); |
| 1508 | if (cmd->SCp.phase == PHASE_DATAIN0x01) |
| 1509 | AM53C974_dma_blast(instance, dmastatus, statreg); |
| 1510 | AM53C974_set_async(instance, cmd->target); |
| 1511 | if (cmd->SCp.phase == PHASE_DATAOUT0x00) { |
| 1512 | unsigned long residual; |
| 1513 | |
| 1514 | if (AM53C974_read_8(DMACMD)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __inbc(io_port + (0x40)) : __inb(io_port + (0x40))) & DMACMD_START0x03) { |
| 1515 | AM53C974_write_8(DMACMD, DMACMD_IDLE)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __outbc(((0x00)),(io_port + (0x40))) : __outb(((0x00)),(io_port + (0x40)))); |
| 1516 | residual = cfifo + (AM53C974_read_8(CTCLREG)((__builtin_constant_p((io_port + (0x00))) && (io_port + (0x00)) < 256) ? __inbc(io_port + (0x00)) : __inb(io_port + (0x00))) | (AM53C974_read_8(CTCMREG)((__builtin_constant_p((io_port + (0x04))) && (io_port + (0x04)) < 256) ? __inbc(io_port + (0x04)) : __inb(io_port + (0x04))) << 8) | |
| 1517 | (AM53C974_read_8(CTCHREG)((__builtin_constant_p((io_port + (0x38))) && (io_port + (0x38)) < 256) ? __inbc(io_port + (0x38)) : __inb(io_port + (0x38))) << 16)); |
| 1518 | cmd->SCp.ptr += cmd->SCp.this_residual - residual; |
| 1519 | cmd->SCp.this_residual = residual; } |
| 1520 | if (cfifo) { AM53C974_write_8(CMDREG, CMDREG_CFIFO)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x01)),(io_port + (0x0C))) : __outb(((0x01)),(io_port + (0x0C)))); cfifo = 0; } |
| 1521 | } |
| 1522 | cmd->SCp.phase = PHASE_STATIN0x03; |
| 1523 | AM53C974_write_8(CMDREG, CMDREG_ICCS)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x11)),(io_port + (0x0C))) : __outb(((0x11)),(io_port + (0x0C)))); /* command complete */ |
| 1524 | break; |
| 1525 | |
| 1526 | case PHASE_RES_00x04: |
| 1527 | case PHASE_RES_10x05: |
| 1528 | #ifdef AM53C974_DEBUG |
| 1529 | deb_stop = 1; |
| 1530 | #endif |
| 1531 | DEB_INFO(printk("Reserved phase\n")); |
| 1532 | break; |
| 1533 | } |
| 1534 | KEYWAIT(); |
| 1535 | } |
| 1536 | |
| 1537 | /****************************************************************************** |
| 1538 | * Function : int AM53C974_message(struct Scsi_Host *instance, Scsi_Cmnd *cmd, |
| 1539 | * unsigned char msg) |
| 1540 | * |
| 1541 | * Purpose : handle SCSI messages |
| 1542 | * |
| 1543 | * Inputs : instance -- which AM53C974 |
| 1544 | * cmd -- SCSI command the message belongs to |
| 1545 | * msg -- message id byte |
| 1546 | * |
| 1547 | * Returns : 1 on success, 0 on failure. |
| 1548 | **************************************************************************/ |
| 1549 | static int AM53C974_message(struct Scsi_Host *instance, Scsi_Cmnd *cmd, |
| 1550 | unsigned char msg) |
| 1551 | { |
| 1552 | AM53C974_local_declare()unsigned long io_port; |
| 1553 | static unsigned char extended_msg[10]; |
| 1554 | unsigned char statreg; |
| 1555 | int len, ret = 0; |
| 1556 | unsigned char *p; |
| 1557 | #ifdef AM53C974_DEBUG_MSG |
| 1558 | int j; |
| 1559 | #endif |
| 1560 | struct AM53C974_hostdata *hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 1561 | AM53C974_setio(instance)io_port = instance->io_port; |
| 1562 | |
| 1563 | DEB_MSG(printk(SEPARATOR_LINE)); |
| 1564 | |
| 1565 | /* Linking lets us reduce the time required to get the |
| 1566 | * next command out to the device, hopefully this will |
| 1567 | * mean we don't waste another revolution due to the delays |
| 1568 | * required by ARBITRATION and another SELECTION. |
| 1569 | * In the current implementation proposal, low level drivers |
| 1570 | * merely have to start the next command, pointed to by |
| 1571 | * next_link, done() is called as with unlinked commands. */ |
| 1572 | switch (msg) { |
| 1573 | #ifdef LINKED |
| 1574 | case LINKED_CMD_COMPLETE0x0a: |
| 1575 | case LINKED_FLG_CMD_COMPLETE0x0b: |
| 1576 | /* Accept message by releasing ACK */ |
| 1577 | DEB_LINKED(printk("scsi%d : target %d lun %d linked command complete.\n", |
| 1578 | instance->host_no, cmd->target, cmd->lun)); |
| 1579 | /* Sanity check : A linked command should only terminate with |
| 1580 | * one of these messages if there are more linked commands available. */ |
| 1581 | if (!cmd->next_link) { |
| 1582 | printk("scsi%d : target %d lun %d linked command complete, no next_link\n" |
| 1583 | instance->host_no, cmd->target, cmd->lun); |
| 1584 | hostdata->aborted = 1; |
| 1585 | AM53C974_write_8(CMDREG, CMDREG_SATN)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x1A)),(io_port + (0x0C))) : __outb(((0x1A)),(io_port + (0x0C)))); |
| 1586 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); |
| 1587 | break; } |
| 1588 | if (hostdata->aborted) { |
| 1589 | DEB_ABORT(printk("ATN set for cmnd %d upon reception of LINKED_CMD_COMPLETE or"printk("ATN set for cmnd %d upon reception of LINKED_CMD_COMPLETE or" "LINKED_FLG_CMD_COMPLETE message\n", cmd->cmnd[0]) |
| 1590 | "LINKED_FLG_CMD_COMPLETE message\n", cmd->cmnd[0]))printk("ATN set for cmnd %d upon reception of LINKED_CMD_COMPLETE or" "LINKED_FLG_CMD_COMPLETE message\n", cmd->cmnd[0]); |
| 1591 | AM53C974_write_8(CMDREG, CMDREG_SATN)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x1A)),(io_port + (0x0C))) : __outb(((0x1A)),(io_port + (0x0C)))); } |
| 1592 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); |
| 1593 | |
| 1594 | initialize_SCp(cmd->next_link); |
| 1595 | /* The next command is still part of this process */ |
| 1596 | cmd->next_link->tag = cmd->tag; |
| 1597 | cmd->result = cmd->SCp.Status | (cmd->SCp.Message << 8); |
| 1598 | DEB_LINKED(printk("scsi%d : target %d lun %d linked request done, calling scsi_done().\n", |
| 1599 | instance->host_no, cmd->target, cmd->lun)); |
| 1600 | cmd->scsi_done(cmd); |
| 1601 | cmd = hostdata->connected; |
| 1602 | break; |
| 1603 | |
| 1604 | #endif /* def LINKED */ |
| 1605 | |
| 1606 | case ABORT0x06: |
| 1607 | case COMMAND_COMPLETE0x00: |
| 1608 | DEB_MSG(printk("scsi%d: command complete message received; cmd %d for target %d, lun %d\n", |
| 1609 | instance->host_no, cmd->cmnd[0], cmd->target, cmd->lun)); |
| 1610 | hostdata->disconnecting = 1; |
| 1611 | cmd->device->disconnect = 0; |
| 1612 | |
| 1613 | /* I'm not sure what the correct thing to do here is : |
| 1614 | * |
| 1615 | * If the command that just executed is NOT a request |
| 1616 | * sense, the obvious thing to do is to set the result |
| 1617 | * code to the values of the stored parameters. |
| 1618 | * If it was a REQUEST SENSE command, we need some way |
| 1619 | * to differentiate between the failure code of the original |
| 1620 | * and the failure code of the REQUEST sense - the obvious |
| 1621 | * case is success, where we fall through and leave the result |
| 1622 | * code unchanged. |
| 1623 | * |
| 1624 | * The non-obvious place is where the REQUEST SENSE failed */ |
| 1625 | if (cmd->cmnd[0] != REQUEST_SENSE0x03) |
| 1626 | cmd->result = cmd->SCp.Status | (cmd->SCp.Message << 8); |
| 1627 | else if (cmd->SCp.Status != GOOD0x00) |
| 1628 | cmd->result = (cmd->result & 0x00ffff) | (DID_ERROR0x07 << 16); |
| 1629 | if (hostdata->aborted) { |
| 1630 | AM53C974_write_8(CMDREG, CMDREG_SATN)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x1A)),(io_port + (0x0C))) : __outb(((0x1A)),(io_port + (0x0C)))); |
| 1631 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); |
| 1632 | DEB_ABORT(printk("ATN set for cmnd %d upon reception of ABORT or"printk("ATN set for cmnd %d upon reception of ABORT or" "COMMAND_COMPLETE message\n" , cmd->cmnd[0]) |
| 1633 | "COMMAND_COMPLETE message\n", cmd->cmnd[0]))printk("ATN set for cmnd %d upon reception of ABORT or" "COMMAND_COMPLETE message\n" , cmd->cmnd[0]); |
| 1634 | break; } |
| 1635 | if ((cmd->cmnd[0] != REQUEST_SENSE0x03) && (cmd->SCp.Status == CHECK_CONDITION0x01)) { |
| 1636 | DEB_MSG(printk("scsi%d : performing request sense\n", instance->host_no)); |
| 1637 | cmd->cmnd[0] = REQUEST_SENSE0x03; |
| 1638 | cmd->cmnd[1] &= 0xe0; |
| 1639 | cmd->cmnd[2] = 0; |
| 1640 | cmd->cmnd[3] = 0; |
| 1641 | cmd->cmnd[4] = sizeof(cmd->sense_buffer); |
| 1642 | cmd->cmnd[5] = 0; |
| 1643 | cmd->SCp.buffer = NULL((void *) 0); |
| 1644 | cmd->SCp.buffers_residual = 0; |
| 1645 | cmd->SCp.ptr = (char *)cmd->sense_buffer; |
| 1646 | cmd->SCp.this_residual = sizeof(cmd->sense_buffer); |
| 1647 | LIST(cmd,hostdata->issue_queue); |
| 1648 | cmd->host_scribble = (unsigned char *)hostdata->issue_queue; |
| 1649 | hostdata->issue_queue = (Scsi_Cmnd *)cmd; |
| 1650 | DEB_MSG(printk("scsi%d : REQUEST SENSE added to head of issue queue\n",instance->host_no)); |
| 1651 | } |
| 1652 | |
| 1653 | /* Accept message by clearing ACK */ |
| 1654 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); |
| 1655 | break; |
| 1656 | |
| 1657 | case MESSAGE_REJECT0x07: |
| 1658 | DEB_MSG(printk("scsi%d: reject message received; cmd %d for target %d, lun %d\n", |
| 1659 | instance->host_no, cmd->cmnd[0], cmd->target, cmd->lun)); |
| 1660 | switch (hostdata->last_message[0]) { |
| 1661 | case EXTENDED_MESSAGE0x01: |
| 1662 | if (hostdata->last_message[2] == EXTENDED_SDTR0x01) { |
| 1663 | /* sync. negotiation was rejected, setup asynchronous transfer with target */ |
| 1664 | printk("\ntarget %d: rate=%d Mhz, asynchronous (sync. negotiation rejected)\n", |
| 1665 | cmd->target, DEF_CLK40 / DEF_STP8); |
| 1666 | hostdata->sync_off[cmd->target] = 0; |
| 1667 | hostdata->sync_per[cmd->target] = DEF_STP8; } |
| 1668 | break; |
| 1669 | case HEAD_OF_QUEUE_TAG0x21: |
| 1670 | case ORDERED_QUEUE_TAG0x22: |
| 1671 | case SIMPLE_QUEUE_TAG0x20: |
| 1672 | cmd->device->tagged_queue = 0; |
| 1673 | hostdata->busy[cmd->target] |= (1 << cmd->lun); |
| 1674 | break; |
| 1675 | default: |
| 1676 | break; |
| 1677 | } |
| 1678 | if (hostdata->aborted) AM53C974_write_8(CMDREG, CMDREG_SATN)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x1A)),(io_port + (0x0C))) : __outb(((0x1A)),(io_port + (0x0C)))); |
| 1679 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); |
| 1680 | break; |
| 1681 | |
| 1682 | case DISCONNECT0x04: |
| 1683 | DEB_MSG(printk("scsi%d: disconnect message received; cmd %d for target %d, lun %d\n", |
| 1684 | instance->host_no, cmd->cmnd[0], cmd->target, cmd->lun)); |
| 1685 | cmd->device->disconnect = 1; |
| 1686 | hostdata->disconnecting = 1; |
| 1687 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); /* Accept message by clearing ACK */ |
| 1688 | break; |
| 1689 | |
| 1690 | case SAVE_POINTERS0x02: |
| 1691 | case RESTORE_POINTERS0x03: |
| 1692 | DEB_MSG(printk("scsi%d: save/restore pointers message received; cmd %d for target %d, lun %d\n", |
| 1693 | instance->host_no, cmd->cmnd[0], cmd->target, cmd->lun)); |
| 1694 | /* The SCSI data pointer is *IMPLICITLY* saved on a disconnect |
| 1695 | * operation, in violation of the SCSI spec so we can safely |
| 1696 | * ignore SAVE/RESTORE pointers calls. |
| 1697 | * |
| 1698 | * Unfortunately, some disks violate the SCSI spec and |
| 1699 | * don't issue the required SAVE_POINTERS message before |
| 1700 | * disconnecting, and we have to break spec to remain |
| 1701 | * compatible. */ |
| 1702 | if (hostdata->aborted) { |
| 1703 | DEB_ABORT(printk("ATN set for cmnd %d upon reception of SAVE/REST. POINTERS message\n",printk("ATN set for cmnd %d upon reception of SAVE/REST. POINTERS message\n" , cmd->cmnd[0]) |
| 1704 | cmd->cmnd[0]))printk("ATN set for cmnd %d upon reception of SAVE/REST. POINTERS message\n" , cmd->cmnd[0]); |
| 1705 | AM53C974_write_8(CMDREG, CMDREG_SATN)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x1A)),(io_port + (0x0C))) : __outb(((0x1A)),(io_port + (0x0C)))); } |
| 1706 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); |
| 1707 | break; |
| 1708 | |
| 1709 | case EXTENDED_MESSAGE0x01: |
| 1710 | DEB_MSG(printk("scsi%d: extended message received; cmd %d for target %d, lun %d\n", |
| 1711 | instance->host_no, cmd->cmnd[0], cmd->target, cmd->lun)); |
| 1712 | /* Extended messages are sent in the following format : |
| 1713 | * Byte |
| 1714 | * 0 EXTENDED_MESSAGE == 1 |
| 1715 | * 1 length (includes one byte for code, doesn't include first two bytes) |
| 1716 | * 2 code |
| 1717 | * 3..length+1 arguments |
| 1718 | */ |
| 1719 | /* BEWARE!! THIS CODE IS EXTREMELY UGLY */ |
| 1720 | extended_msg[0] = EXTENDED_MESSAGE0x01; |
| 1721 | AM53C974_read_8(INSTREG)((__builtin_constant_p((io_port + (0x14))) && (io_port + (0x14)) < 256) ? __inbc(io_port + (0x14)) : __inb(io_port + (0x14))) ; /* clear int */ |
| 1722 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); /* ack. msg byte, then wait for SO */ |
| 1723 | AM53C974_poll_int(){ do { statreg = ((__builtin_constant_p((io_port + (0x10))) && (io_port + (0x10)) < 256) ? __inbc(io_port + (0x10)) : __inb (io_port + (0x10))); } while (!(statreg & 0x80)) ; ((__builtin_constant_p ((io_port + (0x14))) && (io_port + (0x14)) < 256) ? __inbc(io_port + (0x14)) : __inb(io_port + (0x14))) ; }; |
| 1724 | /* get length */ |
| 1725 | AM53C974_write_8(CMDREG, CMDREG_IT)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x10)),(io_port + (0x0C))) : __outb(((0x10)),(io_port + (0x0C)))); |
| 1726 | AM53C974_poll_int(){ do { statreg = ((__builtin_constant_p((io_port + (0x10))) && (io_port + (0x10)) < 256) ? __inbc(io_port + (0x10)) : __inb (io_port + (0x10))); } while (!(statreg & 0x80)) ; ((__builtin_constant_p ((io_port + (0x14))) && (io_port + (0x14)) < 256) ? __inbc(io_port + (0x14)) : __inb(io_port + (0x14))) ; }; |
| 1727 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); /* ack. msg byte, then wait for SO */ |
| 1728 | AM53C974_poll_int(){ do { statreg = ((__builtin_constant_p((io_port + (0x10))) && (io_port + (0x10)) < 256) ? __inbc(io_port + (0x10)) : __inb (io_port + (0x10))); } while (!(statreg & 0x80)) ; ((__builtin_constant_p ((io_port + (0x14))) && (io_port + (0x14)) < 256) ? __inbc(io_port + (0x14)) : __inb(io_port + (0x14))) ; }; |
| 1729 | extended_msg[1] = len = AM53C974_read_8(FFREG)((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __inbc(io_port + (0x08)) : __inb(io_port + (0x08))); /* get length */ |
| 1730 | p = extended_msg+2; |
| 1731 | /* read the remaining (len) bytes */ |
| 1732 | while (len) { |
| 1733 | AM53C974_write_8(CMDREG, CMDREG_IT)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x10)),(io_port + (0x0C))) : __outb(((0x10)),(io_port + (0x0C)))); |
| 1734 | AM53C974_poll_int(){ do { statreg = ((__builtin_constant_p((io_port + (0x10))) && (io_port + (0x10)) < 256) ? __inbc(io_port + (0x10)) : __inb (io_port + (0x10))); } while (!(statreg & 0x80)) ; ((__builtin_constant_p ((io_port + (0x14))) && (io_port + (0x14)) < 256) ? __inbc(io_port + (0x14)) : __inb(io_port + (0x14))) ; }; |
| 1735 | if (len > 1) { |
| 1736 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); /* ack. msg byte, then wait for SO */ |
| 1737 | AM53C974_poll_int(){ do { statreg = ((__builtin_constant_p((io_port + (0x10))) && (io_port + (0x10)) < 256) ? __inbc(io_port + (0x10)) : __inb (io_port + (0x10))); } while (!(statreg & 0x80)) ; ((__builtin_constant_p ((io_port + (0x14))) && (io_port + (0x14)) < 256) ? __inbc(io_port + (0x14)) : __inb(io_port + (0x14))) ; }; } |
| 1738 | *p = AM53C974_read_8(FFREG)((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __inbc(io_port + (0x08)) : __inb(io_port + (0x08))); |
| 1739 | p++; len--; } |
| 1740 | |
| 1741 | #ifdef AM53C974_DEBUG_MSG |
| 1742 | printk("scsi%d: received extended message: ", instance->host_no); |
| 1743 | for (j = 0; j < extended_msg[1] + 2; j++) { |
| 1744 | printk("0x%02x ", extended_msg[j]); |
| 1745 | if (j && !(j % 16)) printk("\n"); } |
| 1746 | printk("\n"); |
| 1747 | #endif |
| 1748 | |
| 1749 | /* check message */ |
| 1750 | if (extended_msg[2] == EXTENDED_SDTR0x01) |
| 1751 | ret = AM53C974_sync_neg(instance, cmd->target, extended_msg); |
| 1752 | if (ret || hostdata->aborted) AM53C974_write_8(CMDREG, CMDREG_SATN)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x1A)),(io_port + (0x0C))) : __outb(((0x1A)),(io_port + (0x0C)))); |
| 1753 | |
| 1754 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); |
| 1755 | break; |
| 1756 | |
| 1757 | default: |
| 1758 | printk("scsi%d: unknown message 0x%02x received\n",instance->host_no, msg); |
| 1759 | #ifdef AM53C974_DEBUG |
| 1760 | deb_stop = 1; |
| 1761 | #endif |
| 1762 | /* reject message */ |
| 1763 | hostdata->msgout[0] = MESSAGE_REJECT0x07; |
| 1764 | AM53C974_write_8(CMDREG, CMDREG_SATN)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x1A)),(io_port + (0x0C))) : __outb(((0x1A)),(io_port + (0x0C)))); |
| 1765 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); |
| 1766 | return(0); |
| 1767 | break; |
| 1768 | |
| 1769 | } /* switch (msg) */ |
| 1770 | KEYWAIT(); |
| 1771 | return(1); |
| 1772 | } |
| 1773 | |
| 1774 | /************************************************************************** |
| 1775 | * Function : AM53C974_select(struct Scsi_Host *instance, Scsi_Cmnd *cmd, int tag) |
| 1776 | * |
| 1777 | * Purpose : try to establish nexus for the command; |
| 1778 | * start sync negotiation via start stop and transfer the command in |
| 1779 | * cmdout phase in case of an inquiry or req. sense command with no |
| 1780 | * sync. neg. performed yet |
| 1781 | * |
| 1782 | * Inputs : instance -- which AM53C974 |
| 1783 | * cmd -- command which requires the selection |
| 1784 | * tag -- tagged queueing |
| 1785 | * |
| 1786 | * Returns : nothing |
| 1787 | * |
| 1788 | * Note: this function initializes the selection process, which is continued |
| 1789 | * in the interrupt handler |
| 1790 | **************************************************************************/ |
| 1791 | static void AM53C974_select(struct Scsi_Host *instance, Scsi_Cmnd *cmd, int tag) |
| 1792 | { |
| 1793 | AM53C974_local_declare()unsigned long io_port; |
| 1794 | struct AM53C974_hostdata *hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 1795 | unsigned char cfifo, tmp[3]; |
| 1796 | unsigned int i, len, cmd_size = COMMAND_SIZE(cmd->cmnd[0])scsi_command_size[((cmd->cmnd[0]) >> 5) & 7]; |
| 1797 | AM53C974_setio(instance)io_port = instance->io_port; |
| 1798 | |
| 1799 | cfifo = AM53C974_cfifo()(((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __inbc(io_port + (0x1C)) : __inb(io_port + (0x1C))) & 0x1F); |
| 1800 | if (cfifo) { |
| 1801 | printk("scsi%d: select error; %d residual bytes in FIFO\n", instance->host_no, cfifo); |
| 1802 | AM53C974_write_8(CMDREG, CMDREG_CFIFO)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x01)),(io_port + (0x0C))) : __outb(((0x01)),(io_port + (0x0C)))); /* clear FIFO */ |
| 1803 | } |
| 1804 | |
| 1805 | tmp[0] = IDENTIFY(1, cmd->lun)(0x80 | ((1) ? 0x40 : 0) | ((cmd->lun) & 0x07)); |
| 1806 | |
| 1807 | #ifdef SCSI2 |
| 1808 | if (cmd->device->tagged_queue && (tag != TAG_NONE-2)) { |
| 1809 | tmp[1] = SIMPLE_QUEUE_TAG0x20; |
| 1810 | if (tag == TAG_NEXT-1) { |
| 1811 | /* 0 is TAG_NONE, used to imply no tag for this command */ |
| 1812 | if (cmd->device->current_tag == 0) cmd->device->current_tag = 1; |
| 1813 | cmd->tag = cmd->device->current_tag; |
| 1814 | cmd->device->current_tag++; } |
| 1815 | else |
| 1816 | cmd->tag = (unsigned char)tag; |
| 1817 | tmp[2] = cmd->tag; |
| 1818 | hostdata->last_message[0] = SIMPLE_QUEUE_TAG0x20; |
| 1819 | len = 3; |
| 1820 | AM53C974_write_8(FFREG, tmp[0])((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __outbc(((tmp[0])),(io_port + (0x08))) : __outb(((tmp[0])),(io_port + (0x08)))); |
| 1821 | AM53C974_write_8(FFREG, tmp[1])((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __outbc(((tmp[1])),(io_port + (0x08))) : __outb(((tmp[1])),(io_port + (0x08)))); |
| 1822 | AM53C974_write_8(FFREG, tmp[2])((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __outbc(((tmp[2])),(io_port + (0x08))) : __outb(((tmp[2])),(io_port + (0x08)))); |
| 1823 | } |
| 1824 | else |
| 1825 | #endif /* def SCSI2 */ |
| 1826 | { |
| 1827 | len = 1; |
| 1828 | AM53C974_write_8(FFREG, tmp[0])((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __outbc(((tmp[0])),(io_port + (0x08))) : __outb(((tmp[0])),(io_port + (0x08)))); |
| 1829 | cmd->tag = 0; } |
| 1830 | |
| 1831 | /* in case of an inquiry or req. sense command with no sync. neg performed yet, we start |
| 1832 | sync negotiation via start stops and transfer the command in cmdout phase */ |
| 1833 | if (((cmd->cmnd[0] == INQUIRY0x12) || (cmd->cmnd[0] == REQUEST_SENSE0x03)) && |
| 1834 | !(hostdata->sync_neg[cmd->target]) && hostdata->sync_en[cmd->target]) { |
| 1835 | hostdata->sync_neg[cmd->target] = 1; |
| 1836 | hostdata->msgout[0] = EXTENDED_MESSAGE0x01; |
| 1837 | hostdata->msgout[1] = 3; |
| 1838 | hostdata->msgout[2] = EXTENDED_SDTR0x01; |
| 1839 | hostdata->msgout[3] = 250 / (int)hostdata->max_rate[cmd->target]; |
| 1840 | hostdata->msgout[4] = hostdata->max_offset[cmd->target]; |
| 1841 | len += 5; } |
| 1842 | |
| 1843 | AM53C974_write_8(SDIDREG, SDIREG_MASK & cmd->target)((__builtin_constant_p((io_port + (0x10))) && (io_port + (0x10)) < 256) ? __outbc(((0x07 & cmd->target)), (io_port + (0x10))) : __outb(((0x07 & cmd->target)),(io_port + (0x10)))); /* setup dest. id */ |
| 1844 | AM53C974_write_8(STIMREG, DEF_SCSI_TIMEOUT)((__builtin_constant_p((io_port + (0x14))) && (io_port + (0x14)) < 256) ? __outbc(((245)),(io_port + (0x14))) : __outb (((245)),(io_port + (0x14)))); /* setup timeout reg */ |
| 1845 | switch (len) { |
| 1846 | case 1: |
| 1847 | for (i = 0; i < cmd_size; i++) AM53C974_write_8(FFREG, cmd->cmnd[i])((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __outbc(((cmd->cmnd[i])),(io_port + (0x08))) : __outb(((cmd->cmnd[i])),(io_port + (0x08)))); |
| 1848 | AM53C974_write_8(CMDREG, CMDREG_SAS)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x42)),(io_port + (0x0C))) : __outb(((0x42)),(io_port + (0x0C)))); /* select with ATN, 1 msg byte */ |
| 1849 | hostdata->msgout[0] = NOP0x08; |
| 1850 | break; |
| 1851 | case 3: |
| 1852 | for (i = 0; i < cmd_size; i++) AM53C974_write_8(FFREG, cmd->cmnd[i])((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __outbc(((cmd->cmnd[i])),(io_port + (0x08))) : __outb(((cmd->cmnd[i])),(io_port + (0x08)))); |
| 1853 | AM53C974_write_8(CMDREG, CMDREG_SA3S)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x46)),(io_port + (0x0C))) : __outb(((0x46)),(io_port + (0x0C)))); /* select with ATN, 3 msg bytes */ |
| 1854 | hostdata->msgout[0] = NOP0x08; |
| 1855 | break; |
| 1856 | default: |
| 1857 | AM53C974_write_8(CMDREG, CMDREG_SASS)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x43)),(io_port + (0x0C))) : __outb(((0x43)),(io_port + (0x0C)))); /* select with ATN, stop steps; continue in message out phase */ |
| 1858 | break; |
| 1859 | } |
| 1860 | } |
| 1861 | |
| 1862 | /************************************************************************** |
| 1863 | * Function : AM53C974_intr_select(struct Scsi_Host *instance, unsigned char statreg) |
| 1864 | * |
| 1865 | * Purpose : handle reselection |
| 1866 | * |
| 1867 | * Inputs : instance -- which AM53C974 |
| 1868 | * statreg -- status register |
| 1869 | * |
| 1870 | * Returns : nothing |
| 1871 | * |
| 1872 | * side effects: manipulates hostdata |
| 1873 | **************************************************************************/ |
| 1874 | static void AM53C974_intr_reselect(struct Scsi_Host *instance, unsigned char statreg) |
| 1875 | { |
| 1876 | AM53C974_local_declare()unsigned long io_port; |
| 1877 | struct AM53C974_hostdata *hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 1878 | unsigned char cfifo, msg[3], lun, t, target = 0; |
| 1879 | #ifdef SCSI2 |
| 1880 | unsigned char tag; |
| 1881 | #endif |
| 1882 | Scsi_Cmnd *tmp = NULL((void *) 0), *prev; |
| 1883 | AM53C974_setio(instance)io_port = instance->io_port; |
| 1884 | |
| 1885 | cfifo = AM53C974_cfifo()(((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __inbc(io_port + (0x1C)) : __inb(io_port + (0x1C))) & 0x1F); |
| 1886 | |
| 1887 | if (hostdata->selecting) { |
| 1888 | /* caught reselect interrupt in selection process; |
| 1889 | put selecting command back into the issue queue and continue with the |
| 1890 | reselecting command */ |
| 1891 | DEB_RESEL(printk("AM53C974_intr_reselect: in selection process\n")); |
| 1892 | LIST(hostdata->sel_cmd, hostdata->issue_queue); |
| 1893 | hostdata->sel_cmd->host_scribble = (unsigned char *)hostdata->issue_queue; |
| 1894 | hostdata->issue_queue = hostdata->sel_cmd; |
| 1895 | hostdata->sel_cmd = NULL((void *) 0); |
| 1896 | hostdata->selecting = 0; } |
| 1897 | |
| 1898 | /* 2 bytes must be in the FIFO now */ |
| 1899 | if (cfifo != 2) { |
| 1900 | printk("scsi %d: error: %d bytes in fifo, 2 expected\n", instance->host_no, cfifo); |
| 1901 | hostdata->aborted = 1; |
| 1902 | goto EXIT_ABORT; } |
| 1903 | |
| 1904 | /* determine target which reselected */ |
| 1905 | t = AM53C974_read_8(FFREG)((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __inbc(io_port + (0x08)) : __inb(io_port + (0x08))); |
| 1906 | if (!(t & (1 << instance->this_id))) { |
| 1907 | printk("scsi %d: error: invalid host id\n", instance->host_no); |
| 1908 | hostdata->aborted = 1; |
| 1909 | goto EXIT_ABORT; } |
| 1910 | t ^= (1 << instance->this_id); |
| 1911 | target = 0; while (t != 1) { t >>= 1; target++; } |
| 1912 | DEB_RESEL(printk("scsi %d: reselect; target: %d\n", instance->host_no, target)); |
| 1913 | |
| 1914 | if (hostdata->aborted) goto EXIT_ABORT; |
| 1915 | |
| 1916 | if ((statreg & STATREG_PHASE0x07) != PHASE_MSGIN0x07) { |
| 1917 | printk("scsi %d: error: upon reselection interrupt not in MSGIN\n", instance->host_no); |
| 1918 | hostdata->aborted = 1; |
| 1919 | goto EXIT_ABORT; } |
| 1920 | |
| 1921 | msg[0] = AM53C974_read_8(FFREG)((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __inbc(io_port + (0x08)) : __inb(io_port + (0x08))); |
| 1922 | if (!(msg[0] & 0x80)) { |
| 1923 | printk("scsi%d: error: expecting IDENTIFY message, got ", instance->host_no); |
| 1924 | print_msg(msg); |
| 1925 | hostdata->aborted = 1; |
| 1926 | goto EXIT_ABORT; } |
| 1927 | |
| 1928 | lun = (msg[0] & 0x07); |
| 1929 | |
| 1930 | /* We need to add code for SCSI-II to track which devices have |
| 1931 | * I_T_L_Q nexuses established, and which have simple I_T_L |
| 1932 | * nexuses so we can chose to do additional data transfer. */ |
| 1933 | #ifdef SCSI2 |
| 1934 | #error "SCSI-II tagged queueing is not supported yet" |
| 1935 | #endif |
| 1936 | |
| 1937 | /* Find the command corresponding to the I_T_L or I_T_L_Q nexus we |
| 1938 | * just reestablished, and remove it from the disconnected queue. */ |
| 1939 | for (tmp = (Scsi_Cmnd *)hostdata->disconnected_queue, prev = NULL((void *) 0); |
| 1940 | tmp; prev = tmp, tmp = (Scsi_Cmnd *)tmp->host_scribble) |
| 1941 | if ((target == tmp->target) && (lun == tmp->lun) |
| 1942 | #ifdef SCSI2 |
| 1943 | && (tag == tmp->tag) |
| 1944 | #endif |
| 1945 | ) { |
| 1946 | if (prev) { |
| 1947 | REMOVE(prev, (Scsi_Cmnd *)(prev->host_scribble), tmp, |
| 1948 | (Scsi_Cmnd *)(tmp->host_scribble)); |
| 1949 | prev->host_scribble = tmp->host_scribble; } |
| 1950 | else { |
| 1951 | REMOVE(-1, hostdata->disconnected_queue, tmp, tmp->host_scribble); |
| 1952 | hostdata->disconnected_queue = (Scsi_Cmnd *)tmp->host_scribble; } |
| 1953 | tmp->host_scribble = NULL((void *) 0); |
| 1954 | hostdata->connected = tmp; |
| 1955 | break; } |
| 1956 | |
| 1957 | if (!tmp) { |
| 1958 | #ifdef SCSI2 |
| 1959 | printk("scsi%d: warning : target %d lun %d tag %d not in disconnect_queue.\n", |
| 1960 | instance->host_no, target, lun, tag); |
| 1961 | #else |
| 1962 | printk("scsi%d: warning : target %d lun %d not in disconnect_queue.\n", |
| 1963 | instance->host_no, target, lun); |
| 1964 | #endif |
| 1965 | /* Since we have an established nexus that we can't do anything with, we must abort it. */ |
| 1966 | hostdata->aborted = 1; |
| 1967 | DEB(AM53C974_keywait()); |
| 1968 | goto EXIT_ABORT; } |
| 1969 | else |
| 1970 | goto EXIT_OK; |
| 1971 | |
| 1972 | EXIT_ABORT: |
| 1973 | AM53C974_write_8(CMDREG, CMDREG_SATN)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x1A)),(io_port + (0x0C))) : __outb(((0x1A)),(io_port + (0x0C)))); |
| 1974 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); |
| 1975 | return; |
| 1976 | |
| 1977 | EXIT_OK: |
| 1978 | DEB_RESEL(printk("scsi%d: nexus established, target = %d, lun = %d, tag = %d\n", |
| 1979 | instance->host_no, target, tmp->lun, tmp->tag)); |
| 1980 | AM53C974_set_sync(instance, target); |
| 1981 | AM53C974_write_8(SDIDREG, SDIREG_MASK & target)((__builtin_constant_p((io_port + (0x10))) && (io_port + (0x10)) < 256) ? __outbc(((0x07 & target)),(io_port + (0x10))) : __outb(((0x07 & target)),(io_port + (0x10)) )); /* setup dest. id */ |
| 1982 | AM53C974_write_8(CMDREG, CMDREG_MA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x12)),(io_port + (0x0C))) : __outb(((0x12)),(io_port + (0x0C)))); |
| 1983 | hostdata->dma_busy = 0; |
| 1984 | hostdata->connected->SCp.phase = PHASE_CMDOUT0x02; |
| 1985 | } |
| 1986 | |
| 1987 | /************************************************************************** |
| 1988 | * Function : AM53C974_transfer_dma(struct Scsi_Host *instance, short dir, |
| 1989 | * unsigned long length, char *data) |
| 1990 | * |
| 1991 | * Purpose : setup DMA transfer |
| 1992 | * |
| 1993 | * Inputs : instance -- which AM53C974 |
| 1994 | * dir -- direction flag, 0: write to device, read from memory; |
| 1995 | * 1: read from device, write to memory |
| 1996 | * length -- number of bytes to transfer to from buffer |
| 1997 | * data -- pointer to data buffer |
| 1998 | * |
| 1999 | * Returns : nothing |
| 2000 | **************************************************************************/ |
| 2001 | static __inline____inline__ __attribute__((always_inline)) void AM53C974_transfer_dma(struct Scsi_Host *instance, short dir, |
| 2002 | unsigned long length, char *data) |
| 2003 | { |
| 2004 | AM53C974_local_declare()unsigned long io_port; |
| 2005 | AM53C974_setio(instance)io_port = instance->io_port; |
| 2006 | |
| 2007 | AM53C974_write_8(CMDREG, CMDREG_NOP)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x00)),(io_port + (0x0C))) : __outb(((0x00)),(io_port + (0x0C)))); |
| 2008 | AM53C974_write_8(DMACMD, (dir << 7) | DMACMD_INTE_D)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __outbc((((dir << 7) | 0x40)),(io_port + (0x40))) : __outb((((dir << 7) | 0x40)),(io_port + ( 0x40)))); /* idle command */ |
| 2009 | AM53C974_write_8(STCLREG, (unsigned char)(length & 0xff))((__builtin_constant_p((io_port + (0x00))) && (io_port + (0x00)) < 256) ? __outbc((((unsigned char)(length & 0xff))),(io_port + (0x00))) : __outb((((unsigned char)(length & 0xff))),(io_port + (0x00)))); |
| 2010 | AM53C974_write_8(STCMREG, (unsigned char)((length & 0xff00) >> 8))((__builtin_constant_p((io_port + (0x04))) && (io_port + (0x04)) < 256) ? __outbc((((unsigned char)((length & 0xff00) >> 8))),(io_port + (0x04))) : __outb((((unsigned char)((length & 0xff00) >> 8))),(io_port + (0x04)) )); |
| 2011 | AM53C974_write_8(STCHREG, (unsigned char)((length & 0xff0000) >> 16))((__builtin_constant_p((io_port + (0x38))) && (io_port + (0x38)) < 256) ? __outbc((((unsigned char)((length & 0xff0000) >> 16))),(io_port + (0x38))) : __outb((((unsigned char)((length & 0xff0000) >> 16))),(io_port + (0x38 )))); |
| 2012 | AM53C974_write_32(DMASTC, length & 0xffffff)((__builtin_constant_p((io_port + (0x44))) && (io_port + (0x44)) < 256) ? __outlc(((length & 0xffffff)),(io_port + (0x44))) : __outl(((length & 0xffffff)),(io_port + (0x44 )))); |
| 2013 | AM53C974_write_32(DMASPA, virt_to_bus(data))((__builtin_constant_p((io_port + (0x48))) && (io_port + (0x48)) < 256) ? __outlc(((virt_to_phys(data))),(io_port + (0x48))) : __outl(((virt_to_phys(data))),(io_port + (0x48) ))); |
| 2014 | AM53C974_write_8(CMDREG, CMDREG_IT | CMDREG_DMA)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x10 | 0x80)),(io_port + (0x0C ))) : __outb(((0x10 | 0x80)),(io_port + (0x0C)))); |
| 2015 | AM53C974_write_8(DMACMD, (dir << 7) | DMACMD_INTE_D | DMACMD_START)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __outbc((((dir << 7) | 0x40 | 0x03 )),(io_port + (0x40))) : __outb((((dir << 7) | 0x40 | 0x03 )),(io_port + (0x40)))); |
| 2016 | } |
| 2017 | |
| 2018 | /************************************************************************** |
| 2019 | * Function : AM53C974_dma_blast(struct Scsi_Host *instance, unsigned char dmastatus, |
| 2020 | * unsigned char statreg) |
| 2021 | * |
| 2022 | * Purpose : cleanup DMA transfer |
| 2023 | * |
| 2024 | * Inputs : instance -- which AM53C974 |
| 2025 | * dmastatus -- dma status register |
| 2026 | * statreg -- status register |
| 2027 | * |
| 2028 | * Returns : nothing |
| 2029 | **************************************************************************/ |
| 2030 | static void AM53C974_dma_blast(struct Scsi_Host *instance, unsigned char dmastatus, |
| 2031 | unsigned char statreg) |
| 2032 | { |
| 2033 | AM53C974_local_declare()unsigned long io_port; |
| 2034 | struct AM53C974_hostdata *hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 2035 | unsigned long ctcreg; |
| 2036 | int dir = statreg & STATREG_IO0x01; |
| 2037 | int cfifo, pio, i = 0; |
| 2038 | AM53C974_setio(instance)io_port = instance->io_port; |
| 2039 | |
| 2040 | do { |
| 2041 | cfifo = AM53C974_cfifo()(((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __inbc(io_port + (0x1C)) : __inb(io_port + (0x1C))) & 0x1F); |
| 2042 | i++; |
| 2043 | } while (cfifo && (i < 50000)); |
| 2044 | pio = (i == 50000) ? 1: 0; |
| 2045 | |
| 2046 | if (statreg & STATREG_CTZ0x10) { AM53C974_write_8(DMACMD, DMACMD_IDLE)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __outbc(((0x00)),(io_port + (0x40))) : __outb(((0x00)),(io_port + (0x40)))); return; } |
| 2047 | |
| 2048 | if (dmastatus & DMASTATUS_DONE0x08) { AM53C974_write_8(DMACMD, DMACMD_IDLE)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __outbc(((0x00)),(io_port + (0x40))) : __outb(((0x00)),(io_port + (0x40)))); return; } |
| 2049 | |
| 2050 | AM53C974_write_8(DMACMD, ((dir << 7) & DMACMD_DIR) | DMACMD_BLAST)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __outbc(((((dir << 7) & 0x80 ) | 0x01)),(io_port + (0x40))) : __outb(((((dir << 7) & 0x80) | 0x01)),(io_port + (0x40)))); |
| 2051 | while(!(AM53C974_read_8(DMASTATUS)((__builtin_constant_p((io_port + (0x54))) && (io_port + (0x54)) < 256) ? __inbc(io_port + (0x54)) : __inb(io_port + (0x54))) & DMASTATUS_BCMPLT0x20)) ; |
| 2052 | AM53C974_write_8(DMACMD, DMACMD_IDLE)((__builtin_constant_p((io_port + (0x40))) && (io_port + (0x40)) < 256) ? __outbc(((0x00)),(io_port + (0x40))) : __outb(((0x00)),(io_port + (0x40)))); |
| 2053 | |
| 2054 | if (pio) { |
| 2055 | /* transfer residual bytes via PIO */ |
| 2056 | unsigned char *wac = (unsigned char *)AM53C974_read_32(DMAWAC)((__builtin_constant_p((io_port + (0x50))) && (io_port + (0x50)) < 256) ? __inlc(io_port + (0x50)) : __inl(io_port + (0x50))); |
| 2057 | printk("pio mode, residual=%d\n", AM53C974_read_8(CFIREG)((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __inbc(io_port + (0x1C)) : __inb(io_port + (0x1C))) & CFIREG_CF0x1F); |
| 2058 | while (AM53C974_read_8(CFIREG)((__builtin_constant_p((io_port + (0x1C))) && (io_port + (0x1C)) < 256) ? __inbc(io_port + (0x1C)) : __inb(io_port + (0x1C))) & CFIREG_CF0x1F) *(wac++) = AM53C974_read_8(FFREG)((__builtin_constant_p((io_port + (0x08))) && (io_port + (0x08)) < 256) ? __inbc(io_port + (0x08)) : __inb(io_port + (0x08))); |
| 2059 | } |
| 2060 | |
| 2061 | ctcreg = AM53C974_read_8(CTCLREG)((__builtin_constant_p((io_port + (0x00))) && (io_port + (0x00)) < 256) ? __inbc(io_port + (0x00)) : __inb(io_port + (0x00))) | (AM53C974_read_8(CTCMREG)((__builtin_constant_p((io_port + (0x04))) && (io_port + (0x04)) < 256) ? __inbc(io_port + (0x04)) : __inb(io_port + (0x04))) << 8) | |
| 2062 | (AM53C974_read_8(CTCHREG)((__builtin_constant_p((io_port + (0x38))) && (io_port + (0x38)) < 256) ? __inbc(io_port + (0x38)) : __inb(io_port + (0x38))) << 16); |
| 2063 | |
| 2064 | hostdata->connected->SCp.ptr += hostdata->connected->SCp.this_residual - ctcreg; |
| 2065 | hostdata->connected->SCp.this_residual = ctcreg; |
| 2066 | } |
| 2067 | |
| 2068 | /************************************************************************** |
| 2069 | * Function : AM53C974_intr_bus_reset(struct Scsi_Host *instance) |
| 2070 | * |
| 2071 | * Purpose : handle bus reset interrupt |
| 2072 | * |
| 2073 | * Inputs : instance -- which AM53C974 |
| 2074 | * |
| 2075 | * Returns : nothing |
| 2076 | **************************************************************************/ |
| 2077 | static void AM53C974_intr_bus_reset(struct Scsi_Host *instance) |
| 2078 | { |
| 2079 | AM53C974_local_declare()unsigned long io_port; |
| 2080 | unsigned char cntlreg1; |
| 2081 | AM53C974_setio(instance)io_port = instance->io_port; |
| 2082 | |
| 2083 | AM53C974_write_8(CMDREG, CMDREG_CFIFO)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x01)),(io_port + (0x0C))) : __outb(((0x01)),(io_port + (0x0C)))); |
| 2084 | AM53C974_write_8(CMDREG, CMDREG_NOP)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x00)),(io_port + (0x0C))) : __outb(((0x00)),(io_port + (0x0C)))); |
| 2085 | |
| 2086 | cntlreg1 = AM53C974_read_8(CNTLREG1)((__builtin_constant_p((io_port + (0x20))) && (io_port + (0x20)) < 256) ? __inbc(io_port + (0x20)) : __inb(io_port + (0x20))); |
| 2087 | AM53C974_write_8(CNTLREG1, cntlreg1 | CNTLREG1_DISR)((__builtin_constant_p((io_port + (0x20))) && (io_port + (0x20)) < 256) ? __outbc(((cntlreg1 | 0x40)),(io_port + (0x20))) : __outb(((cntlreg1 | 0x40)),(io_port + (0x20)))); |
| 2088 | } |
| 2089 | |
| 2090 | /************************************************************************** |
| 2091 | * Function : int AM53C974_abort(Scsi_Cmnd *cmd) |
| 2092 | * |
| 2093 | * Purpose : abort a command |
| 2094 | * |
| 2095 | * Inputs : cmd - the Scsi_Cmnd to abort, code - code to set the |
| 2096 | * host byte of the result field to, if zero DID_ABORTED is |
| 2097 | * used. |
| 2098 | * |
| 2099 | * Returns : 0 - success, -1 on failure. |
| 2100 | **************************************************************************/ |
| 2101 | int AM53C974_abort(Scsi_Cmnd *cmd) |
| 2102 | { |
| 2103 | AM53C974_local_declare()unsigned long io_port; |
| 2104 | struct Scsi_Host *instance = cmd->host; |
| 2105 | struct AM53C974_hostdata *hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 2106 | Scsi_Cmnd *tmp, **prev; |
| 2107 | |
| 2108 | #ifdef AM53C974_DEBUG |
| 2109 | deb_stop = 1; |
| 2110 | #endif |
| 2111 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 2112 | AM53C974_setio(instance)io_port = instance->io_port; |
| 2113 | |
| 2114 | DEB_ABORT(printk(SEPARATOR_LINE))printk("--------------------------------------------------------------------------\n" ); |
| 2115 | DEB_ABORT(printk("scsi%d : AM53C974_abort called -- trouble starts!!\n", instance->host_no))printk("scsi%d : AM53C974_abort called -- trouble starts!!\n" , instance->host_no); |
| 2116 | DEB_ABORT(AM53C974_print(instance))AM53C974_print(instance); |
| 2117 | DEB_ABORT(AM53C974_keywait())AM53C974_keywait(); |
| 2118 | |
| 2119 | /* Case 1 : If the command is the currently executing command, |
| 2120 | we'll set the aborted flag and return control so that the |
| 2121 | information transfer routine can exit cleanly. */ |
| 2122 | if ((hostdata->connected == cmd) || (hostdata->sel_cmd == cmd)) { |
| 2123 | DEB_ABORT(printk("scsi%d: aborting connected command\n", instance->host_no))printk("scsi%d: aborting connected command\n", instance->host_no ); |
| 2124 | hostdata->aborted = 1; |
| 2125 | hostdata->msgout[0] = ABORT0x06; |
| 2126 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 2127 | return(SCSI_ABORT_PENDING2); } |
| 2128 | |
| 2129 | /* Case 2 : If the command hasn't been issued yet, |
| 2130 | we simply remove it from the issue queue. */ |
| 2131 | for (prev = (Scsi_Cmnd **)&(hostdata->issue_queue), |
| 2132 | tmp = (Scsi_Cmnd *)hostdata->issue_queue; tmp; |
| 2133 | prev = (Scsi_Cmnd **)&(tmp->host_scribble), |
| 2134 | tmp = (Scsi_Cmnd *)tmp->host_scribble) { |
| 2135 | if (cmd == tmp) { |
| 2136 | DEB_ABORT(printk("scsi%d : abort removed command from issue queue.\n", instance->host_no))printk("scsi%d : abort removed command from issue queue.\n", instance ->host_no); |
| 2137 | REMOVE(5, *prev, tmp, tmp->host_scribble); |
| 2138 | (*prev) = (Scsi_Cmnd *)tmp->host_scribble; |
| 2139 | tmp->host_scribble = NULL((void *) 0); |
| 2140 | tmp->result = DID_ABORT0x05 << 16; |
| 2141 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 2142 | tmp->done(tmp); |
| 2143 | return(SCSI_ABORT_SUCCESS1); } |
| 2144 | #ifdef AM53C974_DEBUG_ABORT |
| 2145 | else { |
| 2146 | if (prev == (Scsi_Cmnd **)tmp) |
| 2147 | printk("scsi%d : LOOP\n", instance->host_no); |
| 2148 | } |
| 2149 | #endif |
| 2150 | } |
| 2151 | |
| 2152 | /* Case 3 : If any commands are connected, we're going to fail the abort |
| 2153 | * and let the high level SCSI driver retry at a later time or |
| 2154 | * issue a reset. |
| 2155 | * |
| 2156 | * Timeouts, and therefore aborted commands, will be highly unlikely |
| 2157 | * and handling them cleanly in this situation would make the common |
| 2158 | * case of noresets less efficient, and would pollute our code. So, |
| 2159 | * we fail. */ |
| 2160 | if (hostdata->connected || hostdata->sel_cmd) { |
| 2161 | DEB_ABORT(printk("scsi%d : abort failed, other command connected.\n", instance->host_no))printk("scsi%d : abort failed, other command connected.\n", instance ->host_no); |
| 2162 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 2163 | return(SCSI_ABORT_NOT_RUNNING4); } |
| 2164 | |
| 2165 | /* Case 4: If the command is currently disconnected from the bus, and |
| 2166 | * there are no connected commands, we reconnect the I_T_L or |
| 2167 | * I_T_L_Q nexus associated with it, go into message out, and send |
| 2168 | * an abort message. */ |
| 2169 | for (tmp = (Scsi_Cmnd *)hostdata->disconnected_queue; tmp; |
| 2170 | tmp = (Scsi_Cmnd *)tmp->host_scribble) { |
| 2171 | if (cmd == tmp) { |
| 2172 | DEB_ABORT(printk("scsi%d: aborting disconnected command\n", instance->host_no))printk("scsi%d: aborting disconnected command\n", instance-> host_no); |
| 2173 | hostdata->aborted = 1; |
| 2174 | hostdata->msgout[0] = ABORT0x06; |
| 2175 | hostdata->selecting = 1; |
| 2176 | hostdata->sel_cmd = tmp; |
| 2177 | AM53C974_write_8(CMDREG, CMDREG_DSR)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x45)),(io_port + (0x0C))) : __outb(((0x45)),(io_port + (0x0C)))); |
| 2178 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 2179 | return(SCSI_ABORT_PENDING2); } |
| 2180 | } |
| 2181 | |
| 2182 | /* Case 5 : If we reached this point, the command was not found in any of |
| 2183 | * the queues. |
| 2184 | * |
| 2185 | * We probably reached this point because of an unlikely race condition |
| 2186 | * between the command completing successfully and the abortion code, |
| 2187 | * so we won't panic, but we will notify the user in case something really |
| 2188 | * broke. */ |
| 2189 | DEB_ABORT(printk("scsi%d : abort failed, command not found.\n", instance->host_no))printk("scsi%d : abort failed, command not found.\n", instance ->host_no); |
| 2190 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 2191 | return(SCSI_ABORT_NOT_RUNNING4); |
| 2192 | } |
| 2193 | |
| 2194 | /************************************************************************** |
| 2195 | * Function : int AM53C974_reset(Scsi_Cmnd *cmd) |
| 2196 | * |
| 2197 | * Purpose : reset the SCSI controller and bus |
| 2198 | * |
| 2199 | * Inputs : cmd -- which command within the command block was responsible for the reset |
| 2200 | * |
| 2201 | * Returns : status (SCSI_ABORT_SUCCESS) |
| 2202 | **************************************************************************/ |
| 2203 | int AM53C974_reset(Scsi_Cmnd *cmd, unsigned int flags) |
| 2204 | { |
| 2205 | AM53C974_local_declare()unsigned long io_port; |
| 2206 | int i; |
| 2207 | struct Scsi_Host *instance = cmd->host; |
| 2208 | struct AM53C974_hostdata *hostdata = (struct AM53C974_hostdata *)instance->hostdata; |
| 2209 | AM53C974_setio(instance)io_port = instance->io_port; |
| 2210 | |
| 2211 | cli()__asm__ __volatile__ ("cli": : :"memory"); |
| 2212 | DEB(printk("AM53C974_reset called; ")); |
| 2213 | |
| 2214 | printk("AM53C974_reset called\n"); |
| 2215 | AM53C974_print(instance); |
| 2216 | AM53C974_keywait(); |
| 2217 | |
| 2218 | /* do hard reset */ |
| 2219 | AM53C974_write_8(CMDREG, CMDREG_RDEV)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x02)),(io_port + (0x0C))) : __outb(((0x02)),(io_port + (0x0C)))); |
| 2220 | AM53C974_write_8(CMDREG, CMDREG_NOP)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x00)),(io_port + (0x0C))) : __outb(((0x00)),(io_port + (0x0C)))); |
| 2221 | hostdata->msgout[0] = NOP0x08; |
| 2222 | for (i = 0; i < 8; i++) { |
| 2223 | hostdata->busy[i] = 0; |
| 2224 | hostdata->sync_per[i] = DEF_STP8; |
| 2225 | hostdata->sync_off[i] = 0; |
| 2226 | hostdata->sync_neg[i] = 0; } |
| 2227 | hostdata->last_message[0] = NOP0x08; |
| 2228 | hostdata->sel_cmd = NULL((void *) 0); |
| 2229 | hostdata->connected = NULL((void *) 0); |
| 2230 | hostdata->issue_queue = NULL((void *) 0); |
| 2231 | hostdata->disconnected_queue = NULL((void *) 0); |
| 2232 | hostdata->in_reset = 0; |
| 2233 | hostdata->aborted = 0; |
| 2234 | hostdata->selecting = 0; |
| 2235 | hostdata->disconnecting = 0; |
| 2236 | hostdata->dma_busy = 0; |
| 2237 | |
| 2238 | /* reset bus */ |
| 2239 | AM53C974_write_8(CNTLREG1, CNTLREG1_DISR | instance->this_id)((__builtin_constant_p((io_port + (0x20))) && (io_port + (0x20)) < 256) ? __outbc(((0x40 | instance->this_id) ),(io_port + (0x20))) : __outb(((0x40 | instance->this_id) ),(io_port + (0x20)))); /* disable interrupt upon SCSI RESET */ |
| 2240 | AM53C974_write_8(CMDREG, CMDREG_RBUS)((__builtin_constant_p((io_port + (0x0C))) && (io_port + (0x0C)) < 256) ? __outbc(((0x03)),(io_port + (0x0C))) : __outb(((0x03)),(io_port + (0x0C)))); /* reset SCSI bus */ |
| 2241 | udelay(40)(__builtin_constant_p(40) ? __const_udelay((40) * 0x10c6ul) : __udelay(40)); |
| 2242 | AM53C974_config_after_reset(instance); |
| 2243 | |
| 2244 | sti()__asm__ __volatile__ ("sti": : :"memory"); |
| 2245 | cmd->result = DID_RESET0x08 << 16; |
| 2246 | cmd->scsi_done(cmd); |
| 2247 | return SCSI_ABORT_SUCCESS1; |
| 2248 | } |
| 2249 | |
| 2250 | |
| 2251 | /* |
| 2252 | * AM53C974_release() |
| 2253 | * |
| 2254 | * Release resources allocated for a single AM53C974 adapter. |
| 2255 | */ |
| 2256 | int |
| 2257 | AM53C974_release(struct Scsi_Host *shp) |
| 2258 | { |
| 2259 | free_irq(shp->irq, NULL((void *) 0)); |
| 2260 | scsi_unregister(shp); |
| 2261 | return 0; |
| 2262 | } |
| 2263 | |
| 2264 | |
| 2265 | #ifdef MODULE |
| 2266 | /* Eventually this will go into an include file, but this will be later */ |
| 2267 | Scsi_Host_Template driver_template = AM53C974{ ((void *) 0), ((void *) 0), ((void *) 0), ((void *) 0), "AM53C974" , AM53C974_detect, ((void *) 0), AM53C974_info, AM53C974_command , AM53C974_queue_command, AM53C974_abort, AM53C974_reset, ((void *) 0), scsicam_bios_param, 12, -1, 0xff, 1, 0, 0, 0 }; |
| 2268 | |
| 2269 | #include "scsi_module.c" |
| 2270 | #endif |