From patchwork Mon Oct 12 15:20:30 2015 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: John Garry X-Patchwork-Id: 54796 Return-Path: X-Original-To: linaro@patches.linaro.org Delivered-To: linaro@patches.linaro.org Received: from mail-lb0-f200.google.com (mail-lb0-f200.google.com [209.85.217.200]) by patches.linaro.org (Postfix) with ESMTPS id 2659D23001 for ; Mon, 12 Oct 2015 15:14:31 +0000 (UTC) Received: by lbwr8 with SMTP id r8sf71106184lbw.0 for ; Mon, 12 Oct 2015 08:14:30 -0700 (PDT) X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20130820; h=x-gm-message-state:delivered-to:from:to:cc:subject:date:message-id :in-reply-to:references:mime-version:content-type:sender:precedence :list-id:x-original-sender:x-original-authentication-results :mailing-list:list-post:list-help:list-archive:list-unsubscribe; bh=y1W5B4ldCsCzkK0NsSSS2c3cBQPCsaPaq9FRhZCIS70=; b=PD3svtDilgy2y+ZO5HKtw90dzb0SJJ+tLG41aaZDpz3gpFkmZdxlDNeQ/MtL8pxYur AN5KsgiXrze0Lcf5NWsSd4UycwiYOd1ZjUhRjz3XSKKLI8pNv6sD/G+1ujw/51o5EWmt TxNnYN4hxSKHj2PWTeZ3pWsMwvIL3t2047A6YvNMx+7WHq8S8EB/A+iepL40R9iVz0kw Ts3rcUs4GwzOXV3uh9Q5maSMpvMiNhDsGMfsFHGb4RLwAI/WLAJdFBHbnzoUGdMHgSD6 Mhe1n+fXcrdPXMY6S43J6fJVcTU5IsOr6hzBHRTBpBofDk7yttf8F3G3wnHoE6L5P9pK zCeg== X-Gm-Message-State: ALoCoQlSD+6dDhamUGrl+KTD9iTsRnflXbRsztYgCHBSmyEDwC8QOMo7JjCr9Ks+9UvVVvJ76YFX X-Received: by 10.180.210.71 with SMTP id ms7mr3022405wic.4.1444662870077; Mon, 12 Oct 2015 08:14:30 -0700 (PDT) X-BeenThere: patchwork-forward@linaro.org Received: by 10.25.143.209 with SMTP id r200ls563879lfd.6.gmail; Mon, 12 Oct 2015 08:14:29 -0700 (PDT) X-Received: by 10.25.153.147 with SMTP id b141mr8590296lfe.59.1444662869913; Mon, 12 Oct 2015 08:14:29 -0700 (PDT) Received: from mail-lb0-f175.google.com (mail-lb0-f175.google.com. [209.85.217.175]) by mx.google.com with ESMTPS id i8si11532823lbj.130.2015.10.12.08.14.29 for (version=TLSv1.2 cipher=ECDHE-RSA-AES128-GCM-SHA256 bits=128/128); Mon, 12 Oct 2015 08:14:29 -0700 (PDT) Received-SPF: pass (google.com: domain of patch+caf_=patchwork-forward=linaro.org@linaro.org designates 209.85.217.175 as permitted sender) client-ip=209.85.217.175; Received: by lbbk10 with SMTP id k10so34054785lbb.0 for ; Mon, 12 Oct 2015 08:14:29 -0700 (PDT) X-Received: by 10.25.211.201 with SMTP id k192mr8514494lfg.32.1444662869790; Mon, 12 Oct 2015 08:14:29 -0700 (PDT) X-Forwarded-To: patchwork-forward@linaro.org X-Forwarded-For: patch@linaro.org patchwork-forward@linaro.org Delivered-To: patch@linaro.org Received: by 10.112.59.35 with SMTP id w3csp1604182lbq; Mon, 12 Oct 2015 08:14:28 -0700 (PDT) X-Received: by 10.202.93.70 with SMTP id r67mr15527217oib.89.1444662868719; Mon, 12 Oct 2015 08:14:28 -0700 (PDT) Received: from vger.kernel.org (vger.kernel.org. [209.132.180.67]) by mx.google.com with ESMTP id y6si9020652oei.53.2015.10.12.08.14.28; Mon, 12 Oct 2015 08:14:28 -0700 (PDT) Received-SPF: pass (google.com: best guess record for domain of devicetree-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) client-ip=209.132.180.67; Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1751980AbbJLPO1 (ORCPT + 7 others); Mon, 12 Oct 2015 11:14:27 -0400 Received: from szxga02-in.huawei.com ([119.145.14.65]:14430 "EHLO szxga02-in.huawei.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1751974AbbJLPO0 (ORCPT ); Mon, 12 Oct 2015 11:14:26 -0400 Received: from 172.24.1.51 (EHLO szxeml432-hub.china.huawei.com) ([172.24.1.51]) by szxrg02-dlp.huawei.com (MOS 4.3.7-GA FastPath queued) with ESMTP id CUB61532; Mon, 12 Oct 2015 23:05:16 +0800 (CST) Received: from localhost.localdomain (10.67.212.75) by szxeml432-hub.china.huawei.com (10.82.67.209) with Microsoft SMTP Server id 14.3.235.1; Mon, 12 Oct 2015 23:05:04 +0800 From: John Garry To: CC: , , , , , , , , , John Garry Subject: [PATCH 18/25] scsi: hisi_sas: add dev_gone and port_deformed Date: Mon, 12 Oct 2015 23:20:30 +0800 Message-ID: <1444663237-238302-19-git-send-email-john.garry@huawei.com> X-Mailer: git-send-email 1.9.1 In-Reply-To: <1444663237-238302-1-git-send-email-john.garry@huawei.com> References: <1444663237-238302-1-git-send-email-john.garry@huawei.com> MIME-Version: 1.0 X-Originating-IP: [10.67.212.75] X-CFilter-Loop: Reflected Sender: devicetree-owner@vger.kernel.org Precedence: list List-ID: X-Mailing-List: devicetree@vger.kernel.org X-Removed-Original-Auth: Dkim didn't pass. X-Original-Sender: john.garry@huawei.com X-Original-Authentication-Results: mx.google.com; spf=pass (google.com: domain of patch+caf_=patchwork-forward=linaro.org@linaro.org designates 209.85.217.175 as permitted sender) smtp.mailfrom=patch+caf_=patchwork-forward=linaro.org@linaro.org Mailing-list: list patchwork-forward@linaro.org; contact patchwork-forward+owners@linaro.org X-Google-Group-Id: 836684582541 List-Post: , List-Help: , List-Archive: List-Unsubscribe: , Add function calls for lldd_dev_gone and lldd_port_deformed. Signed-off-by: John Garry --- drivers/scsi/hisi_sas/hisi_sas.h | 7 +++ drivers/scsi/hisi_sas/hisi_sas_init.c | 2 + drivers/scsi/hisi_sas/hisi_sas_main.c | 80 ++++++++++++++++++++++++++++++++++ drivers/scsi/hisi_sas/hisi_sas_v1_hw.c | 28 ++++++++++++ 4 files changed, 117 insertions(+) diff --git a/drivers/scsi/hisi_sas/hisi_sas.h b/drivers/scsi/hisi_sas/hisi_sas.h index 3f61a4a..265d9bd 100644 --- a/drivers/scsi/hisi_sas/hisi_sas.h +++ b/drivers/scsi/hisi_sas/hisi_sas.h @@ -352,14 +352,19 @@ union hisi_sas_command_table { void hisi_sas_slot_index_init(struct hisi_hba *hisi_hba); void hisi_sas_phy_init(struct hisi_hba *hisi_hba, int i); int hisi_sas_dev_found(struct domain_device *dev); +void hisi_sas_dev_gone(struct domain_device *dev); int hisi_sas_queue_command(struct sas_task *task, gfp_t gfp_flags); void hisi_sas_port_formed(struct asd_sas_phy *sas_phy); +void hisi_sas_port_deformed(struct asd_sas_phy *sas_phy); void hisi_sas_phy_down(struct hisi_hba *hisi_hba, int phy_no, int rdy); void hisi_sas_wq_process(struct work_struct *work); void hisi_sas_slot_task_free(struct hisi_hba *hisi_hba, struct sas_task *task, struct hisi_sas_slot *slot); /* hw specific functions */ +extern int slot_complete_v1_hw(struct hisi_hba *hisi_hba, + struct hisi_sas_slot *slot, + int abort); extern void hisi_sas_setup_itct_v1_hw(struct hisi_hba *hisi_hba, struct hisi_sas_device *device); extern void start_delivery_v1_hw(struct hisi_hba *hisi_hba); @@ -370,6 +375,8 @@ extern int prep_ssp_v1_hw(struct hisi_hba *hisi_hba, extern int interrupt_init_v1_hw(struct hisi_hba *hisi_hba); extern int interrupt_openall_v1_hw(struct hisi_hba *hisi_hba); extern int hw_init_v1_hw(struct hisi_hba *hisi_hba); +extern int free_device_v1_hw(struct hisi_hba *hisi_hba, + struct hisi_sas_device *dev); extern int phys_init_v1_hw(struct hisi_hba *hisi_hba); extern void sl_notify_v1_hw(struct hisi_hba *hisi_hba, int phy_no); extern void setup_itct_v1_hw(struct hisi_hba *hisi_hba, diff --git a/drivers/scsi/hisi_sas/hisi_sas_init.c b/drivers/scsi/hisi_sas/hisi_sas_init.c index 703527b..ba64562 100644 --- a/drivers/scsi/hisi_sas/hisi_sas_init.c +++ b/drivers/scsi/hisi_sas/hisi_sas_init.c @@ -34,8 +34,10 @@ static struct scsi_host_template hisi_sas_sht = { static struct sas_domain_function_template hisi_sas_transport_ops = { .lldd_dev_found = hisi_sas_dev_found, + .lldd_dev_gone = hisi_sas_dev_gone, .lldd_execute_task = hisi_sas_queue_command, .lldd_port_formed = hisi_sas_port_formed, + .lldd_port_deformed = hisi_sas_port_deformed, }; static int hisi_sas_alloc(struct hisi_hba *hisi_hba, struct Scsi_Host *shost) diff --git a/drivers/scsi/hisi_sas/hisi_sas_main.c b/drivers/scsi/hisi_sas/hisi_sas_main.c index fbc2cca..36ef8cd 100644 --- a/drivers/scsi/hisi_sas/hisi_sas_main.c +++ b/drivers/scsi/hisi_sas/hisi_sas_main.c @@ -514,12 +514,86 @@ void hisi_sas_port_notify_formed(struct asd_sas_phy *sas_phy, int lock) spin_unlock_irqrestore(&hisi_hba->lock, flags); } +void hisi_sas_do_release_task(struct hisi_hba *hisi_hba, + int phy_no, struct domain_device *device) +{ + struct hisi_sas_phy *phy; + struct hisi_sas_port *port; + struct hisi_sas_slot *slot, *slot2; + struct device *dev = &hisi_hba->pdev->dev; + + phy = &hisi_hba->phy[phy_no]; + port = phy->port; + if (!port) + return; + + list_for_each_entry_safe(slot, slot2, &port->list, entry) { + struct sas_task *task; + + task = slot->task; + if (device && task->dev != device) + continue; + + dev_info(dev, "Release slot [%d:%d], task [%p]:\n", + slot->dlvry_queue, slot->dlvry_queue_slot, task); + slot_complete_v1_hw(hisi_hba, slot, 1); + } +} + +static void hisi_sas_port_notify_deformed(struct asd_sas_phy *sas_phy, + int lock) +{ + struct domain_device *device; + struct hisi_sas_phy *phy = sas_phy->lldd_phy; + struct hisi_hba *hisi_hba = phy->hisi_hba; + struct asd_sas_port *sas_port = sas_phy->port; + struct hisi_sas_port *port = sas_port->lldd_port; + int phy_no = 0; + + port->port_attached = 0; + port->id = -1; + + while (phy != &hisi_hba->phy[phy_no]) { + phy_no++; + + if (phy_no >= hisi_hba->n_phy) + return; + } + list_for_each_entry(device, &sas_port->dev_list, dev_list_node) + hisi_sas_do_release_task(phy->hisi_hba, phy_no, device); +} int hisi_sas_dev_found(struct domain_device *device) { return hisi_sas_dev_found_notify(device, 1); } + +static void hisi_sas_dev_gone_notify(struct domain_device *device) +{ + struct hisi_sas_device *sas_dev = device->lldd_dev; + struct hisi_hba *hisi_hba = dev_to_hisi_hba(device); + struct device *dev = &hisi_hba->pdev->dev; + + if (!sas_dev) { + pr_warn("%s: found dev has gone\n", __func__); + return; + } + + dev_info(dev, "found dev[%lld:%x] is gone\n", + sas_dev->device_id, sas_dev->dev_type); + + free_device_v1_hw(hisi_hba, sas_dev); + + device->lldd_dev = NULL; + sas_dev->sas_device = NULL; +} + +void hisi_sas_dev_gone(struct domain_device *device) +{ + hisi_sas_dev_gone_notify(device); +} + int hisi_sas_queue_command(struct sas_task *task, gfp_t gfp_flags) { return hisi_sas_task_exec(task, gfp_flags, NULL, 0, NULL); @@ -529,6 +603,12 @@ void hisi_sas_port_formed(struct asd_sas_phy *sas_phy) { hisi_sas_port_notify_formed(sas_phy, 1); } + +void hisi_sas_port_deformed(struct asd_sas_phy *sas_phy) +{ + hisi_sas_port_notify_deformed(sas_phy, 1); +} + static void hisi_sas_phy_disconnected(struct hisi_sas_phy *phy) { phy->phy_attached = 0; diff --git a/drivers/scsi/hisi_sas/hisi_sas_v1_hw.c b/drivers/scsi/hisi_sas/hisi_sas_v1_hw.c index fadd163..2de54a7 100644 --- a/drivers/scsi/hisi_sas/hisi_sas_v1_hw.c +++ b/drivers/scsi/hisi_sas/hisi_sas_v1_hw.c @@ -534,6 +534,34 @@ void setup_itct_v1_hw(struct hisi_hba *hisi_hba, (0xff00 < ITCT_HDR_REJ_OPEN_TL_OFF)); } +int free_device_v1_hw(struct hisi_hba *hisi_hba, + struct hisi_sas_device *sas_dev) +{ + u64 dev_id = sas_dev->device_id; + struct hisi_sas_itct *itct = &hisi_hba->itct[dev_id]; + u32 qw0, reg_val = hisi_sas_read32(hisi_hba, CFG_AGING_TIME); + + reg_val |= CFG_AGING_TIME_ITCT_REL_MSK; + hisi_sas_write32(hisi_hba, CFG_AGING_TIME, reg_val); + + /* free itct */ + udelay(1); + reg_val = hisi_sas_read32(hisi_hba, CFG_AGING_TIME); + reg_val &= ~CFG_AGING_TIME_ITCT_REL_MSK; + hisi_sas_write32(hisi_hba, CFG_AGING_TIME, reg_val); + + qw0 = cpu_to_le64(itct->qw0); + qw0 &= ~ITCT_HDR_VALID_MSK; + itct->qw0 = cpu_to_le64(qw0); + + memset(sas_dev, 0, sizeof(*sas_dev)); + sas_dev->device_id = dev_id; + sas_dev->dev_type = SAS_PHY_UNUSED; + sas_dev->dev_status = HISI_SAS_DEV_NORMAL; + + return 0; +} + static int reset_hw_v1_hw(struct hisi_hba *hisi_hba) { int i;