From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-12.0 required=3.0 tests=BAYES_00,DKIMWL_WL_HIGH, DKIM_SIGNED,DKIM_VALID,HEADER_FROM_DIFFERENT_DOMAINS,INCLUDES_PATCH, MAILING_LIST_MULTI,NICE_REPLY_A,SIGNED_OFF_BY,SPF_HELO_NONE,SPF_PASS, URIBL_BLOCKED,USER_AGENT_SANE_1 autolearn=unavailable autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id D1A6EC4346E for ; Tue, 29 Sep 2020 09:27:25 +0000 (UTC) Received: from merlin.infradead.org (merlin.infradead.org [205.233.59.134]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPS id 33A7E2076B for ; Tue, 29 Sep 2020 09:27:25 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (2048-bit key) header.d=lists.infradead.org header.i=@lists.infradead.org header.b="czQyqsft"; dkim=fail reason="signature verification failed" (2048-bit key) header.d=baylibre-com.20150623.gappssmtp.com header.i=@baylibre-com.20150623.gappssmtp.com header.b="15gqtpmA" DMARC-Filter: OpenDMARC Filter v1.3.2 mail.kernel.org 33A7E2076B Authentication-Results: mail.kernel.org; dmarc=none (p=none dis=none) header.from=baylibre.com Authentication-Results: mail.kernel.org; spf=none smtp.mailfrom=linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=merlin.20170209; h=Sender:Content-Transfer-Encoding: Content-Type:Cc:List-Subscribe:List-Help:List-Post:List-Archive: List-Unsubscribe:List-Id:In-Reply-To:MIME-Version:Date:Message-ID:From: References:To:Subject:Reply-To:Content-ID:Content-Description:Resent-Date: Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=eoK9To2d5kZ2vI5anUGDZ7Nt2OlVVi5n/YdwvJAaoqg=; b=czQyqsftvT6KQ+vtmY499GcJU 6vxj4yjiX3IeJDFvAx1OEnANt0H/c1Xee656aJo1Fm2No6GEt6ncjBHj6vMYHYiWenXUqwjGsNp0Z kiioDeZqHmdOAPwugQ+siaDbwbz5Qw7rhEOOKBs6s8aAnou6R14eRf1r/7/TeVem2O0DIibhq6vXw rfqWy3kCZCgcBgFhIq3ehc+hmZjKa0LSKVPMNX+ejyFppaHYDSxfTiP4yY/GMMhMg1/2T0wDIutVe EdZLtbCQtlSkNgcoZzngSkl7dgXeBV2esAcS/2KNCTAdrekxPUyV1zauJDPnNGtDLUsF8hhwF7odR 3iZXpQQRA==; Received: from localhost ([::1] helo=merlin.infradead.org) by merlin.infradead.org with esmtp (Exim 4.92.3 #3 (Red Hat Linux)) id 1kNBtU-0005wi-47; Tue, 29 Sep 2020 09:25:56 +0000 Received: from mail-wm1-x342.google.com ([2a00:1450:4864:20::342]) by merlin.infradead.org with esmtps (Exim 4.92.3 #3 (Red Hat Linux)) id 1kNBtQ-0005va-NY for linux-arm-kernel@lists.infradead.org; Tue, 29 Sep 2020 09:25:54 +0000 Received: by mail-wm1-x342.google.com with SMTP id y15so4042703wmi.0 for ; Tue, 29 Sep 2020 02:25:52 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=baylibre-com.20150623.gappssmtp.com; s=20150623; h=subject:to:cc:references:from:autocrypt:organization:message-id :date:user-agent:mime-version:in-reply-to:content-language :content-transfer-encoding; bh=v9c1L7bUzqt1ZGy8xPf6IsuN+4ufXucqMXMZTtjee18=; b=15gqtpmAD0OaMKuUPYlal5hDi+UNrQBkvSUYSJZRg7VAPrBpqq4zycCzc3FJJnWAk/ oMbSNNKgpC8UUw8ojTm4M53K5KSDBmHAitJS0eXKFqHK17RNzvxUsR3SS+BxicnekA+f Jnthrtl1ovaIft9tFqT2qHH7u8jCMxrPRtbunGxblDA6uZHPfOtiLdn2+1a+GS7MtQcI bGJ4edLfB0hYJx+F+FvLvTvUMxk/jdon7tnPsNOpdHZSnap5YotNeygp1aeZb0xmOO+E KTtx76DJqVE7TeuqhToVrWF6o7WsZQaDW+U6Ww2b4mSCbN+mbG6dqZHA6EE6ClibKMK+ qiJQ== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:subject:to:cc:references:from:autocrypt :organization:message-id:date:user-agent:mime-version:in-reply-to :content-language:content-transfer-encoding; bh=v9c1L7bUzqt1ZGy8xPf6IsuN+4ufXucqMXMZTtjee18=; b=RT6gLsJQDiUfjY3bDLdLEViNETNb2ZEe7EIKgQLVmreYb2lh4nkMH0hZen22BRHjrK Q1k75CFxjztA4z87HUsO1w8VL+pRm3zWprmpUSDdvUzsOpbLAQTa52NvMaxT5OhPmeU0 1v/Rtxc0pJGnlvy6CODRm62NZ2s3uRGq/kxN68U8PVSBswThbfWsMFWiB4HaaW+4p13Y drq045B/sYtoHirZX3/SES3ylsrNdqs8pqpsuVYkaW2ODmN12N+C9FP5Qjru8UwKoUCX 0EbRU3a4lxHGHbeUm8FWHJWMgowiRAorLkuX56xIhsMUywxf+P3ieLksuY5THMJKpKYB jkDA== X-Gm-Message-State: AOAM531atRipbf5IoiovC1+KBR3UNYMMVv9ZKT/Ncj9cX22SXM4qTb1/ KwnUJWkjMymve9TiQpFVq/DzVw== X-Google-Smtp-Source: ABdhPJzDxUzxjsNRbjoNYDUCPZDL7AiNK138Zwox9ijD51mws2kOEv6wosJOL8a2oRC3h3TuE3dD4w== X-Received: by 2002:a1c:7918:: with SMTP id l24mr3629696wme.46.1601371551527; Tue, 29 Sep 2020 02:25:51 -0700 (PDT) Received: from ?IPv6:2a01:e35:2ec0:82b0:d50c:1ee4:fec5:ad12? ([2a01:e35:2ec0:82b0:d50c:1ee4:fec5:ad12]) by smtp.gmail.com with ESMTPSA id n66sm4715316wmb.35.2020.09.29.02.25.49 (version=TLS1_3 cipher=TLS_AES_128_GCM_SHA256 bits=128/128); Tue, 29 Sep 2020 02:25:50 -0700 (PDT) Subject: Re: [PATCH v2 3/3] phy: amlogic: phy-meson-axg-mipi-pcie-analog: add support for MIPI DSI analog To: kishon@ti.com, repk@triplefau.lt References: <20200915130339.11079-1-narmstrong@baylibre.com> <20200915130339.11079-4-narmstrong@baylibre.com> From: Neil Armstrong Autocrypt: addr=narmstrong@baylibre.com; prefer-encrypt=mutual; keydata= mQENBE1ZBs8BCAD78xVLsXPwV/2qQx2FaO/7mhWL0Qodw8UcQJnkrWmgTFRobtTWxuRx8WWP GTjuhvbleoQ5Cxjr+v+1ARGCH46MxFP5DwauzPekwJUD5QKZlaw/bURTLmS2id5wWi3lqVH4 BVF2WzvGyyeV1o4RTCYDnZ9VLLylJ9bneEaIs/7cjCEbipGGFlfIML3sfqnIvMAxIMZrvcl9 qPV2k+KQ7q+aXavU5W+yLNn7QtXUB530Zlk/d2ETgzQ5FLYYnUDAaRl+8JUTjc0CNOTpCeik 80TZcE6f8M76Xa6yU8VcNko94Ck7iB4vj70q76P/J7kt98hklrr85/3NU3oti3nrIHmHABEB AAG0KE5laWwgQXJtc3Ryb25nIDxuYXJtc3Ryb25nQGJheWxpYnJlLmNvbT6JATsEEwEKACUC GyMGCwkIBwMCBhUIAgkKCwQWAgMBAh4BAheABQJXDO2CAhkBAAoJEBaat7Gkz/iubGIH/iyk RqvgB62oKOFlgOTYCMkYpm2aAOZZLf6VKHKc7DoVwuUkjHfIRXdslbrxi4pk5VKU6ZP9AKsN NtMZntB8WrBTtkAZfZbTF7850uwd3eU5cN/7N1Q6g0JQihE7w4GlIkEpQ8vwSg5W7hkx3yQ6 2YzrUZh/b7QThXbNZ7xOeSEms014QXazx8+txR7jrGF3dYxBsCkotO/8DNtZ1R+aUvRfpKg5 ZgABTC0LmAQnuUUf2PHcKFAHZo5KrdO+tyfL+LgTUXIXkK+tenkLsAJ0cagz1EZ5gntuheLD YJuzS4zN+1Asmb9kVKxhjSQOcIh6g2tw7vaYJgL/OzJtZi6JlIW5AQ0ETVkGzwEIALyKDN/O GURaHBVzwjgYq+ZtifvekdrSNl8TIDH8g1xicBYpQTbPn6bbSZbdvfeQPNCcD4/EhXZuhQXM coJsQQQnO4vwVULmPGgtGf8PVc7dxKOeta+qUh6+SRh3vIcAUFHDT3f/Zdspz+e2E0hPV2hi SvICLk11qO6cyJE13zeNFoeY3ggrKY+IzbFomIZY4yG6xI99NIPEVE9lNBXBKIlewIyVlkOa YvJWSV+p5gdJXOvScNN1epm5YHmf9aE2ZjnqZGoMMtsyw18YoX9BqMFInxqYQQ3j/HpVgTSv mo5ea5qQDDUaCsaTf8UeDcwYOtgI8iL4oHcsGtUXoUk33HEAEQEAAYkBHwQYAQIACQUCTVkG zwIbDAAKCRAWmrexpM/4rrXiB/sGbkQ6itMrAIfnM7IbRuiSZS1unlySUVYu3SD6YBYnNi3G 5EpbwfBNuT3H8//rVvtOFK4OD8cRYkxXRQmTvqa33eDIHu/zr1HMKErm+2SD6PO9umRef8V8 2o2oaCLvf4WeIssFjwB0b6a12opuRP7yo3E3gTCSKmbUuLv1CtxKQF+fUV1cVaTPMyT25Od+ RC1K+iOR0F54oUJvJeq7fUzbn/KdlhA8XPGzwGRy4zcsPWvwnXgfe5tk680fEKZVwOZKIEuJ C3v+/yZpQzDvGYJvbyix0lHnrCzq43WefRHI5XTTQbM0WUIBIcGmq38+OgUsMYu4NzLu7uZF Acmp6h8guQINBFYnf6QBEADQ+wBYa+X2n/xIQz/RUoGHf84Jm+yTqRT43t7sO48/cBW9vAn9 GNwnJ3HRJWKATW0ZXrCr40ES/JqM1fUTfiFDB3VMdWpEfwOAT1zXS+0rX8yljgsWR1UvqyEP 3xN0M/40Zk+rdmZKaZS8VQaXbveaiWMEmY7sBV3QvgOzB7UF2It1HwoCon5Y+PvyE3CguhBd 9iq5iEampkMIkbA3FFCpQFI5Ai3BywkLzbA3ZtnMXR8Qt9gFZtyXvFQrB+/6hDzEPnBGZOOx zkd/iIX59SxBuS38LMlhPPycbFNmtauOC0DNpXCv9ACgC9tFw3exER/xQgSpDVc4vrL2Cacr wmQp1k9E0W+9pk/l8S1jcHx03hgCxPtQLOIyEu9iIJb27TjcXNjiInd7Uea195NldIrndD+x 58/yU3X70qVY+eWbqzpdlwF1KRm6uV0ZOQhEhbi0FfKKgsYFgBIBchGqSOBsCbL35f9hK/JC 6LnGDtSHeJs+jd9/qJj4WqF3x8i0sncQ/gszSajdhnWrxraG3b7/9ldMLpKo/OoihfLaCxtv xYmtw8TGhlMaiOxjDrohmY1z7f3rf6njskoIXUO0nabun1nPAiV1dpjleg60s3OmVQeEpr3a K7gR1ljkemJzM9NUoRROPaT7nMlNYQL+IwuthJd6XQqwzp1jRTGG26J97wARAQABiQM+BBgB AgAJBQJWJ3+kAhsCAikJEBaat7Gkz/iuwV0gBBkBAgAGBQJWJ3+kAAoJEHfc29rIyEnRk6MQ AJDo0nxsadLpYB26FALZsWlN74rnFXth5dQVQ7SkipmyFWZhFL8fQ9OiIoxWhM6rSg9+C1w+ n45eByMg2b8H3mmQmyWztdI95OxSREKwbaXVapCcZnv52JRjlc3DoiiHqTZML5x1Z7lQ1T3F 8o9sKrbFO1WQw1+Nc91+MU0MGN0jtfZ0Tvn/ouEZrSXCE4K3oDGtj3AdC764yZVq6CPigCgs 6Ex80k6QlzCdVP3RKsnPO2xQXXPgyJPJlpD8bHHHW7OLfoR9DaBNympfcbQJeekQrTvyoASw EOTPKE6CVWrcQIztUp0WFTdRGgMK0cZB3Xfe6sOp24PQTHAKGtjTHNP/THomkH24Fum9K3iM /4Wh4V2eqGEgpdeSp5K+LdaNyNgaqzMOtt4HYk86LYLSHfFXywdlbGrY9+TqiJ+ZVW4trmui NIJCOku8SYansq34QzYM0x3UFRwff+45zNBEVzctSnremg1mVgrzOfXU8rt+4N1b2MxorPF8 619aCwVP7U16qNSBaqiAJr4e5SNEnoAq18+1Gp8QsFG0ARY8xp+qaKBByWES7lRi3QbqAKZf yOHS6gmYo9gBmuAhc65/VtHMJtxwjpUeN4Bcs9HUpDMDVHdfeRa73wM+wY5potfQ5zkSp0Jp bxnv/cRBH6+c43stTffprd//4Hgz+nJcCgZKtCYIAPkUxABC85ID2CidzbraErVACmRoizhT KR2OiqSLW2x4xdmSiFNcIWkWJB6Qdri0Fzs2dHe8etD1HYaht1ZhZ810s7QOL7JwypO8dscN KTEkyoTGn6cWj0CX+PeP4xp8AR8ot4d0BhtUY34UPzjE1/xyrQFAdnLd0PP4wXxdIUuRs0+n WLY9Aou/vC1LAdlaGsoTVzJ2gX4fkKQIWhX0WVk41BSFeDKQ3RQ2pnuzwedLO94Bf6X0G48O VsbXrP9BZ6snXyHfebPnno/te5XRqZTL9aJOytB/1iUna+1MAwBxGFPvqeEUUyT+gx1l3Acl ZaTUOEkgIor5losDrePdPgE= Organization: Baylibre Message-ID: <6f87aa99-e044-f7f6-802f-ea2fe8b9de6d@baylibre.com> Date: Tue, 29 Sep 2020 11:25:49 +0200 User-Agent: Mozilla/5.0 (X11; Linux x86_64; rv:68.0) Gecko/20100101 Thunderbird/68.10.0 MIME-Version: 1.0 In-Reply-To: <20200915130339.11079-4-narmstrong@baylibre.com> Content-Language: en-US X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20200929_052552_808767_F75DEF8A X-CRM114-Status: GOOD ( 30.03 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.29 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: linux-amlogic@lists.infradead.org, linux-kernel@vger.kernel.org, linux-arm-kernel@lists.infradead.org Content-Type: text/plain; charset="us-ascii" Content-Transfer-Encoding: 7bit Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org Hi Kishon, Gentle ping. Thanks, Neil On 15/09/2020 15:03, Neil Armstrong wrote: > The AXG Analog MIPI-DSI PHY also provides functions to the PCIe PHY, > thus we need to have inclusive support for both interfaces at runtime. > > This fixes the regmap get from parent node, removes cell param > to select a mode and implement runtime configuration & power on/off > for both functions since they are not exclusive. > > Signed-off-by: Neil Armstrong > Reviewed-by: Remi Pommarel > --- > drivers/phy/amlogic/Kconfig | 1 + > .../amlogic/phy-meson-axg-mipi-pcie-analog.c | 204 ++++++++++++------ > 2 files changed, 136 insertions(+), 69 deletions(-) > > diff --git a/drivers/phy/amlogic/Kconfig b/drivers/phy/amlogic/Kconfig > index 99e8a4c7f1f3..db5d0cd757e3 100644 > --- a/drivers/phy/amlogic/Kconfig > +++ b/drivers/phy/amlogic/Kconfig > @@ -66,6 +66,7 @@ config PHY_MESON_AXG_MIPI_PCIE_ANALOG > depends on OF && (ARCH_MESON || COMPILE_TEST) > select GENERIC_PHY > select REGMAP_MMIO > + select GENERIC_PHY_MIPI_DPHY > help > Enable this to support the Meson MIPI + PCIE analog PHY > found in Meson AXG SoCs. > diff --git a/drivers/phy/amlogic/phy-meson-axg-mipi-pcie-analog.c b/drivers/phy/amlogic/phy-meson-axg-mipi-pcie-analog.c > index 1431cbf885e1..6eb21551bdd9 100644 > --- a/drivers/phy/amlogic/phy-meson-axg-mipi-pcie-analog.c > +++ b/drivers/phy/amlogic/phy-meson-axg-mipi-pcie-analog.c > @@ -4,9 +4,13 @@ > * > * Copyright (C) 2019 Remi Pommarel > */ > +#include > +#include > #include > #include > #include > +#include > +#include > #include > #include > > @@ -14,10 +18,10 @@ > #define HHI_MIPI_CNTL0_COMMON_BLOCK GENMASK(31, 28) > #define HHI_MIPI_CNTL0_ENABLE BIT(29) > #define HHI_MIPI_CNTL0_BANDGAP BIT(26) > -#define HHI_MIPI_CNTL0_DECODE_TO_RTERM GENMASK(15, 12) > -#define HHI_MIPI_CNTL0_OUTPUT_EN BIT(3) > +#define HHI_MIPI_CNTL0_DIF_REF_CTL1 GENMASK(25, 16) > +#define HHI_MIPI_CNTL0_DIF_REF_CTL0 GENMASK(15, 0) > > -#define HHI_MIPI_CNTL1 0x01 > +#define HHI_MIPI_CNTL1 0x04 > #define HHI_MIPI_CNTL1_CH0_CML_PDR_EN BIT(12) > #define HHI_MIPI_CNTL1_LP_ABILITY GENMASK(5, 4) > #define HHI_MIPI_CNTL1_LP_RESISTER BIT(3) > @@ -25,100 +29,170 @@ > #define HHI_MIPI_CNTL1_INPUT_SEL BIT(1) > #define HHI_MIPI_CNTL1_PRBS7_EN BIT(0) > > -#define HHI_MIPI_CNTL2 0x02 > +#define HHI_MIPI_CNTL2 0x08 > #define HHI_MIPI_CNTL2_CH_PU GENMASK(31, 25) > #define HHI_MIPI_CNTL2_CH_CTL GENMASK(24, 19) > #define HHI_MIPI_CNTL2_CH0_DIGDR_EN BIT(18) > #define HHI_MIPI_CNTL2_CH_DIGDR_EN BIT(17) > #define HHI_MIPI_CNTL2_LPULPS_EN BIT(16) > -#define HHI_MIPI_CNTL2_CH_EN(n) BIT(15 - (n)) > +#define HHI_MIPI_CNTL2_CH_EN GENMASK(15, 11) > #define HHI_MIPI_CNTL2_CH0_LP_CTL GENMASK(10, 1) > > +#define DSI_LANE_0 (1 << 4) > +#define DSI_LANE_1 (1 << 3) > +#define DSI_LANE_CLK (1 << 2) > +#define DSI_LANE_2 (1 << 1) > +#define DSI_LANE_3 (1 << 0) > +#define DSI_LANE_MASK (0x1F) > + > struct phy_axg_mipi_pcie_analog_priv { > struct phy *phy; > - unsigned int mode; > struct regmap *regmap; > + bool dsi_configured; > + bool dsi_enabled; > + bool powered; > + struct phy_configure_opts_mipi_dphy config; > }; > > -static const struct regmap_config phy_axg_mipi_pcie_analog_regmap_conf = { > - .reg_bits = 8, > - .val_bits = 32, > - .reg_stride = 4, > - .max_register = HHI_MIPI_CNTL2, > -}; > +static void phy_bandgap_enable(struct phy_axg_mipi_pcie_analog_priv *priv) > +{ > + regmap_update_bits(priv->regmap, HHI_MIPI_CNTL0, > + HHI_MIPI_CNTL0_BANDGAP, HHI_MIPI_CNTL0_BANDGAP); > > -static int phy_axg_mipi_pcie_analog_power_on(struct phy *phy) > + regmap_update_bits(priv->regmap, HHI_MIPI_CNTL0, > + HHI_MIPI_CNTL0_ENABLE, HHI_MIPI_CNTL0_ENABLE); > +} > + > +static void phy_bandgap_disable(struct phy_axg_mipi_pcie_analog_priv *priv) > { > - struct phy_axg_mipi_pcie_analog_priv *priv = phy_get_drvdata(phy); > + regmap_update_bits(priv->regmap, HHI_MIPI_CNTL0, > + HHI_MIPI_CNTL0_BANDGAP, 0); > + regmap_update_bits(priv->regmap, HHI_MIPI_CNTL0, > + HHI_MIPI_CNTL0_ENABLE, 0); > +} > > - /* MIPI not supported yet */ > - if (priv->mode != PHY_TYPE_PCIE) > - return -EINVAL; > +static void phy_dsi_analog_enable(struct phy_axg_mipi_pcie_analog_priv *priv) > +{ > + u32 reg; > > regmap_update_bits(priv->regmap, HHI_MIPI_CNTL0, > - HHI_MIPI_CNTL0_BANDGAP, HHI_MIPI_CNTL0_BANDGAP); > + HHI_MIPI_CNTL0_DIF_REF_CTL1, > + FIELD_PREP(HHI_MIPI_CNTL0_DIF_REF_CTL1, 0x1b8)); > + regmap_update_bits(priv->regmap, HHI_MIPI_CNTL0, > + BIT(31), BIT(31)); > + regmap_update_bits(priv->regmap, HHI_MIPI_CNTL0, > + HHI_MIPI_CNTL0_DIF_REF_CTL0, > + FIELD_PREP(HHI_MIPI_CNTL0_DIF_REF_CTL0, 0x8)); > + > + regmap_write(priv->regmap, HHI_MIPI_CNTL1, 0x001e); > + > + regmap_write(priv->regmap, HHI_MIPI_CNTL2, > + (0x26e0 << 16) | (0x459 << 0)); > + > + reg = DSI_LANE_CLK; > + switch (priv->config.lanes) { > + case 4: > + reg |= DSI_LANE_3; > + fallthrough; > + case 3: > + reg |= DSI_LANE_2; > + fallthrough; > + case 2: > + reg |= DSI_LANE_1; > + fallthrough; > + case 1: > + reg |= DSI_LANE_0; > + break; > + default: > + reg = 0; > + } > + > + regmap_update_bits(priv->regmap, HHI_MIPI_CNTL2, > + HHI_MIPI_CNTL2_CH_EN, > + FIELD_PREP(HHI_MIPI_CNTL2_CH_EN, reg)); > + > + priv->dsi_enabled = true; > +} > > +static void phy_dsi_analog_disable(struct phy_axg_mipi_pcie_analog_priv *priv) > +{ > regmap_update_bits(priv->regmap, HHI_MIPI_CNTL0, > - HHI_MIPI_CNTL0_ENABLE, HHI_MIPI_CNTL0_ENABLE); > - return 0; > + HHI_MIPI_CNTL0_DIF_REF_CTL1, > + FIELD_PREP(HHI_MIPI_CNTL0_DIF_REF_CTL1, 0)); > + regmap_update_bits(priv->regmap, HHI_MIPI_CNTL0, BIT(31), 0); > + regmap_update_bits(priv->regmap, HHI_MIPI_CNTL0, > + HHI_MIPI_CNTL0_DIF_REF_CTL1, 0); > + > + regmap_write(priv->regmap, HHI_MIPI_CNTL1, 0x6); > + > + regmap_write(priv->regmap, HHI_MIPI_CNTL2, 0x00200000); > + > + priv->dsi_enabled = false; > } > > -static int phy_axg_mipi_pcie_analog_power_off(struct phy *phy) > +static int phy_axg_mipi_pcie_analog_configure(struct phy *phy, > + union phy_configure_opts *opts) > { > struct phy_axg_mipi_pcie_analog_priv *priv = phy_get_drvdata(phy); > + int ret; > > - /* MIPI not supported yet */ > - if (priv->mode != PHY_TYPE_PCIE) > - return -EINVAL; > + ret = phy_mipi_dphy_config_validate(&opts->mipi_dphy); > + if (ret) > + return ret; > + > + memcpy(&priv->config, opts, sizeof(priv->config)); > + > + priv->dsi_configured = true; > + > + /* If PHY was already powered on, setup the DSI analog part */ > + if (priv->powered) { > + /* If reconfiguring, disable & reconfigure */ > + if (priv->dsi_enabled) > + phy_dsi_analog_disable(priv); > + > + usleep_range(100, 200); > + > + phy_dsi_analog_enable(priv); > + } > > - regmap_update_bits(priv->regmap, HHI_MIPI_CNTL0, > - HHI_MIPI_CNTL0_BANDGAP, 0); > - regmap_update_bits(priv->regmap, HHI_MIPI_CNTL0, > - HHI_MIPI_CNTL0_ENABLE, 0); > return 0; > } > > -static int phy_axg_mipi_pcie_analog_init(struct phy *phy) > +static int phy_axg_mipi_pcie_analog_power_on(struct phy *phy) > { > + struct phy_axg_mipi_pcie_analog_priv *priv = phy_get_drvdata(phy); > + > + phy_bandgap_enable(priv); > + > + if (priv->dsi_configured) > + phy_dsi_analog_enable(priv); > + > + priv->powered = true; > + > return 0; > } > > -static int phy_axg_mipi_pcie_analog_exit(struct phy *phy) > +static int phy_axg_mipi_pcie_analog_power_off(struct phy *phy) > { > + struct phy_axg_mipi_pcie_analog_priv *priv = phy_get_drvdata(phy); > + > + phy_bandgap_disable(priv); > + > + if (priv->dsi_enabled) > + phy_dsi_analog_disable(priv); > + > + priv->powered = false; > + > return 0; > } > > static const struct phy_ops phy_axg_mipi_pcie_analog_ops = { > - .init = phy_axg_mipi_pcie_analog_init, > - .exit = phy_axg_mipi_pcie_analog_exit, > + .configure = phy_axg_mipi_pcie_analog_configure, > .power_on = phy_axg_mipi_pcie_analog_power_on, > .power_off = phy_axg_mipi_pcie_analog_power_off, > .owner = THIS_MODULE, > }; > > -static struct phy *phy_axg_mipi_pcie_analog_xlate(struct device *dev, > - struct of_phandle_args *args) > -{ > - struct phy_axg_mipi_pcie_analog_priv *priv = dev_get_drvdata(dev); > - unsigned int mode; > - > - if (args->args_count != 1) { > - dev_err(dev, "invalid number of arguments\n"); > - return ERR_PTR(-EINVAL); > - } > - > - mode = args->args[0]; > - > - /* MIPI mode is not supported yet */ > - if (mode != PHY_TYPE_PCIE) { > - dev_err(dev, "invalid phy mode select argument\n"); > - return ERR_PTR(-EINVAL); > - } > - > - priv->mode = mode; > - return priv->phy; > -} > - > static int phy_axg_mipi_pcie_analog_probe(struct platform_device *pdev) > { > struct phy_provider *phy; > @@ -126,27 +200,20 @@ static int phy_axg_mipi_pcie_analog_probe(struct platform_device *pdev) > struct phy_axg_mipi_pcie_analog_priv *priv; > struct device_node *np = dev->of_node; > struct regmap *map; > - struct resource *res; > - void __iomem *base; > int ret; > > priv = devm_kmalloc(dev, sizeof(*priv), GFP_KERNEL); > if (!priv) > return -ENOMEM; > > - res = platform_get_resource(pdev, IORESOURCE_MEM, 0); > - base = devm_ioremap_resource(dev, res); > - if (IS_ERR(base)) { > - dev_err(dev, "failed to get regmap base\n"); > - return PTR_ERR(base); > - } > - > - map = devm_regmap_init_mmio(dev, base, > - &phy_axg_mipi_pcie_analog_regmap_conf); > + /* Get the hhi system controller node */ > + map = syscon_node_to_regmap(of_get_parent(dev->of_node)); > if (IS_ERR(map)) { > - dev_err(dev, "failed to get HHI regmap\n"); > + dev_err(dev, > + "failed to get HHI regmap\n"); > return PTR_ERR(map); > } > + > priv->regmap = map; > > priv->phy = devm_phy_create(dev, np, &phy_axg_mipi_pcie_analog_ops); > @@ -160,8 +227,7 @@ static int phy_axg_mipi_pcie_analog_probe(struct platform_device *pdev) > phy_set_drvdata(priv->phy, priv); > dev_set_drvdata(dev, priv); > > - phy = devm_of_phy_provider_register(dev, > - phy_axg_mipi_pcie_analog_xlate); > + phy = devm_of_phy_provider_register(dev, of_phy_simple_xlate); > > return PTR_ERR_OR_ZERO(phy); > } > _______________________________________________ linux-arm-kernel mailing list linux-arm-kernel@lists.infradead.org http://lists.infradead.org/mailman/listinfo/linux-arm-kernel