开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
nsp_cs.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：45k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

nsp_cs.c：源码内容
  1. /*======================================================================
  3.     NinjaSCSI-3 / NinjaSCSI-32Bi PCMCIA SCSI hostadapter card driver
  4.       By: YOKOTA Hiroshi <yokota@netlab.is.tsukuba.ac.jp>
  6.     Ver.2.0   Support 32bit PIO mode
  7.     Ver.1.1.2 Fix for scatter list buffer exceeds
  8.     Ver.1.1   Support scatter list
  9.     Ver.0.1   Initial version
  11.     This software may be used and distributed according to the terms of
  12.     the GNU General Public License.
  14. ======================================================================*/
  16. /***********************************************************************
  17.     This driver is for these PCcards.
  19. I-O DATA PCSC-F  (Workbit NinjaSCSI-3)
  20. "WBT", "NinjaSCSI-3", "R1.0"
  21. I-O DATA CBSC-II (Workbit NinjaSCSI-32Bi in 16bit mode)
  22. "IO DATA", "CBSC16  ", "1"
  24. ***********************************************************************/
  26. /* $Id: nsp_cs.c,v 1.42 2001/09/10 10:30:58 elca Exp $ */
  28. #ifdef NSP_KERNEL_2_2
  29. #include <pcmcia/config.h>
  30. #include <pcmcia/k_compat.h>
  31. #endif
  33. #include <linux/module.h>
  34. #include <linux/kernel.h>
  35. #include <linux/init.h>
  36. #include <linux/sched.h>
  37. #include <linux/slab.h>
  38. #include <linux/string.h>
  39. #include <linux/timer.h>
  40. #include <linux/ioport.h>
  41. #include <linux/delay.h>
  42. #include <linux/tqueue.h>
  43. #include <linux/interrupt.h>
  44. #include <linux/module.h>
  45. #include <linux/major.h>
  46. #include <linux/blk.h>
  47. #include <linux/stat.h>
  49. #include <asm/io.h>
  50. #include <asm/irq.h>
  52. #include <../drivers/scsi/scsi.h>
  53. #include <../drivers/scsi/hosts.h>
  54. #include <../drivers/scsi/sd.h>
  56. #include <scsi/scsi.h>
  57. #include <scsi/scsi_ioctl.h>
  59. #include <pcmcia/version.h>
  60. #include <pcmcia/cs_types.h>
  61. #include <pcmcia/cs.h>
  62. #include <pcmcia/cistpl.h>
  63. #include <pcmcia/ds.h>
  65. #include "nsp_cs.h"
  67. MODULE_AUTHOR("YOKOTA Hiroshi <yokota@netlab.is.tsukuba.ac.jp>");
  68. MODULE_DESCRIPTION("WorkBit NinjaSCSI-3 / NinjaSCSI-32Bi(16bit) PCMCIA SCSI host adapter module");
  69. MODULE_SUPPORTED_DEVICE("sd,sr,sg,st");
  70. MODULE_LICENSE("GPL");
  72. #ifdef PCMCIA_DEBUG
  73. static int pc_debug = PCMCIA_DEBUG;
  74. MODULE_PARM(pc_debug, "i");
  75. MODULE_PARM_DESC(pc_debug, "set debug level");
  76. static char *version = "$Id: nsp_cs.c,v 1.42 2001/09/10 10:30:58 elca Exp $";
  77. #define DEBUG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG args)
  78. #else
  79. #define DEBUG(n, args...) /* */
  80. #endif
  82. #include "nsp_io.h"
  84. /*====================================================================*/
  86. typedef struct scsi_info_t {
  87. dev_link_t             link;
  88. struct Scsi_Host      *host;
  89. int                ndev;
  90. dev_node_t             node[8];
  91. int                    stop;
  92. struct bus_operations *bus;
  93. } scsi_info_t;
  96. /*----------------------------------------------------------------*/
  98. #if (KERNEL_VERSION(2,4,0) > LINUX_VERSION_CODE)
  99. #define PROC_SCSI_NSP PROC_SCSI_IBMMCA /* bad hack... */
  100. static struct proc_dir_entry proc_scsi_nsp = {
  101. PROC_SCSI_NSP, 6, "nsp_cs",
  102. S_IFDIR | S_IRUGO | S_IXUGO, 2
  103. };
  104. #endif
  106. /*====================================================================*/
  107. /* Parameters that can be set with 'insmod' */
  109. static unsigned int irq_mask = 0xffff;
  110. MODULE_PARM(irq_mask, "i");
  111. MODULE_PARM_DESC(irq_mask, "IRQ mask bits");
  113. static int irq_list[4] = { -1 };
  114. MODULE_PARM(irq_list, "1-4i");
  115. MODULE_PARM_DESC(irq_list, "IRQ number list");
  117. /*----------------------------------------------------------------*/
  118. /* driver state info, local to driver */
  119. static char nspinfo[100];     /* description */
  121. /* /usr/src/linux/drivers/scsi/hosts.h */
  122. static Scsi_Host_Template driver_template = {
  123. /* next: NULL,*/
  124. #if (KERNEL_VERSION(2,3,99) > LINUX_VERSION_CODE)
  125. proc_dir:        &proc_scsi_nsp, /* kernel 2.2 */
  126. #else
  127. proc_name:        "nsp_cs",       /* kernel 2.4 */
  128. #endif
  129. /* proc_info: NULL,*/
  130. name: "WorkBit NinjaSCSI-3/32Bi",
  131. detect: nsp_detect,
  132. release: nsp_release,
  133. info: nsp_info,
  134. /* command: NULL,*/
  135. queuecommand: nsp_queuecommand,
  136. /* eh_strategy_handler: nsp_eh_strategy,*/
  137. eh_abort_handler: nsp_eh_abort,
  138. eh_device_reset_handler: nsp_eh_device_reset,
  139. eh_bus_reset_handler: nsp_eh_bus_reset,
  140. eh_host_reset_handler: nsp_eh_host_reset,
  141. abort: nsp_abort,
  142. reset: nsp_reset,
  143. /* slave_attach: NULL,*/
  144. /* bios_param: NULL,*/
  145. can_queue: 1,
  146. this_id: SCSI_INITIATOR_ID,
  147. sg_tablesize: SG_ALL,
  148. cmd_per_lun: 1,
  149. /* present: 0,*/
  150. /* unchecked_isa_dma: 0,*/
  151. use_clustering: DISABLE_CLUSTERING,
  152. use_new_eh_code: 0,
  153. /* emulated: 0,*/
  154. };
  156. static dev_link_t *dev_list = NULL;
  157. static dev_info_t dev_info  = {"nsp_cs"};
  159. static nsp_hw_data nsp_data;
  161. /***********************************************************/
  163. static int nsp_queuecommand(Scsi_Cmnd *SCpnt, void (*done)(Scsi_Cmnd *))
  164. {
  165. #ifdef PCMCIA_DEBUG
  166. //unsigned int host_id = SCpnt->host->this_id;
  167. //unsigned int base    = SCpnt->host->io_port;
  168. unsigned char target = SCpnt->target;
  169. #endif
  170. nsp_hw_data *data = &nsp_data;
  172. DEBUG(0, __FUNCTION__ "() SCpnt=0x%p target=%d lun=%d buff=0x%p bufflen=%d use_sg=%dn",
  173.       SCpnt, target, SCpnt->lun, SCpnt->request_buffer, SCpnt->request_bufflen, SCpnt->use_sg);
  174. //DEBUG(0, " before CurrentSC=0x%pn", data->CurrentSC);
  176. if(data->CurrentSC != NULL) {
  177. printk(KERN_DEBUG " " __FUNCTION__ "() CurrentSC!=NULL this can't be happenn");
  178. data->CurrentSC = NULL;
  179. SCpnt->result   = DID_BAD_TARGET << 16;
  180. done(SCpnt);
  181. return -1;
  182. }
  184. show_command(SCpnt);
  186. SCpnt->scsi_done = done;
  187. data->CurrentSC = SCpnt;
  188. RESID         = SCpnt->request_bufflen;
  190. SCpnt->SCp.Status = -1;
  191. SCpnt->SCp.Message = -1;
  192. SCpnt->SCp.have_data_in = IO_UNKNOWN;
  193. SCpnt->SCp.sent_command = 0;
  194. SCpnt->SCp.phase = PH_UNDETERMINED;
  196. /* setup scratch area
  197.    SCp.ptr : buffer pointer
  198.    SCp.this_residual : buffer length
  199.    SCp.buffer : next buffer
  200.    SCp.buffers_residual : left buffers in list
  201.    SCp.phase : current state of the command */
  202. if (SCpnt->use_sg) {
  203. SCpnt->SCp.buffer     = (struct scatterlist *) SCpnt->request_buffer;
  204. SCpnt->SCp.ptr     = SCpnt->SCp.buffer->address;
  205. SCpnt->SCp.this_residual    = SCpnt->SCp.buffer->length;
  206. SCpnt->SCp.buffers_residual = SCpnt->use_sg - 1;
  207. } else {
  208. SCpnt->SCp.ptr     = (char *) SCpnt->request_buffer;
  209. SCpnt->SCp.this_residual    = SCpnt->request_bufflen;
  210. SCpnt->SCp.buffer     = NULL;
  211. SCpnt->SCp.buffers_residual = 0;
  212. }
  214. if(nsphw_start_selection(SCpnt, data) == FALSE) {
  215. DEBUG(0, " selection failn");
  216. data->CurrentSC = NULL;
  217. SCpnt->result   = DID_NO_CONNECT << 16;
  218. done(SCpnt);
  219. return -1;
  220. }
  223. //DEBUG(0, __FUNCTION__ "() outn");
  224. return 0;
  225. }
  227. /*
  228.  * setup PIO FIFO transfer mode and enable/disable to data out
  229.  */
  230. static void nsp_setup_fifo(nsp_hw_data *data, int enabled)
  231. {
  232. unsigned int  base = data->BaseAddress;
  233. unsigned char transfer_mode_reg;
  235. //DEBUG(0, __FUNCTION__ "() enabled=%dn", enabled);
  237. if (enabled != FALSE) {
  238. transfer_mode_reg = TRANSFER_GO | BRAIND;
  239. } else {
  240. transfer_mode_reg = 0;
  241. }
  243. transfer_mode_reg |= data->TransferMode;
  245. nsp_index_write(base, TRANSFERMODE, transfer_mode_reg);
  246. }
  248. /*
  249.  * Initialize Ninja hardware
  250.  */
  251. static int nsphw_init(nsp_hw_data *data)
  252. {
  253. unsigned int base     = data->BaseAddress;
  254. int      i, j;
  255. sync_data    tmp_sync = { SyncNegotiation: SYNC_NOT_YET,
  256.   SyncPeriod:    0,
  257.   SyncOffset:    0
  258. };
  260. DEBUG(0, __FUNCTION__ "() in base=0x%xn", base);
  262. data->ScsiClockDiv = CLOCK_40M;
  263. data->CurrentSC    = NULL;
  264. data->FifoCount    = 0;
  265. data->TransferMode = MODE_IO8;
  267. /* setup sync data */
  268. for ( i = 0; i < N_TARGET; i++ ) {
  269. for ( j = 0; j < N_LUN; j++ ) {
  270. data->Sync[i][j] = tmp_sync;
  271. }
  272. }
  274. /* block all interrupts */
  275. nsp_write(base,       IRQCONTROL,   IRQCONTROL_ALLMASK);
  277. /* setup SCSI interface */
  278. nsp_write(base,       IFSELECT,     IF_IFSEL);
  280. nsp_index_write(base, SCSIIRQMODE,  0);
  282. nsp_index_write(base, TRANSFERMODE, MODE_IO8);
  283. nsp_index_write(base, CLOCKDIV,     data->ScsiClockDiv);
  285. nsp_index_write(base, PARITYCTRL,   0);
  286. nsp_index_write(base, POINTERCLR,   POINTER_CLEAR     |
  287.     ACK_COUNTER_CLEAR |
  288.     REQ_COUNTER_CLEAR |
  289.     HOST_COUNTER_CLEAR);
  291. /* setup fifo asic */
  292. nsp_write(base,       IFSELECT,     IF_REGSEL);
  293. nsp_index_write(base, TERMPWRCTRL,  0);
  294. if ((nsp_index_read(base, OTHERCONTROL) & TPWR_SENSE) == 0) {
  295. printk(KERN_INFO "nsp_cs: terminator power onn");
  296. nsp_index_write(base, TERMPWRCTRL, POWER_ON);
  297. }
  299. nsp_index_write(base, TIMERCOUNT,   0);
  300. nsp_index_write(base, TIMERCOUNT,   0); /* requires 2 times!! */
  302. nsp_index_write(base, SYNCREG,     0);
  303. nsp_index_write(base, ACKWIDTH,     0);
  305. /* enable interrupts and ack them */
  306. nsp_index_write(base, SCSIIRQMODE,  SCSI_PHASE_CHANGE_EI |
  307.     RESELECT_EI  |
  308.     SCSI_RESET_IRQ_EI  );
  309. nsp_write(base,       IRQCONTROL,   IRQCONTROL_ALLCLEAR);
  311. nsp_setup_fifo(data, FALSE);
  313. return TRUE;
  314. }
  316. /*
  317.  * Start selection phase
  318.  */
  319. static unsigned int nsphw_start_selection(Scsi_Cmnd   *SCpnt,
  320.   nsp_hw_data *data)
  321. {
  322. unsigned int  host_id  = SCpnt->host->this_id;
  323. unsigned int  base  = SCpnt->host->io_port;
  324. unsigned char target  = SCpnt->target;
  325. int       wait_count;
  326. unsigned char phase, arbit;
  328. //DEBUG(0, __FUNCTION__ "()inn");
  330. phase = nsp_index_read(base, SCSIBUSMON);
  331. if(phase != BUSMON_BUS_FREE) {
  332. //DEBUG(0, " bus busyn");
  333. return FALSE;
  334. }
  336. /* start arbitration */
  337. //DEBUG(0, " start arbitn");
  338. SCpnt->SCp.phase = PH_ARBSTART;
  339. nsp_index_write(base, SETARBIT, ARBIT_GO);
  341. wait_count = jiffies + 10 * HZ;
  342. do {
  343. /* XXX: what a stupid chip! */
  344. arbit = nsp_index_read(base, ARBITSTATUS);
  345. //DEBUG(0, " arbit=%d, wait_count=%dn", arbit, wait_count);
  346. udelay(1); /* hold 1.2us */
  347. } while((arbit & (ARBIT_WIN | ARBIT_FAIL)) == 0 &&
  348. time_before(jiffies, wait_count));
  350. if((arbit & ARBIT_WIN) == 0) {
  351. //DEBUG(0, " arbit failn");
  352. nsp_index_write(base, SETARBIT, ARBIT_FLAG_CLEAR);
  353. return FALSE;
  354. }
  356. /* assert select line */
  357. //DEBUG(0, " assert SEL linen");
  358. SCpnt->SCp.phase = PH_SELSTART;
  359. udelay(3);
  360. nsp_index_write(base, SCSIDATALATCH, (1 << host_id) | (1 << target));
  361. nsp_index_write(base, SCSIBUSCTRL,   SCSI_SEL | SCSI_BSY | SCSI_ATN);
  362. udelay(3);
  363. nsp_index_write(base, SCSIBUSCTRL,   SCSI_SEL | SCSI_BSY | SCSI_DATAOUT_ENB | SCSI_ATN);
  364. nsp_index_write(base, SETARBIT,      ARBIT_FLAG_CLEAR);
  365. udelay(3);
  366. nsp_index_write(base, SCSIBUSCTRL,   SCSI_SEL | SCSI_DATAOUT_ENB | SCSI_ATN);
  368. /* check selection timeout */
  369. nsp_start_timer(SCpnt, data, 1000/51);
  370. data->SelectionTimeOut = 1;
  372. return TRUE;
  373. }
  375. struct nsp_sync_table {
  376. unsigned int min_period;
  377. unsigned int max_period;
  378. unsigned int chip_period;
  379. unsigned int ack_width;
  380. };
  382. static struct nsp_sync_table nsp_sync_table_40M[] = {
  383. {0x0c,0x0c,0x1,0}, /* 20MB  50ns*/
  384. {0x19,0x19,0x3,1}, /* 10MB  100ns*/ 
  385. {0x1a,0x25,0x5,2}, /* 7.5MB 150ns*/ 
  386. {0x26,0x32,0x7,3}, /* 5MB  200ns*/
  387. {0x0, 0,   0,  0}
  388. };
  390. static struct nsp_sync_table nsp_sync_table_20M[] = {
  391. {0x19,0x19,0x1,0}, /* 10MB  100ns*/ 
  392. {0x1a,0x25,0x2,0}, /* 7.5MB 150ns*/ 
  393. {0x26,0x32,0x3,1}, /* 5MB  200ns*/
  394. {0x0, 0,   0,  0}
  395. };
  397. /*
  398.  * setup synchronous data transfer mode
  399.  */
  400. static int nsp_msg(Scsi_Cmnd *SCpnt, nsp_hw_data *data)
  401. {
  402. unsigned char        target = SCpnt->target;
  403. unsigned char        lun    = SCpnt->lun;
  404. sync_data       *sync   = &(data->Sync[target][lun]);
  405. struct nsp_sync_table *sync_table;
  406. unsigned int        period, offset;
  407. int        i;
  410. DEBUG(0, __FUNCTION__ "()n");
  412. /**!**/
  414. period = sync->SyncPeriod;
  415. offset = sync->SyncOffset;
  417. DEBUG(0, " period=0x%x, offset=0x%xn", period, offset);
  419. if (data->ScsiClockDiv == CLOCK_20M) {
  420. sync_table = &nsp_sync_table_20M[0];
  421. } else {
  422. sync_table = &nsp_sync_table_40M[0];
  423. }
  425. for ( i = 0; sync_table->max_period != 0; i++, sync_table++) {
  426. if ( period >= sync_table->min_period &&
  427.      period <= sync_table->max_period  ) {
  428. break;
  429. }
  430. }
  432. if (period != 0 && sync_table->max_period == 0) {
  433. /*
  434.  * No proper period/offset found
  435.  */
  436. DEBUG(0, " no proper period/offsetn");
  438. sync->SyncPeriod      = 0;
  439. sync->SyncOffset      = 0;
  440. sync->SyncRegister    = 0;
  441. sync->AckWidth       = 0;
  442. sync->SyncNegotiation = SYNC_OK;
  444. return FALSE;
  445. }
  447. sync->SyncRegister    = (sync_table->chip_period << SYNCREG_PERIOD_SHIFT) |
  448.                 (offset & SYNCREG_OFFSET_MASK);
  449. sync->AckWidth       = sync_table->ack_width;
  450. sync->SyncNegotiation = SYNC_OK;
  452. DEBUG(0, " sync_reg=0x%x, ack_width=0x%xn", sync->SyncRegister, sync->AckWidth);
  454. return TRUE;
  455. }
  458. /*
  459.  * start ninja hardware timer
  460.  */
  461. static void nsp_start_timer(Scsi_Cmnd *SCpnt, nsp_hw_data *data, int time)
  462. {
  463. unsigned int base = SCpnt->host->io_port;
  465. //DEBUG(0, __FUNCTION__ "() in SCpnt=0x%p, time=%dn", SCpnt, time);
  466. data->TimerCount = time;
  467. nsp_index_write(base, TIMERCOUNT, time);
  468. }
  470. /*
  471.  * wait for bus phase change
  472.  */
  473. static int nsp_negate_signal(Scsi_Cmnd *SCpnt, unsigned char mask, char *str)
  474. {
  475. unsigned int  base = SCpnt->host->io_port;
  476. unsigned char reg;
  477. int       count, i = TRUE;
  479. //DEBUG(0, __FUNCTION__ "()n");
  481. count = jiffies + HZ;
  483. do {
  484. reg = nsp_index_read(base, SCSIBUSMON);
  485. if (reg == 0xff) {
  486. break;
  487. }
  488. } while ((i = time_before(jiffies, count)) && (reg & mask) != 0);
  490. if (!i) {
  491. printk(KERN_DEBUG __FUNCTION__ " %s signal off timeutn", str);
  492. }
  494. return 0;
  495. }
  497. /*
  498.  * expect Ninja Irq
  499.  */
  500. static int nsp_expect_signal(Scsi_Cmnd    *SCpnt,
  501.      unsigned char  current_phase,
  502.      unsigned char  mask)
  503. {
  504. unsigned int  base  = SCpnt->host->io_port;
  505. int       wait_count;
  506. unsigned char phase, i_src;
  508. //DEBUG(0, __FUNCTION__ "() current_phase=0x%x, mask=0x%xn", current_phase, mask);
  510. wait_count = jiffies + HZ;
  511. do {
  512. phase = nsp_index_read(base, SCSIBUSMON);
  513. if (phase == 0xff) {
  514. //DEBUG(0, " ret -1n");
  515. return -1;
  516. }
  517. i_src = nsp_read(base, IRQSTATUS);
  518. if (i_src & IRQSTATUS_SCSI) {
  519. //DEBUG(0, " ret 0 found scsi signaln");
  520. return 0;
  521. }
  522. if ((phase & mask) != 0 && (phase & BUSMON_PHASE_MASK) == current_phase) {
  523. //DEBUG(0, " ret 1 phase=0x%xn", phase);
  524. return 1;
  525. }
  526. } while(time_before(jiffies, wait_count));
  528. //DEBUG(0, __FUNCTION__ " : " __FUNCTION__ " timeoutn");
  529. return -1;
  530. }
  532. /*
  533.  * transfer SCSI message
  534.  */
  535. static int nsp_xfer(Scsi_Cmnd *SCpnt, nsp_hw_data *data, int phase)
  536. {
  537. unsigned int  base = SCpnt->host->io_port;
  538. char      *buf  = data->MsgBuffer;
  539. int       len  = MIN(MSGBUF_SIZE, data->MsgLen);
  540. int       ptr;
  541. int       ret;
  543. //DEBUG(0, __FUNCTION__ "()n");
  544. for (ptr = 0; len > 0; len --, ptr ++) {
  546. ret = nsp_expect_signal(SCpnt, phase, BUSMON_REQ);
  547. if (ret <= 0) {
  548. DEBUG(0, " xfer quitn");
  549. return 0;
  550. }
  552. /* if last byte, negate ATN */
  553. if (len == 1 && SCpnt->SCp.phase == PH_MSG_OUT) {
  554. nsp_index_write(base, SCSIBUSCTRL, AUTODIRECTION | ACKENB);
  555. }
  557. /* read & write message */
  558. if (phase & BUSMON_IO) {
  559. DEBUG(0, " read msgn");
  560. buf[ptr] = nsp_index_read(base, SCSIDATAWITHACK);
  561. } else {
  562. DEBUG(0, " write msgn");
  563. nsp_index_write(base, SCSIDATAWITHACK, buf[ptr]);
  564. }
  565. nsp_negate_signal(SCpnt, BUSMON_ACK, "xfer<ack>");
  567. }
  568. return len;
  569. }
  571. /*
  572.  * get extra SCSI data from fifo
  573.  */
  574. static int nsp_dataphase_bypass(Scsi_Cmnd *SCpnt, nsp_hw_data *data)
  575. {
  576. unsigned int count;
  578. //DEBUG(0, __FUNCTION__ "()n");
  580. if (SCpnt->SCp.have_data_in != IO_IN) {
  581. return 0;
  582. }
  584. count = nsp_fifo_count(SCpnt);
  585. if (data->FifoCount == count) {
  586. //DEBUG(0, " not use bypass quirkn");
  587. return 0;
  588. }
  590. /*
  591.  * XXX: NSP_QUIRK
  592.  * data phase skip only occures in case of SCSI_LOW_READ
  593.  */
  594. SCpnt->SCp.phase = PH_DATA;
  595. nsp_pio_read(SCpnt, data);
  596. nsp_setup_fifo(data, FALSE);
  598. DEBUG(0, " use bypass quirkn");
  599. return 0;
  600. }
  602. /*
  603.  * accept reselection
  604.  */
  605. static int nsp_reselected(Scsi_Cmnd *SCpnt, nsp_hw_data *data)
  606. {
  607. unsigned int  base = SCpnt->host->io_port;
  608. unsigned char reg;
  610. //DEBUG(0, __FUNCTION__ "()n");
  612. nsp_negate_signal(SCpnt, BUSMON_SEL, "reselect<SEL>");
  614. nsp_nexus(SCpnt, data);
  615. reg = nsp_index_read(base, SCSIBUSCTRL) & ~(SCSI_BSY | SCSI_ATN);
  616. nsp_index_write(base, SCSIBUSCTRL, reg);
  617. nsp_index_write(base, SCSIBUSCTRL, reg | AUTODIRECTION | ACKENB);
  619. return TRUE;
  620. }
  622. /*
  623.  * count how many data transferd
  624.  */
  625. static int nsp_fifo_count(Scsi_Cmnd *SCpnt)
  626. {
  627. unsigned int base = SCpnt->host->io_port;
  628. unsigned int count;
  629. unsigned int l, m, h;
  631. nsp_index_write(base, POINTERCLR, POINTER_CLEAR);
  633.         l = (unsigned int)nsp_read(base, DATAREG);
  634.         m = (unsigned int)nsp_read(base, DATAREG);
  635.         h = (unsigned int)nsp_read(base, DATAREG);
  637. count = (h << 16) | (m << 8) | (l << 0);
  639. //DEBUG(0, __FUNCTION__ "() =0x%xn", count);
  641. return count;
  642. }
  644. /* fifo size */
  645. #define RFIFO_CRIT 64
  646. #define WFIFO_CRIT 64
  648. /*
  649.  * read data in DATA IN phase
  650.  */
  651. static void nsp_pio_read(Scsi_Cmnd *SCpnt, nsp_hw_data *data)
  652. {
  653. unsigned int  base     = SCpnt->host->io_port;
  654. int       time_out, i;
  655. int       ocount, res;
  656. unsigned char stat, fifo_stat;
  658. ocount = data->FifoCount;
  660. DEBUG(0, __FUNCTION__ "() in SCpnt=0x%p resid=%d ocount=%d ptr=0x%p this_residual=%d buffers=0x%p nbuf=%dn", SCpnt, RESID, ocount, SCpnt->SCp.ptr, SCpnt->SCp.this_residual, SCpnt->SCp.buffer, SCpnt->SCp.buffers_residual);
  662. time_out = jiffies + 10 * HZ;
  664. while ((i = time_before(jiffies,time_out)) &&
  665.        (SCpnt->SCp.this_residual > 0 || SCpnt->SCp.buffers_residual > 0 ) ) {
  667. stat = nsp_index_read(base, SCSIBUSMON);
  668. stat &= BUSMON_PHASE_MASK;
  670. res = nsp_fifo_count(SCpnt) - ocount;
  672. //DEBUG(0, " ptr=0x%p this=0x%x ocount=0x%x res=0x%xn", SCpnt->SCp.ptr, SCpnt->SCp.this_residual, ocount, res);
  673. if (res == 0) { /* if some data avilable ? */
  674. if (stat == BUSPHASE_DATA_IN) { /* phase changed? */
  675. //DEBUG(0, " wait for data this=%dn", SCpnt->SCp.this_residual);
  676. continue;
  677. } else {
  678. DEBUG(0, " phase changed stat=0x%xn", stat);
  679. break;
  680. }
  681. }
  683. fifo_stat = nsp_read(base, FIFOSTATUS);
  684. if ((fifo_stat & FIFOSTATUS_FULL_EMPTY) == 0 &&
  685.     stat                                == BUSPHASE_DATA_IN) {
  686. continue;
  687. }
  689. res = MIN(res, SCpnt->SCp.this_residual);
  691. switch (data->TransferMode) {
  692. case MODE_IO32:
  693. res &= ~(BIT(1)|BIT(0)); /* align 4 */
  694. nsp_fifo32_read(base, SCpnt->SCp.ptr, res >> 2);
  695. break;
  696. case MODE_IO8:
  697. nsp_fifo8_read (base, SCpnt->SCp.ptr, res     );
  698. break;
  699. default:
  700. DEBUG(0, "unknown read moden");
  701. break;
  702. }
  704. RESID  -= res;
  705. SCpnt->SCp.ptr  += res;
  706. SCpnt->SCp.this_residual -= res;
  707. ocount  += res;
  708. //DEBUG(0, " ptr=0x%p this_residual=0x%x ocount=0x%xn", SCpnt->SCp.ptr, SCpnt->SCp.this_residual, ocount);
  710. /* go to next scatter list if availavle */
  711. if (SCpnt->SCp.this_residual == 0 &&
  712.     SCpnt->SCp.buffers_residual != 0 ) {
  713. //DEBUG(0, " scatterlist next timeout=%dn", time_out);
  714. SCpnt->SCp.buffers_residual--;
  715. SCpnt->SCp.buffer++;
  716. SCpnt->SCp.ptr  = SCpnt->SCp.buffer->address;
  717. SCpnt->SCp.this_residual = SCpnt->SCp.buffer->length;
  718. }
  720. time_out = jiffies + 10 * HZ;
  721. }
  723. data->FifoCount = ocount;
  725. if (!i) {
  726. printk(KERN_DEBUG __FUNCTION__ "() pio read timeout resid=%d this_residual=%d buffers_residual=%dn", RESID, SCpnt->SCp.this_residual, SCpnt->SCp.buffers_residual);
  727. }
  728. DEBUG(0, " read ocount=0x%xn", ocount);
  729. }
  731. /*
  732.  * write data in DATA OUT phase
  733.  */
  734. static void nsp_pio_write(Scsi_Cmnd *SCpnt, nsp_hw_data *data)
  735. {
  736. unsigned int  base     = SCpnt->host->io_port;
  737. int       time_out, i;
  738. unsigned int  ocount, res;
  739. unsigned char stat;
  741. ocount  = data->FifoCount;
  743. DEBUG(0, __FUNCTION__ "() in fifocount=%d ptr=0x%p this_residual=%d buffers=0x%p nbuf=%d resid=0x%xn", data->FifoCount, SCpnt->SCp.ptr, SCpnt->SCp.this_residual, SCpnt->SCp.buffer, SCpnt->SCp.buffers_residual, RESID);
  745. time_out = jiffies + 10 * HZ;
  747. while ((i = time_before(jiffies, time_out))                             &&
  748.        (SCpnt->SCp.this_residual > 0 || SCpnt->SCp.buffers_residual > 0)) {
  749. stat = nsp_index_read(base, SCSIBUSMON);
  750. stat &= BUSMON_PHASE_MASK;
  751. if (stat != BUSPHASE_DATA_OUT) {
  752. DEBUG(0, " phase changed stat=0x%xn", stat);
  753. break;
  754. }
  756. res = ocount - nsp_fifo_count(SCpnt);
  757. if (res > 0) { /* write all data? */
  758. DEBUG(0, " wait for all data out. ocount=0x%x res=%dn", ocount, res);
  759. continue;
  760. }
  762. res = MIN(SCpnt->SCp.this_residual, WFIFO_CRIT);
  764. //DEBUG(0, " ptr=0x%p this=0x%x res=0x%xn", SCpnt->SCp.ptr, SCpnt->SCp.this_residual, res);
  765. switch (data->TransferMode) {
  766. case MODE_IO32:
  767. res &= ~(BIT(1)|BIT(0)); /* align 4 */
  768. nsp_fifo32_write(base, SCpnt->SCp.ptr, res >> 2);
  769. break;
  770. case MODE_IO8:
  771. nsp_fifo8_write (base, SCpnt->SCp.ptr, res     );
  772. break;
  773. default:
  774. DEBUG(0, "unknown write moden");
  775. break;
  776. }
  778. RESID  -= res;
  779. SCpnt->SCp.ptr  += res;
  780. SCpnt->SCp.this_residual -= res;
  781. ocount  += res;
  783. /* go to next scatter list if availavle */
  784. if (SCpnt->SCp.this_residual == 0 &&
  785.     SCpnt->SCp.buffers_residual != 0 ) {
  786. //DEBUG(0, " scatterlist nextn");
  787. SCpnt->SCp.buffers_residual--;
  788. SCpnt->SCp.buffer++;
  789. SCpnt->SCp.ptr  = SCpnt->SCp.buffer->address;
  790. SCpnt->SCp.this_residual = SCpnt->SCp.buffer->length;
  791. }
  793. time_out = jiffies + 10 * HZ;
  794. }
  796. data->FifoCount = ocount;
  798. if (!i) {
  799. printk(KERN_DEBUG __FUNCTION__ "() pio write timeout resid=%dn", RESID);
  800. }
  801. //DEBUG(0, " write ocount=%dn", ocount);
  802. }
  804. #undef RFIFO_CRIT
  805. #undef WFIFO_CRIT
  807. /*
  808.  * setup synchronous/asynchronous data transfer mode
  809.  */
  810. static int nsp_nexus(Scsi_Cmnd *SCpnt, nsp_hw_data *data)
  811. {
  812. unsigned int   base   = SCpnt->host->io_port;
  813. unsigned char  target = SCpnt->target;
  814. unsigned char  lun    = SCpnt->lun;
  815. sync_data     *sync   = &(data->Sync[target][lun]);
  817. //DEBUG(0, __FUNCTION__ "() in SCpnt=0x%pn", SCpnt);
  819. /* setup synch transfer registers */
  820. nsp_index_write(base, SYNCREG, sync->SyncRegister);
  821. nsp_index_write(base, ACKWIDTH, sync->AckWidth);
  823. if (RESID % 4 != 0   ||
  824.     RESID     <= 256 ) {
  825. data->TransferMode = MODE_IO8;
  826. } else {
  827. data->TransferMode = MODE_IO32;
  828. }
  830. /* setup pdma fifo */
  831. nsp_setup_fifo(data, TRUE);
  833. /* clear ack counter */
  834. data->FifoCount = 0;
  835. nsp_index_write(base, POINTERCLR, POINTER_CLEAR     |
  836.   ACK_COUNTER_CLEAR |
  837.   REQ_COUNTER_CLEAR |
  838.   HOST_COUNTER_CLEAR);
  840. return 0;
  841. }
  843. #include "nsp_message.c"
  844. /*
  845.  * interrupt handler
  846.  */
  847. static void nspintr(int irq, void *dev_id, struct pt_regs *regs)
  848. {
  849. unsigned int   base;
  850. unsigned char  i_src, irq_phase, phase;
  851. Scsi_Cmnd     *tmpSC;
  852. int            len;
  853. unsigned char  target, lun;
  854. unsigned int  *sync_neg;
  855. int            i, tmp;
  856. nsp_hw_data   *data;
  858. //printk("&nsp_data=0x%p, dev_id=0x%pn", &nsp_data, dev_id);
  860. /* sanity check */
  861. if (&nsp_data != dev_id) {
  862. DEBUG(0, " irq conflict? this can't happenn");
  863. return;
  864. }
  865. data = dev_id;
  866. if (irq != data->IrqNumber) {
  867. return;
  868. }
  870. base = data->BaseAddress;
  871. //DEBUG(0, " base=0x%xn", base);
  873. /*
  874.  * interrupt check
  875.  */
  876. nsp_write(base, IRQCONTROL, IRQCONTROL_IRQDISABLE);
  877. i_src = nsp_read(base, IRQSTATUS);
  878. if (i_src == 0xff || (i_src & IRQSTATUS_MASK) == 0) {
  879. nsp_write(base, IRQCONTROL, 0);
  880. //DEBUG(0, " no irqn");
  881. return;
  882. }
  884. //DEBUG(0, " i_src=0x%xn", i_src);
  886. /* XXX: IMPORTANT
  887.  * Do not read an irq_phase register if no scsi phase interrupt.
  888.  * Unless, you should lose a scsi phase interrupt.
  889.  */
  890. phase = nsp_index_read(base, SCSIBUSMON);
  891. if((i_src & IRQSTATUS_SCSI) != 0) {
  892. irq_phase = nsp_index_read(base, IRQPHASESENCE);
  893. } else {
  894. irq_phase = 0;
  895. }
  897. //DEBUG(0, " irq_phase=0x%xn", irq_phase);
  899. /*
  900.  * timer interrupt handler (scsi vs timer interrupts)
  901.  */
  902. //DEBUG(0, " timercount=%dn", data->TimerCount);
  903. if (data->TimerCount != 0) {
  904. //DEBUG(0, " stop timern");
  905. nsp_index_write(base, TIMERCOUNT, 0);
  906. nsp_index_write(base, TIMERCOUNT, 0);
  907. data->TimerCount = 0;
  908. }
  910. if ((i_src & IRQSTATUS_MASK) == IRQSTATUS_TIMER &&
  911.     data->SelectionTimeOut == 0) {
  912. //DEBUG(0, " timer startn");
  913. nsp_write(base, IRQCONTROL, IRQCONTROL_TIMER_CLEAR);
  914. return;
  915. }
  917. nsp_write(base, IRQCONTROL, IRQCONTROL_TIMER_CLEAR | IRQCONTROL_FIFO_CLEAR);
  919. if (data->CurrentSC == NULL) {
  920. printk(KERN_DEBUG __FUNCTION__ " CurrentSC==NULL irq_status=0x%x phase=0x%x irq_phase=0x%x this can't be happenn", i_src, phase, irq_phase);
  921. return;
  922. } else {
  923. tmpSC    = data->CurrentSC;
  924. target   = tmpSC->target;
  925. lun      = tmpSC->lun;
  926. sync_neg = &(data->Sync[target][lun].SyncNegotiation);
  927. }
  929. /*
  930.  * parse hardware SCSI irq reasons register
  931.  */
  932. if ((i_src & IRQSTATUS_SCSI) != 0) {
  933. if ((irq_phase & SCSI_RESET_IRQ) != 0) {
  934. printk(KERN_DEBUG " " __FUNCTION__ "() bus reset (power off?)n");
  935. *sync_neg          = SYNC_NOT_YET;
  936. data->CurrentSC    = NULL;
  937. tmpSC->result    = DID_RESET << 16;
  938. tmpSC->scsi_done(tmpSC);
  939. return;
  940. }
  942. if ((irq_phase & RESELECT_IRQ) != 0) {
  943. DEBUG(0, " reselectn");
  944. nsp_write(base, IRQCONTROL, IRQCONTROL_RESELECT_CLEAR);
  945. if (nsp_reselected(tmpSC, data) != FALSE) {
  946. return;
  947. }
  948. }
  950. if ((irq_phase & (PHASE_CHANGE_IRQ | LATCHED_BUS_FREE)) == 0) {
  951. return; 
  952. }
  953. }
  955. //show_phase(tmpSC);
  957. switch(tmpSC->SCp.phase) {
  958. case PH_SELSTART:
  959. *sync_neg = SYNC_NOT_YET;
  960. if ((phase & BUSMON_BSY) == 0) {
  961. //DEBUG(0, " selection count=%dn", data->SelectionTimeOut);
  962. if (data->SelectionTimeOut >= NSP_SELTIMEOUT) {
  963. DEBUG(0, " selection time outn");
  964. data->SelectionTimeOut = 0;
  965. nsp_index_write(base, SCSIBUSCTRL, 0);
  967. data->CurrentSC = NULL;
  968. tmpSC->result   = DID_NO_CONNECT << 16;
  969. tmpSC->scsi_done(tmpSC);
  971. return;
  972. }
  973. data->SelectionTimeOut += 1;
  974. nsp_start_timer(tmpSC, data, 1000/51);
  975. return;
  976. }
  978. /* attention assert */
  979. //DEBUG(0, " attention assertn");
  980. data->SelectionTimeOut = 0;
  981. tmpSC->SCp.phase       = PH_SELECTED;
  982. nsp_index_write(base, SCSIBUSCTRL, SCSI_ATN);
  983. udelay(1);
  984. nsp_index_write(base, SCSIBUSCTRL, SCSI_ATN | AUTODIRECTION | ACKENB);
  985. return;
  987. break;
  989. case PH_RESELECT:
  990. //DEBUG(0, " phase reselectn");
  991. *sync_neg = SYNC_NOT_YET;
  992. if ((phase & BUSMON_PHASE_MASK) != BUSPHASE_MESSAGE_IN) {
  994. data->CurrentSC = NULL;
  995. tmpSC->result = DID_ABORT << 16;
  996. tmpSC->scsi_done(tmpSC);
  997. return;
  998. }
  999. /* fall thru */
  1000. default:
  1001. if ((i_src & (IRQSTATUS_SCSI | IRQSTATUS_FIFO)) == 0) {
  1002. return;
  1003. }
  1004. break;
  1005. }
  1007. /*
  1008.  * SCSI sequencer
  1009.  */
  1010. //DEBUG(0, " start scsi seqn");
  1012. /* normal disconnect */
  1013. if ((irq_phase & LATCHED_BUS_FREE) != 0) {
  1014. //DEBUG(0, " normal disconnect i_src=0x%x, phase=0x%x, irq_phase=0x%xn", i_src, phase, irq_phase);
  1015. if ((tmpSC->SCp.Message == MSG_COMMAND_COMPLETE)) {     /* all command complete and return status */
  1016. *sync_neg       = SYNC_NOT_YET;
  1017. data->CurrentSC = NULL;
  1018. tmpSC->result = (DID_OK     << 16) |
  1019. (tmpSC->SCp.Message << 8) |
  1020. (tmpSC->SCp.Status  << 0);
  1021. DEBUG(0, " command complete result=0x%xn", tmpSC->result);
  1022. tmpSC->scsi_done(tmpSC);
  1023. return;
  1024. }
  1026. return;
  1027. }
  1030. /* check unexpected bus free state */
  1031. if (phase == 0) {
  1032. printk(KERN_DEBUG " " __FUNCTION__ " unexpected bus free. i_src=0x%x, phase=0x%x, irq_phase=0x%xn", i_src, phase, irq_phase);
  1034. *sync_neg       = SYNC_NOT_YET;
  1035. data->CurrentSC = NULL;
  1036. tmpSC->result   = DID_ERROR << 16;
  1037. tmpSC->scsi_done(tmpSC);
  1038. return;
  1039. }
  1041. switch (phase & BUSMON_PHASE_MASK) {
  1042. case BUSPHASE_COMMAND:
  1043. DEBUG(0, " BUSPHASE_COMMANDn");
  1044. if ((phase & BUSMON_REQ) == 0) {
  1045. DEBUG(0, " REQ == 0n");
  1046. return;
  1047. }
  1049. tmpSC->SCp.phase = PH_COMMAND;
  1051. nsp_nexus(tmpSC, data);
  1053. /* write scsi command */
  1054. nsp_index_write(base, COMMANDCTRL, CLEAR_COMMAND_POINTER);
  1055. for (len = 0; len < COMMAND_SIZE(tmpSC->cmnd[0]); len++) {
  1056. nsp_index_write(base, COMMANDDATA, tmpSC->cmnd[len]);
  1057. }
  1058. nsp_index_write(base, COMMANDCTRL, CLEAR_COMMAND_POINTER | AUTO_COMMAND_GO);
  1059. break;
  1061. case BUSPHASE_DATA_OUT:
  1062. DEBUG(0, " BUSPHASE_DATA_OUTn");
  1064. tmpSC->SCp.phase = PH_DATA;
  1065. tmpSC->SCp.have_data_in = IO_OUT;
  1067. nsp_pio_write(tmpSC, data);
  1069. break;
  1071. case BUSPHASE_DATA_IN:
  1072. DEBUG(0, " BUSPHASE_DATA_INn");
  1074. tmpSC->SCp.phase = PH_DATA;
  1075. tmpSC->SCp.have_data_in = IO_IN;
  1077. nsp_pio_read(tmpSC, data);
  1079. break;
  1081. case BUSPHASE_STATUS:
  1082. nsp_dataphase_bypass(tmpSC, data);
  1083. DEBUG(0, " BUSPHASE_STATUSn");
  1085. tmpSC->SCp.phase = PH_STATUS;
  1087. tmpSC->SCp.Status = nsp_index_read(base, SCSIDATAWITHACK);
  1088. //DEBUG(0, " message=0x%x status=0x%xn", tmpSC->SCp.Message, tmpSC->SCp.Status);
  1090. break;
  1092. case BUSPHASE_MESSAGE_OUT:
  1093. DEBUG(0, " BUSPHASE_MESSAGE_OUTn");
  1094. if ((phase & BUSMON_REQ) == 0) {
  1095. goto timer_out;
  1096. }
  1098. tmpSC->SCp.phase = PH_MSG_OUT;
  1100. data->MsgLen = len = 0;
  1101. if (*sync_neg == SYNC_NOT_YET) {
  1102. data->Sync[target][lun].SyncPeriod = 0;
  1103. data->Sync[target][lun].SyncOffset = 0;
  1104. nsp_msg(tmpSC, data);
  1106. data->MsgBuffer[len] = IDENTIFY(TRUE, lun); len++;
  1107. /*
  1108. data->MsgBuffer[len] = MSG_EXTENDED;        len++;
  1109. data->MsgBuffer[len] = 3;                   len++;
  1110. data->MsgBuffer[len] = MSG_EXT_SDTR;        len++;
  1111. data->MsgBuffer[len] = 0x0c;                len++;
  1112. data->MsgBuffer[len] = 15;                  len++;
  1113. */
  1114. }
  1115. if (len == 0) {
  1116. data->MsgBuffer[len] = MSG_NO_OPERATION; len++;
  1117. }
  1118. data->MsgLen = len;
  1120. show_message(data);
  1121. nsp_message_out(tmpSC, data);
  1122. break;
  1124. case BUSPHASE_MESSAGE_IN:
  1125. nsp_dataphase_bypass(tmpSC, data);
  1126. DEBUG(0, " BUSPHASE_MESSAGE_INn");
  1127. if ((phase & BUSMON_REQ) == 0) {
  1128. goto timer_out;
  1129. }
  1131. tmpSC->SCp.phase = PH_MSG_IN;
  1132. nsp_message_in(tmpSC, data);
  1134. /*
  1135. if (data->MsgLen       >= 5            &&
  1136.     data->MsgBuffer[0] == MSG_EXTENDED &&
  1137.     data->MsgBuffer[1] == 3            &&
  1138.     data->MsgBuffer[2] == MSG_EXT_SDTR ) {
  1139. data->Sync[target][lun].SyncPeriod = data->MsgBuffer[3];
  1140. data->Sync[target][lun].SyncOffset = data->MsgBuffer[4];
  1141. nsp_msg(tmpSC, data);
  1142. }
  1143. */
  1145. /* search last messeage byte */
  1146. tmp = -1;
  1147. for (i = 0; i < data->MsgLen; i++) {
  1148. tmp = data->MsgBuffer[i];
  1149. if (data->MsgBuffer[i] == MSG_EXTENDED) {
  1150. i += (1 + data->MsgBuffer[i+1]);
  1151. }
  1152. }
  1153. tmpSC->SCp.Message = tmp;
  1155. DEBUG(0, " message=0x%x len=%dn", tmpSC->SCp.Message, data->MsgLen);
  1156. show_message(data);
  1158. break;
  1160. case BUSPHASE_SELECT:
  1161. default:
  1162. DEBUG(0, " BUSPHASE othern");
  1164. break;
  1165. }
  1167. //DEBUG(0, __FUNCTION__ "() outn");
  1168. return;
  1170. timer_out:
  1171. nsp_start_timer(tmpSC, data, 1000/102);
  1172. return;
  1173. }
  1175. #ifdef PCMCIA_DEBUG
  1176. #include "nsp_debug.c"
  1177. #endif /* DBG_SHOWCOMMAND */
  1179. /*----------------------------------------------------------------*/
  1180. /* look for ninja3 card and init if found   */
  1181. /*----------------------------------------------------------------*/
  1182. static int nsp_detect(Scsi_Host_Template *sht)
  1183. {
  1184. struct Scsi_Host *host; /* registered host structure */
  1185. nsp_hw_data *data = &nsp_data;
  1187. DEBUG(0, __FUNCTION__ " this_id=%dn", sht->this_id);
  1189. request_region(data->BaseAddress, data->NumAddress, "nsp_cs");
  1190. host   = scsi_register(sht, 0);
  1191. host->io_port   = data->BaseAddress;
  1192. host->unique_id   = data->BaseAddress;
  1193. host->n_io_port   = data->NumAddress;
  1194. host->irq   = data->IrqNumber;
  1195. host->dma_channel = 0xff;             /* not use dms */
  1197. sprintf(nspinfo,
  1198. /* Buffer size is 100 bytes */
  1199. /*  0         1         2         3         4         5         6         7         8         9         0*/
  1200. /*  01234567890123456789012345678901234567890123456789012345678901234567890123456789012345678901234567890*/
  1201.    "NinjaSCSI-3/32Bi Driver $Revision: 1.42 $, I/O 0x%04lx-0x%04lx IRQ %2d",
  1202. host->io_port, host->io_port + host->n_io_port,
  1203. host->irq);
  1204. sht->name   = nspinfo;
  1206. DEBUG(0, __FUNCTION__ " endn");
  1208. return 1; /* detect done. */
  1209. }
  1211. /* nsp_cs requires own release handler because its uses dev_id (=data) */
  1212. static int nsp_release(struct Scsi_Host *shpnt)
  1213. {
  1214. nsp_hw_data *data = &nsp_data;
  1216.         if (shpnt->irq) {
  1217.                 free_irq(shpnt->irq, data);
  1218. }
  1219.         if (shpnt->io_port && shpnt->n_io_port) {
  1220. release_region(shpnt->io_port, shpnt->n_io_port);
  1221. }
  1222. return 0;
  1223. }
  1225. /*----------------------------------------------------------------*/
  1226. /* return info string   */
  1227. /*----------------------------------------------------------------*/
  1228. static const char *nsp_info(struct Scsi_Host *shpnt)
  1229. {
  1230. return nspinfo;
  1231. }
  1233. /*---------------------------------------------------------------*/
  1234. /* error handler                                                 */
  1235. /*---------------------------------------------------------------*/
  1236. static int nsp_reset(Scsi_Cmnd *SCpnt, unsigned int why)
  1237. {
  1238. DEBUG(0, __FUNCTION__ " SCpnt=0x%p why=%dn", SCpnt, why);
  1240. nsp_eh_bus_reset(SCpnt);
  1242. return SCSI_RESET_SUCCESS;
  1243. }
  1245. static int nsp_abort(Scsi_Cmnd *SCpnt)
  1246. {
  1247. DEBUG(0, __FUNCTION__ " SCpnt=0x%pn", SCpnt);
  1249. nsp_eh_bus_reset(SCpnt);
  1251. return SCSI_ABORT_SUCCESS;
  1252. }
  1254. /*static int nsp_eh_strategy(struct Scsi_Host *Shost)
  1255. {
  1256. return FAILED;
  1257. }*/
  1259. static int nsp_eh_abort(Scsi_Cmnd *SCpnt)
  1260. {
  1261. DEBUG(0, __FUNCTION__ " SCpnt=0x%pn", SCpnt);
  1263. nsp_eh_bus_reset(SCpnt);
  1265. return SUCCESS;
  1266. }
  1268. static int nsp_eh_device_reset(Scsi_Cmnd *SCpnt)
  1269. {
  1270. DEBUG(0, __FUNCTION__ " SCpnt=0x%pn", SCpnt);
  1272. return FAILED;
  1273. }
  1275. static int nsp_eh_bus_reset(Scsi_Cmnd *SCpnt)
  1276. {
  1277. unsigned int base = SCpnt->host->io_port;
  1278. int      i;
  1280. DEBUG(0, __FUNCTION__ "() SCpnt=0x%p base=0x%xn", SCpnt, base);
  1282. nsp_write(base, IRQCONTROL, IRQCONTROL_ALLMASK);
  1284. nsp_index_write(base, SCSIBUSCTRL, SCSI_RST);
  1285. mdelay(100); /* 100ms */
  1286. nsp_index_write(base, SCSIBUSCTRL, 0);
  1287. for(i = 0; i < 5; i++) {
  1288. nsp_index_read(base, IRQPHASESENCE); /* dummy read */
  1289. }
  1291. nsp_write(base, IRQCONTROL, IRQCONTROL_ALLCLEAR);
  1293. return SUCCESS;
  1294. }
  1296. static int nsp_eh_host_reset(Scsi_Cmnd *SCpnt)
  1297. {
  1298. nsp_hw_data *data = &nsp_data;
  1300. DEBUG(0, __FUNCTION__ "n");
  1302. nsphw_init(data);
  1304. return nsp_eh_bus_reset(SCpnt);
  1305. }
  1308. /**********************************************************************
  1309.   PCMCIA functions
  1310.   *********************************************************************/
  1312. /*====================================================================*/
  1313. static void cs_error(client_handle_t handle, int func, int ret)
  1314. {
  1315. error_info_t err = { func, ret };
  1316. CardServices(ReportError, handle, &err);
  1317. }
  1319. /*======================================================================
  1320.     nsp_cs_attach() creates an "instance" of the driver, allocating
  1321.     local data structures for one device.  The device is registered
  1322.     with Card Services.
  1324.     The dev_link structure is initialized, but we don't actually
  1325.     configure the card at this point -- we wait until we receive a
  1326.     card insertion event.
  1327. ======================================================================*/
  1328. static dev_link_t *nsp_cs_attach(void)
  1329. {
  1330. scsi_info_t  *info;
  1331. client_reg_t  client_reg;
  1332. dev_link_t   *link;
  1333. int       ret, i;
  1335. DEBUG(0, __FUNCTION__ "()n");
  1337. /* Create new SCSI device */
  1338. info = kmalloc(sizeof(*info), GFP_KERNEL);
  1339. if (!info) { return NULL; }
  1340. memset(info, 0, sizeof(*info));
  1341. link = &info->link;
  1342. link->priv = info;
  1344. /* Initialize the dev_link_t structure */
  1345. link->release.function  = &nsp_cs_release;
  1346. link->release.data  = (u_long)link;
  1348. /* The io structure describes IO port mapping */
  1349. link->io.NumPorts1  = 0x10;
  1350. link->io.Attributes1  = IO_DATA_PATH_WIDTH_AUTO;
  1351. link->io.IOAddrLines  = 10; /* not used */
  1353. /* Interrupt setup */
  1354. link->irq.Attributes  = IRQ_TYPE_EXCLUSIVE | IRQ_HANDLE_PRESENT;
  1355. link->irq.IRQInfo1  = IRQ_INFO2_VALID    | IRQ_LEVEL_ID;
  1356. if (irq_list[0] == -1) {
  1357. link->irq.IRQInfo2 = irq_mask;
  1358. } else {
  1359. for (i = 0; i < 4; i++) {
  1360. link->irq.IRQInfo2 |= 1 << irq_list[i];
  1361. }
  1362. }
  1363. link->irq.Handler  = &nspintr;
  1364. link->irq.Instance       = &nsp_data;
  1366. /* General socket configuration */
  1367. link->conf.Attributes  = CONF_ENABLE_IRQ;
  1368. link->conf.Vcc  = 50;
  1369. link->conf.IntType  = INT_MEMORY_AND_IO;
  1370. link->conf.Present  = PRESENT_OPTION;
  1373. /* Register with Card Services */
  1374. link->next               = dev_list;
  1375. dev_list                 = link;
  1376. client_reg.dev_info  = &dev_info;
  1377. client_reg.Attributes  = INFO_IO_CLIENT | INFO_CARD_SHARE;
  1378. client_reg.EventMask  =
  1379. CS_EVENT_CARD_INSERTION | CS_EVENT_CARD_REMOVAL |
  1380. CS_EVENT_RESET_PHYSICAL | CS_EVENT_CARD_RESET |
  1381. CS_EVENT_PM_SUSPEND | CS_EVENT_PM_RESUME  ;
  1382. client_reg.event_handler = &nsp_cs_event;
  1383. client_reg.Version  = 0x0210;
  1384. client_reg.event_callback_args.client_data = link;
  1385. ret = CardServices(RegisterClient, &link->handle, &client_reg);
  1386. if (ret != CS_SUCCESS) {
  1387. cs_error(link->handle, RegisterClient, ret);
  1388. nsp_cs_detach(link);
  1389. return NULL;
  1390. }
  1392. return link;
  1393. } /* nsp_cs_attach */
  1396. /*======================================================================
  1397.     This deletes a driver "instance".  The device is de-registered
  1398.     with Card Services.  If it has been released, all local data
  1399.     structures are freed.  Otherwise, the structures will be freed
  1400.     when the device is released.
  1401. ======================================================================*/
  1402. static void nsp_cs_detach(dev_link_t *link)
  1403. {
  1404. dev_link_t **linkp;
  1406. DEBUG(0, __FUNCTION__ "(0x%p)n", link);
  1407.     
  1408. /* Locate device structure */
  1409. for (linkp = &dev_list; *linkp; linkp = &(*linkp)->next) {
  1410. if (*linkp == link) {
  1411. break;
  1412. }
  1413. }
  1414. if (*linkp == NULL) {
  1415. return;
  1416. }
  1418. del_timer(&link->release);
  1419. if (link->state & DEV_CONFIG) {
  1420. nsp_cs_release((u_long)link);
  1421. if (link->state & DEV_STALE_CONFIG) {
  1422. link->state |= DEV_STALE_LINK;
  1423. return;
  1424. }
  1425. }
  1427. /* Break the link with Card Services */
  1428. if (link->handle) {
  1429. CardServices(DeregisterClient, link->handle);
  1430. }
  1432. /* Unlink device structure, free bits */
  1433. *linkp = link->next;
  1434. kfree(link->priv);
  1436. } /* nsp_cs_detach */
  1439. /*======================================================================
  1440.     nsp_cs_config() is scheduled to run after a CARD_INSERTION event
  1441.     is received, to configure the PCMCIA socket, and to make the
  1442.     ethernet device available to the system.
  1443. ======================================================================*/
  1444. #define CS_CHECK(fn, args...) 
  1445. while ((last_ret=CardServices(last_fn=(fn),args))!=0) goto cs_failed
  1446. #define CFG_CHECK(fn, args...) 
  1447. if (CardServices(fn, args) != 0) goto next_entry
  1448. /*====================================================================*/
  1450. static void nsp_cs_config(dev_link_t *link)
  1451. {
  1452. client_handle_t   handle = link->handle;
  1453. scsi_info_t  *info  = link->priv;
  1454. tuple_t   tuple;
  1455. cisparse_t   parse;
  1456. int   i, last_ret, last_fn;
  1457. u_char   tuple_data[64];
  1458. config_info_t   conf;
  1459. Scsi_Device  *dev;
  1460. dev_node_t **tail, *node;
  1461. struct Scsi_Host *host;
  1462. nsp_hw_data      *data = &nsp_data;
  1464. DEBUG(0, __FUNCTION__ "() inn");
  1466. tuple.DesiredTuple    = CISTPL_CONFIG;
  1467. tuple.Attributes      = 0;
  1468. tuple.TupleData       = tuple_data;
  1469. tuple.TupleDataMax    = sizeof(tuple_data);
  1470. tuple.TupleOffset     = 0;
  1471. CS_CHECK(GetFirstTuple, handle, &tuple);
  1472. CS_CHECK(GetTupleData, handle, &tuple);
  1473. CS_CHECK(ParseTuple, handle, &tuple, &parse);
  1474. link->conf.ConfigBase = parse.config.base;
  1475. link->conf.Present    = parse.config.rmask[0];
  1477. /* Configure card */
  1478. driver_template.module = &__this_module;
  1479. link->state       |= DEV_CONFIG;
  1481. /* Look up the current Vcc */
  1482. CS_CHECK(GetConfigurationInfo, handle, &conf);
  1483. link->conf.Vcc = conf.Vcc;
  1485. tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
  1486. CS_CHECK(GetFirstTuple, handle, &tuple);
  1487. while (1) {
  1488. CFG_CHECK(GetTupleData, handle, &tuple);
  1489. CFG_CHECK(ParseTuple, handle, &tuple, &parse);
  1490. link->conf.ConfigIndex = parse.cftable_entry.index;
  1491. link->io.BasePort1     = parse.cftable_entry.io.win[0].base;
  1492. i = CardServices(RequestIO, handle, &link->io);
  1493. if (i == CS_SUCCESS) {
  1494. break;
  1495. }
  1496. next_entry:
  1497. DEBUG(0, __FUNCTION__ " nextn");
  1498. CS_CHECK(GetNextTuple, handle, &tuple);
  1499. }
  1501. CS_CHECK(RequestIRQ,        handle, &link->irq);
  1502. CS_CHECK(RequestConfiguration, handle, &link->conf);
  1504. /* A bad hack... */
  1505. release_region(link->io.BasePort1, link->io.NumPorts1);
  1507. /* Set port and IRQ */
  1508. data->BaseAddress = link->io.BasePort1;
  1509. data->NumAddress  = link->io.NumPorts1;
  1510. data->IrqNumber   = link->irq.AssignedIRQ;
  1512. DEBUG(0, __FUNCTION__ " I/O[0x%x+0x%x] IRQ %dn",
  1513.       data->BaseAddress, data->NumAddress, data->IrqNumber);
  1515. if(nsphw_init(data) == FALSE) {
  1516. goto cs_failed;
  1517. }
  1519. scsi_register_module(MODULE_SCSI_HA, &driver_template);
  1521. DEBUG(0, "GET_SCSI_INFOn");
  1522. tail = &link->dev;
  1523. info->ndev = 0;
  1524. for (host = scsi_hostlist; host != NULL; host = host->next) {
  1525. if (host->hostt == &driver_template) {
  1526. for (dev = host->host_queue; dev != NULL; dev = dev->next) {
  1527. u_long arg[2], id;
  1528. kernel_scsi_ioctl(dev, SCSI_IOCTL_GET_IDLUN, arg);
  1529. id = (arg[0]&0x0f) + ((arg[0]>>4)&0xf0) +
  1530. ((arg[0]>>8)&0xf00) + ((arg[0]>>12)&0xf000);
  1531. node = &info->node[info->ndev];
  1532. node->minor = 0;
  1533. switch (dev->type) {
  1534. case TYPE_TAPE:
  1535. node->major = SCSI_TAPE_MAJOR;
  1536. sprintf(node->dev_name, "st#%04lx", id);
  1537. break;
  1538. case TYPE_DISK:
  1539. case TYPE_MOD:
  1540. node->major = SCSI_DISK0_MAJOR;
  1541. sprintf(node->dev_name, "sd#%04lx", id);
  1542. break;
  1543. case TYPE_ROM:
  1544. case TYPE_WORM:
  1545. node->major = SCSI_CDROM_MAJOR;
  1546. sprintf(node->dev_name, "sr#%04lx", id);
  1547. break;
  1548. default:
  1549. node->major = SCSI_GENERIC_MAJOR;
  1550. sprintf(node->dev_name, "sg#%04lx", id);
  1551. break;
  1552. }
  1553. *tail = node; tail = &node->next;
  1554. info->ndev++;
  1555. info->host = dev->host;
  1556. }
  1557. }
  1558. }
  1559. *tail = NULL;
  1560. if (info->ndev == 0) {
  1561. printk(KERN_INFO "nsp_cs: no SCSI devices foundn");
  1562. }
  1564. /* Finally, report what we've done */
  1565. printk(KERN_INFO "nsp_cs: index 0x%02x: Vcc %d.%d",
  1566.        link->conf.ConfigIndex,
  1567.        link->conf.Vcc/10, link->conf.Vcc%10);
  1568. if (link->conf.Vpp1) {
  1569. printk(", Vpp %d.%d", link->conf.Vpp1/10, link->conf.Vpp1%10);
  1570. }
  1571. if (link->conf.Attributes & CONF_ENABLE_IRQ) {
  1572. printk(", irq %d", link->irq.AssignedIRQ);
  1573. }
  1574. if (link->io.NumPorts1) {
  1575. printk(", io 0x%04x-0x%04x", link->io.BasePort1,
  1576.        link->io.BasePort1+link->io.NumPorts1-1);
  1577. }
  1578. printk("n");
  1580. link->state &= ~DEV_CONFIG_PENDING;
  1581. return;
  1583. cs_failed:
  1584. cs_error(link->handle, last_fn, last_ret);
  1585. nsp_cs_release((u_long)link);
  1586. return;
  1588. } /* nsp_cs_config */
  1589. #undef CS_CHECK
  1590. #undef CFG_CHECK
  1592. /*======================================================================
  1593.     After a card is removed, nsp_cs_release() will unregister the net
  1594.     device, and release the PCMCIA configuration.  If the device is
  1595.     still open, this will be postponed until it is closed.
  1596. ======================================================================*/
  1597. static void nsp_cs_release(u_long arg)
  1598. {
  1599. dev_link_t *link = (dev_link_t *)arg;
  1601. DEBUG(0, __FUNCTION__ "(0x%p)n", link);
  1603. /*
  1604.  * If the device is currently in use, we won't release until it
  1605.  * is actually closed.
  1606.  */
  1607. if (link->open) {
  1608. DEBUG(1, "nsp_cs: release postponed, '%s' still openn",
  1609.       link->dev->dev_name);
  1610. link->state |= DEV_STALE_CONFIG;
  1611. return;
  1612. }
  1614. /* Unlink the device chain */
  1615. scsi_unregister_module(MODULE_SCSI_HA, &driver_template);
  1616. link->dev = NULL;
  1618. if (link->win) {
  1619. CardServices(ReleaseWindow, link->win);
  1620. }
  1621. CardServices(ReleaseConfiguration,  link->handle);
  1622. if (link->io.NumPorts1) {
  1623. CardServices(ReleaseIO,     link->handle, &link->io);
  1624. }
  1625. if (link->irq.AssignedIRQ) {
  1626. CardServices(ReleaseIRQ,    link->handle, &link->irq);
  1627. }
  1628. link->state &= ~DEV_CONFIG;
  1630. if (link->state & DEV_STALE_LINK) {
  1631. nsp_cs_detach(link);
  1632. }
  1633. } /* nsp_cs_release */
  1635. /*======================================================================
  1637.     The card status event handler.  Mostly, this schedules other
  1638.     stuff to run after an event is received.  A CARD_REMOVAL event
  1639.     also sets some flags to discourage the net drivers from trying
  1640.     to talk to the card any more.
  1642.     When a CARD_REMOVAL event is received, we immediately set a flag
  1643.     to block future accesses to this device.  All the functions that
  1644.     actually access the device should check this flag to make sure
  1645.     the card is still present.
  1646.     
  1647. ======================================================================*/
  1648. static int nsp_cs_event(event_t     event,
  1649.      int     priority,
  1650.      event_callback_args_t *args)
  1651. {
  1652. dev_link_t  *link = args->client_data;
  1653. scsi_info_t *info = link->priv;
  1655. DEBUG(1, __FUNCTION__ "(0x%06x)n", event);
  1657. switch (event) {
  1658. case CS_EVENT_CARD_REMOVAL:
  1659. DEBUG(0, " event: removen");
  1660. link->state &= ~DEV_PRESENT;
  1661. if (link->state & DEV_CONFIG) {
  1662. ((scsi_info_t *)link->priv)->stop = 1;
  1663. mod_timer(&link->release, jiffies + HZ/20);
  1664. }
  1665. break;
  1667. case CS_EVENT_CARD_INSERTION:
  1668. DEBUG(0, " event: insertn");
  1669. link->state |= DEV_PRESENT | DEV_CONFIG_PENDING;
  1670. info->bus    =  args->bus;
  1671. nsp_cs_config(link);
  1672. break;
  1674. case CS_EVENT_PM_SUSPEND:
  1675. link->state |= DEV_SUSPEND;
  1676. /* Fall through... */
  1677. case CS_EVENT_RESET_PHYSICAL:
  1678. /* Mark the device as stopped, to block IO until later */
  1679. info->stop = 1;
  1680. if (link->state & DEV_CONFIG) {
  1681. CardServices(ReleaseConfiguration, link->handle);
  1682. }
  1683. break;
  1685. case CS_EVENT_PM_RESUME:
  1686. link->state &= ~DEV_SUSPEND;
  1687. /* Fall through... */
  1688. case CS_EVENT_CARD_RESET:
  1689. DEBUG(0, " event: resetn");
  1690. if (link->state & DEV_CONFIG) {
  1691. Scsi_Cmnd tmp;
  1693. CardServices(RequestConfiguration, link->handle, &link->conf);
  1694. tmp.host = info->host;
  1695. nsp_eh_host_reset(&tmp);
  1696. }
  1697. info->stop = 0;
  1698. break;
  1700. default:
  1701. DEBUG(0, " event: unknownn");
  1702. break;
  1703. }
  1704. DEBUG(0, __FUNCTION__ " endn");
  1705. return 0;
  1706. } /* nsp_cs_event */
  1708. /*======================================================================*
  1709.  * module entry point
  1710.  *====================================================================*/
  1711. static int __init nsp_cs_init(void)
  1712. {
  1713. servinfo_t serv;
  1715. DEBUG(0, __FUNCTION__ "() inn");
  1716. DEBUG(0, "%sn", version);
  1717. CardServices(GetCardServicesInfo, &serv);
  1718. if (serv.Revision != CS_RELEASE_CODE) {
  1719. printk(KERN_DEBUG "nsp_cs: Card Services release "
  1720.        "does not match!n");
  1721. return -1;
  1722. }
  1723. register_pcmcia_driver(&dev_info, &nsp_cs_attach, &nsp_cs_detach);
  1725. DEBUG(0, __FUNCTION__ "() outn");
  1726. return 0;
  1727. }
  1730. static void __exit nsp_cs_cleanup(void)
  1731. {
  1732. DEBUG(0, __FUNCTION__ "() unloadingn");
  1733. unregister_pcmcia_driver(&dev_info);
  1734. while (dev_list != NULL) {
  1735. if (dev_list->state & DEV_CONFIG) {
  1736. nsp_cs_release((u_long)dev_list);
  1737. }
  1738. nsp_cs_detach(dev_list);
  1739. }
  1740. }
  1742. module_init(nsp_cs_init);
  1743. module_exit(nsp_cs_cleanup);
  1745. /*
  1746.  *
  1747.  *
  1748.  */
  1750. /* end */