From patchwork Wed Sep 19 23:42:01 2012 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Anton Vorontsov X-Patchwork-Id: 11520 Return-Path: X-Original-To: patchwork@peony.canonical.com Delivered-To: patchwork@peony.canonical.com Received: from fiordland.canonical.com (fiordland.canonical.com [91.189.94.145]) by peony.canonical.com (Postfix) with ESMTP id DB54223E41 for ; Wed, 19 Sep 2012 23:49:31 +0000 (UTC) Received: from mail-ie0-f180.google.com (mail-ie0-f180.google.com [209.85.223.180]) by fiordland.canonical.com (Postfix) with ESMTP id 4958FA18157 for ; Wed, 19 Sep 2012 23:49:31 +0000 (UTC) Received: by mail-ie0-f180.google.com with SMTP id e10so2023684iej.11 for ; Wed, 19 Sep 2012 16:49:31 -0700 (PDT) X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=20120113; h=x-forwarded-to:x-forwarded-for:delivered-to:received-spf:from:to:cc :subject:date:message-id:x-mailer:in-reply-to:references :x-gm-message-state; bh=tvYWsK/dU8UJVmIG9wn3l+POQTaiYI0mxeqyr0f3WaI=; b=YpMlRUBEXdTza5QnYQEc9Sgc5C1FkPY0PF1gvPa97OlQTz2S2xvKMNLONevyrD08Jl SGssOc0Lp1Pap42U2eXyMyJW5FFxpSYVDrDYvCKQ0In+jLgTbQQt4hHAg1sLCYbCUlB9 lNojqT0oTP/V04DWd5h/jSff2bsAKhUfwPw+1VwseDiTgn7W52gCGlBpMgJzdKC7muOK jnjcqGS8ug8PDsfnrw3LkrrsshMFCMSY6NSJipSUVubkYRc7O19vsUe6MUPYqLmv/7IP O0CWb+4jO273bvj3JPncf13vj+S+2aCiXRCLKwTI4cET7u6dDr94EJKxy+C17vHZzeHD 8bHQ== Received: by 10.50.195.134 with SMTP id ie6mr120029igc.28.1348098571028; Wed, 19 Sep 2012 16:49:31 -0700 (PDT) X-Forwarded-To: linaro-patchwork@canonical.com X-Forwarded-For: patch@linaro.org linaro-patchwork@canonical.com Delivered-To: patches@linaro.org Received: by 10.50.184.232 with SMTP id ex8csp49801igc; Wed, 19 Sep 2012 16:49:30 -0700 (PDT) Received: by 10.68.129.164 with SMTP id nx4mr2091624pbb.28.1348098570275; Wed, 19 Sep 2012 16:49:30 -0700 (PDT) Received: from mail-pb0-f50.google.com (mail-pb0-f50.google.com [209.85.160.50]) by mx.google.com with ESMTPS id b10si2181336pav.329.2012.09.19.16.49.30 (version=TLSv1/SSLv3 cipher=OTHER); Wed, 19 Sep 2012 16:49:30 -0700 (PDT) Received-SPF: neutral (google.com: 209.85.160.50 is neither permitted nor denied by best guess record for domain of anton.vorontsov@linaro.org) client-ip=209.85.160.50; Authentication-Results: mx.google.com; spf=neutral (google.com: 209.85.160.50 is neither permitted nor denied by best guess record for domain of anton.vorontsov@linaro.org) smtp.mail=anton.vorontsov@linaro.org Received: by mail-pb0-f50.google.com with SMTP id md12so3894116pbc.37 for ; Wed, 19 Sep 2012 16:49:30 -0700 (PDT) Received: by 10.66.73.166 with SMTP id m6mr1111327pav.1.1348098570042; Wed, 19 Sep 2012 16:49:30 -0700 (PDT) Received: from localhost (ip-64-134-220-225.public.wayport.net. [64.134.220.225]) by mx.google.com with ESMTPS id gf8sm2538318pbc.52.2012.09.19.16.49.27 (version=TLSv1/SSLv3 cipher=OTHER); Wed, 19 Sep 2012 16:49:29 -0700 (PDT) From: Anton Vorontsov To: Andrew Morton , Russell King , Jason Wessel , Greg Kroah-Hartman , Alan Cox Cc: =?UTF-8?q?Arve=20Hj=C3=B8nnev=C3=A5g?= , Colin Cross , Brian Swetland , John Stultz , Thomas Gleixner , linux-kernel@vger.kernel.org, linux-arm-kernel@lists.infradead.org, linaro-kernel@lists.linaro.org, patches@linaro.org, kernel-team@android.com, kgdb-bugreport@lists.sourceforge.net, linux-serial@vger.kernel.org Subject: [PATCH 10/11] ARM: VIC: Add a couple of low-level FIQ management helpers Date: Wed, 19 Sep 2012 16:42:01 -0700 Message-Id: <1348098122-11041-10-git-send-email-anton.vorontsov@linaro.org> X-Mailer: git-send-email 1.7.11.5 In-Reply-To: <20120919234003.GA24143@lizard> References: <20120919234003.GA24143@lizard> X-Gm-Message-State: ALoCoQnDZWNqvcKMZe5itgt4t2HmtvuPIod/FXsScIFOQrppNmvH/S3CyOFg774TQTZ4iY07maSr Just a couple of calls to manage VIC FIQ routing. We'll use them for KGDB FIQ support on ARM Versatile machines. Signed-off-by: Anton Vorontsov --- arch/arm/common/vic.c | 28 ++++++++++++++++++++++++++++ arch/arm/include/asm/hardware/vic.h | 2 ++ 2 files changed, 30 insertions(+) diff --git a/arch/arm/common/vic.c b/arch/arm/common/vic.c index e0d5388..df2fc82 100644 --- a/arch/arm/common/vic.c +++ b/arch/arm/common/vic.c @@ -66,6 +66,34 @@ static struct vic_device vic_devices[CONFIG_ARM_VIC_NR]; static int vic_id; +static void __iomem *vic_base(struct irq_data *d) +{ + return (void __iomem *)irq_data_get_irq_chip_data(d); +} + +void vic_fiq_select(unsigned int irq, bool on) +{ + void __iomem *base = vic_base(&irq_to_desc(irq)->irq_data); + void __iomem *sel = base + VIC_INT_SELECT; + u32 msk = 1 << irq; + u32 val; + + pr_debug("rerouting VIC vector %d to %s\n", irq, on ? "FIQ" : "IRQ"); + + val = readl(sel); + val &= ~msk; + if (on) + val |= msk; + writel(val, sel); +} + +bool vic_is_fiq_rised(unsigned int irq) +{ + void __iomem *base = vic_base(&irq_to_desc(irq)->irq_data); + + return readl(base + VIC_FIQ_STATUS) & (1 << irq); +} + /** * vic_init2 - common initialisation code * @base: Base of the VIC. diff --git a/arch/arm/include/asm/hardware/vic.h b/arch/arm/include/asm/hardware/vic.h index e14af1a..2728975 100644 --- a/arch/arm/include/asm/hardware/vic.h +++ b/arch/arm/include/asm/hardware/vic.h @@ -52,6 +52,8 @@ void __vic_init(void __iomem *base, unsigned int irq_start, u32 vic_sources, void vic_init(void __iomem *base, unsigned int irq_start, u32 vic_sources, u32 resume_sources); int vic_of_init(struct device_node *node, struct device_node *parent); void vic_handle_irq(struct pt_regs *regs); +void vic_fiq_select(unsigned int irq, bool on); +bool vic_is_fiq_rised(unsigned int irq); #endif /* __ASSEMBLY__ */ #endif