drm/amdgpu/mes12: add mes mapping legacy queue support

Add mes12 map legacy queue packet submission.

Signed-off-by: Jack Xiao <Jack.Xiao@amd.com>
Reviewed-by: Hawking Zhang <Hawking.Zhang@amd.com>
Signed-off-by: Alex Deucher <alexander.deucher@amd.com>

diff --git a/drivers/gpu/drm/amd/amdgpu/mes_v12_0.c b/drivers/gpu/drm/amd/amdgpu/mes_v12_0.c
index b60ed178114e98f1991a5d3a7105283948c86c94..132868b8db198611f5540d412f482f9248ef1fcc 100644 (file)
--- a/drivers/gpu/drm/amd/amdgpu/mes_v12_0.c
+++ b/drivers/gpu/drm/amd/amdgpu/mes_v12_0.c
@@ -230,6 +230,31 @@ static int mes_v12_0_remove_hw_queue(struct amdgpu_mes *mes,
                        offsetof(union MESAPI__REMOVE_QUEUE, api_status));
 }
 
+static int mes_v12_0_map_legacy_queue(struct amdgpu_mes *mes,
+                                     struct mes_map_legacy_queue_input *input)
+{
+       union MESAPI__ADD_QUEUE mes_add_queue_pkt;
+
+       memset(&mes_add_queue_pkt, 0, sizeof(mes_add_queue_pkt));
+
+       mes_add_queue_pkt.header.type = MES_API_TYPE_SCHEDULER;
+       mes_add_queue_pkt.header.opcode = MES_SCH_API_ADD_QUEUE;
+       mes_add_queue_pkt.header.dwsize = API_FRAME_SIZE_IN_DWORDS;
+
+       mes_add_queue_pkt.pipe_id = input->pipe_id;
+       mes_add_queue_pkt.queue_id = input->queue_id;
+       mes_add_queue_pkt.doorbell_offset = input->doorbell_offset;
+       mes_add_queue_pkt.mqd_addr = input->mqd_addr;
+       mes_add_queue_pkt.wptr_addr = input->wptr_addr;
+       mes_add_queue_pkt.queue_type =
+               convert_to_mes_queue_type(input->queue_type);
+       mes_add_queue_pkt.map_legacy_kq = 1;
+
+       return mes_v12_0_submit_pkt_and_poll_completion(mes,
+                       &mes_add_queue_pkt, sizeof(mes_add_queue_pkt),
+                       offsetof(union MESAPI__ADD_QUEUE, api_status));
+}
+
 static int mes_v12_0_unmap_legacy_queue(struct amdgpu_mes *mes,
                        struct mes_unmap_legacy_queue_input *input)
 {
@@ -493,6 +518,7 @@ static void mes_v12_0_enable_unmapped_doorbell_handling(
 static const struct amdgpu_mes_funcs mes_v12_0_funcs = {
        .add_hw_queue = mes_v12_0_add_hw_queue,
        .remove_hw_queue = mes_v12_0_remove_hw_queue,
+       .map_legacy_queue = mes_v12_0_map_legacy_queue,
        .unmap_legacy_queue = mes_v12_0_unmap_legacy_queue,
        .suspend_gang = mes_v12_0_suspend_gang,
        .resume_gang = mes_v12_0_resume_gang,