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=-9.7 required=3.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,HEADER_FROM_DIFFERENT_DOMAINS,INCLUDES_PATCH,MAILING_LIST_MULTI, SIGNED_OFF_BY,SPF_HELO_NONE,SPF_PASS,URIBL_BLOCKED autolearn=ham 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 2AB02C43461 for ; Wed, 16 Sep 2020 15:45:30 +0000 (UTC) Received: from alsa0.perex.cz (alsa0.perex.cz [77.48.224.243]) (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 6F16022272 for ; Wed, 16 Sep 2020 15:45:29 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (1024-bit key) header.d=alsa-project.org header.i=@alsa-project.org header.b="SbrqSiHX" DMARC-Filter: OpenDMARC Filter v1.3.2 mail.kernel.org 6F16022272 Authentication-Results: mail.kernel.org; dmarc=fail (p=none dis=none) header.from=linux.intel.com Authentication-Results: mail.kernel.org; spf=pass smtp.mailfrom=alsa-devel-bounces@alsa-project.org Received: from alsa1.perex.cz (alsa1.perex.cz [207.180.221.201]) (using TLSv1.2 with cipher AECDH-AES256-SHA (256/256 bits)) (No client certificate requested) by alsa0.perex.cz (Postfix) with ESMTPS id DAA4C3E; Wed, 16 Sep 2020 17:44:37 +0200 (CEST) DKIM-Filter: OpenDKIM Filter v2.11.0 alsa0.perex.cz DAA4C3E DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/simple; d=alsa-project.org; s=default; t=1600271127; bh=HFk5casZiTsfb5s8kl8Kz7rfmF0fuunZn7GB32urFB8=; h=Date:From:To:Subject:References:In-Reply-To:Cc:List-Id: List-Unsubscribe:List-Archive:List-Post:List-Help:List-Subscribe: From; b=SbrqSiHXOlFJnXtSHsFN8ynUxD5taLPOooZZ2yNlQJqgJZDC6OiZ3ejm/Mu/pYt+D XJWuae1ADBKh0u8bdFtvEcZzi0mTOaMNveCPSakp0lyHIlTSpgQNMpDMBPCHM70yJY Rqk8f+wEtUQYKkqExBf/ZIec730jaktQ4Ep89enw= Received: from alsa1.perex.cz (localhost.localdomain [127.0.0.1]) by alsa1.perex.cz (Postfix) with ESMTP id 67B3EF8015A; Wed, 16 Sep 2020 17:44:37 +0200 (CEST) Received: by alsa1.perex.cz (Postfix, from userid 50401) id 2A250F8015C; Wed, 16 Sep 2020 17:44:35 +0200 (CEST) Received: from mga09.intel.com (mga09.intel.com [134.134.136.24]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by alsa1.perex.cz (Postfix) with ESMTPS id B778BF800BB for ; Wed, 16 Sep 2020 17:44:22 +0200 (CEST) DKIM-Filter: OpenDKIM Filter v2.11.0 alsa1.perex.cz B778BF800BB IronPort-SDR: RCabaVBq66sMlCfXzHAPZfUDhu4tgLGFNicMsQr4pt1A+23S6gB5rJO1Jrhf2LC7nNZFLTHWA2 UdWtQO3t3fgQ== X-IronPort-AV: E=McAfee;i="6000,8403,9746"; a="160424383" X-IronPort-AV: E=Sophos;i="5.76,433,1592895600"; d="scan'208";a="160424383" X-Amp-Result: SKIPPED(no attachment in message) X-Amp-File-Uploaded: False Received: from orsmga008.jf.intel.com ([10.7.209.65]) by orsmga102.jf.intel.com with ESMTP/TLS/ECDHE-RSA-AES256-GCM-SHA384; 16 Sep 2020 08:44:16 -0700 IronPort-SDR: NLkmt4ZHPVv0LF3V37koUkBJSReB4Ghtk/rOnMyD/xAg6GrJk2RA9FvDzFliwczY/HHIb3T+5B oiBPO3mlHxbg== X-ExtLoop1: 1 X-IronPort-AV: E=Sophos;i="5.76,433,1592895600"; d="scan'208";a="336065288" Received: from smile.fi.intel.com (HELO smile) ([10.237.68.40]) by orsmga008.jf.intel.com with ESMTP; 16 Sep 2020 08:44:12 -0700 Received: from andy by smile with local (Exim 4.94) (envelope-from ) id 1kIZbN-00H7Cx-68; Wed, 16 Sep 2020 18:44:09 +0300 Date: Wed, 16 Sep 2020 18:44:09 +0300 From: Andy Shevchenko To: Cezary Rojewski Subject: Re: [PATCH v5 02/13] ASoC: Intel: catpt: Define DSP operations Message-ID: <20200916154409.GQ3956970@smile.fi.intel.com> References: <20200915162944.16241-1-cezary.rojewski@intel.com> <20200915162944.16241-3-cezary.rojewski@intel.com> MIME-Version: 1.0 Content-Type: text/plain; charset=us-ascii Content-Disposition: inline In-Reply-To: <20200915162944.16241-3-cezary.rojewski@intel.com> Organization: Intel Finland Oy - BIC 0357606-4 - Westendinkatu 7, 02160 Espoo Cc: pierre-louis.bossart@linux.intel.com, alsa-devel@alsa-project.org, filip.kaczmarski@intel.com, harshapriya.n@intel.com, marcin.barlik@intel.com, zwisler@google.com, lgirdwood@gmail.com, tiwai@suse.com, filip.proborszcz@intel.com, broonie@kernel.org, amadeuszx.slawinski@linux.intel.com, michal.wasko@intel.com, cujomalainey@chromium.org, krzysztof.hejmowski@intel.com, ppapierkowski@habana.ai, vamshi.krishna.gopal@intel.com X-BeenThere: alsa-devel@alsa-project.org X-Mailman-Version: 2.1.15 Precedence: list List-Id: "Alsa-devel mailing list for ALSA developers - http://www.alsa-project.org" List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Errors-To: alsa-devel-bounces@alsa-project.org Sender: "Alsa-devel" On Tue, Sep 15, 2020 at 06:29:33PM +0200, Cezary Rojewski wrote: > Implement dsp lifecycle functions such as core RESET and STALL, > SRAM power control and LP clock selection. This also adds functions for > handling transport over DW DMA controller. Some nit-picks below. FWIW, Reviewed-by: Andy Shevchenko > Signed-off-by: Cezary Rojewski > --- > sound/soc/intel/catpt/dsp.c | 473 ++++++++++++++++++++++++++++++++++++ > 1 file changed, 473 insertions(+) > create mode 100644 sound/soc/intel/catpt/dsp.c > > diff --git a/sound/soc/intel/catpt/dsp.c b/sound/soc/intel/catpt/dsp.c > new file mode 100644 > index 000000000000..202d90bb51b4 > --- /dev/null > +++ b/sound/soc/intel/catpt/dsp.c > @@ -0,0 +1,473 @@ > +// SPDX-License-Identifier: GPL-2.0-only > +// > +// Copyright(c) 2020 Intel Corporation. All rights reserved. > +// > +// Author: Cezary Rojewski > +// > + > +#include > +#include > +#include > +#include > +#include "core.h" > +#include "messages.h" > +#include "registers.h" > + > +static bool catpt_dma_filter(struct dma_chan *chan, void *param) > +{ > + return param == chan->device->dev; > +} > + > +/* > + * Either engine 0 or 1 can be used for image loading. > + * Align with Windows driver equivalent and stick to engine 1. > + */ > +#define CATPT_DMA_DEVID 1 > +#define CATPT_DMA_DSP_ADDR_MASK GENMASK(31, 20) > + > +struct dma_chan *catpt_dma_request_config_chan(struct catpt_dev *cdev) > +{ > + struct dma_slave_config config; > + struct dma_chan *chan; > + dma_cap_mask_t mask; > + int ret; > + > + dma_cap_zero(mask); > + dma_cap_set(DMA_MEMCPY, mask); > + > + chan = dma_request_channel(mask, catpt_dma_filter, cdev->dev); > + if (!chan) { > + dev_err(cdev->dev, "request channel failed\n"); > + return ERR_PTR(-EPROBE_DEFER); > + } > + > + memset(&config, 0, sizeof(config)); > + config.direction = DMA_MEM_TO_DEV; > + config.src_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; > + config.dst_addr_width = DMA_SLAVE_BUSWIDTH_4_BYTES; > + config.src_maxburst = 16; > + config.dst_maxburst = 16; > + > + ret = dmaengine_slave_config(chan, &config); > + if (ret) { > + dev_err(cdev->dev, "slave config failed: %d\n", ret); > + dma_release_channel(chan); > + return ERR_PTR(ret); > + } > + > + return chan; > +} > + > +static int catpt_dma_memcpy(struct catpt_dev *cdev, struct dma_chan *chan, > + dma_addr_t dst_addr, dma_addr_t src_addr, > + size_t size) > +{ > + struct dma_async_tx_descriptor *desc; > + enum dma_status status; > + > + desc = dmaengine_prep_dma_memcpy(chan, dst_addr, src_addr, size, > + DMA_CTRL_ACK); > + if (!desc) { > + dev_err(cdev->dev, "prep dma memcpy failed\n"); > + return -EIO; > + } > + > + /* enable demand mode for dma channel */ > + catpt_updatel_shim(cdev, HMDC, > + CATPT_HMDC_HDDA(CATPT_DMA_DEVID, chan->chan_id), > + CATPT_HMDC_HDDA(CATPT_DMA_DEVID, chan->chan_id)); > + dmaengine_submit(desc); > + status = dma_wait_for_async_tx(desc); > + /* regardless of status, disable access to HOST memory in demand mode */ > + catpt_updatel_shim(cdev, HMDC, > + CATPT_HMDC_HDDA(CATPT_DMA_DEVID, chan->chan_id), 0); > + > + return (status == DMA_COMPLETE) ? 0 : -EPROTO; > +} > + > +int catpt_dma_memcpy_todsp(struct catpt_dev *cdev, struct dma_chan *chan, > + dma_addr_t dst_addr, dma_addr_t src_addr, > + size_t size) > +{ > + return catpt_dma_memcpy(cdev, chan, dst_addr | CATPT_DMA_DSP_ADDR_MASK, > + src_addr, size); > +} > + > +int catpt_dma_memcpy_fromdsp(struct catpt_dev *cdev, struct dma_chan *chan, > + dma_addr_t dst_addr, dma_addr_t src_addr, > + size_t size) > +{ > + return catpt_dma_memcpy(cdev, chan, dst_addr, > + src_addr | CATPT_DMA_DSP_ADDR_MASK, size); > +} > + > +int catpt_dmac_probe(struct catpt_dev *cdev) > +{ > + struct dw_dma_chip *dmac; > + int ret; > + > + dmac = devm_kzalloc(cdev->dev, sizeof(*dmac), GFP_KERNEL); > + if (!dmac) > + return -ENOMEM; > + dmac->regs = cdev->lpe_ba + > + cdev->spec->host_dma_offset[CATPT_DMA_DEVID]; One line? > + dmac->dev = cdev->dev; > + dmac->irq = cdev->irq; > + > + ret = dma_coerce_mask_and_coherent(cdev->dev, DMA_BIT_MASK(31)); > + if (ret) > + return ret; > + /* > + * Caller is responsible for putting device in D0 to allow > + * for I/O and memory access before probing DW. > + */ > + ret = dw_dma_probe(dmac); > + if (ret) > + return ret; > + > + cdev->dmac = dmac; > + return 0; > +} > + > +void catpt_dmac_remove(struct catpt_dev *cdev) > +{ > + /* > + * As do_dma_remove() juggles with pm_runtime_get_xxx() and > + * pm_runtime_put_xxx() while both ADSP and DW 'devices' are part of > + * the same module, caller makes sure pm_runtime_disable() is invoked > + * before removing DW to prevent postmortem resume and suspend. > + */ > + dw_dma_remove(cdev->dmac); > +} > + > +static void catpt_dsp_set_srampge(struct catpt_dev *cdev, struct resource *sram, > + unsigned long mask, unsigned long new) > +{ > + unsigned long old; > + u32 off = sram->start; > + u32 b = __ffs(mask); > + > + old = catpt_readl_pci(cdev, VDRTCTL0) & mask; > + dev_dbg(cdev->dev, "SRAMPGE [0x%08lx] 0x%08lx -> 0x%08lx", > + mask, old, new); I saw use of trace points, this looks like non-production leftover. > + if (old == new) > + return; > + > + catpt_updatel_pci(cdev, VDRTCTL0, mask, new); > + /* wait for SRAM power gating to propagate */ > + udelay(60); > + > + /* > + * Dummy read as the very first access after block enable > + * to prevent byte loss in future operations. > + */ > + for_each_clear_bit_from(b, &new, fls_long(mask)) { > + u8 buf[4]; > + > + /* newly enabled: new bit=0 while old bit=1 */ > + if (test_bit(b, &old)) { > + dev_dbg(cdev->dev, "sanitize block %ld: off 0x%08x\n", > + b - __ffs(mask), off); So does this. > + memcpy_fromio(buf, cdev->lpe_ba + off, sizeof(buf)); > + } > + off += CATPT_MEMBLOCK_SIZE; > + } > +} > + > +void catpt_dsp_update_srampge(struct catpt_dev *cdev, struct resource *sram, > + unsigned long mask) > +{ > + struct resource *res; > + unsigned long new = 0; > + > + /* flag all busy blocks */ > + for (res = sram->child; res; res = res->sibling) { > + u32 h, l; > + > + h = (res->end - sram->start) / CATPT_MEMBLOCK_SIZE; > + l = (res->start - sram->start) / CATPT_MEMBLOCK_SIZE; > + new |= GENMASK(h, l); I think better assembly will be generated with (BIT(h - l + 1) - 1) << l Looking at the above calculus it seems (needs to be carefully checked!) can be u32 bits = DIV_ROUND_UP(resource_size(res), CATPT_MEMBLOCK_SIZE); u32 shift = (res->start - sram->start) / CATPT_MEMBLOCK_SIZE; new |= (BIT(bits) - 1) << shift; Note, your approach is also good from readability point of view, so just weight pros and cons and choose best one. > + } > + > + /* offset value given mask's start and invert it as ON=b0 */ > + new = ~(new << __ffs(mask)) & mask; > + > + /* disable core clock gating */ > + catpt_updatel_pci(cdev, VDRTCTL2, CATPT_VDRTCTL2_DCLCGE, 0); > + > + catpt_dsp_set_srampge(cdev, sram, mask, new); > + > + /* enable core clock gating */ > + catpt_updatel_pci(cdev, VDRTCTL2, CATPT_VDRTCTL2_DCLCGE, > + CATPT_VDRTCTL2_DCLCGE); > +} > + > +int catpt_dsp_stall(struct catpt_dev *cdev, bool stall) > +{ > + u32 reg, val; > + > + val = stall ? CATPT_CS_STALL : 0; > + catpt_updatel_shim(cdev, CS1, CATPT_CS_STALL, val); > + > + return catpt_readl_poll_shim(cdev, CS1, > + reg, (reg & CATPT_CS_STALL) == val, > + 500, 10000); > +} > + > +static int catpt_dsp_reset(struct catpt_dev *cdev, bool reset) > +{ > + u32 reg, val; > + > + val = reset ? CATPT_CS_RST : 0; > + catpt_updatel_shim(cdev, CS1, CATPT_CS_RST, val); > + > + return catpt_readl_poll_shim(cdev, CS1, > + reg, (reg & CATPT_CS_RST) == val, > + 500, 10000); > +} > + > +void lpt_dsp_pll_shutdown(struct catpt_dev *cdev, bool enable) > +{ > + u32 val; > + > + val = enable ? LPT_VDRTCTL0_APLLSE : 0; > + catpt_updatel_pci(cdev, VDRTCTL0, LPT_VDRTCTL0_APLLSE, val); > +} > + > +void wpt_dsp_pll_shutdown(struct catpt_dev *cdev, bool enable) > +{ > + u32 val; > + > + val = enable ? WPT_VDRTCTL2_APLLSE : 0; > + catpt_updatel_pci(cdev, VDRTCTL2, WPT_VDRTCTL2_APLLSE, val); > +} > + > +static int catpt_dsp_select_lpclock(struct catpt_dev *cdev, bool lp, bool waiti) > +{ > + u32 mask, reg, val; > + int ret; > + > + mutex_lock(&cdev->clk_mutex); > + > + val = lp ? CATPT_CS_LPCS : 0; > + reg = catpt_readl_shim(cdev, CS1) & CATPT_CS_LPCS; > + dev_dbg(cdev->dev, "LPCS [0x%08lx] 0x%08x -> 0x%08x", > + CATPT_CS_LPCS, reg, val); Leftover? > + if (reg == val) { > + mutex_unlock(&cdev->clk_mutex); > + return 0; > + } > + > + if (waiti) { > + /* wait for DSP to signal WAIT state */ > + ret = catpt_readl_poll_shim(cdev, ISD, > + reg, (reg & CATPT_ISD_DCPWM), > + 500, 10000); > + if (ret) { > + dev_err(cdev->dev, "await WAITI timeout\n"); > + mutex_unlock(&cdev->clk_mutex); > + return ret; > + } > + } > + > + ret = catpt_readl_poll_shim(cdev, CLKCTL, > + reg, !(reg & CATPT_CLKCTL_CFCIP), > + 500, 10000); > + if (ret) > + dev_warn(cdev->dev, "clock change still in progress\n"); > + > + /* default to DSP core & audio fabric high clock */ > + val |= CATPT_CS_DCS_HIGH; > + mask = CATPT_CS_LPCS | CATPT_CS_DCS; > + catpt_updatel_shim(cdev, CS1, mask, val); > + > + ret = catpt_readl_poll_shim(cdev, CLKCTL, > + reg, !(reg & CATPT_CLKCTL_CFCIP), > + 500, 10000); > + if (ret) > + dev_warn(cdev->dev, "clock change still in progress\n"); > + > + /* update PLL accordingly */ > + cdev->spec->pll_shutdown(cdev, lp); > + > + mutex_unlock(&cdev->clk_mutex); > + return 0; > +} > + > +int catpt_dsp_update_lpclock(struct catpt_dev *cdev) > +{ > + struct catpt_stream_runtime *stream; > + > + list_for_each_entry(stream, &cdev->stream_list, node) > + if (stream->prepared) > + return catpt_dsp_select_lpclock(cdev, false, true); > + > + return catpt_dsp_select_lpclock(cdev, true, true); > +} > + > +/* bring registers to their defaults as HW won't reset itself */ > +static void catpt_dsp_set_regs_defaults(struct catpt_dev *cdev) > +{ > + int i; > + > + catpt_writel_shim(cdev, CS1, CATPT_CS_DEFAULT); > + catpt_writel_shim(cdev, ISC, CATPT_ISC_DEFAULT); > + catpt_writel_shim(cdev, ISD, CATPT_ISD_DEFAULT); > + catpt_writel_shim(cdev, IMC, CATPT_IMC_DEFAULT); > + catpt_writel_shim(cdev, IMD, CATPT_IMD_DEFAULT); > + catpt_writel_shim(cdev, IPCC, CATPT_IPCC_DEFAULT); > + catpt_writel_shim(cdev, IPCD, CATPT_IPCD_DEFAULT); > + catpt_writel_shim(cdev, CLKCTL, CATPT_CLKCTL_DEFAULT); > + catpt_writel_shim(cdev, CS2, CATPT_CS2_DEFAULT); > + catpt_writel_shim(cdev, LTRC, CATPT_LTRC_DEFAULT); > + catpt_writel_shim(cdev, HMDC, CATPT_HMDC_DEFAULT); > + > + for (i = 0; i < CATPT_SSP_COUNT; i++) { > + catpt_writel_ssp(cdev, i, SSCR0, CATPT_SSC0_DEFAULT); > + catpt_writel_ssp(cdev, i, SSCR1, CATPT_SSC1_DEFAULT); > + catpt_writel_ssp(cdev, i, SSSR, CATPT_SSS_DEFAULT); > + catpt_writel_ssp(cdev, i, SSITR, CATPT_SSIT_DEFAULT); > + catpt_writel_ssp(cdev, i, SSDR, CATPT_SSD_DEFAULT); > + catpt_writel_ssp(cdev, i, SSTO, CATPT_SSTO_DEFAULT); > + catpt_writel_ssp(cdev, i, SSPSP, CATPT_SSPSP_DEFAULT); > + catpt_writel_ssp(cdev, i, SSTSA, CATPT_SSTSA_DEFAULT); > + catpt_writel_ssp(cdev, i, SSRSA, CATPT_SSRSA_DEFAULT); > + catpt_writel_ssp(cdev, i, SSTSS, CATPT_SSTSS_DEFAULT); > + catpt_writel_ssp(cdev, i, SSCR2, CATPT_SSCR2_DEFAULT); > + catpt_writel_ssp(cdev, i, SSPSP2, CATPT_SSPSP2_DEFAULT); > + } > +} > + > +int lpt_dsp_power_down(struct catpt_dev *cdev) > +{ > + catpt_dsp_reset(cdev, true); > + > + /* set 24Mhz clock for both SSPs */ > + catpt_updatel_shim(cdev, CS1, CATPT_CS_SBCS(0) | CATPT_CS_SBCS(1), > + CATPT_CS_SBCS(0) | CATPT_CS_SBCS(1)); > + catpt_dsp_select_lpclock(cdev, true, false); > + > + /* DRAM power gating all */ > + catpt_dsp_set_srampge(cdev, &cdev->dram, cdev->spec->dram_mask, > + cdev->spec->dram_mask); > + catpt_dsp_set_srampge(cdev, &cdev->iram, cdev->spec->iram_mask, > + cdev->spec->iram_mask); > + > + catpt_updatel_pci(cdev, PMCS, PCI_PM_CTRL_STATE_MASK, PCI_D3hot); > + /* give hw time to drop off */ > + udelay(50); > + > + return 0; > +} > + > +int lpt_dsp_power_up(struct catpt_dev *cdev) > +{ > + /* SRAM power gating none */ > + catpt_dsp_set_srampge(cdev, &cdev->dram, cdev->spec->dram_mask, 0); > + catpt_dsp_set_srampge(cdev, &cdev->iram, cdev->spec->iram_mask, 0); > + > + catpt_updatel_pci(cdev, PMCS, PCI_PM_CTRL_STATE_MASK, PCI_D0); > + /* give hw time to wake up */ > + udelay(100); > + > + catpt_dsp_select_lpclock(cdev, false, false); > + catpt_updatel_shim(cdev, CS1, > + CATPT_CS_SBCS(0) | CATPT_CS_SBCS(1), > + CATPT_CS_SBCS(0) | CATPT_CS_SBCS(1)); > + /* stagger DSP reset after clock selection */ > + udelay(50); > + > + catpt_dsp_reset(cdev, false); > + /* generate int deassert msg to fix inversed int logic */ > + catpt_updatel_shim(cdev, IMC, CATPT_IMC_IPCDB | CATPT_IMC_IPCCD, 0); > + > + return 0; > +} > + > +int wpt_dsp_power_down(struct catpt_dev *cdev) > +{ > + u32 mask, val; > + > + /* disable core clock gating */ > + catpt_updatel_pci(cdev, VDRTCTL2, CATPT_VDRTCTL2_DCLCGE, 0); > + > + catpt_dsp_reset(cdev, true); > + /* set 24Mhz clock for both SSPs */ > + catpt_updatel_shim(cdev, CS1, CATPT_CS_SBCS(0) | CATPT_CS_SBCS(1), > + CATPT_CS_SBCS(0) | CATPT_CS_SBCS(1)); > + catpt_dsp_select_lpclock(cdev, true, false); > + /* disable MCLK */ > + catpt_updatel_shim(cdev, CLKCTL, CATPT_CLKCTL_SMOS, 0); > + > + catpt_dsp_set_regs_defaults(cdev); > + > + /* switch clock gating */ > + mask = CATPT_VDRTCTL2_CGEALL & (~CATPT_VDRTCTL2_DCLCGE); > + val = mask & (~CATPT_VDRTCTL2_DTCGE); > + catpt_updatel_pci(cdev, VDRTCTL2, mask, val); > + /* enable DTCGE separatelly */ > + catpt_updatel_pci(cdev, VDRTCTL2, CATPT_VDRTCTL2_DTCGE, > + CATPT_VDRTCTL2_DTCGE); > + > + /* SRAM power gating all */ > + catpt_dsp_set_srampge(cdev, &cdev->dram, cdev->spec->dram_mask, > + cdev->spec->dram_mask); > + catpt_dsp_set_srampge(cdev, &cdev->iram, cdev->spec->iram_mask, > + cdev->spec->iram_mask); > + mask = WPT_VDRTCTL0_D3SRAMPGD | WPT_VDRTCTL0_D3PGD; > + catpt_updatel_pci(cdev, VDRTCTL0, mask, WPT_VDRTCTL0_D3PGD); > + > + catpt_updatel_pci(cdev, PMCS, PCI_PM_CTRL_STATE_MASK, PCI_D3hot); > + /* give hw time to drop off */ > + udelay(50); > + > + /* enable core clock gating */ > + catpt_updatel_pci(cdev, VDRTCTL2, CATPT_VDRTCTL2_DCLCGE, > + CATPT_VDRTCTL2_DCLCGE); > + udelay(50); > + > + return 0; > +} > + > +int wpt_dsp_power_up(struct catpt_dev *cdev) > +{ > + u32 mask, val; > + > + /* disable core clock gating */ > + catpt_updatel_pci(cdev, VDRTCTL2, CATPT_VDRTCTL2_DCLCGE, 0); > + > + /* switch clock gating */ > + mask = CATPT_VDRTCTL2_CGEALL & (~CATPT_VDRTCTL2_DCLCGE); > + val = mask & (~CATPT_VDRTCTL2_DTCGE); > + catpt_updatel_pci(cdev, VDRTCTL2, mask, val); > + > + catpt_updatel_pci(cdev, PMCS, PCI_PM_CTRL_STATE_MASK, PCI_D0); > + > + /* SRAM power gating none */ > + mask = WPT_VDRTCTL0_D3SRAMPGD | WPT_VDRTCTL0_D3PGD; > + catpt_updatel_pci(cdev, VDRTCTL0, mask, mask); > + catpt_dsp_set_srampge(cdev, &cdev->dram, cdev->spec->dram_mask, 0); > + catpt_dsp_set_srampge(cdev, &cdev->iram, cdev->spec->iram_mask, 0); > + > + catpt_dsp_set_regs_defaults(cdev); > + > + /* restore MCLK */ > + catpt_updatel_shim(cdev, CLKCTL, CATPT_CLKCTL_SMOS, CATPT_CLKCTL_SMOS); > + catpt_dsp_select_lpclock(cdev, false, false); > + /* set 24Mhz clock for both SSPs */ > + catpt_updatel_shim(cdev, CS1, CATPT_CS_SBCS(0) | CATPT_CS_SBCS(1), > + CATPT_CS_SBCS(0) | CATPT_CS_SBCS(1)); > + catpt_dsp_reset(cdev, false); > + > + /* enable core clock gating */ > + catpt_updatel_pci(cdev, VDRTCTL2, CATPT_VDRTCTL2_DCLCGE, > + CATPT_VDRTCTL2_DCLCGE); > + > + /* generate int deassert msg to fix inversed int logic */ > + catpt_updatel_shim(cdev, IMC, CATPT_IMC_IPCDB | CATPT_IMC_IPCCD, 0); > + > + return 0; > +} > -- > 2.17.1 > -- With Best Regards, Andy Shevchenko