ASoC: Intel: cnl: Add sst library functions for cnl platform
authorGuneshwor Singh <guneshwor.o.singh@intel.com>
Wed, 2 Aug 2017 16:21:18 +0000 (21:51 +0530)
committerMark Brown <broonie@kernel.org>
Thu, 3 Aug 2017 10:07:33 +0000 (11:07 +0100)
This adds the necessary DSP functions specific for the Cannonlake platform
which includes firmware download using host DMA, DO/D3 handlers, irq_thread
handlers and sst ops.

Signed-off-by: Guneshwor Singh <guneshwor.o.singh@intel.com>
Acked-By: Vinod Koul <vinod.koul@intel.com>
Signed-off-by: Mark Brown <broonie@kernel.org>
sound/soc/intel/skylake/Makefile
sound/soc/intel/skylake/cnl-sst-dsp.h
sound/soc/intel/skylake/cnl-sst.c [new file with mode: 0644]

index e7d7772..3380deb 100644 (file)
@@ -8,7 +8,8 @@ endif
 obj-$(CONFIG_SND_SOC_INTEL_SKYLAKE) += snd-soc-skl.o
 
 # Skylake IPC Support
-snd-soc-skl-ipc-objs := skl-sst-ipc.o skl-sst-dsp.o skl-sst-cldma.o \
-               skl-sst.o bxt-sst.o skl-sst-utils.o
+snd-soc-skl-ipc-objs := skl-sst-ipc.o skl-sst-dsp.o cnl-sst-dsp.o \
+               skl-sst-cldma.o skl-sst.o bxt-sst.o cnl-sst.o \
+               skl-sst-utils.o
 
 obj-$(CONFIG_SND_SOC_INTEL_SKYLAKE) += snd-soc-skl-ipc.o
index 2fe41b1..09bd218 100644 (file)
@@ -103,4 +103,10 @@ void cnl_ipc_op_int_disable(struct sst_dsp *ctx);
 bool cnl_ipc_int_status(struct sst_dsp *ctx);
 void cnl_ipc_free(struct sst_generic_ipc *ipc);
 
+int cnl_sst_dsp_init(struct device *dev, void __iomem *mmio_base, int irq,
+                    const char *fw_name, struct skl_dsp_loader_ops dsp_ops,
+                    struct skl_sst **dsp);
+int cnl_sst_init_fw(struct device *dev, struct skl_sst *ctx);
+void cnl_sst_dsp_cleanup(struct device *dev, struct skl_sst *ctx);
+
 #endif /*__CNL_SST_DSP_H__*/
