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