From patchwork Thu Nov 9 17:10:09 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Oleksandr Tyshchenko X-Patchwork-Id: 10051341 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 86BE060381 for ; Thu, 9 Nov 2017 17:12:41 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 6AA042B042 for ; Thu, 9 Nov 2017 17:12:41 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 5F28E2B04A; Thu, 9 Nov 2017 17:12:41 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-4.1 required=2.0 tests=BAYES_00, DKIM_ADSP_CUSTOM_MED, DKIM_SIGNED, FREEMAIL_FROM, RCVD_IN_DNSWL_MED, T_DKIM_INVALID autolearn=ham version=3.3.1 Received: from lists.xenproject.org (lists.xenproject.org [192.237.175.120]) (using TLSv1.2 with cipher AES128-GCM-SHA256 (128/128 bits)) (No client certificate requested) by mail.wl.linuxfoundation.org (Postfix) with ESMTPS id C20B02B042 for ; Thu, 9 Nov 2017 17:12:40 +0000 (UTC) Received: from localhost ([127.0.0.1] helo=lists.xenproject.org) by lists.xenproject.org with esmtp (Exim 4.84_2) (envelope-from ) id 1eCqLw-0004TC-W8; Thu, 09 Nov 2017 17:10:56 +0000 Received: from mail6.bemta5.messagelabs.com ([195.245.231.135]) by lists.xenproject.org with esmtp (Exim 4.84_2) (envelope-from ) id 1eCqLv-0004P9-W1 for xen-devel@lists.xenproject.org; Thu, 09 Nov 2017 17:10:56 +0000 Received: from [85.158.139.211] by server-16.bemta-5.messagelabs.com id 6E/6F-01788-F1C840A5; Thu, 09 Nov 2017 17:10:55 +0000 X-Brightmail-Tracker: H4sIAAAAAAAAA+NgFjrCIsWRWlGSWpSXmKPExsVyMfS6i65sD0u UweJ1Ghbft0xmcmD0OPzhCksAYxRrZl5SfkUCa8bOw7cZC/6qV/TcWMPWwNim1MXIxSEkMINR Yvm1+ywgDovASxaJ5heP2EEcCYF+Voklr66ydjFyAjlZEjfnzGHqYuQAstMkDl4yhgiXSyx8s JkZxBYSUJJ4vXMzE8TU2UwSB769YgJJsAkYSOx/94QdxBYBKrq3ajJYEbPAHkaJ9XevghUJCz hLLFy9ggXEZhFQlbj4aRrYYl4BF4lLDfvZIbbJSdw81wm2jRMo/ubjdTaIzc4SF18fZ5vAKLi AkWEVo3pxalFZapGumV5SUWZ6RkluYmaOrqGBqV5uanFxYnpqTmJSsV5yfu4mRmDIMQDBDsap Dc6HGCU5mJREeaUsWaKE+JLyUyozEosz4otKc1KLDzHKcHAoSfB6dwPlBItS01Mr0jJzgMEPk 5bg4FES4X3XBZTmLS5IzC3OTIdInWJ05bhw59IfJo4De24ByRc37wLJZzNfNzBzTLva2sQsxJ KXn5cqJc5rBTJbAKQ5ozQPbjQsci8xykoJ8zICHSvEU5BalJtZgir/ilGcg1FJmNcQZApPZl4 J3AWvgI5jAjoumh3suJJEhJRUA+Pif9etFA96BQTeq2cqX9B29tic008/cflw5nL8PG1YXrkk 9GNfkNSOZ4fuZX3on/jt2mn1mpLEvI0ZG/VsjC8YHXOtcJ7Dled6N0xx7v8Zq5ek2x607Mx4u qPibovbpcQPi3d7dU2Um378PvvsZN0A9rpmIR2JGZM3f9iZtMVhh9uttJ4dmYpKLMUZiYZazE XFiQBUSQ5n1wIAAA== X-Env-Sender: olekstysh@gmail.com X-Msg-Ref: server-4.tower-206.messagelabs.com!1510247453!106497468!1 X-Originating-IP: [209.85.215.68] X-SpamReason: No, hits=0.0 required=7.0 tests= X-StarScan-Received: X-StarScan-Version: 9.4.45; banners=-,-,- X-VirusChecked: Checked Received: (qmail 556 invoked from network); 9 Nov 2017 17:10:53 -0000 Received: from mail-lf0-f68.google.com (HELO mail-lf0-f68.google.com) (209.85.215.68) by server-4.tower-206.messagelabs.com with AES128-GCM-SHA256 encrypted SMTP; 9 Nov 2017 17:10:53 -0000 Received: by mail-lf0-f68.google.com with SMTP id r135so8043421lfe.5 for ; Thu, 09 Nov 2017 09:10:53 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=from:to:cc:subject:date:message-id:in-reply-to:references; bh=mFw5W4Mzo3cJqlXE4sUia7/IR1rTj1BDZlPIkwva52I=; b=TEVmnmzOPLI+8OvgF853AYv61bgcXq9iWrRrVE3BFgG1xAxVY8KgljPftvmk1L/X8w aPMCC/LS+32zz3pndgVkWBW+D2fS6oJp16NuNbjA9oHHLz7+svWel50nI+tv/9FaU1cv 4gNJG107q/8UudFdReMBDFCbMERoLaaHoj+CuPhnpXDZJqCUDXvatZAcoiEVgDWTv3rB V2vWWjx4VLKWAr2H6rDGMFFb/3VvX77QOYM46SLc0vIzjgmB6D/U7jRj+Mk8PYi556uW Q4k335gJZiu4NMzyIuqe4ljkyFAHftWZ5axBKJJ3mhRGOoLEqu9OfGpzMOFtqmbnXGDR Ogag== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references; bh=mFw5W4Mzo3cJqlXE4sUia7/IR1rTj1BDZlPIkwva52I=; b=NSL9enU0Wbdm/s+GtgG9Fl3kUKf2YAig+GpK4yz+N0aGgFLvWcj1V0oTJ6kntnizwi 7L9VGGicAg6fcfeO4swp3DQIs8mtwGM4Wov/mRWHZCf12afzxBFhqqOKUt+Yg7ogqFOx 4X5e9xdXJSXfbgtxvpNXtNj2Bl6sV86+fnzYqlMOrCRDkMhdQU2q/b4qIiWh57obDNxq eEYhDHMgRDFMlknlA2ReidxMRw4uJYF5Gpn55Z660oAh+i7V+qJp7Hs0Ur3xVnb12iYU cDZ3I7eswMnquZ8iYdmNzyaHAwn+WTy2XEvgUm4Qxh3Xi5ga+zviBS+5gYyzCrIk9FgJ iSlw== X-Gm-Message-State: AJaThX4I5fmEMvg9Iqw2vnXq47nbpieG2/fcmscceg96ZCZAIvrhQ+ni uBDq36aTKMPVJ8L61Q4dOvbMzQ== X-Google-Smtp-Source: ABhQp+Qc22Kt4sMV2Oao6slsQip4djvCucWETCylElVDPtLRvn1G7t8ez7TmhhPNqyoxTTA1zuX9oA== X-Received: by 10.46.5.205 with SMTP id 196mr501478ljf.186.1510247452800; Thu, 09 Nov 2017 09:10:52 -0800 (PST) Received: from otyshchenko.kyiv.epam.com (ll-53.209.223.85.sovam.net.ua. [85.223.209.53]) by smtp.gmail.com with ESMTPSA id x90sm1394299ljb.86.2017.11.09.09.10.51 (version=TLS1_2 cipher=ECDHE-RSA-AES128-SHA bits=128/128); Thu, 09 Nov 2017 09:10:52 -0800 (PST) From: Oleksandr Tyshchenko To: xen-devel@lists.xenproject.org Date: Thu, 9 Nov 2017 19:10:09 +0200 Message-Id: <1510247421-24094-20-git-send-email-olekstysh@gmail.com> X-Mailer: git-send-email 2.7.4 In-Reply-To: <1510247421-24094-1-git-send-email-olekstysh@gmail.com> References: <1510247421-24094-1-git-send-email-olekstysh@gmail.com> Cc: Oleksandr Tyshchenko , Stefano Stabellini , Andre Przywara , Julien Grall Subject: [Xen-devel] [RFC PATCH 19/31] xen/arm: Introduce ARM SMC based mailbox X-BeenThere: xen-devel@lists.xen.org X-Mailman-Version: 2.1.18 Precedence: list List-Id: Xen developer discussion List-Unsubscribe: , List-Post: List-Help: List-Subscribe: , MIME-Version: 1.0 Errors-To: xen-devel-bounces@lists.xen.org Sender: "Xen-devel" X-Virus-Scanned: ClamAV using ClamSMTP From: Oleksandr Tyshchenko This code is completely borrowed from the patch series for Linux which hasn't been upstreamed yet: [PATCH v2 0/3] mailbox: arm: introduce smc triggered mailbox https://lkml.org/lkml/2017/7/23/129 I am very excited about the idea described it a link above. This solution lets us (who plays with ARM based SoCs with Security Extensions enabled, but without possibility to involve some standalone co-prossesor to control PM) have SCPI based CPUFreq in Xen on ARM with a minimal cost. Signed-off-by: Oleksandr Tyshchenko CC: Stefano Stabellini CC: Julien Grall CC: Andre Przywara --- xen/arch/arm/cpufreq/arm-smc-mailbox.c | 155 +++++++++++++++++++++++++++++++++ 1 file changed, 155 insertions(+) create mode 100644 xen/arch/arm/cpufreq/arm-smc-mailbox.c diff --git a/xen/arch/arm/cpufreq/arm-smc-mailbox.c b/xen/arch/arm/cpufreq/arm-smc-mailbox.c new file mode 100644 index 0000000..d7b61a7 --- /dev/null +++ b/xen/arch/arm/cpufreq/arm-smc-mailbox.c @@ -0,0 +1,155 @@ +/* + * Copyright (C) 2016,2017 ARM Ltd. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License version 2 as + * published by the Free Software Foundation. + * + * This device provides a mechanism for emulating a mailbox by using + * smc calls, allowing a "mailbox" consumer to sit in firmware running + * on the same core. + */ + +#include +#include +#include +#include +#include +#include + +#define ARM_SMC_MBOX_USE_HVC BIT(0) + +struct arm_smc_chan_data { + u32 function_id; + u32 flags; +}; + +static int arm_smc_send_data(struct mbox_chan *link, void *data) +{ + struct arm_smc_chan_data *chan_data = link->con_priv; + u32 function_id = chan_data->function_id; + struct arm_smccc_res res; + u32 msg = *(u32 *)data; + + if (chan_data->flags & ARM_SMC_MBOX_USE_HVC) + arm_smccc_hvc(function_id, msg, 0, 0, 0, 0, 0, 0, &res); + else + arm_smccc_smc(function_id, msg, 0, 0, 0, 0, 0, 0, &res); + + mbox_chan_received_data(link, (void *)res.a0); + + return 0; +} + +/* This mailbox is synchronous, so we are always done. */ +static bool arm_smc_last_tx_done(struct mbox_chan *link) +{ + return true; +} + +static const struct mbox_chan_ops arm_smc_mbox_chan_ops = { + .send_data = arm_smc_send_data, + .last_tx_done = arm_smc_last_tx_done +}; + +static int arm_smc_mbox_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct mbox_controller *mbox; + struct arm_smc_chan_data *chan_data; + const char *method; + bool use_hvc = false; + int ret, i; + + ret = of_property_count_elems_of_size(dev->of_node, "arm,func-ids", + sizeof(u32)); + if (ret < 0) + return ret; + + if (!of_property_read_string(dev->of_node, "method", &method)) { + if (!strcmp("hvc", method)) { + use_hvc = true; + } else if (!strcmp("smc", method)) { + use_hvc = false; + } else { + dev_warn(dev, "invalid \"method\" property: %s\n", + method); + + return -EINVAL; + } + } + + mbox = devm_kzalloc(dev, sizeof(*mbox), GFP_KERNEL); + if (!mbox) + return -ENOMEM; + + mbox->num_chans = ret; + mbox->chans = devm_kcalloc(dev, mbox->num_chans, sizeof(*mbox->chans), + GFP_KERNEL); + if (!mbox->chans) + return -ENOMEM; + + chan_data = devm_kcalloc(dev, mbox->num_chans, sizeof(*chan_data), + GFP_KERNEL); + if (!chan_data) + return -ENOMEM; + + for (i = 0; i < mbox->num_chans; i++) { + u32 function_id; + + ret = of_property_read_u32_index(dev->of_node, + "arm,func-ids", i, + &function_id); + if (ret) + return ret; + + chan_data[i].function_id = function_id; + if (use_hvc) + chan_data[i].flags |= ARM_SMC_MBOX_USE_HVC; + mbox->chans[i].con_priv = &chan_data[i]; + } + + mbox->txdone_poll = true; + mbox->txdone_irq = false; + mbox->txpoll_period = 1; + mbox->ops = &arm_smc_mbox_chan_ops; + mbox->dev = dev; + + ret = mbox_controller_register(mbox); + if (ret) + return ret; + + platform_set_drvdata(pdev, mbox); + dev_info(dev, "ARM SMC mailbox enabled with %d chan%s.\n", + mbox->num_chans, mbox->num_chans == 1 ? "" : "s"); + + return ret; +} + +static int arm_smc_mbox_remove(struct platform_device *pdev) +{ + struct mbox_controller *mbox = platform_get_drvdata(pdev); + + mbox_controller_unregister(mbox); + return 0; +} + +static const struct of_device_id arm_smc_mbox_of_match[] = { + { .compatible = "arm,smc-mbox", }, + {}, +}; +MODULE_DEVICE_TABLE(of, arm_smc_mbox_of_match); + +static struct platform_driver arm_smc_mbox_driver = { + .driver = { + .name = "arm-smc-mbox", + .of_match_table = arm_smc_mbox_of_match, + }, + .probe = arm_smc_mbox_probe, + .remove = arm_smc_mbox_remove, +}; +module_platform_driver(arm_smc_mbox_driver); + +MODULE_AUTHOR("Andre Przywara "); +MODULE_DESCRIPTION("Generic ARM smc mailbox driver"); +MODULE_LICENSE("GPL v2");