1 /*
2 * SPDX-FileCopyrightText: Copyright (c)2022 NVIDIA CORPORATION & AFFILIATES. All rights reserved.
3 * SPDX-License-Identifier: MIT
4 *
5 * Permission is hereby granted, free of charge, to any person obtaining a
6 * copy of this software and associated documentation files (the "Software"),
7 * to deal in the Software without restriction, including without limitation
8 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
9 * and/or sell copies of the Software, and to permit persons to whom the
10 * Software is furnished to do so, subject to the following conditions:
11 *
12 * The above copyright notice and this permission notice shall be included in
13 * all copies or substantial portions of the Software.
14 *
15 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
16 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
17 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
18 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
19 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
20 * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
21 * DEALINGS IN THE SOFTWARE.
22 */
23
24 /******************************************************************************
25 *
26 * VblankCallback Module
27 * This file contains functions managing the vblank callback.
28 *
29 ******************************************************************************/
30
31 #include "gpu/disp/vblank_callback/vblank_callback.h"
32 #include "os/os.h"
33 #include "gpu/disp/kern_disp.h"
34 #include "gpu/disp/head/kernel_head.h"
35
36 static NV_STATUS
_vblankCallback(OBJGPU * pGpu,void * pObject,NvU32 Parm1,NvU32 Parm2,NV_STATUS rmStatus)37 _vblankCallback
38 (
39 OBJGPU *pGpu,
40 void *pObject,
41 NvU32 Parm1,
42 NvU32 Parm2,
43 NV_STATUS rmStatus
44 )
45 {
46 VblankCallback *pVblankCallback = (VblankCallback *)pObject;
47 if (pVblankCallback->CallBack.bIsVblankNotifyEnable)
48 {
49 pVblankCallback->pProc(pVblankCallback->pParm1, pVblankCallback->pParm2);
50 }
51 return NV_OK;
52 }
53
54 NV_STATUS
vblcbConstruct_IMPL(VblankCallback * pVblankCallback,CALL_CONTEXT * pCallContext,RS_RES_ALLOC_PARAMS_INTERNAL * pParams)55 vblcbConstruct_IMPL
56 (
57 VblankCallback *pVblankCallback,
58 CALL_CONTEXT *pCallContext,
59 RS_RES_ALLOC_PARAMS_INTERNAL *pParams
60 )
61 {
62 OBJGPU *pGpu = GPU_RES_GET_GPU(pVblankCallback);
63 KernelDisplay *pKernelDisplay = GPU_GET_KERNEL_DISPLAY(pGpu);
64 KernelHead *pKernelHead = NULL;
65 NV_STATUS status = NV_OK;
66 NV_VBLANK_CALLBACK_ALLOCATION_PARAMETERS *pAllocParams = pParams->pAllocParams;
67
68 if (pKernelDisplay == NULL)
69 {
70 return NV_ERR_NOT_SUPPORTED;
71 }
72
73 pKernelHead = KDISP_GET_HEAD(pKernelDisplay, pAllocParams->LogicalHead);
74
75 if (pKernelHead == NULL)
76 {
77 return NV_ERR_INVALID_ARGUMENT;
78 }
79
80 pVblankCallback->LogicalHead = pAllocParams->LogicalHead;
81 pVblankCallback->pProc = pAllocParams->pProc;
82 pVblankCallback->pParm1 = pAllocParams->pParm1;
83 pVblankCallback->pParm2 = pAllocParams->pParm2;
84 pVblankCallback->CallBack.Flags = VBLANK_CALLBACK_FLAG_LOW_LATENCY | VBLANK_CALLBACK_FLAG_PERSISTENT | VBLANK_CALLBACK_FLAG_SPECIFIED_VBLANK_NEXT;
85 pVblankCallback->CallBack.Proc = _vblankCallback;
86 pVblankCallback->CallBack.pObject = pVblankCallback;
87 pVblankCallback->CallBack.bObjectIsChannelDescendant = NV_FALSE;
88 pVblankCallback->CallBack.Param1 = 0;
89 pVblankCallback->CallBack.Param2 = 0;
90 pVblankCallback->CallBack.VBlankCount = 0;
91 pVblankCallback->CallBack.VBlankOffset = 0;
92 pVblankCallback->CallBack.TimeStamp = 0;
93 pVblankCallback->CallBack.MC_CallbackFlag = 0;
94 pVblankCallback->CallBack.Status = NV_OK;
95 pVblankCallback->CallBack.bIsVblankNotifyEnable = NV_TRUE;
96 pVblankCallback->CallBack.Next = NULL;
97
98 kheadAddVblankCallback(pGpu, pKernelHead, &pVblankCallback->CallBack);
99 status = osSetupVBlank(pGpu, pAllocParams->pProc, pAllocParams->pParm1, pAllocParams->pParm2, pAllocParams->LogicalHead, &pVblankCallback->CallBack);
100
101 if (status != NV_OK)
102 {
103 kheadDeleteVblankCallback(pGpu, pKernelHead, &pVblankCallback->CallBack);
104 }
105
106 return status;
107 }
108
109 void
vblcbDestruct_IMPL(VblankCallback * pVblankCallback)110 vblcbDestruct_IMPL
111 (
112 VblankCallback *pVblankCallback
113 )
114 {
115 OBJGPU *pGpu = GPU_RES_GET_GPU(pVblankCallback);
116 KernelDisplay *pKernelDisplay = GPU_GET_KERNEL_DISPLAY(pGpu);
117 KernelHead *pKernelHead = KDISP_GET_HEAD(pKernelDisplay, pVblankCallback->LogicalHead);
118
119 osSetupVBlank(pGpu, NULL, NULL, NULL, pVblankCallback->LogicalHead, NULL);
120 kheadDeleteVblankCallback(pGpu, pKernelHead, &pVblankCallback->CallBack);
121 }
122
123 NV_STATUS
vblcbCtrlSetVBlankNotification_IMPL(VblankCallback * pVblankCallback,NV9010_CTRL_CMD_SET_VBLANK_NOTIFICATION_PARAMS * pParams)124 vblcbCtrlSetVBlankNotification_IMPL
125 (
126 VblankCallback *pVblankCallback,
127 NV9010_CTRL_CMD_SET_VBLANK_NOTIFICATION_PARAMS *pParams
128 )
129 {
130 OBJGPU *pGpu = GPU_RES_GET_GPU(pVblankCallback);
131 KernelDisplay *pKernelDisplay = GPU_GET_KERNEL_DISPLAY(pGpu);
132 KernelHead *pKernelHead = KDISP_GET_HEAD(pKernelDisplay, pVblankCallback->LogicalHead);
133 NV_STATUS status = NV_ERR_INVALID_ARGUMENT;
134 NvBool enabled = NV_FALSE;
135 if (pVblankCallback->CallBack.Proc != NULL)
136 {
137 if (pParams->bSetVBlankNotifyEnable)
138 {
139 pVblankCallback->CallBack.bIsVblankNotifyEnable = NV_TRUE;
140
141 enabled = kheadReadVblankIntrEnable_HAL(pGpu, pKernelHead);
142 //
143 // We are assuming list is not empty as DD already done the registration for vsync
144 // So we can enable the _LAST_DATA in case if it is already disable.
145 //
146 if (!enabled)
147 {
148 kheadWriteVblankIntrState(pGpu, pKernelHead, NV_HEAD_VBLANK_INTR_ENABLED);
149 }
150 }
151 else
152 {
153 pVblankCallback->CallBack.bIsVblankNotifyEnable = NV_FALSE;
154 kheadPauseVblankCbNotifications(pGpu, pKernelHead, &pVblankCallback->CallBack);
155 }
156 status = NV_OK;
157 }
158 return status;
159 }
160
161