18c2ecf20Sopenharmony_ci/* 28c2ecf20Sopenharmony_ci******************************************************************************* 38c2ecf20Sopenharmony_ci** O.S : Linux 48c2ecf20Sopenharmony_ci** FILE NAME : arcmsr_hba.c 58c2ecf20Sopenharmony_ci** BY : Nick Cheng, C.L. Huang 68c2ecf20Sopenharmony_ci** Description: SCSI RAID Device Driver for Areca RAID Controller 78c2ecf20Sopenharmony_ci******************************************************************************* 88c2ecf20Sopenharmony_ci** Copyright (C) 2002 - 2014, Areca Technology Corporation All rights reserved 98c2ecf20Sopenharmony_ci** 108c2ecf20Sopenharmony_ci** Web site: www.areca.com.tw 118c2ecf20Sopenharmony_ci** E-mail: support@areca.com.tw 128c2ecf20Sopenharmony_ci** 138c2ecf20Sopenharmony_ci** This program is free software; you can redistribute it and/or modify 148c2ecf20Sopenharmony_ci** it under the terms of the GNU General Public License version 2 as 158c2ecf20Sopenharmony_ci** published by the Free Software Foundation. 168c2ecf20Sopenharmony_ci** This program is distributed in the hope that it will be useful, 178c2ecf20Sopenharmony_ci** but WITHOUT ANY WARRANTY; without even the implied warranty of 188c2ecf20Sopenharmony_ci** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 198c2ecf20Sopenharmony_ci** GNU General Public License for more details. 208c2ecf20Sopenharmony_ci******************************************************************************* 218c2ecf20Sopenharmony_ci** Redistribution and use in source and binary forms, with or without 228c2ecf20Sopenharmony_ci** modification, are permitted provided that the following conditions 238c2ecf20Sopenharmony_ci** are met: 248c2ecf20Sopenharmony_ci** 1. Redistributions of source code must retain the above copyright 258c2ecf20Sopenharmony_ci** notice, this list of conditions and the following disclaimer. 268c2ecf20Sopenharmony_ci** 2. Redistributions in binary form must reproduce the above copyright 278c2ecf20Sopenharmony_ci** notice, this list of conditions and the following disclaimer in the 288c2ecf20Sopenharmony_ci** documentation and/or other materials provided with the distribution. 298c2ecf20Sopenharmony_ci** 3. The name of the author may not be used to endorse or promote products 308c2ecf20Sopenharmony_ci** derived from this software without specific prior written permission. 318c2ecf20Sopenharmony_ci** 328c2ecf20Sopenharmony_ci** THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 338c2ecf20Sopenharmony_ci** IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 348c2ecf20Sopenharmony_ci** OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 358c2ecf20Sopenharmony_ci** IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 368c2ecf20Sopenharmony_ci** INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES(INCLUDING,BUT 378c2ecf20Sopenharmony_ci** NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 388c2ecf20Sopenharmony_ci** DATA, OR PROFITS; OR BUSINESS INTERRUPTION)HOWEVER CAUSED AND ON ANY 398c2ecf20Sopenharmony_ci** THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 408c2ecf20Sopenharmony_ci** (INCLUDING NEGLIGENCE OR OTHERWISE)ARISING IN ANY WAY OUT OF THE USE OF 418c2ecf20Sopenharmony_ci** THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 428c2ecf20Sopenharmony_ci******************************************************************************* 438c2ecf20Sopenharmony_ci** For history of changes, see Documentation/scsi/ChangeLog.arcmsr 448c2ecf20Sopenharmony_ci** Firmware Specification, see Documentation/scsi/arcmsr_spec.rst 458c2ecf20Sopenharmony_ci******************************************************************************* 468c2ecf20Sopenharmony_ci*/ 478c2ecf20Sopenharmony_ci#include <linux/module.h> 488c2ecf20Sopenharmony_ci#include <linux/reboot.h> 498c2ecf20Sopenharmony_ci#include <linux/spinlock.h> 508c2ecf20Sopenharmony_ci#include <linux/pci_ids.h> 518c2ecf20Sopenharmony_ci#include <linux/interrupt.h> 528c2ecf20Sopenharmony_ci#include <linux/moduleparam.h> 538c2ecf20Sopenharmony_ci#include <linux/errno.h> 548c2ecf20Sopenharmony_ci#include <linux/types.h> 558c2ecf20Sopenharmony_ci#include <linux/delay.h> 568c2ecf20Sopenharmony_ci#include <linux/dma-mapping.h> 578c2ecf20Sopenharmony_ci#include <linux/timer.h> 588c2ecf20Sopenharmony_ci#include <linux/slab.h> 598c2ecf20Sopenharmony_ci#include <linux/pci.h> 608c2ecf20Sopenharmony_ci#include <linux/aer.h> 618c2ecf20Sopenharmony_ci#include <linux/circ_buf.h> 628c2ecf20Sopenharmony_ci#include <asm/dma.h> 638c2ecf20Sopenharmony_ci#include <asm/io.h> 648c2ecf20Sopenharmony_ci#include <linux/uaccess.h> 658c2ecf20Sopenharmony_ci#include <scsi/scsi_host.h> 668c2ecf20Sopenharmony_ci#include <scsi/scsi.h> 678c2ecf20Sopenharmony_ci#include <scsi/scsi_cmnd.h> 688c2ecf20Sopenharmony_ci#include <scsi/scsi_tcq.h> 698c2ecf20Sopenharmony_ci#include <scsi/scsi_device.h> 708c2ecf20Sopenharmony_ci#include <scsi/scsi_transport.h> 718c2ecf20Sopenharmony_ci#include <scsi/scsicam.h> 728c2ecf20Sopenharmony_ci#include "arcmsr.h" 738c2ecf20Sopenharmony_ciMODULE_AUTHOR("Nick Cheng, C.L. Huang <support@areca.com.tw>"); 748c2ecf20Sopenharmony_ciMODULE_DESCRIPTION("Areca ARC11xx/12xx/16xx/188x SAS/SATA RAID Controller Driver"); 758c2ecf20Sopenharmony_ciMODULE_LICENSE("Dual BSD/GPL"); 768c2ecf20Sopenharmony_ciMODULE_VERSION(ARCMSR_DRIVER_VERSION); 778c2ecf20Sopenharmony_ci 788c2ecf20Sopenharmony_cistatic int msix_enable = 1; 798c2ecf20Sopenharmony_cimodule_param(msix_enable, int, S_IRUGO); 808c2ecf20Sopenharmony_ciMODULE_PARM_DESC(msix_enable, "Enable MSI-X interrupt(0 ~ 1), msix_enable=1(enable), =0(disable)"); 818c2ecf20Sopenharmony_ci 828c2ecf20Sopenharmony_cistatic int msi_enable = 1; 838c2ecf20Sopenharmony_cimodule_param(msi_enable, int, S_IRUGO); 848c2ecf20Sopenharmony_ciMODULE_PARM_DESC(msi_enable, "Enable MSI interrupt(0 ~ 1), msi_enable=1(enable), =0(disable)"); 858c2ecf20Sopenharmony_ci 868c2ecf20Sopenharmony_cistatic int host_can_queue = ARCMSR_DEFAULT_OUTSTANDING_CMD; 878c2ecf20Sopenharmony_cimodule_param(host_can_queue, int, S_IRUGO); 888c2ecf20Sopenharmony_ciMODULE_PARM_DESC(host_can_queue, " adapter queue depth(32 ~ 1024), default is 128"); 898c2ecf20Sopenharmony_ci 908c2ecf20Sopenharmony_cistatic int cmd_per_lun = ARCMSR_DEFAULT_CMD_PERLUN; 918c2ecf20Sopenharmony_cimodule_param(cmd_per_lun, int, S_IRUGO); 928c2ecf20Sopenharmony_ciMODULE_PARM_DESC(cmd_per_lun, " device queue depth(1 ~ 128), default is 32"); 938c2ecf20Sopenharmony_ci 948c2ecf20Sopenharmony_cistatic int dma_mask_64 = 0; 958c2ecf20Sopenharmony_cimodule_param(dma_mask_64, int, S_IRUGO); 968c2ecf20Sopenharmony_ciMODULE_PARM_DESC(dma_mask_64, " set DMA mask to 64 bits(0 ~ 1), dma_mask_64=1(64 bits), =0(32 bits)"); 978c2ecf20Sopenharmony_ci 988c2ecf20Sopenharmony_cistatic int set_date_time = 0; 998c2ecf20Sopenharmony_cimodule_param(set_date_time, int, S_IRUGO); 1008c2ecf20Sopenharmony_ciMODULE_PARM_DESC(set_date_time, " send date, time to iop(0 ~ 1), set_date_time=1(enable), default(=0) is disable"); 1018c2ecf20Sopenharmony_ci 1028c2ecf20Sopenharmony_ci#define ARCMSR_SLEEPTIME 10 1038c2ecf20Sopenharmony_ci#define ARCMSR_RETRYCOUNT 12 1048c2ecf20Sopenharmony_ci 1058c2ecf20Sopenharmony_cistatic wait_queue_head_t wait_q; 1068c2ecf20Sopenharmony_cistatic int arcmsr_iop_message_xfer(struct AdapterControlBlock *acb, 1078c2ecf20Sopenharmony_ci struct scsi_cmnd *cmd); 1088c2ecf20Sopenharmony_cistatic int arcmsr_iop_confirm(struct AdapterControlBlock *acb); 1098c2ecf20Sopenharmony_cistatic int arcmsr_abort(struct scsi_cmnd *); 1108c2ecf20Sopenharmony_cistatic int arcmsr_bus_reset(struct scsi_cmnd *); 1118c2ecf20Sopenharmony_cistatic int arcmsr_bios_param(struct scsi_device *sdev, 1128c2ecf20Sopenharmony_ci struct block_device *bdev, sector_t capacity, int *info); 1138c2ecf20Sopenharmony_cistatic int arcmsr_queue_command(struct Scsi_Host *h, struct scsi_cmnd *cmd); 1148c2ecf20Sopenharmony_cistatic int arcmsr_probe(struct pci_dev *pdev, 1158c2ecf20Sopenharmony_ci const struct pci_device_id *id); 1168c2ecf20Sopenharmony_cistatic int arcmsr_suspend(struct pci_dev *pdev, pm_message_t state); 1178c2ecf20Sopenharmony_cistatic int arcmsr_resume(struct pci_dev *pdev); 1188c2ecf20Sopenharmony_cistatic void arcmsr_remove(struct pci_dev *pdev); 1198c2ecf20Sopenharmony_cistatic void arcmsr_shutdown(struct pci_dev *pdev); 1208c2ecf20Sopenharmony_cistatic void arcmsr_iop_init(struct AdapterControlBlock *acb); 1218c2ecf20Sopenharmony_cistatic void arcmsr_free_ccb_pool(struct AdapterControlBlock *acb); 1228c2ecf20Sopenharmony_cistatic u32 arcmsr_disable_outbound_ints(struct AdapterControlBlock *acb); 1238c2ecf20Sopenharmony_cistatic void arcmsr_enable_outbound_ints(struct AdapterControlBlock *acb, 1248c2ecf20Sopenharmony_ci u32 intmask_org); 1258c2ecf20Sopenharmony_cistatic void arcmsr_stop_adapter_bgrb(struct AdapterControlBlock *acb); 1268c2ecf20Sopenharmony_cistatic void arcmsr_hbaA_flush_cache(struct AdapterControlBlock *acb); 1278c2ecf20Sopenharmony_cistatic void arcmsr_hbaB_flush_cache(struct AdapterControlBlock *acb); 1288c2ecf20Sopenharmony_cistatic void arcmsr_request_device_map(struct timer_list *t); 1298c2ecf20Sopenharmony_cistatic void arcmsr_message_isr_bh_fn(struct work_struct *work); 1308c2ecf20Sopenharmony_cistatic bool arcmsr_get_firmware_spec(struct AdapterControlBlock *acb); 1318c2ecf20Sopenharmony_cistatic void arcmsr_start_adapter_bgrb(struct AdapterControlBlock *acb); 1328c2ecf20Sopenharmony_cistatic void arcmsr_hbaC_message_isr(struct AdapterControlBlock *pACB); 1338c2ecf20Sopenharmony_cistatic void arcmsr_hbaD_message_isr(struct AdapterControlBlock *acb); 1348c2ecf20Sopenharmony_cistatic void arcmsr_hbaE_message_isr(struct AdapterControlBlock *acb); 1358c2ecf20Sopenharmony_cistatic void arcmsr_hbaE_postqueue_isr(struct AdapterControlBlock *acb); 1368c2ecf20Sopenharmony_cistatic void arcmsr_hbaF_postqueue_isr(struct AdapterControlBlock *acb); 1378c2ecf20Sopenharmony_cistatic void arcmsr_hardware_reset(struct AdapterControlBlock *acb); 1388c2ecf20Sopenharmony_cistatic const char *arcmsr_info(struct Scsi_Host *); 1398c2ecf20Sopenharmony_cistatic irqreturn_t arcmsr_interrupt(struct AdapterControlBlock *acb); 1408c2ecf20Sopenharmony_cistatic void arcmsr_free_irq(struct pci_dev *, struct AdapterControlBlock *); 1418c2ecf20Sopenharmony_cistatic void arcmsr_wait_firmware_ready(struct AdapterControlBlock *acb); 1428c2ecf20Sopenharmony_cistatic void arcmsr_set_iop_datetime(struct timer_list *); 1438c2ecf20Sopenharmony_cistatic int arcmsr_adjust_disk_queue_depth(struct scsi_device *sdev, int queue_depth) 1448c2ecf20Sopenharmony_ci{ 1458c2ecf20Sopenharmony_ci if (queue_depth > ARCMSR_MAX_CMD_PERLUN) 1468c2ecf20Sopenharmony_ci queue_depth = ARCMSR_MAX_CMD_PERLUN; 1478c2ecf20Sopenharmony_ci return scsi_change_queue_depth(sdev, queue_depth); 1488c2ecf20Sopenharmony_ci} 1498c2ecf20Sopenharmony_ci 1508c2ecf20Sopenharmony_cistatic struct scsi_host_template arcmsr_scsi_host_template = { 1518c2ecf20Sopenharmony_ci .module = THIS_MODULE, 1528c2ecf20Sopenharmony_ci .name = "Areca SAS/SATA RAID driver", 1538c2ecf20Sopenharmony_ci .info = arcmsr_info, 1548c2ecf20Sopenharmony_ci .queuecommand = arcmsr_queue_command, 1558c2ecf20Sopenharmony_ci .eh_abort_handler = arcmsr_abort, 1568c2ecf20Sopenharmony_ci .eh_bus_reset_handler = arcmsr_bus_reset, 1578c2ecf20Sopenharmony_ci .bios_param = arcmsr_bios_param, 1588c2ecf20Sopenharmony_ci .change_queue_depth = arcmsr_adjust_disk_queue_depth, 1598c2ecf20Sopenharmony_ci .can_queue = ARCMSR_DEFAULT_OUTSTANDING_CMD, 1608c2ecf20Sopenharmony_ci .this_id = ARCMSR_SCSI_INITIATOR_ID, 1618c2ecf20Sopenharmony_ci .sg_tablesize = ARCMSR_DEFAULT_SG_ENTRIES, 1628c2ecf20Sopenharmony_ci .max_sectors = ARCMSR_MAX_XFER_SECTORS_C, 1638c2ecf20Sopenharmony_ci .cmd_per_lun = ARCMSR_DEFAULT_CMD_PERLUN, 1648c2ecf20Sopenharmony_ci .shost_attrs = arcmsr_host_attrs, 1658c2ecf20Sopenharmony_ci .no_write_same = 1, 1668c2ecf20Sopenharmony_ci}; 1678c2ecf20Sopenharmony_ci 1688c2ecf20Sopenharmony_cistatic struct pci_device_id arcmsr_device_id_table[] = { 1698c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1110), 1708c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 1718c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1120), 1728c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 1738c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1130), 1748c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 1758c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1160), 1768c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 1778c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1170), 1788c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 1798c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1200), 1808c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_B}, 1818c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1201), 1828c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_B}, 1838c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1202), 1848c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_B}, 1858c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1203), 1868c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_B}, 1878c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1210), 1888c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 1898c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1214), 1908c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_D}, 1918c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1220), 1928c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 1938c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1230), 1948c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 1958c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1260), 1968c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 1978c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1270), 1988c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 1998c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1280), 2008c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 2018c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1380), 2028c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 2038c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1381), 2048c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 2058c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1680), 2068c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 2078c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1681), 2088c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_A}, 2098c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1880), 2108c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_C}, 2118c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1883), 2128c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_C}, 2138c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1884), 2148c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_E}, 2158c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1886_0), 2168c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_F}, 2178c2ecf20Sopenharmony_ci {PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1886), 2188c2ecf20Sopenharmony_ci .driver_data = ACB_ADAPTER_TYPE_F}, 2198c2ecf20Sopenharmony_ci {0, 0}, /* Terminating entry */ 2208c2ecf20Sopenharmony_ci}; 2218c2ecf20Sopenharmony_ciMODULE_DEVICE_TABLE(pci, arcmsr_device_id_table); 2228c2ecf20Sopenharmony_ci 2238c2ecf20Sopenharmony_cistatic struct pci_driver arcmsr_pci_driver = { 2248c2ecf20Sopenharmony_ci .name = "arcmsr", 2258c2ecf20Sopenharmony_ci .id_table = arcmsr_device_id_table, 2268c2ecf20Sopenharmony_ci .probe = arcmsr_probe, 2278c2ecf20Sopenharmony_ci .remove = arcmsr_remove, 2288c2ecf20Sopenharmony_ci .suspend = arcmsr_suspend, 2298c2ecf20Sopenharmony_ci .resume = arcmsr_resume, 2308c2ecf20Sopenharmony_ci .shutdown = arcmsr_shutdown, 2318c2ecf20Sopenharmony_ci}; 2328c2ecf20Sopenharmony_ci/* 2338c2ecf20Sopenharmony_ci**************************************************************************** 2348c2ecf20Sopenharmony_ci**************************************************************************** 2358c2ecf20Sopenharmony_ci*/ 2368c2ecf20Sopenharmony_ci 2378c2ecf20Sopenharmony_cistatic void arcmsr_free_io_queue(struct AdapterControlBlock *acb) 2388c2ecf20Sopenharmony_ci{ 2398c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 2408c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: 2418c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: 2428c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 2438c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 2448c2ecf20Sopenharmony_ci dma_free_coherent(&acb->pdev->dev, acb->ioqueue_size, 2458c2ecf20Sopenharmony_ci acb->dma_coherent2, acb->dma_coherent_handle2); 2468c2ecf20Sopenharmony_ci break; 2478c2ecf20Sopenharmony_ci } 2488c2ecf20Sopenharmony_ci} 2498c2ecf20Sopenharmony_ci 2508c2ecf20Sopenharmony_cistatic bool arcmsr_remap_pciregion(struct AdapterControlBlock *acb) 2518c2ecf20Sopenharmony_ci{ 2528c2ecf20Sopenharmony_ci struct pci_dev *pdev = acb->pdev; 2538c2ecf20Sopenharmony_ci switch (acb->adapter_type){ 2548c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A:{ 2558c2ecf20Sopenharmony_ci acb->pmuA = ioremap(pci_resource_start(pdev,0), pci_resource_len(pdev,0)); 2568c2ecf20Sopenharmony_ci if (!acb->pmuA) { 2578c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: memory mapping region fail \n", acb->host->host_no); 2588c2ecf20Sopenharmony_ci return false; 2598c2ecf20Sopenharmony_ci } 2608c2ecf20Sopenharmony_ci break; 2618c2ecf20Sopenharmony_ci } 2628c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B:{ 2638c2ecf20Sopenharmony_ci void __iomem *mem_base0, *mem_base1; 2648c2ecf20Sopenharmony_ci mem_base0 = ioremap(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0)); 2658c2ecf20Sopenharmony_ci if (!mem_base0) { 2668c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: memory mapping region fail \n", acb->host->host_no); 2678c2ecf20Sopenharmony_ci return false; 2688c2ecf20Sopenharmony_ci } 2698c2ecf20Sopenharmony_ci mem_base1 = ioremap(pci_resource_start(pdev, 2), pci_resource_len(pdev, 2)); 2708c2ecf20Sopenharmony_ci if (!mem_base1) { 2718c2ecf20Sopenharmony_ci iounmap(mem_base0); 2728c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: memory mapping region fail \n", acb->host->host_no); 2738c2ecf20Sopenharmony_ci return false; 2748c2ecf20Sopenharmony_ci } 2758c2ecf20Sopenharmony_ci acb->mem_base0 = mem_base0; 2768c2ecf20Sopenharmony_ci acb->mem_base1 = mem_base1; 2778c2ecf20Sopenharmony_ci break; 2788c2ecf20Sopenharmony_ci } 2798c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C:{ 2808c2ecf20Sopenharmony_ci acb->pmuC = ioremap(pci_resource_start(pdev, 1), pci_resource_len(pdev, 1)); 2818c2ecf20Sopenharmony_ci if (!acb->pmuC) { 2828c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: memory mapping region fail \n", acb->host->host_no); 2838c2ecf20Sopenharmony_ci return false; 2848c2ecf20Sopenharmony_ci } 2858c2ecf20Sopenharmony_ci if (readl(&acb->pmuC->outbound_doorbell) & ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE) { 2868c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE_DOORBELL_CLEAR, &acb->pmuC->outbound_doorbell_clear);/*clear interrupt*/ 2878c2ecf20Sopenharmony_ci return true; 2888c2ecf20Sopenharmony_ci } 2898c2ecf20Sopenharmony_ci break; 2908c2ecf20Sopenharmony_ci } 2918c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 2928c2ecf20Sopenharmony_ci void __iomem *mem_base0; 2938c2ecf20Sopenharmony_ci unsigned long addr, range; 2948c2ecf20Sopenharmony_ci 2958c2ecf20Sopenharmony_ci addr = (unsigned long)pci_resource_start(pdev, 0); 2968c2ecf20Sopenharmony_ci range = pci_resource_len(pdev, 0); 2978c2ecf20Sopenharmony_ci mem_base0 = ioremap(addr, range); 2988c2ecf20Sopenharmony_ci if (!mem_base0) { 2998c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: memory mapping region fail\n", 3008c2ecf20Sopenharmony_ci acb->host->host_no); 3018c2ecf20Sopenharmony_ci return false; 3028c2ecf20Sopenharmony_ci } 3038c2ecf20Sopenharmony_ci acb->mem_base0 = mem_base0; 3048c2ecf20Sopenharmony_ci break; 3058c2ecf20Sopenharmony_ci } 3068c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: { 3078c2ecf20Sopenharmony_ci acb->pmuE = ioremap(pci_resource_start(pdev, 1), 3088c2ecf20Sopenharmony_ci pci_resource_len(pdev, 1)); 3098c2ecf20Sopenharmony_ci if (!acb->pmuE) { 3108c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: memory mapping region fail \n", 3118c2ecf20Sopenharmony_ci acb->host->host_no); 3128c2ecf20Sopenharmony_ci return false; 3138c2ecf20Sopenharmony_ci } 3148c2ecf20Sopenharmony_ci writel(0, &acb->pmuE->host_int_status); /*clear interrupt*/ 3158c2ecf20Sopenharmony_ci writel(ARCMSR_HBEMU_DOORBELL_SYNC, &acb->pmuE->iobound_doorbell); /* synchronize doorbell to 0 */ 3168c2ecf20Sopenharmony_ci acb->in_doorbell = 0; 3178c2ecf20Sopenharmony_ci acb->out_doorbell = 0; 3188c2ecf20Sopenharmony_ci break; 3198c2ecf20Sopenharmony_ci } 3208c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 3218c2ecf20Sopenharmony_ci acb->pmuF = ioremap(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0)); 3228c2ecf20Sopenharmony_ci if (!acb->pmuF) { 3238c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: memory mapping region fail\n", 3248c2ecf20Sopenharmony_ci acb->host->host_no); 3258c2ecf20Sopenharmony_ci return false; 3268c2ecf20Sopenharmony_ci } 3278c2ecf20Sopenharmony_ci writel(0, &acb->pmuF->host_int_status); /* clear interrupt */ 3288c2ecf20Sopenharmony_ci writel(ARCMSR_HBFMU_DOORBELL_SYNC, &acb->pmuF->iobound_doorbell); 3298c2ecf20Sopenharmony_ci acb->in_doorbell = 0; 3308c2ecf20Sopenharmony_ci acb->out_doorbell = 0; 3318c2ecf20Sopenharmony_ci break; 3328c2ecf20Sopenharmony_ci } 3338c2ecf20Sopenharmony_ci } 3348c2ecf20Sopenharmony_ci return true; 3358c2ecf20Sopenharmony_ci} 3368c2ecf20Sopenharmony_ci 3378c2ecf20Sopenharmony_cistatic void arcmsr_unmap_pciregion(struct AdapterControlBlock *acb) 3388c2ecf20Sopenharmony_ci{ 3398c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 3408c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: 3418c2ecf20Sopenharmony_ci iounmap(acb->pmuA); 3428c2ecf20Sopenharmony_ci break; 3438c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: 3448c2ecf20Sopenharmony_ci iounmap(acb->mem_base0); 3458c2ecf20Sopenharmony_ci iounmap(acb->mem_base1); 3468c2ecf20Sopenharmony_ci break; 3478c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: 3488c2ecf20Sopenharmony_ci iounmap(acb->pmuC); 3498c2ecf20Sopenharmony_ci break; 3508c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: 3518c2ecf20Sopenharmony_ci iounmap(acb->mem_base0); 3528c2ecf20Sopenharmony_ci break; 3538c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 3548c2ecf20Sopenharmony_ci iounmap(acb->pmuE); 3558c2ecf20Sopenharmony_ci break; 3568c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 3578c2ecf20Sopenharmony_ci iounmap(acb->pmuF); 3588c2ecf20Sopenharmony_ci break; 3598c2ecf20Sopenharmony_ci } 3608c2ecf20Sopenharmony_ci} 3618c2ecf20Sopenharmony_ci 3628c2ecf20Sopenharmony_cistatic irqreturn_t arcmsr_do_interrupt(int irq, void *dev_id) 3638c2ecf20Sopenharmony_ci{ 3648c2ecf20Sopenharmony_ci irqreturn_t handle_state; 3658c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb = dev_id; 3668c2ecf20Sopenharmony_ci 3678c2ecf20Sopenharmony_ci handle_state = arcmsr_interrupt(acb); 3688c2ecf20Sopenharmony_ci return handle_state; 3698c2ecf20Sopenharmony_ci} 3708c2ecf20Sopenharmony_ci 3718c2ecf20Sopenharmony_cistatic int arcmsr_bios_param(struct scsi_device *sdev, 3728c2ecf20Sopenharmony_ci struct block_device *bdev, sector_t capacity, int *geom) 3738c2ecf20Sopenharmony_ci{ 3748c2ecf20Sopenharmony_ci int heads, sectors, cylinders, total_capacity; 3758c2ecf20Sopenharmony_ci 3768c2ecf20Sopenharmony_ci if (scsi_partsize(bdev, capacity, geom)) 3778c2ecf20Sopenharmony_ci return 0; 3788c2ecf20Sopenharmony_ci 3798c2ecf20Sopenharmony_ci total_capacity = capacity; 3808c2ecf20Sopenharmony_ci heads = 64; 3818c2ecf20Sopenharmony_ci sectors = 32; 3828c2ecf20Sopenharmony_ci cylinders = total_capacity / (heads * sectors); 3838c2ecf20Sopenharmony_ci if (cylinders > 1024) { 3848c2ecf20Sopenharmony_ci heads = 255; 3858c2ecf20Sopenharmony_ci sectors = 63; 3868c2ecf20Sopenharmony_ci cylinders = total_capacity / (heads * sectors); 3878c2ecf20Sopenharmony_ci } 3888c2ecf20Sopenharmony_ci geom[0] = heads; 3898c2ecf20Sopenharmony_ci geom[1] = sectors; 3908c2ecf20Sopenharmony_ci geom[2] = cylinders; 3918c2ecf20Sopenharmony_ci return 0; 3928c2ecf20Sopenharmony_ci} 3938c2ecf20Sopenharmony_ci 3948c2ecf20Sopenharmony_cistatic uint8_t arcmsr_hbaA_wait_msgint_ready(struct AdapterControlBlock *acb) 3958c2ecf20Sopenharmony_ci{ 3968c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 3978c2ecf20Sopenharmony_ci int i; 3988c2ecf20Sopenharmony_ci 3998c2ecf20Sopenharmony_ci for (i = 0; i < 2000; i++) { 4008c2ecf20Sopenharmony_ci if (readl(®->outbound_intstatus) & 4018c2ecf20Sopenharmony_ci ARCMSR_MU_OUTBOUND_MESSAGE0_INT) { 4028c2ecf20Sopenharmony_ci writel(ARCMSR_MU_OUTBOUND_MESSAGE0_INT, 4038c2ecf20Sopenharmony_ci ®->outbound_intstatus); 4048c2ecf20Sopenharmony_ci return true; 4058c2ecf20Sopenharmony_ci } 4068c2ecf20Sopenharmony_ci msleep(10); 4078c2ecf20Sopenharmony_ci } /* max 20 seconds */ 4088c2ecf20Sopenharmony_ci 4098c2ecf20Sopenharmony_ci return false; 4108c2ecf20Sopenharmony_ci} 4118c2ecf20Sopenharmony_ci 4128c2ecf20Sopenharmony_cistatic uint8_t arcmsr_hbaB_wait_msgint_ready(struct AdapterControlBlock *acb) 4138c2ecf20Sopenharmony_ci{ 4148c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 4158c2ecf20Sopenharmony_ci int i; 4168c2ecf20Sopenharmony_ci 4178c2ecf20Sopenharmony_ci for (i = 0; i < 2000; i++) { 4188c2ecf20Sopenharmony_ci if (readl(reg->iop2drv_doorbell) 4198c2ecf20Sopenharmony_ci & ARCMSR_IOP2DRV_MESSAGE_CMD_DONE) { 4208c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_INT_CLEAR_PATTERN, 4218c2ecf20Sopenharmony_ci reg->iop2drv_doorbell); 4228c2ecf20Sopenharmony_ci writel(ARCMSR_DRV2IOP_END_OF_INTERRUPT, 4238c2ecf20Sopenharmony_ci reg->drv2iop_doorbell); 4248c2ecf20Sopenharmony_ci return true; 4258c2ecf20Sopenharmony_ci } 4268c2ecf20Sopenharmony_ci msleep(10); 4278c2ecf20Sopenharmony_ci } /* max 20 seconds */ 4288c2ecf20Sopenharmony_ci 4298c2ecf20Sopenharmony_ci return false; 4308c2ecf20Sopenharmony_ci} 4318c2ecf20Sopenharmony_ci 4328c2ecf20Sopenharmony_cistatic uint8_t arcmsr_hbaC_wait_msgint_ready(struct AdapterControlBlock *pACB) 4338c2ecf20Sopenharmony_ci{ 4348c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *phbcmu = pACB->pmuC; 4358c2ecf20Sopenharmony_ci int i; 4368c2ecf20Sopenharmony_ci 4378c2ecf20Sopenharmony_ci for (i = 0; i < 2000; i++) { 4388c2ecf20Sopenharmony_ci if (readl(&phbcmu->outbound_doorbell) 4398c2ecf20Sopenharmony_ci & ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE) { 4408c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE_DOORBELL_CLEAR, 4418c2ecf20Sopenharmony_ci &phbcmu->outbound_doorbell_clear); /*clear interrupt*/ 4428c2ecf20Sopenharmony_ci return true; 4438c2ecf20Sopenharmony_ci } 4448c2ecf20Sopenharmony_ci msleep(10); 4458c2ecf20Sopenharmony_ci } /* max 20 seconds */ 4468c2ecf20Sopenharmony_ci 4478c2ecf20Sopenharmony_ci return false; 4488c2ecf20Sopenharmony_ci} 4498c2ecf20Sopenharmony_ci 4508c2ecf20Sopenharmony_cistatic bool arcmsr_hbaD_wait_msgint_ready(struct AdapterControlBlock *pACB) 4518c2ecf20Sopenharmony_ci{ 4528c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = pACB->pmuD; 4538c2ecf20Sopenharmony_ci int i; 4548c2ecf20Sopenharmony_ci 4558c2ecf20Sopenharmony_ci for (i = 0; i < 2000; i++) { 4568c2ecf20Sopenharmony_ci if (readl(reg->outbound_doorbell) 4578c2ecf20Sopenharmony_ci & ARCMSR_ARC1214_IOP2DRV_MESSAGE_CMD_DONE) { 4588c2ecf20Sopenharmony_ci writel(ARCMSR_ARC1214_IOP2DRV_MESSAGE_CMD_DONE, 4598c2ecf20Sopenharmony_ci reg->outbound_doorbell); 4608c2ecf20Sopenharmony_ci return true; 4618c2ecf20Sopenharmony_ci } 4628c2ecf20Sopenharmony_ci msleep(10); 4638c2ecf20Sopenharmony_ci } /* max 20 seconds */ 4648c2ecf20Sopenharmony_ci return false; 4658c2ecf20Sopenharmony_ci} 4668c2ecf20Sopenharmony_ci 4678c2ecf20Sopenharmony_cistatic bool arcmsr_hbaE_wait_msgint_ready(struct AdapterControlBlock *pACB) 4688c2ecf20Sopenharmony_ci{ 4698c2ecf20Sopenharmony_ci int i; 4708c2ecf20Sopenharmony_ci uint32_t read_doorbell; 4718c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *phbcmu = pACB->pmuE; 4728c2ecf20Sopenharmony_ci 4738c2ecf20Sopenharmony_ci for (i = 0; i < 2000; i++) { 4748c2ecf20Sopenharmony_ci read_doorbell = readl(&phbcmu->iobound_doorbell); 4758c2ecf20Sopenharmony_ci if ((read_doorbell ^ pACB->in_doorbell) & ARCMSR_HBEMU_IOP2DRV_MESSAGE_CMD_DONE) { 4768c2ecf20Sopenharmony_ci writel(0, &phbcmu->host_int_status); /*clear interrupt*/ 4778c2ecf20Sopenharmony_ci pACB->in_doorbell = read_doorbell; 4788c2ecf20Sopenharmony_ci return true; 4798c2ecf20Sopenharmony_ci } 4808c2ecf20Sopenharmony_ci msleep(10); 4818c2ecf20Sopenharmony_ci } /* max 20 seconds */ 4828c2ecf20Sopenharmony_ci return false; 4838c2ecf20Sopenharmony_ci} 4848c2ecf20Sopenharmony_ci 4858c2ecf20Sopenharmony_cistatic void arcmsr_hbaA_flush_cache(struct AdapterControlBlock *acb) 4868c2ecf20Sopenharmony_ci{ 4878c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 4888c2ecf20Sopenharmony_ci int retry_count = 30; 4898c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_FLUSH_CACHE, ®->inbound_msgaddr0); 4908c2ecf20Sopenharmony_ci do { 4918c2ecf20Sopenharmony_ci if (arcmsr_hbaA_wait_msgint_ready(acb)) 4928c2ecf20Sopenharmony_ci break; 4938c2ecf20Sopenharmony_ci else { 4948c2ecf20Sopenharmony_ci retry_count--; 4958c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: wait 'flush adapter cache' \ 4968c2ecf20Sopenharmony_ci timeout, retry count down = %d \n", acb->host->host_no, retry_count); 4978c2ecf20Sopenharmony_ci } 4988c2ecf20Sopenharmony_ci } while (retry_count != 0); 4998c2ecf20Sopenharmony_ci} 5008c2ecf20Sopenharmony_ci 5018c2ecf20Sopenharmony_cistatic void arcmsr_hbaB_flush_cache(struct AdapterControlBlock *acb) 5028c2ecf20Sopenharmony_ci{ 5038c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 5048c2ecf20Sopenharmony_ci int retry_count = 30; 5058c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_FLUSH_CACHE, reg->drv2iop_doorbell); 5068c2ecf20Sopenharmony_ci do { 5078c2ecf20Sopenharmony_ci if (arcmsr_hbaB_wait_msgint_ready(acb)) 5088c2ecf20Sopenharmony_ci break; 5098c2ecf20Sopenharmony_ci else { 5108c2ecf20Sopenharmony_ci retry_count--; 5118c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: wait 'flush adapter cache' \ 5128c2ecf20Sopenharmony_ci timeout,retry count down = %d \n", acb->host->host_no, retry_count); 5138c2ecf20Sopenharmony_ci } 5148c2ecf20Sopenharmony_ci } while (retry_count != 0); 5158c2ecf20Sopenharmony_ci} 5168c2ecf20Sopenharmony_ci 5178c2ecf20Sopenharmony_cistatic void arcmsr_hbaC_flush_cache(struct AdapterControlBlock *pACB) 5188c2ecf20Sopenharmony_ci{ 5198c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = pACB->pmuC; 5208c2ecf20Sopenharmony_ci int retry_count = 30;/* enlarge wait flush adapter cache time: 10 minute */ 5218c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_FLUSH_CACHE, ®->inbound_msgaddr0); 5228c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, ®->inbound_doorbell); 5238c2ecf20Sopenharmony_ci do { 5248c2ecf20Sopenharmony_ci if (arcmsr_hbaC_wait_msgint_ready(pACB)) { 5258c2ecf20Sopenharmony_ci break; 5268c2ecf20Sopenharmony_ci } else { 5278c2ecf20Sopenharmony_ci retry_count--; 5288c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: wait 'flush adapter cache' \ 5298c2ecf20Sopenharmony_ci timeout,retry count down = %d \n", pACB->host->host_no, retry_count); 5308c2ecf20Sopenharmony_ci } 5318c2ecf20Sopenharmony_ci } while (retry_count != 0); 5328c2ecf20Sopenharmony_ci return; 5338c2ecf20Sopenharmony_ci} 5348c2ecf20Sopenharmony_ci 5358c2ecf20Sopenharmony_cistatic void arcmsr_hbaD_flush_cache(struct AdapterControlBlock *pACB) 5368c2ecf20Sopenharmony_ci{ 5378c2ecf20Sopenharmony_ci int retry_count = 15; 5388c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = pACB->pmuD; 5398c2ecf20Sopenharmony_ci 5408c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_FLUSH_CACHE, reg->inbound_msgaddr0); 5418c2ecf20Sopenharmony_ci do { 5428c2ecf20Sopenharmony_ci if (arcmsr_hbaD_wait_msgint_ready(pACB)) 5438c2ecf20Sopenharmony_ci break; 5448c2ecf20Sopenharmony_ci 5458c2ecf20Sopenharmony_ci retry_count--; 5468c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: wait 'flush adapter " 5478c2ecf20Sopenharmony_ci "cache' timeout, retry count down = %d\n", 5488c2ecf20Sopenharmony_ci pACB->host->host_no, retry_count); 5498c2ecf20Sopenharmony_ci } while (retry_count != 0); 5508c2ecf20Sopenharmony_ci} 5518c2ecf20Sopenharmony_ci 5528c2ecf20Sopenharmony_cistatic void arcmsr_hbaE_flush_cache(struct AdapterControlBlock *pACB) 5538c2ecf20Sopenharmony_ci{ 5548c2ecf20Sopenharmony_ci int retry_count = 30; 5558c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = pACB->pmuE; 5568c2ecf20Sopenharmony_ci 5578c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_FLUSH_CACHE, ®->inbound_msgaddr0); 5588c2ecf20Sopenharmony_ci pACB->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_MESSAGE_CMD_DONE; 5598c2ecf20Sopenharmony_ci writel(pACB->out_doorbell, ®->iobound_doorbell); 5608c2ecf20Sopenharmony_ci do { 5618c2ecf20Sopenharmony_ci if (arcmsr_hbaE_wait_msgint_ready(pACB)) 5628c2ecf20Sopenharmony_ci break; 5638c2ecf20Sopenharmony_ci retry_count--; 5648c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: wait 'flush adapter " 5658c2ecf20Sopenharmony_ci "cache' timeout, retry count down = %d\n", 5668c2ecf20Sopenharmony_ci pACB->host->host_no, retry_count); 5678c2ecf20Sopenharmony_ci } while (retry_count != 0); 5688c2ecf20Sopenharmony_ci} 5698c2ecf20Sopenharmony_ci 5708c2ecf20Sopenharmony_cistatic void arcmsr_flush_adapter_cache(struct AdapterControlBlock *acb) 5718c2ecf20Sopenharmony_ci{ 5728c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 5738c2ecf20Sopenharmony_ci 5748c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: 5758c2ecf20Sopenharmony_ci arcmsr_hbaA_flush_cache(acb); 5768c2ecf20Sopenharmony_ci break; 5778c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: 5788c2ecf20Sopenharmony_ci arcmsr_hbaB_flush_cache(acb); 5798c2ecf20Sopenharmony_ci break; 5808c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: 5818c2ecf20Sopenharmony_ci arcmsr_hbaC_flush_cache(acb); 5828c2ecf20Sopenharmony_ci break; 5838c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: 5848c2ecf20Sopenharmony_ci arcmsr_hbaD_flush_cache(acb); 5858c2ecf20Sopenharmony_ci break; 5868c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 5878c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 5888c2ecf20Sopenharmony_ci arcmsr_hbaE_flush_cache(acb); 5898c2ecf20Sopenharmony_ci break; 5908c2ecf20Sopenharmony_ci } 5918c2ecf20Sopenharmony_ci} 5928c2ecf20Sopenharmony_ci 5938c2ecf20Sopenharmony_cistatic void arcmsr_hbaB_assign_regAddr(struct AdapterControlBlock *acb) 5948c2ecf20Sopenharmony_ci{ 5958c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 5968c2ecf20Sopenharmony_ci 5978c2ecf20Sopenharmony_ci if (acb->pdev->device == PCI_DEVICE_ID_ARECA_1203) { 5988c2ecf20Sopenharmony_ci reg->drv2iop_doorbell = MEM_BASE0(ARCMSR_DRV2IOP_DOORBELL_1203); 5998c2ecf20Sopenharmony_ci reg->drv2iop_doorbell_mask = MEM_BASE0(ARCMSR_DRV2IOP_DOORBELL_MASK_1203); 6008c2ecf20Sopenharmony_ci reg->iop2drv_doorbell = MEM_BASE0(ARCMSR_IOP2DRV_DOORBELL_1203); 6018c2ecf20Sopenharmony_ci reg->iop2drv_doorbell_mask = MEM_BASE0(ARCMSR_IOP2DRV_DOORBELL_MASK_1203); 6028c2ecf20Sopenharmony_ci } else { 6038c2ecf20Sopenharmony_ci reg->drv2iop_doorbell= MEM_BASE0(ARCMSR_DRV2IOP_DOORBELL); 6048c2ecf20Sopenharmony_ci reg->drv2iop_doorbell_mask = MEM_BASE0(ARCMSR_DRV2IOP_DOORBELL_MASK); 6058c2ecf20Sopenharmony_ci reg->iop2drv_doorbell = MEM_BASE0(ARCMSR_IOP2DRV_DOORBELL); 6068c2ecf20Sopenharmony_ci reg->iop2drv_doorbell_mask = MEM_BASE0(ARCMSR_IOP2DRV_DOORBELL_MASK); 6078c2ecf20Sopenharmony_ci } 6088c2ecf20Sopenharmony_ci reg->message_wbuffer = MEM_BASE1(ARCMSR_MESSAGE_WBUFFER); 6098c2ecf20Sopenharmony_ci reg->message_rbuffer = MEM_BASE1(ARCMSR_MESSAGE_RBUFFER); 6108c2ecf20Sopenharmony_ci reg->message_rwbuffer = MEM_BASE1(ARCMSR_MESSAGE_RWBUFFER); 6118c2ecf20Sopenharmony_ci} 6128c2ecf20Sopenharmony_ci 6138c2ecf20Sopenharmony_cistatic void arcmsr_hbaD_assign_regAddr(struct AdapterControlBlock *acb) 6148c2ecf20Sopenharmony_ci{ 6158c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 6168c2ecf20Sopenharmony_ci 6178c2ecf20Sopenharmony_ci reg->chip_id = MEM_BASE0(ARCMSR_ARC1214_CHIP_ID); 6188c2ecf20Sopenharmony_ci reg->cpu_mem_config = MEM_BASE0(ARCMSR_ARC1214_CPU_MEMORY_CONFIGURATION); 6198c2ecf20Sopenharmony_ci reg->i2o_host_interrupt_mask = MEM_BASE0(ARCMSR_ARC1214_I2_HOST_INTERRUPT_MASK); 6208c2ecf20Sopenharmony_ci reg->sample_at_reset = MEM_BASE0(ARCMSR_ARC1214_SAMPLE_RESET); 6218c2ecf20Sopenharmony_ci reg->reset_request = MEM_BASE0(ARCMSR_ARC1214_RESET_REQUEST); 6228c2ecf20Sopenharmony_ci reg->host_int_status = MEM_BASE0(ARCMSR_ARC1214_MAIN_INTERRUPT_STATUS); 6238c2ecf20Sopenharmony_ci reg->pcief0_int_enable = MEM_BASE0(ARCMSR_ARC1214_PCIE_F0_INTERRUPT_ENABLE); 6248c2ecf20Sopenharmony_ci reg->inbound_msgaddr0 = MEM_BASE0(ARCMSR_ARC1214_INBOUND_MESSAGE0); 6258c2ecf20Sopenharmony_ci reg->inbound_msgaddr1 = MEM_BASE0(ARCMSR_ARC1214_INBOUND_MESSAGE1); 6268c2ecf20Sopenharmony_ci reg->outbound_msgaddr0 = MEM_BASE0(ARCMSR_ARC1214_OUTBOUND_MESSAGE0); 6278c2ecf20Sopenharmony_ci reg->outbound_msgaddr1 = MEM_BASE0(ARCMSR_ARC1214_OUTBOUND_MESSAGE1); 6288c2ecf20Sopenharmony_ci reg->inbound_doorbell = MEM_BASE0(ARCMSR_ARC1214_INBOUND_DOORBELL); 6298c2ecf20Sopenharmony_ci reg->outbound_doorbell = MEM_BASE0(ARCMSR_ARC1214_OUTBOUND_DOORBELL); 6308c2ecf20Sopenharmony_ci reg->outbound_doorbell_enable = MEM_BASE0(ARCMSR_ARC1214_OUTBOUND_DOORBELL_ENABLE); 6318c2ecf20Sopenharmony_ci reg->inboundlist_base_low = MEM_BASE0(ARCMSR_ARC1214_INBOUND_LIST_BASE_LOW); 6328c2ecf20Sopenharmony_ci reg->inboundlist_base_high = MEM_BASE0(ARCMSR_ARC1214_INBOUND_LIST_BASE_HIGH); 6338c2ecf20Sopenharmony_ci reg->inboundlist_write_pointer = MEM_BASE0(ARCMSR_ARC1214_INBOUND_LIST_WRITE_POINTER); 6348c2ecf20Sopenharmony_ci reg->outboundlist_base_low = MEM_BASE0(ARCMSR_ARC1214_OUTBOUND_LIST_BASE_LOW); 6358c2ecf20Sopenharmony_ci reg->outboundlist_base_high = MEM_BASE0(ARCMSR_ARC1214_OUTBOUND_LIST_BASE_HIGH); 6368c2ecf20Sopenharmony_ci reg->outboundlist_copy_pointer = MEM_BASE0(ARCMSR_ARC1214_OUTBOUND_LIST_COPY_POINTER); 6378c2ecf20Sopenharmony_ci reg->outboundlist_read_pointer = MEM_BASE0(ARCMSR_ARC1214_OUTBOUND_LIST_READ_POINTER); 6388c2ecf20Sopenharmony_ci reg->outboundlist_interrupt_cause = MEM_BASE0(ARCMSR_ARC1214_OUTBOUND_INTERRUPT_CAUSE); 6398c2ecf20Sopenharmony_ci reg->outboundlist_interrupt_enable = MEM_BASE0(ARCMSR_ARC1214_OUTBOUND_INTERRUPT_ENABLE); 6408c2ecf20Sopenharmony_ci reg->message_wbuffer = MEM_BASE0(ARCMSR_ARC1214_MESSAGE_WBUFFER); 6418c2ecf20Sopenharmony_ci reg->message_rbuffer = MEM_BASE0(ARCMSR_ARC1214_MESSAGE_RBUFFER); 6428c2ecf20Sopenharmony_ci reg->msgcode_rwbuffer = MEM_BASE0(ARCMSR_ARC1214_MESSAGE_RWBUFFER); 6438c2ecf20Sopenharmony_ci} 6448c2ecf20Sopenharmony_ci 6458c2ecf20Sopenharmony_cistatic void arcmsr_hbaF_assign_regAddr(struct AdapterControlBlock *acb) 6468c2ecf20Sopenharmony_ci{ 6478c2ecf20Sopenharmony_ci dma_addr_t host_buffer_dma; 6488c2ecf20Sopenharmony_ci struct MessageUnit_F __iomem *pmuF; 6498c2ecf20Sopenharmony_ci 6508c2ecf20Sopenharmony_ci memset(acb->dma_coherent2, 0xff, acb->completeQ_size); 6518c2ecf20Sopenharmony_ci acb->message_wbuffer = (uint32_t *)round_up((unsigned long)acb->dma_coherent2 + 6528c2ecf20Sopenharmony_ci acb->completeQ_size, 4); 6538c2ecf20Sopenharmony_ci acb->message_rbuffer = ((void *)acb->message_wbuffer) + 0x100; 6548c2ecf20Sopenharmony_ci acb->msgcode_rwbuffer = ((void *)acb->message_wbuffer) + 0x200; 6558c2ecf20Sopenharmony_ci memset((void *)acb->message_wbuffer, 0, MESG_RW_BUFFER_SIZE); 6568c2ecf20Sopenharmony_ci host_buffer_dma = round_up(acb->dma_coherent_handle2 + acb->completeQ_size, 4); 6578c2ecf20Sopenharmony_ci pmuF = acb->pmuF; 6588c2ecf20Sopenharmony_ci /* host buffer low address, bit0:1 all buffer active */ 6598c2ecf20Sopenharmony_ci writel(lower_32_bits(host_buffer_dma | 1), &pmuF->inbound_msgaddr0); 6608c2ecf20Sopenharmony_ci /* host buffer high address */ 6618c2ecf20Sopenharmony_ci writel(upper_32_bits(host_buffer_dma), &pmuF->inbound_msgaddr1); 6628c2ecf20Sopenharmony_ci /* set host buffer physical address */ 6638c2ecf20Sopenharmony_ci writel(ARCMSR_HBFMU_DOORBELL_SYNC1, &pmuF->iobound_doorbell); 6648c2ecf20Sopenharmony_ci} 6658c2ecf20Sopenharmony_ci 6668c2ecf20Sopenharmony_cistatic bool arcmsr_alloc_io_queue(struct AdapterControlBlock *acb) 6678c2ecf20Sopenharmony_ci{ 6688c2ecf20Sopenharmony_ci bool rtn = true; 6698c2ecf20Sopenharmony_ci void *dma_coherent; 6708c2ecf20Sopenharmony_ci dma_addr_t dma_coherent_handle; 6718c2ecf20Sopenharmony_ci struct pci_dev *pdev = acb->pdev; 6728c2ecf20Sopenharmony_ci 6738c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 6748c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 6758c2ecf20Sopenharmony_ci acb->ioqueue_size = roundup(sizeof(struct MessageUnit_B), 32); 6768c2ecf20Sopenharmony_ci dma_coherent = dma_alloc_coherent(&pdev->dev, acb->ioqueue_size, 6778c2ecf20Sopenharmony_ci &dma_coherent_handle, GFP_KERNEL); 6788c2ecf20Sopenharmony_ci if (!dma_coherent) { 6798c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: DMA allocation failed\n", acb->host->host_no); 6808c2ecf20Sopenharmony_ci return false; 6818c2ecf20Sopenharmony_ci } 6828c2ecf20Sopenharmony_ci acb->dma_coherent_handle2 = dma_coherent_handle; 6838c2ecf20Sopenharmony_ci acb->dma_coherent2 = dma_coherent; 6848c2ecf20Sopenharmony_ci acb->pmuB = (struct MessageUnit_B *)dma_coherent; 6858c2ecf20Sopenharmony_ci arcmsr_hbaB_assign_regAddr(acb); 6868c2ecf20Sopenharmony_ci } 6878c2ecf20Sopenharmony_ci break; 6888c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 6898c2ecf20Sopenharmony_ci acb->ioqueue_size = roundup(sizeof(struct MessageUnit_D), 32); 6908c2ecf20Sopenharmony_ci dma_coherent = dma_alloc_coherent(&pdev->dev, acb->ioqueue_size, 6918c2ecf20Sopenharmony_ci &dma_coherent_handle, GFP_KERNEL); 6928c2ecf20Sopenharmony_ci if (!dma_coherent) { 6938c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: DMA allocation failed\n", acb->host->host_no); 6948c2ecf20Sopenharmony_ci return false; 6958c2ecf20Sopenharmony_ci } 6968c2ecf20Sopenharmony_ci acb->dma_coherent_handle2 = dma_coherent_handle; 6978c2ecf20Sopenharmony_ci acb->dma_coherent2 = dma_coherent; 6988c2ecf20Sopenharmony_ci acb->pmuD = (struct MessageUnit_D *)dma_coherent; 6998c2ecf20Sopenharmony_ci arcmsr_hbaD_assign_regAddr(acb); 7008c2ecf20Sopenharmony_ci } 7018c2ecf20Sopenharmony_ci break; 7028c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: { 7038c2ecf20Sopenharmony_ci uint32_t completeQ_size; 7048c2ecf20Sopenharmony_ci completeQ_size = sizeof(struct deliver_completeQ) * ARCMSR_MAX_HBE_DONEQUEUE + 128; 7058c2ecf20Sopenharmony_ci acb->ioqueue_size = roundup(completeQ_size, 32); 7068c2ecf20Sopenharmony_ci dma_coherent = dma_alloc_coherent(&pdev->dev, acb->ioqueue_size, 7078c2ecf20Sopenharmony_ci &dma_coherent_handle, GFP_KERNEL); 7088c2ecf20Sopenharmony_ci if (!dma_coherent){ 7098c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: DMA allocation failed\n", acb->host->host_no); 7108c2ecf20Sopenharmony_ci return false; 7118c2ecf20Sopenharmony_ci } 7128c2ecf20Sopenharmony_ci acb->dma_coherent_handle2 = dma_coherent_handle; 7138c2ecf20Sopenharmony_ci acb->dma_coherent2 = dma_coherent; 7148c2ecf20Sopenharmony_ci acb->pCompletionQ = dma_coherent; 7158c2ecf20Sopenharmony_ci acb->completionQ_entry = acb->ioqueue_size / sizeof(struct deliver_completeQ); 7168c2ecf20Sopenharmony_ci acb->doneq_index = 0; 7178c2ecf20Sopenharmony_ci } 7188c2ecf20Sopenharmony_ci break; 7198c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 7208c2ecf20Sopenharmony_ci uint32_t QueueDepth; 7218c2ecf20Sopenharmony_ci uint32_t depthTbl[] = {256, 512, 1024, 128, 64, 32}; 7228c2ecf20Sopenharmony_ci 7238c2ecf20Sopenharmony_ci arcmsr_wait_firmware_ready(acb); 7248c2ecf20Sopenharmony_ci QueueDepth = depthTbl[readl(&acb->pmuF->outbound_msgaddr1) & 7]; 7258c2ecf20Sopenharmony_ci acb->completeQ_size = sizeof(struct deliver_completeQ) * QueueDepth + 128; 7268c2ecf20Sopenharmony_ci acb->ioqueue_size = roundup(acb->completeQ_size + MESG_RW_BUFFER_SIZE, 32); 7278c2ecf20Sopenharmony_ci dma_coherent = dma_alloc_coherent(&pdev->dev, acb->ioqueue_size, 7288c2ecf20Sopenharmony_ci &dma_coherent_handle, GFP_KERNEL); 7298c2ecf20Sopenharmony_ci if (!dma_coherent) { 7308c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: DMA allocation failed\n", acb->host->host_no); 7318c2ecf20Sopenharmony_ci return false; 7328c2ecf20Sopenharmony_ci } 7338c2ecf20Sopenharmony_ci acb->dma_coherent_handle2 = dma_coherent_handle; 7348c2ecf20Sopenharmony_ci acb->dma_coherent2 = dma_coherent; 7358c2ecf20Sopenharmony_ci acb->pCompletionQ = dma_coherent; 7368c2ecf20Sopenharmony_ci acb->completionQ_entry = acb->completeQ_size / sizeof(struct deliver_completeQ); 7378c2ecf20Sopenharmony_ci acb->doneq_index = 0; 7388c2ecf20Sopenharmony_ci arcmsr_hbaF_assign_regAddr(acb); 7398c2ecf20Sopenharmony_ci } 7408c2ecf20Sopenharmony_ci break; 7418c2ecf20Sopenharmony_ci default: 7428c2ecf20Sopenharmony_ci break; 7438c2ecf20Sopenharmony_ci } 7448c2ecf20Sopenharmony_ci return rtn; 7458c2ecf20Sopenharmony_ci} 7468c2ecf20Sopenharmony_ci 7478c2ecf20Sopenharmony_cistatic int arcmsr_alloc_ccb_pool(struct AdapterControlBlock *acb) 7488c2ecf20Sopenharmony_ci{ 7498c2ecf20Sopenharmony_ci struct pci_dev *pdev = acb->pdev; 7508c2ecf20Sopenharmony_ci void *dma_coherent; 7518c2ecf20Sopenharmony_ci dma_addr_t dma_coherent_handle; 7528c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb_tmp; 7538c2ecf20Sopenharmony_ci int i = 0, j = 0; 7548c2ecf20Sopenharmony_ci unsigned long cdb_phyaddr, next_ccb_phy; 7558c2ecf20Sopenharmony_ci unsigned long roundup_ccbsize; 7568c2ecf20Sopenharmony_ci unsigned long max_xfer_len; 7578c2ecf20Sopenharmony_ci unsigned long max_sg_entrys; 7588c2ecf20Sopenharmony_ci uint32_t firm_config_version, curr_phy_upper32; 7598c2ecf20Sopenharmony_ci 7608c2ecf20Sopenharmony_ci for (i = 0; i < ARCMSR_MAX_TARGETID; i++) 7618c2ecf20Sopenharmony_ci for (j = 0; j < ARCMSR_MAX_TARGETLUN; j++) 7628c2ecf20Sopenharmony_ci acb->devstate[i][j] = ARECA_RAID_GONE; 7638c2ecf20Sopenharmony_ci 7648c2ecf20Sopenharmony_ci max_xfer_len = ARCMSR_MAX_XFER_LEN; 7658c2ecf20Sopenharmony_ci max_sg_entrys = ARCMSR_DEFAULT_SG_ENTRIES; 7668c2ecf20Sopenharmony_ci firm_config_version = acb->firm_cfg_version; 7678c2ecf20Sopenharmony_ci if((firm_config_version & 0xFF) >= 3){ 7688c2ecf20Sopenharmony_ci max_xfer_len = (ARCMSR_CDB_SG_PAGE_LENGTH << ((firm_config_version >> 8) & 0xFF)) * 1024;/* max 4M byte */ 7698c2ecf20Sopenharmony_ci max_sg_entrys = (max_xfer_len/4096); 7708c2ecf20Sopenharmony_ci } 7718c2ecf20Sopenharmony_ci acb->host->max_sectors = max_xfer_len/512; 7728c2ecf20Sopenharmony_ci acb->host->sg_tablesize = max_sg_entrys; 7738c2ecf20Sopenharmony_ci roundup_ccbsize = roundup(sizeof(struct CommandControlBlock) + (max_sg_entrys - 1) * sizeof(struct SG64ENTRY), 32); 7748c2ecf20Sopenharmony_ci acb->uncache_size = roundup_ccbsize * acb->maxFreeCCB; 7758c2ecf20Sopenharmony_ci if (acb->adapter_type != ACB_ADAPTER_TYPE_F) 7768c2ecf20Sopenharmony_ci acb->uncache_size += acb->ioqueue_size; 7778c2ecf20Sopenharmony_ci dma_coherent = dma_alloc_coherent(&pdev->dev, acb->uncache_size, &dma_coherent_handle, GFP_KERNEL); 7788c2ecf20Sopenharmony_ci if(!dma_coherent){ 7798c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: dma_alloc_coherent got error\n", acb->host->host_no); 7808c2ecf20Sopenharmony_ci return -ENOMEM; 7818c2ecf20Sopenharmony_ci } 7828c2ecf20Sopenharmony_ci acb->dma_coherent = dma_coherent; 7838c2ecf20Sopenharmony_ci acb->dma_coherent_handle = dma_coherent_handle; 7848c2ecf20Sopenharmony_ci memset(dma_coherent, 0, acb->uncache_size); 7858c2ecf20Sopenharmony_ci acb->ccbsize = roundup_ccbsize; 7868c2ecf20Sopenharmony_ci ccb_tmp = dma_coherent; 7878c2ecf20Sopenharmony_ci curr_phy_upper32 = upper_32_bits(dma_coherent_handle); 7888c2ecf20Sopenharmony_ci acb->vir2phy_offset = (unsigned long)dma_coherent - (unsigned long)dma_coherent_handle; 7898c2ecf20Sopenharmony_ci for(i = 0; i < acb->maxFreeCCB; i++){ 7908c2ecf20Sopenharmony_ci cdb_phyaddr = (unsigned long)dma_coherent_handle + offsetof(struct CommandControlBlock, arcmsr_cdb); 7918c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 7928c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: 7938c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: 7948c2ecf20Sopenharmony_ci ccb_tmp->cdb_phyaddr = cdb_phyaddr >> 5; 7958c2ecf20Sopenharmony_ci break; 7968c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: 7978c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: 7988c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 7998c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 8008c2ecf20Sopenharmony_ci ccb_tmp->cdb_phyaddr = cdb_phyaddr; 8018c2ecf20Sopenharmony_ci break; 8028c2ecf20Sopenharmony_ci } 8038c2ecf20Sopenharmony_ci acb->pccb_pool[i] = ccb_tmp; 8048c2ecf20Sopenharmony_ci ccb_tmp->acb = acb; 8058c2ecf20Sopenharmony_ci ccb_tmp->smid = (u32)i << 16; 8068c2ecf20Sopenharmony_ci INIT_LIST_HEAD(&ccb_tmp->list); 8078c2ecf20Sopenharmony_ci next_ccb_phy = dma_coherent_handle + roundup_ccbsize; 8088c2ecf20Sopenharmony_ci if (upper_32_bits(next_ccb_phy) != curr_phy_upper32) { 8098c2ecf20Sopenharmony_ci acb->maxFreeCCB = i; 8108c2ecf20Sopenharmony_ci acb->host->can_queue = i; 8118c2ecf20Sopenharmony_ci break; 8128c2ecf20Sopenharmony_ci } 8138c2ecf20Sopenharmony_ci else 8148c2ecf20Sopenharmony_ci list_add_tail(&ccb_tmp->list, &acb->ccb_free_list); 8158c2ecf20Sopenharmony_ci ccb_tmp = (struct CommandControlBlock *)((unsigned long)ccb_tmp + roundup_ccbsize); 8168c2ecf20Sopenharmony_ci dma_coherent_handle = next_ccb_phy; 8178c2ecf20Sopenharmony_ci } 8188c2ecf20Sopenharmony_ci if (acb->adapter_type != ACB_ADAPTER_TYPE_F) { 8198c2ecf20Sopenharmony_ci acb->dma_coherent_handle2 = dma_coherent_handle; 8208c2ecf20Sopenharmony_ci acb->dma_coherent2 = ccb_tmp; 8218c2ecf20Sopenharmony_ci } 8228c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 8238c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: 8248c2ecf20Sopenharmony_ci acb->pmuB = (struct MessageUnit_B *)acb->dma_coherent2; 8258c2ecf20Sopenharmony_ci arcmsr_hbaB_assign_regAddr(acb); 8268c2ecf20Sopenharmony_ci break; 8278c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: 8288c2ecf20Sopenharmony_ci acb->pmuD = (struct MessageUnit_D *)acb->dma_coherent2; 8298c2ecf20Sopenharmony_ci arcmsr_hbaD_assign_regAddr(acb); 8308c2ecf20Sopenharmony_ci break; 8318c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 8328c2ecf20Sopenharmony_ci acb->pCompletionQ = acb->dma_coherent2; 8338c2ecf20Sopenharmony_ci acb->completionQ_entry = acb->ioqueue_size / sizeof(struct deliver_completeQ); 8348c2ecf20Sopenharmony_ci acb->doneq_index = 0; 8358c2ecf20Sopenharmony_ci break; 8368c2ecf20Sopenharmony_ci } 8378c2ecf20Sopenharmony_ci return 0; 8388c2ecf20Sopenharmony_ci} 8398c2ecf20Sopenharmony_ci 8408c2ecf20Sopenharmony_cistatic void arcmsr_message_isr_bh_fn(struct work_struct *work) 8418c2ecf20Sopenharmony_ci{ 8428c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb = container_of(work, 8438c2ecf20Sopenharmony_ci struct AdapterControlBlock, arcmsr_do_message_isr_bh); 8448c2ecf20Sopenharmony_ci char *acb_dev_map = (char *)acb->device_map; 8458c2ecf20Sopenharmony_ci uint32_t __iomem *signature = NULL; 8468c2ecf20Sopenharmony_ci char __iomem *devicemap = NULL; 8478c2ecf20Sopenharmony_ci int target, lun; 8488c2ecf20Sopenharmony_ci struct scsi_device *psdev; 8498c2ecf20Sopenharmony_ci char diff, temp; 8508c2ecf20Sopenharmony_ci 8518c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 8528c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: { 8538c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 8548c2ecf20Sopenharmony_ci 8558c2ecf20Sopenharmony_ci signature = (uint32_t __iomem *)(®->message_rwbuffer[0]); 8568c2ecf20Sopenharmony_ci devicemap = (char __iomem *)(®->message_rwbuffer[21]); 8578c2ecf20Sopenharmony_ci break; 8588c2ecf20Sopenharmony_ci } 8598c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 8608c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 8618c2ecf20Sopenharmony_ci 8628c2ecf20Sopenharmony_ci signature = (uint32_t __iomem *)(®->message_rwbuffer[0]); 8638c2ecf20Sopenharmony_ci devicemap = (char __iomem *)(®->message_rwbuffer[21]); 8648c2ecf20Sopenharmony_ci break; 8658c2ecf20Sopenharmony_ci } 8668c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: { 8678c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 8688c2ecf20Sopenharmony_ci 8698c2ecf20Sopenharmony_ci signature = (uint32_t __iomem *)(®->msgcode_rwbuffer[0]); 8708c2ecf20Sopenharmony_ci devicemap = (char __iomem *)(®->msgcode_rwbuffer[21]); 8718c2ecf20Sopenharmony_ci break; 8728c2ecf20Sopenharmony_ci } 8738c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 8748c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 8758c2ecf20Sopenharmony_ci 8768c2ecf20Sopenharmony_ci signature = (uint32_t __iomem *)(®->msgcode_rwbuffer[0]); 8778c2ecf20Sopenharmony_ci devicemap = (char __iomem *)(®->msgcode_rwbuffer[21]); 8788c2ecf20Sopenharmony_ci break; 8798c2ecf20Sopenharmony_ci } 8808c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: { 8818c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 8828c2ecf20Sopenharmony_ci 8838c2ecf20Sopenharmony_ci signature = (uint32_t __iomem *)(®->msgcode_rwbuffer[0]); 8848c2ecf20Sopenharmony_ci devicemap = (char __iomem *)(®->msgcode_rwbuffer[21]); 8858c2ecf20Sopenharmony_ci break; 8868c2ecf20Sopenharmony_ci } 8878c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 8888c2ecf20Sopenharmony_ci signature = (uint32_t __iomem *)(&acb->msgcode_rwbuffer[0]); 8898c2ecf20Sopenharmony_ci devicemap = (char __iomem *)(&acb->msgcode_rwbuffer[21]); 8908c2ecf20Sopenharmony_ci break; 8918c2ecf20Sopenharmony_ci } 8928c2ecf20Sopenharmony_ci } 8938c2ecf20Sopenharmony_ci if (readl(signature) != ARCMSR_SIGNATURE_GET_CONFIG) 8948c2ecf20Sopenharmony_ci return; 8958c2ecf20Sopenharmony_ci for (target = 0; target < ARCMSR_MAX_TARGETID - 1; 8968c2ecf20Sopenharmony_ci target++) { 8978c2ecf20Sopenharmony_ci temp = readb(devicemap); 8988c2ecf20Sopenharmony_ci diff = (*acb_dev_map) ^ temp; 8998c2ecf20Sopenharmony_ci if (diff != 0) { 9008c2ecf20Sopenharmony_ci *acb_dev_map = temp; 9018c2ecf20Sopenharmony_ci for (lun = 0; lun < ARCMSR_MAX_TARGETLUN; 9028c2ecf20Sopenharmony_ci lun++) { 9038c2ecf20Sopenharmony_ci if ((diff & 0x01) == 1 && 9048c2ecf20Sopenharmony_ci (temp & 0x01) == 1) { 9058c2ecf20Sopenharmony_ci scsi_add_device(acb->host, 9068c2ecf20Sopenharmony_ci 0, target, lun); 9078c2ecf20Sopenharmony_ci } else if ((diff & 0x01) == 1 9088c2ecf20Sopenharmony_ci && (temp & 0x01) == 0) { 9098c2ecf20Sopenharmony_ci psdev = scsi_device_lookup(acb->host, 9108c2ecf20Sopenharmony_ci 0, target, lun); 9118c2ecf20Sopenharmony_ci if (psdev != NULL) { 9128c2ecf20Sopenharmony_ci scsi_remove_device(psdev); 9138c2ecf20Sopenharmony_ci scsi_device_put(psdev); 9148c2ecf20Sopenharmony_ci } 9158c2ecf20Sopenharmony_ci } 9168c2ecf20Sopenharmony_ci temp >>= 1; 9178c2ecf20Sopenharmony_ci diff >>= 1; 9188c2ecf20Sopenharmony_ci } 9198c2ecf20Sopenharmony_ci } 9208c2ecf20Sopenharmony_ci devicemap++; 9218c2ecf20Sopenharmony_ci acb_dev_map++; 9228c2ecf20Sopenharmony_ci } 9238c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_MSG_GET_CONFIG; 9248c2ecf20Sopenharmony_ci} 9258c2ecf20Sopenharmony_ci 9268c2ecf20Sopenharmony_cistatic int 9278c2ecf20Sopenharmony_ciarcmsr_request_irq(struct pci_dev *pdev, struct AdapterControlBlock *acb) 9288c2ecf20Sopenharmony_ci{ 9298c2ecf20Sopenharmony_ci unsigned long flags; 9308c2ecf20Sopenharmony_ci int nvec, i; 9318c2ecf20Sopenharmony_ci 9328c2ecf20Sopenharmony_ci if (msix_enable == 0) 9338c2ecf20Sopenharmony_ci goto msi_int0; 9348c2ecf20Sopenharmony_ci nvec = pci_alloc_irq_vectors(pdev, 1, ARCMST_NUM_MSIX_VECTORS, 9358c2ecf20Sopenharmony_ci PCI_IRQ_MSIX); 9368c2ecf20Sopenharmony_ci if (nvec > 0) { 9378c2ecf20Sopenharmony_ci pr_info("arcmsr%d: msi-x enabled\n", acb->host->host_no); 9388c2ecf20Sopenharmony_ci flags = 0; 9398c2ecf20Sopenharmony_ci } else { 9408c2ecf20Sopenharmony_cimsi_int0: 9418c2ecf20Sopenharmony_ci if (msi_enable == 1) { 9428c2ecf20Sopenharmony_ci nvec = pci_alloc_irq_vectors(pdev, 1, 1, PCI_IRQ_MSI); 9438c2ecf20Sopenharmony_ci if (nvec == 1) { 9448c2ecf20Sopenharmony_ci dev_info(&pdev->dev, "msi enabled\n"); 9458c2ecf20Sopenharmony_ci goto msi_int1; 9468c2ecf20Sopenharmony_ci } 9478c2ecf20Sopenharmony_ci } 9488c2ecf20Sopenharmony_ci nvec = pci_alloc_irq_vectors(pdev, 1, 1, PCI_IRQ_LEGACY); 9498c2ecf20Sopenharmony_ci if (nvec < 1) 9508c2ecf20Sopenharmony_ci return FAILED; 9518c2ecf20Sopenharmony_cimsi_int1: 9528c2ecf20Sopenharmony_ci flags = IRQF_SHARED; 9538c2ecf20Sopenharmony_ci } 9548c2ecf20Sopenharmony_ci 9558c2ecf20Sopenharmony_ci acb->vector_count = nvec; 9568c2ecf20Sopenharmony_ci for (i = 0; i < nvec; i++) { 9578c2ecf20Sopenharmony_ci if (request_irq(pci_irq_vector(pdev, i), arcmsr_do_interrupt, 9588c2ecf20Sopenharmony_ci flags, "arcmsr", acb)) { 9598c2ecf20Sopenharmony_ci pr_warn("arcmsr%d: request_irq =%d failed!\n", 9608c2ecf20Sopenharmony_ci acb->host->host_no, pci_irq_vector(pdev, i)); 9618c2ecf20Sopenharmony_ci goto out_free_irq; 9628c2ecf20Sopenharmony_ci } 9638c2ecf20Sopenharmony_ci } 9648c2ecf20Sopenharmony_ci 9658c2ecf20Sopenharmony_ci return SUCCESS; 9668c2ecf20Sopenharmony_ciout_free_irq: 9678c2ecf20Sopenharmony_ci while (--i >= 0) 9688c2ecf20Sopenharmony_ci free_irq(pci_irq_vector(pdev, i), acb); 9698c2ecf20Sopenharmony_ci pci_free_irq_vectors(pdev); 9708c2ecf20Sopenharmony_ci return FAILED; 9718c2ecf20Sopenharmony_ci} 9728c2ecf20Sopenharmony_ci 9738c2ecf20Sopenharmony_cistatic void arcmsr_init_get_devmap_timer(struct AdapterControlBlock *pacb) 9748c2ecf20Sopenharmony_ci{ 9758c2ecf20Sopenharmony_ci INIT_WORK(&pacb->arcmsr_do_message_isr_bh, arcmsr_message_isr_bh_fn); 9768c2ecf20Sopenharmony_ci pacb->fw_flag = FW_NORMAL; 9778c2ecf20Sopenharmony_ci timer_setup(&pacb->eternal_timer, arcmsr_request_device_map, 0); 9788c2ecf20Sopenharmony_ci pacb->eternal_timer.expires = jiffies + msecs_to_jiffies(6 * HZ); 9798c2ecf20Sopenharmony_ci add_timer(&pacb->eternal_timer); 9808c2ecf20Sopenharmony_ci} 9818c2ecf20Sopenharmony_ci 9828c2ecf20Sopenharmony_cistatic void arcmsr_init_set_datetime_timer(struct AdapterControlBlock *pacb) 9838c2ecf20Sopenharmony_ci{ 9848c2ecf20Sopenharmony_ci timer_setup(&pacb->refresh_timer, arcmsr_set_iop_datetime, 0); 9858c2ecf20Sopenharmony_ci pacb->refresh_timer.expires = jiffies + msecs_to_jiffies(60 * 1000); 9868c2ecf20Sopenharmony_ci add_timer(&pacb->refresh_timer); 9878c2ecf20Sopenharmony_ci} 9888c2ecf20Sopenharmony_ci 9898c2ecf20Sopenharmony_cistatic int arcmsr_set_dma_mask(struct AdapterControlBlock *acb) 9908c2ecf20Sopenharmony_ci{ 9918c2ecf20Sopenharmony_ci struct pci_dev *pcidev = acb->pdev; 9928c2ecf20Sopenharmony_ci 9938c2ecf20Sopenharmony_ci if (IS_DMA64) { 9948c2ecf20Sopenharmony_ci if (((acb->adapter_type == ACB_ADAPTER_TYPE_A) && !dma_mask_64) || 9958c2ecf20Sopenharmony_ci dma_set_mask(&pcidev->dev, DMA_BIT_MASK(64))) 9968c2ecf20Sopenharmony_ci goto dma32; 9978c2ecf20Sopenharmony_ci if (dma_set_coherent_mask(&pcidev->dev, DMA_BIT_MASK(64)) || 9988c2ecf20Sopenharmony_ci dma_set_mask_and_coherent(&pcidev->dev, DMA_BIT_MASK(64))) { 9998c2ecf20Sopenharmony_ci printk("arcmsr: set DMA 64 mask failed\n"); 10008c2ecf20Sopenharmony_ci return -ENXIO; 10018c2ecf20Sopenharmony_ci } 10028c2ecf20Sopenharmony_ci } else { 10038c2ecf20Sopenharmony_cidma32: 10048c2ecf20Sopenharmony_ci if (dma_set_mask(&pcidev->dev, DMA_BIT_MASK(32)) || 10058c2ecf20Sopenharmony_ci dma_set_coherent_mask(&pcidev->dev, DMA_BIT_MASK(32)) || 10068c2ecf20Sopenharmony_ci dma_set_mask_and_coherent(&pcidev->dev, DMA_BIT_MASK(32))) { 10078c2ecf20Sopenharmony_ci printk("arcmsr: set DMA 32-bit mask failed\n"); 10088c2ecf20Sopenharmony_ci return -ENXIO; 10098c2ecf20Sopenharmony_ci } 10108c2ecf20Sopenharmony_ci } 10118c2ecf20Sopenharmony_ci return 0; 10128c2ecf20Sopenharmony_ci} 10138c2ecf20Sopenharmony_ci 10148c2ecf20Sopenharmony_cistatic int arcmsr_probe(struct pci_dev *pdev, const struct pci_device_id *id) 10158c2ecf20Sopenharmony_ci{ 10168c2ecf20Sopenharmony_ci struct Scsi_Host *host; 10178c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb; 10188c2ecf20Sopenharmony_ci uint8_t bus,dev_fun; 10198c2ecf20Sopenharmony_ci int error; 10208c2ecf20Sopenharmony_ci error = pci_enable_device(pdev); 10218c2ecf20Sopenharmony_ci if(error){ 10228c2ecf20Sopenharmony_ci return -ENODEV; 10238c2ecf20Sopenharmony_ci } 10248c2ecf20Sopenharmony_ci host = scsi_host_alloc(&arcmsr_scsi_host_template, sizeof(struct AdapterControlBlock)); 10258c2ecf20Sopenharmony_ci if(!host){ 10268c2ecf20Sopenharmony_ci goto pci_disable_dev; 10278c2ecf20Sopenharmony_ci } 10288c2ecf20Sopenharmony_ci init_waitqueue_head(&wait_q); 10298c2ecf20Sopenharmony_ci bus = pdev->bus->number; 10308c2ecf20Sopenharmony_ci dev_fun = pdev->devfn; 10318c2ecf20Sopenharmony_ci acb = (struct AdapterControlBlock *) host->hostdata; 10328c2ecf20Sopenharmony_ci memset(acb,0,sizeof(struct AdapterControlBlock)); 10338c2ecf20Sopenharmony_ci acb->pdev = pdev; 10348c2ecf20Sopenharmony_ci acb->adapter_type = id->driver_data; 10358c2ecf20Sopenharmony_ci if (arcmsr_set_dma_mask(acb)) 10368c2ecf20Sopenharmony_ci goto scsi_host_release; 10378c2ecf20Sopenharmony_ci acb->host = host; 10388c2ecf20Sopenharmony_ci host->max_lun = ARCMSR_MAX_TARGETLUN; 10398c2ecf20Sopenharmony_ci host->max_id = ARCMSR_MAX_TARGETID; /*16:8*/ 10408c2ecf20Sopenharmony_ci host->max_cmd_len = 16; /*this is issue of 64bit LBA ,over 2T byte*/ 10418c2ecf20Sopenharmony_ci if ((host_can_queue < ARCMSR_MIN_OUTSTANDING_CMD) || (host_can_queue > ARCMSR_MAX_OUTSTANDING_CMD)) 10428c2ecf20Sopenharmony_ci host_can_queue = ARCMSR_DEFAULT_OUTSTANDING_CMD; 10438c2ecf20Sopenharmony_ci host->can_queue = host_can_queue; /* max simultaneous cmds */ 10448c2ecf20Sopenharmony_ci if ((cmd_per_lun < ARCMSR_MIN_CMD_PERLUN) || (cmd_per_lun > ARCMSR_MAX_CMD_PERLUN)) 10458c2ecf20Sopenharmony_ci cmd_per_lun = ARCMSR_DEFAULT_CMD_PERLUN; 10468c2ecf20Sopenharmony_ci host->cmd_per_lun = cmd_per_lun; 10478c2ecf20Sopenharmony_ci host->this_id = ARCMSR_SCSI_INITIATOR_ID; 10488c2ecf20Sopenharmony_ci host->unique_id = (bus << 8) | dev_fun; 10498c2ecf20Sopenharmony_ci pci_set_drvdata(pdev, host); 10508c2ecf20Sopenharmony_ci pci_set_master(pdev); 10518c2ecf20Sopenharmony_ci error = pci_request_regions(pdev, "arcmsr"); 10528c2ecf20Sopenharmony_ci if(error){ 10538c2ecf20Sopenharmony_ci goto scsi_host_release; 10548c2ecf20Sopenharmony_ci } 10558c2ecf20Sopenharmony_ci spin_lock_init(&acb->eh_lock); 10568c2ecf20Sopenharmony_ci spin_lock_init(&acb->ccblist_lock); 10578c2ecf20Sopenharmony_ci spin_lock_init(&acb->postq_lock); 10588c2ecf20Sopenharmony_ci spin_lock_init(&acb->doneq_lock); 10598c2ecf20Sopenharmony_ci spin_lock_init(&acb->rqbuffer_lock); 10608c2ecf20Sopenharmony_ci spin_lock_init(&acb->wqbuffer_lock); 10618c2ecf20Sopenharmony_ci acb->acb_flags |= (ACB_F_MESSAGE_WQBUFFER_CLEARED | 10628c2ecf20Sopenharmony_ci ACB_F_MESSAGE_RQBUFFER_CLEARED | 10638c2ecf20Sopenharmony_ci ACB_F_MESSAGE_WQBUFFER_READED); 10648c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_SCSISTOPADAPTER; 10658c2ecf20Sopenharmony_ci INIT_LIST_HEAD(&acb->ccb_free_list); 10668c2ecf20Sopenharmony_ci error = arcmsr_remap_pciregion(acb); 10678c2ecf20Sopenharmony_ci if(!error){ 10688c2ecf20Sopenharmony_ci goto pci_release_regs; 10698c2ecf20Sopenharmony_ci } 10708c2ecf20Sopenharmony_ci error = arcmsr_alloc_io_queue(acb); 10718c2ecf20Sopenharmony_ci if (!error) 10728c2ecf20Sopenharmony_ci goto unmap_pci_region; 10738c2ecf20Sopenharmony_ci error = arcmsr_get_firmware_spec(acb); 10748c2ecf20Sopenharmony_ci if(!error){ 10758c2ecf20Sopenharmony_ci goto free_hbb_mu; 10768c2ecf20Sopenharmony_ci } 10778c2ecf20Sopenharmony_ci if (acb->adapter_type != ACB_ADAPTER_TYPE_F) 10788c2ecf20Sopenharmony_ci arcmsr_free_io_queue(acb); 10798c2ecf20Sopenharmony_ci error = arcmsr_alloc_ccb_pool(acb); 10808c2ecf20Sopenharmony_ci if(error){ 10818c2ecf20Sopenharmony_ci goto unmap_pci_region; 10828c2ecf20Sopenharmony_ci } 10838c2ecf20Sopenharmony_ci error = scsi_add_host(host, &pdev->dev); 10848c2ecf20Sopenharmony_ci if(error){ 10858c2ecf20Sopenharmony_ci goto free_ccb_pool; 10868c2ecf20Sopenharmony_ci } 10878c2ecf20Sopenharmony_ci if (arcmsr_request_irq(pdev, acb) == FAILED) 10888c2ecf20Sopenharmony_ci goto scsi_host_remove; 10898c2ecf20Sopenharmony_ci arcmsr_iop_init(acb); 10908c2ecf20Sopenharmony_ci arcmsr_init_get_devmap_timer(acb); 10918c2ecf20Sopenharmony_ci if (set_date_time) 10928c2ecf20Sopenharmony_ci arcmsr_init_set_datetime_timer(acb); 10938c2ecf20Sopenharmony_ci if(arcmsr_alloc_sysfs_attr(acb)) 10948c2ecf20Sopenharmony_ci goto out_free_sysfs; 10958c2ecf20Sopenharmony_ci scsi_scan_host(host); 10968c2ecf20Sopenharmony_ci return 0; 10978c2ecf20Sopenharmony_ciout_free_sysfs: 10988c2ecf20Sopenharmony_ci if (set_date_time) 10998c2ecf20Sopenharmony_ci del_timer_sync(&acb->refresh_timer); 11008c2ecf20Sopenharmony_ci del_timer_sync(&acb->eternal_timer); 11018c2ecf20Sopenharmony_ci flush_work(&acb->arcmsr_do_message_isr_bh); 11028c2ecf20Sopenharmony_ci arcmsr_stop_adapter_bgrb(acb); 11038c2ecf20Sopenharmony_ci arcmsr_flush_adapter_cache(acb); 11048c2ecf20Sopenharmony_ci arcmsr_free_irq(pdev, acb); 11058c2ecf20Sopenharmony_ciscsi_host_remove: 11068c2ecf20Sopenharmony_ci scsi_remove_host(host); 11078c2ecf20Sopenharmony_cifree_ccb_pool: 11088c2ecf20Sopenharmony_ci arcmsr_free_ccb_pool(acb); 11098c2ecf20Sopenharmony_ci goto unmap_pci_region; 11108c2ecf20Sopenharmony_cifree_hbb_mu: 11118c2ecf20Sopenharmony_ci arcmsr_free_io_queue(acb); 11128c2ecf20Sopenharmony_ciunmap_pci_region: 11138c2ecf20Sopenharmony_ci arcmsr_unmap_pciregion(acb); 11148c2ecf20Sopenharmony_cipci_release_regs: 11158c2ecf20Sopenharmony_ci pci_release_regions(pdev); 11168c2ecf20Sopenharmony_ciscsi_host_release: 11178c2ecf20Sopenharmony_ci scsi_host_put(host); 11188c2ecf20Sopenharmony_cipci_disable_dev: 11198c2ecf20Sopenharmony_ci pci_disable_device(pdev); 11208c2ecf20Sopenharmony_ci return -ENODEV; 11218c2ecf20Sopenharmony_ci} 11228c2ecf20Sopenharmony_ci 11238c2ecf20Sopenharmony_cistatic void arcmsr_free_irq(struct pci_dev *pdev, 11248c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb) 11258c2ecf20Sopenharmony_ci{ 11268c2ecf20Sopenharmony_ci int i; 11278c2ecf20Sopenharmony_ci 11288c2ecf20Sopenharmony_ci for (i = 0; i < acb->vector_count; i++) 11298c2ecf20Sopenharmony_ci free_irq(pci_irq_vector(pdev, i), acb); 11308c2ecf20Sopenharmony_ci pci_free_irq_vectors(pdev); 11318c2ecf20Sopenharmony_ci} 11328c2ecf20Sopenharmony_ci 11338c2ecf20Sopenharmony_cistatic int arcmsr_suspend(struct pci_dev *pdev, pm_message_t state) 11348c2ecf20Sopenharmony_ci{ 11358c2ecf20Sopenharmony_ci struct Scsi_Host *host = pci_get_drvdata(pdev); 11368c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb = 11378c2ecf20Sopenharmony_ci (struct AdapterControlBlock *)host->hostdata; 11388c2ecf20Sopenharmony_ci 11398c2ecf20Sopenharmony_ci arcmsr_disable_outbound_ints(acb); 11408c2ecf20Sopenharmony_ci arcmsr_free_irq(pdev, acb); 11418c2ecf20Sopenharmony_ci del_timer_sync(&acb->eternal_timer); 11428c2ecf20Sopenharmony_ci if (set_date_time) 11438c2ecf20Sopenharmony_ci del_timer_sync(&acb->refresh_timer); 11448c2ecf20Sopenharmony_ci flush_work(&acb->arcmsr_do_message_isr_bh); 11458c2ecf20Sopenharmony_ci arcmsr_stop_adapter_bgrb(acb); 11468c2ecf20Sopenharmony_ci arcmsr_flush_adapter_cache(acb); 11478c2ecf20Sopenharmony_ci pci_set_drvdata(pdev, host); 11488c2ecf20Sopenharmony_ci pci_save_state(pdev); 11498c2ecf20Sopenharmony_ci pci_disable_device(pdev); 11508c2ecf20Sopenharmony_ci pci_set_power_state(pdev, pci_choose_state(pdev, state)); 11518c2ecf20Sopenharmony_ci return 0; 11528c2ecf20Sopenharmony_ci} 11538c2ecf20Sopenharmony_ci 11548c2ecf20Sopenharmony_cistatic int arcmsr_resume(struct pci_dev *pdev) 11558c2ecf20Sopenharmony_ci{ 11568c2ecf20Sopenharmony_ci struct Scsi_Host *host = pci_get_drvdata(pdev); 11578c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb = 11588c2ecf20Sopenharmony_ci (struct AdapterControlBlock *)host->hostdata; 11598c2ecf20Sopenharmony_ci 11608c2ecf20Sopenharmony_ci pci_set_power_state(pdev, PCI_D0); 11618c2ecf20Sopenharmony_ci pci_enable_wake(pdev, PCI_D0, 0); 11628c2ecf20Sopenharmony_ci pci_restore_state(pdev); 11638c2ecf20Sopenharmony_ci if (pci_enable_device(pdev)) { 11648c2ecf20Sopenharmony_ci pr_warn("%s: pci_enable_device error\n", __func__); 11658c2ecf20Sopenharmony_ci return -ENODEV; 11668c2ecf20Sopenharmony_ci } 11678c2ecf20Sopenharmony_ci if (arcmsr_set_dma_mask(acb)) 11688c2ecf20Sopenharmony_ci goto controller_unregister; 11698c2ecf20Sopenharmony_ci pci_set_master(pdev); 11708c2ecf20Sopenharmony_ci if (arcmsr_request_irq(pdev, acb) == FAILED) 11718c2ecf20Sopenharmony_ci goto controller_stop; 11728c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 11738c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 11748c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 11758c2ecf20Sopenharmony_ci uint32_t i; 11768c2ecf20Sopenharmony_ci for (i = 0; i < ARCMSR_MAX_HBB_POSTQUEUE; i++) { 11778c2ecf20Sopenharmony_ci reg->post_qbuffer[i] = 0; 11788c2ecf20Sopenharmony_ci reg->done_qbuffer[i] = 0; 11798c2ecf20Sopenharmony_ci } 11808c2ecf20Sopenharmony_ci reg->postq_index = 0; 11818c2ecf20Sopenharmony_ci reg->doneq_index = 0; 11828c2ecf20Sopenharmony_ci break; 11838c2ecf20Sopenharmony_ci } 11848c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 11858c2ecf20Sopenharmony_ci writel(0, &acb->pmuE->host_int_status); 11868c2ecf20Sopenharmony_ci writel(ARCMSR_HBEMU_DOORBELL_SYNC, &acb->pmuE->iobound_doorbell); 11878c2ecf20Sopenharmony_ci acb->in_doorbell = 0; 11888c2ecf20Sopenharmony_ci acb->out_doorbell = 0; 11898c2ecf20Sopenharmony_ci acb->doneq_index = 0; 11908c2ecf20Sopenharmony_ci break; 11918c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 11928c2ecf20Sopenharmony_ci writel(0, &acb->pmuF->host_int_status); 11938c2ecf20Sopenharmony_ci writel(ARCMSR_HBFMU_DOORBELL_SYNC, &acb->pmuF->iobound_doorbell); 11948c2ecf20Sopenharmony_ci acb->in_doorbell = 0; 11958c2ecf20Sopenharmony_ci acb->out_doorbell = 0; 11968c2ecf20Sopenharmony_ci acb->doneq_index = 0; 11978c2ecf20Sopenharmony_ci arcmsr_hbaF_assign_regAddr(acb); 11988c2ecf20Sopenharmony_ci break; 11998c2ecf20Sopenharmony_ci } 12008c2ecf20Sopenharmony_ci arcmsr_iop_init(acb); 12018c2ecf20Sopenharmony_ci arcmsr_init_get_devmap_timer(acb); 12028c2ecf20Sopenharmony_ci if (set_date_time) 12038c2ecf20Sopenharmony_ci arcmsr_init_set_datetime_timer(acb); 12048c2ecf20Sopenharmony_ci return 0; 12058c2ecf20Sopenharmony_cicontroller_stop: 12068c2ecf20Sopenharmony_ci arcmsr_stop_adapter_bgrb(acb); 12078c2ecf20Sopenharmony_ci arcmsr_flush_adapter_cache(acb); 12088c2ecf20Sopenharmony_cicontroller_unregister: 12098c2ecf20Sopenharmony_ci scsi_remove_host(host); 12108c2ecf20Sopenharmony_ci arcmsr_free_ccb_pool(acb); 12118c2ecf20Sopenharmony_ci if (acb->adapter_type == ACB_ADAPTER_TYPE_F) 12128c2ecf20Sopenharmony_ci arcmsr_free_io_queue(acb); 12138c2ecf20Sopenharmony_ci arcmsr_unmap_pciregion(acb); 12148c2ecf20Sopenharmony_ci pci_release_regions(pdev); 12158c2ecf20Sopenharmony_ci scsi_host_put(host); 12168c2ecf20Sopenharmony_ci pci_disable_device(pdev); 12178c2ecf20Sopenharmony_ci return -ENODEV; 12188c2ecf20Sopenharmony_ci} 12198c2ecf20Sopenharmony_ci 12208c2ecf20Sopenharmony_cistatic uint8_t arcmsr_hbaA_abort_allcmd(struct AdapterControlBlock *acb) 12218c2ecf20Sopenharmony_ci{ 12228c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 12238c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_ABORT_CMD, ®->inbound_msgaddr0); 12248c2ecf20Sopenharmony_ci if (!arcmsr_hbaA_wait_msgint_ready(acb)) { 12258c2ecf20Sopenharmony_ci printk(KERN_NOTICE 12268c2ecf20Sopenharmony_ci "arcmsr%d: wait 'abort all outstanding command' timeout\n" 12278c2ecf20Sopenharmony_ci , acb->host->host_no); 12288c2ecf20Sopenharmony_ci return false; 12298c2ecf20Sopenharmony_ci } 12308c2ecf20Sopenharmony_ci return true; 12318c2ecf20Sopenharmony_ci} 12328c2ecf20Sopenharmony_ci 12338c2ecf20Sopenharmony_cistatic uint8_t arcmsr_hbaB_abort_allcmd(struct AdapterControlBlock *acb) 12348c2ecf20Sopenharmony_ci{ 12358c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 12368c2ecf20Sopenharmony_ci 12378c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_ABORT_CMD, reg->drv2iop_doorbell); 12388c2ecf20Sopenharmony_ci if (!arcmsr_hbaB_wait_msgint_ready(acb)) { 12398c2ecf20Sopenharmony_ci printk(KERN_NOTICE 12408c2ecf20Sopenharmony_ci "arcmsr%d: wait 'abort all outstanding command' timeout\n" 12418c2ecf20Sopenharmony_ci , acb->host->host_no); 12428c2ecf20Sopenharmony_ci return false; 12438c2ecf20Sopenharmony_ci } 12448c2ecf20Sopenharmony_ci return true; 12458c2ecf20Sopenharmony_ci} 12468c2ecf20Sopenharmony_cistatic uint8_t arcmsr_hbaC_abort_allcmd(struct AdapterControlBlock *pACB) 12478c2ecf20Sopenharmony_ci{ 12488c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = pACB->pmuC; 12498c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_ABORT_CMD, ®->inbound_msgaddr0); 12508c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, ®->inbound_doorbell); 12518c2ecf20Sopenharmony_ci if (!arcmsr_hbaC_wait_msgint_ready(pACB)) { 12528c2ecf20Sopenharmony_ci printk(KERN_NOTICE 12538c2ecf20Sopenharmony_ci "arcmsr%d: wait 'abort all outstanding command' timeout\n" 12548c2ecf20Sopenharmony_ci , pACB->host->host_no); 12558c2ecf20Sopenharmony_ci return false; 12568c2ecf20Sopenharmony_ci } 12578c2ecf20Sopenharmony_ci return true; 12588c2ecf20Sopenharmony_ci} 12598c2ecf20Sopenharmony_ci 12608c2ecf20Sopenharmony_cistatic uint8_t arcmsr_hbaD_abort_allcmd(struct AdapterControlBlock *pACB) 12618c2ecf20Sopenharmony_ci{ 12628c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = pACB->pmuD; 12638c2ecf20Sopenharmony_ci 12648c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_ABORT_CMD, reg->inbound_msgaddr0); 12658c2ecf20Sopenharmony_ci if (!arcmsr_hbaD_wait_msgint_ready(pACB)) { 12668c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: wait 'abort all outstanding " 12678c2ecf20Sopenharmony_ci "command' timeout\n", pACB->host->host_no); 12688c2ecf20Sopenharmony_ci return false; 12698c2ecf20Sopenharmony_ci } 12708c2ecf20Sopenharmony_ci return true; 12718c2ecf20Sopenharmony_ci} 12728c2ecf20Sopenharmony_ci 12738c2ecf20Sopenharmony_cistatic uint8_t arcmsr_hbaE_abort_allcmd(struct AdapterControlBlock *pACB) 12748c2ecf20Sopenharmony_ci{ 12758c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = pACB->pmuE; 12768c2ecf20Sopenharmony_ci 12778c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_ABORT_CMD, ®->inbound_msgaddr0); 12788c2ecf20Sopenharmony_ci pACB->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_MESSAGE_CMD_DONE; 12798c2ecf20Sopenharmony_ci writel(pACB->out_doorbell, ®->iobound_doorbell); 12808c2ecf20Sopenharmony_ci if (!arcmsr_hbaE_wait_msgint_ready(pACB)) { 12818c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: wait 'abort all outstanding " 12828c2ecf20Sopenharmony_ci "command' timeout\n", pACB->host->host_no); 12838c2ecf20Sopenharmony_ci return false; 12848c2ecf20Sopenharmony_ci } 12858c2ecf20Sopenharmony_ci return true; 12868c2ecf20Sopenharmony_ci} 12878c2ecf20Sopenharmony_ci 12888c2ecf20Sopenharmony_cistatic uint8_t arcmsr_abort_allcmd(struct AdapterControlBlock *acb) 12898c2ecf20Sopenharmony_ci{ 12908c2ecf20Sopenharmony_ci uint8_t rtnval = 0; 12918c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 12928c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: 12938c2ecf20Sopenharmony_ci rtnval = arcmsr_hbaA_abort_allcmd(acb); 12948c2ecf20Sopenharmony_ci break; 12958c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: 12968c2ecf20Sopenharmony_ci rtnval = arcmsr_hbaB_abort_allcmd(acb); 12978c2ecf20Sopenharmony_ci break; 12988c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: 12998c2ecf20Sopenharmony_ci rtnval = arcmsr_hbaC_abort_allcmd(acb); 13008c2ecf20Sopenharmony_ci break; 13018c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: 13028c2ecf20Sopenharmony_ci rtnval = arcmsr_hbaD_abort_allcmd(acb); 13038c2ecf20Sopenharmony_ci break; 13048c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 13058c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 13068c2ecf20Sopenharmony_ci rtnval = arcmsr_hbaE_abort_allcmd(acb); 13078c2ecf20Sopenharmony_ci break; 13088c2ecf20Sopenharmony_ci } 13098c2ecf20Sopenharmony_ci return rtnval; 13108c2ecf20Sopenharmony_ci} 13118c2ecf20Sopenharmony_ci 13128c2ecf20Sopenharmony_cistatic void arcmsr_pci_unmap_dma(struct CommandControlBlock *ccb) 13138c2ecf20Sopenharmony_ci{ 13148c2ecf20Sopenharmony_ci struct scsi_cmnd *pcmd = ccb->pcmd; 13158c2ecf20Sopenharmony_ci 13168c2ecf20Sopenharmony_ci scsi_dma_unmap(pcmd); 13178c2ecf20Sopenharmony_ci} 13188c2ecf20Sopenharmony_ci 13198c2ecf20Sopenharmony_cistatic void arcmsr_ccb_complete(struct CommandControlBlock *ccb) 13208c2ecf20Sopenharmony_ci{ 13218c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb = ccb->acb; 13228c2ecf20Sopenharmony_ci struct scsi_cmnd *pcmd = ccb->pcmd; 13238c2ecf20Sopenharmony_ci unsigned long flags; 13248c2ecf20Sopenharmony_ci atomic_dec(&acb->ccboutstandingcount); 13258c2ecf20Sopenharmony_ci arcmsr_pci_unmap_dma(ccb); 13268c2ecf20Sopenharmony_ci ccb->startdone = ARCMSR_CCB_DONE; 13278c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->ccblist_lock, flags); 13288c2ecf20Sopenharmony_ci list_add_tail(&ccb->list, &acb->ccb_free_list); 13298c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->ccblist_lock, flags); 13308c2ecf20Sopenharmony_ci pcmd->scsi_done(pcmd); 13318c2ecf20Sopenharmony_ci} 13328c2ecf20Sopenharmony_ci 13338c2ecf20Sopenharmony_cistatic void arcmsr_report_sense_info(struct CommandControlBlock *ccb) 13348c2ecf20Sopenharmony_ci{ 13358c2ecf20Sopenharmony_ci 13368c2ecf20Sopenharmony_ci struct scsi_cmnd *pcmd = ccb->pcmd; 13378c2ecf20Sopenharmony_ci struct SENSE_DATA *sensebuffer = (struct SENSE_DATA *)pcmd->sense_buffer; 13388c2ecf20Sopenharmony_ci pcmd->result = (DID_OK << 16) | (CHECK_CONDITION << 1); 13398c2ecf20Sopenharmony_ci if (sensebuffer) { 13408c2ecf20Sopenharmony_ci int sense_data_length = 13418c2ecf20Sopenharmony_ci sizeof(struct SENSE_DATA) < SCSI_SENSE_BUFFERSIZE 13428c2ecf20Sopenharmony_ci ? sizeof(struct SENSE_DATA) : SCSI_SENSE_BUFFERSIZE; 13438c2ecf20Sopenharmony_ci memset(sensebuffer, 0, SCSI_SENSE_BUFFERSIZE); 13448c2ecf20Sopenharmony_ci memcpy(sensebuffer, ccb->arcmsr_cdb.SenseData, sense_data_length); 13458c2ecf20Sopenharmony_ci sensebuffer->ErrorCode = SCSI_SENSE_CURRENT_ERRORS; 13468c2ecf20Sopenharmony_ci sensebuffer->Valid = 1; 13478c2ecf20Sopenharmony_ci pcmd->result |= (DRIVER_SENSE << 24); 13488c2ecf20Sopenharmony_ci } 13498c2ecf20Sopenharmony_ci} 13508c2ecf20Sopenharmony_ci 13518c2ecf20Sopenharmony_cistatic u32 arcmsr_disable_outbound_ints(struct AdapterControlBlock *acb) 13528c2ecf20Sopenharmony_ci{ 13538c2ecf20Sopenharmony_ci u32 orig_mask = 0; 13548c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 13558c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A : { 13568c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 13578c2ecf20Sopenharmony_ci orig_mask = readl(®->outbound_intmask); 13588c2ecf20Sopenharmony_ci writel(orig_mask|ARCMSR_MU_OUTBOUND_ALL_INTMASKENABLE, \ 13598c2ecf20Sopenharmony_ci ®->outbound_intmask); 13608c2ecf20Sopenharmony_ci } 13618c2ecf20Sopenharmony_ci break; 13628c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B : { 13638c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 13648c2ecf20Sopenharmony_ci orig_mask = readl(reg->iop2drv_doorbell_mask); 13658c2ecf20Sopenharmony_ci writel(0, reg->iop2drv_doorbell_mask); 13668c2ecf20Sopenharmony_ci } 13678c2ecf20Sopenharmony_ci break; 13688c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C:{ 13698c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 13708c2ecf20Sopenharmony_ci /* disable all outbound interrupt */ 13718c2ecf20Sopenharmony_ci orig_mask = readl(®->host_int_mask); /* disable outbound message0 int */ 13728c2ecf20Sopenharmony_ci writel(orig_mask|ARCMSR_HBCMU_ALL_INTMASKENABLE, ®->host_int_mask); 13738c2ecf20Sopenharmony_ci } 13748c2ecf20Sopenharmony_ci break; 13758c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 13768c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 13778c2ecf20Sopenharmony_ci /* disable all outbound interrupt */ 13788c2ecf20Sopenharmony_ci writel(ARCMSR_ARC1214_ALL_INT_DISABLE, reg->pcief0_int_enable); 13798c2ecf20Sopenharmony_ci } 13808c2ecf20Sopenharmony_ci break; 13818c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 13828c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 13838c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 13848c2ecf20Sopenharmony_ci orig_mask = readl(®->host_int_mask); 13858c2ecf20Sopenharmony_ci writel(orig_mask | ARCMSR_HBEMU_OUTBOUND_DOORBELL_ISR | ARCMSR_HBEMU_OUTBOUND_POSTQUEUE_ISR, ®->host_int_mask); 13868c2ecf20Sopenharmony_ci readl(®->host_int_mask); /* Dummy readl to force pci flush */ 13878c2ecf20Sopenharmony_ci } 13888c2ecf20Sopenharmony_ci break; 13898c2ecf20Sopenharmony_ci } 13908c2ecf20Sopenharmony_ci return orig_mask; 13918c2ecf20Sopenharmony_ci} 13928c2ecf20Sopenharmony_ci 13938c2ecf20Sopenharmony_cistatic void arcmsr_report_ccb_state(struct AdapterControlBlock *acb, 13948c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb, bool error) 13958c2ecf20Sopenharmony_ci{ 13968c2ecf20Sopenharmony_ci uint8_t id, lun; 13978c2ecf20Sopenharmony_ci id = ccb->pcmd->device->id; 13988c2ecf20Sopenharmony_ci lun = ccb->pcmd->device->lun; 13998c2ecf20Sopenharmony_ci if (!error) { 14008c2ecf20Sopenharmony_ci if (acb->devstate[id][lun] == ARECA_RAID_GONE) 14018c2ecf20Sopenharmony_ci acb->devstate[id][lun] = ARECA_RAID_GOOD; 14028c2ecf20Sopenharmony_ci ccb->pcmd->result = DID_OK << 16; 14038c2ecf20Sopenharmony_ci arcmsr_ccb_complete(ccb); 14048c2ecf20Sopenharmony_ci }else{ 14058c2ecf20Sopenharmony_ci switch (ccb->arcmsr_cdb.DeviceStatus) { 14068c2ecf20Sopenharmony_ci case ARCMSR_DEV_SELECT_TIMEOUT: { 14078c2ecf20Sopenharmony_ci acb->devstate[id][lun] = ARECA_RAID_GONE; 14088c2ecf20Sopenharmony_ci ccb->pcmd->result = DID_NO_CONNECT << 16; 14098c2ecf20Sopenharmony_ci arcmsr_ccb_complete(ccb); 14108c2ecf20Sopenharmony_ci } 14118c2ecf20Sopenharmony_ci break; 14128c2ecf20Sopenharmony_ci 14138c2ecf20Sopenharmony_ci case ARCMSR_DEV_ABORTED: 14148c2ecf20Sopenharmony_ci 14158c2ecf20Sopenharmony_ci case ARCMSR_DEV_INIT_FAIL: { 14168c2ecf20Sopenharmony_ci acb->devstate[id][lun] = ARECA_RAID_GONE; 14178c2ecf20Sopenharmony_ci ccb->pcmd->result = DID_BAD_TARGET << 16; 14188c2ecf20Sopenharmony_ci arcmsr_ccb_complete(ccb); 14198c2ecf20Sopenharmony_ci } 14208c2ecf20Sopenharmony_ci break; 14218c2ecf20Sopenharmony_ci 14228c2ecf20Sopenharmony_ci case ARCMSR_DEV_CHECK_CONDITION: { 14238c2ecf20Sopenharmony_ci acb->devstate[id][lun] = ARECA_RAID_GOOD; 14248c2ecf20Sopenharmony_ci arcmsr_report_sense_info(ccb); 14258c2ecf20Sopenharmony_ci arcmsr_ccb_complete(ccb); 14268c2ecf20Sopenharmony_ci } 14278c2ecf20Sopenharmony_ci break; 14288c2ecf20Sopenharmony_ci 14298c2ecf20Sopenharmony_ci default: 14308c2ecf20Sopenharmony_ci printk(KERN_NOTICE 14318c2ecf20Sopenharmony_ci "arcmsr%d: scsi id = %d lun = %d isr get command error done, \ 14328c2ecf20Sopenharmony_ci but got unknown DeviceStatus = 0x%x \n" 14338c2ecf20Sopenharmony_ci , acb->host->host_no 14348c2ecf20Sopenharmony_ci , id 14358c2ecf20Sopenharmony_ci , lun 14368c2ecf20Sopenharmony_ci , ccb->arcmsr_cdb.DeviceStatus); 14378c2ecf20Sopenharmony_ci acb->devstate[id][lun] = ARECA_RAID_GONE; 14388c2ecf20Sopenharmony_ci ccb->pcmd->result = DID_NO_CONNECT << 16; 14398c2ecf20Sopenharmony_ci arcmsr_ccb_complete(ccb); 14408c2ecf20Sopenharmony_ci break; 14418c2ecf20Sopenharmony_ci } 14428c2ecf20Sopenharmony_ci } 14438c2ecf20Sopenharmony_ci} 14448c2ecf20Sopenharmony_ci 14458c2ecf20Sopenharmony_cistatic void arcmsr_drain_donequeue(struct AdapterControlBlock *acb, struct CommandControlBlock *pCCB, bool error) 14468c2ecf20Sopenharmony_ci{ 14478c2ecf20Sopenharmony_ci if ((pCCB->acb != acb) || (pCCB->startdone != ARCMSR_CCB_START)) { 14488c2ecf20Sopenharmony_ci if (pCCB->startdone == ARCMSR_CCB_ABORTED) { 14498c2ecf20Sopenharmony_ci struct scsi_cmnd *abortcmd = pCCB->pcmd; 14508c2ecf20Sopenharmony_ci if (abortcmd) { 14518c2ecf20Sopenharmony_ci abortcmd->result |= DID_ABORT << 16; 14528c2ecf20Sopenharmony_ci arcmsr_ccb_complete(pCCB); 14538c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: pCCB ='0x%p' isr got aborted command \n", 14548c2ecf20Sopenharmony_ci acb->host->host_no, pCCB); 14558c2ecf20Sopenharmony_ci } 14568c2ecf20Sopenharmony_ci return; 14578c2ecf20Sopenharmony_ci } 14588c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: isr get an illegal ccb command \ 14598c2ecf20Sopenharmony_ci done acb = '0x%p'" 14608c2ecf20Sopenharmony_ci "ccb = '0x%p' ccbacb = '0x%p' startdone = 0x%x" 14618c2ecf20Sopenharmony_ci " ccboutstandingcount = %d \n" 14628c2ecf20Sopenharmony_ci , acb->host->host_no 14638c2ecf20Sopenharmony_ci , acb 14648c2ecf20Sopenharmony_ci , pCCB 14658c2ecf20Sopenharmony_ci , pCCB->acb 14668c2ecf20Sopenharmony_ci , pCCB->startdone 14678c2ecf20Sopenharmony_ci , atomic_read(&acb->ccboutstandingcount)); 14688c2ecf20Sopenharmony_ci return; 14698c2ecf20Sopenharmony_ci } 14708c2ecf20Sopenharmony_ci arcmsr_report_ccb_state(acb, pCCB, error); 14718c2ecf20Sopenharmony_ci} 14728c2ecf20Sopenharmony_ci 14738c2ecf20Sopenharmony_cistatic void arcmsr_done4abort_postqueue(struct AdapterControlBlock *acb) 14748c2ecf20Sopenharmony_ci{ 14758c2ecf20Sopenharmony_ci int i = 0; 14768c2ecf20Sopenharmony_ci uint32_t flag_ccb; 14778c2ecf20Sopenharmony_ci struct ARCMSR_CDB *pARCMSR_CDB; 14788c2ecf20Sopenharmony_ci bool error; 14798c2ecf20Sopenharmony_ci struct CommandControlBlock *pCCB; 14808c2ecf20Sopenharmony_ci unsigned long ccb_cdb_phy; 14818c2ecf20Sopenharmony_ci 14828c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 14838c2ecf20Sopenharmony_ci 14848c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: { 14858c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 14868c2ecf20Sopenharmony_ci uint32_t outbound_intstatus; 14878c2ecf20Sopenharmony_ci outbound_intstatus = readl(®->outbound_intstatus) & 14888c2ecf20Sopenharmony_ci acb->outbound_int_enable; 14898c2ecf20Sopenharmony_ci /*clear and abort all outbound posted Q*/ 14908c2ecf20Sopenharmony_ci writel(outbound_intstatus, ®->outbound_intstatus);/*clear interrupt*/ 14918c2ecf20Sopenharmony_ci while(((flag_ccb = readl(®->outbound_queueport)) != 0xFFFFFFFF) 14928c2ecf20Sopenharmony_ci && (i++ < acb->maxOutstanding)) { 14938c2ecf20Sopenharmony_ci ccb_cdb_phy = (flag_ccb << 5) & 0xffffffff; 14948c2ecf20Sopenharmony_ci if (acb->cdb_phyadd_hipart) 14958c2ecf20Sopenharmony_ci ccb_cdb_phy = ccb_cdb_phy | acb->cdb_phyadd_hipart; 14968c2ecf20Sopenharmony_ci pARCMSR_CDB = (struct ARCMSR_CDB *)(acb->vir2phy_offset + ccb_cdb_phy); 14978c2ecf20Sopenharmony_ci pCCB = container_of(pARCMSR_CDB, struct CommandControlBlock, arcmsr_cdb); 14988c2ecf20Sopenharmony_ci error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE0) ? true : false; 14998c2ecf20Sopenharmony_ci arcmsr_drain_donequeue(acb, pCCB, error); 15008c2ecf20Sopenharmony_ci } 15018c2ecf20Sopenharmony_ci } 15028c2ecf20Sopenharmony_ci break; 15038c2ecf20Sopenharmony_ci 15048c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 15058c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 15068c2ecf20Sopenharmony_ci /*clear all outbound posted Q*/ 15078c2ecf20Sopenharmony_ci writel(ARCMSR_DOORBELL_INT_CLEAR_PATTERN, reg->iop2drv_doorbell); /* clear doorbell interrupt */ 15088c2ecf20Sopenharmony_ci for (i = 0; i < ARCMSR_MAX_HBB_POSTQUEUE; i++) { 15098c2ecf20Sopenharmony_ci flag_ccb = reg->done_qbuffer[i]; 15108c2ecf20Sopenharmony_ci if (flag_ccb != 0) { 15118c2ecf20Sopenharmony_ci reg->done_qbuffer[i] = 0; 15128c2ecf20Sopenharmony_ci ccb_cdb_phy = (flag_ccb << 5) & 0xffffffff; 15138c2ecf20Sopenharmony_ci if (acb->cdb_phyadd_hipart) 15148c2ecf20Sopenharmony_ci ccb_cdb_phy = ccb_cdb_phy | acb->cdb_phyadd_hipart; 15158c2ecf20Sopenharmony_ci pARCMSR_CDB = (struct ARCMSR_CDB *)(acb->vir2phy_offset + ccb_cdb_phy); 15168c2ecf20Sopenharmony_ci pCCB = container_of(pARCMSR_CDB, struct CommandControlBlock, arcmsr_cdb); 15178c2ecf20Sopenharmony_ci error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE0) ? true : false; 15188c2ecf20Sopenharmony_ci arcmsr_drain_donequeue(acb, pCCB, error); 15198c2ecf20Sopenharmony_ci } 15208c2ecf20Sopenharmony_ci reg->post_qbuffer[i] = 0; 15218c2ecf20Sopenharmony_ci } 15228c2ecf20Sopenharmony_ci reg->doneq_index = 0; 15238c2ecf20Sopenharmony_ci reg->postq_index = 0; 15248c2ecf20Sopenharmony_ci } 15258c2ecf20Sopenharmony_ci break; 15268c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: { 15278c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 15288c2ecf20Sopenharmony_ci while ((readl(®->host_int_status) & ARCMSR_HBCMU_OUTBOUND_POSTQUEUE_ISR) && (i++ < acb->maxOutstanding)) { 15298c2ecf20Sopenharmony_ci /*need to do*/ 15308c2ecf20Sopenharmony_ci flag_ccb = readl(®->outbound_queueport_low); 15318c2ecf20Sopenharmony_ci ccb_cdb_phy = (flag_ccb & 0xFFFFFFF0); 15328c2ecf20Sopenharmony_ci if (acb->cdb_phyadd_hipart) 15338c2ecf20Sopenharmony_ci ccb_cdb_phy = ccb_cdb_phy | acb->cdb_phyadd_hipart; 15348c2ecf20Sopenharmony_ci pARCMSR_CDB = (struct ARCMSR_CDB *)(acb->vir2phy_offset + ccb_cdb_phy); 15358c2ecf20Sopenharmony_ci pCCB = container_of(pARCMSR_CDB, struct CommandControlBlock, arcmsr_cdb); 15368c2ecf20Sopenharmony_ci error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE1) ? true : false; 15378c2ecf20Sopenharmony_ci arcmsr_drain_donequeue(acb, pCCB, error); 15388c2ecf20Sopenharmony_ci } 15398c2ecf20Sopenharmony_ci } 15408c2ecf20Sopenharmony_ci break; 15418c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 15428c2ecf20Sopenharmony_ci struct MessageUnit_D *pmu = acb->pmuD; 15438c2ecf20Sopenharmony_ci uint32_t outbound_write_pointer; 15448c2ecf20Sopenharmony_ci uint32_t doneq_index, index_stripped, addressLow, residual, toggle; 15458c2ecf20Sopenharmony_ci unsigned long flags; 15468c2ecf20Sopenharmony_ci 15478c2ecf20Sopenharmony_ci residual = atomic_read(&acb->ccboutstandingcount); 15488c2ecf20Sopenharmony_ci for (i = 0; i < residual; i++) { 15498c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->doneq_lock, flags); 15508c2ecf20Sopenharmony_ci outbound_write_pointer = 15518c2ecf20Sopenharmony_ci pmu->done_qbuffer[0].addressLow + 1; 15528c2ecf20Sopenharmony_ci doneq_index = pmu->doneq_index; 15538c2ecf20Sopenharmony_ci if ((doneq_index & 0xFFF) != 15548c2ecf20Sopenharmony_ci (outbound_write_pointer & 0xFFF)) { 15558c2ecf20Sopenharmony_ci toggle = doneq_index & 0x4000; 15568c2ecf20Sopenharmony_ci index_stripped = (doneq_index & 0xFFF) + 1; 15578c2ecf20Sopenharmony_ci index_stripped %= ARCMSR_MAX_ARC1214_DONEQUEUE; 15588c2ecf20Sopenharmony_ci pmu->doneq_index = index_stripped ? (index_stripped | toggle) : 15598c2ecf20Sopenharmony_ci ((toggle ^ 0x4000) + 1); 15608c2ecf20Sopenharmony_ci doneq_index = pmu->doneq_index; 15618c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->doneq_lock, flags); 15628c2ecf20Sopenharmony_ci addressLow = pmu->done_qbuffer[doneq_index & 15638c2ecf20Sopenharmony_ci 0xFFF].addressLow; 15648c2ecf20Sopenharmony_ci ccb_cdb_phy = (addressLow & 0xFFFFFFF0); 15658c2ecf20Sopenharmony_ci if (acb->cdb_phyadd_hipart) 15668c2ecf20Sopenharmony_ci ccb_cdb_phy = ccb_cdb_phy | acb->cdb_phyadd_hipart; 15678c2ecf20Sopenharmony_ci pARCMSR_CDB = (struct ARCMSR_CDB *) 15688c2ecf20Sopenharmony_ci (acb->vir2phy_offset + ccb_cdb_phy); 15698c2ecf20Sopenharmony_ci pCCB = container_of(pARCMSR_CDB, 15708c2ecf20Sopenharmony_ci struct CommandControlBlock, arcmsr_cdb); 15718c2ecf20Sopenharmony_ci error = (addressLow & 15728c2ecf20Sopenharmony_ci ARCMSR_CCBREPLY_FLAG_ERROR_MODE1) ? 15738c2ecf20Sopenharmony_ci true : false; 15748c2ecf20Sopenharmony_ci arcmsr_drain_donequeue(acb, pCCB, error); 15758c2ecf20Sopenharmony_ci writel(doneq_index, 15768c2ecf20Sopenharmony_ci pmu->outboundlist_read_pointer); 15778c2ecf20Sopenharmony_ci } else { 15788c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->doneq_lock, flags); 15798c2ecf20Sopenharmony_ci mdelay(10); 15808c2ecf20Sopenharmony_ci } 15818c2ecf20Sopenharmony_ci } 15828c2ecf20Sopenharmony_ci pmu->postq_index = 0; 15838c2ecf20Sopenharmony_ci pmu->doneq_index = 0x40FF; 15848c2ecf20Sopenharmony_ci } 15858c2ecf20Sopenharmony_ci break; 15868c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 15878c2ecf20Sopenharmony_ci arcmsr_hbaE_postqueue_isr(acb); 15888c2ecf20Sopenharmony_ci break; 15898c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 15908c2ecf20Sopenharmony_ci arcmsr_hbaF_postqueue_isr(acb); 15918c2ecf20Sopenharmony_ci break; 15928c2ecf20Sopenharmony_ci } 15938c2ecf20Sopenharmony_ci} 15948c2ecf20Sopenharmony_ci 15958c2ecf20Sopenharmony_cistatic void arcmsr_remove_scsi_devices(struct AdapterControlBlock *acb) 15968c2ecf20Sopenharmony_ci{ 15978c2ecf20Sopenharmony_ci char *acb_dev_map = (char *)acb->device_map; 15988c2ecf20Sopenharmony_ci int target, lun, i; 15998c2ecf20Sopenharmony_ci struct scsi_device *psdev; 16008c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb; 16018c2ecf20Sopenharmony_ci char temp; 16028c2ecf20Sopenharmony_ci 16038c2ecf20Sopenharmony_ci for (i = 0; i < acb->maxFreeCCB; i++) { 16048c2ecf20Sopenharmony_ci ccb = acb->pccb_pool[i]; 16058c2ecf20Sopenharmony_ci if (ccb->startdone == ARCMSR_CCB_START) { 16068c2ecf20Sopenharmony_ci ccb->pcmd->result = DID_NO_CONNECT << 16; 16078c2ecf20Sopenharmony_ci arcmsr_pci_unmap_dma(ccb); 16088c2ecf20Sopenharmony_ci ccb->pcmd->scsi_done(ccb->pcmd); 16098c2ecf20Sopenharmony_ci } 16108c2ecf20Sopenharmony_ci } 16118c2ecf20Sopenharmony_ci for (target = 0; target < ARCMSR_MAX_TARGETID; target++) { 16128c2ecf20Sopenharmony_ci temp = *acb_dev_map; 16138c2ecf20Sopenharmony_ci if (temp) { 16148c2ecf20Sopenharmony_ci for (lun = 0; lun < ARCMSR_MAX_TARGETLUN; lun++) { 16158c2ecf20Sopenharmony_ci if (temp & 1) { 16168c2ecf20Sopenharmony_ci psdev = scsi_device_lookup(acb->host, 16178c2ecf20Sopenharmony_ci 0, target, lun); 16188c2ecf20Sopenharmony_ci if (psdev != NULL) { 16198c2ecf20Sopenharmony_ci scsi_remove_device(psdev); 16208c2ecf20Sopenharmony_ci scsi_device_put(psdev); 16218c2ecf20Sopenharmony_ci } 16228c2ecf20Sopenharmony_ci } 16238c2ecf20Sopenharmony_ci temp >>= 1; 16248c2ecf20Sopenharmony_ci } 16258c2ecf20Sopenharmony_ci *acb_dev_map = 0; 16268c2ecf20Sopenharmony_ci } 16278c2ecf20Sopenharmony_ci acb_dev_map++; 16288c2ecf20Sopenharmony_ci } 16298c2ecf20Sopenharmony_ci} 16308c2ecf20Sopenharmony_ci 16318c2ecf20Sopenharmony_cistatic void arcmsr_free_pcidev(struct AdapterControlBlock *acb) 16328c2ecf20Sopenharmony_ci{ 16338c2ecf20Sopenharmony_ci struct pci_dev *pdev; 16348c2ecf20Sopenharmony_ci struct Scsi_Host *host; 16358c2ecf20Sopenharmony_ci 16368c2ecf20Sopenharmony_ci host = acb->host; 16378c2ecf20Sopenharmony_ci arcmsr_free_sysfs_attr(acb); 16388c2ecf20Sopenharmony_ci scsi_remove_host(host); 16398c2ecf20Sopenharmony_ci flush_work(&acb->arcmsr_do_message_isr_bh); 16408c2ecf20Sopenharmony_ci del_timer_sync(&acb->eternal_timer); 16418c2ecf20Sopenharmony_ci if (set_date_time) 16428c2ecf20Sopenharmony_ci del_timer_sync(&acb->refresh_timer); 16438c2ecf20Sopenharmony_ci pdev = acb->pdev; 16448c2ecf20Sopenharmony_ci arcmsr_free_irq(pdev, acb); 16458c2ecf20Sopenharmony_ci arcmsr_free_ccb_pool(acb); 16468c2ecf20Sopenharmony_ci if (acb->adapter_type == ACB_ADAPTER_TYPE_F) 16478c2ecf20Sopenharmony_ci arcmsr_free_io_queue(acb); 16488c2ecf20Sopenharmony_ci arcmsr_unmap_pciregion(acb); 16498c2ecf20Sopenharmony_ci pci_release_regions(pdev); 16508c2ecf20Sopenharmony_ci scsi_host_put(host); 16518c2ecf20Sopenharmony_ci pci_disable_device(pdev); 16528c2ecf20Sopenharmony_ci} 16538c2ecf20Sopenharmony_ci 16548c2ecf20Sopenharmony_cistatic void arcmsr_remove(struct pci_dev *pdev) 16558c2ecf20Sopenharmony_ci{ 16568c2ecf20Sopenharmony_ci struct Scsi_Host *host = pci_get_drvdata(pdev); 16578c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb = 16588c2ecf20Sopenharmony_ci (struct AdapterControlBlock *) host->hostdata; 16598c2ecf20Sopenharmony_ci int poll_count = 0; 16608c2ecf20Sopenharmony_ci uint16_t dev_id; 16618c2ecf20Sopenharmony_ci 16628c2ecf20Sopenharmony_ci pci_read_config_word(pdev, PCI_DEVICE_ID, &dev_id); 16638c2ecf20Sopenharmony_ci if (dev_id == 0xffff) { 16648c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_IOP_INITED; 16658c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_ADAPTER_REMOVED; 16668c2ecf20Sopenharmony_ci arcmsr_remove_scsi_devices(acb); 16678c2ecf20Sopenharmony_ci arcmsr_free_pcidev(acb); 16688c2ecf20Sopenharmony_ci return; 16698c2ecf20Sopenharmony_ci } 16708c2ecf20Sopenharmony_ci arcmsr_free_sysfs_attr(acb); 16718c2ecf20Sopenharmony_ci scsi_remove_host(host); 16728c2ecf20Sopenharmony_ci flush_work(&acb->arcmsr_do_message_isr_bh); 16738c2ecf20Sopenharmony_ci del_timer_sync(&acb->eternal_timer); 16748c2ecf20Sopenharmony_ci if (set_date_time) 16758c2ecf20Sopenharmony_ci del_timer_sync(&acb->refresh_timer); 16768c2ecf20Sopenharmony_ci arcmsr_disable_outbound_ints(acb); 16778c2ecf20Sopenharmony_ci arcmsr_stop_adapter_bgrb(acb); 16788c2ecf20Sopenharmony_ci arcmsr_flush_adapter_cache(acb); 16798c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_SCSISTOPADAPTER; 16808c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_IOP_INITED; 16818c2ecf20Sopenharmony_ci 16828c2ecf20Sopenharmony_ci for (poll_count = 0; poll_count < acb->maxOutstanding; poll_count++){ 16838c2ecf20Sopenharmony_ci if (!atomic_read(&acb->ccboutstandingcount)) 16848c2ecf20Sopenharmony_ci break; 16858c2ecf20Sopenharmony_ci arcmsr_interrupt(acb);/* FIXME: need spinlock */ 16868c2ecf20Sopenharmony_ci msleep(25); 16878c2ecf20Sopenharmony_ci } 16888c2ecf20Sopenharmony_ci 16898c2ecf20Sopenharmony_ci if (atomic_read(&acb->ccboutstandingcount)) { 16908c2ecf20Sopenharmony_ci int i; 16918c2ecf20Sopenharmony_ci 16928c2ecf20Sopenharmony_ci arcmsr_abort_allcmd(acb); 16938c2ecf20Sopenharmony_ci arcmsr_done4abort_postqueue(acb); 16948c2ecf20Sopenharmony_ci for (i = 0; i < acb->maxFreeCCB; i++) { 16958c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb = acb->pccb_pool[i]; 16968c2ecf20Sopenharmony_ci if (ccb->startdone == ARCMSR_CCB_START) { 16978c2ecf20Sopenharmony_ci ccb->startdone = ARCMSR_CCB_ABORTED; 16988c2ecf20Sopenharmony_ci ccb->pcmd->result = DID_ABORT << 16; 16998c2ecf20Sopenharmony_ci arcmsr_ccb_complete(ccb); 17008c2ecf20Sopenharmony_ci } 17018c2ecf20Sopenharmony_ci } 17028c2ecf20Sopenharmony_ci } 17038c2ecf20Sopenharmony_ci arcmsr_free_irq(pdev, acb); 17048c2ecf20Sopenharmony_ci arcmsr_free_ccb_pool(acb); 17058c2ecf20Sopenharmony_ci if (acb->adapter_type == ACB_ADAPTER_TYPE_F) 17068c2ecf20Sopenharmony_ci arcmsr_free_io_queue(acb); 17078c2ecf20Sopenharmony_ci arcmsr_unmap_pciregion(acb); 17088c2ecf20Sopenharmony_ci pci_release_regions(pdev); 17098c2ecf20Sopenharmony_ci scsi_host_put(host); 17108c2ecf20Sopenharmony_ci pci_disable_device(pdev); 17118c2ecf20Sopenharmony_ci} 17128c2ecf20Sopenharmony_ci 17138c2ecf20Sopenharmony_cistatic void arcmsr_shutdown(struct pci_dev *pdev) 17148c2ecf20Sopenharmony_ci{ 17158c2ecf20Sopenharmony_ci struct Scsi_Host *host = pci_get_drvdata(pdev); 17168c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb = 17178c2ecf20Sopenharmony_ci (struct AdapterControlBlock *)host->hostdata; 17188c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_ADAPTER_REMOVED) 17198c2ecf20Sopenharmony_ci return; 17208c2ecf20Sopenharmony_ci del_timer_sync(&acb->eternal_timer); 17218c2ecf20Sopenharmony_ci if (set_date_time) 17228c2ecf20Sopenharmony_ci del_timer_sync(&acb->refresh_timer); 17238c2ecf20Sopenharmony_ci arcmsr_disable_outbound_ints(acb); 17248c2ecf20Sopenharmony_ci arcmsr_free_irq(pdev, acb); 17258c2ecf20Sopenharmony_ci flush_work(&acb->arcmsr_do_message_isr_bh); 17268c2ecf20Sopenharmony_ci arcmsr_stop_adapter_bgrb(acb); 17278c2ecf20Sopenharmony_ci arcmsr_flush_adapter_cache(acb); 17288c2ecf20Sopenharmony_ci} 17298c2ecf20Sopenharmony_ci 17308c2ecf20Sopenharmony_cistatic int arcmsr_module_init(void) 17318c2ecf20Sopenharmony_ci{ 17328c2ecf20Sopenharmony_ci int error = 0; 17338c2ecf20Sopenharmony_ci error = pci_register_driver(&arcmsr_pci_driver); 17348c2ecf20Sopenharmony_ci return error; 17358c2ecf20Sopenharmony_ci} 17368c2ecf20Sopenharmony_ci 17378c2ecf20Sopenharmony_cistatic void arcmsr_module_exit(void) 17388c2ecf20Sopenharmony_ci{ 17398c2ecf20Sopenharmony_ci pci_unregister_driver(&arcmsr_pci_driver); 17408c2ecf20Sopenharmony_ci} 17418c2ecf20Sopenharmony_cimodule_init(arcmsr_module_init); 17428c2ecf20Sopenharmony_cimodule_exit(arcmsr_module_exit); 17438c2ecf20Sopenharmony_ci 17448c2ecf20Sopenharmony_cistatic void arcmsr_enable_outbound_ints(struct AdapterControlBlock *acb, 17458c2ecf20Sopenharmony_ci u32 intmask_org) 17468c2ecf20Sopenharmony_ci{ 17478c2ecf20Sopenharmony_ci u32 mask; 17488c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 17498c2ecf20Sopenharmony_ci 17508c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: { 17518c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 17528c2ecf20Sopenharmony_ci mask = intmask_org & ~(ARCMSR_MU_OUTBOUND_POSTQUEUE_INTMASKENABLE | 17538c2ecf20Sopenharmony_ci ARCMSR_MU_OUTBOUND_DOORBELL_INTMASKENABLE| 17548c2ecf20Sopenharmony_ci ARCMSR_MU_OUTBOUND_MESSAGE0_INTMASKENABLE); 17558c2ecf20Sopenharmony_ci writel(mask, ®->outbound_intmask); 17568c2ecf20Sopenharmony_ci acb->outbound_int_enable = ~(intmask_org & mask) & 0x000000ff; 17578c2ecf20Sopenharmony_ci } 17588c2ecf20Sopenharmony_ci break; 17598c2ecf20Sopenharmony_ci 17608c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 17618c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 17628c2ecf20Sopenharmony_ci mask = intmask_org | (ARCMSR_IOP2DRV_DATA_WRITE_OK | 17638c2ecf20Sopenharmony_ci ARCMSR_IOP2DRV_DATA_READ_OK | 17648c2ecf20Sopenharmony_ci ARCMSR_IOP2DRV_CDB_DONE | 17658c2ecf20Sopenharmony_ci ARCMSR_IOP2DRV_MESSAGE_CMD_DONE); 17668c2ecf20Sopenharmony_ci writel(mask, reg->iop2drv_doorbell_mask); 17678c2ecf20Sopenharmony_ci acb->outbound_int_enable = (intmask_org | mask) & 0x0000000f; 17688c2ecf20Sopenharmony_ci } 17698c2ecf20Sopenharmony_ci break; 17708c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: { 17718c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 17728c2ecf20Sopenharmony_ci mask = ~(ARCMSR_HBCMU_UTILITY_A_ISR_MASK | ARCMSR_HBCMU_OUTBOUND_DOORBELL_ISR_MASK|ARCMSR_HBCMU_OUTBOUND_POSTQUEUE_ISR_MASK); 17738c2ecf20Sopenharmony_ci writel(intmask_org & mask, ®->host_int_mask); 17748c2ecf20Sopenharmony_ci acb->outbound_int_enable = ~(intmask_org & mask) & 0x0000000f; 17758c2ecf20Sopenharmony_ci } 17768c2ecf20Sopenharmony_ci break; 17778c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 17788c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 17798c2ecf20Sopenharmony_ci 17808c2ecf20Sopenharmony_ci mask = ARCMSR_ARC1214_ALL_INT_ENABLE; 17818c2ecf20Sopenharmony_ci writel(intmask_org | mask, reg->pcief0_int_enable); 17828c2ecf20Sopenharmony_ci break; 17838c2ecf20Sopenharmony_ci } 17848c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 17858c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 17868c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 17878c2ecf20Sopenharmony_ci 17888c2ecf20Sopenharmony_ci mask = ~(ARCMSR_HBEMU_OUTBOUND_DOORBELL_ISR | ARCMSR_HBEMU_OUTBOUND_POSTQUEUE_ISR); 17898c2ecf20Sopenharmony_ci writel(intmask_org & mask, ®->host_int_mask); 17908c2ecf20Sopenharmony_ci break; 17918c2ecf20Sopenharmony_ci } 17928c2ecf20Sopenharmony_ci } 17938c2ecf20Sopenharmony_ci} 17948c2ecf20Sopenharmony_ci 17958c2ecf20Sopenharmony_cistatic int arcmsr_build_ccb(struct AdapterControlBlock *acb, 17968c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb, struct scsi_cmnd *pcmd) 17978c2ecf20Sopenharmony_ci{ 17988c2ecf20Sopenharmony_ci struct ARCMSR_CDB *arcmsr_cdb = (struct ARCMSR_CDB *)&ccb->arcmsr_cdb; 17998c2ecf20Sopenharmony_ci int8_t *psge = (int8_t *)&arcmsr_cdb->u; 18008c2ecf20Sopenharmony_ci __le32 address_lo, address_hi; 18018c2ecf20Sopenharmony_ci int arccdbsize = 0x30; 18028c2ecf20Sopenharmony_ci __le32 length = 0; 18038c2ecf20Sopenharmony_ci int i; 18048c2ecf20Sopenharmony_ci struct scatterlist *sg; 18058c2ecf20Sopenharmony_ci int nseg; 18068c2ecf20Sopenharmony_ci ccb->pcmd = pcmd; 18078c2ecf20Sopenharmony_ci memset(arcmsr_cdb, 0, sizeof(struct ARCMSR_CDB)); 18088c2ecf20Sopenharmony_ci arcmsr_cdb->TargetID = pcmd->device->id; 18098c2ecf20Sopenharmony_ci arcmsr_cdb->LUN = pcmd->device->lun; 18108c2ecf20Sopenharmony_ci arcmsr_cdb->Function = 1; 18118c2ecf20Sopenharmony_ci arcmsr_cdb->msgContext = 0; 18128c2ecf20Sopenharmony_ci memcpy(arcmsr_cdb->Cdb, pcmd->cmnd, pcmd->cmd_len); 18138c2ecf20Sopenharmony_ci 18148c2ecf20Sopenharmony_ci nseg = scsi_dma_map(pcmd); 18158c2ecf20Sopenharmony_ci if (unlikely(nseg > acb->host->sg_tablesize || nseg < 0)) 18168c2ecf20Sopenharmony_ci return FAILED; 18178c2ecf20Sopenharmony_ci scsi_for_each_sg(pcmd, sg, nseg, i) { 18188c2ecf20Sopenharmony_ci /* Get the physical address of the current data pointer */ 18198c2ecf20Sopenharmony_ci length = cpu_to_le32(sg_dma_len(sg)); 18208c2ecf20Sopenharmony_ci address_lo = cpu_to_le32(dma_addr_lo32(sg_dma_address(sg))); 18218c2ecf20Sopenharmony_ci address_hi = cpu_to_le32(dma_addr_hi32(sg_dma_address(sg))); 18228c2ecf20Sopenharmony_ci if (address_hi == 0) { 18238c2ecf20Sopenharmony_ci struct SG32ENTRY *pdma_sg = (struct SG32ENTRY *)psge; 18248c2ecf20Sopenharmony_ci 18258c2ecf20Sopenharmony_ci pdma_sg->address = address_lo; 18268c2ecf20Sopenharmony_ci pdma_sg->length = length; 18278c2ecf20Sopenharmony_ci psge += sizeof (struct SG32ENTRY); 18288c2ecf20Sopenharmony_ci arccdbsize += sizeof (struct SG32ENTRY); 18298c2ecf20Sopenharmony_ci } else { 18308c2ecf20Sopenharmony_ci struct SG64ENTRY *pdma_sg = (struct SG64ENTRY *)psge; 18318c2ecf20Sopenharmony_ci 18328c2ecf20Sopenharmony_ci pdma_sg->addresshigh = address_hi; 18338c2ecf20Sopenharmony_ci pdma_sg->address = address_lo; 18348c2ecf20Sopenharmony_ci pdma_sg->length = length|cpu_to_le32(IS_SG64_ADDR); 18358c2ecf20Sopenharmony_ci psge += sizeof (struct SG64ENTRY); 18368c2ecf20Sopenharmony_ci arccdbsize += sizeof (struct SG64ENTRY); 18378c2ecf20Sopenharmony_ci } 18388c2ecf20Sopenharmony_ci } 18398c2ecf20Sopenharmony_ci arcmsr_cdb->sgcount = (uint8_t)nseg; 18408c2ecf20Sopenharmony_ci arcmsr_cdb->DataLength = scsi_bufflen(pcmd); 18418c2ecf20Sopenharmony_ci arcmsr_cdb->msgPages = arccdbsize/0x100 + (arccdbsize % 0x100 ? 1 : 0); 18428c2ecf20Sopenharmony_ci if ( arccdbsize > 256) 18438c2ecf20Sopenharmony_ci arcmsr_cdb->Flags |= ARCMSR_CDB_FLAG_SGL_BSIZE; 18448c2ecf20Sopenharmony_ci if (pcmd->sc_data_direction == DMA_TO_DEVICE) 18458c2ecf20Sopenharmony_ci arcmsr_cdb->Flags |= ARCMSR_CDB_FLAG_WRITE; 18468c2ecf20Sopenharmony_ci ccb->arc_cdb_size = arccdbsize; 18478c2ecf20Sopenharmony_ci return SUCCESS; 18488c2ecf20Sopenharmony_ci} 18498c2ecf20Sopenharmony_ci 18508c2ecf20Sopenharmony_cistatic void arcmsr_post_ccb(struct AdapterControlBlock *acb, struct CommandControlBlock *ccb) 18518c2ecf20Sopenharmony_ci{ 18528c2ecf20Sopenharmony_ci uint32_t cdb_phyaddr = ccb->cdb_phyaddr; 18538c2ecf20Sopenharmony_ci struct ARCMSR_CDB *arcmsr_cdb = (struct ARCMSR_CDB *)&ccb->arcmsr_cdb; 18548c2ecf20Sopenharmony_ci atomic_inc(&acb->ccboutstandingcount); 18558c2ecf20Sopenharmony_ci ccb->startdone = ARCMSR_CCB_START; 18568c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 18578c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: { 18588c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 18598c2ecf20Sopenharmony_ci 18608c2ecf20Sopenharmony_ci if (arcmsr_cdb->Flags & ARCMSR_CDB_FLAG_SGL_BSIZE) 18618c2ecf20Sopenharmony_ci writel(cdb_phyaddr | ARCMSR_CCBPOST_FLAG_SGL_BSIZE, 18628c2ecf20Sopenharmony_ci ®->inbound_queueport); 18638c2ecf20Sopenharmony_ci else 18648c2ecf20Sopenharmony_ci writel(cdb_phyaddr, ®->inbound_queueport); 18658c2ecf20Sopenharmony_ci break; 18668c2ecf20Sopenharmony_ci } 18678c2ecf20Sopenharmony_ci 18688c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 18698c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 18708c2ecf20Sopenharmony_ci uint32_t ending_index, index = reg->postq_index; 18718c2ecf20Sopenharmony_ci 18728c2ecf20Sopenharmony_ci ending_index = ((index + 1) % ARCMSR_MAX_HBB_POSTQUEUE); 18738c2ecf20Sopenharmony_ci reg->post_qbuffer[ending_index] = 0; 18748c2ecf20Sopenharmony_ci if (arcmsr_cdb->Flags & ARCMSR_CDB_FLAG_SGL_BSIZE) { 18758c2ecf20Sopenharmony_ci reg->post_qbuffer[index] = 18768c2ecf20Sopenharmony_ci cdb_phyaddr | ARCMSR_CCBPOST_FLAG_SGL_BSIZE; 18778c2ecf20Sopenharmony_ci } else { 18788c2ecf20Sopenharmony_ci reg->post_qbuffer[index] = cdb_phyaddr; 18798c2ecf20Sopenharmony_ci } 18808c2ecf20Sopenharmony_ci index++; 18818c2ecf20Sopenharmony_ci index %= ARCMSR_MAX_HBB_POSTQUEUE;/*if last index number set it to 0 */ 18828c2ecf20Sopenharmony_ci reg->postq_index = index; 18838c2ecf20Sopenharmony_ci writel(ARCMSR_DRV2IOP_CDB_POSTED, reg->drv2iop_doorbell); 18848c2ecf20Sopenharmony_ci } 18858c2ecf20Sopenharmony_ci break; 18868c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: { 18878c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *phbcmu = acb->pmuC; 18888c2ecf20Sopenharmony_ci uint32_t ccb_post_stamp, arc_cdb_size; 18898c2ecf20Sopenharmony_ci 18908c2ecf20Sopenharmony_ci arc_cdb_size = (ccb->arc_cdb_size > 0x300) ? 0x300 : ccb->arc_cdb_size; 18918c2ecf20Sopenharmony_ci ccb_post_stamp = (cdb_phyaddr | ((arc_cdb_size - 1) >> 6) | 1); 18928c2ecf20Sopenharmony_ci writel(upper_32_bits(ccb->cdb_phyaddr), &phbcmu->inbound_queueport_high); 18938c2ecf20Sopenharmony_ci writel(ccb_post_stamp, &phbcmu->inbound_queueport_low); 18948c2ecf20Sopenharmony_ci } 18958c2ecf20Sopenharmony_ci break; 18968c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 18978c2ecf20Sopenharmony_ci struct MessageUnit_D *pmu = acb->pmuD; 18988c2ecf20Sopenharmony_ci u16 index_stripped; 18998c2ecf20Sopenharmony_ci u16 postq_index, toggle; 19008c2ecf20Sopenharmony_ci unsigned long flags; 19018c2ecf20Sopenharmony_ci struct InBound_SRB *pinbound_srb; 19028c2ecf20Sopenharmony_ci 19038c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->postq_lock, flags); 19048c2ecf20Sopenharmony_ci postq_index = pmu->postq_index; 19058c2ecf20Sopenharmony_ci pinbound_srb = (struct InBound_SRB *)&(pmu->post_qbuffer[postq_index & 0xFF]); 19068c2ecf20Sopenharmony_ci pinbound_srb->addressHigh = upper_32_bits(ccb->cdb_phyaddr); 19078c2ecf20Sopenharmony_ci pinbound_srb->addressLow = cdb_phyaddr; 19088c2ecf20Sopenharmony_ci pinbound_srb->length = ccb->arc_cdb_size >> 2; 19098c2ecf20Sopenharmony_ci arcmsr_cdb->msgContext = dma_addr_lo32(cdb_phyaddr); 19108c2ecf20Sopenharmony_ci toggle = postq_index & 0x4000; 19118c2ecf20Sopenharmony_ci index_stripped = postq_index + 1; 19128c2ecf20Sopenharmony_ci index_stripped &= (ARCMSR_MAX_ARC1214_POSTQUEUE - 1); 19138c2ecf20Sopenharmony_ci pmu->postq_index = index_stripped ? (index_stripped | toggle) : 19148c2ecf20Sopenharmony_ci (toggle ^ 0x4000); 19158c2ecf20Sopenharmony_ci writel(postq_index, pmu->inboundlist_write_pointer); 19168c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->postq_lock, flags); 19178c2ecf20Sopenharmony_ci break; 19188c2ecf20Sopenharmony_ci } 19198c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: { 19208c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *pmu = acb->pmuE; 19218c2ecf20Sopenharmony_ci u32 ccb_post_stamp, arc_cdb_size; 19228c2ecf20Sopenharmony_ci 19238c2ecf20Sopenharmony_ci arc_cdb_size = (ccb->arc_cdb_size > 0x300) ? 0x300 : ccb->arc_cdb_size; 19248c2ecf20Sopenharmony_ci ccb_post_stamp = (ccb->smid | ((arc_cdb_size - 1) >> 6)); 19258c2ecf20Sopenharmony_ci writel(0, &pmu->inbound_queueport_high); 19268c2ecf20Sopenharmony_ci writel(ccb_post_stamp, &pmu->inbound_queueport_low); 19278c2ecf20Sopenharmony_ci break; 19288c2ecf20Sopenharmony_ci } 19298c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 19308c2ecf20Sopenharmony_ci struct MessageUnit_F __iomem *pmu = acb->pmuF; 19318c2ecf20Sopenharmony_ci u32 ccb_post_stamp, arc_cdb_size; 19328c2ecf20Sopenharmony_ci 19338c2ecf20Sopenharmony_ci if (ccb->arc_cdb_size <= 0x300) 19348c2ecf20Sopenharmony_ci arc_cdb_size = (ccb->arc_cdb_size - 1) >> 6 | 1; 19358c2ecf20Sopenharmony_ci else { 19368c2ecf20Sopenharmony_ci arc_cdb_size = ((ccb->arc_cdb_size + 0xff) >> 8) + 2; 19378c2ecf20Sopenharmony_ci if (arc_cdb_size > 0xF) 19388c2ecf20Sopenharmony_ci arc_cdb_size = 0xF; 19398c2ecf20Sopenharmony_ci arc_cdb_size = (arc_cdb_size << 1) | 1; 19408c2ecf20Sopenharmony_ci } 19418c2ecf20Sopenharmony_ci ccb_post_stamp = (ccb->smid | arc_cdb_size); 19428c2ecf20Sopenharmony_ci writel(0, &pmu->inbound_queueport_high); 19438c2ecf20Sopenharmony_ci writel(ccb_post_stamp, &pmu->inbound_queueport_low); 19448c2ecf20Sopenharmony_ci break; 19458c2ecf20Sopenharmony_ci } 19468c2ecf20Sopenharmony_ci } 19478c2ecf20Sopenharmony_ci} 19488c2ecf20Sopenharmony_ci 19498c2ecf20Sopenharmony_cistatic void arcmsr_hbaA_stop_bgrb(struct AdapterControlBlock *acb) 19508c2ecf20Sopenharmony_ci{ 19518c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 19528c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_MSG_START_BGRB; 19538c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_STOP_BGRB, ®->inbound_msgaddr0); 19548c2ecf20Sopenharmony_ci if (!arcmsr_hbaA_wait_msgint_ready(acb)) { 19558c2ecf20Sopenharmony_ci printk(KERN_NOTICE 19568c2ecf20Sopenharmony_ci "arcmsr%d: wait 'stop adapter background rebuild' timeout\n" 19578c2ecf20Sopenharmony_ci , acb->host->host_no); 19588c2ecf20Sopenharmony_ci } 19598c2ecf20Sopenharmony_ci} 19608c2ecf20Sopenharmony_ci 19618c2ecf20Sopenharmony_cistatic void arcmsr_hbaB_stop_bgrb(struct AdapterControlBlock *acb) 19628c2ecf20Sopenharmony_ci{ 19638c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 19648c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_MSG_START_BGRB; 19658c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_STOP_BGRB, reg->drv2iop_doorbell); 19668c2ecf20Sopenharmony_ci 19678c2ecf20Sopenharmony_ci if (!arcmsr_hbaB_wait_msgint_ready(acb)) { 19688c2ecf20Sopenharmony_ci printk(KERN_NOTICE 19698c2ecf20Sopenharmony_ci "arcmsr%d: wait 'stop adapter background rebuild' timeout\n" 19708c2ecf20Sopenharmony_ci , acb->host->host_no); 19718c2ecf20Sopenharmony_ci } 19728c2ecf20Sopenharmony_ci} 19738c2ecf20Sopenharmony_ci 19748c2ecf20Sopenharmony_cistatic void arcmsr_hbaC_stop_bgrb(struct AdapterControlBlock *pACB) 19758c2ecf20Sopenharmony_ci{ 19768c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = pACB->pmuC; 19778c2ecf20Sopenharmony_ci pACB->acb_flags &= ~ACB_F_MSG_START_BGRB; 19788c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_STOP_BGRB, ®->inbound_msgaddr0); 19798c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, ®->inbound_doorbell); 19808c2ecf20Sopenharmony_ci if (!arcmsr_hbaC_wait_msgint_ready(pACB)) { 19818c2ecf20Sopenharmony_ci printk(KERN_NOTICE 19828c2ecf20Sopenharmony_ci "arcmsr%d: wait 'stop adapter background rebuild' timeout\n" 19838c2ecf20Sopenharmony_ci , pACB->host->host_no); 19848c2ecf20Sopenharmony_ci } 19858c2ecf20Sopenharmony_ci return; 19868c2ecf20Sopenharmony_ci} 19878c2ecf20Sopenharmony_ci 19888c2ecf20Sopenharmony_cistatic void arcmsr_hbaD_stop_bgrb(struct AdapterControlBlock *pACB) 19898c2ecf20Sopenharmony_ci{ 19908c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = pACB->pmuD; 19918c2ecf20Sopenharmony_ci 19928c2ecf20Sopenharmony_ci pACB->acb_flags &= ~ACB_F_MSG_START_BGRB; 19938c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_STOP_BGRB, reg->inbound_msgaddr0); 19948c2ecf20Sopenharmony_ci if (!arcmsr_hbaD_wait_msgint_ready(pACB)) 19958c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: wait 'stop adapter background rebuild' " 19968c2ecf20Sopenharmony_ci "timeout\n", pACB->host->host_no); 19978c2ecf20Sopenharmony_ci} 19988c2ecf20Sopenharmony_ci 19998c2ecf20Sopenharmony_cistatic void arcmsr_hbaE_stop_bgrb(struct AdapterControlBlock *pACB) 20008c2ecf20Sopenharmony_ci{ 20018c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = pACB->pmuE; 20028c2ecf20Sopenharmony_ci 20038c2ecf20Sopenharmony_ci pACB->acb_flags &= ~ACB_F_MSG_START_BGRB; 20048c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_STOP_BGRB, ®->inbound_msgaddr0); 20058c2ecf20Sopenharmony_ci pACB->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_MESSAGE_CMD_DONE; 20068c2ecf20Sopenharmony_ci writel(pACB->out_doorbell, ®->iobound_doorbell); 20078c2ecf20Sopenharmony_ci if (!arcmsr_hbaE_wait_msgint_ready(pACB)) { 20088c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: wait 'stop adapter background rebuild' " 20098c2ecf20Sopenharmony_ci "timeout\n", pACB->host->host_no); 20108c2ecf20Sopenharmony_ci } 20118c2ecf20Sopenharmony_ci} 20128c2ecf20Sopenharmony_ci 20138c2ecf20Sopenharmony_cistatic void arcmsr_stop_adapter_bgrb(struct AdapterControlBlock *acb) 20148c2ecf20Sopenharmony_ci{ 20158c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 20168c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: 20178c2ecf20Sopenharmony_ci arcmsr_hbaA_stop_bgrb(acb); 20188c2ecf20Sopenharmony_ci break; 20198c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: 20208c2ecf20Sopenharmony_ci arcmsr_hbaB_stop_bgrb(acb); 20218c2ecf20Sopenharmony_ci break; 20228c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: 20238c2ecf20Sopenharmony_ci arcmsr_hbaC_stop_bgrb(acb); 20248c2ecf20Sopenharmony_ci break; 20258c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: 20268c2ecf20Sopenharmony_ci arcmsr_hbaD_stop_bgrb(acb); 20278c2ecf20Sopenharmony_ci break; 20288c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 20298c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 20308c2ecf20Sopenharmony_ci arcmsr_hbaE_stop_bgrb(acb); 20318c2ecf20Sopenharmony_ci break; 20328c2ecf20Sopenharmony_ci } 20338c2ecf20Sopenharmony_ci} 20348c2ecf20Sopenharmony_ci 20358c2ecf20Sopenharmony_cistatic void arcmsr_free_ccb_pool(struct AdapterControlBlock *acb) 20368c2ecf20Sopenharmony_ci{ 20378c2ecf20Sopenharmony_ci dma_free_coherent(&acb->pdev->dev, acb->uncache_size, acb->dma_coherent, acb->dma_coherent_handle); 20388c2ecf20Sopenharmony_ci} 20398c2ecf20Sopenharmony_ci 20408c2ecf20Sopenharmony_cistatic void arcmsr_iop_message_read(struct AdapterControlBlock *acb) 20418c2ecf20Sopenharmony_ci{ 20428c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 20438c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: { 20448c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 20458c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_DRIVER_DATA_READ_OK, ®->inbound_doorbell); 20468c2ecf20Sopenharmony_ci } 20478c2ecf20Sopenharmony_ci break; 20488c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 20498c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 20508c2ecf20Sopenharmony_ci writel(ARCMSR_DRV2IOP_DATA_READ_OK, reg->drv2iop_doorbell); 20518c2ecf20Sopenharmony_ci } 20528c2ecf20Sopenharmony_ci break; 20538c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: { 20548c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 20558c2ecf20Sopenharmony_ci 20568c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_DRV2IOP_DATA_READ_OK, ®->inbound_doorbell); 20578c2ecf20Sopenharmony_ci } 20588c2ecf20Sopenharmony_ci break; 20598c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 20608c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 20618c2ecf20Sopenharmony_ci writel(ARCMSR_ARC1214_DRV2IOP_DATA_OUT_READ, 20628c2ecf20Sopenharmony_ci reg->inbound_doorbell); 20638c2ecf20Sopenharmony_ci } 20648c2ecf20Sopenharmony_ci break; 20658c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 20668c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 20678c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 20688c2ecf20Sopenharmony_ci acb->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_DATA_READ_OK; 20698c2ecf20Sopenharmony_ci writel(acb->out_doorbell, ®->iobound_doorbell); 20708c2ecf20Sopenharmony_ci } 20718c2ecf20Sopenharmony_ci break; 20728c2ecf20Sopenharmony_ci } 20738c2ecf20Sopenharmony_ci} 20748c2ecf20Sopenharmony_ci 20758c2ecf20Sopenharmony_cistatic void arcmsr_iop_message_wrote(struct AdapterControlBlock *acb) 20768c2ecf20Sopenharmony_ci{ 20778c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 20788c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: { 20798c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 20808c2ecf20Sopenharmony_ci /* 20818c2ecf20Sopenharmony_ci ** push inbound doorbell tell iop, driver data write ok 20828c2ecf20Sopenharmony_ci ** and wait reply on next hwinterrupt for next Qbuffer post 20838c2ecf20Sopenharmony_ci */ 20848c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_DRIVER_DATA_WRITE_OK, ®->inbound_doorbell); 20858c2ecf20Sopenharmony_ci } 20868c2ecf20Sopenharmony_ci break; 20878c2ecf20Sopenharmony_ci 20888c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 20898c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 20908c2ecf20Sopenharmony_ci /* 20918c2ecf20Sopenharmony_ci ** push inbound doorbell tell iop, driver data write ok 20928c2ecf20Sopenharmony_ci ** and wait reply on next hwinterrupt for next Qbuffer post 20938c2ecf20Sopenharmony_ci */ 20948c2ecf20Sopenharmony_ci writel(ARCMSR_DRV2IOP_DATA_WRITE_OK, reg->drv2iop_doorbell); 20958c2ecf20Sopenharmony_ci } 20968c2ecf20Sopenharmony_ci break; 20978c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: { 20988c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 20998c2ecf20Sopenharmony_ci /* 21008c2ecf20Sopenharmony_ci ** push inbound doorbell tell iop, driver data write ok 21018c2ecf20Sopenharmony_ci ** and wait reply on next hwinterrupt for next Qbuffer post 21028c2ecf20Sopenharmony_ci */ 21038c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_DRV2IOP_DATA_WRITE_OK, ®->inbound_doorbell); 21048c2ecf20Sopenharmony_ci } 21058c2ecf20Sopenharmony_ci break; 21068c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 21078c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 21088c2ecf20Sopenharmony_ci writel(ARCMSR_ARC1214_DRV2IOP_DATA_IN_READY, 21098c2ecf20Sopenharmony_ci reg->inbound_doorbell); 21108c2ecf20Sopenharmony_ci } 21118c2ecf20Sopenharmony_ci break; 21128c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 21138c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 21148c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 21158c2ecf20Sopenharmony_ci acb->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_DATA_WRITE_OK; 21168c2ecf20Sopenharmony_ci writel(acb->out_doorbell, ®->iobound_doorbell); 21178c2ecf20Sopenharmony_ci } 21188c2ecf20Sopenharmony_ci break; 21198c2ecf20Sopenharmony_ci } 21208c2ecf20Sopenharmony_ci} 21218c2ecf20Sopenharmony_ci 21228c2ecf20Sopenharmony_cistruct QBUFFER __iomem *arcmsr_get_iop_rqbuffer(struct AdapterControlBlock *acb) 21238c2ecf20Sopenharmony_ci{ 21248c2ecf20Sopenharmony_ci struct QBUFFER __iomem *qbuffer = NULL; 21258c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 21268c2ecf20Sopenharmony_ci 21278c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: { 21288c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 21298c2ecf20Sopenharmony_ci qbuffer = (struct QBUFFER __iomem *)®->message_rbuffer; 21308c2ecf20Sopenharmony_ci } 21318c2ecf20Sopenharmony_ci break; 21328c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 21338c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 21348c2ecf20Sopenharmony_ci qbuffer = (struct QBUFFER __iomem *)reg->message_rbuffer; 21358c2ecf20Sopenharmony_ci } 21368c2ecf20Sopenharmony_ci break; 21378c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: { 21388c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *phbcmu = acb->pmuC; 21398c2ecf20Sopenharmony_ci qbuffer = (struct QBUFFER __iomem *)&phbcmu->message_rbuffer; 21408c2ecf20Sopenharmony_ci } 21418c2ecf20Sopenharmony_ci break; 21428c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 21438c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 21448c2ecf20Sopenharmony_ci qbuffer = (struct QBUFFER __iomem *)reg->message_rbuffer; 21458c2ecf20Sopenharmony_ci } 21468c2ecf20Sopenharmony_ci break; 21478c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: { 21488c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 21498c2ecf20Sopenharmony_ci qbuffer = (struct QBUFFER __iomem *)®->message_rbuffer; 21508c2ecf20Sopenharmony_ci } 21518c2ecf20Sopenharmony_ci break; 21528c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 21538c2ecf20Sopenharmony_ci qbuffer = (struct QBUFFER __iomem *)acb->message_rbuffer; 21548c2ecf20Sopenharmony_ci } 21558c2ecf20Sopenharmony_ci break; 21568c2ecf20Sopenharmony_ci } 21578c2ecf20Sopenharmony_ci return qbuffer; 21588c2ecf20Sopenharmony_ci} 21598c2ecf20Sopenharmony_ci 21608c2ecf20Sopenharmony_cistatic struct QBUFFER __iomem *arcmsr_get_iop_wqbuffer(struct AdapterControlBlock *acb) 21618c2ecf20Sopenharmony_ci{ 21628c2ecf20Sopenharmony_ci struct QBUFFER __iomem *pqbuffer = NULL; 21638c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 21648c2ecf20Sopenharmony_ci 21658c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: { 21668c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 21678c2ecf20Sopenharmony_ci pqbuffer = (struct QBUFFER __iomem *) ®->message_wbuffer; 21688c2ecf20Sopenharmony_ci } 21698c2ecf20Sopenharmony_ci break; 21708c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 21718c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 21728c2ecf20Sopenharmony_ci pqbuffer = (struct QBUFFER __iomem *)reg->message_wbuffer; 21738c2ecf20Sopenharmony_ci } 21748c2ecf20Sopenharmony_ci break; 21758c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: { 21768c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 21778c2ecf20Sopenharmony_ci pqbuffer = (struct QBUFFER __iomem *)®->message_wbuffer; 21788c2ecf20Sopenharmony_ci } 21798c2ecf20Sopenharmony_ci break; 21808c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 21818c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 21828c2ecf20Sopenharmony_ci pqbuffer = (struct QBUFFER __iomem *)reg->message_wbuffer; 21838c2ecf20Sopenharmony_ci } 21848c2ecf20Sopenharmony_ci break; 21858c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: { 21868c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 21878c2ecf20Sopenharmony_ci pqbuffer = (struct QBUFFER __iomem *)®->message_wbuffer; 21888c2ecf20Sopenharmony_ci } 21898c2ecf20Sopenharmony_ci break; 21908c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 21918c2ecf20Sopenharmony_ci pqbuffer = (struct QBUFFER __iomem *)acb->message_wbuffer; 21928c2ecf20Sopenharmony_ci break; 21938c2ecf20Sopenharmony_ci } 21948c2ecf20Sopenharmony_ci return pqbuffer; 21958c2ecf20Sopenharmony_ci} 21968c2ecf20Sopenharmony_ci 21978c2ecf20Sopenharmony_cistatic uint32_t 21988c2ecf20Sopenharmony_ciarcmsr_Read_iop_rqbuffer_in_DWORD(struct AdapterControlBlock *acb, 21998c2ecf20Sopenharmony_ci struct QBUFFER __iomem *prbuffer) 22008c2ecf20Sopenharmony_ci{ 22018c2ecf20Sopenharmony_ci uint8_t *pQbuffer; 22028c2ecf20Sopenharmony_ci uint8_t *buf1 = NULL; 22038c2ecf20Sopenharmony_ci uint32_t __iomem *iop_data; 22048c2ecf20Sopenharmony_ci uint32_t iop_len, data_len, *buf2 = NULL; 22058c2ecf20Sopenharmony_ci 22068c2ecf20Sopenharmony_ci iop_data = (uint32_t __iomem *)prbuffer->data; 22078c2ecf20Sopenharmony_ci iop_len = readl(&prbuffer->data_len); 22088c2ecf20Sopenharmony_ci if (iop_len > 0) { 22098c2ecf20Sopenharmony_ci buf1 = kmalloc(128, GFP_ATOMIC); 22108c2ecf20Sopenharmony_ci buf2 = (uint32_t *)buf1; 22118c2ecf20Sopenharmony_ci if (buf1 == NULL) 22128c2ecf20Sopenharmony_ci return 0; 22138c2ecf20Sopenharmony_ci data_len = iop_len; 22148c2ecf20Sopenharmony_ci while (data_len >= 4) { 22158c2ecf20Sopenharmony_ci *buf2++ = readl(iop_data); 22168c2ecf20Sopenharmony_ci iop_data++; 22178c2ecf20Sopenharmony_ci data_len -= 4; 22188c2ecf20Sopenharmony_ci } 22198c2ecf20Sopenharmony_ci if (data_len) 22208c2ecf20Sopenharmony_ci *buf2 = readl(iop_data); 22218c2ecf20Sopenharmony_ci buf2 = (uint32_t *)buf1; 22228c2ecf20Sopenharmony_ci } 22238c2ecf20Sopenharmony_ci while (iop_len > 0) { 22248c2ecf20Sopenharmony_ci pQbuffer = &acb->rqbuffer[acb->rqbuf_putIndex]; 22258c2ecf20Sopenharmony_ci *pQbuffer = *buf1; 22268c2ecf20Sopenharmony_ci acb->rqbuf_putIndex++; 22278c2ecf20Sopenharmony_ci /* if last, index number set it to 0 */ 22288c2ecf20Sopenharmony_ci acb->rqbuf_putIndex %= ARCMSR_MAX_QBUFFER; 22298c2ecf20Sopenharmony_ci buf1++; 22308c2ecf20Sopenharmony_ci iop_len--; 22318c2ecf20Sopenharmony_ci } 22328c2ecf20Sopenharmony_ci kfree(buf2); 22338c2ecf20Sopenharmony_ci /* let IOP know data has been read */ 22348c2ecf20Sopenharmony_ci arcmsr_iop_message_read(acb); 22358c2ecf20Sopenharmony_ci return 1; 22368c2ecf20Sopenharmony_ci} 22378c2ecf20Sopenharmony_ci 22388c2ecf20Sopenharmony_ciuint32_t 22398c2ecf20Sopenharmony_ciarcmsr_Read_iop_rqbuffer_data(struct AdapterControlBlock *acb, 22408c2ecf20Sopenharmony_ci struct QBUFFER __iomem *prbuffer) { 22418c2ecf20Sopenharmony_ci 22428c2ecf20Sopenharmony_ci uint8_t *pQbuffer; 22438c2ecf20Sopenharmony_ci uint8_t __iomem *iop_data; 22448c2ecf20Sopenharmony_ci uint32_t iop_len; 22458c2ecf20Sopenharmony_ci 22468c2ecf20Sopenharmony_ci if (acb->adapter_type > ACB_ADAPTER_TYPE_B) 22478c2ecf20Sopenharmony_ci return arcmsr_Read_iop_rqbuffer_in_DWORD(acb, prbuffer); 22488c2ecf20Sopenharmony_ci iop_data = (uint8_t __iomem *)prbuffer->data; 22498c2ecf20Sopenharmony_ci iop_len = readl(&prbuffer->data_len); 22508c2ecf20Sopenharmony_ci while (iop_len > 0) { 22518c2ecf20Sopenharmony_ci pQbuffer = &acb->rqbuffer[acb->rqbuf_putIndex]; 22528c2ecf20Sopenharmony_ci *pQbuffer = readb(iop_data); 22538c2ecf20Sopenharmony_ci acb->rqbuf_putIndex++; 22548c2ecf20Sopenharmony_ci acb->rqbuf_putIndex %= ARCMSR_MAX_QBUFFER; 22558c2ecf20Sopenharmony_ci iop_data++; 22568c2ecf20Sopenharmony_ci iop_len--; 22578c2ecf20Sopenharmony_ci } 22588c2ecf20Sopenharmony_ci arcmsr_iop_message_read(acb); 22598c2ecf20Sopenharmony_ci return 1; 22608c2ecf20Sopenharmony_ci} 22618c2ecf20Sopenharmony_ci 22628c2ecf20Sopenharmony_cistatic void arcmsr_iop2drv_data_wrote_handle(struct AdapterControlBlock *acb) 22638c2ecf20Sopenharmony_ci{ 22648c2ecf20Sopenharmony_ci unsigned long flags; 22658c2ecf20Sopenharmony_ci struct QBUFFER __iomem *prbuffer; 22668c2ecf20Sopenharmony_ci int32_t buf_empty_len; 22678c2ecf20Sopenharmony_ci 22688c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->rqbuffer_lock, flags); 22698c2ecf20Sopenharmony_ci prbuffer = arcmsr_get_iop_rqbuffer(acb); 22708c2ecf20Sopenharmony_ci buf_empty_len = (acb->rqbuf_putIndex - acb->rqbuf_getIndex - 1) & 22718c2ecf20Sopenharmony_ci (ARCMSR_MAX_QBUFFER - 1); 22728c2ecf20Sopenharmony_ci if (buf_empty_len >= readl(&prbuffer->data_len)) { 22738c2ecf20Sopenharmony_ci if (arcmsr_Read_iop_rqbuffer_data(acb, prbuffer) == 0) 22748c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_IOPDATA_OVERFLOW; 22758c2ecf20Sopenharmony_ci } else 22768c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_IOPDATA_OVERFLOW; 22778c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->rqbuffer_lock, flags); 22788c2ecf20Sopenharmony_ci} 22798c2ecf20Sopenharmony_ci 22808c2ecf20Sopenharmony_cistatic void arcmsr_write_ioctldata2iop_in_DWORD(struct AdapterControlBlock *acb) 22818c2ecf20Sopenharmony_ci{ 22828c2ecf20Sopenharmony_ci uint8_t *pQbuffer; 22838c2ecf20Sopenharmony_ci struct QBUFFER __iomem *pwbuffer; 22848c2ecf20Sopenharmony_ci uint8_t *buf1 = NULL; 22858c2ecf20Sopenharmony_ci uint32_t __iomem *iop_data; 22868c2ecf20Sopenharmony_ci uint32_t allxfer_len = 0, data_len, *buf2 = NULL, data; 22878c2ecf20Sopenharmony_ci 22888c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_MESSAGE_WQBUFFER_READED) { 22898c2ecf20Sopenharmony_ci buf1 = kmalloc(128, GFP_ATOMIC); 22908c2ecf20Sopenharmony_ci buf2 = (uint32_t *)buf1; 22918c2ecf20Sopenharmony_ci if (buf1 == NULL) 22928c2ecf20Sopenharmony_ci return; 22938c2ecf20Sopenharmony_ci 22948c2ecf20Sopenharmony_ci acb->acb_flags &= (~ACB_F_MESSAGE_WQBUFFER_READED); 22958c2ecf20Sopenharmony_ci pwbuffer = arcmsr_get_iop_wqbuffer(acb); 22968c2ecf20Sopenharmony_ci iop_data = (uint32_t __iomem *)pwbuffer->data; 22978c2ecf20Sopenharmony_ci while ((acb->wqbuf_getIndex != acb->wqbuf_putIndex) 22988c2ecf20Sopenharmony_ci && (allxfer_len < 124)) { 22998c2ecf20Sopenharmony_ci pQbuffer = &acb->wqbuffer[acb->wqbuf_getIndex]; 23008c2ecf20Sopenharmony_ci *buf1 = *pQbuffer; 23018c2ecf20Sopenharmony_ci acb->wqbuf_getIndex++; 23028c2ecf20Sopenharmony_ci acb->wqbuf_getIndex %= ARCMSR_MAX_QBUFFER; 23038c2ecf20Sopenharmony_ci buf1++; 23048c2ecf20Sopenharmony_ci allxfer_len++; 23058c2ecf20Sopenharmony_ci } 23068c2ecf20Sopenharmony_ci data_len = allxfer_len; 23078c2ecf20Sopenharmony_ci buf1 = (uint8_t *)buf2; 23088c2ecf20Sopenharmony_ci while (data_len >= 4) { 23098c2ecf20Sopenharmony_ci data = *buf2++; 23108c2ecf20Sopenharmony_ci writel(data, iop_data); 23118c2ecf20Sopenharmony_ci iop_data++; 23128c2ecf20Sopenharmony_ci data_len -= 4; 23138c2ecf20Sopenharmony_ci } 23148c2ecf20Sopenharmony_ci if (data_len) { 23158c2ecf20Sopenharmony_ci data = *buf2; 23168c2ecf20Sopenharmony_ci writel(data, iop_data); 23178c2ecf20Sopenharmony_ci } 23188c2ecf20Sopenharmony_ci writel(allxfer_len, &pwbuffer->data_len); 23198c2ecf20Sopenharmony_ci kfree(buf1); 23208c2ecf20Sopenharmony_ci arcmsr_iop_message_wrote(acb); 23218c2ecf20Sopenharmony_ci } 23228c2ecf20Sopenharmony_ci} 23238c2ecf20Sopenharmony_ci 23248c2ecf20Sopenharmony_civoid 23258c2ecf20Sopenharmony_ciarcmsr_write_ioctldata2iop(struct AdapterControlBlock *acb) 23268c2ecf20Sopenharmony_ci{ 23278c2ecf20Sopenharmony_ci uint8_t *pQbuffer; 23288c2ecf20Sopenharmony_ci struct QBUFFER __iomem *pwbuffer; 23298c2ecf20Sopenharmony_ci uint8_t __iomem *iop_data; 23308c2ecf20Sopenharmony_ci int32_t allxfer_len = 0; 23318c2ecf20Sopenharmony_ci 23328c2ecf20Sopenharmony_ci if (acb->adapter_type > ACB_ADAPTER_TYPE_B) { 23338c2ecf20Sopenharmony_ci arcmsr_write_ioctldata2iop_in_DWORD(acb); 23348c2ecf20Sopenharmony_ci return; 23358c2ecf20Sopenharmony_ci } 23368c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_MESSAGE_WQBUFFER_READED) { 23378c2ecf20Sopenharmony_ci acb->acb_flags &= (~ACB_F_MESSAGE_WQBUFFER_READED); 23388c2ecf20Sopenharmony_ci pwbuffer = arcmsr_get_iop_wqbuffer(acb); 23398c2ecf20Sopenharmony_ci iop_data = (uint8_t __iomem *)pwbuffer->data; 23408c2ecf20Sopenharmony_ci while ((acb->wqbuf_getIndex != acb->wqbuf_putIndex) 23418c2ecf20Sopenharmony_ci && (allxfer_len < 124)) { 23428c2ecf20Sopenharmony_ci pQbuffer = &acb->wqbuffer[acb->wqbuf_getIndex]; 23438c2ecf20Sopenharmony_ci writeb(*pQbuffer, iop_data); 23448c2ecf20Sopenharmony_ci acb->wqbuf_getIndex++; 23458c2ecf20Sopenharmony_ci acb->wqbuf_getIndex %= ARCMSR_MAX_QBUFFER; 23468c2ecf20Sopenharmony_ci iop_data++; 23478c2ecf20Sopenharmony_ci allxfer_len++; 23488c2ecf20Sopenharmony_ci } 23498c2ecf20Sopenharmony_ci writel(allxfer_len, &pwbuffer->data_len); 23508c2ecf20Sopenharmony_ci arcmsr_iop_message_wrote(acb); 23518c2ecf20Sopenharmony_ci } 23528c2ecf20Sopenharmony_ci} 23538c2ecf20Sopenharmony_ci 23548c2ecf20Sopenharmony_cistatic void arcmsr_iop2drv_data_read_handle(struct AdapterControlBlock *acb) 23558c2ecf20Sopenharmony_ci{ 23568c2ecf20Sopenharmony_ci unsigned long flags; 23578c2ecf20Sopenharmony_ci 23588c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->wqbuffer_lock, flags); 23598c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_MESSAGE_WQBUFFER_READED; 23608c2ecf20Sopenharmony_ci if (acb->wqbuf_getIndex != acb->wqbuf_putIndex) 23618c2ecf20Sopenharmony_ci arcmsr_write_ioctldata2iop(acb); 23628c2ecf20Sopenharmony_ci if (acb->wqbuf_getIndex == acb->wqbuf_putIndex) 23638c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_MESSAGE_WQBUFFER_CLEARED; 23648c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->wqbuffer_lock, flags); 23658c2ecf20Sopenharmony_ci} 23668c2ecf20Sopenharmony_ci 23678c2ecf20Sopenharmony_cistatic void arcmsr_hbaA_doorbell_isr(struct AdapterControlBlock *acb) 23688c2ecf20Sopenharmony_ci{ 23698c2ecf20Sopenharmony_ci uint32_t outbound_doorbell; 23708c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 23718c2ecf20Sopenharmony_ci outbound_doorbell = readl(®->outbound_doorbell); 23728c2ecf20Sopenharmony_ci do { 23738c2ecf20Sopenharmony_ci writel(outbound_doorbell, ®->outbound_doorbell); 23748c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_OUTBOUND_IOP331_DATA_WRITE_OK) 23758c2ecf20Sopenharmony_ci arcmsr_iop2drv_data_wrote_handle(acb); 23768c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_OUTBOUND_IOP331_DATA_READ_OK) 23778c2ecf20Sopenharmony_ci arcmsr_iop2drv_data_read_handle(acb); 23788c2ecf20Sopenharmony_ci outbound_doorbell = readl(®->outbound_doorbell); 23798c2ecf20Sopenharmony_ci } while (outbound_doorbell & (ARCMSR_OUTBOUND_IOP331_DATA_WRITE_OK 23808c2ecf20Sopenharmony_ci | ARCMSR_OUTBOUND_IOP331_DATA_READ_OK)); 23818c2ecf20Sopenharmony_ci} 23828c2ecf20Sopenharmony_cistatic void arcmsr_hbaC_doorbell_isr(struct AdapterControlBlock *pACB) 23838c2ecf20Sopenharmony_ci{ 23848c2ecf20Sopenharmony_ci uint32_t outbound_doorbell; 23858c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = pACB->pmuC; 23868c2ecf20Sopenharmony_ci /* 23878c2ecf20Sopenharmony_ci ******************************************************************* 23888c2ecf20Sopenharmony_ci ** Maybe here we need to check wrqbuffer_lock is lock or not 23898c2ecf20Sopenharmony_ci ** DOORBELL: din! don! 23908c2ecf20Sopenharmony_ci ** check if there are any mail need to pack from firmware 23918c2ecf20Sopenharmony_ci ******************************************************************* 23928c2ecf20Sopenharmony_ci */ 23938c2ecf20Sopenharmony_ci outbound_doorbell = readl(®->outbound_doorbell); 23948c2ecf20Sopenharmony_ci do { 23958c2ecf20Sopenharmony_ci writel(outbound_doorbell, ®->outbound_doorbell_clear); 23968c2ecf20Sopenharmony_ci readl(®->outbound_doorbell_clear); 23978c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_HBCMU_IOP2DRV_DATA_WRITE_OK) 23988c2ecf20Sopenharmony_ci arcmsr_iop2drv_data_wrote_handle(pACB); 23998c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_HBCMU_IOP2DRV_DATA_READ_OK) 24008c2ecf20Sopenharmony_ci arcmsr_iop2drv_data_read_handle(pACB); 24018c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE) 24028c2ecf20Sopenharmony_ci arcmsr_hbaC_message_isr(pACB); 24038c2ecf20Sopenharmony_ci outbound_doorbell = readl(®->outbound_doorbell); 24048c2ecf20Sopenharmony_ci } while (outbound_doorbell & (ARCMSR_HBCMU_IOP2DRV_DATA_WRITE_OK 24058c2ecf20Sopenharmony_ci | ARCMSR_HBCMU_IOP2DRV_DATA_READ_OK 24068c2ecf20Sopenharmony_ci | ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE)); 24078c2ecf20Sopenharmony_ci} 24088c2ecf20Sopenharmony_ci 24098c2ecf20Sopenharmony_cistatic void arcmsr_hbaD_doorbell_isr(struct AdapterControlBlock *pACB) 24108c2ecf20Sopenharmony_ci{ 24118c2ecf20Sopenharmony_ci uint32_t outbound_doorbell; 24128c2ecf20Sopenharmony_ci struct MessageUnit_D *pmu = pACB->pmuD; 24138c2ecf20Sopenharmony_ci 24148c2ecf20Sopenharmony_ci outbound_doorbell = readl(pmu->outbound_doorbell); 24158c2ecf20Sopenharmony_ci do { 24168c2ecf20Sopenharmony_ci writel(outbound_doorbell, pmu->outbound_doorbell); 24178c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_ARC1214_IOP2DRV_MESSAGE_CMD_DONE) 24188c2ecf20Sopenharmony_ci arcmsr_hbaD_message_isr(pACB); 24198c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_ARC1214_IOP2DRV_DATA_WRITE_OK) 24208c2ecf20Sopenharmony_ci arcmsr_iop2drv_data_wrote_handle(pACB); 24218c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_ARC1214_IOP2DRV_DATA_READ_OK) 24228c2ecf20Sopenharmony_ci arcmsr_iop2drv_data_read_handle(pACB); 24238c2ecf20Sopenharmony_ci outbound_doorbell = readl(pmu->outbound_doorbell); 24248c2ecf20Sopenharmony_ci } while (outbound_doorbell & (ARCMSR_ARC1214_IOP2DRV_DATA_WRITE_OK 24258c2ecf20Sopenharmony_ci | ARCMSR_ARC1214_IOP2DRV_DATA_READ_OK 24268c2ecf20Sopenharmony_ci | ARCMSR_ARC1214_IOP2DRV_MESSAGE_CMD_DONE)); 24278c2ecf20Sopenharmony_ci} 24288c2ecf20Sopenharmony_ci 24298c2ecf20Sopenharmony_cistatic void arcmsr_hbaE_doorbell_isr(struct AdapterControlBlock *pACB) 24308c2ecf20Sopenharmony_ci{ 24318c2ecf20Sopenharmony_ci uint32_t outbound_doorbell, in_doorbell, tmp, i; 24328c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = pACB->pmuE; 24338c2ecf20Sopenharmony_ci 24348c2ecf20Sopenharmony_ci if (pACB->adapter_type == ACB_ADAPTER_TYPE_F) { 24358c2ecf20Sopenharmony_ci for (i = 0; i < 5; i++) { 24368c2ecf20Sopenharmony_ci in_doorbell = readl(®->iobound_doorbell); 24378c2ecf20Sopenharmony_ci if (in_doorbell != 0) 24388c2ecf20Sopenharmony_ci break; 24398c2ecf20Sopenharmony_ci } 24408c2ecf20Sopenharmony_ci } else 24418c2ecf20Sopenharmony_ci in_doorbell = readl(®->iobound_doorbell); 24428c2ecf20Sopenharmony_ci outbound_doorbell = in_doorbell ^ pACB->in_doorbell; 24438c2ecf20Sopenharmony_ci do { 24448c2ecf20Sopenharmony_ci writel(0, ®->host_int_status); /* clear interrupt */ 24458c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_HBEMU_IOP2DRV_DATA_WRITE_OK) { 24468c2ecf20Sopenharmony_ci arcmsr_iop2drv_data_wrote_handle(pACB); 24478c2ecf20Sopenharmony_ci } 24488c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_HBEMU_IOP2DRV_DATA_READ_OK) { 24498c2ecf20Sopenharmony_ci arcmsr_iop2drv_data_read_handle(pACB); 24508c2ecf20Sopenharmony_ci } 24518c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_HBEMU_IOP2DRV_MESSAGE_CMD_DONE) { 24528c2ecf20Sopenharmony_ci arcmsr_hbaE_message_isr(pACB); 24538c2ecf20Sopenharmony_ci } 24548c2ecf20Sopenharmony_ci tmp = in_doorbell; 24558c2ecf20Sopenharmony_ci in_doorbell = readl(®->iobound_doorbell); 24568c2ecf20Sopenharmony_ci outbound_doorbell = tmp ^ in_doorbell; 24578c2ecf20Sopenharmony_ci } while (outbound_doorbell & (ARCMSR_HBEMU_IOP2DRV_DATA_WRITE_OK 24588c2ecf20Sopenharmony_ci | ARCMSR_HBEMU_IOP2DRV_DATA_READ_OK 24598c2ecf20Sopenharmony_ci | ARCMSR_HBEMU_IOP2DRV_MESSAGE_CMD_DONE)); 24608c2ecf20Sopenharmony_ci pACB->in_doorbell = in_doorbell; 24618c2ecf20Sopenharmony_ci} 24628c2ecf20Sopenharmony_ci 24638c2ecf20Sopenharmony_cistatic void arcmsr_hbaA_postqueue_isr(struct AdapterControlBlock *acb) 24648c2ecf20Sopenharmony_ci{ 24658c2ecf20Sopenharmony_ci uint32_t flag_ccb; 24668c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 24678c2ecf20Sopenharmony_ci struct ARCMSR_CDB *pARCMSR_CDB; 24688c2ecf20Sopenharmony_ci struct CommandControlBlock *pCCB; 24698c2ecf20Sopenharmony_ci bool error; 24708c2ecf20Sopenharmony_ci unsigned long cdb_phy_addr; 24718c2ecf20Sopenharmony_ci 24728c2ecf20Sopenharmony_ci while ((flag_ccb = readl(®->outbound_queueport)) != 0xFFFFFFFF) { 24738c2ecf20Sopenharmony_ci cdb_phy_addr = (flag_ccb << 5) & 0xffffffff; 24748c2ecf20Sopenharmony_ci if (acb->cdb_phyadd_hipart) 24758c2ecf20Sopenharmony_ci cdb_phy_addr = cdb_phy_addr | acb->cdb_phyadd_hipart; 24768c2ecf20Sopenharmony_ci pARCMSR_CDB = (struct ARCMSR_CDB *)(acb->vir2phy_offset + cdb_phy_addr); 24778c2ecf20Sopenharmony_ci pCCB = container_of(pARCMSR_CDB, struct CommandControlBlock, arcmsr_cdb); 24788c2ecf20Sopenharmony_ci error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE0) ? true : false; 24798c2ecf20Sopenharmony_ci arcmsr_drain_donequeue(acb, pCCB, error); 24808c2ecf20Sopenharmony_ci } 24818c2ecf20Sopenharmony_ci} 24828c2ecf20Sopenharmony_cistatic void arcmsr_hbaB_postqueue_isr(struct AdapterControlBlock *acb) 24838c2ecf20Sopenharmony_ci{ 24848c2ecf20Sopenharmony_ci uint32_t index; 24858c2ecf20Sopenharmony_ci uint32_t flag_ccb; 24868c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 24878c2ecf20Sopenharmony_ci struct ARCMSR_CDB *pARCMSR_CDB; 24888c2ecf20Sopenharmony_ci struct CommandControlBlock *pCCB; 24898c2ecf20Sopenharmony_ci bool error; 24908c2ecf20Sopenharmony_ci unsigned long cdb_phy_addr; 24918c2ecf20Sopenharmony_ci 24928c2ecf20Sopenharmony_ci index = reg->doneq_index; 24938c2ecf20Sopenharmony_ci while ((flag_ccb = reg->done_qbuffer[index]) != 0) { 24948c2ecf20Sopenharmony_ci cdb_phy_addr = (flag_ccb << 5) & 0xffffffff; 24958c2ecf20Sopenharmony_ci if (acb->cdb_phyadd_hipart) 24968c2ecf20Sopenharmony_ci cdb_phy_addr = cdb_phy_addr | acb->cdb_phyadd_hipart; 24978c2ecf20Sopenharmony_ci pARCMSR_CDB = (struct ARCMSR_CDB *)(acb->vir2phy_offset + cdb_phy_addr); 24988c2ecf20Sopenharmony_ci pCCB = container_of(pARCMSR_CDB, struct CommandControlBlock, arcmsr_cdb); 24998c2ecf20Sopenharmony_ci error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE0) ? true : false; 25008c2ecf20Sopenharmony_ci arcmsr_drain_donequeue(acb, pCCB, error); 25018c2ecf20Sopenharmony_ci reg->done_qbuffer[index] = 0; 25028c2ecf20Sopenharmony_ci index++; 25038c2ecf20Sopenharmony_ci index %= ARCMSR_MAX_HBB_POSTQUEUE; 25048c2ecf20Sopenharmony_ci reg->doneq_index = index; 25058c2ecf20Sopenharmony_ci } 25068c2ecf20Sopenharmony_ci} 25078c2ecf20Sopenharmony_ci 25088c2ecf20Sopenharmony_cistatic void arcmsr_hbaC_postqueue_isr(struct AdapterControlBlock *acb) 25098c2ecf20Sopenharmony_ci{ 25108c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *phbcmu; 25118c2ecf20Sopenharmony_ci struct ARCMSR_CDB *arcmsr_cdb; 25128c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb; 25138c2ecf20Sopenharmony_ci uint32_t flag_ccb, throttling = 0; 25148c2ecf20Sopenharmony_ci unsigned long ccb_cdb_phy; 25158c2ecf20Sopenharmony_ci int error; 25168c2ecf20Sopenharmony_ci 25178c2ecf20Sopenharmony_ci phbcmu = acb->pmuC; 25188c2ecf20Sopenharmony_ci /* areca cdb command done */ 25198c2ecf20Sopenharmony_ci /* Use correct offset and size for syncing */ 25208c2ecf20Sopenharmony_ci 25218c2ecf20Sopenharmony_ci while ((flag_ccb = readl(&phbcmu->outbound_queueport_low)) != 25228c2ecf20Sopenharmony_ci 0xFFFFFFFF) { 25238c2ecf20Sopenharmony_ci ccb_cdb_phy = (flag_ccb & 0xFFFFFFF0); 25248c2ecf20Sopenharmony_ci if (acb->cdb_phyadd_hipart) 25258c2ecf20Sopenharmony_ci ccb_cdb_phy = ccb_cdb_phy | acb->cdb_phyadd_hipart; 25268c2ecf20Sopenharmony_ci arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset 25278c2ecf20Sopenharmony_ci + ccb_cdb_phy); 25288c2ecf20Sopenharmony_ci ccb = container_of(arcmsr_cdb, struct CommandControlBlock, 25298c2ecf20Sopenharmony_ci arcmsr_cdb); 25308c2ecf20Sopenharmony_ci error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE1) 25318c2ecf20Sopenharmony_ci ? true : false; 25328c2ecf20Sopenharmony_ci /* check if command done with no error */ 25338c2ecf20Sopenharmony_ci arcmsr_drain_donequeue(acb, ccb, error); 25348c2ecf20Sopenharmony_ci throttling++; 25358c2ecf20Sopenharmony_ci if (throttling == ARCMSR_HBC_ISR_THROTTLING_LEVEL) { 25368c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_DRV2IOP_POSTQUEUE_THROTTLING, 25378c2ecf20Sopenharmony_ci &phbcmu->inbound_doorbell); 25388c2ecf20Sopenharmony_ci throttling = 0; 25398c2ecf20Sopenharmony_ci } 25408c2ecf20Sopenharmony_ci } 25418c2ecf20Sopenharmony_ci} 25428c2ecf20Sopenharmony_ci 25438c2ecf20Sopenharmony_cistatic void arcmsr_hbaD_postqueue_isr(struct AdapterControlBlock *acb) 25448c2ecf20Sopenharmony_ci{ 25458c2ecf20Sopenharmony_ci u32 outbound_write_pointer, doneq_index, index_stripped, toggle; 25468c2ecf20Sopenharmony_ci uint32_t addressLow; 25478c2ecf20Sopenharmony_ci int error; 25488c2ecf20Sopenharmony_ci struct MessageUnit_D *pmu; 25498c2ecf20Sopenharmony_ci struct ARCMSR_CDB *arcmsr_cdb; 25508c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb; 25518c2ecf20Sopenharmony_ci unsigned long flags, ccb_cdb_phy; 25528c2ecf20Sopenharmony_ci 25538c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->doneq_lock, flags); 25548c2ecf20Sopenharmony_ci pmu = acb->pmuD; 25558c2ecf20Sopenharmony_ci outbound_write_pointer = pmu->done_qbuffer[0].addressLow + 1; 25568c2ecf20Sopenharmony_ci doneq_index = pmu->doneq_index; 25578c2ecf20Sopenharmony_ci if ((doneq_index & 0xFFF) != (outbound_write_pointer & 0xFFF)) { 25588c2ecf20Sopenharmony_ci do { 25598c2ecf20Sopenharmony_ci toggle = doneq_index & 0x4000; 25608c2ecf20Sopenharmony_ci index_stripped = (doneq_index & 0xFFF) + 1; 25618c2ecf20Sopenharmony_ci index_stripped %= ARCMSR_MAX_ARC1214_DONEQUEUE; 25628c2ecf20Sopenharmony_ci pmu->doneq_index = index_stripped ? (index_stripped | toggle) : 25638c2ecf20Sopenharmony_ci ((toggle ^ 0x4000) + 1); 25648c2ecf20Sopenharmony_ci doneq_index = pmu->doneq_index; 25658c2ecf20Sopenharmony_ci addressLow = pmu->done_qbuffer[doneq_index & 25668c2ecf20Sopenharmony_ci 0xFFF].addressLow; 25678c2ecf20Sopenharmony_ci ccb_cdb_phy = (addressLow & 0xFFFFFFF0); 25688c2ecf20Sopenharmony_ci if (acb->cdb_phyadd_hipart) 25698c2ecf20Sopenharmony_ci ccb_cdb_phy = ccb_cdb_phy | acb->cdb_phyadd_hipart; 25708c2ecf20Sopenharmony_ci arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset 25718c2ecf20Sopenharmony_ci + ccb_cdb_phy); 25728c2ecf20Sopenharmony_ci ccb = container_of(arcmsr_cdb, 25738c2ecf20Sopenharmony_ci struct CommandControlBlock, arcmsr_cdb); 25748c2ecf20Sopenharmony_ci error = (addressLow & ARCMSR_CCBREPLY_FLAG_ERROR_MODE1) 25758c2ecf20Sopenharmony_ci ? true : false; 25768c2ecf20Sopenharmony_ci arcmsr_drain_donequeue(acb, ccb, error); 25778c2ecf20Sopenharmony_ci writel(doneq_index, pmu->outboundlist_read_pointer); 25788c2ecf20Sopenharmony_ci } while ((doneq_index & 0xFFF) != 25798c2ecf20Sopenharmony_ci (outbound_write_pointer & 0xFFF)); 25808c2ecf20Sopenharmony_ci } 25818c2ecf20Sopenharmony_ci writel(ARCMSR_ARC1214_OUTBOUND_LIST_INTERRUPT_CLEAR, 25828c2ecf20Sopenharmony_ci pmu->outboundlist_interrupt_cause); 25838c2ecf20Sopenharmony_ci readl(pmu->outboundlist_interrupt_cause); 25848c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->doneq_lock, flags); 25858c2ecf20Sopenharmony_ci} 25868c2ecf20Sopenharmony_ci 25878c2ecf20Sopenharmony_cistatic void arcmsr_hbaE_postqueue_isr(struct AdapterControlBlock *acb) 25888c2ecf20Sopenharmony_ci{ 25898c2ecf20Sopenharmony_ci uint32_t doneq_index; 25908c2ecf20Sopenharmony_ci uint16_t cmdSMID; 25918c2ecf20Sopenharmony_ci int error; 25928c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *pmu; 25938c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb; 25948c2ecf20Sopenharmony_ci unsigned long flags; 25958c2ecf20Sopenharmony_ci 25968c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->doneq_lock, flags); 25978c2ecf20Sopenharmony_ci doneq_index = acb->doneq_index; 25988c2ecf20Sopenharmony_ci pmu = acb->pmuE; 25998c2ecf20Sopenharmony_ci while ((readl(&pmu->reply_post_producer_index) & 0xFFFF) != doneq_index) { 26008c2ecf20Sopenharmony_ci cmdSMID = acb->pCompletionQ[doneq_index].cmdSMID; 26018c2ecf20Sopenharmony_ci ccb = acb->pccb_pool[cmdSMID]; 26028c2ecf20Sopenharmony_ci error = (acb->pCompletionQ[doneq_index].cmdFlag 26038c2ecf20Sopenharmony_ci & ARCMSR_CCBREPLY_FLAG_ERROR_MODE1) ? true : false; 26048c2ecf20Sopenharmony_ci arcmsr_drain_donequeue(acb, ccb, error); 26058c2ecf20Sopenharmony_ci doneq_index++; 26068c2ecf20Sopenharmony_ci if (doneq_index >= acb->completionQ_entry) 26078c2ecf20Sopenharmony_ci doneq_index = 0; 26088c2ecf20Sopenharmony_ci } 26098c2ecf20Sopenharmony_ci acb->doneq_index = doneq_index; 26108c2ecf20Sopenharmony_ci writel(doneq_index, &pmu->reply_post_consumer_index); 26118c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->doneq_lock, flags); 26128c2ecf20Sopenharmony_ci} 26138c2ecf20Sopenharmony_ci 26148c2ecf20Sopenharmony_cistatic void arcmsr_hbaF_postqueue_isr(struct AdapterControlBlock *acb) 26158c2ecf20Sopenharmony_ci{ 26168c2ecf20Sopenharmony_ci uint32_t doneq_index; 26178c2ecf20Sopenharmony_ci uint16_t cmdSMID; 26188c2ecf20Sopenharmony_ci int error; 26198c2ecf20Sopenharmony_ci struct MessageUnit_F __iomem *phbcmu; 26208c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb; 26218c2ecf20Sopenharmony_ci unsigned long flags; 26228c2ecf20Sopenharmony_ci 26238c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->doneq_lock, flags); 26248c2ecf20Sopenharmony_ci doneq_index = acb->doneq_index; 26258c2ecf20Sopenharmony_ci phbcmu = acb->pmuF; 26268c2ecf20Sopenharmony_ci while (1) { 26278c2ecf20Sopenharmony_ci cmdSMID = acb->pCompletionQ[doneq_index].cmdSMID; 26288c2ecf20Sopenharmony_ci if (cmdSMID == 0xffff) 26298c2ecf20Sopenharmony_ci break; 26308c2ecf20Sopenharmony_ci ccb = acb->pccb_pool[cmdSMID]; 26318c2ecf20Sopenharmony_ci error = (acb->pCompletionQ[doneq_index].cmdFlag & 26328c2ecf20Sopenharmony_ci ARCMSR_CCBREPLY_FLAG_ERROR_MODE1) ? true : false; 26338c2ecf20Sopenharmony_ci arcmsr_drain_donequeue(acb, ccb, error); 26348c2ecf20Sopenharmony_ci acb->pCompletionQ[doneq_index].cmdSMID = 0xffff; 26358c2ecf20Sopenharmony_ci doneq_index++; 26368c2ecf20Sopenharmony_ci if (doneq_index >= acb->completionQ_entry) 26378c2ecf20Sopenharmony_ci doneq_index = 0; 26388c2ecf20Sopenharmony_ci } 26398c2ecf20Sopenharmony_ci acb->doneq_index = doneq_index; 26408c2ecf20Sopenharmony_ci writel(doneq_index, &phbcmu->reply_post_consumer_index); 26418c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->doneq_lock, flags); 26428c2ecf20Sopenharmony_ci} 26438c2ecf20Sopenharmony_ci 26448c2ecf20Sopenharmony_ci/* 26458c2ecf20Sopenharmony_ci********************************************************************************** 26468c2ecf20Sopenharmony_ci** Handle a message interrupt 26478c2ecf20Sopenharmony_ci** 26488c2ecf20Sopenharmony_ci** The only message interrupt we expect is in response to a query for the current adapter config. 26498c2ecf20Sopenharmony_ci** We want this in order to compare the drivemap so that we can detect newly-attached drives. 26508c2ecf20Sopenharmony_ci********************************************************************************** 26518c2ecf20Sopenharmony_ci*/ 26528c2ecf20Sopenharmony_cistatic void arcmsr_hbaA_message_isr(struct AdapterControlBlock *acb) 26538c2ecf20Sopenharmony_ci{ 26548c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 26558c2ecf20Sopenharmony_ci /*clear interrupt and message state*/ 26568c2ecf20Sopenharmony_ci writel(ARCMSR_MU_OUTBOUND_MESSAGE0_INT, ®->outbound_intstatus); 26578c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_MSG_GET_CONFIG) 26588c2ecf20Sopenharmony_ci schedule_work(&acb->arcmsr_do_message_isr_bh); 26598c2ecf20Sopenharmony_ci} 26608c2ecf20Sopenharmony_cistatic void arcmsr_hbaB_message_isr(struct AdapterControlBlock *acb) 26618c2ecf20Sopenharmony_ci{ 26628c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 26638c2ecf20Sopenharmony_ci 26648c2ecf20Sopenharmony_ci /*clear interrupt and message state*/ 26658c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_INT_CLEAR_PATTERN, reg->iop2drv_doorbell); 26668c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_MSG_GET_CONFIG) 26678c2ecf20Sopenharmony_ci schedule_work(&acb->arcmsr_do_message_isr_bh); 26688c2ecf20Sopenharmony_ci} 26698c2ecf20Sopenharmony_ci/* 26708c2ecf20Sopenharmony_ci********************************************************************************** 26718c2ecf20Sopenharmony_ci** Handle a message interrupt 26728c2ecf20Sopenharmony_ci** 26738c2ecf20Sopenharmony_ci** The only message interrupt we expect is in response to a query for the 26748c2ecf20Sopenharmony_ci** current adapter config. 26758c2ecf20Sopenharmony_ci** We want this in order to compare the drivemap so that we can detect newly-attached drives. 26768c2ecf20Sopenharmony_ci********************************************************************************** 26778c2ecf20Sopenharmony_ci*/ 26788c2ecf20Sopenharmony_cistatic void arcmsr_hbaC_message_isr(struct AdapterControlBlock *acb) 26798c2ecf20Sopenharmony_ci{ 26808c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 26818c2ecf20Sopenharmony_ci /*clear interrupt and message state*/ 26828c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE_DOORBELL_CLEAR, ®->outbound_doorbell_clear); 26838c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_MSG_GET_CONFIG) 26848c2ecf20Sopenharmony_ci schedule_work(&acb->arcmsr_do_message_isr_bh); 26858c2ecf20Sopenharmony_ci} 26868c2ecf20Sopenharmony_ci 26878c2ecf20Sopenharmony_cistatic void arcmsr_hbaD_message_isr(struct AdapterControlBlock *acb) 26888c2ecf20Sopenharmony_ci{ 26898c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 26908c2ecf20Sopenharmony_ci 26918c2ecf20Sopenharmony_ci writel(ARCMSR_ARC1214_IOP2DRV_MESSAGE_CMD_DONE, reg->outbound_doorbell); 26928c2ecf20Sopenharmony_ci readl(reg->outbound_doorbell); 26938c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_MSG_GET_CONFIG) 26948c2ecf20Sopenharmony_ci schedule_work(&acb->arcmsr_do_message_isr_bh); 26958c2ecf20Sopenharmony_ci} 26968c2ecf20Sopenharmony_ci 26978c2ecf20Sopenharmony_cistatic void arcmsr_hbaE_message_isr(struct AdapterControlBlock *acb) 26988c2ecf20Sopenharmony_ci{ 26998c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 27008c2ecf20Sopenharmony_ci 27018c2ecf20Sopenharmony_ci writel(0, ®->host_int_status); 27028c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_MSG_GET_CONFIG) 27038c2ecf20Sopenharmony_ci schedule_work(&acb->arcmsr_do_message_isr_bh); 27048c2ecf20Sopenharmony_ci} 27058c2ecf20Sopenharmony_ci 27068c2ecf20Sopenharmony_cistatic int arcmsr_hbaA_handle_isr(struct AdapterControlBlock *acb) 27078c2ecf20Sopenharmony_ci{ 27088c2ecf20Sopenharmony_ci uint32_t outbound_intstatus; 27098c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 27108c2ecf20Sopenharmony_ci outbound_intstatus = readl(®->outbound_intstatus) & 27118c2ecf20Sopenharmony_ci acb->outbound_int_enable; 27128c2ecf20Sopenharmony_ci if (!(outbound_intstatus & ARCMSR_MU_OUTBOUND_HANDLE_INT)) 27138c2ecf20Sopenharmony_ci return IRQ_NONE; 27148c2ecf20Sopenharmony_ci do { 27158c2ecf20Sopenharmony_ci writel(outbound_intstatus, ®->outbound_intstatus); 27168c2ecf20Sopenharmony_ci if (outbound_intstatus & ARCMSR_MU_OUTBOUND_DOORBELL_INT) 27178c2ecf20Sopenharmony_ci arcmsr_hbaA_doorbell_isr(acb); 27188c2ecf20Sopenharmony_ci if (outbound_intstatus & ARCMSR_MU_OUTBOUND_POSTQUEUE_INT) 27198c2ecf20Sopenharmony_ci arcmsr_hbaA_postqueue_isr(acb); 27208c2ecf20Sopenharmony_ci if (outbound_intstatus & ARCMSR_MU_OUTBOUND_MESSAGE0_INT) 27218c2ecf20Sopenharmony_ci arcmsr_hbaA_message_isr(acb); 27228c2ecf20Sopenharmony_ci outbound_intstatus = readl(®->outbound_intstatus) & 27238c2ecf20Sopenharmony_ci acb->outbound_int_enable; 27248c2ecf20Sopenharmony_ci } while (outbound_intstatus & (ARCMSR_MU_OUTBOUND_DOORBELL_INT 27258c2ecf20Sopenharmony_ci | ARCMSR_MU_OUTBOUND_POSTQUEUE_INT 27268c2ecf20Sopenharmony_ci | ARCMSR_MU_OUTBOUND_MESSAGE0_INT)); 27278c2ecf20Sopenharmony_ci return IRQ_HANDLED; 27288c2ecf20Sopenharmony_ci} 27298c2ecf20Sopenharmony_ci 27308c2ecf20Sopenharmony_cistatic int arcmsr_hbaB_handle_isr(struct AdapterControlBlock *acb) 27318c2ecf20Sopenharmony_ci{ 27328c2ecf20Sopenharmony_ci uint32_t outbound_doorbell; 27338c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 27348c2ecf20Sopenharmony_ci outbound_doorbell = readl(reg->iop2drv_doorbell) & 27358c2ecf20Sopenharmony_ci acb->outbound_int_enable; 27368c2ecf20Sopenharmony_ci if (!outbound_doorbell) 27378c2ecf20Sopenharmony_ci return IRQ_NONE; 27388c2ecf20Sopenharmony_ci do { 27398c2ecf20Sopenharmony_ci writel(~outbound_doorbell, reg->iop2drv_doorbell); 27408c2ecf20Sopenharmony_ci writel(ARCMSR_DRV2IOP_END_OF_INTERRUPT, reg->drv2iop_doorbell); 27418c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_IOP2DRV_DATA_WRITE_OK) 27428c2ecf20Sopenharmony_ci arcmsr_iop2drv_data_wrote_handle(acb); 27438c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_IOP2DRV_DATA_READ_OK) 27448c2ecf20Sopenharmony_ci arcmsr_iop2drv_data_read_handle(acb); 27458c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_IOP2DRV_CDB_DONE) 27468c2ecf20Sopenharmony_ci arcmsr_hbaB_postqueue_isr(acb); 27478c2ecf20Sopenharmony_ci if (outbound_doorbell & ARCMSR_IOP2DRV_MESSAGE_CMD_DONE) 27488c2ecf20Sopenharmony_ci arcmsr_hbaB_message_isr(acb); 27498c2ecf20Sopenharmony_ci outbound_doorbell = readl(reg->iop2drv_doorbell) & 27508c2ecf20Sopenharmony_ci acb->outbound_int_enable; 27518c2ecf20Sopenharmony_ci } while (outbound_doorbell & (ARCMSR_IOP2DRV_DATA_WRITE_OK 27528c2ecf20Sopenharmony_ci | ARCMSR_IOP2DRV_DATA_READ_OK 27538c2ecf20Sopenharmony_ci | ARCMSR_IOP2DRV_CDB_DONE 27548c2ecf20Sopenharmony_ci | ARCMSR_IOP2DRV_MESSAGE_CMD_DONE)); 27558c2ecf20Sopenharmony_ci return IRQ_HANDLED; 27568c2ecf20Sopenharmony_ci} 27578c2ecf20Sopenharmony_ci 27588c2ecf20Sopenharmony_cistatic int arcmsr_hbaC_handle_isr(struct AdapterControlBlock *pACB) 27598c2ecf20Sopenharmony_ci{ 27608c2ecf20Sopenharmony_ci uint32_t host_interrupt_status; 27618c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *phbcmu = pACB->pmuC; 27628c2ecf20Sopenharmony_ci /* 27638c2ecf20Sopenharmony_ci ********************************************* 27648c2ecf20Sopenharmony_ci ** check outbound intstatus 27658c2ecf20Sopenharmony_ci ********************************************* 27668c2ecf20Sopenharmony_ci */ 27678c2ecf20Sopenharmony_ci host_interrupt_status = readl(&phbcmu->host_int_status) & 27688c2ecf20Sopenharmony_ci (ARCMSR_HBCMU_OUTBOUND_POSTQUEUE_ISR | 27698c2ecf20Sopenharmony_ci ARCMSR_HBCMU_OUTBOUND_DOORBELL_ISR); 27708c2ecf20Sopenharmony_ci if (!host_interrupt_status) 27718c2ecf20Sopenharmony_ci return IRQ_NONE; 27728c2ecf20Sopenharmony_ci do { 27738c2ecf20Sopenharmony_ci if (host_interrupt_status & ARCMSR_HBCMU_OUTBOUND_DOORBELL_ISR) 27748c2ecf20Sopenharmony_ci arcmsr_hbaC_doorbell_isr(pACB); 27758c2ecf20Sopenharmony_ci /* MU post queue interrupts*/ 27768c2ecf20Sopenharmony_ci if (host_interrupt_status & ARCMSR_HBCMU_OUTBOUND_POSTQUEUE_ISR) 27778c2ecf20Sopenharmony_ci arcmsr_hbaC_postqueue_isr(pACB); 27788c2ecf20Sopenharmony_ci host_interrupt_status = readl(&phbcmu->host_int_status); 27798c2ecf20Sopenharmony_ci } while (host_interrupt_status & (ARCMSR_HBCMU_OUTBOUND_POSTQUEUE_ISR | 27808c2ecf20Sopenharmony_ci ARCMSR_HBCMU_OUTBOUND_DOORBELL_ISR)); 27818c2ecf20Sopenharmony_ci return IRQ_HANDLED; 27828c2ecf20Sopenharmony_ci} 27838c2ecf20Sopenharmony_ci 27848c2ecf20Sopenharmony_cistatic irqreturn_t arcmsr_hbaD_handle_isr(struct AdapterControlBlock *pACB) 27858c2ecf20Sopenharmony_ci{ 27868c2ecf20Sopenharmony_ci u32 host_interrupt_status; 27878c2ecf20Sopenharmony_ci struct MessageUnit_D *pmu = pACB->pmuD; 27888c2ecf20Sopenharmony_ci 27898c2ecf20Sopenharmony_ci host_interrupt_status = readl(pmu->host_int_status) & 27908c2ecf20Sopenharmony_ci (ARCMSR_ARC1214_OUTBOUND_POSTQUEUE_ISR | 27918c2ecf20Sopenharmony_ci ARCMSR_ARC1214_OUTBOUND_DOORBELL_ISR); 27928c2ecf20Sopenharmony_ci if (!host_interrupt_status) 27938c2ecf20Sopenharmony_ci return IRQ_NONE; 27948c2ecf20Sopenharmony_ci do { 27958c2ecf20Sopenharmony_ci /* MU post queue interrupts*/ 27968c2ecf20Sopenharmony_ci if (host_interrupt_status & 27978c2ecf20Sopenharmony_ci ARCMSR_ARC1214_OUTBOUND_POSTQUEUE_ISR) 27988c2ecf20Sopenharmony_ci arcmsr_hbaD_postqueue_isr(pACB); 27998c2ecf20Sopenharmony_ci if (host_interrupt_status & 28008c2ecf20Sopenharmony_ci ARCMSR_ARC1214_OUTBOUND_DOORBELL_ISR) 28018c2ecf20Sopenharmony_ci arcmsr_hbaD_doorbell_isr(pACB); 28028c2ecf20Sopenharmony_ci host_interrupt_status = readl(pmu->host_int_status); 28038c2ecf20Sopenharmony_ci } while (host_interrupt_status & 28048c2ecf20Sopenharmony_ci (ARCMSR_ARC1214_OUTBOUND_POSTQUEUE_ISR | 28058c2ecf20Sopenharmony_ci ARCMSR_ARC1214_OUTBOUND_DOORBELL_ISR)); 28068c2ecf20Sopenharmony_ci return IRQ_HANDLED; 28078c2ecf20Sopenharmony_ci} 28088c2ecf20Sopenharmony_ci 28098c2ecf20Sopenharmony_cistatic irqreturn_t arcmsr_hbaE_handle_isr(struct AdapterControlBlock *pACB) 28108c2ecf20Sopenharmony_ci{ 28118c2ecf20Sopenharmony_ci uint32_t host_interrupt_status; 28128c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *pmu = pACB->pmuE; 28138c2ecf20Sopenharmony_ci 28148c2ecf20Sopenharmony_ci host_interrupt_status = readl(&pmu->host_int_status) & 28158c2ecf20Sopenharmony_ci (ARCMSR_HBEMU_OUTBOUND_POSTQUEUE_ISR | 28168c2ecf20Sopenharmony_ci ARCMSR_HBEMU_OUTBOUND_DOORBELL_ISR); 28178c2ecf20Sopenharmony_ci if (!host_interrupt_status) 28188c2ecf20Sopenharmony_ci return IRQ_NONE; 28198c2ecf20Sopenharmony_ci do { 28208c2ecf20Sopenharmony_ci /* MU ioctl transfer doorbell interrupts*/ 28218c2ecf20Sopenharmony_ci if (host_interrupt_status & ARCMSR_HBEMU_OUTBOUND_DOORBELL_ISR) { 28228c2ecf20Sopenharmony_ci arcmsr_hbaE_doorbell_isr(pACB); 28238c2ecf20Sopenharmony_ci } 28248c2ecf20Sopenharmony_ci /* MU post queue interrupts*/ 28258c2ecf20Sopenharmony_ci if (host_interrupt_status & ARCMSR_HBEMU_OUTBOUND_POSTQUEUE_ISR) { 28268c2ecf20Sopenharmony_ci arcmsr_hbaE_postqueue_isr(pACB); 28278c2ecf20Sopenharmony_ci } 28288c2ecf20Sopenharmony_ci host_interrupt_status = readl(&pmu->host_int_status); 28298c2ecf20Sopenharmony_ci } while (host_interrupt_status & (ARCMSR_HBEMU_OUTBOUND_POSTQUEUE_ISR | 28308c2ecf20Sopenharmony_ci ARCMSR_HBEMU_OUTBOUND_DOORBELL_ISR)); 28318c2ecf20Sopenharmony_ci return IRQ_HANDLED; 28328c2ecf20Sopenharmony_ci} 28338c2ecf20Sopenharmony_ci 28348c2ecf20Sopenharmony_cistatic irqreturn_t arcmsr_hbaF_handle_isr(struct AdapterControlBlock *pACB) 28358c2ecf20Sopenharmony_ci{ 28368c2ecf20Sopenharmony_ci uint32_t host_interrupt_status; 28378c2ecf20Sopenharmony_ci struct MessageUnit_F __iomem *phbcmu = pACB->pmuF; 28388c2ecf20Sopenharmony_ci 28398c2ecf20Sopenharmony_ci host_interrupt_status = readl(&phbcmu->host_int_status) & 28408c2ecf20Sopenharmony_ci (ARCMSR_HBEMU_OUTBOUND_POSTQUEUE_ISR | 28418c2ecf20Sopenharmony_ci ARCMSR_HBEMU_OUTBOUND_DOORBELL_ISR); 28428c2ecf20Sopenharmony_ci if (!host_interrupt_status) 28438c2ecf20Sopenharmony_ci return IRQ_NONE; 28448c2ecf20Sopenharmony_ci do { 28458c2ecf20Sopenharmony_ci /* MU post queue interrupts*/ 28468c2ecf20Sopenharmony_ci if (host_interrupt_status & ARCMSR_HBEMU_OUTBOUND_POSTQUEUE_ISR) 28478c2ecf20Sopenharmony_ci arcmsr_hbaF_postqueue_isr(pACB); 28488c2ecf20Sopenharmony_ci 28498c2ecf20Sopenharmony_ci /* MU ioctl transfer doorbell interrupts*/ 28508c2ecf20Sopenharmony_ci if (host_interrupt_status & ARCMSR_HBEMU_OUTBOUND_DOORBELL_ISR) 28518c2ecf20Sopenharmony_ci arcmsr_hbaE_doorbell_isr(pACB); 28528c2ecf20Sopenharmony_ci 28538c2ecf20Sopenharmony_ci host_interrupt_status = readl(&phbcmu->host_int_status); 28548c2ecf20Sopenharmony_ci } while (host_interrupt_status & (ARCMSR_HBEMU_OUTBOUND_POSTQUEUE_ISR | 28558c2ecf20Sopenharmony_ci ARCMSR_HBEMU_OUTBOUND_DOORBELL_ISR)); 28568c2ecf20Sopenharmony_ci return IRQ_HANDLED; 28578c2ecf20Sopenharmony_ci} 28588c2ecf20Sopenharmony_ci 28598c2ecf20Sopenharmony_cistatic irqreturn_t arcmsr_interrupt(struct AdapterControlBlock *acb) 28608c2ecf20Sopenharmony_ci{ 28618c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 28628c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: 28638c2ecf20Sopenharmony_ci return arcmsr_hbaA_handle_isr(acb); 28648c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: 28658c2ecf20Sopenharmony_ci return arcmsr_hbaB_handle_isr(acb); 28668c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: 28678c2ecf20Sopenharmony_ci return arcmsr_hbaC_handle_isr(acb); 28688c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: 28698c2ecf20Sopenharmony_ci return arcmsr_hbaD_handle_isr(acb); 28708c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 28718c2ecf20Sopenharmony_ci return arcmsr_hbaE_handle_isr(acb); 28728c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 28738c2ecf20Sopenharmony_ci return arcmsr_hbaF_handle_isr(acb); 28748c2ecf20Sopenharmony_ci default: 28758c2ecf20Sopenharmony_ci return IRQ_NONE; 28768c2ecf20Sopenharmony_ci } 28778c2ecf20Sopenharmony_ci} 28788c2ecf20Sopenharmony_ci 28798c2ecf20Sopenharmony_cistatic void arcmsr_iop_parking(struct AdapterControlBlock *acb) 28808c2ecf20Sopenharmony_ci{ 28818c2ecf20Sopenharmony_ci if (acb) { 28828c2ecf20Sopenharmony_ci /* stop adapter background rebuild */ 28838c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_MSG_START_BGRB) { 28848c2ecf20Sopenharmony_ci uint32_t intmask_org; 28858c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_MSG_START_BGRB; 28868c2ecf20Sopenharmony_ci intmask_org = arcmsr_disable_outbound_ints(acb); 28878c2ecf20Sopenharmony_ci arcmsr_stop_adapter_bgrb(acb); 28888c2ecf20Sopenharmony_ci arcmsr_flush_adapter_cache(acb); 28898c2ecf20Sopenharmony_ci arcmsr_enable_outbound_ints(acb, intmask_org); 28908c2ecf20Sopenharmony_ci } 28918c2ecf20Sopenharmony_ci } 28928c2ecf20Sopenharmony_ci} 28938c2ecf20Sopenharmony_ci 28948c2ecf20Sopenharmony_ci 28958c2ecf20Sopenharmony_civoid arcmsr_clear_iop2drv_rqueue_buffer(struct AdapterControlBlock *acb) 28968c2ecf20Sopenharmony_ci{ 28978c2ecf20Sopenharmony_ci uint32_t i; 28988c2ecf20Sopenharmony_ci 28998c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_IOPDATA_OVERFLOW) { 29008c2ecf20Sopenharmony_ci for (i = 0; i < 15; i++) { 29018c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_IOPDATA_OVERFLOW) { 29028c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_IOPDATA_OVERFLOW; 29038c2ecf20Sopenharmony_ci acb->rqbuf_getIndex = 0; 29048c2ecf20Sopenharmony_ci acb->rqbuf_putIndex = 0; 29058c2ecf20Sopenharmony_ci arcmsr_iop_message_read(acb); 29068c2ecf20Sopenharmony_ci mdelay(30); 29078c2ecf20Sopenharmony_ci } else if (acb->rqbuf_getIndex != 29088c2ecf20Sopenharmony_ci acb->rqbuf_putIndex) { 29098c2ecf20Sopenharmony_ci acb->rqbuf_getIndex = 0; 29108c2ecf20Sopenharmony_ci acb->rqbuf_putIndex = 0; 29118c2ecf20Sopenharmony_ci mdelay(30); 29128c2ecf20Sopenharmony_ci } else 29138c2ecf20Sopenharmony_ci break; 29148c2ecf20Sopenharmony_ci } 29158c2ecf20Sopenharmony_ci } 29168c2ecf20Sopenharmony_ci} 29178c2ecf20Sopenharmony_ci 29188c2ecf20Sopenharmony_cistatic int arcmsr_iop_message_xfer(struct AdapterControlBlock *acb, 29198c2ecf20Sopenharmony_ci struct scsi_cmnd *cmd) 29208c2ecf20Sopenharmony_ci{ 29218c2ecf20Sopenharmony_ci char *buffer; 29228c2ecf20Sopenharmony_ci unsigned short use_sg; 29238c2ecf20Sopenharmony_ci int retvalue = 0, transfer_len = 0; 29248c2ecf20Sopenharmony_ci unsigned long flags; 29258c2ecf20Sopenharmony_ci struct CMD_MESSAGE_FIELD *pcmdmessagefld; 29268c2ecf20Sopenharmony_ci uint32_t controlcode = (uint32_t)cmd->cmnd[5] << 24 | 29278c2ecf20Sopenharmony_ci (uint32_t)cmd->cmnd[6] << 16 | 29288c2ecf20Sopenharmony_ci (uint32_t)cmd->cmnd[7] << 8 | 29298c2ecf20Sopenharmony_ci (uint32_t)cmd->cmnd[8]; 29308c2ecf20Sopenharmony_ci struct scatterlist *sg; 29318c2ecf20Sopenharmony_ci 29328c2ecf20Sopenharmony_ci use_sg = scsi_sg_count(cmd); 29338c2ecf20Sopenharmony_ci sg = scsi_sglist(cmd); 29348c2ecf20Sopenharmony_ci buffer = kmap_atomic(sg_page(sg)) + sg->offset; 29358c2ecf20Sopenharmony_ci if (use_sg > 1) { 29368c2ecf20Sopenharmony_ci retvalue = ARCMSR_MESSAGE_FAIL; 29378c2ecf20Sopenharmony_ci goto message_out; 29388c2ecf20Sopenharmony_ci } 29398c2ecf20Sopenharmony_ci transfer_len += sg->length; 29408c2ecf20Sopenharmony_ci if (transfer_len > sizeof(struct CMD_MESSAGE_FIELD)) { 29418c2ecf20Sopenharmony_ci retvalue = ARCMSR_MESSAGE_FAIL; 29428c2ecf20Sopenharmony_ci pr_info("%s: ARCMSR_MESSAGE_FAIL!\n", __func__); 29438c2ecf20Sopenharmony_ci goto message_out; 29448c2ecf20Sopenharmony_ci } 29458c2ecf20Sopenharmony_ci pcmdmessagefld = (struct CMD_MESSAGE_FIELD *)buffer; 29468c2ecf20Sopenharmony_ci switch (controlcode) { 29478c2ecf20Sopenharmony_ci case ARCMSR_MESSAGE_READ_RQBUFFER: { 29488c2ecf20Sopenharmony_ci unsigned char *ver_addr; 29498c2ecf20Sopenharmony_ci uint8_t *ptmpQbuffer; 29508c2ecf20Sopenharmony_ci uint32_t allxfer_len = 0; 29518c2ecf20Sopenharmony_ci ver_addr = kmalloc(ARCMSR_API_DATA_BUFLEN, GFP_ATOMIC); 29528c2ecf20Sopenharmony_ci if (!ver_addr) { 29538c2ecf20Sopenharmony_ci retvalue = ARCMSR_MESSAGE_FAIL; 29548c2ecf20Sopenharmony_ci pr_info("%s: memory not enough!\n", __func__); 29558c2ecf20Sopenharmony_ci goto message_out; 29568c2ecf20Sopenharmony_ci } 29578c2ecf20Sopenharmony_ci ptmpQbuffer = ver_addr; 29588c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->rqbuffer_lock, flags); 29598c2ecf20Sopenharmony_ci if (acb->rqbuf_getIndex != acb->rqbuf_putIndex) { 29608c2ecf20Sopenharmony_ci unsigned int tail = acb->rqbuf_getIndex; 29618c2ecf20Sopenharmony_ci unsigned int head = acb->rqbuf_putIndex; 29628c2ecf20Sopenharmony_ci unsigned int cnt_to_end = CIRC_CNT_TO_END(head, tail, ARCMSR_MAX_QBUFFER); 29638c2ecf20Sopenharmony_ci 29648c2ecf20Sopenharmony_ci allxfer_len = CIRC_CNT(head, tail, ARCMSR_MAX_QBUFFER); 29658c2ecf20Sopenharmony_ci if (allxfer_len > ARCMSR_API_DATA_BUFLEN) 29668c2ecf20Sopenharmony_ci allxfer_len = ARCMSR_API_DATA_BUFLEN; 29678c2ecf20Sopenharmony_ci 29688c2ecf20Sopenharmony_ci if (allxfer_len <= cnt_to_end) 29698c2ecf20Sopenharmony_ci memcpy(ptmpQbuffer, acb->rqbuffer + tail, allxfer_len); 29708c2ecf20Sopenharmony_ci else { 29718c2ecf20Sopenharmony_ci memcpy(ptmpQbuffer, acb->rqbuffer + tail, cnt_to_end); 29728c2ecf20Sopenharmony_ci memcpy(ptmpQbuffer + cnt_to_end, acb->rqbuffer, allxfer_len - cnt_to_end); 29738c2ecf20Sopenharmony_ci } 29748c2ecf20Sopenharmony_ci acb->rqbuf_getIndex = (acb->rqbuf_getIndex + allxfer_len) % ARCMSR_MAX_QBUFFER; 29758c2ecf20Sopenharmony_ci } 29768c2ecf20Sopenharmony_ci memcpy(pcmdmessagefld->messagedatabuffer, ver_addr, 29778c2ecf20Sopenharmony_ci allxfer_len); 29788c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_IOPDATA_OVERFLOW) { 29798c2ecf20Sopenharmony_ci struct QBUFFER __iomem *prbuffer; 29808c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_IOPDATA_OVERFLOW; 29818c2ecf20Sopenharmony_ci prbuffer = arcmsr_get_iop_rqbuffer(acb); 29828c2ecf20Sopenharmony_ci if (arcmsr_Read_iop_rqbuffer_data(acb, prbuffer) == 0) 29838c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_IOPDATA_OVERFLOW; 29848c2ecf20Sopenharmony_ci } 29858c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->rqbuffer_lock, flags); 29868c2ecf20Sopenharmony_ci kfree(ver_addr); 29878c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.Length = allxfer_len; 29888c2ecf20Sopenharmony_ci if (acb->fw_flag == FW_DEADLOCK) 29898c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 29908c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON; 29918c2ecf20Sopenharmony_ci else 29928c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 29938c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_OK; 29948c2ecf20Sopenharmony_ci break; 29958c2ecf20Sopenharmony_ci } 29968c2ecf20Sopenharmony_ci case ARCMSR_MESSAGE_WRITE_WQBUFFER: { 29978c2ecf20Sopenharmony_ci unsigned char *ver_addr; 29988c2ecf20Sopenharmony_ci uint32_t user_len; 29998c2ecf20Sopenharmony_ci int32_t cnt2end; 30008c2ecf20Sopenharmony_ci uint8_t *pQbuffer, *ptmpuserbuffer; 30018c2ecf20Sopenharmony_ci 30028c2ecf20Sopenharmony_ci user_len = pcmdmessagefld->cmdmessage.Length; 30038c2ecf20Sopenharmony_ci if (user_len > ARCMSR_API_DATA_BUFLEN) { 30048c2ecf20Sopenharmony_ci retvalue = ARCMSR_MESSAGE_FAIL; 30058c2ecf20Sopenharmony_ci goto message_out; 30068c2ecf20Sopenharmony_ci } 30078c2ecf20Sopenharmony_ci 30088c2ecf20Sopenharmony_ci ver_addr = kmalloc(ARCMSR_API_DATA_BUFLEN, GFP_ATOMIC); 30098c2ecf20Sopenharmony_ci if (!ver_addr) { 30108c2ecf20Sopenharmony_ci retvalue = ARCMSR_MESSAGE_FAIL; 30118c2ecf20Sopenharmony_ci goto message_out; 30128c2ecf20Sopenharmony_ci } 30138c2ecf20Sopenharmony_ci ptmpuserbuffer = ver_addr; 30148c2ecf20Sopenharmony_ci 30158c2ecf20Sopenharmony_ci memcpy(ptmpuserbuffer, 30168c2ecf20Sopenharmony_ci pcmdmessagefld->messagedatabuffer, user_len); 30178c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->wqbuffer_lock, flags); 30188c2ecf20Sopenharmony_ci if (acb->wqbuf_putIndex != acb->wqbuf_getIndex) { 30198c2ecf20Sopenharmony_ci struct SENSE_DATA *sensebuffer = 30208c2ecf20Sopenharmony_ci (struct SENSE_DATA *)cmd->sense_buffer; 30218c2ecf20Sopenharmony_ci arcmsr_write_ioctldata2iop(acb); 30228c2ecf20Sopenharmony_ci /* has error report sensedata */ 30238c2ecf20Sopenharmony_ci sensebuffer->ErrorCode = SCSI_SENSE_CURRENT_ERRORS; 30248c2ecf20Sopenharmony_ci sensebuffer->SenseKey = ILLEGAL_REQUEST; 30258c2ecf20Sopenharmony_ci sensebuffer->AdditionalSenseLength = 0x0A; 30268c2ecf20Sopenharmony_ci sensebuffer->AdditionalSenseCode = 0x20; 30278c2ecf20Sopenharmony_ci sensebuffer->Valid = 1; 30288c2ecf20Sopenharmony_ci retvalue = ARCMSR_MESSAGE_FAIL; 30298c2ecf20Sopenharmony_ci } else { 30308c2ecf20Sopenharmony_ci pQbuffer = &acb->wqbuffer[acb->wqbuf_putIndex]; 30318c2ecf20Sopenharmony_ci cnt2end = ARCMSR_MAX_QBUFFER - acb->wqbuf_putIndex; 30328c2ecf20Sopenharmony_ci if (user_len > cnt2end) { 30338c2ecf20Sopenharmony_ci memcpy(pQbuffer, ptmpuserbuffer, cnt2end); 30348c2ecf20Sopenharmony_ci ptmpuserbuffer += cnt2end; 30358c2ecf20Sopenharmony_ci user_len -= cnt2end; 30368c2ecf20Sopenharmony_ci acb->wqbuf_putIndex = 0; 30378c2ecf20Sopenharmony_ci pQbuffer = acb->wqbuffer; 30388c2ecf20Sopenharmony_ci } 30398c2ecf20Sopenharmony_ci memcpy(pQbuffer, ptmpuserbuffer, user_len); 30408c2ecf20Sopenharmony_ci acb->wqbuf_putIndex += user_len; 30418c2ecf20Sopenharmony_ci acb->wqbuf_putIndex %= ARCMSR_MAX_QBUFFER; 30428c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_MESSAGE_WQBUFFER_CLEARED) { 30438c2ecf20Sopenharmony_ci acb->acb_flags &= 30448c2ecf20Sopenharmony_ci ~ACB_F_MESSAGE_WQBUFFER_CLEARED; 30458c2ecf20Sopenharmony_ci arcmsr_write_ioctldata2iop(acb); 30468c2ecf20Sopenharmony_ci } 30478c2ecf20Sopenharmony_ci } 30488c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->wqbuffer_lock, flags); 30498c2ecf20Sopenharmony_ci kfree(ver_addr); 30508c2ecf20Sopenharmony_ci if (acb->fw_flag == FW_DEADLOCK) 30518c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 30528c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON; 30538c2ecf20Sopenharmony_ci else 30548c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 30558c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_OK; 30568c2ecf20Sopenharmony_ci break; 30578c2ecf20Sopenharmony_ci } 30588c2ecf20Sopenharmony_ci case ARCMSR_MESSAGE_CLEAR_RQBUFFER: { 30598c2ecf20Sopenharmony_ci uint8_t *pQbuffer = acb->rqbuffer; 30608c2ecf20Sopenharmony_ci 30618c2ecf20Sopenharmony_ci arcmsr_clear_iop2drv_rqueue_buffer(acb); 30628c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->rqbuffer_lock, flags); 30638c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_MESSAGE_RQBUFFER_CLEARED; 30648c2ecf20Sopenharmony_ci acb->rqbuf_getIndex = 0; 30658c2ecf20Sopenharmony_ci acb->rqbuf_putIndex = 0; 30668c2ecf20Sopenharmony_ci memset(pQbuffer, 0, ARCMSR_MAX_QBUFFER); 30678c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->rqbuffer_lock, flags); 30688c2ecf20Sopenharmony_ci if (acb->fw_flag == FW_DEADLOCK) 30698c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 30708c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON; 30718c2ecf20Sopenharmony_ci else 30728c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 30738c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_OK; 30748c2ecf20Sopenharmony_ci break; 30758c2ecf20Sopenharmony_ci } 30768c2ecf20Sopenharmony_ci case ARCMSR_MESSAGE_CLEAR_WQBUFFER: { 30778c2ecf20Sopenharmony_ci uint8_t *pQbuffer = acb->wqbuffer; 30788c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->wqbuffer_lock, flags); 30798c2ecf20Sopenharmony_ci acb->acb_flags |= (ACB_F_MESSAGE_WQBUFFER_CLEARED | 30808c2ecf20Sopenharmony_ci ACB_F_MESSAGE_WQBUFFER_READED); 30818c2ecf20Sopenharmony_ci acb->wqbuf_getIndex = 0; 30828c2ecf20Sopenharmony_ci acb->wqbuf_putIndex = 0; 30838c2ecf20Sopenharmony_ci memset(pQbuffer, 0, ARCMSR_MAX_QBUFFER); 30848c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->wqbuffer_lock, flags); 30858c2ecf20Sopenharmony_ci if (acb->fw_flag == FW_DEADLOCK) 30868c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 30878c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON; 30888c2ecf20Sopenharmony_ci else 30898c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 30908c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_OK; 30918c2ecf20Sopenharmony_ci break; 30928c2ecf20Sopenharmony_ci } 30938c2ecf20Sopenharmony_ci case ARCMSR_MESSAGE_CLEAR_ALLQBUFFER: { 30948c2ecf20Sopenharmony_ci uint8_t *pQbuffer; 30958c2ecf20Sopenharmony_ci arcmsr_clear_iop2drv_rqueue_buffer(acb); 30968c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->rqbuffer_lock, flags); 30978c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_MESSAGE_RQBUFFER_CLEARED; 30988c2ecf20Sopenharmony_ci acb->rqbuf_getIndex = 0; 30998c2ecf20Sopenharmony_ci acb->rqbuf_putIndex = 0; 31008c2ecf20Sopenharmony_ci pQbuffer = acb->rqbuffer; 31018c2ecf20Sopenharmony_ci memset(pQbuffer, 0, sizeof(struct QBUFFER)); 31028c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->rqbuffer_lock, flags); 31038c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->wqbuffer_lock, flags); 31048c2ecf20Sopenharmony_ci acb->acb_flags |= (ACB_F_MESSAGE_WQBUFFER_CLEARED | 31058c2ecf20Sopenharmony_ci ACB_F_MESSAGE_WQBUFFER_READED); 31068c2ecf20Sopenharmony_ci acb->wqbuf_getIndex = 0; 31078c2ecf20Sopenharmony_ci acb->wqbuf_putIndex = 0; 31088c2ecf20Sopenharmony_ci pQbuffer = acb->wqbuffer; 31098c2ecf20Sopenharmony_ci memset(pQbuffer, 0, sizeof(struct QBUFFER)); 31108c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->wqbuffer_lock, flags); 31118c2ecf20Sopenharmony_ci if (acb->fw_flag == FW_DEADLOCK) 31128c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 31138c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON; 31148c2ecf20Sopenharmony_ci else 31158c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 31168c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_OK; 31178c2ecf20Sopenharmony_ci break; 31188c2ecf20Sopenharmony_ci } 31198c2ecf20Sopenharmony_ci case ARCMSR_MESSAGE_RETURN_CODE_3F: { 31208c2ecf20Sopenharmony_ci if (acb->fw_flag == FW_DEADLOCK) 31218c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 31228c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON; 31238c2ecf20Sopenharmony_ci else 31248c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 31258c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_3F; 31268c2ecf20Sopenharmony_ci break; 31278c2ecf20Sopenharmony_ci } 31288c2ecf20Sopenharmony_ci case ARCMSR_MESSAGE_SAY_HELLO: { 31298c2ecf20Sopenharmony_ci int8_t *hello_string = "Hello! I am ARCMSR"; 31308c2ecf20Sopenharmony_ci if (acb->fw_flag == FW_DEADLOCK) 31318c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 31328c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON; 31338c2ecf20Sopenharmony_ci else 31348c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 31358c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_OK; 31368c2ecf20Sopenharmony_ci memcpy(pcmdmessagefld->messagedatabuffer, 31378c2ecf20Sopenharmony_ci hello_string, (int16_t)strlen(hello_string)); 31388c2ecf20Sopenharmony_ci break; 31398c2ecf20Sopenharmony_ci } 31408c2ecf20Sopenharmony_ci case ARCMSR_MESSAGE_SAY_GOODBYE: { 31418c2ecf20Sopenharmony_ci if (acb->fw_flag == FW_DEADLOCK) 31428c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 31438c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON; 31448c2ecf20Sopenharmony_ci else 31458c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 31468c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_OK; 31478c2ecf20Sopenharmony_ci arcmsr_iop_parking(acb); 31488c2ecf20Sopenharmony_ci break; 31498c2ecf20Sopenharmony_ci } 31508c2ecf20Sopenharmony_ci case ARCMSR_MESSAGE_FLUSH_ADAPTER_CACHE: { 31518c2ecf20Sopenharmony_ci if (acb->fw_flag == FW_DEADLOCK) 31528c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 31538c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON; 31548c2ecf20Sopenharmony_ci else 31558c2ecf20Sopenharmony_ci pcmdmessagefld->cmdmessage.ReturnCode = 31568c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_RETURNCODE_OK; 31578c2ecf20Sopenharmony_ci arcmsr_flush_adapter_cache(acb); 31588c2ecf20Sopenharmony_ci break; 31598c2ecf20Sopenharmony_ci } 31608c2ecf20Sopenharmony_ci default: 31618c2ecf20Sopenharmony_ci retvalue = ARCMSR_MESSAGE_FAIL; 31628c2ecf20Sopenharmony_ci pr_info("%s: unknown controlcode!\n", __func__); 31638c2ecf20Sopenharmony_ci } 31648c2ecf20Sopenharmony_cimessage_out: 31658c2ecf20Sopenharmony_ci if (use_sg) { 31668c2ecf20Sopenharmony_ci struct scatterlist *sg = scsi_sglist(cmd); 31678c2ecf20Sopenharmony_ci kunmap_atomic(buffer - sg->offset); 31688c2ecf20Sopenharmony_ci } 31698c2ecf20Sopenharmony_ci return retvalue; 31708c2ecf20Sopenharmony_ci} 31718c2ecf20Sopenharmony_ci 31728c2ecf20Sopenharmony_cistatic struct CommandControlBlock *arcmsr_get_freeccb(struct AdapterControlBlock *acb) 31738c2ecf20Sopenharmony_ci{ 31748c2ecf20Sopenharmony_ci struct list_head *head = &acb->ccb_free_list; 31758c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb = NULL; 31768c2ecf20Sopenharmony_ci unsigned long flags; 31778c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->ccblist_lock, flags); 31788c2ecf20Sopenharmony_ci if (!list_empty(head)) { 31798c2ecf20Sopenharmony_ci ccb = list_entry(head->next, struct CommandControlBlock, list); 31808c2ecf20Sopenharmony_ci list_del_init(&ccb->list); 31818c2ecf20Sopenharmony_ci }else{ 31828c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->ccblist_lock, flags); 31838c2ecf20Sopenharmony_ci return NULL; 31848c2ecf20Sopenharmony_ci } 31858c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->ccblist_lock, flags); 31868c2ecf20Sopenharmony_ci return ccb; 31878c2ecf20Sopenharmony_ci} 31888c2ecf20Sopenharmony_ci 31898c2ecf20Sopenharmony_cistatic void arcmsr_handle_virtual_command(struct AdapterControlBlock *acb, 31908c2ecf20Sopenharmony_ci struct scsi_cmnd *cmd) 31918c2ecf20Sopenharmony_ci{ 31928c2ecf20Sopenharmony_ci switch (cmd->cmnd[0]) { 31938c2ecf20Sopenharmony_ci case INQUIRY: { 31948c2ecf20Sopenharmony_ci unsigned char inqdata[36]; 31958c2ecf20Sopenharmony_ci char *buffer; 31968c2ecf20Sopenharmony_ci struct scatterlist *sg; 31978c2ecf20Sopenharmony_ci 31988c2ecf20Sopenharmony_ci if (cmd->device->lun) { 31998c2ecf20Sopenharmony_ci cmd->result = (DID_TIME_OUT << 16); 32008c2ecf20Sopenharmony_ci cmd->scsi_done(cmd); 32018c2ecf20Sopenharmony_ci return; 32028c2ecf20Sopenharmony_ci } 32038c2ecf20Sopenharmony_ci inqdata[0] = TYPE_PROCESSOR; 32048c2ecf20Sopenharmony_ci /* Periph Qualifier & Periph Dev Type */ 32058c2ecf20Sopenharmony_ci inqdata[1] = 0; 32068c2ecf20Sopenharmony_ci /* rem media bit & Dev Type Modifier */ 32078c2ecf20Sopenharmony_ci inqdata[2] = 0; 32088c2ecf20Sopenharmony_ci /* ISO, ECMA, & ANSI versions */ 32098c2ecf20Sopenharmony_ci inqdata[4] = 31; 32108c2ecf20Sopenharmony_ci /* length of additional data */ 32118c2ecf20Sopenharmony_ci strncpy(&inqdata[8], "Areca ", 8); 32128c2ecf20Sopenharmony_ci /* Vendor Identification */ 32138c2ecf20Sopenharmony_ci strncpy(&inqdata[16], "RAID controller ", 16); 32148c2ecf20Sopenharmony_ci /* Product Identification */ 32158c2ecf20Sopenharmony_ci strncpy(&inqdata[32], "R001", 4); /* Product Revision */ 32168c2ecf20Sopenharmony_ci 32178c2ecf20Sopenharmony_ci sg = scsi_sglist(cmd); 32188c2ecf20Sopenharmony_ci buffer = kmap_atomic(sg_page(sg)) + sg->offset; 32198c2ecf20Sopenharmony_ci 32208c2ecf20Sopenharmony_ci memcpy(buffer, inqdata, sizeof(inqdata)); 32218c2ecf20Sopenharmony_ci sg = scsi_sglist(cmd); 32228c2ecf20Sopenharmony_ci kunmap_atomic(buffer - sg->offset); 32238c2ecf20Sopenharmony_ci 32248c2ecf20Sopenharmony_ci cmd->scsi_done(cmd); 32258c2ecf20Sopenharmony_ci } 32268c2ecf20Sopenharmony_ci break; 32278c2ecf20Sopenharmony_ci case WRITE_BUFFER: 32288c2ecf20Sopenharmony_ci case READ_BUFFER: { 32298c2ecf20Sopenharmony_ci if (arcmsr_iop_message_xfer(acb, cmd)) 32308c2ecf20Sopenharmony_ci cmd->result = (DID_ERROR << 16); 32318c2ecf20Sopenharmony_ci cmd->scsi_done(cmd); 32328c2ecf20Sopenharmony_ci } 32338c2ecf20Sopenharmony_ci break; 32348c2ecf20Sopenharmony_ci default: 32358c2ecf20Sopenharmony_ci cmd->scsi_done(cmd); 32368c2ecf20Sopenharmony_ci } 32378c2ecf20Sopenharmony_ci} 32388c2ecf20Sopenharmony_ci 32398c2ecf20Sopenharmony_cistatic int arcmsr_queue_command_lck(struct scsi_cmnd *cmd, 32408c2ecf20Sopenharmony_ci void (* done)(struct scsi_cmnd *)) 32418c2ecf20Sopenharmony_ci{ 32428c2ecf20Sopenharmony_ci struct Scsi_Host *host = cmd->device->host; 32438c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb = (struct AdapterControlBlock *) host->hostdata; 32448c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb; 32458c2ecf20Sopenharmony_ci int target = cmd->device->id; 32468c2ecf20Sopenharmony_ci 32478c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_ADAPTER_REMOVED) { 32488c2ecf20Sopenharmony_ci cmd->result = (DID_NO_CONNECT << 16); 32498c2ecf20Sopenharmony_ci cmd->scsi_done(cmd); 32508c2ecf20Sopenharmony_ci return 0; 32518c2ecf20Sopenharmony_ci } 32528c2ecf20Sopenharmony_ci cmd->scsi_done = done; 32538c2ecf20Sopenharmony_ci cmd->host_scribble = NULL; 32548c2ecf20Sopenharmony_ci cmd->result = 0; 32558c2ecf20Sopenharmony_ci if (target == 16) { 32568c2ecf20Sopenharmony_ci /* virtual device for iop message transfer */ 32578c2ecf20Sopenharmony_ci arcmsr_handle_virtual_command(acb, cmd); 32588c2ecf20Sopenharmony_ci return 0; 32598c2ecf20Sopenharmony_ci } 32608c2ecf20Sopenharmony_ci ccb = arcmsr_get_freeccb(acb); 32618c2ecf20Sopenharmony_ci if (!ccb) 32628c2ecf20Sopenharmony_ci return SCSI_MLQUEUE_HOST_BUSY; 32638c2ecf20Sopenharmony_ci if (arcmsr_build_ccb( acb, ccb, cmd ) == FAILED) { 32648c2ecf20Sopenharmony_ci cmd->result = (DID_ERROR << 16) | (RESERVATION_CONFLICT << 1); 32658c2ecf20Sopenharmony_ci cmd->scsi_done(cmd); 32668c2ecf20Sopenharmony_ci return 0; 32678c2ecf20Sopenharmony_ci } 32688c2ecf20Sopenharmony_ci arcmsr_post_ccb(acb, ccb); 32698c2ecf20Sopenharmony_ci return 0; 32708c2ecf20Sopenharmony_ci} 32718c2ecf20Sopenharmony_ci 32728c2ecf20Sopenharmony_cistatic DEF_SCSI_QCMD(arcmsr_queue_command) 32738c2ecf20Sopenharmony_ci 32748c2ecf20Sopenharmony_cistatic void arcmsr_get_adapter_config(struct AdapterControlBlock *pACB, uint32_t *rwbuffer) 32758c2ecf20Sopenharmony_ci{ 32768c2ecf20Sopenharmony_ci int count; 32778c2ecf20Sopenharmony_ci uint32_t *acb_firm_model = (uint32_t *)pACB->firm_model; 32788c2ecf20Sopenharmony_ci uint32_t *acb_firm_version = (uint32_t *)pACB->firm_version; 32798c2ecf20Sopenharmony_ci uint32_t *acb_device_map = (uint32_t *)pACB->device_map; 32808c2ecf20Sopenharmony_ci uint32_t *firm_model = &rwbuffer[15]; 32818c2ecf20Sopenharmony_ci uint32_t *firm_version = &rwbuffer[17]; 32828c2ecf20Sopenharmony_ci uint32_t *device_map = &rwbuffer[21]; 32838c2ecf20Sopenharmony_ci 32848c2ecf20Sopenharmony_ci count = 2; 32858c2ecf20Sopenharmony_ci while (count) { 32868c2ecf20Sopenharmony_ci *acb_firm_model = readl(firm_model); 32878c2ecf20Sopenharmony_ci acb_firm_model++; 32888c2ecf20Sopenharmony_ci firm_model++; 32898c2ecf20Sopenharmony_ci count--; 32908c2ecf20Sopenharmony_ci } 32918c2ecf20Sopenharmony_ci count = 4; 32928c2ecf20Sopenharmony_ci while (count) { 32938c2ecf20Sopenharmony_ci *acb_firm_version = readl(firm_version); 32948c2ecf20Sopenharmony_ci acb_firm_version++; 32958c2ecf20Sopenharmony_ci firm_version++; 32968c2ecf20Sopenharmony_ci count--; 32978c2ecf20Sopenharmony_ci } 32988c2ecf20Sopenharmony_ci count = 4; 32998c2ecf20Sopenharmony_ci while (count) { 33008c2ecf20Sopenharmony_ci *acb_device_map = readl(device_map); 33018c2ecf20Sopenharmony_ci acb_device_map++; 33028c2ecf20Sopenharmony_ci device_map++; 33038c2ecf20Sopenharmony_ci count--; 33048c2ecf20Sopenharmony_ci } 33058c2ecf20Sopenharmony_ci pACB->signature = readl(&rwbuffer[0]); 33068c2ecf20Sopenharmony_ci pACB->firm_request_len = readl(&rwbuffer[1]); 33078c2ecf20Sopenharmony_ci pACB->firm_numbers_queue = readl(&rwbuffer[2]); 33088c2ecf20Sopenharmony_ci pACB->firm_sdram_size = readl(&rwbuffer[3]); 33098c2ecf20Sopenharmony_ci pACB->firm_hd_channels = readl(&rwbuffer[4]); 33108c2ecf20Sopenharmony_ci pACB->firm_cfg_version = readl(&rwbuffer[25]); 33118c2ecf20Sopenharmony_ci pr_notice("Areca RAID Controller%d: Model %s, F/W %s\n", 33128c2ecf20Sopenharmony_ci pACB->host->host_no, 33138c2ecf20Sopenharmony_ci pACB->firm_model, 33148c2ecf20Sopenharmony_ci pACB->firm_version); 33158c2ecf20Sopenharmony_ci} 33168c2ecf20Sopenharmony_ci 33178c2ecf20Sopenharmony_cistatic bool arcmsr_hbaA_get_config(struct AdapterControlBlock *acb) 33188c2ecf20Sopenharmony_ci{ 33198c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 33208c2ecf20Sopenharmony_ci 33218c2ecf20Sopenharmony_ci arcmsr_wait_firmware_ready(acb); 33228c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, ®->inbound_msgaddr0); 33238c2ecf20Sopenharmony_ci if (!arcmsr_hbaA_wait_msgint_ready(acb)) { 33248c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: wait 'get adapter firmware \ 33258c2ecf20Sopenharmony_ci miscellaneous data' timeout \n", acb->host->host_no); 33268c2ecf20Sopenharmony_ci return false; 33278c2ecf20Sopenharmony_ci } 33288c2ecf20Sopenharmony_ci arcmsr_get_adapter_config(acb, reg->message_rwbuffer); 33298c2ecf20Sopenharmony_ci return true; 33308c2ecf20Sopenharmony_ci} 33318c2ecf20Sopenharmony_cistatic bool arcmsr_hbaB_get_config(struct AdapterControlBlock *acb) 33328c2ecf20Sopenharmony_ci{ 33338c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 33348c2ecf20Sopenharmony_ci 33358c2ecf20Sopenharmony_ci arcmsr_wait_firmware_ready(acb); 33368c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_START_DRIVER_MODE, reg->drv2iop_doorbell); 33378c2ecf20Sopenharmony_ci if (!arcmsr_hbaB_wait_msgint_ready(acb)) { 33388c2ecf20Sopenharmony_ci printk(KERN_ERR "arcmsr%d: can't set driver mode.\n", acb->host->host_no); 33398c2ecf20Sopenharmony_ci return false; 33408c2ecf20Sopenharmony_ci } 33418c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_GET_CONFIG, reg->drv2iop_doorbell); 33428c2ecf20Sopenharmony_ci if (!arcmsr_hbaB_wait_msgint_ready(acb)) { 33438c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: wait 'get adapter firmware \ 33448c2ecf20Sopenharmony_ci miscellaneous data' timeout \n", acb->host->host_no); 33458c2ecf20Sopenharmony_ci return false; 33468c2ecf20Sopenharmony_ci } 33478c2ecf20Sopenharmony_ci arcmsr_get_adapter_config(acb, reg->message_rwbuffer); 33488c2ecf20Sopenharmony_ci return true; 33498c2ecf20Sopenharmony_ci} 33508c2ecf20Sopenharmony_ci 33518c2ecf20Sopenharmony_cistatic bool arcmsr_hbaC_get_config(struct AdapterControlBlock *pACB) 33528c2ecf20Sopenharmony_ci{ 33538c2ecf20Sopenharmony_ci uint32_t intmask_org; 33548c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = pACB->pmuC; 33558c2ecf20Sopenharmony_ci 33568c2ecf20Sopenharmony_ci /* disable all outbound interrupt */ 33578c2ecf20Sopenharmony_ci intmask_org = readl(®->host_int_mask); /* disable outbound message0 int */ 33588c2ecf20Sopenharmony_ci writel(intmask_org|ARCMSR_HBCMU_ALL_INTMASKENABLE, ®->host_int_mask); 33598c2ecf20Sopenharmony_ci /* wait firmware ready */ 33608c2ecf20Sopenharmony_ci arcmsr_wait_firmware_ready(pACB); 33618c2ecf20Sopenharmony_ci /* post "get config" instruction */ 33628c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, ®->inbound_msgaddr0); 33638c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, ®->inbound_doorbell); 33648c2ecf20Sopenharmony_ci /* wait message ready */ 33658c2ecf20Sopenharmony_ci if (!arcmsr_hbaC_wait_msgint_ready(pACB)) { 33668c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: wait 'get adapter firmware \ 33678c2ecf20Sopenharmony_ci miscellaneous data' timeout \n", pACB->host->host_no); 33688c2ecf20Sopenharmony_ci return false; 33698c2ecf20Sopenharmony_ci } 33708c2ecf20Sopenharmony_ci arcmsr_get_adapter_config(pACB, reg->msgcode_rwbuffer); 33718c2ecf20Sopenharmony_ci return true; 33728c2ecf20Sopenharmony_ci} 33738c2ecf20Sopenharmony_ci 33748c2ecf20Sopenharmony_cistatic bool arcmsr_hbaD_get_config(struct AdapterControlBlock *acb) 33758c2ecf20Sopenharmony_ci{ 33768c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 33778c2ecf20Sopenharmony_ci 33788c2ecf20Sopenharmony_ci if (readl(acb->pmuD->outbound_doorbell) & 33798c2ecf20Sopenharmony_ci ARCMSR_ARC1214_IOP2DRV_MESSAGE_CMD_DONE) { 33808c2ecf20Sopenharmony_ci writel(ARCMSR_ARC1214_IOP2DRV_MESSAGE_CMD_DONE, 33818c2ecf20Sopenharmony_ci acb->pmuD->outbound_doorbell);/*clear interrupt*/ 33828c2ecf20Sopenharmony_ci } 33838c2ecf20Sopenharmony_ci arcmsr_wait_firmware_ready(acb); 33848c2ecf20Sopenharmony_ci /* post "get config" instruction */ 33858c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, reg->inbound_msgaddr0); 33868c2ecf20Sopenharmony_ci /* wait message ready */ 33878c2ecf20Sopenharmony_ci if (!arcmsr_hbaD_wait_msgint_ready(acb)) { 33888c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: wait get adapter firmware " 33898c2ecf20Sopenharmony_ci "miscellaneous data timeout\n", acb->host->host_no); 33908c2ecf20Sopenharmony_ci return false; 33918c2ecf20Sopenharmony_ci } 33928c2ecf20Sopenharmony_ci arcmsr_get_adapter_config(acb, reg->msgcode_rwbuffer); 33938c2ecf20Sopenharmony_ci return true; 33948c2ecf20Sopenharmony_ci} 33958c2ecf20Sopenharmony_ci 33968c2ecf20Sopenharmony_cistatic bool arcmsr_hbaE_get_config(struct AdapterControlBlock *pACB) 33978c2ecf20Sopenharmony_ci{ 33988c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = pACB->pmuE; 33998c2ecf20Sopenharmony_ci uint32_t intmask_org; 34008c2ecf20Sopenharmony_ci 34018c2ecf20Sopenharmony_ci /* disable all outbound interrupt */ 34028c2ecf20Sopenharmony_ci intmask_org = readl(®->host_int_mask); /* disable outbound message0 int */ 34038c2ecf20Sopenharmony_ci writel(intmask_org | ARCMSR_HBEMU_ALL_INTMASKENABLE, ®->host_int_mask); 34048c2ecf20Sopenharmony_ci /* wait firmware ready */ 34058c2ecf20Sopenharmony_ci arcmsr_wait_firmware_ready(pACB); 34068c2ecf20Sopenharmony_ci mdelay(20); 34078c2ecf20Sopenharmony_ci /* post "get config" instruction */ 34088c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, ®->inbound_msgaddr0); 34098c2ecf20Sopenharmony_ci 34108c2ecf20Sopenharmony_ci pACB->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_MESSAGE_CMD_DONE; 34118c2ecf20Sopenharmony_ci writel(pACB->out_doorbell, ®->iobound_doorbell); 34128c2ecf20Sopenharmony_ci /* wait message ready */ 34138c2ecf20Sopenharmony_ci if (!arcmsr_hbaE_wait_msgint_ready(pACB)) { 34148c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: wait get adapter firmware " 34158c2ecf20Sopenharmony_ci "miscellaneous data timeout\n", pACB->host->host_no); 34168c2ecf20Sopenharmony_ci return false; 34178c2ecf20Sopenharmony_ci } 34188c2ecf20Sopenharmony_ci arcmsr_get_adapter_config(pACB, reg->msgcode_rwbuffer); 34198c2ecf20Sopenharmony_ci return true; 34208c2ecf20Sopenharmony_ci} 34218c2ecf20Sopenharmony_ci 34228c2ecf20Sopenharmony_cistatic bool arcmsr_hbaF_get_config(struct AdapterControlBlock *pACB) 34238c2ecf20Sopenharmony_ci{ 34248c2ecf20Sopenharmony_ci struct MessageUnit_F __iomem *reg = pACB->pmuF; 34258c2ecf20Sopenharmony_ci uint32_t intmask_org; 34268c2ecf20Sopenharmony_ci 34278c2ecf20Sopenharmony_ci /* disable all outbound interrupt */ 34288c2ecf20Sopenharmony_ci intmask_org = readl(®->host_int_mask); /* disable outbound message0 int */ 34298c2ecf20Sopenharmony_ci writel(intmask_org | ARCMSR_HBEMU_ALL_INTMASKENABLE, ®->host_int_mask); 34308c2ecf20Sopenharmony_ci /* wait firmware ready */ 34318c2ecf20Sopenharmony_ci arcmsr_wait_firmware_ready(pACB); 34328c2ecf20Sopenharmony_ci /* post "get config" instruction */ 34338c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, ®->inbound_msgaddr0); 34348c2ecf20Sopenharmony_ci 34358c2ecf20Sopenharmony_ci pACB->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_MESSAGE_CMD_DONE; 34368c2ecf20Sopenharmony_ci writel(pACB->out_doorbell, ®->iobound_doorbell); 34378c2ecf20Sopenharmony_ci /* wait message ready */ 34388c2ecf20Sopenharmony_ci if (!arcmsr_hbaE_wait_msgint_ready(pACB)) { 34398c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: wait get adapter firmware miscellaneous data timeout\n", 34408c2ecf20Sopenharmony_ci pACB->host->host_no); 34418c2ecf20Sopenharmony_ci return false; 34428c2ecf20Sopenharmony_ci } 34438c2ecf20Sopenharmony_ci arcmsr_get_adapter_config(pACB, pACB->msgcode_rwbuffer); 34448c2ecf20Sopenharmony_ci return true; 34458c2ecf20Sopenharmony_ci} 34468c2ecf20Sopenharmony_ci 34478c2ecf20Sopenharmony_cistatic bool arcmsr_get_firmware_spec(struct AdapterControlBlock *acb) 34488c2ecf20Sopenharmony_ci{ 34498c2ecf20Sopenharmony_ci bool rtn = false; 34508c2ecf20Sopenharmony_ci 34518c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 34528c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: 34538c2ecf20Sopenharmony_ci rtn = arcmsr_hbaA_get_config(acb); 34548c2ecf20Sopenharmony_ci break; 34558c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: 34568c2ecf20Sopenharmony_ci rtn = arcmsr_hbaB_get_config(acb); 34578c2ecf20Sopenharmony_ci break; 34588c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: 34598c2ecf20Sopenharmony_ci rtn = arcmsr_hbaC_get_config(acb); 34608c2ecf20Sopenharmony_ci break; 34618c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: 34628c2ecf20Sopenharmony_ci rtn = arcmsr_hbaD_get_config(acb); 34638c2ecf20Sopenharmony_ci break; 34648c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 34658c2ecf20Sopenharmony_ci rtn = arcmsr_hbaE_get_config(acb); 34668c2ecf20Sopenharmony_ci break; 34678c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 34688c2ecf20Sopenharmony_ci rtn = arcmsr_hbaF_get_config(acb); 34698c2ecf20Sopenharmony_ci break; 34708c2ecf20Sopenharmony_ci default: 34718c2ecf20Sopenharmony_ci break; 34728c2ecf20Sopenharmony_ci } 34738c2ecf20Sopenharmony_ci acb->maxOutstanding = acb->firm_numbers_queue - 1; 34748c2ecf20Sopenharmony_ci if (acb->host->can_queue >= acb->firm_numbers_queue) 34758c2ecf20Sopenharmony_ci acb->host->can_queue = acb->maxOutstanding; 34768c2ecf20Sopenharmony_ci else 34778c2ecf20Sopenharmony_ci acb->maxOutstanding = acb->host->can_queue; 34788c2ecf20Sopenharmony_ci acb->maxFreeCCB = acb->host->can_queue; 34798c2ecf20Sopenharmony_ci if (acb->maxFreeCCB < ARCMSR_MAX_FREECCB_NUM) 34808c2ecf20Sopenharmony_ci acb->maxFreeCCB += 64; 34818c2ecf20Sopenharmony_ci return rtn; 34828c2ecf20Sopenharmony_ci} 34838c2ecf20Sopenharmony_ci 34848c2ecf20Sopenharmony_cistatic int arcmsr_hbaA_polling_ccbdone(struct AdapterControlBlock *acb, 34858c2ecf20Sopenharmony_ci struct CommandControlBlock *poll_ccb) 34868c2ecf20Sopenharmony_ci{ 34878c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 34888c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb; 34898c2ecf20Sopenharmony_ci struct ARCMSR_CDB *arcmsr_cdb; 34908c2ecf20Sopenharmony_ci uint32_t flag_ccb, outbound_intstatus, poll_ccb_done = 0, poll_count = 0; 34918c2ecf20Sopenharmony_ci int rtn; 34928c2ecf20Sopenharmony_ci bool error; 34938c2ecf20Sopenharmony_ci unsigned long ccb_cdb_phy; 34948c2ecf20Sopenharmony_ci 34958c2ecf20Sopenharmony_cipolling_hba_ccb_retry: 34968c2ecf20Sopenharmony_ci poll_count++; 34978c2ecf20Sopenharmony_ci outbound_intstatus = readl(®->outbound_intstatus) & acb->outbound_int_enable; 34988c2ecf20Sopenharmony_ci writel(outbound_intstatus, ®->outbound_intstatus);/*clear interrupt*/ 34998c2ecf20Sopenharmony_ci while (1) { 35008c2ecf20Sopenharmony_ci if ((flag_ccb = readl(®->outbound_queueport)) == 0xFFFFFFFF) { 35018c2ecf20Sopenharmony_ci if (poll_ccb_done){ 35028c2ecf20Sopenharmony_ci rtn = SUCCESS; 35038c2ecf20Sopenharmony_ci break; 35048c2ecf20Sopenharmony_ci }else { 35058c2ecf20Sopenharmony_ci msleep(25); 35068c2ecf20Sopenharmony_ci if (poll_count > 100){ 35078c2ecf20Sopenharmony_ci rtn = FAILED; 35088c2ecf20Sopenharmony_ci break; 35098c2ecf20Sopenharmony_ci } 35108c2ecf20Sopenharmony_ci goto polling_hba_ccb_retry; 35118c2ecf20Sopenharmony_ci } 35128c2ecf20Sopenharmony_ci } 35138c2ecf20Sopenharmony_ci ccb_cdb_phy = (flag_ccb << 5) & 0xffffffff; 35148c2ecf20Sopenharmony_ci if (acb->cdb_phyadd_hipart) 35158c2ecf20Sopenharmony_ci ccb_cdb_phy = ccb_cdb_phy | acb->cdb_phyadd_hipart; 35168c2ecf20Sopenharmony_ci arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset + ccb_cdb_phy); 35178c2ecf20Sopenharmony_ci ccb = container_of(arcmsr_cdb, struct CommandControlBlock, arcmsr_cdb); 35188c2ecf20Sopenharmony_ci poll_ccb_done |= (ccb == poll_ccb) ? 1 : 0; 35198c2ecf20Sopenharmony_ci if ((ccb->acb != acb) || (ccb->startdone != ARCMSR_CCB_START)) { 35208c2ecf20Sopenharmony_ci if ((ccb->startdone == ARCMSR_CCB_ABORTED) || (ccb == poll_ccb)) { 35218c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: scsi id = %d lun = %d ccb = '0x%p'" 35228c2ecf20Sopenharmony_ci " poll command abort successfully \n" 35238c2ecf20Sopenharmony_ci , acb->host->host_no 35248c2ecf20Sopenharmony_ci , ccb->pcmd->device->id 35258c2ecf20Sopenharmony_ci , (u32)ccb->pcmd->device->lun 35268c2ecf20Sopenharmony_ci , ccb); 35278c2ecf20Sopenharmony_ci ccb->pcmd->result = DID_ABORT << 16; 35288c2ecf20Sopenharmony_ci arcmsr_ccb_complete(ccb); 35298c2ecf20Sopenharmony_ci continue; 35308c2ecf20Sopenharmony_ci } 35318c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: polling get an illegal ccb" 35328c2ecf20Sopenharmony_ci " command done ccb = '0x%p'" 35338c2ecf20Sopenharmony_ci "ccboutstandingcount = %d \n" 35348c2ecf20Sopenharmony_ci , acb->host->host_no 35358c2ecf20Sopenharmony_ci , ccb 35368c2ecf20Sopenharmony_ci , atomic_read(&acb->ccboutstandingcount)); 35378c2ecf20Sopenharmony_ci continue; 35388c2ecf20Sopenharmony_ci } 35398c2ecf20Sopenharmony_ci error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE0) ? true : false; 35408c2ecf20Sopenharmony_ci arcmsr_report_ccb_state(acb, ccb, error); 35418c2ecf20Sopenharmony_ci } 35428c2ecf20Sopenharmony_ci return rtn; 35438c2ecf20Sopenharmony_ci} 35448c2ecf20Sopenharmony_ci 35458c2ecf20Sopenharmony_cistatic int arcmsr_hbaB_polling_ccbdone(struct AdapterControlBlock *acb, 35468c2ecf20Sopenharmony_ci struct CommandControlBlock *poll_ccb) 35478c2ecf20Sopenharmony_ci{ 35488c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 35498c2ecf20Sopenharmony_ci struct ARCMSR_CDB *arcmsr_cdb; 35508c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb; 35518c2ecf20Sopenharmony_ci uint32_t flag_ccb, poll_ccb_done = 0, poll_count = 0; 35528c2ecf20Sopenharmony_ci int index, rtn; 35538c2ecf20Sopenharmony_ci bool error; 35548c2ecf20Sopenharmony_ci unsigned long ccb_cdb_phy; 35558c2ecf20Sopenharmony_ci 35568c2ecf20Sopenharmony_cipolling_hbb_ccb_retry: 35578c2ecf20Sopenharmony_ci poll_count++; 35588c2ecf20Sopenharmony_ci /* clear doorbell interrupt */ 35598c2ecf20Sopenharmony_ci writel(ARCMSR_DOORBELL_INT_CLEAR_PATTERN, reg->iop2drv_doorbell); 35608c2ecf20Sopenharmony_ci while(1){ 35618c2ecf20Sopenharmony_ci index = reg->doneq_index; 35628c2ecf20Sopenharmony_ci flag_ccb = reg->done_qbuffer[index]; 35638c2ecf20Sopenharmony_ci if (flag_ccb == 0) { 35648c2ecf20Sopenharmony_ci if (poll_ccb_done){ 35658c2ecf20Sopenharmony_ci rtn = SUCCESS; 35668c2ecf20Sopenharmony_ci break; 35678c2ecf20Sopenharmony_ci }else { 35688c2ecf20Sopenharmony_ci msleep(25); 35698c2ecf20Sopenharmony_ci if (poll_count > 100){ 35708c2ecf20Sopenharmony_ci rtn = FAILED; 35718c2ecf20Sopenharmony_ci break; 35728c2ecf20Sopenharmony_ci } 35738c2ecf20Sopenharmony_ci goto polling_hbb_ccb_retry; 35748c2ecf20Sopenharmony_ci } 35758c2ecf20Sopenharmony_ci } 35768c2ecf20Sopenharmony_ci reg->done_qbuffer[index] = 0; 35778c2ecf20Sopenharmony_ci index++; 35788c2ecf20Sopenharmony_ci /*if last index number set it to 0 */ 35798c2ecf20Sopenharmony_ci index %= ARCMSR_MAX_HBB_POSTQUEUE; 35808c2ecf20Sopenharmony_ci reg->doneq_index = index; 35818c2ecf20Sopenharmony_ci /* check if command done with no error*/ 35828c2ecf20Sopenharmony_ci ccb_cdb_phy = (flag_ccb << 5) & 0xffffffff; 35838c2ecf20Sopenharmony_ci if (acb->cdb_phyadd_hipart) 35848c2ecf20Sopenharmony_ci ccb_cdb_phy = ccb_cdb_phy | acb->cdb_phyadd_hipart; 35858c2ecf20Sopenharmony_ci arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset + ccb_cdb_phy); 35868c2ecf20Sopenharmony_ci ccb = container_of(arcmsr_cdb, struct CommandControlBlock, arcmsr_cdb); 35878c2ecf20Sopenharmony_ci poll_ccb_done |= (ccb == poll_ccb) ? 1 : 0; 35888c2ecf20Sopenharmony_ci if ((ccb->acb != acb) || (ccb->startdone != ARCMSR_CCB_START)) { 35898c2ecf20Sopenharmony_ci if ((ccb->startdone == ARCMSR_CCB_ABORTED) || (ccb == poll_ccb)) { 35908c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: scsi id = %d lun = %d ccb = '0x%p'" 35918c2ecf20Sopenharmony_ci " poll command abort successfully \n" 35928c2ecf20Sopenharmony_ci ,acb->host->host_no 35938c2ecf20Sopenharmony_ci ,ccb->pcmd->device->id 35948c2ecf20Sopenharmony_ci ,(u32)ccb->pcmd->device->lun 35958c2ecf20Sopenharmony_ci ,ccb); 35968c2ecf20Sopenharmony_ci ccb->pcmd->result = DID_ABORT << 16; 35978c2ecf20Sopenharmony_ci arcmsr_ccb_complete(ccb); 35988c2ecf20Sopenharmony_ci continue; 35998c2ecf20Sopenharmony_ci } 36008c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: polling get an illegal ccb" 36018c2ecf20Sopenharmony_ci " command done ccb = '0x%p'" 36028c2ecf20Sopenharmony_ci "ccboutstandingcount = %d \n" 36038c2ecf20Sopenharmony_ci , acb->host->host_no 36048c2ecf20Sopenharmony_ci , ccb 36058c2ecf20Sopenharmony_ci , atomic_read(&acb->ccboutstandingcount)); 36068c2ecf20Sopenharmony_ci continue; 36078c2ecf20Sopenharmony_ci } 36088c2ecf20Sopenharmony_ci error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE0) ? true : false; 36098c2ecf20Sopenharmony_ci arcmsr_report_ccb_state(acb, ccb, error); 36108c2ecf20Sopenharmony_ci } 36118c2ecf20Sopenharmony_ci return rtn; 36128c2ecf20Sopenharmony_ci} 36138c2ecf20Sopenharmony_ci 36148c2ecf20Sopenharmony_cistatic int arcmsr_hbaC_polling_ccbdone(struct AdapterControlBlock *acb, 36158c2ecf20Sopenharmony_ci struct CommandControlBlock *poll_ccb) 36168c2ecf20Sopenharmony_ci{ 36178c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 36188c2ecf20Sopenharmony_ci uint32_t flag_ccb; 36198c2ecf20Sopenharmony_ci struct ARCMSR_CDB *arcmsr_cdb; 36208c2ecf20Sopenharmony_ci bool error; 36218c2ecf20Sopenharmony_ci struct CommandControlBlock *pCCB; 36228c2ecf20Sopenharmony_ci uint32_t poll_ccb_done = 0, poll_count = 0; 36238c2ecf20Sopenharmony_ci int rtn; 36248c2ecf20Sopenharmony_ci unsigned long ccb_cdb_phy; 36258c2ecf20Sopenharmony_ci 36268c2ecf20Sopenharmony_cipolling_hbc_ccb_retry: 36278c2ecf20Sopenharmony_ci poll_count++; 36288c2ecf20Sopenharmony_ci while (1) { 36298c2ecf20Sopenharmony_ci if ((readl(®->host_int_status) & ARCMSR_HBCMU_OUTBOUND_POSTQUEUE_ISR) == 0) { 36308c2ecf20Sopenharmony_ci if (poll_ccb_done) { 36318c2ecf20Sopenharmony_ci rtn = SUCCESS; 36328c2ecf20Sopenharmony_ci break; 36338c2ecf20Sopenharmony_ci } else { 36348c2ecf20Sopenharmony_ci msleep(25); 36358c2ecf20Sopenharmony_ci if (poll_count > 100) { 36368c2ecf20Sopenharmony_ci rtn = FAILED; 36378c2ecf20Sopenharmony_ci break; 36388c2ecf20Sopenharmony_ci } 36398c2ecf20Sopenharmony_ci goto polling_hbc_ccb_retry; 36408c2ecf20Sopenharmony_ci } 36418c2ecf20Sopenharmony_ci } 36428c2ecf20Sopenharmony_ci flag_ccb = readl(®->outbound_queueport_low); 36438c2ecf20Sopenharmony_ci ccb_cdb_phy = (flag_ccb & 0xFFFFFFF0); 36448c2ecf20Sopenharmony_ci if (acb->cdb_phyadd_hipart) 36458c2ecf20Sopenharmony_ci ccb_cdb_phy = ccb_cdb_phy | acb->cdb_phyadd_hipart; 36468c2ecf20Sopenharmony_ci arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset + ccb_cdb_phy); 36478c2ecf20Sopenharmony_ci pCCB = container_of(arcmsr_cdb, struct CommandControlBlock, arcmsr_cdb); 36488c2ecf20Sopenharmony_ci poll_ccb_done |= (pCCB == poll_ccb) ? 1 : 0; 36498c2ecf20Sopenharmony_ci /* check ifcommand done with no error*/ 36508c2ecf20Sopenharmony_ci if ((pCCB->acb != acb) || (pCCB->startdone != ARCMSR_CCB_START)) { 36518c2ecf20Sopenharmony_ci if (pCCB->startdone == ARCMSR_CCB_ABORTED) { 36528c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: scsi id = %d lun = %d ccb = '0x%p'" 36538c2ecf20Sopenharmony_ci " poll command abort successfully \n" 36548c2ecf20Sopenharmony_ci , acb->host->host_no 36558c2ecf20Sopenharmony_ci , pCCB->pcmd->device->id 36568c2ecf20Sopenharmony_ci , (u32)pCCB->pcmd->device->lun 36578c2ecf20Sopenharmony_ci , pCCB); 36588c2ecf20Sopenharmony_ci pCCB->pcmd->result = DID_ABORT << 16; 36598c2ecf20Sopenharmony_ci arcmsr_ccb_complete(pCCB); 36608c2ecf20Sopenharmony_ci continue; 36618c2ecf20Sopenharmony_ci } 36628c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: polling get an illegal ccb" 36638c2ecf20Sopenharmony_ci " command done ccb = '0x%p'" 36648c2ecf20Sopenharmony_ci "ccboutstandingcount = %d \n" 36658c2ecf20Sopenharmony_ci , acb->host->host_no 36668c2ecf20Sopenharmony_ci , pCCB 36678c2ecf20Sopenharmony_ci , atomic_read(&acb->ccboutstandingcount)); 36688c2ecf20Sopenharmony_ci continue; 36698c2ecf20Sopenharmony_ci } 36708c2ecf20Sopenharmony_ci error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE1) ? true : false; 36718c2ecf20Sopenharmony_ci arcmsr_report_ccb_state(acb, pCCB, error); 36728c2ecf20Sopenharmony_ci } 36738c2ecf20Sopenharmony_ci return rtn; 36748c2ecf20Sopenharmony_ci} 36758c2ecf20Sopenharmony_ci 36768c2ecf20Sopenharmony_cistatic int arcmsr_hbaD_polling_ccbdone(struct AdapterControlBlock *acb, 36778c2ecf20Sopenharmony_ci struct CommandControlBlock *poll_ccb) 36788c2ecf20Sopenharmony_ci{ 36798c2ecf20Sopenharmony_ci bool error; 36808c2ecf20Sopenharmony_ci uint32_t poll_ccb_done = 0, poll_count = 0, flag_ccb; 36818c2ecf20Sopenharmony_ci int rtn, doneq_index, index_stripped, outbound_write_pointer, toggle; 36828c2ecf20Sopenharmony_ci unsigned long flags, ccb_cdb_phy; 36838c2ecf20Sopenharmony_ci struct ARCMSR_CDB *arcmsr_cdb; 36848c2ecf20Sopenharmony_ci struct CommandControlBlock *pCCB; 36858c2ecf20Sopenharmony_ci struct MessageUnit_D *pmu = acb->pmuD; 36868c2ecf20Sopenharmony_ci 36878c2ecf20Sopenharmony_cipolling_hbaD_ccb_retry: 36888c2ecf20Sopenharmony_ci poll_count++; 36898c2ecf20Sopenharmony_ci while (1) { 36908c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->doneq_lock, flags); 36918c2ecf20Sopenharmony_ci outbound_write_pointer = pmu->done_qbuffer[0].addressLow + 1; 36928c2ecf20Sopenharmony_ci doneq_index = pmu->doneq_index; 36938c2ecf20Sopenharmony_ci if ((outbound_write_pointer & 0xFFF) == (doneq_index & 0xFFF)) { 36948c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->doneq_lock, flags); 36958c2ecf20Sopenharmony_ci if (poll_ccb_done) { 36968c2ecf20Sopenharmony_ci rtn = SUCCESS; 36978c2ecf20Sopenharmony_ci break; 36988c2ecf20Sopenharmony_ci } else { 36998c2ecf20Sopenharmony_ci msleep(25); 37008c2ecf20Sopenharmony_ci if (poll_count > 40) { 37018c2ecf20Sopenharmony_ci rtn = FAILED; 37028c2ecf20Sopenharmony_ci break; 37038c2ecf20Sopenharmony_ci } 37048c2ecf20Sopenharmony_ci goto polling_hbaD_ccb_retry; 37058c2ecf20Sopenharmony_ci } 37068c2ecf20Sopenharmony_ci } 37078c2ecf20Sopenharmony_ci toggle = doneq_index & 0x4000; 37088c2ecf20Sopenharmony_ci index_stripped = (doneq_index & 0xFFF) + 1; 37098c2ecf20Sopenharmony_ci index_stripped %= ARCMSR_MAX_ARC1214_DONEQUEUE; 37108c2ecf20Sopenharmony_ci pmu->doneq_index = index_stripped ? (index_stripped | toggle) : 37118c2ecf20Sopenharmony_ci ((toggle ^ 0x4000) + 1); 37128c2ecf20Sopenharmony_ci doneq_index = pmu->doneq_index; 37138c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->doneq_lock, flags); 37148c2ecf20Sopenharmony_ci flag_ccb = pmu->done_qbuffer[doneq_index & 0xFFF].addressLow; 37158c2ecf20Sopenharmony_ci ccb_cdb_phy = (flag_ccb & 0xFFFFFFF0); 37168c2ecf20Sopenharmony_ci if (acb->cdb_phyadd_hipart) 37178c2ecf20Sopenharmony_ci ccb_cdb_phy = ccb_cdb_phy | acb->cdb_phyadd_hipart; 37188c2ecf20Sopenharmony_ci arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset + 37198c2ecf20Sopenharmony_ci ccb_cdb_phy); 37208c2ecf20Sopenharmony_ci pCCB = container_of(arcmsr_cdb, struct CommandControlBlock, 37218c2ecf20Sopenharmony_ci arcmsr_cdb); 37228c2ecf20Sopenharmony_ci poll_ccb_done |= (pCCB == poll_ccb) ? 1 : 0; 37238c2ecf20Sopenharmony_ci if ((pCCB->acb != acb) || 37248c2ecf20Sopenharmony_ci (pCCB->startdone != ARCMSR_CCB_START)) { 37258c2ecf20Sopenharmony_ci if (pCCB->startdone == ARCMSR_CCB_ABORTED) { 37268c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: scsi id = %d " 37278c2ecf20Sopenharmony_ci "lun = %d ccb = '0x%p' poll command " 37288c2ecf20Sopenharmony_ci "abort successfully\n" 37298c2ecf20Sopenharmony_ci , acb->host->host_no 37308c2ecf20Sopenharmony_ci , pCCB->pcmd->device->id 37318c2ecf20Sopenharmony_ci , (u32)pCCB->pcmd->device->lun 37328c2ecf20Sopenharmony_ci , pCCB); 37338c2ecf20Sopenharmony_ci pCCB->pcmd->result = DID_ABORT << 16; 37348c2ecf20Sopenharmony_ci arcmsr_ccb_complete(pCCB); 37358c2ecf20Sopenharmony_ci continue; 37368c2ecf20Sopenharmony_ci } 37378c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: polling an illegal " 37388c2ecf20Sopenharmony_ci "ccb command done ccb = '0x%p' " 37398c2ecf20Sopenharmony_ci "ccboutstandingcount = %d\n" 37408c2ecf20Sopenharmony_ci , acb->host->host_no 37418c2ecf20Sopenharmony_ci , pCCB 37428c2ecf20Sopenharmony_ci , atomic_read(&acb->ccboutstandingcount)); 37438c2ecf20Sopenharmony_ci continue; 37448c2ecf20Sopenharmony_ci } 37458c2ecf20Sopenharmony_ci error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE1) 37468c2ecf20Sopenharmony_ci ? true : false; 37478c2ecf20Sopenharmony_ci arcmsr_report_ccb_state(acb, pCCB, error); 37488c2ecf20Sopenharmony_ci } 37498c2ecf20Sopenharmony_ci return rtn; 37508c2ecf20Sopenharmony_ci} 37518c2ecf20Sopenharmony_ci 37528c2ecf20Sopenharmony_cistatic int arcmsr_hbaE_polling_ccbdone(struct AdapterControlBlock *acb, 37538c2ecf20Sopenharmony_ci struct CommandControlBlock *poll_ccb) 37548c2ecf20Sopenharmony_ci{ 37558c2ecf20Sopenharmony_ci bool error; 37568c2ecf20Sopenharmony_ci uint32_t poll_ccb_done = 0, poll_count = 0, doneq_index; 37578c2ecf20Sopenharmony_ci uint16_t cmdSMID; 37588c2ecf20Sopenharmony_ci unsigned long flags; 37598c2ecf20Sopenharmony_ci int rtn; 37608c2ecf20Sopenharmony_ci struct CommandControlBlock *pCCB; 37618c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 37628c2ecf20Sopenharmony_ci 37638c2ecf20Sopenharmony_ci polling_hbaC_ccb_retry: 37648c2ecf20Sopenharmony_ci poll_count++; 37658c2ecf20Sopenharmony_ci while (1) { 37668c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->doneq_lock, flags); 37678c2ecf20Sopenharmony_ci doneq_index = acb->doneq_index; 37688c2ecf20Sopenharmony_ci if ((readl(®->reply_post_producer_index) & 0xFFFF) == 37698c2ecf20Sopenharmony_ci doneq_index) { 37708c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->doneq_lock, flags); 37718c2ecf20Sopenharmony_ci if (poll_ccb_done) { 37728c2ecf20Sopenharmony_ci rtn = SUCCESS; 37738c2ecf20Sopenharmony_ci break; 37748c2ecf20Sopenharmony_ci } else { 37758c2ecf20Sopenharmony_ci msleep(25); 37768c2ecf20Sopenharmony_ci if (poll_count > 40) { 37778c2ecf20Sopenharmony_ci rtn = FAILED; 37788c2ecf20Sopenharmony_ci break; 37798c2ecf20Sopenharmony_ci } 37808c2ecf20Sopenharmony_ci goto polling_hbaC_ccb_retry; 37818c2ecf20Sopenharmony_ci } 37828c2ecf20Sopenharmony_ci } 37838c2ecf20Sopenharmony_ci cmdSMID = acb->pCompletionQ[doneq_index].cmdSMID; 37848c2ecf20Sopenharmony_ci doneq_index++; 37858c2ecf20Sopenharmony_ci if (doneq_index >= acb->completionQ_entry) 37868c2ecf20Sopenharmony_ci doneq_index = 0; 37878c2ecf20Sopenharmony_ci acb->doneq_index = doneq_index; 37888c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->doneq_lock, flags); 37898c2ecf20Sopenharmony_ci pCCB = acb->pccb_pool[cmdSMID]; 37908c2ecf20Sopenharmony_ci poll_ccb_done |= (pCCB == poll_ccb) ? 1 : 0; 37918c2ecf20Sopenharmony_ci /* check if command done with no error*/ 37928c2ecf20Sopenharmony_ci if ((pCCB->acb != acb) || (pCCB->startdone != ARCMSR_CCB_START)) { 37938c2ecf20Sopenharmony_ci if (pCCB->startdone == ARCMSR_CCB_ABORTED) { 37948c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: scsi id = %d " 37958c2ecf20Sopenharmony_ci "lun = %d ccb = '0x%p' poll command " 37968c2ecf20Sopenharmony_ci "abort successfully\n" 37978c2ecf20Sopenharmony_ci , acb->host->host_no 37988c2ecf20Sopenharmony_ci , pCCB->pcmd->device->id 37998c2ecf20Sopenharmony_ci , (u32)pCCB->pcmd->device->lun 38008c2ecf20Sopenharmony_ci , pCCB); 38018c2ecf20Sopenharmony_ci pCCB->pcmd->result = DID_ABORT << 16; 38028c2ecf20Sopenharmony_ci arcmsr_ccb_complete(pCCB); 38038c2ecf20Sopenharmony_ci continue; 38048c2ecf20Sopenharmony_ci } 38058c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: polling an illegal " 38068c2ecf20Sopenharmony_ci "ccb command done ccb = '0x%p' " 38078c2ecf20Sopenharmony_ci "ccboutstandingcount = %d\n" 38088c2ecf20Sopenharmony_ci , acb->host->host_no 38098c2ecf20Sopenharmony_ci , pCCB 38108c2ecf20Sopenharmony_ci , atomic_read(&acb->ccboutstandingcount)); 38118c2ecf20Sopenharmony_ci continue; 38128c2ecf20Sopenharmony_ci } 38138c2ecf20Sopenharmony_ci error = (acb->pCompletionQ[doneq_index].cmdFlag & 38148c2ecf20Sopenharmony_ci ARCMSR_CCBREPLY_FLAG_ERROR_MODE1) ? true : false; 38158c2ecf20Sopenharmony_ci arcmsr_report_ccb_state(acb, pCCB, error); 38168c2ecf20Sopenharmony_ci } 38178c2ecf20Sopenharmony_ci writel(doneq_index, ®->reply_post_consumer_index); 38188c2ecf20Sopenharmony_ci return rtn; 38198c2ecf20Sopenharmony_ci} 38208c2ecf20Sopenharmony_ci 38218c2ecf20Sopenharmony_cistatic int arcmsr_polling_ccbdone(struct AdapterControlBlock *acb, 38228c2ecf20Sopenharmony_ci struct CommandControlBlock *poll_ccb) 38238c2ecf20Sopenharmony_ci{ 38248c2ecf20Sopenharmony_ci int rtn = 0; 38258c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 38268c2ecf20Sopenharmony_ci 38278c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: 38288c2ecf20Sopenharmony_ci rtn = arcmsr_hbaA_polling_ccbdone(acb, poll_ccb); 38298c2ecf20Sopenharmony_ci break; 38308c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: 38318c2ecf20Sopenharmony_ci rtn = arcmsr_hbaB_polling_ccbdone(acb, poll_ccb); 38328c2ecf20Sopenharmony_ci break; 38338c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: 38348c2ecf20Sopenharmony_ci rtn = arcmsr_hbaC_polling_ccbdone(acb, poll_ccb); 38358c2ecf20Sopenharmony_ci break; 38368c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: 38378c2ecf20Sopenharmony_ci rtn = arcmsr_hbaD_polling_ccbdone(acb, poll_ccb); 38388c2ecf20Sopenharmony_ci break; 38398c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 38408c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 38418c2ecf20Sopenharmony_ci rtn = arcmsr_hbaE_polling_ccbdone(acb, poll_ccb); 38428c2ecf20Sopenharmony_ci break; 38438c2ecf20Sopenharmony_ci } 38448c2ecf20Sopenharmony_ci return rtn; 38458c2ecf20Sopenharmony_ci} 38468c2ecf20Sopenharmony_ci 38478c2ecf20Sopenharmony_cistatic void arcmsr_set_iop_datetime(struct timer_list *t) 38488c2ecf20Sopenharmony_ci{ 38498c2ecf20Sopenharmony_ci struct AdapterControlBlock *pacb = from_timer(pacb, t, refresh_timer); 38508c2ecf20Sopenharmony_ci unsigned int next_time; 38518c2ecf20Sopenharmony_ci struct tm tm; 38528c2ecf20Sopenharmony_ci 38538c2ecf20Sopenharmony_ci union { 38548c2ecf20Sopenharmony_ci struct { 38558c2ecf20Sopenharmony_ci uint16_t signature; 38568c2ecf20Sopenharmony_ci uint8_t year; 38578c2ecf20Sopenharmony_ci uint8_t month; 38588c2ecf20Sopenharmony_ci uint8_t date; 38598c2ecf20Sopenharmony_ci uint8_t hour; 38608c2ecf20Sopenharmony_ci uint8_t minute; 38618c2ecf20Sopenharmony_ci uint8_t second; 38628c2ecf20Sopenharmony_ci } a; 38638c2ecf20Sopenharmony_ci struct { 38648c2ecf20Sopenharmony_ci uint32_t msg_time[2]; 38658c2ecf20Sopenharmony_ci } b; 38668c2ecf20Sopenharmony_ci } datetime; 38678c2ecf20Sopenharmony_ci 38688c2ecf20Sopenharmony_ci time64_to_tm(ktime_get_real_seconds(), -sys_tz.tz_minuteswest * 60, &tm); 38698c2ecf20Sopenharmony_ci 38708c2ecf20Sopenharmony_ci datetime.a.signature = 0x55AA; 38718c2ecf20Sopenharmony_ci datetime.a.year = tm.tm_year - 100; /* base 2000 instead of 1900 */ 38728c2ecf20Sopenharmony_ci datetime.a.month = tm.tm_mon; 38738c2ecf20Sopenharmony_ci datetime.a.date = tm.tm_mday; 38748c2ecf20Sopenharmony_ci datetime.a.hour = tm.tm_hour; 38758c2ecf20Sopenharmony_ci datetime.a.minute = tm.tm_min; 38768c2ecf20Sopenharmony_ci datetime.a.second = tm.tm_sec; 38778c2ecf20Sopenharmony_ci 38788c2ecf20Sopenharmony_ci switch (pacb->adapter_type) { 38798c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: { 38808c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = pacb->pmuA; 38818c2ecf20Sopenharmony_ci writel(datetime.b.msg_time[0], ®->message_rwbuffer[0]); 38828c2ecf20Sopenharmony_ci writel(datetime.b.msg_time[1], ®->message_rwbuffer[1]); 38838c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_SYNC_TIMER, ®->inbound_msgaddr0); 38848c2ecf20Sopenharmony_ci break; 38858c2ecf20Sopenharmony_ci } 38868c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 38878c2ecf20Sopenharmony_ci uint32_t __iomem *rwbuffer; 38888c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = pacb->pmuB; 38898c2ecf20Sopenharmony_ci rwbuffer = reg->message_rwbuffer; 38908c2ecf20Sopenharmony_ci writel(datetime.b.msg_time[0], rwbuffer++); 38918c2ecf20Sopenharmony_ci writel(datetime.b.msg_time[1], rwbuffer++); 38928c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_SYNC_TIMER, reg->drv2iop_doorbell); 38938c2ecf20Sopenharmony_ci break; 38948c2ecf20Sopenharmony_ci } 38958c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: { 38968c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = pacb->pmuC; 38978c2ecf20Sopenharmony_ci writel(datetime.b.msg_time[0], ®->msgcode_rwbuffer[0]); 38988c2ecf20Sopenharmony_ci writel(datetime.b.msg_time[1], ®->msgcode_rwbuffer[1]); 38998c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_SYNC_TIMER, ®->inbound_msgaddr0); 39008c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, ®->inbound_doorbell); 39018c2ecf20Sopenharmony_ci break; 39028c2ecf20Sopenharmony_ci } 39038c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 39048c2ecf20Sopenharmony_ci uint32_t __iomem *rwbuffer; 39058c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = pacb->pmuD; 39068c2ecf20Sopenharmony_ci rwbuffer = reg->msgcode_rwbuffer; 39078c2ecf20Sopenharmony_ci writel(datetime.b.msg_time[0], rwbuffer++); 39088c2ecf20Sopenharmony_ci writel(datetime.b.msg_time[1], rwbuffer++); 39098c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_SYNC_TIMER, reg->inbound_msgaddr0); 39108c2ecf20Sopenharmony_ci break; 39118c2ecf20Sopenharmony_ci } 39128c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: { 39138c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = pacb->pmuE; 39148c2ecf20Sopenharmony_ci writel(datetime.b.msg_time[0], ®->msgcode_rwbuffer[0]); 39158c2ecf20Sopenharmony_ci writel(datetime.b.msg_time[1], ®->msgcode_rwbuffer[1]); 39168c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_SYNC_TIMER, ®->inbound_msgaddr0); 39178c2ecf20Sopenharmony_ci pacb->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_MESSAGE_CMD_DONE; 39188c2ecf20Sopenharmony_ci writel(pacb->out_doorbell, ®->iobound_doorbell); 39198c2ecf20Sopenharmony_ci break; 39208c2ecf20Sopenharmony_ci } 39218c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 39228c2ecf20Sopenharmony_ci struct MessageUnit_F __iomem *reg = pacb->pmuF; 39238c2ecf20Sopenharmony_ci 39248c2ecf20Sopenharmony_ci pacb->msgcode_rwbuffer[0] = datetime.b.msg_time[0]; 39258c2ecf20Sopenharmony_ci pacb->msgcode_rwbuffer[1] = datetime.b.msg_time[1]; 39268c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_SYNC_TIMER, ®->inbound_msgaddr0); 39278c2ecf20Sopenharmony_ci pacb->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_MESSAGE_CMD_DONE; 39288c2ecf20Sopenharmony_ci writel(pacb->out_doorbell, ®->iobound_doorbell); 39298c2ecf20Sopenharmony_ci break; 39308c2ecf20Sopenharmony_ci } 39318c2ecf20Sopenharmony_ci } 39328c2ecf20Sopenharmony_ci if (sys_tz.tz_minuteswest) 39338c2ecf20Sopenharmony_ci next_time = ARCMSR_HOURS; 39348c2ecf20Sopenharmony_ci else 39358c2ecf20Sopenharmony_ci next_time = ARCMSR_MINUTES; 39368c2ecf20Sopenharmony_ci mod_timer(&pacb->refresh_timer, jiffies + msecs_to_jiffies(next_time)); 39378c2ecf20Sopenharmony_ci} 39388c2ecf20Sopenharmony_ci 39398c2ecf20Sopenharmony_cistatic int arcmsr_iop_confirm(struct AdapterControlBlock *acb) 39408c2ecf20Sopenharmony_ci{ 39418c2ecf20Sopenharmony_ci uint32_t cdb_phyaddr, cdb_phyaddr_hi32; 39428c2ecf20Sopenharmony_ci dma_addr_t dma_coherent_handle; 39438c2ecf20Sopenharmony_ci 39448c2ecf20Sopenharmony_ci /* 39458c2ecf20Sopenharmony_ci ******************************************************************** 39468c2ecf20Sopenharmony_ci ** here we need to tell iop 331 our freeccb.HighPart 39478c2ecf20Sopenharmony_ci ** if freeccb.HighPart is not zero 39488c2ecf20Sopenharmony_ci ******************************************************************** 39498c2ecf20Sopenharmony_ci */ 39508c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 39518c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: 39528c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: 39538c2ecf20Sopenharmony_ci dma_coherent_handle = acb->dma_coherent_handle2; 39548c2ecf20Sopenharmony_ci break; 39558c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 39568c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 39578c2ecf20Sopenharmony_ci dma_coherent_handle = acb->dma_coherent_handle + 39588c2ecf20Sopenharmony_ci offsetof(struct CommandControlBlock, arcmsr_cdb); 39598c2ecf20Sopenharmony_ci break; 39608c2ecf20Sopenharmony_ci default: 39618c2ecf20Sopenharmony_ci dma_coherent_handle = acb->dma_coherent_handle; 39628c2ecf20Sopenharmony_ci break; 39638c2ecf20Sopenharmony_ci } 39648c2ecf20Sopenharmony_ci cdb_phyaddr = lower_32_bits(dma_coherent_handle); 39658c2ecf20Sopenharmony_ci cdb_phyaddr_hi32 = upper_32_bits(dma_coherent_handle); 39668c2ecf20Sopenharmony_ci acb->cdb_phyaddr_hi32 = cdb_phyaddr_hi32; 39678c2ecf20Sopenharmony_ci acb->cdb_phyadd_hipart = ((uint64_t)cdb_phyaddr_hi32) << 32; 39688c2ecf20Sopenharmony_ci /* 39698c2ecf20Sopenharmony_ci *********************************************************************** 39708c2ecf20Sopenharmony_ci ** if adapter type B, set window of "post command Q" 39718c2ecf20Sopenharmony_ci *********************************************************************** 39728c2ecf20Sopenharmony_ci */ 39738c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 39748c2ecf20Sopenharmony_ci 39758c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: { 39768c2ecf20Sopenharmony_ci if (cdb_phyaddr_hi32 != 0) { 39778c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 39788c2ecf20Sopenharmony_ci writel(ARCMSR_SIGNATURE_SET_CONFIG, \ 39798c2ecf20Sopenharmony_ci ®->message_rwbuffer[0]); 39808c2ecf20Sopenharmony_ci writel(cdb_phyaddr_hi32, ®->message_rwbuffer[1]); 39818c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_SET_CONFIG, \ 39828c2ecf20Sopenharmony_ci ®->inbound_msgaddr0); 39838c2ecf20Sopenharmony_ci if (!arcmsr_hbaA_wait_msgint_ready(acb)) { 39848c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: ""set ccb high \ 39858c2ecf20Sopenharmony_ci part physical address timeout\n", 39868c2ecf20Sopenharmony_ci acb->host->host_no); 39878c2ecf20Sopenharmony_ci return 1; 39888c2ecf20Sopenharmony_ci } 39898c2ecf20Sopenharmony_ci } 39908c2ecf20Sopenharmony_ci } 39918c2ecf20Sopenharmony_ci break; 39928c2ecf20Sopenharmony_ci 39938c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 39948c2ecf20Sopenharmony_ci uint32_t __iomem *rwbuffer; 39958c2ecf20Sopenharmony_ci 39968c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 39978c2ecf20Sopenharmony_ci reg->postq_index = 0; 39988c2ecf20Sopenharmony_ci reg->doneq_index = 0; 39998c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_SET_POST_WINDOW, reg->drv2iop_doorbell); 40008c2ecf20Sopenharmony_ci if (!arcmsr_hbaB_wait_msgint_ready(acb)) { 40018c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: cannot set driver mode\n", \ 40028c2ecf20Sopenharmony_ci acb->host->host_no); 40038c2ecf20Sopenharmony_ci return 1; 40048c2ecf20Sopenharmony_ci } 40058c2ecf20Sopenharmony_ci rwbuffer = reg->message_rwbuffer; 40068c2ecf20Sopenharmony_ci /* driver "set config" signature */ 40078c2ecf20Sopenharmony_ci writel(ARCMSR_SIGNATURE_SET_CONFIG, rwbuffer++); 40088c2ecf20Sopenharmony_ci /* normal should be zero */ 40098c2ecf20Sopenharmony_ci writel(cdb_phyaddr_hi32, rwbuffer++); 40108c2ecf20Sopenharmony_ci /* postQ size (256 + 8)*4 */ 40118c2ecf20Sopenharmony_ci writel(cdb_phyaddr, rwbuffer++); 40128c2ecf20Sopenharmony_ci /* doneQ size (256 + 8)*4 */ 40138c2ecf20Sopenharmony_ci writel(cdb_phyaddr + 1056, rwbuffer++); 40148c2ecf20Sopenharmony_ci /* ccb maxQ size must be --> [(256 + 8)*4]*/ 40158c2ecf20Sopenharmony_ci writel(1056, rwbuffer); 40168c2ecf20Sopenharmony_ci 40178c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_SET_CONFIG, reg->drv2iop_doorbell); 40188c2ecf20Sopenharmony_ci if (!arcmsr_hbaB_wait_msgint_ready(acb)) { 40198c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: 'set command Q window' \ 40208c2ecf20Sopenharmony_ci timeout \n",acb->host->host_no); 40218c2ecf20Sopenharmony_ci return 1; 40228c2ecf20Sopenharmony_ci } 40238c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_START_DRIVER_MODE, reg->drv2iop_doorbell); 40248c2ecf20Sopenharmony_ci if (!arcmsr_hbaB_wait_msgint_ready(acb)) { 40258c2ecf20Sopenharmony_ci pr_err("arcmsr%d: can't set driver mode.\n", 40268c2ecf20Sopenharmony_ci acb->host->host_no); 40278c2ecf20Sopenharmony_ci return 1; 40288c2ecf20Sopenharmony_ci } 40298c2ecf20Sopenharmony_ci } 40308c2ecf20Sopenharmony_ci break; 40318c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: { 40328c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 40338c2ecf20Sopenharmony_ci 40348c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: cdb_phyaddr_hi32=0x%x\n", 40358c2ecf20Sopenharmony_ci acb->adapter_index, cdb_phyaddr_hi32); 40368c2ecf20Sopenharmony_ci writel(ARCMSR_SIGNATURE_SET_CONFIG, ®->msgcode_rwbuffer[0]); 40378c2ecf20Sopenharmony_ci writel(cdb_phyaddr_hi32, ®->msgcode_rwbuffer[1]); 40388c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_SET_CONFIG, ®->inbound_msgaddr0); 40398c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, ®->inbound_doorbell); 40408c2ecf20Sopenharmony_ci if (!arcmsr_hbaC_wait_msgint_ready(acb)) { 40418c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: 'set command Q window' \ 40428c2ecf20Sopenharmony_ci timeout \n", acb->host->host_no); 40438c2ecf20Sopenharmony_ci return 1; 40448c2ecf20Sopenharmony_ci } 40458c2ecf20Sopenharmony_ci } 40468c2ecf20Sopenharmony_ci break; 40478c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 40488c2ecf20Sopenharmony_ci uint32_t __iomem *rwbuffer; 40498c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 40508c2ecf20Sopenharmony_ci reg->postq_index = 0; 40518c2ecf20Sopenharmony_ci reg->doneq_index = 0; 40528c2ecf20Sopenharmony_ci rwbuffer = reg->msgcode_rwbuffer; 40538c2ecf20Sopenharmony_ci writel(ARCMSR_SIGNATURE_SET_CONFIG, rwbuffer++); 40548c2ecf20Sopenharmony_ci writel(cdb_phyaddr_hi32, rwbuffer++); 40558c2ecf20Sopenharmony_ci writel(cdb_phyaddr, rwbuffer++); 40568c2ecf20Sopenharmony_ci writel(cdb_phyaddr + (ARCMSR_MAX_ARC1214_POSTQUEUE * 40578c2ecf20Sopenharmony_ci sizeof(struct InBound_SRB)), rwbuffer++); 40588c2ecf20Sopenharmony_ci writel(0x100, rwbuffer); 40598c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_SET_CONFIG, reg->inbound_msgaddr0); 40608c2ecf20Sopenharmony_ci if (!arcmsr_hbaD_wait_msgint_ready(acb)) { 40618c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: 'set command Q window' timeout\n", 40628c2ecf20Sopenharmony_ci acb->host->host_no); 40638c2ecf20Sopenharmony_ci return 1; 40648c2ecf20Sopenharmony_ci } 40658c2ecf20Sopenharmony_ci } 40668c2ecf20Sopenharmony_ci break; 40678c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: { 40688c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 40698c2ecf20Sopenharmony_ci writel(ARCMSR_SIGNATURE_SET_CONFIG, ®->msgcode_rwbuffer[0]); 40708c2ecf20Sopenharmony_ci writel(ARCMSR_SIGNATURE_1884, ®->msgcode_rwbuffer[1]); 40718c2ecf20Sopenharmony_ci writel(cdb_phyaddr, ®->msgcode_rwbuffer[2]); 40728c2ecf20Sopenharmony_ci writel(cdb_phyaddr_hi32, ®->msgcode_rwbuffer[3]); 40738c2ecf20Sopenharmony_ci writel(acb->ccbsize, ®->msgcode_rwbuffer[4]); 40748c2ecf20Sopenharmony_ci writel(lower_32_bits(acb->dma_coherent_handle2), ®->msgcode_rwbuffer[5]); 40758c2ecf20Sopenharmony_ci writel(upper_32_bits(acb->dma_coherent_handle2), ®->msgcode_rwbuffer[6]); 40768c2ecf20Sopenharmony_ci writel(acb->ioqueue_size, ®->msgcode_rwbuffer[7]); 40778c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_SET_CONFIG, ®->inbound_msgaddr0); 40788c2ecf20Sopenharmony_ci acb->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_MESSAGE_CMD_DONE; 40798c2ecf20Sopenharmony_ci writel(acb->out_doorbell, ®->iobound_doorbell); 40808c2ecf20Sopenharmony_ci if (!arcmsr_hbaE_wait_msgint_ready(acb)) { 40818c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: 'set command Q window' timeout \n", 40828c2ecf20Sopenharmony_ci acb->host->host_no); 40838c2ecf20Sopenharmony_ci return 1; 40848c2ecf20Sopenharmony_ci } 40858c2ecf20Sopenharmony_ci } 40868c2ecf20Sopenharmony_ci break; 40878c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 40888c2ecf20Sopenharmony_ci struct MessageUnit_F __iomem *reg = acb->pmuF; 40898c2ecf20Sopenharmony_ci 40908c2ecf20Sopenharmony_ci acb->msgcode_rwbuffer[0] = ARCMSR_SIGNATURE_SET_CONFIG; 40918c2ecf20Sopenharmony_ci acb->msgcode_rwbuffer[1] = ARCMSR_SIGNATURE_1886; 40928c2ecf20Sopenharmony_ci acb->msgcode_rwbuffer[2] = cdb_phyaddr; 40938c2ecf20Sopenharmony_ci acb->msgcode_rwbuffer[3] = cdb_phyaddr_hi32; 40948c2ecf20Sopenharmony_ci acb->msgcode_rwbuffer[4] = acb->ccbsize; 40958c2ecf20Sopenharmony_ci acb->msgcode_rwbuffer[5] = lower_32_bits(acb->dma_coherent_handle2); 40968c2ecf20Sopenharmony_ci acb->msgcode_rwbuffer[6] = upper_32_bits(acb->dma_coherent_handle2); 40978c2ecf20Sopenharmony_ci acb->msgcode_rwbuffer[7] = acb->completeQ_size; 40988c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_SET_CONFIG, ®->inbound_msgaddr0); 40998c2ecf20Sopenharmony_ci acb->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_MESSAGE_CMD_DONE; 41008c2ecf20Sopenharmony_ci writel(acb->out_doorbell, ®->iobound_doorbell); 41018c2ecf20Sopenharmony_ci if (!arcmsr_hbaE_wait_msgint_ready(acb)) { 41028c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: 'set command Q window' timeout\n", 41038c2ecf20Sopenharmony_ci acb->host->host_no); 41048c2ecf20Sopenharmony_ci return 1; 41058c2ecf20Sopenharmony_ci } 41068c2ecf20Sopenharmony_ci } 41078c2ecf20Sopenharmony_ci break; 41088c2ecf20Sopenharmony_ci } 41098c2ecf20Sopenharmony_ci return 0; 41108c2ecf20Sopenharmony_ci} 41118c2ecf20Sopenharmony_ci 41128c2ecf20Sopenharmony_cistatic void arcmsr_wait_firmware_ready(struct AdapterControlBlock *acb) 41138c2ecf20Sopenharmony_ci{ 41148c2ecf20Sopenharmony_ci uint32_t firmware_state = 0; 41158c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 41168c2ecf20Sopenharmony_ci 41178c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: { 41188c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 41198c2ecf20Sopenharmony_ci do { 41208c2ecf20Sopenharmony_ci if (!(acb->acb_flags & ACB_F_IOP_INITED)) 41218c2ecf20Sopenharmony_ci msleep(20); 41228c2ecf20Sopenharmony_ci firmware_state = readl(®->outbound_msgaddr1); 41238c2ecf20Sopenharmony_ci } while ((firmware_state & ARCMSR_OUTBOUND_MESG1_FIRMWARE_OK) == 0); 41248c2ecf20Sopenharmony_ci } 41258c2ecf20Sopenharmony_ci break; 41268c2ecf20Sopenharmony_ci 41278c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 41288c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 41298c2ecf20Sopenharmony_ci do { 41308c2ecf20Sopenharmony_ci if (!(acb->acb_flags & ACB_F_IOP_INITED)) 41318c2ecf20Sopenharmony_ci msleep(20); 41328c2ecf20Sopenharmony_ci firmware_state = readl(reg->iop2drv_doorbell); 41338c2ecf20Sopenharmony_ci } while ((firmware_state & ARCMSR_MESSAGE_FIRMWARE_OK) == 0); 41348c2ecf20Sopenharmony_ci writel(ARCMSR_DRV2IOP_END_OF_INTERRUPT, reg->drv2iop_doorbell); 41358c2ecf20Sopenharmony_ci } 41368c2ecf20Sopenharmony_ci break; 41378c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: { 41388c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 41398c2ecf20Sopenharmony_ci do { 41408c2ecf20Sopenharmony_ci if (!(acb->acb_flags & ACB_F_IOP_INITED)) 41418c2ecf20Sopenharmony_ci msleep(20); 41428c2ecf20Sopenharmony_ci firmware_state = readl(®->outbound_msgaddr1); 41438c2ecf20Sopenharmony_ci } while ((firmware_state & ARCMSR_HBCMU_MESSAGE_FIRMWARE_OK) == 0); 41448c2ecf20Sopenharmony_ci } 41458c2ecf20Sopenharmony_ci break; 41468c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 41478c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 41488c2ecf20Sopenharmony_ci do { 41498c2ecf20Sopenharmony_ci if (!(acb->acb_flags & ACB_F_IOP_INITED)) 41508c2ecf20Sopenharmony_ci msleep(20); 41518c2ecf20Sopenharmony_ci firmware_state = readl(reg->outbound_msgaddr1); 41528c2ecf20Sopenharmony_ci } while ((firmware_state & 41538c2ecf20Sopenharmony_ci ARCMSR_ARC1214_MESSAGE_FIRMWARE_OK) == 0); 41548c2ecf20Sopenharmony_ci } 41558c2ecf20Sopenharmony_ci break; 41568c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 41578c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 41588c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 41598c2ecf20Sopenharmony_ci do { 41608c2ecf20Sopenharmony_ci if (!(acb->acb_flags & ACB_F_IOP_INITED)) 41618c2ecf20Sopenharmony_ci msleep(20); 41628c2ecf20Sopenharmony_ci firmware_state = readl(®->outbound_msgaddr1); 41638c2ecf20Sopenharmony_ci } while ((firmware_state & ARCMSR_HBEMU_MESSAGE_FIRMWARE_OK) == 0); 41648c2ecf20Sopenharmony_ci } 41658c2ecf20Sopenharmony_ci break; 41668c2ecf20Sopenharmony_ci } 41678c2ecf20Sopenharmony_ci} 41688c2ecf20Sopenharmony_ci 41698c2ecf20Sopenharmony_cistatic void arcmsr_request_device_map(struct timer_list *t) 41708c2ecf20Sopenharmony_ci{ 41718c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb = from_timer(acb, t, eternal_timer); 41728c2ecf20Sopenharmony_ci if (acb->acb_flags & (ACB_F_MSG_GET_CONFIG | ACB_F_BUS_RESET | ACB_F_ABORT)) { 41738c2ecf20Sopenharmony_ci mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ)); 41748c2ecf20Sopenharmony_ci } else { 41758c2ecf20Sopenharmony_ci acb->fw_flag = FW_NORMAL; 41768c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 41778c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: { 41788c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 41798c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, ®->inbound_msgaddr0); 41808c2ecf20Sopenharmony_ci break; 41818c2ecf20Sopenharmony_ci } 41828c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 41838c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 41848c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_GET_CONFIG, reg->drv2iop_doorbell); 41858c2ecf20Sopenharmony_ci break; 41868c2ecf20Sopenharmony_ci } 41878c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: { 41888c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 41898c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, ®->inbound_msgaddr0); 41908c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, ®->inbound_doorbell); 41918c2ecf20Sopenharmony_ci break; 41928c2ecf20Sopenharmony_ci } 41938c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 41948c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 41958c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, reg->inbound_msgaddr0); 41968c2ecf20Sopenharmony_ci break; 41978c2ecf20Sopenharmony_ci } 41988c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: { 41998c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 42008c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, ®->inbound_msgaddr0); 42018c2ecf20Sopenharmony_ci acb->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_MESSAGE_CMD_DONE; 42028c2ecf20Sopenharmony_ci writel(acb->out_doorbell, ®->iobound_doorbell); 42038c2ecf20Sopenharmony_ci break; 42048c2ecf20Sopenharmony_ci } 42058c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 42068c2ecf20Sopenharmony_ci struct MessageUnit_F __iomem *reg = acb->pmuF; 42078c2ecf20Sopenharmony_ci uint32_t outMsg1 = readl(®->outbound_msgaddr1); 42088c2ecf20Sopenharmony_ci 42098c2ecf20Sopenharmony_ci if (!(outMsg1 & ARCMSR_HBFMU_MESSAGE_FIRMWARE_OK) || 42108c2ecf20Sopenharmony_ci (outMsg1 & ARCMSR_HBFMU_MESSAGE_NO_VOLUME_CHANGE)) 42118c2ecf20Sopenharmony_ci goto nxt6s; 42128c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, ®->inbound_msgaddr0); 42138c2ecf20Sopenharmony_ci acb->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_MESSAGE_CMD_DONE; 42148c2ecf20Sopenharmony_ci writel(acb->out_doorbell, ®->iobound_doorbell); 42158c2ecf20Sopenharmony_ci break; 42168c2ecf20Sopenharmony_ci } 42178c2ecf20Sopenharmony_ci default: 42188c2ecf20Sopenharmony_ci return; 42198c2ecf20Sopenharmony_ci } 42208c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_MSG_GET_CONFIG; 42218c2ecf20Sopenharmony_cinxt6s: 42228c2ecf20Sopenharmony_ci mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ)); 42238c2ecf20Sopenharmony_ci } 42248c2ecf20Sopenharmony_ci} 42258c2ecf20Sopenharmony_ci 42268c2ecf20Sopenharmony_cistatic void arcmsr_hbaA_start_bgrb(struct AdapterControlBlock *acb) 42278c2ecf20Sopenharmony_ci{ 42288c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 42298c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_MSG_START_BGRB; 42308c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_START_BGRB, ®->inbound_msgaddr0); 42318c2ecf20Sopenharmony_ci if (!arcmsr_hbaA_wait_msgint_ready(acb)) { 42328c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: wait 'start adapter background \ 42338c2ecf20Sopenharmony_ci rebuild' timeout \n", acb->host->host_no); 42348c2ecf20Sopenharmony_ci } 42358c2ecf20Sopenharmony_ci} 42368c2ecf20Sopenharmony_ci 42378c2ecf20Sopenharmony_cistatic void arcmsr_hbaB_start_bgrb(struct AdapterControlBlock *acb) 42388c2ecf20Sopenharmony_ci{ 42398c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 42408c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_MSG_START_BGRB; 42418c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_START_BGRB, reg->drv2iop_doorbell); 42428c2ecf20Sopenharmony_ci if (!arcmsr_hbaB_wait_msgint_ready(acb)) { 42438c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: wait 'start adapter background \ 42448c2ecf20Sopenharmony_ci rebuild' timeout \n",acb->host->host_no); 42458c2ecf20Sopenharmony_ci } 42468c2ecf20Sopenharmony_ci} 42478c2ecf20Sopenharmony_ci 42488c2ecf20Sopenharmony_cistatic void arcmsr_hbaC_start_bgrb(struct AdapterControlBlock *pACB) 42498c2ecf20Sopenharmony_ci{ 42508c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *phbcmu = pACB->pmuC; 42518c2ecf20Sopenharmony_ci pACB->acb_flags |= ACB_F_MSG_START_BGRB; 42528c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_START_BGRB, &phbcmu->inbound_msgaddr0); 42538c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, &phbcmu->inbound_doorbell); 42548c2ecf20Sopenharmony_ci if (!arcmsr_hbaC_wait_msgint_ready(pACB)) { 42558c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: wait 'start adapter background \ 42568c2ecf20Sopenharmony_ci rebuild' timeout \n", pACB->host->host_no); 42578c2ecf20Sopenharmony_ci } 42588c2ecf20Sopenharmony_ci return; 42598c2ecf20Sopenharmony_ci} 42608c2ecf20Sopenharmony_ci 42618c2ecf20Sopenharmony_cistatic void arcmsr_hbaD_start_bgrb(struct AdapterControlBlock *pACB) 42628c2ecf20Sopenharmony_ci{ 42638c2ecf20Sopenharmony_ci struct MessageUnit_D *pmu = pACB->pmuD; 42648c2ecf20Sopenharmony_ci 42658c2ecf20Sopenharmony_ci pACB->acb_flags |= ACB_F_MSG_START_BGRB; 42668c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_START_BGRB, pmu->inbound_msgaddr0); 42678c2ecf20Sopenharmony_ci if (!arcmsr_hbaD_wait_msgint_ready(pACB)) { 42688c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: wait 'start adapter " 42698c2ecf20Sopenharmony_ci "background rebuild' timeout\n", pACB->host->host_no); 42708c2ecf20Sopenharmony_ci } 42718c2ecf20Sopenharmony_ci} 42728c2ecf20Sopenharmony_ci 42738c2ecf20Sopenharmony_cistatic void arcmsr_hbaE_start_bgrb(struct AdapterControlBlock *pACB) 42748c2ecf20Sopenharmony_ci{ 42758c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *pmu = pACB->pmuE; 42768c2ecf20Sopenharmony_ci 42778c2ecf20Sopenharmony_ci pACB->acb_flags |= ACB_F_MSG_START_BGRB; 42788c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_MESG0_START_BGRB, &pmu->inbound_msgaddr0); 42798c2ecf20Sopenharmony_ci pACB->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_MESSAGE_CMD_DONE; 42808c2ecf20Sopenharmony_ci writel(pACB->out_doorbell, &pmu->iobound_doorbell); 42818c2ecf20Sopenharmony_ci if (!arcmsr_hbaE_wait_msgint_ready(pACB)) { 42828c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: wait 'start adapter " 42838c2ecf20Sopenharmony_ci "background rebuild' timeout \n", pACB->host->host_no); 42848c2ecf20Sopenharmony_ci } 42858c2ecf20Sopenharmony_ci} 42868c2ecf20Sopenharmony_ci 42878c2ecf20Sopenharmony_cistatic void arcmsr_start_adapter_bgrb(struct AdapterControlBlock *acb) 42888c2ecf20Sopenharmony_ci{ 42898c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 42908c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: 42918c2ecf20Sopenharmony_ci arcmsr_hbaA_start_bgrb(acb); 42928c2ecf20Sopenharmony_ci break; 42938c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: 42948c2ecf20Sopenharmony_ci arcmsr_hbaB_start_bgrb(acb); 42958c2ecf20Sopenharmony_ci break; 42968c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: 42978c2ecf20Sopenharmony_ci arcmsr_hbaC_start_bgrb(acb); 42988c2ecf20Sopenharmony_ci break; 42998c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: 43008c2ecf20Sopenharmony_ci arcmsr_hbaD_start_bgrb(acb); 43018c2ecf20Sopenharmony_ci break; 43028c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 43038c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: 43048c2ecf20Sopenharmony_ci arcmsr_hbaE_start_bgrb(acb); 43058c2ecf20Sopenharmony_ci break; 43068c2ecf20Sopenharmony_ci } 43078c2ecf20Sopenharmony_ci} 43088c2ecf20Sopenharmony_ci 43098c2ecf20Sopenharmony_cistatic void arcmsr_clear_doorbell_queue_buffer(struct AdapterControlBlock *acb) 43108c2ecf20Sopenharmony_ci{ 43118c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 43128c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: { 43138c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 43148c2ecf20Sopenharmony_ci uint32_t outbound_doorbell; 43158c2ecf20Sopenharmony_ci /* empty doorbell Qbuffer if door bell ringed */ 43168c2ecf20Sopenharmony_ci outbound_doorbell = readl(®->outbound_doorbell); 43178c2ecf20Sopenharmony_ci /*clear doorbell interrupt */ 43188c2ecf20Sopenharmony_ci writel(outbound_doorbell, ®->outbound_doorbell); 43198c2ecf20Sopenharmony_ci writel(ARCMSR_INBOUND_DRIVER_DATA_READ_OK, ®->inbound_doorbell); 43208c2ecf20Sopenharmony_ci } 43218c2ecf20Sopenharmony_ci break; 43228c2ecf20Sopenharmony_ci 43238c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: { 43248c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 43258c2ecf20Sopenharmony_ci uint32_t outbound_doorbell, i; 43268c2ecf20Sopenharmony_ci writel(ARCMSR_DOORBELL_INT_CLEAR_PATTERN, reg->iop2drv_doorbell); 43278c2ecf20Sopenharmony_ci writel(ARCMSR_DRV2IOP_DATA_READ_OK, reg->drv2iop_doorbell); 43288c2ecf20Sopenharmony_ci /* let IOP know data has been read */ 43298c2ecf20Sopenharmony_ci for(i=0; i < 200; i++) { 43308c2ecf20Sopenharmony_ci msleep(20); 43318c2ecf20Sopenharmony_ci outbound_doorbell = readl(reg->iop2drv_doorbell); 43328c2ecf20Sopenharmony_ci if( outbound_doorbell & ARCMSR_IOP2DRV_DATA_WRITE_OK) { 43338c2ecf20Sopenharmony_ci writel(ARCMSR_DOORBELL_INT_CLEAR_PATTERN, reg->iop2drv_doorbell); 43348c2ecf20Sopenharmony_ci writel(ARCMSR_DRV2IOP_DATA_READ_OK, reg->drv2iop_doorbell); 43358c2ecf20Sopenharmony_ci } else 43368c2ecf20Sopenharmony_ci break; 43378c2ecf20Sopenharmony_ci } 43388c2ecf20Sopenharmony_ci } 43398c2ecf20Sopenharmony_ci break; 43408c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: { 43418c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 43428c2ecf20Sopenharmony_ci uint32_t outbound_doorbell, i; 43438c2ecf20Sopenharmony_ci /* empty doorbell Qbuffer if door bell ringed */ 43448c2ecf20Sopenharmony_ci outbound_doorbell = readl(®->outbound_doorbell); 43458c2ecf20Sopenharmony_ci writel(outbound_doorbell, ®->outbound_doorbell_clear); 43468c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_DRV2IOP_DATA_READ_OK, ®->inbound_doorbell); 43478c2ecf20Sopenharmony_ci for (i = 0; i < 200; i++) { 43488c2ecf20Sopenharmony_ci msleep(20); 43498c2ecf20Sopenharmony_ci outbound_doorbell = readl(®->outbound_doorbell); 43508c2ecf20Sopenharmony_ci if (outbound_doorbell & 43518c2ecf20Sopenharmony_ci ARCMSR_HBCMU_IOP2DRV_DATA_WRITE_OK) { 43528c2ecf20Sopenharmony_ci writel(outbound_doorbell, 43538c2ecf20Sopenharmony_ci ®->outbound_doorbell_clear); 43548c2ecf20Sopenharmony_ci writel(ARCMSR_HBCMU_DRV2IOP_DATA_READ_OK, 43558c2ecf20Sopenharmony_ci ®->inbound_doorbell); 43568c2ecf20Sopenharmony_ci } else 43578c2ecf20Sopenharmony_ci break; 43588c2ecf20Sopenharmony_ci } 43598c2ecf20Sopenharmony_ci } 43608c2ecf20Sopenharmony_ci break; 43618c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D: { 43628c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 43638c2ecf20Sopenharmony_ci uint32_t outbound_doorbell, i; 43648c2ecf20Sopenharmony_ci /* empty doorbell Qbuffer if door bell ringed */ 43658c2ecf20Sopenharmony_ci outbound_doorbell = readl(reg->outbound_doorbell); 43668c2ecf20Sopenharmony_ci writel(outbound_doorbell, reg->outbound_doorbell); 43678c2ecf20Sopenharmony_ci writel(ARCMSR_ARC1214_DRV2IOP_DATA_OUT_READ, 43688c2ecf20Sopenharmony_ci reg->inbound_doorbell); 43698c2ecf20Sopenharmony_ci for (i = 0; i < 200; i++) { 43708c2ecf20Sopenharmony_ci msleep(20); 43718c2ecf20Sopenharmony_ci outbound_doorbell = readl(reg->outbound_doorbell); 43728c2ecf20Sopenharmony_ci if (outbound_doorbell & 43738c2ecf20Sopenharmony_ci ARCMSR_ARC1214_IOP2DRV_DATA_WRITE_OK) { 43748c2ecf20Sopenharmony_ci writel(outbound_doorbell, 43758c2ecf20Sopenharmony_ci reg->outbound_doorbell); 43768c2ecf20Sopenharmony_ci writel(ARCMSR_ARC1214_DRV2IOP_DATA_OUT_READ, 43778c2ecf20Sopenharmony_ci reg->inbound_doorbell); 43788c2ecf20Sopenharmony_ci } else 43798c2ecf20Sopenharmony_ci break; 43808c2ecf20Sopenharmony_ci } 43818c2ecf20Sopenharmony_ci } 43828c2ecf20Sopenharmony_ci break; 43838c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 43848c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F: { 43858c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 43868c2ecf20Sopenharmony_ci uint32_t i, tmp; 43878c2ecf20Sopenharmony_ci 43888c2ecf20Sopenharmony_ci acb->in_doorbell = readl(®->iobound_doorbell); 43898c2ecf20Sopenharmony_ci writel(0, ®->host_int_status); /*clear interrupt*/ 43908c2ecf20Sopenharmony_ci acb->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_DATA_READ_OK; 43918c2ecf20Sopenharmony_ci writel(acb->out_doorbell, ®->iobound_doorbell); 43928c2ecf20Sopenharmony_ci for(i=0; i < 200; i++) { 43938c2ecf20Sopenharmony_ci msleep(20); 43948c2ecf20Sopenharmony_ci tmp = acb->in_doorbell; 43958c2ecf20Sopenharmony_ci acb->in_doorbell = readl(®->iobound_doorbell); 43968c2ecf20Sopenharmony_ci if((tmp ^ acb->in_doorbell) & ARCMSR_HBEMU_IOP2DRV_DATA_WRITE_OK) { 43978c2ecf20Sopenharmony_ci writel(0, ®->host_int_status); /*clear interrupt*/ 43988c2ecf20Sopenharmony_ci acb->out_doorbell ^= ARCMSR_HBEMU_DRV2IOP_DATA_READ_OK; 43998c2ecf20Sopenharmony_ci writel(acb->out_doorbell, ®->iobound_doorbell); 44008c2ecf20Sopenharmony_ci } else 44018c2ecf20Sopenharmony_ci break; 44028c2ecf20Sopenharmony_ci } 44038c2ecf20Sopenharmony_ci } 44048c2ecf20Sopenharmony_ci break; 44058c2ecf20Sopenharmony_ci } 44068c2ecf20Sopenharmony_ci} 44078c2ecf20Sopenharmony_ci 44088c2ecf20Sopenharmony_cistatic void arcmsr_enable_eoi_mode(struct AdapterControlBlock *acb) 44098c2ecf20Sopenharmony_ci{ 44108c2ecf20Sopenharmony_ci switch (acb->adapter_type) { 44118c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A: 44128c2ecf20Sopenharmony_ci return; 44138c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B: 44148c2ecf20Sopenharmony_ci { 44158c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 44168c2ecf20Sopenharmony_ci writel(ARCMSR_MESSAGE_ACTIVE_EOI_MODE, reg->drv2iop_doorbell); 44178c2ecf20Sopenharmony_ci if (!arcmsr_hbaB_wait_msgint_ready(acb)) { 44188c2ecf20Sopenharmony_ci printk(KERN_NOTICE "ARCMSR IOP enables EOI_MODE TIMEOUT"); 44198c2ecf20Sopenharmony_ci return; 44208c2ecf20Sopenharmony_ci } 44218c2ecf20Sopenharmony_ci } 44228c2ecf20Sopenharmony_ci break; 44238c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C: 44248c2ecf20Sopenharmony_ci return; 44258c2ecf20Sopenharmony_ci } 44268c2ecf20Sopenharmony_ci return; 44278c2ecf20Sopenharmony_ci} 44288c2ecf20Sopenharmony_ci 44298c2ecf20Sopenharmony_cistatic void arcmsr_hardware_reset(struct AdapterControlBlock *acb) 44308c2ecf20Sopenharmony_ci{ 44318c2ecf20Sopenharmony_ci uint8_t value[64]; 44328c2ecf20Sopenharmony_ci int i, count = 0; 44338c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *pmuA = acb->pmuA; 44348c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *pmuC = acb->pmuC; 44358c2ecf20Sopenharmony_ci struct MessageUnit_D *pmuD = acb->pmuD; 44368c2ecf20Sopenharmony_ci 44378c2ecf20Sopenharmony_ci /* backup pci config data */ 44388c2ecf20Sopenharmony_ci printk(KERN_NOTICE "arcmsr%d: executing hw bus reset .....\n", acb->host->host_no); 44398c2ecf20Sopenharmony_ci for (i = 0; i < 64; i++) { 44408c2ecf20Sopenharmony_ci pci_read_config_byte(acb->pdev, i, &value[i]); 44418c2ecf20Sopenharmony_ci } 44428c2ecf20Sopenharmony_ci /* hardware reset signal */ 44438c2ecf20Sopenharmony_ci if (acb->dev_id == 0x1680) { 44448c2ecf20Sopenharmony_ci writel(ARCMSR_ARC1680_BUS_RESET, &pmuA->reserved1[0]); 44458c2ecf20Sopenharmony_ci } else if (acb->dev_id == 0x1880) { 44468c2ecf20Sopenharmony_ci do { 44478c2ecf20Sopenharmony_ci count++; 44488c2ecf20Sopenharmony_ci writel(0xF, &pmuC->write_sequence); 44498c2ecf20Sopenharmony_ci writel(0x4, &pmuC->write_sequence); 44508c2ecf20Sopenharmony_ci writel(0xB, &pmuC->write_sequence); 44518c2ecf20Sopenharmony_ci writel(0x2, &pmuC->write_sequence); 44528c2ecf20Sopenharmony_ci writel(0x7, &pmuC->write_sequence); 44538c2ecf20Sopenharmony_ci writel(0xD, &pmuC->write_sequence); 44548c2ecf20Sopenharmony_ci } while (((readl(&pmuC->host_diagnostic) & ARCMSR_ARC1880_DiagWrite_ENABLE) == 0) && (count < 5)); 44558c2ecf20Sopenharmony_ci writel(ARCMSR_ARC1880_RESET_ADAPTER, &pmuC->host_diagnostic); 44568c2ecf20Sopenharmony_ci } else if (acb->dev_id == 0x1884) { 44578c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *pmuE = acb->pmuE; 44588c2ecf20Sopenharmony_ci do { 44598c2ecf20Sopenharmony_ci count++; 44608c2ecf20Sopenharmony_ci writel(0x4, &pmuE->write_sequence_3xxx); 44618c2ecf20Sopenharmony_ci writel(0xB, &pmuE->write_sequence_3xxx); 44628c2ecf20Sopenharmony_ci writel(0x2, &pmuE->write_sequence_3xxx); 44638c2ecf20Sopenharmony_ci writel(0x7, &pmuE->write_sequence_3xxx); 44648c2ecf20Sopenharmony_ci writel(0xD, &pmuE->write_sequence_3xxx); 44658c2ecf20Sopenharmony_ci mdelay(10); 44668c2ecf20Sopenharmony_ci } while (((readl(&pmuE->host_diagnostic_3xxx) & 44678c2ecf20Sopenharmony_ci ARCMSR_ARC1884_DiagWrite_ENABLE) == 0) && (count < 5)); 44688c2ecf20Sopenharmony_ci writel(ARCMSR_ARC188X_RESET_ADAPTER, &pmuE->host_diagnostic_3xxx); 44698c2ecf20Sopenharmony_ci } else if (acb->dev_id == 0x1214) { 44708c2ecf20Sopenharmony_ci writel(0x20, pmuD->reset_request); 44718c2ecf20Sopenharmony_ci } else { 44728c2ecf20Sopenharmony_ci pci_write_config_byte(acb->pdev, 0x84, 0x20); 44738c2ecf20Sopenharmony_ci } 44748c2ecf20Sopenharmony_ci msleep(2000); 44758c2ecf20Sopenharmony_ci /* write back pci config data */ 44768c2ecf20Sopenharmony_ci for (i = 0; i < 64; i++) { 44778c2ecf20Sopenharmony_ci pci_write_config_byte(acb->pdev, i, value[i]); 44788c2ecf20Sopenharmony_ci } 44798c2ecf20Sopenharmony_ci msleep(1000); 44808c2ecf20Sopenharmony_ci return; 44818c2ecf20Sopenharmony_ci} 44828c2ecf20Sopenharmony_ci 44838c2ecf20Sopenharmony_cistatic bool arcmsr_reset_in_progress(struct AdapterControlBlock *acb) 44848c2ecf20Sopenharmony_ci{ 44858c2ecf20Sopenharmony_ci bool rtn = true; 44868c2ecf20Sopenharmony_ci 44878c2ecf20Sopenharmony_ci switch(acb->adapter_type) { 44888c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_A:{ 44898c2ecf20Sopenharmony_ci struct MessageUnit_A __iomem *reg = acb->pmuA; 44908c2ecf20Sopenharmony_ci rtn = ((readl(®->outbound_msgaddr1) & 44918c2ecf20Sopenharmony_ci ARCMSR_OUTBOUND_MESG1_FIRMWARE_OK) == 0) ? true : false; 44928c2ecf20Sopenharmony_ci } 44938c2ecf20Sopenharmony_ci break; 44948c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_B:{ 44958c2ecf20Sopenharmony_ci struct MessageUnit_B *reg = acb->pmuB; 44968c2ecf20Sopenharmony_ci rtn = ((readl(reg->iop2drv_doorbell) & 44978c2ecf20Sopenharmony_ci ARCMSR_MESSAGE_FIRMWARE_OK) == 0) ? true : false; 44988c2ecf20Sopenharmony_ci } 44998c2ecf20Sopenharmony_ci break; 45008c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_C:{ 45018c2ecf20Sopenharmony_ci struct MessageUnit_C __iomem *reg = acb->pmuC; 45028c2ecf20Sopenharmony_ci rtn = (readl(®->host_diagnostic) & 0x04) ? true : false; 45038c2ecf20Sopenharmony_ci } 45048c2ecf20Sopenharmony_ci break; 45058c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_D:{ 45068c2ecf20Sopenharmony_ci struct MessageUnit_D *reg = acb->pmuD; 45078c2ecf20Sopenharmony_ci rtn = ((readl(reg->sample_at_reset) & 0x80) == 0) ? 45088c2ecf20Sopenharmony_ci true : false; 45098c2ecf20Sopenharmony_ci } 45108c2ecf20Sopenharmony_ci break; 45118c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_E: 45128c2ecf20Sopenharmony_ci case ACB_ADAPTER_TYPE_F:{ 45138c2ecf20Sopenharmony_ci struct MessageUnit_E __iomem *reg = acb->pmuE; 45148c2ecf20Sopenharmony_ci rtn = (readl(®->host_diagnostic_3xxx) & 45158c2ecf20Sopenharmony_ci ARCMSR_ARC188X_RESET_ADAPTER) ? true : false; 45168c2ecf20Sopenharmony_ci } 45178c2ecf20Sopenharmony_ci break; 45188c2ecf20Sopenharmony_ci } 45198c2ecf20Sopenharmony_ci return rtn; 45208c2ecf20Sopenharmony_ci} 45218c2ecf20Sopenharmony_ci 45228c2ecf20Sopenharmony_cistatic void arcmsr_iop_init(struct AdapterControlBlock *acb) 45238c2ecf20Sopenharmony_ci{ 45248c2ecf20Sopenharmony_ci uint32_t intmask_org; 45258c2ecf20Sopenharmony_ci /* disable all outbound interrupt */ 45268c2ecf20Sopenharmony_ci intmask_org = arcmsr_disable_outbound_ints(acb); 45278c2ecf20Sopenharmony_ci arcmsr_wait_firmware_ready(acb); 45288c2ecf20Sopenharmony_ci arcmsr_iop_confirm(acb); 45298c2ecf20Sopenharmony_ci /*start background rebuild*/ 45308c2ecf20Sopenharmony_ci arcmsr_start_adapter_bgrb(acb); 45318c2ecf20Sopenharmony_ci /* empty doorbell Qbuffer if door bell ringed */ 45328c2ecf20Sopenharmony_ci arcmsr_clear_doorbell_queue_buffer(acb); 45338c2ecf20Sopenharmony_ci arcmsr_enable_eoi_mode(acb); 45348c2ecf20Sopenharmony_ci /* enable outbound Post Queue,outbound doorbell Interrupt */ 45358c2ecf20Sopenharmony_ci arcmsr_enable_outbound_ints(acb, intmask_org); 45368c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_IOP_INITED; 45378c2ecf20Sopenharmony_ci} 45388c2ecf20Sopenharmony_ci 45398c2ecf20Sopenharmony_cistatic uint8_t arcmsr_iop_reset(struct AdapterControlBlock *acb) 45408c2ecf20Sopenharmony_ci{ 45418c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb; 45428c2ecf20Sopenharmony_ci uint32_t intmask_org; 45438c2ecf20Sopenharmony_ci uint8_t rtnval = 0x00; 45448c2ecf20Sopenharmony_ci int i = 0; 45458c2ecf20Sopenharmony_ci unsigned long flags; 45468c2ecf20Sopenharmony_ci 45478c2ecf20Sopenharmony_ci if (atomic_read(&acb->ccboutstandingcount) != 0) { 45488c2ecf20Sopenharmony_ci /* disable all outbound interrupt */ 45498c2ecf20Sopenharmony_ci intmask_org = arcmsr_disable_outbound_ints(acb); 45508c2ecf20Sopenharmony_ci /* talk to iop 331 outstanding command aborted */ 45518c2ecf20Sopenharmony_ci rtnval = arcmsr_abort_allcmd(acb); 45528c2ecf20Sopenharmony_ci /* clear all outbound posted Q */ 45538c2ecf20Sopenharmony_ci arcmsr_done4abort_postqueue(acb); 45548c2ecf20Sopenharmony_ci for (i = 0; i < acb->maxFreeCCB; i++) { 45558c2ecf20Sopenharmony_ci ccb = acb->pccb_pool[i]; 45568c2ecf20Sopenharmony_ci if (ccb->startdone == ARCMSR_CCB_START) { 45578c2ecf20Sopenharmony_ci scsi_dma_unmap(ccb->pcmd); 45588c2ecf20Sopenharmony_ci ccb->startdone = ARCMSR_CCB_DONE; 45598c2ecf20Sopenharmony_ci ccb->ccb_flags = 0; 45608c2ecf20Sopenharmony_ci spin_lock_irqsave(&acb->ccblist_lock, flags); 45618c2ecf20Sopenharmony_ci list_add_tail(&ccb->list, &acb->ccb_free_list); 45628c2ecf20Sopenharmony_ci spin_unlock_irqrestore(&acb->ccblist_lock, flags); 45638c2ecf20Sopenharmony_ci } 45648c2ecf20Sopenharmony_ci } 45658c2ecf20Sopenharmony_ci atomic_set(&acb->ccboutstandingcount, 0); 45668c2ecf20Sopenharmony_ci /* enable all outbound interrupt */ 45678c2ecf20Sopenharmony_ci arcmsr_enable_outbound_ints(acb, intmask_org); 45688c2ecf20Sopenharmony_ci return rtnval; 45698c2ecf20Sopenharmony_ci } 45708c2ecf20Sopenharmony_ci return rtnval; 45718c2ecf20Sopenharmony_ci} 45728c2ecf20Sopenharmony_ci 45738c2ecf20Sopenharmony_cistatic int arcmsr_bus_reset(struct scsi_cmnd *cmd) 45748c2ecf20Sopenharmony_ci{ 45758c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb; 45768c2ecf20Sopenharmony_ci int retry_count = 0; 45778c2ecf20Sopenharmony_ci int rtn = FAILED; 45788c2ecf20Sopenharmony_ci acb = (struct AdapterControlBlock *) cmd->device->host->hostdata; 45798c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_ADAPTER_REMOVED) 45808c2ecf20Sopenharmony_ci return SUCCESS; 45818c2ecf20Sopenharmony_ci pr_notice("arcmsr: executing bus reset eh.....num_resets = %d," 45828c2ecf20Sopenharmony_ci " num_aborts = %d \n", acb->num_resets, acb->num_aborts); 45838c2ecf20Sopenharmony_ci acb->num_resets++; 45848c2ecf20Sopenharmony_ci 45858c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_BUS_RESET) { 45868c2ecf20Sopenharmony_ci long timeout; 45878c2ecf20Sopenharmony_ci pr_notice("arcmsr: there is a bus reset eh proceeding...\n"); 45888c2ecf20Sopenharmony_ci timeout = wait_event_timeout(wait_q, (acb->acb_flags 45898c2ecf20Sopenharmony_ci & ACB_F_BUS_RESET) == 0, 220 * HZ); 45908c2ecf20Sopenharmony_ci if (timeout) 45918c2ecf20Sopenharmony_ci return SUCCESS; 45928c2ecf20Sopenharmony_ci } 45938c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_BUS_RESET; 45948c2ecf20Sopenharmony_ci if (!arcmsr_iop_reset(acb)) { 45958c2ecf20Sopenharmony_ci arcmsr_hardware_reset(acb); 45968c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_IOP_INITED; 45978c2ecf20Sopenharmony_ciwait_reset_done: 45988c2ecf20Sopenharmony_ci ssleep(ARCMSR_SLEEPTIME); 45998c2ecf20Sopenharmony_ci if (arcmsr_reset_in_progress(acb)) { 46008c2ecf20Sopenharmony_ci if (retry_count > ARCMSR_RETRYCOUNT) { 46018c2ecf20Sopenharmony_ci acb->fw_flag = FW_DEADLOCK; 46028c2ecf20Sopenharmony_ci pr_notice("arcmsr%d: waiting for hw bus reset" 46038c2ecf20Sopenharmony_ci " return, RETRY TERMINATED!!\n", 46048c2ecf20Sopenharmony_ci acb->host->host_no); 46058c2ecf20Sopenharmony_ci return FAILED; 46068c2ecf20Sopenharmony_ci } 46078c2ecf20Sopenharmony_ci retry_count++; 46088c2ecf20Sopenharmony_ci goto wait_reset_done; 46098c2ecf20Sopenharmony_ci } 46108c2ecf20Sopenharmony_ci arcmsr_iop_init(acb); 46118c2ecf20Sopenharmony_ci acb->fw_flag = FW_NORMAL; 46128c2ecf20Sopenharmony_ci mod_timer(&acb->eternal_timer, jiffies + 46138c2ecf20Sopenharmony_ci msecs_to_jiffies(6 * HZ)); 46148c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_BUS_RESET; 46158c2ecf20Sopenharmony_ci rtn = SUCCESS; 46168c2ecf20Sopenharmony_ci pr_notice("arcmsr: scsi bus reset eh returns with success\n"); 46178c2ecf20Sopenharmony_ci } else { 46188c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_BUS_RESET; 46198c2ecf20Sopenharmony_ci acb->fw_flag = FW_NORMAL; 46208c2ecf20Sopenharmony_ci mod_timer(&acb->eternal_timer, jiffies + 46218c2ecf20Sopenharmony_ci msecs_to_jiffies(6 * HZ)); 46228c2ecf20Sopenharmony_ci rtn = SUCCESS; 46238c2ecf20Sopenharmony_ci } 46248c2ecf20Sopenharmony_ci return rtn; 46258c2ecf20Sopenharmony_ci} 46268c2ecf20Sopenharmony_ci 46278c2ecf20Sopenharmony_cistatic int arcmsr_abort_one_cmd(struct AdapterControlBlock *acb, 46288c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb) 46298c2ecf20Sopenharmony_ci{ 46308c2ecf20Sopenharmony_ci int rtn; 46318c2ecf20Sopenharmony_ci rtn = arcmsr_polling_ccbdone(acb, ccb); 46328c2ecf20Sopenharmony_ci return rtn; 46338c2ecf20Sopenharmony_ci} 46348c2ecf20Sopenharmony_ci 46358c2ecf20Sopenharmony_cistatic int arcmsr_abort(struct scsi_cmnd *cmd) 46368c2ecf20Sopenharmony_ci{ 46378c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb = 46388c2ecf20Sopenharmony_ci (struct AdapterControlBlock *)cmd->device->host->hostdata; 46398c2ecf20Sopenharmony_ci int i = 0; 46408c2ecf20Sopenharmony_ci int rtn = FAILED; 46418c2ecf20Sopenharmony_ci uint32_t intmask_org; 46428c2ecf20Sopenharmony_ci 46438c2ecf20Sopenharmony_ci if (acb->acb_flags & ACB_F_ADAPTER_REMOVED) 46448c2ecf20Sopenharmony_ci return SUCCESS; 46458c2ecf20Sopenharmony_ci printk(KERN_NOTICE 46468c2ecf20Sopenharmony_ci "arcmsr%d: abort device command of scsi id = %d lun = %d\n", 46478c2ecf20Sopenharmony_ci acb->host->host_no, cmd->device->id, (u32)cmd->device->lun); 46488c2ecf20Sopenharmony_ci acb->acb_flags |= ACB_F_ABORT; 46498c2ecf20Sopenharmony_ci acb->num_aborts++; 46508c2ecf20Sopenharmony_ci /* 46518c2ecf20Sopenharmony_ci ************************************************ 46528c2ecf20Sopenharmony_ci ** the all interrupt service routine is locked 46538c2ecf20Sopenharmony_ci ** we need to handle it as soon as possible and exit 46548c2ecf20Sopenharmony_ci ************************************************ 46558c2ecf20Sopenharmony_ci */ 46568c2ecf20Sopenharmony_ci if (!atomic_read(&acb->ccboutstandingcount)) { 46578c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_ABORT; 46588c2ecf20Sopenharmony_ci return rtn; 46598c2ecf20Sopenharmony_ci } 46608c2ecf20Sopenharmony_ci 46618c2ecf20Sopenharmony_ci intmask_org = arcmsr_disable_outbound_ints(acb); 46628c2ecf20Sopenharmony_ci for (i = 0; i < acb->maxFreeCCB; i++) { 46638c2ecf20Sopenharmony_ci struct CommandControlBlock *ccb = acb->pccb_pool[i]; 46648c2ecf20Sopenharmony_ci if (ccb->startdone == ARCMSR_CCB_START && ccb->pcmd == cmd) { 46658c2ecf20Sopenharmony_ci ccb->startdone = ARCMSR_CCB_ABORTED; 46668c2ecf20Sopenharmony_ci rtn = arcmsr_abort_one_cmd(acb, ccb); 46678c2ecf20Sopenharmony_ci break; 46688c2ecf20Sopenharmony_ci } 46698c2ecf20Sopenharmony_ci } 46708c2ecf20Sopenharmony_ci acb->acb_flags &= ~ACB_F_ABORT; 46718c2ecf20Sopenharmony_ci arcmsr_enable_outbound_ints(acb, intmask_org); 46728c2ecf20Sopenharmony_ci return rtn; 46738c2ecf20Sopenharmony_ci} 46748c2ecf20Sopenharmony_ci 46758c2ecf20Sopenharmony_cistatic const char *arcmsr_info(struct Scsi_Host *host) 46768c2ecf20Sopenharmony_ci{ 46778c2ecf20Sopenharmony_ci struct AdapterControlBlock *acb = 46788c2ecf20Sopenharmony_ci (struct AdapterControlBlock *) host->hostdata; 46798c2ecf20Sopenharmony_ci static char buf[256]; 46808c2ecf20Sopenharmony_ci char *type; 46818c2ecf20Sopenharmony_ci int raid6 = 1; 46828c2ecf20Sopenharmony_ci switch (acb->pdev->device) { 46838c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1110: 46848c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1200: 46858c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1202: 46868c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1210: 46878c2ecf20Sopenharmony_ci raid6 = 0; 46888c2ecf20Sopenharmony_ci fallthrough; 46898c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1120: 46908c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1130: 46918c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1160: 46928c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1170: 46938c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1201: 46948c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1203: 46958c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1220: 46968c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1230: 46978c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1260: 46988c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1270: 46998c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1280: 47008c2ecf20Sopenharmony_ci type = "SATA"; 47018c2ecf20Sopenharmony_ci break; 47028c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1214: 47038c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1380: 47048c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1381: 47058c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1680: 47068c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1681: 47078c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1880: 47088c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1883: 47098c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1884: 47108c2ecf20Sopenharmony_ci type = "SAS/SATA"; 47118c2ecf20Sopenharmony_ci break; 47128c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1886_0: 47138c2ecf20Sopenharmony_ci case PCI_DEVICE_ID_ARECA_1886: 47148c2ecf20Sopenharmony_ci type = "NVMe/SAS/SATA"; 47158c2ecf20Sopenharmony_ci break; 47168c2ecf20Sopenharmony_ci default: 47178c2ecf20Sopenharmony_ci type = "unknown"; 47188c2ecf20Sopenharmony_ci raid6 = 0; 47198c2ecf20Sopenharmony_ci break; 47208c2ecf20Sopenharmony_ci } 47218c2ecf20Sopenharmony_ci sprintf(buf, "Areca %s RAID Controller %s\narcmsr version %s\n", 47228c2ecf20Sopenharmony_ci type, raid6 ? "(RAID6 capable)" : "", ARCMSR_DRIVER_VERSION); 47238c2ecf20Sopenharmony_ci return buf; 47248c2ecf20Sopenharmony_ci} 4725