mtk_mdp_vpu.c

  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Copyright (c) 2015-2016 MediaTek Inc.
  4 * Author: Houlong Wei <houlong.wei@mediatek.com>
  5 *         Ming Hsiu Tsai <minghsiu.tsai@mediatek.com>
  6 */
  7
  8#include "mtk_mdp_core.h"
  9#include "mtk_mdp_vpu.h"
 10#include "mtk_vpu.h"
 11
 12
 13static inline struct mtk_mdp_ctx *vpu_to_ctx(struct mtk_mdp_vpu *vpu)
 14{
 15	return container_of(vpu, struct mtk_mdp_ctx, vpu);
 16}
 17
 18static void mtk_mdp_vpu_handle_init_ack(const struct mdp_ipi_comm_ack *msg)
 19{
 20	struct mtk_mdp_vpu *vpu = (struct mtk_mdp_vpu *)
 21					(unsigned long)msg->ap_inst;
 22
 23	/* mapping VPU address to kernel virtual address */
 24	vpu->vsi = (struct mdp_process_vsi *)
 25			vpu_mapping_dm_addr(vpu->pdev, msg->vpu_inst_addr);
 26	vpu->inst_addr = msg->vpu_inst_addr;
 27}
 28
 29static void mtk_mdp_vpu_ipi_handler(void *data, unsigned int len,
 30				    void *priv)
 31{
 32	const struct mdp_ipi_comm_ack *msg = data;
 33	unsigned int msg_id = msg->msg_id;
 34	struct mtk_mdp_vpu *vpu = (struct mtk_mdp_vpu *)
 35					(unsigned long)msg->ap_inst;
 36	struct mtk_mdp_ctx *ctx;
 37
 38	vpu->failure = msg->status;
 39	if (!vpu->failure) {
 40		switch (msg_id) {
 41		case VPU_MDP_INIT_ACK:
 42			mtk_mdp_vpu_handle_init_ack(data);
 43			break;
 44		case VPU_MDP_DEINIT_ACK:
 45		case VPU_MDP_PROCESS_ACK:
 46			break;
 47		default:
 48			ctx = vpu_to_ctx(vpu);
 49			dev_err(&ctx->mdp_dev->pdev->dev,
 50				"handle unknown ipi msg:0x%x\n",
 51				msg_id);
 52			break;
 53		}
 54	} else {
 55		ctx = vpu_to_ctx(vpu);
 56		mtk_mdp_dbg(0, "[%d]:msg 0x%x, failure:%d", ctx->id,
 57			    msg_id, vpu->failure);
 58	}
 59}
 60
 61int mtk_mdp_vpu_register(struct platform_device *pdev)
 62{
 63	struct mtk_mdp_dev *mdp = platform_get_drvdata(pdev);
 64	int err;
 65
 66	err = vpu_ipi_register(mdp->vpu_dev, IPI_MDP,
 67			       mtk_mdp_vpu_ipi_handler, "mdp_vpu", NULL);
 68	if (err)
 69		dev_err(&mdp->pdev->dev,
 70			"vpu_ipi_registration fail status=%d\n", err);
 71
 72	return err;
 73}
 74
 75static int mtk_mdp_vpu_send_msg(void *msg, int len, struct mtk_mdp_vpu *vpu,
 76				int id)
 77{
 78	struct mtk_mdp_ctx *ctx = vpu_to_ctx(vpu);
 79	int err;
 80
 81	if (!vpu->pdev) {
 82		mtk_mdp_dbg(1, "[%d]:vpu pdev is NULL", ctx->id);
 83		return -EINVAL;
 84	}
 85
 86	mutex_lock(&ctx->mdp_dev->vpulock);
 87	err = vpu_ipi_send(vpu->pdev, (enum ipi_id)id, msg, len);
 88	if (err)
 89		dev_err(&ctx->mdp_dev->pdev->dev,
 90			"vpu_ipi_send fail status %d\n", err);
 91	mutex_unlock(&ctx->mdp_dev->vpulock);
 92
 93	return err;
 94}
 95
 96static int mtk_mdp_vpu_send_ap_ipi(struct mtk_mdp_vpu *vpu, uint32_t msg_id)
 97{
 98	int err;
 99	struct mdp_ipi_comm msg;
100
101	msg.msg_id = msg_id;
102	msg.ipi_id = IPI_MDP;
103	msg.vpu_inst_addr = vpu->inst_addr;
104	msg.ap_inst = (unsigned long)vpu;
105	err = mtk_mdp_vpu_send_msg((void *)&msg, sizeof(msg), vpu, IPI_MDP);
106	if (!err && vpu->failure)
107		err = -EINVAL;
108
109	return err;
110}
111
112int mtk_mdp_vpu_init(struct mtk_mdp_vpu *vpu)
113{
114	int err;
115	struct mdp_ipi_init msg;
116	struct mtk_mdp_ctx *ctx = vpu_to_ctx(vpu);
117
118	vpu->pdev = ctx->mdp_dev->vpu_dev;
119
120	msg.msg_id = AP_MDP_INIT;
121	msg.ipi_id = IPI_MDP;
122	msg.ap_inst = (unsigned long)vpu;
123	err = mtk_mdp_vpu_send_msg((void *)&msg, sizeof(msg), vpu, IPI_MDP);
124	if (!err && vpu->failure)
125		err = -EINVAL;
126
127	return err;
128}
129
130int mtk_mdp_vpu_deinit(struct mtk_mdp_vpu *vpu)
131{
132	return mtk_mdp_vpu_send_ap_ipi(vpu, AP_MDP_DEINIT);
133}
134
135int mtk_mdp_vpu_process(struct mtk_mdp_vpu *vpu)
136{
137	return mtk_mdp_vpu_send_ap_ipi(vpu, AP_MDP_PROCESS);
138}