162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci// 362306a36Sopenharmony_ci// Copyright(c) 2020 Intel Corporation. All rights reserved. 462306a36Sopenharmony_ci// 562306a36Sopenharmony_ci// Author: Cezary Rojewski <cezary.rojewski@intel.com> 662306a36Sopenharmony_ci// 762306a36Sopenharmony_ci 862306a36Sopenharmony_ci#include <linux/irqreturn.h> 962306a36Sopenharmony_ci#include "core.h" 1062306a36Sopenharmony_ci#include "messages.h" 1162306a36Sopenharmony_ci#include "registers.h" 1262306a36Sopenharmony_ci#include "trace.h" 1362306a36Sopenharmony_ci 1462306a36Sopenharmony_ci#define CATPT_IPC_TIMEOUT_MS 300 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_civoid catpt_ipc_init(struct catpt_ipc *ipc, struct device *dev) 1762306a36Sopenharmony_ci{ 1862306a36Sopenharmony_ci ipc->dev = dev; 1962306a36Sopenharmony_ci ipc->ready = false; 2062306a36Sopenharmony_ci ipc->default_timeout = CATPT_IPC_TIMEOUT_MS; 2162306a36Sopenharmony_ci init_completion(&ipc->done_completion); 2262306a36Sopenharmony_ci init_completion(&ipc->busy_completion); 2362306a36Sopenharmony_ci spin_lock_init(&ipc->lock); 2462306a36Sopenharmony_ci mutex_init(&ipc->mutex); 2562306a36Sopenharmony_ci} 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_cistatic int catpt_ipc_arm(struct catpt_ipc *ipc, struct catpt_fw_ready *config) 2862306a36Sopenharmony_ci{ 2962306a36Sopenharmony_ci /* 3062306a36Sopenharmony_ci * Both tx and rx are put into and received from outbox. Inbox is 3162306a36Sopenharmony_ci * only used for notifications where payload size is known upfront, 3262306a36Sopenharmony_ci * thus no separate buffer is allocated for it. 3362306a36Sopenharmony_ci */ 3462306a36Sopenharmony_ci ipc->rx.data = devm_kzalloc(ipc->dev, config->outbox_size, GFP_KERNEL); 3562306a36Sopenharmony_ci if (!ipc->rx.data) 3662306a36Sopenharmony_ci return -ENOMEM; 3762306a36Sopenharmony_ci 3862306a36Sopenharmony_ci memcpy(&ipc->config, config, sizeof(*config)); 3962306a36Sopenharmony_ci ipc->ready = true; 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_ci return 0; 4262306a36Sopenharmony_ci} 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_cistatic void catpt_ipc_msg_init(struct catpt_ipc *ipc, 4562306a36Sopenharmony_ci struct catpt_ipc_msg *reply) 4662306a36Sopenharmony_ci{ 4762306a36Sopenharmony_ci lockdep_assert_held(&ipc->lock); 4862306a36Sopenharmony_ci 4962306a36Sopenharmony_ci ipc->rx.header = 0; 5062306a36Sopenharmony_ci ipc->rx.size = reply ? reply->size : 0; 5162306a36Sopenharmony_ci reinit_completion(&ipc->done_completion); 5262306a36Sopenharmony_ci reinit_completion(&ipc->busy_completion); 5362306a36Sopenharmony_ci} 5462306a36Sopenharmony_ci 5562306a36Sopenharmony_cistatic void catpt_dsp_send_tx(struct catpt_dev *cdev, 5662306a36Sopenharmony_ci const struct catpt_ipc_msg *tx) 5762306a36Sopenharmony_ci{ 5862306a36Sopenharmony_ci u32 header = tx->header | CATPT_IPCC_BUSY; 5962306a36Sopenharmony_ci 6062306a36Sopenharmony_ci trace_catpt_ipc_request(header); 6162306a36Sopenharmony_ci trace_catpt_ipc_payload(tx->data, tx->size); 6262306a36Sopenharmony_ci 6362306a36Sopenharmony_ci memcpy_toio(catpt_outbox_addr(cdev), tx->data, tx->size); 6462306a36Sopenharmony_ci catpt_writel_shim(cdev, IPCC, header); 6562306a36Sopenharmony_ci} 6662306a36Sopenharmony_ci 6762306a36Sopenharmony_cistatic int catpt_wait_msg_completion(struct catpt_dev *cdev, int timeout) 6862306a36Sopenharmony_ci{ 6962306a36Sopenharmony_ci struct catpt_ipc *ipc = &cdev->ipc; 7062306a36Sopenharmony_ci int ret; 7162306a36Sopenharmony_ci 7262306a36Sopenharmony_ci ret = wait_for_completion_timeout(&ipc->done_completion, 7362306a36Sopenharmony_ci msecs_to_jiffies(timeout)); 7462306a36Sopenharmony_ci if (!ret) 7562306a36Sopenharmony_ci return -ETIMEDOUT; 7662306a36Sopenharmony_ci if (ipc->rx.rsp.status != CATPT_REPLY_PENDING) 7762306a36Sopenharmony_ci return 0; 7862306a36Sopenharmony_ci 7962306a36Sopenharmony_ci /* wait for delayed reply */ 8062306a36Sopenharmony_ci ret = wait_for_completion_timeout(&ipc->busy_completion, 8162306a36Sopenharmony_ci msecs_to_jiffies(timeout)); 8262306a36Sopenharmony_ci return ret ? 0 : -ETIMEDOUT; 8362306a36Sopenharmony_ci} 8462306a36Sopenharmony_ci 8562306a36Sopenharmony_cistatic int catpt_dsp_do_send_msg(struct catpt_dev *cdev, 8662306a36Sopenharmony_ci struct catpt_ipc_msg request, 8762306a36Sopenharmony_ci struct catpt_ipc_msg *reply, int timeout) 8862306a36Sopenharmony_ci{ 8962306a36Sopenharmony_ci struct catpt_ipc *ipc = &cdev->ipc; 9062306a36Sopenharmony_ci unsigned long flags; 9162306a36Sopenharmony_ci int ret; 9262306a36Sopenharmony_ci 9362306a36Sopenharmony_ci if (!ipc->ready) 9462306a36Sopenharmony_ci return -EPERM; 9562306a36Sopenharmony_ci if (request.size > ipc->config.outbox_size || 9662306a36Sopenharmony_ci (reply && reply->size > ipc->config.outbox_size)) 9762306a36Sopenharmony_ci return -EINVAL; 9862306a36Sopenharmony_ci 9962306a36Sopenharmony_ci spin_lock_irqsave(&ipc->lock, flags); 10062306a36Sopenharmony_ci catpt_ipc_msg_init(ipc, reply); 10162306a36Sopenharmony_ci catpt_dsp_send_tx(cdev, &request); 10262306a36Sopenharmony_ci spin_unlock_irqrestore(&ipc->lock, flags); 10362306a36Sopenharmony_ci 10462306a36Sopenharmony_ci ret = catpt_wait_msg_completion(cdev, timeout); 10562306a36Sopenharmony_ci if (ret) { 10662306a36Sopenharmony_ci dev_crit(cdev->dev, "communication severed: %d, rebooting dsp..\n", 10762306a36Sopenharmony_ci ret); 10862306a36Sopenharmony_ci ipc->ready = false; 10962306a36Sopenharmony_ci /* TODO: attempt recovery */ 11062306a36Sopenharmony_ci return ret; 11162306a36Sopenharmony_ci } 11262306a36Sopenharmony_ci 11362306a36Sopenharmony_ci ret = ipc->rx.rsp.status; 11462306a36Sopenharmony_ci if (reply) { 11562306a36Sopenharmony_ci reply->header = ipc->rx.header; 11662306a36Sopenharmony_ci 11762306a36Sopenharmony_ci if (!ret && reply->data) 11862306a36Sopenharmony_ci memcpy(reply->data, ipc->rx.data, reply->size); 11962306a36Sopenharmony_ci } 12062306a36Sopenharmony_ci 12162306a36Sopenharmony_ci return ret; 12262306a36Sopenharmony_ci} 12362306a36Sopenharmony_ci 12462306a36Sopenharmony_ciint catpt_dsp_send_msg_timeout(struct catpt_dev *cdev, 12562306a36Sopenharmony_ci struct catpt_ipc_msg request, 12662306a36Sopenharmony_ci struct catpt_ipc_msg *reply, int timeout) 12762306a36Sopenharmony_ci{ 12862306a36Sopenharmony_ci struct catpt_ipc *ipc = &cdev->ipc; 12962306a36Sopenharmony_ci int ret; 13062306a36Sopenharmony_ci 13162306a36Sopenharmony_ci mutex_lock(&ipc->mutex); 13262306a36Sopenharmony_ci ret = catpt_dsp_do_send_msg(cdev, request, reply, timeout); 13362306a36Sopenharmony_ci mutex_unlock(&ipc->mutex); 13462306a36Sopenharmony_ci 13562306a36Sopenharmony_ci return ret; 13662306a36Sopenharmony_ci} 13762306a36Sopenharmony_ci 13862306a36Sopenharmony_ciint catpt_dsp_send_msg(struct catpt_dev *cdev, struct catpt_ipc_msg request, 13962306a36Sopenharmony_ci struct catpt_ipc_msg *reply) 14062306a36Sopenharmony_ci{ 14162306a36Sopenharmony_ci return catpt_dsp_send_msg_timeout(cdev, request, reply, 14262306a36Sopenharmony_ci cdev->ipc.default_timeout); 14362306a36Sopenharmony_ci} 14462306a36Sopenharmony_ci 14562306a36Sopenharmony_cistatic void 14662306a36Sopenharmony_cicatpt_dsp_notify_stream(struct catpt_dev *cdev, union catpt_notify_msg msg) 14762306a36Sopenharmony_ci{ 14862306a36Sopenharmony_ci struct catpt_stream_runtime *stream; 14962306a36Sopenharmony_ci struct catpt_notify_position pos; 15062306a36Sopenharmony_ci struct catpt_notify_glitch glitch; 15162306a36Sopenharmony_ci 15262306a36Sopenharmony_ci stream = catpt_stream_find(cdev, msg.stream_hw_id); 15362306a36Sopenharmony_ci if (!stream) { 15462306a36Sopenharmony_ci dev_warn(cdev->dev, "notify %d for non-existent stream %d\n", 15562306a36Sopenharmony_ci msg.notify_reason, msg.stream_hw_id); 15662306a36Sopenharmony_ci return; 15762306a36Sopenharmony_ci } 15862306a36Sopenharmony_ci 15962306a36Sopenharmony_ci switch (msg.notify_reason) { 16062306a36Sopenharmony_ci case CATPT_NOTIFY_POSITION_CHANGED: 16162306a36Sopenharmony_ci memcpy_fromio(&pos, catpt_inbox_addr(cdev), sizeof(pos)); 16262306a36Sopenharmony_ci trace_catpt_ipc_payload((u8 *)&pos, sizeof(pos)); 16362306a36Sopenharmony_ci 16462306a36Sopenharmony_ci catpt_stream_update_position(cdev, stream, &pos); 16562306a36Sopenharmony_ci break; 16662306a36Sopenharmony_ci 16762306a36Sopenharmony_ci case CATPT_NOTIFY_GLITCH_OCCURRED: 16862306a36Sopenharmony_ci memcpy_fromio(&glitch, catpt_inbox_addr(cdev), sizeof(glitch)); 16962306a36Sopenharmony_ci trace_catpt_ipc_payload((u8 *)&glitch, sizeof(glitch)); 17062306a36Sopenharmony_ci 17162306a36Sopenharmony_ci dev_warn(cdev->dev, "glitch %d at pos: 0x%08llx, wp: 0x%08x\n", 17262306a36Sopenharmony_ci glitch.type, glitch.presentation_pos, 17362306a36Sopenharmony_ci glitch.write_pos); 17462306a36Sopenharmony_ci break; 17562306a36Sopenharmony_ci 17662306a36Sopenharmony_ci default: 17762306a36Sopenharmony_ci dev_warn(cdev->dev, "unknown notification: %d received\n", 17862306a36Sopenharmony_ci msg.notify_reason); 17962306a36Sopenharmony_ci break; 18062306a36Sopenharmony_ci } 18162306a36Sopenharmony_ci} 18262306a36Sopenharmony_ci 18362306a36Sopenharmony_cistatic void catpt_dsp_copy_rx(struct catpt_dev *cdev, u32 header) 18462306a36Sopenharmony_ci{ 18562306a36Sopenharmony_ci struct catpt_ipc *ipc = &cdev->ipc; 18662306a36Sopenharmony_ci 18762306a36Sopenharmony_ci ipc->rx.header = header; 18862306a36Sopenharmony_ci if (ipc->rx.rsp.status != CATPT_REPLY_SUCCESS) 18962306a36Sopenharmony_ci return; 19062306a36Sopenharmony_ci 19162306a36Sopenharmony_ci memcpy_fromio(ipc->rx.data, catpt_outbox_addr(cdev), ipc->rx.size); 19262306a36Sopenharmony_ci trace_catpt_ipc_payload(ipc->rx.data, ipc->rx.size); 19362306a36Sopenharmony_ci} 19462306a36Sopenharmony_ci 19562306a36Sopenharmony_cistatic void catpt_dsp_process_response(struct catpt_dev *cdev, u32 header) 19662306a36Sopenharmony_ci{ 19762306a36Sopenharmony_ci union catpt_notify_msg msg = CATPT_MSG(header); 19862306a36Sopenharmony_ci struct catpt_ipc *ipc = &cdev->ipc; 19962306a36Sopenharmony_ci 20062306a36Sopenharmony_ci if (msg.fw_ready) { 20162306a36Sopenharmony_ci struct catpt_fw_ready config; 20262306a36Sopenharmony_ci /* to fit 32b header original address is shifted right by 3 */ 20362306a36Sopenharmony_ci u32 off = msg.mailbox_address << 3; 20462306a36Sopenharmony_ci 20562306a36Sopenharmony_ci memcpy_fromio(&config, cdev->lpe_ba + off, sizeof(config)); 20662306a36Sopenharmony_ci trace_catpt_ipc_payload((u8 *)&config, sizeof(config)); 20762306a36Sopenharmony_ci 20862306a36Sopenharmony_ci catpt_ipc_arm(ipc, &config); 20962306a36Sopenharmony_ci complete(&cdev->fw_ready); 21062306a36Sopenharmony_ci return; 21162306a36Sopenharmony_ci } 21262306a36Sopenharmony_ci 21362306a36Sopenharmony_ci switch (msg.global_msg_type) { 21462306a36Sopenharmony_ci case CATPT_GLB_REQUEST_CORE_DUMP: 21562306a36Sopenharmony_ci dev_err(cdev->dev, "ADSP device coredump received\n"); 21662306a36Sopenharmony_ci ipc->ready = false; 21762306a36Sopenharmony_ci catpt_coredump(cdev); 21862306a36Sopenharmony_ci /* TODO: attempt recovery */ 21962306a36Sopenharmony_ci break; 22062306a36Sopenharmony_ci 22162306a36Sopenharmony_ci case CATPT_GLB_STREAM_MESSAGE: 22262306a36Sopenharmony_ci switch (msg.stream_msg_type) { 22362306a36Sopenharmony_ci case CATPT_STRM_NOTIFICATION: 22462306a36Sopenharmony_ci catpt_dsp_notify_stream(cdev, msg); 22562306a36Sopenharmony_ci break; 22662306a36Sopenharmony_ci default: 22762306a36Sopenharmony_ci catpt_dsp_copy_rx(cdev, header); 22862306a36Sopenharmony_ci /* signal completion of delayed reply */ 22962306a36Sopenharmony_ci complete(&ipc->busy_completion); 23062306a36Sopenharmony_ci break; 23162306a36Sopenharmony_ci } 23262306a36Sopenharmony_ci break; 23362306a36Sopenharmony_ci 23462306a36Sopenharmony_ci default: 23562306a36Sopenharmony_ci dev_warn(cdev->dev, "unknown response: %d received\n", 23662306a36Sopenharmony_ci msg.global_msg_type); 23762306a36Sopenharmony_ci break; 23862306a36Sopenharmony_ci } 23962306a36Sopenharmony_ci} 24062306a36Sopenharmony_ci 24162306a36Sopenharmony_ciirqreturn_t catpt_dsp_irq_thread(int irq, void *dev_id) 24262306a36Sopenharmony_ci{ 24362306a36Sopenharmony_ci struct catpt_dev *cdev = dev_id; 24462306a36Sopenharmony_ci u32 ipcd; 24562306a36Sopenharmony_ci 24662306a36Sopenharmony_ci ipcd = catpt_readl_shim(cdev, IPCD); 24762306a36Sopenharmony_ci trace_catpt_ipc_notify(ipcd); 24862306a36Sopenharmony_ci 24962306a36Sopenharmony_ci /* ensure there is delayed reply or notification to process */ 25062306a36Sopenharmony_ci if (!(ipcd & CATPT_IPCD_BUSY)) 25162306a36Sopenharmony_ci return IRQ_NONE; 25262306a36Sopenharmony_ci 25362306a36Sopenharmony_ci catpt_dsp_process_response(cdev, ipcd); 25462306a36Sopenharmony_ci 25562306a36Sopenharmony_ci /* tell DSP processing is completed */ 25662306a36Sopenharmony_ci catpt_updatel_shim(cdev, IPCD, CATPT_IPCD_BUSY | CATPT_IPCD_DONE, 25762306a36Sopenharmony_ci CATPT_IPCD_DONE); 25862306a36Sopenharmony_ci /* unmask dsp BUSY interrupt */ 25962306a36Sopenharmony_ci catpt_updatel_shim(cdev, IMC, CATPT_IMC_IPCDB, 0); 26062306a36Sopenharmony_ci 26162306a36Sopenharmony_ci return IRQ_HANDLED; 26262306a36Sopenharmony_ci} 26362306a36Sopenharmony_ci 26462306a36Sopenharmony_ciirqreturn_t catpt_dsp_irq_handler(int irq, void *dev_id) 26562306a36Sopenharmony_ci{ 26662306a36Sopenharmony_ci struct catpt_dev *cdev = dev_id; 26762306a36Sopenharmony_ci irqreturn_t ret = IRQ_NONE; 26862306a36Sopenharmony_ci u32 isc, ipcc; 26962306a36Sopenharmony_ci 27062306a36Sopenharmony_ci isc = catpt_readl_shim(cdev, ISC); 27162306a36Sopenharmony_ci trace_catpt_irq(isc); 27262306a36Sopenharmony_ci 27362306a36Sopenharmony_ci /* immediate reply */ 27462306a36Sopenharmony_ci if (isc & CATPT_ISC_IPCCD) { 27562306a36Sopenharmony_ci /* mask host DONE interrupt */ 27662306a36Sopenharmony_ci catpt_updatel_shim(cdev, IMC, CATPT_IMC_IPCCD, CATPT_IMC_IPCCD); 27762306a36Sopenharmony_ci 27862306a36Sopenharmony_ci ipcc = catpt_readl_shim(cdev, IPCC); 27962306a36Sopenharmony_ci trace_catpt_ipc_reply(ipcc); 28062306a36Sopenharmony_ci catpt_dsp_copy_rx(cdev, ipcc); 28162306a36Sopenharmony_ci complete(&cdev->ipc.done_completion); 28262306a36Sopenharmony_ci 28362306a36Sopenharmony_ci /* tell DSP processing is completed */ 28462306a36Sopenharmony_ci catpt_updatel_shim(cdev, IPCC, CATPT_IPCC_DONE, 0); 28562306a36Sopenharmony_ci /* unmask host DONE interrupt */ 28662306a36Sopenharmony_ci catpt_updatel_shim(cdev, IMC, CATPT_IMC_IPCCD, 0); 28762306a36Sopenharmony_ci ret = IRQ_HANDLED; 28862306a36Sopenharmony_ci } 28962306a36Sopenharmony_ci 29062306a36Sopenharmony_ci /* delayed reply or notification */ 29162306a36Sopenharmony_ci if (isc & CATPT_ISC_IPCDB) { 29262306a36Sopenharmony_ci /* mask dsp BUSY interrupt */ 29362306a36Sopenharmony_ci catpt_updatel_shim(cdev, IMC, CATPT_IMC_IPCDB, CATPT_IMC_IPCDB); 29462306a36Sopenharmony_ci ret = IRQ_WAKE_THREAD; 29562306a36Sopenharmony_ci } 29662306a36Sopenharmony_ci 29762306a36Sopenharmony_ci return ret; 29862306a36Sopenharmony_ci} 299