[SCSI] libsas: kill sas_slave_destroy
[linux-2.6.git] / drivers / scsi / mvsas / mv_init.c
1 /*
2  * Marvell 88SE64xx/88SE94xx pci init
3  *
4  * Copyright 2007 Red Hat, Inc.
5  * Copyright 2008 Marvell. <kewei@marvell.com>
6  * Copyright 2009-2011 Marvell. <yuxiangl@marvell.com>
7  *
8  * This file is licensed under GPLv2.
9  *
10  * This program is free software; you can redistribute it and/or
11  * modify it under the terms of the GNU General Public License as
12  * published by the Free Software Foundation; version 2 of the
13  * License.
14  *
15  * This program is distributed in the hope that it will be useful,
16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
18  * General Public License for more details.
19  *
20  * You should have received a copy of the GNU General Public License
21  * along with this program; if not, write to the Free Software
22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
23  * USA
24 */
25
26
27 #include "mv_sas.h"
28
29 static int lldd_max_execute_num = 1;
30 module_param_named(collector, lldd_max_execute_num, int, S_IRUGO);
31 MODULE_PARM_DESC(collector, "\n"
32         "\tIf greater than one, tells the SAS Layer to run in Task Collector\n"
33         "\tMode.  If 1 or 0, tells the SAS Layer to run in Direct Mode.\n"
34         "\tThe mvsas SAS LLDD supports both modes.\n"
35         "\tDefault: 1 (Direct Mode).\n");
36
37 int interrupt_coalescing = 0x80;
38
39 static struct scsi_transport_template *mvs_stt;
40 struct kmem_cache *mvs_task_list_cache;
41 static const struct mvs_chip_info mvs_chips[] = {
42         [chip_6320] =   { 1, 2, 0x400, 17, 16, 6,  9, &mvs_64xx_dispatch, },
43         [chip_6440] =   { 1, 4, 0x400, 17, 16, 6,  9, &mvs_64xx_dispatch, },
44         [chip_6485] =   { 1, 8, 0x800, 33, 32, 6, 10, &mvs_64xx_dispatch, },
45         [chip_9180] =   { 2, 4, 0x800, 17, 64, 8,  9, &mvs_94xx_dispatch, },
46         [chip_9480] =   { 2, 4, 0x800, 17, 64, 8,  9, &mvs_94xx_dispatch, },
47         [chip_9445] =   { 1, 4, 0x800, 17, 64, 8, 11, &mvs_94xx_dispatch, },
48         [chip_9485] =   { 2, 4, 0x800, 17, 64, 8, 11, &mvs_94xx_dispatch, },
49         [chip_1300] =   { 1, 4, 0x400, 17, 16, 6,  9, &mvs_64xx_dispatch, },
50         [chip_1320] =   { 2, 4, 0x800, 17, 64, 8,  9, &mvs_94xx_dispatch, },
51 };
52
53 struct device_attribute *mvst_host_attrs[];
54
55 #define SOC_SAS_NUM 2
56
57 static struct scsi_host_template mvs_sht = {
58         .module                 = THIS_MODULE,
59         .name                   = DRV_NAME,
60         .queuecommand           = sas_queuecommand,
61         .target_alloc           = sas_target_alloc,
62         .slave_configure        = sas_slave_configure,
63         .scan_finished          = mvs_scan_finished,
64         .scan_start             = mvs_scan_start,
65         .change_queue_depth     = sas_change_queue_depth,
66         .change_queue_type      = sas_change_queue_type,
67         .bios_param             = sas_bios_param,
68         .can_queue              = 1,
69         .cmd_per_lun            = 1,
70         .this_id                = -1,
71         .sg_tablesize           = SG_ALL,
72         .max_sectors            = SCSI_DEFAULT_MAX_SECTORS,
73         .use_clustering         = ENABLE_CLUSTERING,
74         .eh_device_reset_handler = sas_eh_device_reset_handler,
75         .eh_bus_reset_handler   = sas_eh_bus_reset_handler,
76         .slave_alloc            = sas_slave_alloc,
77         .target_destroy         = sas_target_destroy,
78         .ioctl                  = sas_ioctl,
79         .shost_attrs            = mvst_host_attrs,
80 };
81
82 static struct sas_domain_function_template mvs_transport_ops = {
83         .lldd_dev_found         = mvs_dev_found,
84         .lldd_dev_gone          = mvs_dev_gone,
85         .lldd_execute_task      = mvs_queue_command,
86         .lldd_control_phy       = mvs_phy_control,
87
88         .lldd_abort_task        = mvs_abort_task,
89         .lldd_abort_task_set    = mvs_abort_task_set,
90         .lldd_clear_aca         = mvs_clear_aca,
91         .lldd_clear_task_set    = mvs_clear_task_set,
92         .lldd_I_T_nexus_reset   = mvs_I_T_nexus_reset,
93         .lldd_lu_reset          = mvs_lu_reset,
94         .lldd_query_task        = mvs_query_task,
95         .lldd_port_formed       = mvs_port_formed,
96         .lldd_port_deformed     = mvs_port_deformed,
97
98 };
99
100 static void __devinit mvs_phy_init(struct mvs_info *mvi, int phy_id)
101 {
102         struct mvs_phy *phy = &mvi->phy[phy_id];
103         struct asd_sas_phy *sas_phy = &phy->sas_phy;
104
105         phy->mvi = mvi;
106         phy->port = NULL;
107         init_timer(&phy->timer);
108         sas_phy->enabled = (phy_id < mvi->chip->n_phy) ? 1 : 0;
109         sas_phy->class = SAS;
110         sas_phy->iproto = SAS_PROTOCOL_ALL;
111         sas_phy->tproto = 0;
112         sas_phy->type = PHY_TYPE_PHYSICAL;
113         sas_phy->role = PHY_ROLE_INITIATOR;
114         sas_phy->oob_mode = OOB_NOT_CONNECTED;
115         sas_phy->linkrate = SAS_LINK_RATE_UNKNOWN;
116
117         sas_phy->id = phy_id;
118         sas_phy->sas_addr = &mvi->sas_addr[0];
119         sas_phy->frame_rcvd = &phy->frame_rcvd[0];
120         sas_phy->ha = (struct sas_ha_struct *)mvi->shost->hostdata;
121         sas_phy->lldd_phy = phy;
122 }
123
124 static void mvs_free(struct mvs_info *mvi)
125 {
126         struct mvs_wq *mwq;
127         int slot_nr;
128
129         if (!mvi)
130                 return;
131
132         if (mvi->flags & MVF_FLAG_SOC)
133                 slot_nr = MVS_SOC_SLOTS;
134         else
135                 slot_nr = MVS_CHIP_SLOT_SZ;
136
137         if (mvi->dma_pool)
138                 pci_pool_destroy(mvi->dma_pool);
139
140         if (mvi->tx)
141                 dma_free_coherent(mvi->dev,
142                                   sizeof(*mvi->tx) * MVS_CHIP_SLOT_SZ,
143                                   mvi->tx, mvi->tx_dma);
144         if (mvi->rx_fis)
145                 dma_free_coherent(mvi->dev, MVS_RX_FISL_SZ,
146                                   mvi->rx_fis, mvi->rx_fis_dma);
147         if (mvi->rx)
148                 dma_free_coherent(mvi->dev,
149                                   sizeof(*mvi->rx) * (MVS_RX_RING_SZ + 1),
150                                   mvi->rx, mvi->rx_dma);
151         if (mvi->slot)
152                 dma_free_coherent(mvi->dev,
153                                   sizeof(*mvi->slot) * slot_nr,
154                                   mvi->slot, mvi->slot_dma);
155
156         if (mvi->bulk_buffer)
157                 dma_free_coherent(mvi->dev, TRASH_BUCKET_SIZE,
158                                   mvi->bulk_buffer, mvi->bulk_buffer_dma);
159         if (mvi->bulk_buffer1)
160                 dma_free_coherent(mvi->dev, TRASH_BUCKET_SIZE,
161                                   mvi->bulk_buffer1, mvi->bulk_buffer_dma1);
162
163         MVS_CHIP_DISP->chip_iounmap(mvi);
164         if (mvi->shost)
165                 scsi_host_put(mvi->shost);
166         list_for_each_entry(mwq, &mvi->wq_list, entry)
167                 cancel_delayed_work(&mwq->work_q);
168         kfree(mvi->tags);
169         kfree(mvi);
170 }
171
172 #ifdef CONFIG_SCSI_MVSAS_TASKLET
173 static void mvs_tasklet(unsigned long opaque)
174 {
175         u32 stat;
176         u16 core_nr, i = 0;
177
178         struct mvs_info *mvi;
179         struct sas_ha_struct *sha = (struct sas_ha_struct *)opaque;
180
181         core_nr = ((struct mvs_prv_info *)sha->lldd_ha)->n_host;
182         mvi = ((struct mvs_prv_info *)sha->lldd_ha)->mvi[0];
183
184         if (unlikely(!mvi))
185                 BUG_ON(1);
186
187         stat = MVS_CHIP_DISP->isr_status(mvi, mvi->pdev->irq);
188         if (!stat)
189                 goto out;
190
191         for (i = 0; i < core_nr; i++) {
192                 mvi = ((struct mvs_prv_info *)sha->lldd_ha)->mvi[i];
193                 MVS_CHIP_DISP->isr(mvi, mvi->pdev->irq, stat);
194         }
195 out:
196         MVS_CHIP_DISP->interrupt_enable(mvi);
197
198 }
199 #endif
200
201 static irqreturn_t mvs_interrupt(int irq, void *opaque)
202 {
203         u32 core_nr;
204         u32 stat;
205         struct mvs_info *mvi;
206         struct sas_ha_struct *sha = opaque;
207 #ifndef CONFIG_SCSI_MVSAS_TASKLET
208         u32 i;
209 #endif
210
211         core_nr = ((struct mvs_prv_info *)sha->lldd_ha)->n_host;
212         mvi = ((struct mvs_prv_info *)sha->lldd_ha)->mvi[0];
213
214         if (unlikely(!mvi))
215                 return IRQ_NONE;
216 #ifdef CONFIG_SCSI_MVSAS_TASKLET
217         MVS_CHIP_DISP->interrupt_disable(mvi);
218 #endif
219
220         stat = MVS_CHIP_DISP->isr_status(mvi, irq);
221         if (!stat) {
222         #ifdef CONFIG_SCSI_MVSAS_TASKLET
223                 MVS_CHIP_DISP->interrupt_enable(mvi);
224         #endif
225                 return IRQ_NONE;
226         }
227
228 #ifdef CONFIG_SCSI_MVSAS_TASKLET
229         tasklet_schedule(&((struct mvs_prv_info *)sha->lldd_ha)->mv_tasklet);
230 #else
231         for (i = 0; i < core_nr; i++) {
232                 mvi = ((struct mvs_prv_info *)sha->lldd_ha)->mvi[i];
233                 MVS_CHIP_DISP->isr(mvi, irq, stat);
234         }
235 #endif
236         return IRQ_HANDLED;
237 }
238
239 static int __devinit mvs_alloc(struct mvs_info *mvi, struct Scsi_Host *shost)
240 {
241         int i = 0, slot_nr;
242         char pool_name[32];
243
244         if (mvi->flags & MVF_FLAG_SOC)
245                 slot_nr = MVS_SOC_SLOTS;
246         else
247                 slot_nr = MVS_CHIP_SLOT_SZ;
248
249         spin_lock_init(&mvi->lock);
250         for (i = 0; i < mvi->chip->n_phy; i++) {
251                 mvs_phy_init(mvi, i);
252                 mvi->port[i].wide_port_phymap = 0;
253                 mvi->port[i].port_attached = 0;
254                 INIT_LIST_HEAD(&mvi->port[i].list);
255         }
256         for (i = 0; i < MVS_MAX_DEVICES; i++) {
257                 mvi->devices[i].taskfileset = MVS_ID_NOT_MAPPED;
258                 mvi->devices[i].dev_type = NO_DEVICE;
259                 mvi->devices[i].device_id = i;
260                 mvi->devices[i].dev_status = MVS_DEV_NORMAL;
261                 init_timer(&mvi->devices[i].timer);
262         }
263
264         /*
265          * alloc and init our DMA areas
266          */
267         mvi->tx = dma_alloc_coherent(mvi->dev,
268                                      sizeof(*mvi->tx) * MVS_CHIP_SLOT_SZ,
269                                      &mvi->tx_dma, GFP_KERNEL);
270         if (!mvi->tx)
271                 goto err_out;
272         memset(mvi->tx, 0, sizeof(*mvi->tx) * MVS_CHIP_SLOT_SZ);
273         mvi->rx_fis = dma_alloc_coherent(mvi->dev, MVS_RX_FISL_SZ,
274                                          &mvi->rx_fis_dma, GFP_KERNEL);
275         if (!mvi->rx_fis)
276                 goto err_out;
277         memset(mvi->rx_fis, 0, MVS_RX_FISL_SZ);
278
279         mvi->rx = dma_alloc_coherent(mvi->dev,
280                                      sizeof(*mvi->rx) * (MVS_RX_RING_SZ + 1),
281                                      &mvi->rx_dma, GFP_KERNEL);
282         if (!mvi->rx)
283                 goto err_out;
284         memset(mvi->rx, 0, sizeof(*mvi->rx) * (MVS_RX_RING_SZ + 1));
285         mvi->rx[0] = cpu_to_le32(0xfff);
286         mvi->rx_cons = 0xfff;
287
288         mvi->slot = dma_alloc_coherent(mvi->dev,
289                                        sizeof(*mvi->slot) * slot_nr,
290                                        &mvi->slot_dma, GFP_KERNEL);
291         if (!mvi->slot)
292                 goto err_out;
293         memset(mvi->slot, 0, sizeof(*mvi->slot) * slot_nr);
294
295         mvi->bulk_buffer = dma_alloc_coherent(mvi->dev,
296                                        TRASH_BUCKET_SIZE,
297                                        &mvi->bulk_buffer_dma, GFP_KERNEL);
298         if (!mvi->bulk_buffer)
299                 goto err_out;
300
301         mvi->bulk_buffer1 = dma_alloc_coherent(mvi->dev,
302                                        TRASH_BUCKET_SIZE,
303                                        &mvi->bulk_buffer_dma1, GFP_KERNEL);
304         if (!mvi->bulk_buffer1)
305                 goto err_out;
306
307         sprintf(pool_name, "%s%d", "mvs_dma_pool", mvi->id);
308         mvi->dma_pool = pci_pool_create(pool_name, mvi->pdev, MVS_SLOT_BUF_SZ, 16, 0);
309         if (!mvi->dma_pool) {
310                         printk(KERN_DEBUG "failed to create dma pool %s.\n", pool_name);
311                         goto err_out;
312         }
313         mvi->tags_num = slot_nr;
314
315         /* Initialize tags */
316         mvs_tag_init(mvi);
317         return 0;
318 err_out:
319         return 1;
320 }
321
322
323 int mvs_ioremap(struct mvs_info *mvi, int bar, int bar_ex)
324 {
325         unsigned long res_start, res_len, res_flag, res_flag_ex = 0;
326         struct pci_dev *pdev = mvi->pdev;
327         if (bar_ex != -1) {
328                 /*
329                  * ioremap main and peripheral registers
330                  */
331                 res_start = pci_resource_start(pdev, bar_ex);
332                 res_len = pci_resource_len(pdev, bar_ex);
333                 if (!res_start || !res_len)
334                         goto err_out;
335
336                 res_flag_ex = pci_resource_flags(pdev, bar_ex);
337                 if (res_flag_ex & IORESOURCE_MEM) {
338                         if (res_flag_ex & IORESOURCE_CACHEABLE)
339                                 mvi->regs_ex = ioremap(res_start, res_len);
340                         else
341                                 mvi->regs_ex = ioremap_nocache(res_start,
342                                                 res_len);
343                 } else
344                         mvi->regs_ex = (void *)res_start;
345                 if (!mvi->regs_ex)
346                         goto err_out;
347         }
348
349         res_start = pci_resource_start(pdev, bar);
350         res_len = pci_resource_len(pdev, bar);
351         if (!res_start || !res_len)
352                 goto err_out;
353
354         res_flag = pci_resource_flags(pdev, bar);
355         if (res_flag & IORESOURCE_CACHEABLE)
356                 mvi->regs = ioremap(res_start, res_len);
357         else
358                 mvi->regs = ioremap_nocache(res_start, res_len);
359
360         if (!mvi->regs) {
361                 if (mvi->regs_ex && (res_flag_ex & IORESOURCE_MEM))
362                         iounmap(mvi->regs_ex);
363                 mvi->regs_ex = NULL;
364                 goto err_out;
365         }
366
367         return 0;
368 err_out:
369         return -1;
370 }
371
372 void mvs_iounmap(void __iomem *regs)
373 {
374         iounmap(regs);
375 }
376
377 static struct mvs_info *__devinit mvs_pci_alloc(struct pci_dev *pdev,
378                                 const struct pci_device_id *ent,
379                                 struct Scsi_Host *shost, unsigned int id)
380 {
381         struct mvs_info *mvi = NULL;
382         struct sas_ha_struct *sha = SHOST_TO_SAS_HA(shost);
383
384         mvi = kzalloc(sizeof(*mvi) +
385                 (1L << mvs_chips[ent->driver_data].slot_width) *
386                 sizeof(struct mvs_slot_info), GFP_KERNEL);
387         if (!mvi)
388                 return NULL;
389
390         mvi->pdev = pdev;
391         mvi->dev = &pdev->dev;
392         mvi->chip_id = ent->driver_data;
393         mvi->chip = &mvs_chips[mvi->chip_id];
394         INIT_LIST_HEAD(&mvi->wq_list);
395
396         ((struct mvs_prv_info *)sha->lldd_ha)->mvi[id] = mvi;
397         ((struct mvs_prv_info *)sha->lldd_ha)->n_phy = mvi->chip->n_phy;
398
399         mvi->id = id;
400         mvi->sas = sha;
401         mvi->shost = shost;
402
403         mvi->tags = kzalloc(MVS_CHIP_SLOT_SZ>>3, GFP_KERNEL);
404         if (!mvi->tags)
405                 goto err_out;
406
407         if (MVS_CHIP_DISP->chip_ioremap(mvi))
408                 goto err_out;
409         if (!mvs_alloc(mvi, shost))
410                 return mvi;
411 err_out:
412         mvs_free(mvi);
413         return NULL;
414 }
415
416 static int pci_go_64(struct pci_dev *pdev)
417 {
418         int rc;
419
420         if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64))) {
421                 rc = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64));
422                 if (rc) {
423                         rc = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32));
424                         if (rc) {
425                                 dev_printk(KERN_ERR, &pdev->dev,
426                                            "64-bit DMA enable failed\n");
427                                 return rc;
428                         }
429                 }
430         } else {
431                 rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
432                 if (rc) {
433                         dev_printk(KERN_ERR, &pdev->dev,
434                                    "32-bit DMA enable failed\n");
435                         return rc;
436                 }
437                 rc = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32));
438                 if (rc) {
439                         dev_printk(KERN_ERR, &pdev->dev,
440                                    "32-bit consistent DMA enable failed\n");
441                         return rc;
442                 }
443         }
444
445         return rc;
446 }
447
448 static int __devinit mvs_prep_sas_ha_init(struct Scsi_Host *shost,
449                                 const struct mvs_chip_info *chip_info)
450 {
451         int phy_nr, port_nr; unsigned short core_nr;
452         struct asd_sas_phy **arr_phy;
453         struct asd_sas_port **arr_port;
454         struct sas_ha_struct *sha = SHOST_TO_SAS_HA(shost);
455
456         core_nr = chip_info->n_host;
457         phy_nr  = core_nr * chip_info->n_phy;
458         port_nr = phy_nr;
459
460         memset(sha, 0x00, sizeof(struct sas_ha_struct));
461         arr_phy  = kcalloc(phy_nr, sizeof(void *), GFP_KERNEL);
462         arr_port = kcalloc(port_nr, sizeof(void *), GFP_KERNEL);
463         if (!arr_phy || !arr_port)
464                 goto exit_free;
465
466         sha->sas_phy = arr_phy;
467         sha->sas_port = arr_port;
468         sha->core.shost = shost;
469
470         sha->lldd_ha = kzalloc(sizeof(struct mvs_prv_info), GFP_KERNEL);
471         if (!sha->lldd_ha)
472                 goto exit_free;
473
474         ((struct mvs_prv_info *)sha->lldd_ha)->n_host = core_nr;
475
476         shost->transportt = mvs_stt;
477         shost->max_id = MVS_MAX_DEVICES;
478         shost->max_lun = ~0;
479         shost->max_channel = 1;
480         shost->max_cmd_len = 16;
481
482         return 0;
483 exit_free:
484         kfree(arr_phy);
485         kfree(arr_port);
486         return -1;
487
488 }
489
490 static void  __devinit mvs_post_sas_ha_init(struct Scsi_Host *shost,
491                         const struct mvs_chip_info *chip_info)
492 {
493         int can_queue, i = 0, j = 0;
494         struct mvs_info *mvi = NULL;
495         struct sas_ha_struct *sha = SHOST_TO_SAS_HA(shost);
496         unsigned short nr_core = ((struct mvs_prv_info *)sha->lldd_ha)->n_host;
497
498         for (j = 0; j < nr_core; j++) {
499                 mvi = ((struct mvs_prv_info *)sha->lldd_ha)->mvi[j];
500                 for (i = 0; i < chip_info->n_phy; i++) {
501                         sha->sas_phy[j * chip_info->n_phy  + i] =
502                                 &mvi->phy[i].sas_phy;
503                         sha->sas_port[j * chip_info->n_phy + i] =
504                                 &mvi->port[i].sas_port;
505                 }
506         }
507
508         sha->sas_ha_name = DRV_NAME;
509         sha->dev = mvi->dev;
510         sha->lldd_module = THIS_MODULE;
511         sha->sas_addr = &mvi->sas_addr[0];
512
513         sha->num_phys = nr_core * chip_info->n_phy;
514
515         sha->lldd_max_execute_num = lldd_max_execute_num;
516
517         if (mvi->flags & MVF_FLAG_SOC)
518                 can_queue = MVS_SOC_CAN_QUEUE;
519         else
520                 can_queue = MVS_CHIP_SLOT_SZ;
521
522         sha->lldd_queue_size = can_queue;
523         shost->sg_tablesize = min_t(u16, SG_ALL, MVS_MAX_SG);
524         shost->can_queue = can_queue;
525         mvi->shost->cmd_per_lun = MVS_QUEUE_SIZE;
526         sha->core.shost = mvi->shost;
527 }
528
529 static void mvs_init_sas_add(struct mvs_info *mvi)
530 {
531         u8 i;
532         for (i = 0; i < mvi->chip->n_phy; i++) {
533                 mvi->phy[i].dev_sas_addr = 0x5005043011ab0000ULL;
534                 mvi->phy[i].dev_sas_addr =
535                         cpu_to_be64((u64)(*(u64 *)&mvi->phy[i].dev_sas_addr));
536         }
537
538         memcpy(mvi->sas_addr, &mvi->phy[0].dev_sas_addr, SAS_ADDR_SIZE);
539 }
540
541 static int __devinit mvs_pci_init(struct pci_dev *pdev,
542                                   const struct pci_device_id *ent)
543 {
544         unsigned int rc, nhost = 0;
545         struct mvs_info *mvi;
546         struct mvs_prv_info *mpi;
547         irq_handler_t irq_handler = mvs_interrupt;
548         struct Scsi_Host *shost = NULL;
549         const struct mvs_chip_info *chip;
550
551         dev_printk(KERN_INFO, &pdev->dev,
552                 "mvsas: driver version %s\n", DRV_VERSION);
553         rc = pci_enable_device(pdev);
554         if (rc)
555                 goto err_out_enable;
556
557         pci_set_master(pdev);
558
559         rc = pci_request_regions(pdev, DRV_NAME);
560         if (rc)
561                 goto err_out_disable;
562
563         rc = pci_go_64(pdev);
564         if (rc)
565                 goto err_out_regions;
566
567         shost = scsi_host_alloc(&mvs_sht, sizeof(void *));
568         if (!shost) {
569                 rc = -ENOMEM;
570                 goto err_out_regions;
571         }
572
573         chip = &mvs_chips[ent->driver_data];
574         SHOST_TO_SAS_HA(shost) =
575                 kcalloc(1, sizeof(struct sas_ha_struct), GFP_KERNEL);
576         if (!SHOST_TO_SAS_HA(shost)) {
577                 kfree(shost);
578                 rc = -ENOMEM;
579                 goto err_out_regions;
580         }
581
582         rc = mvs_prep_sas_ha_init(shost, chip);
583         if (rc) {
584                 kfree(shost);
585                 rc = -ENOMEM;
586                 goto err_out_regions;
587         }
588
589         pci_set_drvdata(pdev, SHOST_TO_SAS_HA(shost));
590
591         do {
592                 mvi = mvs_pci_alloc(pdev, ent, shost, nhost);
593                 if (!mvi) {
594                         rc = -ENOMEM;
595                         goto err_out_regions;
596                 }
597
598                 memset(&mvi->hba_info_param, 0xFF,
599                         sizeof(struct hba_info_page));
600
601                 mvs_init_sas_add(mvi);
602
603                 mvi->instance = nhost;
604                 rc = MVS_CHIP_DISP->chip_init(mvi);
605                 if (rc) {
606                         mvs_free(mvi);
607                         goto err_out_regions;
608                 }
609                 nhost++;
610         } while (nhost < chip->n_host);
611         mpi = (struct mvs_prv_info *)(SHOST_TO_SAS_HA(shost)->lldd_ha);
612 #ifdef CONFIG_SCSI_MVSAS_TASKLET
613         tasklet_init(&(mpi->mv_tasklet), mvs_tasklet,
614                      (unsigned long)SHOST_TO_SAS_HA(shost));
615 #endif
616
617         mvs_post_sas_ha_init(shost, chip);
618
619         rc = scsi_add_host(shost, &pdev->dev);
620         if (rc)
621                 goto err_out_shost;
622
623         rc = sas_register_ha(SHOST_TO_SAS_HA(shost));
624         if (rc)
625                 goto err_out_shost;
626         rc = request_irq(pdev->irq, irq_handler, IRQF_SHARED,
627                 DRV_NAME, SHOST_TO_SAS_HA(shost));
628         if (rc)
629                 goto err_not_sas;
630
631         MVS_CHIP_DISP->interrupt_enable(mvi);
632
633         scsi_scan_host(mvi->shost);
634
635         return 0;
636
637 err_not_sas:
638         sas_unregister_ha(SHOST_TO_SAS_HA(shost));
639 err_out_shost:
640         scsi_remove_host(mvi->shost);
641 err_out_regions:
642         pci_release_regions(pdev);
643 err_out_disable:
644         pci_disable_device(pdev);
645 err_out_enable:
646         return rc;
647 }
648
649 static void __devexit mvs_pci_remove(struct pci_dev *pdev)
650 {
651         unsigned short core_nr, i = 0;
652         struct sas_ha_struct *sha = pci_get_drvdata(pdev);
653         struct mvs_info *mvi = NULL;
654
655         core_nr = ((struct mvs_prv_info *)sha->lldd_ha)->n_host;
656         mvi = ((struct mvs_prv_info *)sha->lldd_ha)->mvi[0];
657
658 #ifdef CONFIG_SCSI_MVSAS_TASKLET
659         tasklet_kill(&((struct mvs_prv_info *)sha->lldd_ha)->mv_tasklet);
660 #endif
661
662         pci_set_drvdata(pdev, NULL);
663         sas_unregister_ha(sha);
664         sas_remove_host(mvi->shost);
665         scsi_remove_host(mvi->shost);
666
667         MVS_CHIP_DISP->interrupt_disable(mvi);
668         free_irq(mvi->pdev->irq, sha);
669         for (i = 0; i < core_nr; i++) {
670                 mvi = ((struct mvs_prv_info *)sha->lldd_ha)->mvi[i];
671                 mvs_free(mvi);
672         }
673         kfree(sha->sas_phy);
674         kfree(sha->sas_port);
675         kfree(sha);
676         pci_release_regions(pdev);
677         pci_disable_device(pdev);
678         return;
679 }
680
681 static struct pci_device_id __devinitdata mvs_pci_table[] = {
682         { PCI_VDEVICE(MARVELL, 0x6320), chip_6320 },
683         { PCI_VDEVICE(MARVELL, 0x6340), chip_6440 },
684         {
685                 .vendor         = PCI_VENDOR_ID_MARVELL,
686                 .device         = 0x6440,
687                 .subvendor      = PCI_ANY_ID,
688                 .subdevice      = 0x6480,
689                 .class          = 0,
690                 .class_mask     = 0,
691                 .driver_data    = chip_6485,
692         },
693         { PCI_VDEVICE(MARVELL, 0x6440), chip_6440 },
694         { PCI_VDEVICE(MARVELL, 0x6485), chip_6485 },
695         { PCI_VDEVICE(MARVELL, 0x9480), chip_9480 },
696         { PCI_VDEVICE(MARVELL, 0x9180), chip_9180 },
697         { PCI_VDEVICE(ARECA, PCI_DEVICE_ID_ARECA_1300), chip_1300 },
698         { PCI_VDEVICE(ARECA, PCI_DEVICE_ID_ARECA_1320), chip_1320 },
699         { PCI_VDEVICE(ADAPTEC2, 0x0450), chip_6440 },
700         { PCI_VDEVICE(TTI, 0x2710), chip_9480 },
701         { PCI_VDEVICE(TTI, 0x2720), chip_9480 },
702         { PCI_VDEVICE(TTI, 0x2721), chip_9480 },
703         { PCI_VDEVICE(TTI, 0x2722), chip_9480 },
704         { PCI_VDEVICE(TTI, 0x2740), chip_9480 },
705         { PCI_VDEVICE(TTI, 0x2744), chip_9480 },
706         { PCI_VDEVICE(TTI, 0x2760), chip_9480 },
707         {
708                 .vendor         = 0x1b4b,
709                 .device         = 0x9480,
710                 .subvendor      = PCI_ANY_ID,
711                 .subdevice      = 0x9480,
712                 .class          = 0,
713                 .class_mask     = 0,
714                 .driver_data    = chip_9480,
715         },
716         {
717                 .vendor         = 0x1b4b,
718                 .device         = 0x9445,
719                 .subvendor      = PCI_ANY_ID,
720                 .subdevice      = 0x9480,
721                 .class          = 0,
722                 .class_mask     = 0,
723                 .driver_data    = chip_9445,
724         },
725         {
726                 .vendor         = 0x1b4b,
727                 .device         = 0x9485,
728                 .subvendor      = PCI_ANY_ID,
729                 .subdevice      = 0x9480,
730                 .class          = 0,
731                 .class_mask     = 0,
732                 .driver_data    = chip_9485,
733         },
734         { PCI_VDEVICE(OCZ, 0x1021), chip_9485}, /* OCZ RevoDrive3 */
735         { PCI_VDEVICE(OCZ, 0x1022), chip_9485}, /* OCZ RevoDrive3/zDriveR4 (exact model unknown) */
736         { PCI_VDEVICE(OCZ, 0x1040), chip_9485}, /* OCZ RevoDrive3/zDriveR4 (exact model unknown) */
737         { PCI_VDEVICE(OCZ, 0x1041), chip_9485}, /* OCZ RevoDrive3/zDriveR4 (exact model unknown) */
738         { PCI_VDEVICE(OCZ, 0x1042), chip_9485}, /* OCZ RevoDrive3/zDriveR4 (exact model unknown) */
739         { PCI_VDEVICE(OCZ, 0x1043), chip_9485}, /* OCZ RevoDrive3/zDriveR4 (exact model unknown) */
740         { PCI_VDEVICE(OCZ, 0x1044), chip_9485}, /* OCZ RevoDrive3/zDriveR4 (exact model unknown) */
741         { PCI_VDEVICE(OCZ, 0x1080), chip_9485}, /* OCZ RevoDrive3/zDriveR4 (exact model unknown) */
742         { PCI_VDEVICE(OCZ, 0x1083), chip_9485}, /* OCZ RevoDrive3/zDriveR4 (exact model unknown) */
743         { PCI_VDEVICE(OCZ, 0x1084), chip_9485}, /* OCZ RevoDrive3/zDriveR4 (exact model unknown) */
744
745         { }     /* terminate list */
746 };
747
748 static struct pci_driver mvs_pci_driver = {
749         .name           = DRV_NAME,
750         .id_table       = mvs_pci_table,
751         .probe          = mvs_pci_init,
752         .remove         = __devexit_p(mvs_pci_remove),
753 };
754
755 static ssize_t
756 mvs_show_driver_version(struct device *cdev,
757                 struct device_attribute *attr,  char *buffer)
758 {
759         return snprintf(buffer, PAGE_SIZE, "%s\n", DRV_VERSION);
760 }
761
762 static DEVICE_ATTR(driver_version,
763                          S_IRUGO,
764                          mvs_show_driver_version,
765                          NULL);
766
767 static ssize_t
768 mvs_store_interrupt_coalescing(struct device *cdev,
769                         struct device_attribute *attr,
770                         const char *buffer, size_t size)
771 {
772         int val = 0;
773         struct mvs_info *mvi = NULL;
774         struct Scsi_Host *shost = class_to_shost(cdev);
775         struct sas_ha_struct *sha = SHOST_TO_SAS_HA(shost);
776         u8 i, core_nr;
777         if (buffer == NULL)
778                 return size;
779
780         if (sscanf(buffer, "%d", &val) != 1)
781                 return -EINVAL;
782
783         if (val >= 0x10000) {
784                 mv_dprintk("interrupt coalescing timer %d us is"
785                         "too long\n", val);
786                 return strlen(buffer);
787         }
788
789         interrupt_coalescing = val;
790
791         core_nr = ((struct mvs_prv_info *)sha->lldd_ha)->n_host;
792         mvi = ((struct mvs_prv_info *)sha->lldd_ha)->mvi[0];
793
794         if (unlikely(!mvi))
795                 return -EINVAL;
796
797         for (i = 0; i < core_nr; i++) {
798                 mvi = ((struct mvs_prv_info *)sha->lldd_ha)->mvi[i];
799                 if (MVS_CHIP_DISP->tune_interrupt)
800                         MVS_CHIP_DISP->tune_interrupt(mvi,
801                                 interrupt_coalescing);
802         }
803         mv_dprintk("set interrupt coalescing time to %d us\n",
804                 interrupt_coalescing);
805         return strlen(buffer);
806 }
807
808 static ssize_t mvs_show_interrupt_coalescing(struct device *cdev,
809                         struct device_attribute *attr, char *buffer)
810 {
811         return snprintf(buffer, PAGE_SIZE, "%d\n", interrupt_coalescing);
812 }
813
814 static DEVICE_ATTR(interrupt_coalescing,
815                          S_IRUGO|S_IWUSR,
816                          mvs_show_interrupt_coalescing,
817                          mvs_store_interrupt_coalescing);
818
819 /* task handler */
820 struct task_struct *mvs_th;
821 static int __init mvs_init(void)
822 {
823         int rc;
824         mvs_stt = sas_domain_attach_transport(&mvs_transport_ops);
825         if (!mvs_stt)
826                 return -ENOMEM;
827
828         mvs_task_list_cache = kmem_cache_create("mvs_task_list", sizeof(struct mvs_task_list),
829                                                          0, SLAB_HWCACHE_ALIGN, NULL);
830         if (!mvs_task_list_cache) {
831                 rc = -ENOMEM;
832                 mv_printk("%s: mvs_task_list_cache alloc failed! \n", __func__);
833                 goto err_out;
834         }
835
836         rc = pci_register_driver(&mvs_pci_driver);
837
838         if (rc)
839                 goto err_out;
840
841         return 0;
842
843 err_out:
844         sas_release_transport(mvs_stt);
845         return rc;
846 }
847
848 static void __exit mvs_exit(void)
849 {
850         pci_unregister_driver(&mvs_pci_driver);
851         sas_release_transport(mvs_stt);
852         kmem_cache_destroy(mvs_task_list_cache);
853 }
854
855 struct device_attribute *mvst_host_attrs[] = {
856         &dev_attr_driver_version,
857         &dev_attr_interrupt_coalescing,
858         NULL,
859 };
860
861 module_init(mvs_init);
862 module_exit(mvs_exit);
863
864 MODULE_AUTHOR("Jeff Garzik <jgarzik@pobox.com>");
865 MODULE_DESCRIPTION("Marvell 88SE6440 SAS/SATA controller driver");
866 MODULE_VERSION(DRV_VERSION);
867 MODULE_LICENSE("GPL");
868 #ifdef CONFIG_PCI
869 MODULE_DEVICE_TABLE(pci, mvs_pci_table);
870 #endif