From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1753401AbdAZXht (ORCPT ); Thu, 26 Jan 2017 18:37:49 -0500 Received: from mx1.redhat.com ([209.132.183.28]:60060 "EHLO mx1.redhat.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1752513AbdAZXhn (ORCPT ); Thu, 26 Jan 2017 18:37:43 -0500 From: Gerd Hoffmann To: linux-rpi-kernel@lists.infradead.org Cc: Stefan Wahren , Eric Anholt , Ulf Hansson , linux-mmc@vger.kernel.org, Gerd Hoffmann , Florian Fainelli , Ray Jui , Scott Branden , bcm-kernel-feedback-list@broadcom.com (maintainer:BROADCOM BCM281XX/BCM11XXX/BCM216XX ARM ARCHITE...), Stephen Warren , Lee Jones , linux-arm-kernel@lists.infradead.org (moderated list:BROADCOM BCM2835 ARM ARCHITECTURE), linux-kernel@vger.kernel.org (open list) Subject: [PATCH 01/13] mmc: bcm2835: add bcm2835_read_wait_sdcmd Date: Fri, 27 Jan 2017 00:37:14 +0100 Message-Id: <1485473846-24537-2-git-send-email-kraxel@redhat.com> In-Reply-To: <1485473846-24537-1-git-send-email-kraxel@redhat.com> References: <1485473846-24537-1-git-send-email-kraxel@redhat.com> X-Greylist: Sender IP whitelisted, not delayed by milter-greylist-4.5.16 (mx1.redhat.com [10.5.110.26]); Thu, 26 Jan 2017 23:37:32 +0000 (UTC) Sender: linux-kernel-owner@vger.kernel.org List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Signed-off-by: Gerd Hoffmann --- drivers/mmc/host/bcm2835.c | 30 ++++++++++++++++++++++++++++++ 1 file changed, 30 insertions(+) diff --git a/drivers/mmc/host/bcm2835.c b/drivers/mmc/host/bcm2835.c index 9744517..ceee4cf 100644 --- a/drivers/mmc/host/bcm2835.c +++ b/drivers/mmc/host/bcm2835.c @@ -609,6 +609,36 @@ static void bcm2835_prepare_data(struct bcm2835_host *host, writel(data->blocks, host->ioaddr + SDHBLC); } +static u32 bcm2835_read_wait_sdcmd(struct bcm2835_host *host, u32 timeout, + bool check_fail) +{ + struct device *dev = &host->pdev->dev; + unsigned long start = jiffies; + unsigned long fastpoll = start + usecs_to_jiffies(10); + unsigned long end = start + msecs_to_jiffies(timeout); + u32 value; + + for (;;) { + value = readl(host->ioaddr + SDCMD); + if (!(value & SDCMD_NEW_FLAG)) + break; + if (check_fail && (value & SDCMD_FAIL_FLAG)) + break; + if (time_after(jiffies, end)) { + dev_err(dev, "%s: timeout (%d us)\n", + __func__, timeout); + break; + } + + /* if it takes longer reduce poll interval */ + if (time_after(jiffies, fastpoll)) + udelay(10); + else + cpu_relax(); + } + return value; +} + bool bcm2835_send_command(struct bcm2835_host *host, struct mmc_command *cmd) { -- 1.8.3.1