diff --git a/sound/soc/intel/skylake/cnl-sst.c b/sound/soc/intel/skylake/cnl-sst.c
new file mode 100644 (file)
index 0000000..7dcfe66
--- /dev/null
@@ -0,0 +1,495 @@
+/*
+ * cnl-sst.c - DSP library functions for CNL platform
+ *
+ * Copyright (C) 2016-17, Intel Corporation.
+ *
+ * Author: Guneshwor Singh <guneshwor.o.singh@intel.com>
+ *
+ * Modified from:
+ *     HDA DSP library functions for SKL platform
+ *     Copyright (C) 2014-15, Intel Corporation.
+ *
+ * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as version 2, as
+ * published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
+ * General Public License for more details.
+ *
+ * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
+ */
+
+#include <linux/module.h>
+#include <linux/delay.h>
+#include <linux/firmware.h>
+#include <linux/device.h>
+
+#include "../common/sst-dsp.h"
+#include "../common/sst-dsp-priv.h"
+#include "../common/sst-ipc.h"
+#include "cnl-sst-dsp.h"
+#include "skl-sst-dsp.h"
+#include "skl-sst-ipc.h"
+
+#define CNL_FW_ROM_INIT                0x1
+#define CNL_FW_INIT            0x5
+#define CNL_IPC_PURGE          0x01004000
+#define CNL_INIT_TIMEOUT       300
+#define CNL_BASEFW_TIMEOUT     3000
+
+#define CNL_ADSP_SRAM0_BASE    0x80000
+
+/* Firmware status window */
+#define CNL_ADSP_FW_STATUS     CNL_ADSP_SRAM0_BASE
+#define CNL_ADSP_ERROR_CODE    (CNL_ADSP_FW_STATUS + 0x4)
+
+#define CNL_INSTANCE_ID                0
+#define CNL_BASE_FW_MODULE_ID  0
+#define CNL_ADSP_FW_HDR_OFFSET 0x2000
+#define CNL_ROM_CTRL_DMA_ID    0x9
+
+static int cnl_prepare_fw(struct sst_dsp *ctx, const void *fwdata, u32 fwsize)
+{
+
+       int ret, stream_tag;
+
+       stream_tag = ctx->dsp_ops.prepare(ctx->dev, 0x40, fwsize, &ctx->dmab);
+       if (stream_tag <= 0) {
+               dev_err(ctx->dev, "dma prepare failed: 0%#x\n", stream_tag);
+               return stream_tag;
+       }
+
+       ctx->dsp_ops.stream_tag = stream_tag;
+       memcpy(ctx->dmab.area, fwdata, fwsize);
+
+       /* purge FW request */
+       sst_dsp_shim_write(ctx, CNL_ADSP_REG_HIPCIDR,
+                          CNL_ADSP_REG_HIPCIDR_BUSY | (CNL_IPC_PURGE |
+                          ((stream_tag - 1) << CNL_ROM_CTRL_DMA_ID)));
+
+       ret = cnl_dsp_enable_core(ctx, SKL_DSP_CORE0_MASK);
+       if (ret < 0) {
+               dev_err(ctx->dev, "dsp boot core failed ret: %d\n", ret);
+               ret = -EIO;
+               goto base_fw_load_failed;
+       }
+
+       /* enable interrupt */
+       cnl_ipc_int_enable(ctx);
+       cnl_ipc_op_int_enable(ctx);
+
+       ret = sst_dsp_register_poll(ctx, CNL_ADSP_FW_STATUS, CNL_FW_STS_MASK,
+                                   CNL_FW_ROM_INIT, CNL_INIT_TIMEOUT,
+                                   "rom load");
+       if (ret < 0) {
+               dev_err(ctx->dev, "rom init timeout, ret: %d\n", ret);
+               goto base_fw_load_failed;
+       }
+
+       return 0;
+
+base_fw_load_failed:
+       ctx->dsp_ops.cleanup(ctx->dev, &ctx->dmab, stream_tag);
+       cnl_dsp_disable_core(ctx, SKL_DSP_CORE0_MASK);
+
+       return ret;
+}
+
+static int sst_transfer_fw_host_dma(struct sst_dsp *ctx)
+{
+       int ret;
+
+       ctx->dsp_ops.trigger(ctx->dev, true, ctx->dsp_ops.stream_tag);
+       ret = sst_dsp_register_poll(ctx, CNL_ADSP_FW_STATUS, CNL_FW_STS_MASK,
+                                   CNL_FW_INIT, CNL_BASEFW_TIMEOUT,
+                                   "firmware boot");
+
+       ctx->dsp_ops.trigger(ctx->dev, false, ctx->dsp_ops.stream_tag);
+       ctx->dsp_ops.cleanup(ctx->dev, &ctx->dmab, ctx->dsp_ops.stream_tag);
+
+       return ret;
+}
+
+static int cnl_load_base_firmware(struct sst_dsp *ctx)
+{
+       struct firmware stripped_fw;
+       struct skl_sst *cnl = ctx->thread_context;
+       int ret;
+
+       if (!ctx->fw) {
+               ret = request_firmware(&ctx->fw, ctx->fw_name, ctx->dev);
+               if (ret < 0) {
+                       dev_err(ctx->dev, "request firmware failed: %d\n", ret);
+                       goto cnl_load_base_firmware_failed;
+               }
+       }
+
+       /* parse uuids if first boot */
+       if (cnl->is_first_boot) {
+               ret = snd_skl_parse_uuids(ctx, ctx->fw,
+                                         CNL_ADSP_FW_HDR_OFFSET, 0);
+               if (ret < 0)
+                       goto cnl_load_base_firmware_failed;
+       }
+
+       stripped_fw.data = ctx->fw->data;
+       stripped_fw.size = ctx->fw->size;
+       skl_dsp_strip_extended_manifest(&stripped_fw);
+
+       ret = cnl_prepare_fw(ctx, stripped_fw.data, stripped_fw.size);
+       if (ret < 0) {
+               dev_err(ctx->dev, "prepare firmware failed: %d\n", ret);
+               goto cnl_load_base_firmware_failed;
+       }
+
+       ret = sst_transfer_fw_host_dma(ctx);
+       if (ret < 0) {
+               dev_err(ctx->dev, "transfer firmware failed: %d\n", ret);
+               cnl_dsp_disable_core(ctx, SKL_DSP_CORE0_MASK);
+               goto cnl_load_base_firmware_failed;
+       }
+
+       ret = wait_event_timeout(cnl->boot_wait, cnl->boot_complete,
+                                msecs_to_jiffies(SKL_IPC_BOOT_MSECS));
+       if (ret == 0) {
+               dev_err(ctx->dev, "FW ready timed-out\n");
+               cnl_dsp_disable_core(ctx, SKL_DSP_CORE0_MASK);
+               ret = -EIO;
+               goto cnl_load_base_firmware_failed;
+       }
+
+       cnl->fw_loaded = true;
+
+       return 0;
+
+cnl_load_base_firmware_failed:
+       release_firmware(ctx->fw);
+       ctx->fw = NULL;
+
+       return ret;
+}
+
+static int cnl_set_dsp_D0(struct sst_dsp *ctx, unsigned int core_id)
+{
+       struct skl_sst *cnl = ctx->thread_context;
+       unsigned int core_mask = SKL_DSP_CORE_MASK(core_id);
+       struct skl_ipc_dxstate_info dx;
+       int ret;
+
+       if (!cnl->fw_loaded) {
+               cnl->boot_complete = false;
+               ret = cnl_load_base_firmware(ctx);
+               if (ret < 0) {
+                       dev_err(ctx->dev, "fw reload failed: %d\n", ret);
+                       return ret;
+               }
+
+               cnl->cores.state[core_id] = SKL_DSP_RUNNING;
+               return ret;
+       }
+
+       ret = cnl_dsp_enable_core(ctx, core_mask);
+       if (ret < 0) {
+               dev_err(ctx->dev, "enable dsp core %d failed: %d\n",
+                       core_id, ret);
+               goto err;
+       }
+
+       if (core_id == SKL_DSP_CORE0_ID) {
+               /* enable interrupt */
+               cnl_ipc_int_enable(ctx);
+               cnl_ipc_op_int_enable(ctx);
+               cnl->boot_complete = false;
+
+               ret = wait_event_timeout(cnl->boot_wait, cnl->boot_complete,
+                                        msecs_to_jiffies(SKL_IPC_BOOT_MSECS));
+               if (ret == 0) {
+                       dev_err(ctx->dev,
+                               "dsp boot timeout, status=%#x error=%#x\n",
+                               sst_dsp_shim_read(ctx, CNL_ADSP_FW_STATUS),
+                               sst_dsp_shim_read(ctx, CNL_ADSP_ERROR_CODE));
+                       goto err;
+               }
+       } else {
+               dx.core_mask = core_mask;
+               dx.dx_mask = core_mask;
+
+               ret = skl_ipc_set_dx(&cnl->ipc, CNL_INSTANCE_ID,
+                                    CNL_BASE_FW_MODULE_ID, &dx);
+               if (ret < 0) {
+                       dev_err(ctx->dev, "set_dx failed, core: %d ret: %d\n",
+                               core_id, ret);
+                       goto err;
+               }
+       }
+       cnl->cores.state[core_id] = SKL_DSP_RUNNING;
+
+       return 0;
+err:
+       cnl_dsp_disable_core(ctx, core_mask);
+
+       return ret;
+}
+
+static int cnl_set_dsp_D3(struct sst_dsp *ctx, unsigned int core_id)
+{
+       struct skl_sst *cnl = ctx->thread_context;
+       unsigned int core_mask = SKL_DSP_CORE_MASK(core_id);
+       struct skl_ipc_dxstate_info dx;
+       int ret;
+
+       dx.core_mask = core_mask;
+       dx.dx_mask = SKL_IPC_D3_MASK;
+
+       ret = skl_ipc_set_dx(&cnl->ipc, CNL_INSTANCE_ID,
+                            CNL_BASE_FW_MODULE_ID, &dx);
+       if (ret < 0) {
+               dev_err(ctx->dev,
+                       "dsp core %d to d3 failed; continue reset\n",
+                       core_id);
+               cnl->fw_loaded = false;
+       }
+
+       /* disable interrupts if core 0 */
+       if (core_id == SKL_DSP_CORE0_ID) {
+               skl_ipc_op_int_disable(ctx);
+               skl_ipc_int_disable(ctx);
+       }
+
+       ret = cnl_dsp_disable_core(ctx, core_mask);
+       if (ret < 0) {
+               dev_err(ctx->dev, "disable dsp core %d failed: %d\n",
+                       core_id, ret);
+               return ret;
+       }
+
+       cnl->cores.state[core_id] = SKL_DSP_RESET;
+
+       return ret;
+}
+
+static unsigned int cnl_get_errno(struct sst_dsp *ctx)
+{
+       return sst_dsp_shim_read(ctx, CNL_ADSP_ERROR_CODE);
+}
+
+static struct skl_dsp_fw_ops cnl_fw_ops = {
+       .set_state_D0 = cnl_set_dsp_D0,
+       .set_state_D3 = cnl_set_dsp_D3,
+       .load_fw = cnl_load_base_firmware,
+       .get_fw_errcode = cnl_get_errno,
+};
+
+static struct sst_ops cnl_ops = {
+       .irq_handler = cnl_dsp_sst_interrupt,
+       .write = sst_shim32_write,
+       .read = sst_shim32_read,
+       .ram_read = sst_memcpy_fromio_32,
+       .ram_write = sst_memcpy_toio_32,
+       .free = cnl_dsp_free,
+};
+
+#define CNL_IPC_GLB_NOTIFY_RSP_SHIFT   29
+#define CNL_IPC_GLB_NOTIFY_RSP_MASK    0x1
+#define CNL_IPC_GLB_NOTIFY_RSP_TYPE(x) (((x) >> CNL_IPC_GLB_NOTIFY_RSP_SHIFT) \
+                                       & CNL_IPC_GLB_NOTIFY_RSP_MASK)
+
+static irqreturn_t cnl_dsp_irq_thread_handler(int irq, void *context)
+{
+       struct sst_dsp *dsp = context;
+       struct skl_sst *cnl = sst_dsp_get_thread_context(dsp);
+       struct sst_generic_ipc *ipc = &cnl->ipc;
+       struct skl_ipc_header header = {0};
+       u32 hipcida, hipctdr, hipctdd;
+       int ipc_irq = 0;
+
+       /* here we handle ipc interrupts only */
+       if (!(dsp->intr_status & CNL_ADSPIS_IPC))
+               return IRQ_NONE;
+
+       hipcida = sst_dsp_shim_read_unlocked(dsp, CNL_ADSP_REG_HIPCIDA);
+       hipctdr = sst_dsp_shim_read_unlocked(dsp, CNL_ADSP_REG_HIPCTDR);
+
+       /* reply message from dsp */
+       if (hipcida & CNL_ADSP_REG_HIPCIDA_DONE) {
+               sst_dsp_shim_update_bits(dsp, CNL_ADSP_REG_HIPCCTL,
+                       CNL_ADSP_REG_HIPCCTL_DONE, 0);
+
+               /* clear done bit - tell dsp operation is complete */
+               sst_dsp_shim_update_bits_forced(dsp, CNL_ADSP_REG_HIPCIDA,
+                       CNL_ADSP_REG_HIPCIDA_DONE, CNL_ADSP_REG_HIPCIDA_DONE);
+
+               ipc_irq = 1;
+
+               /* unmask done interrupt */
+               sst_dsp_shim_update_bits(dsp, CNL_ADSP_REG_HIPCCTL,
+                       CNL_ADSP_REG_HIPCCTL_DONE, CNL_ADSP_REG_HIPCCTL_DONE);
+       }
+
+       /* new message from dsp */
+       if (hipctdr & CNL_ADSP_REG_HIPCTDR_BUSY) {
+               hipctdd = sst_dsp_shim_read_unlocked(dsp, CNL_ADSP_REG_HIPCTDD);
+               header.primary = hipctdr;
+               header.extension = hipctdd;
+               dev_dbg(dsp->dev, "IPC irq: Firmware respond primary:%x",
+                                               header.primary);
+               dev_dbg(dsp->dev, "IPC irq: Firmware respond extension:%x",
+                                               header.extension);
+
+               if (CNL_IPC_GLB_NOTIFY_RSP_TYPE(header.primary)) {
+                       /* Handle Immediate reply from DSP Core */
+                       skl_ipc_process_reply(ipc, header);
+               } else {
+                       dev_dbg(dsp->dev, "IPC irq: Notification from firmware\n");
+                       skl_ipc_process_notification(ipc, header);
+               }
+               /* clear busy interrupt */
+               sst_dsp_shim_update_bits_forced(dsp, CNL_ADSP_REG_HIPCTDR,
+                       CNL_ADSP_REG_HIPCTDR_BUSY, CNL_ADSP_REG_HIPCTDR_BUSY);
+
+               /* set done bit to ack dsp */
+               sst_dsp_shim_update_bits_forced(dsp, CNL_ADSP_REG_HIPCTDA,
+                       CNL_ADSP_REG_HIPCTDA_DONE, CNL_ADSP_REG_HIPCTDA_DONE);
+               ipc_irq = 1;
+       }
+
+       if (ipc_irq == 0)
+               return IRQ_NONE;
+
+       cnl_ipc_int_enable(dsp);
+
+       /* continue to send any remaining messages */
+       schedule_work(&ipc->kwork);
+
+       return IRQ_HANDLED;
+}
+
+static struct sst_dsp_device cnl_dev = {
+       .thread = cnl_dsp_irq_thread_handler,
+       .ops = &cnl_ops,
+};
+
+static void cnl_ipc_tx_msg(struct sst_generic_ipc *ipc, struct ipc_message *msg)
+{
+       struct skl_ipc_header *header = (struct skl_ipc_header *)(&msg->header);
+
+       if (msg->tx_size)
+               sst_dsp_outbox_write(ipc->dsp, msg->tx_data, msg->tx_size);
+       sst_dsp_shim_write_unlocked(ipc->dsp, CNL_ADSP_REG_HIPCIDD,
+                                   header->extension);
+       sst_dsp_shim_write_unlocked(ipc->dsp, CNL_ADSP_REG_HIPCIDR,
+                               header->primary | CNL_ADSP_REG_HIPCIDR_BUSY);
+}
+
+static bool cnl_ipc_is_dsp_busy(struct sst_dsp *dsp)
+{
+       u32 hipcidr;
+
+       hipcidr = sst_dsp_shim_read_unlocked(dsp, CNL_ADSP_REG_HIPCIDR);
+
+       return (hipcidr & CNL_ADSP_REG_HIPCIDR_BUSY);
+}
+
+static int cnl_ipc_init(struct device *dev, struct skl_sst *cnl)
+{
+       struct sst_generic_ipc *ipc;
+       int err;
+
+       ipc = &cnl->ipc;
+       ipc->dsp = cnl->dsp;
+       ipc->dev = dev;
+
+       ipc->tx_data_max_size = CNL_ADSP_W1_SZ;
+       ipc->rx_data_max_size = CNL_ADSP_W0_UP_SZ;
+
+       err = sst_ipc_init(ipc);
+       if (err)
+               return err;
+
+       /*
+        * overriding tx_msg and is_dsp_busy since
+        * ipc registers are different for cnl
+        */
+       ipc->ops.tx_msg = cnl_ipc_tx_msg;
+       ipc->ops.tx_data_copy = skl_ipc_tx_data_copy;
+       ipc->ops.is_dsp_busy = cnl_ipc_is_dsp_busy;
+
+       return 0;
+}
+
+int cnl_sst_dsp_init(struct device *dev, void __iomem *mmio_base, int irq,
+                    const char *fw_name, struct skl_dsp_loader_ops dsp_ops,
+                    struct skl_sst **dsp)
+{
+       struct skl_sst *cnl;
+       struct sst_dsp *sst;
+       int ret;
+
+       ret = skl_sst_ctx_init(dev, irq, fw_name, dsp_ops, dsp, &cnl_dev);
+       if (ret < 0) {
+               dev_err(dev, "%s: no device\n", __func__);
+               return ret;
+       }
+
+       cnl = *dsp;
+       sst = cnl->dsp;
+       sst->fw_ops = cnl_fw_ops;
+       sst->addr.lpe = mmio_base;
+       sst->addr.shim = mmio_base;
+       sst->addr.sram0_base = CNL_ADSP_SRAM0_BASE;
+       sst->addr.sram1_base = CNL_ADSP_SRAM1_BASE;
+       sst->addr.w0_stat_sz = CNL_ADSP_W0_STAT_SZ;
+       sst->addr.w0_up_sz = CNL_ADSP_W0_UP_SZ;
+
+       sst_dsp_mailbox_init(sst, (CNL_ADSP_SRAM0_BASE + CNL_ADSP_W0_STAT_SZ),
+                            CNL_ADSP_W0_UP_SZ, CNL_ADSP_SRAM1_BASE,
+                            CNL_ADSP_W1_SZ);
+
+       ret = cnl_ipc_init(dev, cnl);
+       if (ret)
+               return ret;
+
+       cnl->boot_complete = false;
+       init_waitqueue_head(&cnl->boot_wait);
+
+       return 0;
+}
+EXPORT_SYMBOL_GPL(cnl_sst_dsp_init);
+
+int cnl_sst_init_fw(struct device *dev, struct skl_sst *ctx)
+{
+       int ret;
+       struct sst_dsp *sst = ctx->dsp;
+
+       ret = ctx->dsp->fw_ops.load_fw(sst);
+       if (ret < 0) {
+               dev_err(dev, "load base fw failed: %d", ret);
+               return ret;
+       }
+
+       skl_dsp_init_core_state(sst);
+
+       ctx->is_first_boot = false;
+
+       return 0;
+}
+EXPORT_SYMBOL_GPL(cnl_sst_init_fw);
+
+void cnl_sst_dsp_cleanup(struct device *dev, struct skl_sst *ctx)
+{
+       if (ctx->dsp->fw)
+               release_firmware(ctx->dsp->fw);
+
+       skl_freeup_uuid_list(ctx);
+       cnl_ipc_free(&ctx->ipc);
+
+       ctx->dsp->ops->free(ctx->dsp);
+}
+EXPORT_SYMBOL_GPL(cnl_sst_dsp_cleanup);
+
+MODULE_LICENSE("GPL v2");
+MODULE_DESCRIPTION("Intel Cannonlake IPC driver");