From patchwork Tue Nov 15 13:13:33 2016 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 8bit X-Patchwork-Submitter: Fu Wei Fu X-Patchwork-Id: 82339 Delivered-To: patch@linaro.org Received: by 10.182.1.168 with SMTP id 8csp1698150obn; Tue, 15 Nov 2016 05:16:58 -0800 (PST) X-Received: by 10.99.219.21 with SMTP id e21mr37355512pgg.136.1479215818108; Tue, 15 Nov 2016 05:16:58 -0800 (PST) Return-Path: Received: from vger.kernel.org (vger.kernel.org. [209.132.180.67]) by mx.google.com with ESMTP id y17si26494168pgh.106.2016.11.15.05.16.57; Tue, 15 Nov 2016 05:16:58 -0800 (PST) Received-SPF: pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) client-ip=209.132.180.67; Authentication-Results: mx.google.com; spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org; dmarc=fail (p=NONE dis=NONE) header.from=linaro.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1754193AbcKONQq (ORCPT + 26 others); Tue, 15 Nov 2016 08:16:46 -0500 Received: from mx1.redhat.com ([209.132.183.28]:37498 "EHLO mx1.redhat.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S936179AbcKONQm (ORCPT ); Tue, 15 Nov 2016 08:16:42 -0500 Received: from int-mx13.intmail.prod.int.phx2.redhat.com (int-mx13.intmail.prod.int.phx2.redhat.com [10.5.11.26]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mx1.redhat.com (Postfix) with ESMTPS id 756B6C056793; Tue, 15 Nov 2016 13:16:41 +0000 (UTC) Received: from Rei-Ayanami.localdomain.com (ovpn-8-16.pek2.redhat.com [10.72.8.16]) by int-mx13.intmail.prod.int.phx2.redhat.com (8.14.4/8.14.4) with ESMTP id uAFDDxGW009274; Tue, 15 Nov 2016 08:16:28 -0500 From: fu.wei@linaro.org To: rjw@rjwysocki.net, lenb@kernel.org, daniel.lezcano@linaro.org, tglx@linutronix.de, marc.zyngier@arm.com, mark.rutland@arm.com, lorenzo.pieralisi@arm.com, sudeep.holla@arm.com, hanjun.guo@linaro.org Cc: linux-arm-kernel@lists.infradead.org, linaro-acpi@lists.linaro.org, linux-kernel@vger.kernel.org, linux-acpi@vger.kernel.org, rruigrok@codeaurora.org, harba@codeaurora.org, cov@codeaurora.org, timur@codeaurora.org, graeme.gregory@linaro.org, al.stone@linaro.org, jcm@redhat.com, wei@redhat.com, arnd@arndb.de, catalin.marinas@arm.com, will.deacon@arm.com, Suravee.Suthikulpanit@amd.com, leo.duran@amd.com, wim@iguana.be, linux@roeck-us.net, linux-watchdog@vger.kernel.org, tn@semihalf.com, christoffer.dall@linaro.org, julien.grall@arm.com, Fu Wei Subject: [PATCH v15 11/13] acpi/arm64: Add memory-mapped timer support in GTDT driver Date: Tue, 15 Nov 2016 21:13:33 +0800 Message-Id: <1479215615-26950-12-git-send-email-fu.wei@linaro.org> In-Reply-To: <1479215615-26950-1-git-send-email-fu.wei@linaro.org> References: <1479215615-26950-1-git-send-email-fu.wei@linaro.org> MIME-Version: 1.0 X-Scanned-By: MIMEDefang 2.68 on 10.5.11.26 X-Greylist: Sender IP whitelisted, not delayed by milter-greylist-4.5.16 (mx1.redhat.com [10.5.110.32]); Tue, 15 Nov 2016 13:16:41 +0000 (UTC) Sender: linux-kernel-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org From: Fu Wei On platforms booting with ACPI, architected memory-mapped timers' configuration data is provided by firmware through the ACPI GTDT static table. The clocksource architected timer kernel driver requires a firmware interface to collect timer configuration and configure its driver. this infrastructure is present for device tree systems, but it is missing on systems booting with ACPI. Implement the kernel infrastructure required to parse the static ACPI GTDT table so that the architected timer clocksource driver can make use of it on systems booting with ACPI, therefore enabling the corresponding timers configuration. Signed-off-by: Fu Wei Signed-off-by: Hanjun Guo --- drivers/acpi/arm64/gtdt.c | 95 +++++++++++++++++++++++++++++++++++++++++++++++ include/linux/acpi.h | 1 + 2 files changed, 96 insertions(+) -- 2.7.4 diff --git a/drivers/acpi/arm64/gtdt.c b/drivers/acpi/arm64/gtdt.c index 2de79aa..08d9506 100644 --- a/drivers/acpi/arm64/gtdt.c +++ b/drivers/acpi/arm64/gtdt.c @@ -51,6 +51,14 @@ static inline bool is_timer_block(void *platform_timer) return gh->type == ACPI_GTDT_TYPE_TIMER_BLOCK; } +static inline struct acpi_gtdt_timer_block *get_timer_block(unsigned int index) +{ + if (index >= acpi_gtdt_desc.timer_block_count || !timer_block) + return NULL; + + return timer_block[index]; +} + static inline bool is_watchdog(void *platform_timer) { struct acpi_gtdt_header *gh = platform_timer; @@ -214,3 +222,90 @@ int __init acpi_gtdt_init(struct acpi_table_header *table) acpi_gtdt_release(); return -EINVAL; } + +/* + * Get ONE GT block info for memory-mapped timer from GTDT table. + * @data: the GT block data (parsing result) + * @index: the index number of GT block + * Note: we already verify @data in caller, it can't be NULL here. + * Returns 0 if success, -EINVAL/-ENODEV if error. + */ +int __init gtdt_arch_timer_mem_init(struct arch_timer_mem *data, + unsigned int index) +{ + struct acpi_gtdt_timer_block *block; + struct acpi_gtdt_timer_entry *frame; + int i; + + block = get_timer_block(index); + if (!block) + return -ENODEV; + + if (!block->timer_count) { + pr_err(FW_BUG "GT block present, but frame count is zero."); + return -ENODEV; + } + + if (block->timer_count > ARCH_TIMER_MEM_MAX_FRAMES) { + pr_err(FW_BUG "GT block lists %d frames, ACPI spec only allows 8\n", + block->timer_count); + return -EINVAL; + } + + data->cntctlbase = (phys_addr_t)block->block_address; + /* + * We can NOT get the size info from GTDT table, + * but according to "Table * CNTCTLBase memory map" of + * for ARMv8, + * it should be 4KB(Offset 0x000 – 0xFFC). + */ + data->size = SZ_4K; + data->num_frames = block->timer_count; + + frame = (void *)block + block->timer_offset; + if (frame + block->timer_count != (void *)block + block->header.length) + return -EINVAL; + + /* + * Get the GT timer Frame data for every GT Block Timer + */ + for (i = 0; i < block->timer_count; i++, frame++) { + if (!frame->base_address || !frame->timer_interrupt) + return -EINVAL; + + data->frame[i].phys_irq = map_gt_gsi(frame->timer_interrupt, + frame->timer_flags); + if (data->frame[i].phys_irq <= 0) { + pr_warn("failed to map physical timer irq in frame %d.\n", + i); + return -EINVAL; + } + + if (frame->virtual_timer_interrupt) { + data->frame[i].virt_irq = + map_gt_gsi(frame->virtual_timer_interrupt, + frame->virtual_timer_flags); + if (data->frame[i].virt_irq <= 0) { + pr_warn("failed to map virtual timer irq in frame %d.\n", + i); + return -EINVAL; + } + } + + data->frame[i].frame_nr = frame->frame_number; + data->frame[i].cntbase = frame->base_address; + /* + * We can NOT get the size info from GTDT table, + * but according to "Table * CNTBaseN memory map" of + * for ARMv8, + * it should be 4KB(Offset 0x000 – 0xFFC). + */ + data->frame[i].size = SZ_4K; + } + + if (acpi_gtdt_desc.timer_block_count) + pr_info("parsed No.%d of %d memory-mapped timer block(s).\n", + index, acpi_gtdt_desc.timer_block_count); + + return 0; +} diff --git a/include/linux/acpi.h b/include/linux/acpi.h index a1611d1..44b8c1b 100644 --- a/include/linux/acpi.h +++ b/include/linux/acpi.h @@ -582,6 +582,7 @@ int acpi_gtdt_init(struct acpi_table_header *table); int acpi_gtdt_map_ppi(int type); bool acpi_gtdt_c3stop(int type); void acpi_gtdt_release(void); +int gtdt_arch_timer_mem_init(struct arch_timer_mem *data, unsigned int index); #endif #else /* !CONFIG_ACPI */