[PATCH] libata: add ap->pflags and move core dynamic flags to it
[linux-2.6] / drivers / scsi / hptiop.c
1 /*
2  * HighPoint RR3xxx controller driver for Linux
3  * Copyright (C) 2006 HighPoint Technologies, Inc. All Rights Reserved.
4  *
5  * This program is free software; you can redistribute it and/or modify
6  * it under the terms of the GNU General Public License as published by
7  * the Free Software Foundation; version 2 of the License.
8  *
9  * This program is distributed in the hope that it will be useful,
10  * but WITHOUT ANY WARRANTY; without even the implied warranty of
11  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
12  * GNU General Public License for more details.
13  *
14  * Please report bugs/comments/suggestions to linux@highpoint-tech.com
15  *
16  * For more information, visit http://www.highpoint-tech.com
17  */
18 #include <linux/config.h>
19 #include <linux/module.h>
20 #include <linux/types.h>
21 #include <linux/string.h>
22 #include <linux/kernel.h>
23 #include <linux/pci.h>
24 #include <linux/interrupt.h>
25 #include <linux/errno.h>
26 #include <linux/delay.h>
27 #include <linux/timer.h>
28 #include <linux/spinlock.h>
29 #include <linux/hdreg.h>
30 #include <asm/uaccess.h>
31 #include <asm/io.h>
32 #include <asm/div64.h>
33 #include <scsi/scsi_cmnd.h>
34 #include <scsi/scsi_device.h>
35 #include <scsi/scsi.h>
36 #include <scsi/scsi_tcq.h>
37 #include <scsi/scsi_host.h>
38
39 #include "hptiop.h"
40
41 MODULE_AUTHOR("HighPoint Technologies, Inc.");
42 MODULE_DESCRIPTION("HighPoint RocketRAID 3xxx SATA Controller Driver");
43
44 static char driver_name[] = "hptiop";
45 static const char driver_name_long[] = "RocketRAID 3xxx SATA Controller driver";
46 static const char driver_ver[] = "v1.0 (060426)";
47
48 static DEFINE_SPINLOCK(hptiop_hba_list_lock);
49 static LIST_HEAD(hptiop_hba_list);
50 static int hptiop_cdev_major = -1;
51
52 static void hptiop_host_request_callback(struct hptiop_hba *hba, u32 tag);
53 static void hptiop_iop_request_callback(struct hptiop_hba *hba, u32 tag);
54 static void hptiop_message_callback(struct hptiop_hba *hba, u32 msg);
55
56 static inline void hptiop_pci_posting_flush(struct hpt_iopmu __iomem *iop)
57 {
58         readl(&iop->outbound_intstatus);
59 }
60
61 static int iop_wait_ready(struct hpt_iopmu __iomem *iop, u32 millisec)
62 {
63         u32 req = 0;
64         int i;
65
66         for (i = 0; i < millisec; i++) {
67                 req = readl(&iop->inbound_queue);
68                 if (req != IOPMU_QUEUE_EMPTY)
69                         break;
70                 msleep(1);
71         }
72
73         if (req != IOPMU_QUEUE_EMPTY) {
74                 writel(req, &iop->outbound_queue);
75                 hptiop_pci_posting_flush(iop);
76                 return 0;
77         }
78
79         return -1;
80 }
81
82 static void hptiop_request_callback(struct hptiop_hba *hba, u32 tag)
83 {
84         if ((tag & IOPMU_QUEUE_MASK_HOST_BITS) == IOPMU_QUEUE_ADDR_HOST_BIT)
85                 return hptiop_host_request_callback(hba,
86                                 tag & ~IOPMU_QUEUE_ADDR_HOST_BIT);
87         else
88                 return hptiop_iop_request_callback(hba, tag);
89 }
90
91 static inline void hptiop_drain_outbound_queue(struct hptiop_hba *hba)
92 {
93         u32 req;
94
95         while ((req = readl(&hba->iop->outbound_queue)) != IOPMU_QUEUE_EMPTY) {
96
97                 if (req & IOPMU_QUEUE_MASK_HOST_BITS)
98                         hptiop_request_callback(hba, req);
99                 else {
100                         struct hpt_iop_request_header __iomem * p;
101
102                         p = (struct hpt_iop_request_header __iomem *)
103                                 ((char __iomem *)hba->iop + req);
104
105                         if (readl(&p->flags) & IOP_REQUEST_FLAG_SYNC_REQUEST) {
106                                 if (readl(&p->context))
107                                         hptiop_request_callback(hba, req);
108                                 else
109                                         writel(1, &p->context);
110                         }
111                         else
112                                 hptiop_request_callback(hba, req);
113                 }
114         }
115 }
116
117 static int __iop_intr(struct hptiop_hba *hba)
118 {
119         struct hpt_iopmu __iomem *iop = hba->iop;
120         u32 status;
121         int ret = 0;
122
123         status = readl(&iop->outbound_intstatus);
124
125         if (status & IOPMU_OUTBOUND_INT_MSG0) {
126                 u32 msg = readl(&iop->outbound_msgaddr0);
127                 dprintk("received outbound msg %x\n", msg);
128                 writel(IOPMU_OUTBOUND_INT_MSG0, &iop->outbound_intstatus);
129                 hptiop_message_callback(hba, msg);
130                 ret = 1;
131         }
132
133         if (status & IOPMU_OUTBOUND_INT_POSTQUEUE) {
134                 hptiop_drain_outbound_queue(hba);
135                 ret = 1;
136         }
137
138         return ret;
139 }
140
141 static int iop_send_sync_request(struct hptiop_hba *hba,
142                                         void __iomem *_req, u32 millisec)
143 {
144         struct hpt_iop_request_header __iomem *req = _req;
145         u32 i;
146
147         writel(readl(&req->flags) | IOP_REQUEST_FLAG_SYNC_REQUEST,
148                         &req->flags);
149
150         writel(0, &req->context);
151
152         writel((unsigned long)req - (unsigned long)hba->iop,
153                         &hba->iop->inbound_queue);
154
155         hptiop_pci_posting_flush(hba->iop);
156
157         for (i = 0; i < millisec; i++) {
158                 __iop_intr(hba);
159                 if (readl(&req->context))
160                         return 0;
161                 msleep(1);
162         }
163
164         return -1;
165 }
166
167 static int iop_send_sync_msg(struct hptiop_hba *hba, u32 msg, u32 millisec)
168 {
169         u32 i;
170
171         hba->msg_done = 0;
172
173         writel(msg, &hba->iop->inbound_msgaddr0);
174
175         hptiop_pci_posting_flush(hba->iop);
176
177         for (i = 0; i < millisec; i++) {
178                 spin_lock_irq(hba->host->host_lock);
179                 __iop_intr(hba);
180                 spin_unlock_irq(hba->host->host_lock);
181                 if (hba->msg_done)
182                         break;
183                 msleep(1);
184         }
185
186         return hba->msg_done? 0 : -1;
187 }
188
189 static int iop_get_config(struct hptiop_hba *hba,
190                                 struct hpt_iop_request_get_config *config)
191 {
192         u32 req32;
193         struct hpt_iop_request_get_config __iomem *req;
194
195         req32 = readl(&hba->iop->inbound_queue);
196         if (req32 == IOPMU_QUEUE_EMPTY)
197                 return -1;
198
199         req = (struct hpt_iop_request_get_config __iomem *)
200                         ((unsigned long)hba->iop + req32);
201
202         writel(0, &req->header.flags);
203         writel(IOP_REQUEST_TYPE_GET_CONFIG, &req->header.type);
204         writel(sizeof(struct hpt_iop_request_get_config), &req->header.size);
205         writel(IOP_RESULT_PENDING, &req->header.result);
206
207         if (iop_send_sync_request(hba, req, 20000)) {
208                 dprintk("Get config send cmd failed\n");
209                 return -1;
210         }
211
212         memcpy_fromio(config, req, sizeof(*config));
213         writel(req32, &hba->iop->outbound_queue);
214         return 0;
215 }
216
217 static int iop_set_config(struct hptiop_hba *hba,
218                                 struct hpt_iop_request_set_config *config)
219 {
220         u32 req32;
221         struct hpt_iop_request_set_config __iomem *req;
222
223         req32 = readl(&hba->iop->inbound_queue);
224         if (req32 == IOPMU_QUEUE_EMPTY)
225                 return -1;
226
227         req = (struct hpt_iop_request_set_config __iomem *)
228                         ((unsigned long)hba->iop + req32);
229
230         memcpy_toio((u8 __iomem *)req + sizeof(struct hpt_iop_request_header),
231                 (u8 *)config + sizeof(struct hpt_iop_request_header),
232                 sizeof(struct hpt_iop_request_set_config) -
233                         sizeof(struct hpt_iop_request_header));
234
235         writel(0, &req->header.flags);
236         writel(IOP_REQUEST_TYPE_SET_CONFIG, &req->header.type);
237         writel(sizeof(struct hpt_iop_request_set_config), &req->header.size);
238         writel(IOP_RESULT_PENDING, &req->header.result);
239
240         if (iop_send_sync_request(hba, req, 20000)) {
241                 dprintk("Set config send cmd failed\n");
242                 return -1;
243         }
244
245         writel(req32, &hba->iop->outbound_queue);
246         return 0;
247 }
248
249 static int hptiop_initialize_iop(struct hptiop_hba *hba)
250 {
251         struct hpt_iopmu __iomem *iop = hba->iop;
252
253         /* enable interrupts */
254         writel(~(IOPMU_OUTBOUND_INT_POSTQUEUE | IOPMU_OUTBOUND_INT_MSG0),
255                         &iop->outbound_intmask);
256
257         hba->initialized = 1;
258
259         /* start background tasks */
260         if (iop_send_sync_msg(hba,
261                         IOPMU_INBOUND_MSG0_START_BACKGROUND_TASK, 5000)) {
262                 printk(KERN_ERR "scsi%d: fail to start background task\n",
263                         hba->host->host_no);
264                 return -1;
265         }
266         return 0;
267 }
268
269 static int hptiop_map_pci_bar(struct hptiop_hba *hba)
270 {
271         u32 mem_base_phy, length;
272         void __iomem *mem_base_virt;
273         struct pci_dev *pcidev = hba->pcidev;
274
275         if (!(pci_resource_flags(pcidev, 0) & IORESOURCE_MEM)) {
276                 printk(KERN_ERR "scsi%d: pci resource invalid\n",
277                                 hba->host->host_no);
278                 return -1;
279         }
280
281         mem_base_phy = pci_resource_start(pcidev, 0);
282         length = pci_resource_len(pcidev, 0);
283         mem_base_virt = ioremap(mem_base_phy, length);
284
285         if (!mem_base_virt) {
286                 printk(KERN_ERR "scsi%d: Fail to ioremap memory space\n",
287                                 hba->host->host_no);
288                 return -1;
289         }
290
291         hba->iop = mem_base_virt;
292         dprintk("hptiop_map_pci_bar: iop=%p\n", hba->iop);
293         return 0;
294 }
295
296 static void hptiop_message_callback(struct hptiop_hba *hba, u32 msg)
297 {
298         dprintk("iop message 0x%x\n", msg);
299
300         if (!hba->initialized)
301                 return;
302
303         if (msg == IOPMU_INBOUND_MSG0_RESET) {
304                 atomic_set(&hba->resetting, 0);
305                 wake_up(&hba->reset_wq);
306         }
307         else if (msg <= IOPMU_INBOUND_MSG0_MAX)
308                 hba->msg_done = 1;
309 }
310
311 static inline struct hptiop_request *get_req(struct hptiop_hba *hba)
312 {
313         struct hptiop_request *ret;
314
315         dprintk("get_req : req=%p\n", hba->req_list);
316
317         ret = hba->req_list;
318         if (ret)
319                 hba->req_list = ret->next;
320
321         return ret;
322 }
323
324 static inline void free_req(struct hptiop_hba *hba, struct hptiop_request *req)
325 {
326         dprintk("free_req(%d, %p)\n", req->index, req);
327         req->next = hba->req_list;
328         hba->req_list = req;
329 }
330
331 static void hptiop_host_request_callback(struct hptiop_hba *hba, u32 tag)
332 {
333         struct hpt_iop_request_scsi_command *req;
334         struct scsi_cmnd *scp;
335
336         req = (struct hpt_iop_request_scsi_command *)hba->reqs[tag].req_virt;
337         dprintk("hptiop_host_request_callback: req=%p, type=%d, "
338                         "result=%d, context=0x%x tag=%d\n",
339                         req, req->header.type, req->header.result,
340                         req->header.context, tag);
341
342         BUG_ON(!req->header.result);
343         BUG_ON(req->header.type != cpu_to_le32(IOP_REQUEST_TYPE_SCSI_COMMAND));
344
345         scp = hba->reqs[tag].scp;
346
347         if (HPT_SCP(scp)->mapped) {
348                 if (scp->use_sg)
349                         pci_unmap_sg(hba->pcidev,
350                                 (struct scatterlist *)scp->request_buffer,
351                                 scp->use_sg,
352                                 scp->sc_data_direction
353                         );
354                 else
355                         pci_unmap_single(hba->pcidev,
356                                 HPT_SCP(scp)->dma_handle,
357                                 scp->request_bufflen,
358                                 scp->sc_data_direction
359                         );
360         }
361
362         switch (le32_to_cpu(req->header.result)) {
363         case IOP_RESULT_SUCCESS:
364                 scp->result = (DID_OK<<16);
365                 break;
366         case IOP_RESULT_BAD_TARGET:
367                 scp->result = (DID_BAD_TARGET<<16);
368                 break;
369         case IOP_RESULT_BUSY:
370                 scp->result = (DID_BUS_BUSY<<16);
371                 break;
372         case IOP_RESULT_RESET:
373                 scp->result = (DID_RESET<<16);
374                 break;
375         case IOP_RESULT_FAIL:
376                 scp->result = (DID_ERROR<<16);
377                 break;
378         case IOP_RESULT_INVALID_REQUEST:
379                 scp->result = (DID_ABORT<<16);
380                 break;
381         case IOP_RESULT_MODE_SENSE_CHECK_CONDITION:
382                 scp->result = SAM_STAT_CHECK_CONDITION;
383                 memset(&scp->sense_buffer,
384                                 0, sizeof(scp->sense_buffer));
385                 memcpy(&scp->sense_buffer,
386                         &req->sg_list, le32_to_cpu(req->dataxfer_length));
387                 break;
388
389         default:
390                 scp->result = ((DRIVER_INVALID|SUGGEST_ABORT)<<24) |
391                                         (DID_ABORT<<16);
392                 break;
393         }
394
395         dprintk("scsi_done(%p)\n", scp);
396         scp->scsi_done(scp);
397         free_req(hba, &hba->reqs[tag]);
398 }
399
400 void hptiop_iop_request_callback(struct hptiop_hba *hba, u32 tag)
401 {
402         struct hpt_iop_request_header __iomem *req;
403         struct hpt_iop_request_ioctl_command __iomem *p;
404         struct hpt_ioctl_k *arg;
405
406         req = (struct hpt_iop_request_header __iomem *)
407                         ((unsigned long)hba->iop + tag);
408         dprintk("hptiop_iop_request_callback: req=%p, type=%d, "
409                         "result=%d, context=0x%x tag=%d\n",
410                         req, readl(&req->type), readl(&req->result),
411                         readl(&req->context), tag);
412
413         BUG_ON(!readl(&req->result));
414         BUG_ON(readl(&req->type) != IOP_REQUEST_TYPE_IOCTL_COMMAND);
415
416         p = (struct hpt_iop_request_ioctl_command __iomem *)req;
417         arg = (struct hpt_ioctl_k *)(unsigned long)
418                 (readl(&req->context) |
419                         ((u64)readl(&req->context_hi32)<<32));
420
421         if (readl(&req->result) == IOP_RESULT_SUCCESS) {
422                 arg->result = HPT_IOCTL_RESULT_OK;
423
424                 if (arg->outbuf_size)
425                         memcpy_fromio(arg->outbuf,
426                                 &p->buf[(readl(&p->inbuf_size) + 3)& ~3],
427                                 arg->outbuf_size);
428
429                 if (arg->bytes_returned)
430                         *arg->bytes_returned = arg->outbuf_size;
431         }
432         else
433                 arg->result = HPT_IOCTL_RESULT_FAILED;
434
435         arg->done(arg);
436         writel(tag, &hba->iop->outbound_queue);
437 }
438
439 static irqreturn_t hptiop_intr(int irq, void *dev_id, struct pt_regs *regs)
440 {
441         struct hptiop_hba  *hba = dev_id;
442         int  handled;
443         unsigned long flags;
444
445         spin_lock_irqsave(hba->host->host_lock, flags);
446         handled = __iop_intr(hba);
447         spin_unlock_irqrestore(hba->host->host_lock, flags);
448
449         return handled;
450 }
451
452 static int hptiop_buildsgl(struct scsi_cmnd *scp, struct hpt_iopsg *psg)
453 {
454         struct Scsi_Host *host = scp->device->host;
455         struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata;
456         struct scatterlist *sglist = (struct scatterlist *)scp->request_buffer;
457
458         /*
459          * though we'll not get non-use_sg fields anymore,
460          * keep use_sg checking anyway
461          */
462         if (scp->use_sg) {
463                 int idx;
464
465                 HPT_SCP(scp)->sgcnt = pci_map_sg(hba->pcidev,
466                                 sglist, scp->use_sg,
467                                 scp->sc_data_direction);
468                 HPT_SCP(scp)->mapped = 1;
469                 BUG_ON(HPT_SCP(scp)->sgcnt > hba->max_sg_descriptors);
470
471                 for (idx = 0; idx < HPT_SCP(scp)->sgcnt; idx++) {
472                         psg[idx].pci_address =
473                                 cpu_to_le64(sg_dma_address(&sglist[idx]));
474                         psg[idx].size = cpu_to_le32(sg_dma_len(&sglist[idx]));
475                         psg[idx].eot = (idx == HPT_SCP(scp)->sgcnt - 1) ?
476                                 cpu_to_le32(1) : 0;
477                 }
478
479                 return HPT_SCP(scp)->sgcnt;
480         } else {
481                 HPT_SCP(scp)->dma_handle = pci_map_single(
482                                 hba->pcidev,
483                                 scp->request_buffer,
484                                 scp->request_bufflen,
485                                 scp->sc_data_direction
486                         );
487                 HPT_SCP(scp)->mapped = 1;
488                 psg->pci_address = cpu_to_le64(HPT_SCP(scp)->dma_handle);
489                 psg->size = cpu_to_le32(scp->request_bufflen);
490                 psg->eot = cpu_to_le32(1);
491                 return 1;
492         }
493 }
494
495 static int hptiop_queuecommand(struct scsi_cmnd *scp,
496                                 void (*done)(struct scsi_cmnd *))
497 {
498         struct Scsi_Host *host = scp->device->host;
499         struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata;
500         struct hpt_iop_request_scsi_command *req;
501         int sg_count = 0;
502         struct hptiop_request *_req;
503
504         BUG_ON(!done);
505         scp->scsi_done = done;
506
507         _req = get_req(hba);
508         if (_req == NULL) {
509                 dprintk("hptiop_queuecmd : no free req\n");
510                 return SCSI_MLQUEUE_HOST_BUSY;
511         }
512
513         _req->scp = scp;
514
515         dprintk("hptiop_queuecmd(scp=%p) %d/%d/%d/%d cdb=(%x-%x-%x) "
516                         "req_index=%d, req=%p\n",
517                         scp,
518                         host->host_no, scp->device->channel,
519                         scp->device->id, scp->device->lun,
520                         *((u32 *)&scp->cmnd),
521                         *((u32 *)&scp->cmnd + 1),
522                         *((u32 *)&scp->cmnd + 2),
523                         _req->index, _req->req_virt);
524
525         scp->result = 0;
526
527         if (scp->device->channel || scp->device->lun ||
528                         scp->device->id > hba->max_devices) {
529                 scp->result = DID_BAD_TARGET << 16;
530                 free_req(hba, _req);
531                 goto cmd_done;
532         }
533
534         req = (struct hpt_iop_request_scsi_command *)_req->req_virt;
535
536         /* build S/G table */
537         if (scp->request_bufflen)
538                 sg_count = hptiop_buildsgl(scp, req->sg_list);
539         else
540                 HPT_SCP(scp)->mapped = 0;
541
542         req->header.flags = cpu_to_le32(IOP_REQUEST_FLAG_OUTPUT_CONTEXT);
543         req->header.type = cpu_to_le32(IOP_REQUEST_TYPE_SCSI_COMMAND);
544         req->header.result = cpu_to_le32(IOP_RESULT_PENDING);
545         req->header.context = cpu_to_le32(IOPMU_QUEUE_ADDR_HOST_BIT |
546                                                         (u32)_req->index);
547         req->header.context_hi32 = 0;
548         req->dataxfer_length = cpu_to_le32(scp->request_bufflen);
549         req->channel = scp->device->channel;
550         req->target = scp->device->id;
551         req->lun = scp->device->lun;
552         req->header.size = cpu_to_le32(
553                                 sizeof(struct hpt_iop_request_scsi_command)
554                                  - sizeof(struct hpt_iopsg)
555                                  + sg_count * sizeof(struct hpt_iopsg));
556
557         memcpy(req->cdb, scp->cmnd, sizeof(req->cdb));
558
559         writel(IOPMU_QUEUE_ADDR_HOST_BIT | _req->req_shifted_phy,
560                         &hba->iop->inbound_queue);
561
562         return 0;
563
564 cmd_done:
565         dprintk("scsi_done(scp=%p)\n", scp);
566         scp->scsi_done(scp);
567         return 0;
568 }
569
570 static const char *hptiop_info(struct Scsi_Host *host)
571 {
572         return driver_name_long;
573 }
574
575 static int hptiop_reset_hba(struct hptiop_hba *hba)
576 {
577         if (atomic_xchg(&hba->resetting, 1) == 0) {
578                 atomic_inc(&hba->reset_count);
579                 writel(IOPMU_INBOUND_MSG0_RESET,
580                                 &hba->iop->outbound_msgaddr0);
581                 hptiop_pci_posting_flush(hba->iop);
582         }
583
584         wait_event_timeout(hba->reset_wq,
585                         atomic_read(&hba->resetting) == 0, 60 * HZ);
586
587         if (atomic_read(&hba->resetting)) {
588                 /* IOP is in unkown state, abort reset */
589                 printk(KERN_ERR "scsi%d: reset failed\n", hba->host->host_no);
590                 return -1;
591         }
592
593         if (iop_send_sync_msg(hba,
594                 IOPMU_INBOUND_MSG0_START_BACKGROUND_TASK, 5000)) {
595                 dprintk("scsi%d: fail to start background task\n",
596                                 hba->host->host_no);
597         }
598
599         return 0;
600 }
601
602 static int hptiop_reset(struct scsi_cmnd *scp)
603 {
604         struct Scsi_Host * host = scp->device->host;
605         struct hptiop_hba * hba = (struct hptiop_hba *)host->hostdata;
606
607         printk(KERN_WARNING "hptiop_reset(%d/%d/%d) scp=%p\n",
608                         scp->device->host->host_no, scp->device->channel,
609                         scp->device->id, scp);
610
611         return hptiop_reset_hba(hba)? FAILED : SUCCESS;
612 }
613
614 static int hptiop_adjust_disk_queue_depth(struct scsi_device *sdev,
615                                                 int queue_depth)
616 {
617         if(queue_depth > 256)
618                 queue_depth = 256;
619         scsi_adjust_queue_depth(sdev, MSG_ORDERED_TAG, queue_depth);
620         return queue_depth;
621 }
622
623 struct hptiop_getinfo {
624         char __user *buffer;
625         loff_t buflength;
626         loff_t bufoffset;
627         loff_t buffillen;
628         loff_t filpos;
629 };
630
631 static void hptiop_copy_mem_info(struct hptiop_getinfo *pinfo,
632                                         char *data, int datalen)
633 {
634         if (pinfo->filpos < pinfo->bufoffset) {
635                 if (pinfo->filpos + datalen <= pinfo->bufoffset) {
636                         pinfo->filpos += datalen;
637                         return;
638                 } else {
639                         data += (pinfo->bufoffset - pinfo->filpos);
640                         datalen  -= (pinfo->bufoffset - pinfo->filpos);
641                         pinfo->filpos = pinfo->bufoffset;
642                 }
643         }
644
645         pinfo->filpos += datalen;
646         if (pinfo->buffillen == pinfo->buflength)
647                 return;
648
649         if (pinfo->buflength - pinfo->buffillen < datalen)
650                 datalen = pinfo->buflength - pinfo->buffillen;
651
652         if (copy_to_user(pinfo->buffer + pinfo->buffillen, data, datalen))
653                 return;
654
655         pinfo->buffillen += datalen;
656 }
657
658 static int hptiop_copy_info(struct hptiop_getinfo *pinfo, char *fmt, ...)
659 {
660         va_list args;
661         char buf[128];
662         int len;
663
664         va_start(args, fmt);
665         len = vsnprintf(buf, sizeof(buf), fmt, args);
666         va_end(args);
667         hptiop_copy_mem_info(pinfo, buf, len);
668         return len;
669 }
670
671 static void hptiop_ioctl_done(struct hpt_ioctl_k *arg)
672 {
673         arg->done = NULL;
674         wake_up(&arg->hba->ioctl_wq);
675 }
676
677 static void hptiop_do_ioctl(struct hpt_ioctl_k *arg)
678 {
679         struct hptiop_hba *hba = arg->hba;
680         u32 val;
681         struct hpt_iop_request_ioctl_command __iomem *req;
682         int ioctl_retry = 0;
683
684         dprintk("scsi%d: hptiop_do_ioctl\n", hba->host->host_no);
685
686         /*
687          * check (in + out) buff size from application.
688          * outbuf must be dword aligned.
689          */
690         if (((arg->inbuf_size + 3) & ~3) + arg->outbuf_size >
691                         hba->max_request_size
692                                 - sizeof(struct hpt_iop_request_header)
693                                 - 4 * sizeof(u32)) {
694                 dprintk("scsi%d: ioctl buf size (%d/%d) is too large\n",
695                                 hba->host->host_no,
696                                 arg->inbuf_size, arg->outbuf_size);
697                 arg->result = HPT_IOCTL_RESULT_FAILED;
698                 return;
699         }
700
701 retry:
702         spin_lock_irq(hba->host->host_lock);
703
704         val = readl(&hba->iop->inbound_queue);
705         if (val == IOPMU_QUEUE_EMPTY) {
706                 spin_unlock_irq(hba->host->host_lock);
707                 dprintk("scsi%d: no free req for ioctl\n", hba->host->host_no);
708                 arg->result = -1;
709                 return;
710         }
711
712         req = (struct hpt_iop_request_ioctl_command __iomem *)
713                         ((unsigned long)hba->iop + val);
714
715         writel(HPT_CTL_CODE_LINUX_TO_IOP(arg->ioctl_code),
716                         &req->ioctl_code);
717         writel(arg->inbuf_size, &req->inbuf_size);
718         writel(arg->outbuf_size, &req->outbuf_size);
719
720         /*
721          * use the buffer on the IOP local memory first, then copy it
722          * back to host.
723          * the caller's request buffer shoudl be little-endian.
724          */
725         if (arg->inbuf_size)
726                 memcpy_toio(req->buf, arg->inbuf, arg->inbuf_size);
727
728         /* correct the controller ID for IOP */
729         if ((arg->ioctl_code == HPT_IOCTL_GET_CHANNEL_INFO ||
730                 arg->ioctl_code == HPT_IOCTL_GET_CONTROLLER_INFO_V2 ||
731                 arg->ioctl_code == HPT_IOCTL_GET_CONTROLLER_INFO)
732                 && arg->inbuf_size >= sizeof(u32))
733                 writel(0, req->buf);
734
735         writel(IOP_REQUEST_TYPE_IOCTL_COMMAND, &req->header.type);
736         writel(0, &req->header.flags);
737         writel(offsetof(struct hpt_iop_request_ioctl_command, buf)
738                         + arg->inbuf_size, &req->header.size);
739         writel((u32)(unsigned long)arg, &req->header.context);
740         writel(BITS_PER_LONG > 32 ? (u32)((unsigned long)arg>>32) : 0,
741                         &req->header.context_hi32);
742         writel(IOP_RESULT_PENDING, &req->header.result);
743
744         arg->result = HPT_IOCTL_RESULT_FAILED;
745         arg->done = hptiop_ioctl_done;
746
747         writel(val, &hba->iop->inbound_queue);
748         hptiop_pci_posting_flush(hba->iop);
749
750         spin_unlock_irq(hba->host->host_lock);
751
752         wait_event_timeout(hba->ioctl_wq, arg->done == NULL, 60 * HZ);
753
754         if (arg->done != NULL) {
755                 hptiop_reset_hba(hba);
756                 if (ioctl_retry++ < 3)
757                         goto retry;
758         }
759
760         dprintk("hpt_iop_ioctl %x result %d\n",
761                         arg->ioctl_code, arg->result);
762 }
763
764 static int __hpt_do_ioctl(struct hptiop_hba *hba, u32 code, void *inbuf,
765                         u32 insize, void *outbuf, u32 outsize)
766 {
767         struct hpt_ioctl_k arg;
768         arg.hba = hba;
769         arg.ioctl_code = code;
770         arg.inbuf = inbuf;
771         arg.outbuf = outbuf;
772         arg.inbuf_size = insize;
773         arg.outbuf_size = outsize;
774         arg.bytes_returned = NULL;
775         hptiop_do_ioctl(&arg);
776         return arg.result;
777 }
778
779 static inline int hpt_id_valid(__le32 id)
780 {
781         return id != 0 && id != cpu_to_le32(0xffffffff);
782 }
783
784 static int hptiop_get_controller_info(struct hptiop_hba *hba,
785                                         struct hpt_controller_info *pinfo)
786 {
787         int id = 0;
788
789         return __hpt_do_ioctl(hba, HPT_IOCTL_GET_CONTROLLER_INFO,
790                 &id, sizeof(int), pinfo, sizeof(*pinfo));
791 }
792
793
794 static int hptiop_get_channel_info(struct hptiop_hba *hba, int bus,
795                                         struct hpt_channel_info *pinfo)
796 {
797         u32 ids[2];
798
799         ids[0] = 0;
800         ids[1] = bus;
801         return __hpt_do_ioctl(hba, HPT_IOCTL_GET_CHANNEL_INFO,
802                                 ids, sizeof(ids), pinfo, sizeof(*pinfo));
803
804 }
805
806 static int hptiop_get_logical_devices(struct hptiop_hba *hba,
807                                         __le32 *pids, int maxcount)
808 {
809         int i;
810         u32 count = maxcount - 1;
811
812         if (__hpt_do_ioctl(hba, HPT_IOCTL_GET_LOGICAL_DEVICES,
813                         &count, sizeof(u32),
814                         pids, sizeof(u32) * maxcount))
815                 return -1;
816
817         maxcount = le32_to_cpu(pids[0]);
818         for (i = 0; i < maxcount; i++)
819                 pids[i] = pids[i+1];
820
821         return maxcount;
822 }
823
824 static int hptiop_get_device_info_v3(struct hptiop_hba *hba, __le32 id,
825                                 struct hpt_logical_device_info_v3 *pinfo)
826 {
827         return __hpt_do_ioctl(hba, HPT_IOCTL_GET_DEVICE_INFO_V3,
828                                 &id, sizeof(u32),
829                                 pinfo, sizeof(*pinfo));
830 }
831
832 static const char *get_array_status(struct hpt_logical_device_info_v3 *devinfo)
833 {
834         static char s[64];
835         u32 flags = le32_to_cpu(devinfo->u.array.flags);
836         u32 trans_prog = le32_to_cpu(devinfo->u.array.transforming_progress);
837         u32 reb_prog = le32_to_cpu(devinfo->u.array.rebuilding_progress);
838
839         if (flags & ARRAY_FLAG_DISABLED)
840                 return "Disabled";
841         else if (flags & ARRAY_FLAG_TRANSFORMING)
842                 sprintf(s, "Expanding/Migrating %d.%d%%%s%s",
843                         trans_prog / 100,
844                         trans_prog % 100,
845                         (flags & (ARRAY_FLAG_NEEDBUILDING|ARRAY_FLAG_BROKEN))?
846                                         ", Critical" : "",
847                         ((flags & ARRAY_FLAG_NEEDINITIALIZING) &&
848                          !(flags & ARRAY_FLAG_REBUILDING) &&
849                          !(flags & ARRAY_FLAG_INITIALIZING))?
850                                         ", Unintialized" : "");
851         else if ((flags & ARRAY_FLAG_BROKEN) &&
852                                 devinfo->u.array.array_type != AT_RAID6)
853                 return "Critical";
854         else if (flags & ARRAY_FLAG_REBUILDING)
855                 sprintf(s,
856                         (flags & ARRAY_FLAG_NEEDINITIALIZING)?
857                                 "%sBackground initializing %d.%d%%" :
858                                         "%sRebuilding %d.%d%%",
859                         (flags & ARRAY_FLAG_BROKEN)? "Critical, " : "",
860                         reb_prog / 100,
861                         reb_prog % 100);
862         else if (flags & ARRAY_FLAG_VERIFYING)
863                 sprintf(s, "%sVerifying %d.%d%%",
864                         (flags & ARRAY_FLAG_BROKEN)? "Critical, " : "",
865                         reb_prog / 100,
866                         reb_prog % 100);
867         else if (flags & ARRAY_FLAG_INITIALIZING)
868                 sprintf(s, "%sForground initializing %d.%d%%",
869                         (flags & ARRAY_FLAG_BROKEN)? "Critical, " : "",
870                         reb_prog / 100,
871                         reb_prog % 100);
872         else if (flags & ARRAY_FLAG_NEEDTRANSFORM)
873                 sprintf(s,"%s%s%s", "Need Expanding/Migrating",
874                         (flags & ARRAY_FLAG_BROKEN)? "Critical, " : "",
875                         ((flags & ARRAY_FLAG_NEEDINITIALIZING) &&
876                          !(flags & ARRAY_FLAG_REBUILDING) &&
877                          !(flags & ARRAY_FLAG_INITIALIZING))?
878                                 ", Unintialized" : "");
879         else if (flags & ARRAY_FLAG_NEEDINITIALIZING &&
880                 !(flags & ARRAY_FLAG_REBUILDING) &&
881                 !(flags & ARRAY_FLAG_INITIALIZING))
882                 sprintf(s,"%sUninitialized",
883                         (flags & ARRAY_FLAG_BROKEN)? "Critical, " : "");
884         else if ((flags & ARRAY_FLAG_NEEDBUILDING) ||
885                         (flags & ARRAY_FLAG_BROKEN))
886                 return "Critical";
887         else
888                 return "Normal";
889         return s;
890 }
891
892 static void hptiop_dump_devinfo(struct hptiop_hba *hba,
893                         struct hptiop_getinfo *pinfo, __le32 id, int indent)
894 {
895         struct hpt_logical_device_info_v3 devinfo;
896         int i;
897         u64 capacity;
898
899         for (i = 0; i < indent; i++)
900                 hptiop_copy_info(pinfo, "\t");
901
902         if (hptiop_get_device_info_v3(hba, id, &devinfo)) {
903                 hptiop_copy_info(pinfo, "unknown\n");
904                 return;
905         }
906
907         switch (devinfo.type) {
908
909         case LDT_DEVICE: {
910                 struct hd_driveid *driveid;
911                 u32 flags = le32_to_cpu(devinfo.u.device.flags);
912
913                 driveid = (struct hd_driveid *)devinfo.u.device.ident;
914                 /* model[] is 40 chars long, but we just want 20 chars here */
915                 driveid->model[20] = 0;
916
917                 if (indent)
918                         if (flags & DEVICE_FLAG_DISABLED)
919                                 hptiop_copy_info(pinfo,"Missing\n");
920                         else
921                                 hptiop_copy_info(pinfo, "CH%d %s\n",
922                                         devinfo.u.device.path_id + 1,
923                                         driveid->model);
924                 else {
925                         capacity = le64_to_cpu(devinfo.capacity) * 512;
926                         do_div(capacity, 1000000);
927                         hptiop_copy_info(pinfo,
928                                 "CH%d %s, %lluMB, %s %s%s%s%s\n",
929                                 devinfo.u.device.path_id + 1,
930                                 driveid->model,
931                                 capacity,
932                                 (flags & DEVICE_FLAG_DISABLED)?
933                                         "Disabled" : "Normal",
934                                 devinfo.u.device.read_ahead_enabled?
935                                                 "[RA]" : "",
936                                 devinfo.u.device.write_cache_enabled?
937                                                 "[WC]" : "",
938                                 devinfo.u.device.TCQ_enabled?
939                                                 "[TCQ]" : "",
940                                 devinfo.u.device.NCQ_enabled?
941                                                 "[NCQ]" : ""
942                         );
943                 }
944                 break;
945         }
946
947         case LDT_ARRAY:
948                 if (devinfo.target_id != INVALID_TARGET_ID)
949                         hptiop_copy_info(pinfo, "[DISK %d_%d] ",
950                                         devinfo.vbus_id, devinfo.target_id);
951
952                 capacity = le64_to_cpu(devinfo.capacity) * 512;
953                 do_div(capacity, 1000000);
954                 hptiop_copy_info(pinfo, "%s (%s), %lluMB, %s\n",
955                         devinfo.u.array.name,
956                         devinfo.u.array.array_type==AT_RAID0? "RAID0" :
957                                 devinfo.u.array.array_type==AT_RAID1? "RAID1" :
958                                 devinfo.u.array.array_type==AT_RAID5? "RAID5" :
959                                 devinfo.u.array.array_type==AT_RAID6? "RAID6" :
960                                 devinfo.u.array.array_type==AT_JBOD? "JBOD" :
961                                         "unknown",
962                         capacity,
963                         get_array_status(&devinfo));
964                 for (i = 0; i < devinfo.u.array.ndisk; i++) {
965                         if (hpt_id_valid(devinfo.u.array.members[i])) {
966                                 if (cpu_to_le16(1<<i) &
967                                         devinfo.u.array.critical_members)
968                                         hptiop_copy_info(pinfo, "\t*");
969                                 hptiop_dump_devinfo(hba, pinfo,
970                                         devinfo.u.array.members[i], indent+1);
971                         }
972                         else
973                                 hptiop_copy_info(pinfo, "\tMissing\n");
974                 }
975                 if (id == devinfo.u.array.transform_source) {
976                         hptiop_copy_info(pinfo, "\tExpanding/Migrating to:\n");
977                         hptiop_dump_devinfo(hba, pinfo,
978                                 devinfo.u.array.transform_target, indent+1);
979                 }
980                 break;
981         }
982 }
983
984 static ssize_t hptiop_show_version(struct class_device *class_dev, char *buf)
985 {
986         return snprintf(buf, PAGE_SIZE, "%s\n", driver_ver);
987 }
988
989 static ssize_t hptiop_cdev_read(struct file *filp, char __user *buf,
990                                 size_t count, loff_t *ppos)
991 {
992         struct hptiop_hba *hba = filp->private_data;
993         struct hptiop_getinfo info;
994         int i, j, ndev;
995         struct hpt_controller_info con_info;
996         struct hpt_channel_info chan_info;
997         __le32 ids[32];
998
999         info.buffer     = buf;
1000         info.buflength  = count;
1001         info.bufoffset  = ppos ? *ppos : 0;
1002         info.filpos     = 0;
1003         info.buffillen  = 0;
1004
1005         if (hptiop_get_controller_info(hba, &con_info))
1006                 return -EIO;
1007
1008         for (i = 0; i < con_info.num_buses; i++) {
1009                 if (hptiop_get_channel_info(hba, i, &chan_info) == 0) {
1010                         if (hpt_id_valid(chan_info.devices[0]))
1011                                 hptiop_dump_devinfo(hba, &info,
1012                                                 chan_info.devices[0], 0);
1013                         if (hpt_id_valid(chan_info.devices[1]))
1014                                 hptiop_dump_devinfo(hba, &info,
1015                                                 chan_info.devices[1], 0);
1016                 }
1017         }
1018
1019         ndev = hptiop_get_logical_devices(hba, ids,
1020                                         sizeof(ids) / sizeof(ids[0]));
1021
1022         /*
1023          * if hptiop_get_logical_devices fails, ndev==-1 and it just
1024          * output nothing here
1025          */
1026         for (j = 0; j < ndev; j++)
1027                 hptiop_dump_devinfo(hba, &info, ids[j], 0);
1028
1029         if (ppos)
1030                 *ppos += info.buffillen;
1031
1032         return info.buffillen;
1033 }
1034
1035 static int hptiop_cdev_ioctl(struct inode *inode,  struct file *file,
1036                                         unsigned int cmd, unsigned long arg)
1037 {
1038         struct hptiop_hba *hba = file->private_data;
1039         struct hpt_ioctl_u ioctl_u;
1040         struct hpt_ioctl_k ioctl_k;
1041         u32 bytes_returned;
1042         int err = -EINVAL;
1043
1044         if (copy_from_user(&ioctl_u,
1045                 (void __user *)arg, sizeof(struct hpt_ioctl_u)))
1046                 return -EINVAL;
1047
1048         if (ioctl_u.magic != HPT_IOCTL_MAGIC)
1049                 return -EINVAL;
1050
1051         ioctl_k.ioctl_code = ioctl_u.ioctl_code;
1052         ioctl_k.inbuf = NULL;
1053         ioctl_k.inbuf_size = ioctl_u.inbuf_size;
1054         ioctl_k.outbuf = NULL;
1055         ioctl_k.outbuf_size = ioctl_u.outbuf_size;
1056         ioctl_k.hba = hba;
1057         ioctl_k.bytes_returned = &bytes_returned;
1058
1059         /* verify user buffer */
1060         if ((ioctl_k.inbuf_size && !access_ok(VERIFY_READ,
1061                         ioctl_u.inbuf, ioctl_k.inbuf_size)) ||
1062                 (ioctl_k.outbuf_size && !access_ok(VERIFY_WRITE,
1063                         ioctl_u.outbuf, ioctl_k.outbuf_size)) ||
1064                 (ioctl_u.bytes_returned && !access_ok(VERIFY_WRITE,
1065                         ioctl_u.bytes_returned, sizeof(u32))) ||
1066                 ioctl_k.inbuf_size + ioctl_k.outbuf_size > 0x10000) {
1067
1068                 dprintk("scsi%d: got bad user address\n", hba->host->host_no);
1069                 return -EINVAL;
1070         }
1071
1072         /* map buffer to kernel. */
1073         if (ioctl_k.inbuf_size) {
1074                 ioctl_k.inbuf = kmalloc(ioctl_k.inbuf_size, GFP_KERNEL);
1075                 if (!ioctl_k.inbuf) {
1076                         dprintk("scsi%d: fail to alloc inbuf\n",
1077                                         hba->host->host_no);
1078                         err = -ENOMEM;
1079                         goto err_exit;
1080                 }
1081
1082                 if (copy_from_user(ioctl_k.inbuf,
1083                                 ioctl_u.inbuf, ioctl_k.inbuf_size)) {
1084                         goto err_exit;
1085                 }
1086         }
1087
1088         if (ioctl_k.outbuf_size) {
1089                 ioctl_k.outbuf = kmalloc(ioctl_k.outbuf_size, GFP_KERNEL);
1090                 if (!ioctl_k.outbuf) {
1091                         dprintk("scsi%d: fail to alloc outbuf\n",
1092                                         hba->host->host_no);
1093                         err = -ENOMEM;
1094                         goto err_exit;
1095                 }
1096         }
1097
1098         hptiop_do_ioctl(&ioctl_k);
1099
1100         if (ioctl_k.result == HPT_IOCTL_RESULT_OK) {
1101                 if (ioctl_k.outbuf_size &&
1102                         copy_to_user(ioctl_u.outbuf,
1103                                 ioctl_k.outbuf, ioctl_k.outbuf_size))
1104                         goto err_exit;
1105
1106                 if (ioctl_u.bytes_returned &&
1107                         copy_to_user(ioctl_u.bytes_returned,
1108                                 &bytes_returned, sizeof(u32)))
1109                         goto err_exit;
1110
1111                 err = 0;
1112         }
1113
1114 err_exit:
1115         kfree(ioctl_k.inbuf);
1116         kfree(ioctl_k.outbuf);
1117
1118         return err;
1119 }
1120
1121 static int hptiop_cdev_open(struct inode *inode, struct file *file)
1122 {
1123         struct hptiop_hba *hba;
1124         unsigned i = 0, minor = iminor(inode);
1125         int ret = -ENODEV;
1126
1127         spin_lock(&hptiop_hba_list_lock);
1128         list_for_each_entry(hba, &hptiop_hba_list, link) {
1129                 if (i == minor) {
1130                         file->private_data = hba;
1131                         ret = 0;
1132                         goto out;
1133                 }
1134                 i++;
1135         }
1136
1137 out:
1138         spin_unlock(&hptiop_hba_list_lock);
1139         return ret;
1140 }
1141
1142 static struct file_operations hptiop_cdev_fops = {
1143         .owner = THIS_MODULE,
1144         .read  = hptiop_cdev_read,
1145         .ioctl = hptiop_cdev_ioctl,
1146         .open  = hptiop_cdev_open,
1147 };
1148
1149 static ssize_t hptiop_show_fw_version(struct class_device *class_dev, char *buf)
1150 {
1151         struct Scsi_Host *host = class_to_shost(class_dev);
1152         struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata;
1153
1154         return snprintf(buf, PAGE_SIZE, "%d.%d.%d.%d\n",
1155                                 hba->firmware_version >> 24,
1156                                 (hba->firmware_version >> 16) & 0xff,
1157                                 (hba->firmware_version >> 8) & 0xff,
1158                                 hba->firmware_version & 0xff);
1159 }
1160
1161 static struct class_device_attribute hptiop_attr_version = {
1162         .attr = {
1163                 .name = "driver-version",
1164                 .mode = S_IRUGO,
1165         },
1166         .show = hptiop_show_version,
1167 };
1168
1169 static struct class_device_attribute hptiop_attr_fw_version = {
1170         .attr = {
1171                 .name = "firmware-version",
1172                 .mode = S_IRUGO,
1173         },
1174         .show = hptiop_show_fw_version,
1175 };
1176
1177 static struct class_device_attribute *hptiop_attrs[] = {
1178         &hptiop_attr_version,
1179         &hptiop_attr_fw_version,
1180         NULL
1181 };
1182
1183 static struct scsi_host_template driver_template = {
1184         .module                     = THIS_MODULE,
1185         .name                       = driver_name,
1186         .queuecommand               = hptiop_queuecommand,
1187         .eh_device_reset_handler    = hptiop_reset,
1188         .eh_bus_reset_handler       = hptiop_reset,
1189         .info                       = hptiop_info,
1190         .unchecked_isa_dma          = 0,
1191         .emulated                   = 0,
1192         .use_clustering             = ENABLE_CLUSTERING,
1193         .proc_name                  = driver_name,
1194         .shost_attrs                = hptiop_attrs,
1195         .this_id                    = -1,
1196         .change_queue_depth         = hptiop_adjust_disk_queue_depth,
1197 };
1198
1199 static int __devinit hptiop_probe(struct pci_dev *pcidev,
1200                                         const struct pci_device_id *id)
1201 {
1202         struct Scsi_Host *host = NULL;
1203         struct hptiop_hba *hba;
1204         struct hpt_iop_request_get_config iop_config;
1205         struct hpt_iop_request_set_config set_config;
1206         dma_addr_t start_phy;
1207         void *start_virt;
1208         u32 offset, i, req_size;
1209
1210         dprintk("hptiop_probe(%p)\n", pcidev);
1211
1212         if (pci_enable_device(pcidev)) {
1213                 printk(KERN_ERR "hptiop: fail to enable pci device\n");
1214                 return -ENODEV;
1215         }
1216
1217         printk(KERN_INFO "adapter at PCI %d:%d:%d, IRQ %d\n",
1218                 pcidev->bus->number, pcidev->devfn >> 3, pcidev->devfn & 7,
1219                 pcidev->irq);
1220
1221         pci_set_master(pcidev);
1222
1223         /* Enable 64bit DMA if possible */
1224         if (pci_set_dma_mask(pcidev, DMA_64BIT_MASK)) {
1225                 if (pci_set_dma_mask(pcidev, DMA_32BIT_MASK)) {
1226                         printk(KERN_ERR "hptiop: fail to set dma_mask\n");
1227                         goto disable_pci_device;
1228                 }
1229         }
1230
1231         if (pci_request_regions(pcidev, driver_name)) {
1232                 printk(KERN_ERR "hptiop: pci_request_regions failed\n");
1233                 goto disable_pci_device;
1234         }
1235
1236         host = scsi_host_alloc(&driver_template, sizeof(struct hptiop_hba));
1237         if (!host) {
1238                 printk(KERN_ERR "hptiop: fail to alloc scsi host\n");
1239                 goto free_pci_regions;
1240         }
1241
1242         hba = (struct hptiop_hba *)host->hostdata;
1243
1244         hba->pcidev = pcidev;
1245         hba->host = host;
1246         hba->initialized = 0;
1247
1248         atomic_set(&hba->resetting, 0);
1249         atomic_set(&hba->reset_count, 0);
1250
1251         init_waitqueue_head(&hba->reset_wq);
1252         init_waitqueue_head(&hba->ioctl_wq);
1253
1254         host->max_lun = 1;
1255         host->max_channel = 0;
1256         host->io_port = 0;
1257         host->n_io_port = 0;
1258         host->irq = pcidev->irq;
1259
1260         if (hptiop_map_pci_bar(hba))
1261                 goto free_scsi_host;
1262
1263         if (iop_wait_ready(hba->iop, 20000)) {
1264                 printk(KERN_ERR "scsi%d: firmware not ready\n",
1265                                 hba->host->host_no);
1266                 goto unmap_pci_bar;
1267         }
1268
1269         if (iop_get_config(hba, &iop_config)) {
1270                 printk(KERN_ERR "scsi%d: get config failed\n",
1271                                 hba->host->host_no);
1272                 goto unmap_pci_bar;
1273         }
1274
1275         hba->max_requests = min(le32_to_cpu(iop_config.max_requests),
1276                                 HPTIOP_MAX_REQUESTS);
1277         hba->max_devices = le32_to_cpu(iop_config.max_devices);
1278         hba->max_request_size = le32_to_cpu(iop_config.request_size);
1279         hba->max_sg_descriptors = le32_to_cpu(iop_config.max_sg_count);
1280         hba->firmware_version = le32_to_cpu(iop_config.firmware_version);
1281         hba->sdram_size = le32_to_cpu(iop_config.sdram_size);
1282
1283         host->max_sectors = le32_to_cpu(iop_config.data_transfer_length) >> 9;
1284         host->max_id = le32_to_cpu(iop_config.max_devices);
1285         host->sg_tablesize = le32_to_cpu(iop_config.max_sg_count);
1286         host->can_queue = le32_to_cpu(iop_config.max_requests);
1287         host->cmd_per_lun = le32_to_cpu(iop_config.max_requests);
1288         host->max_cmd_len = 16;
1289
1290         set_config.vbus_id = cpu_to_le32(host->host_no);
1291         set_config.iop_id = cpu_to_le32(host->host_no);
1292
1293         if (iop_set_config(hba, &set_config)) {
1294                 printk(KERN_ERR "scsi%d: set config failed\n",
1295                                 hba->host->host_no);
1296                 goto unmap_pci_bar;
1297         }
1298
1299         if (scsi_add_host(host, &pcidev->dev)) {
1300                 printk(KERN_ERR "scsi%d: scsi_add_host failed\n",
1301                                         hba->host->host_no);
1302                 goto unmap_pci_bar;
1303         }
1304
1305         pci_set_drvdata(pcidev, host);
1306
1307         if (request_irq(pcidev->irq, hptiop_intr, IRQF_SHARED,
1308                                         driver_name, hba)) {
1309                 printk(KERN_ERR "scsi%d: request irq %d failed\n",
1310                                         hba->host->host_no, pcidev->irq);
1311                 goto remove_scsi_host;
1312         }
1313
1314         /* Allocate request mem */
1315         req_size = sizeof(struct hpt_iop_request_scsi_command)
1316                 + sizeof(struct hpt_iopsg) * (hba->max_sg_descriptors - 1);
1317         if ((req_size& 0x1f) != 0)
1318                 req_size = (req_size + 0x1f) & ~0x1f;
1319
1320         dprintk("req_size=%d, max_requests=%d\n", req_size, hba->max_requests);
1321
1322         hba->req_size = req_size;
1323         start_virt = dma_alloc_coherent(&pcidev->dev,
1324                                 hba->req_size*hba->max_requests + 0x20,
1325                                 &start_phy, GFP_KERNEL);
1326
1327         if (!start_virt) {
1328                 printk(KERN_ERR "scsi%d: fail to alloc request mem\n",
1329                                         hba->host->host_no);
1330                 goto free_request_irq;
1331         }
1332
1333         hba->dma_coherent = start_virt;
1334         hba->dma_coherent_handle = start_phy;
1335
1336         if ((start_phy & 0x1f) != 0)
1337         {
1338                 offset = ((start_phy + 0x1f) & ~0x1f) - start_phy;
1339                 start_phy += offset;
1340                 start_virt += offset;
1341         }
1342
1343         hba->req_list = start_virt;
1344         for (i = 0; i < hba->max_requests; i++) {
1345                 hba->reqs[i].next = NULL;
1346                 hba->reqs[i].req_virt = start_virt;
1347                 hba->reqs[i].req_shifted_phy = start_phy >> 5;
1348                 hba->reqs[i].index = i;
1349                 free_req(hba, &hba->reqs[i]);
1350                 start_virt = (char *)start_virt + hba->req_size;
1351                 start_phy = start_phy + hba->req_size;
1352         }
1353
1354         /* Enable Interrupt and start background task */
1355         if (hptiop_initialize_iop(hba))
1356                 goto free_request_mem;
1357
1358         spin_lock(&hptiop_hba_list_lock);
1359         list_add_tail(&hba->link, &hptiop_hba_list);
1360         spin_unlock(&hptiop_hba_list_lock);
1361
1362         scsi_scan_host(host);
1363
1364         dprintk("scsi%d: hptiop_probe successfully\n", hba->host->host_no);
1365         return 0;
1366
1367 free_request_mem:
1368         dma_free_coherent(&hba->pcidev->dev,
1369                         hba->req_size*hba->max_requests + 0x20,
1370                         hba->dma_coherent, hba->dma_coherent_handle);
1371
1372 free_request_irq:
1373         free_irq(hba->pcidev->irq, hba);
1374
1375 remove_scsi_host:
1376         scsi_remove_host(host);
1377
1378 unmap_pci_bar:
1379         iounmap(hba->iop);
1380
1381 free_pci_regions:
1382         pci_release_regions(pcidev) ;
1383
1384 free_scsi_host:
1385         scsi_host_put(host);
1386
1387 disable_pci_device:
1388         pci_disable_device(pcidev);
1389
1390         dprintk("scsi%d: hptiop_probe fail\n", host->host_no);
1391         return -ENODEV;
1392 }
1393
1394 static void hptiop_shutdown(struct pci_dev *pcidev)
1395 {
1396         struct Scsi_Host *host = pci_get_drvdata(pcidev);
1397         struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata;
1398         struct hpt_iopmu __iomem *iop = hba->iop;
1399         u32    int_mask;
1400
1401         dprintk("hptiop_shutdown(%p)\n", hba);
1402
1403         /* stop the iop */
1404         if (iop_send_sync_msg(hba, IOPMU_INBOUND_MSG0_SHUTDOWN, 60000))
1405                 printk(KERN_ERR "scsi%d: shutdown the iop timeout\n",
1406                                         hba->host->host_no);
1407
1408         /* disable all outbound interrupts */
1409         int_mask = readl(&iop->outbound_intmask);
1410         writel(int_mask |
1411                 IOPMU_OUTBOUND_INT_MSG0 | IOPMU_OUTBOUND_INT_POSTQUEUE,
1412                 &iop->outbound_intmask);
1413         hptiop_pci_posting_flush(iop);
1414 }
1415
1416 static void hptiop_remove(struct pci_dev *pcidev)
1417 {
1418         struct Scsi_Host *host = pci_get_drvdata(pcidev);
1419         struct hptiop_hba *hba = (struct hptiop_hba *)host->hostdata;
1420
1421         dprintk("scsi%d: hptiop_remove\n", hba->host->host_no);
1422
1423         scsi_remove_host(host);
1424
1425         spin_lock(&hptiop_hba_list_lock);
1426         list_del_init(&hba->link);
1427         spin_unlock(&hptiop_hba_list_lock);
1428
1429         hptiop_shutdown(pcidev);
1430
1431         free_irq(hba->pcidev->irq, hba);
1432
1433         dma_free_coherent(&hba->pcidev->dev,
1434                         hba->req_size * hba->max_requests + 0x20,
1435                         hba->dma_coherent,
1436                         hba->dma_coherent_handle);
1437
1438         iounmap(hba->iop);
1439
1440         pci_release_regions(hba->pcidev);
1441         pci_set_drvdata(hba->pcidev, NULL);
1442         pci_disable_device(hba->pcidev);
1443
1444         scsi_host_put(host);
1445 }
1446
1447 static struct pci_device_id hptiop_id_table[] = {
1448         { PCI_DEVICE(0x1103, 0x3220) },
1449         { PCI_DEVICE(0x1103, 0x3320) },
1450         {},
1451 };
1452
1453 MODULE_DEVICE_TABLE(pci, hptiop_id_table);
1454
1455 static struct pci_driver hptiop_pci_driver = {
1456         .name       = driver_name,
1457         .id_table   = hptiop_id_table,
1458         .probe      = hptiop_probe,
1459         .remove     = hptiop_remove,
1460         .shutdown   = hptiop_shutdown,
1461 };
1462
1463 static int __init hptiop_module_init(void)
1464 {
1465         int error;
1466
1467         printk(KERN_INFO "%s %s\n", driver_name_long, driver_ver);
1468
1469         error = pci_register_driver(&hptiop_pci_driver);
1470         if (error < 0)
1471                 return error;
1472
1473         hptiop_cdev_major = register_chrdev(0, "hptiop", &hptiop_cdev_fops);
1474         if (hptiop_cdev_major < 0) {
1475                 printk(KERN_WARNING "unable to register hptiop device.\n");
1476                 return hptiop_cdev_major;
1477         }
1478
1479         return 0;
1480 }
1481
1482 static void __exit hptiop_module_exit(void)
1483 {
1484         dprintk("hptiop_module_exit\n");
1485         unregister_chrdev(hptiop_cdev_major, "hptiop");
1486         pci_unregister_driver(&hptiop_pci_driver);
1487 }
1488
1489
1490 module_init(hptiop_module_init);
1491 module_exit(hptiop_module_exit);
1492
1493 MODULE_LICENSE("GPL");