1 /*
2  * Copyright 2017 Red Hat Inc.
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining a
5  * copy of this software and associated documentation files (the "Software"),
6  * to deal in the Software without restriction, including without limitation
7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8  * and/or sell copies of the Software, and to permit persons to whom the
9  * Software is furnished to do so, subject to the following conditions:
10  *
11  * The above copyright notice and this permission notice shall be included in
12  * all copies or substantial portions of the Software.
13  *
14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20  * OTHER DEALINGS IN THE SOFTWARE.
21  *
22  * Authors: Ben Skeggs <bskeggs@redhat.com>
23  */
24 #include "head.h"
25 
26 #include <core/client.h>
27 
28 #include <nvif/cl0046.h>
29 #include <nvif/unpack.h>
30 
31 struct nvkm_head *
nvkm_head_find(struct nvkm_disp * disp,int id)32 nvkm_head_find(struct nvkm_disp *disp, int id)
33 {
34 	struct nvkm_head *head;
35 	list_for_each_entry(head, &disp->head, head) {
36 		if (head->id == id)
37 			return head;
38 	}
39 	return NULL;
40 }
41 
42 int
nvkm_head_mthd_scanoutpos(struct nvkm_object * object,struct nvkm_head * head,void * data,u32 size)43 nvkm_head_mthd_scanoutpos(struct nvkm_object *object,
44 			  struct nvkm_head *head, void *data, u32 size)
45 {
46 	union {
47 		struct nv04_disp_scanoutpos_v0 v0;
48 	} *args = data;
49 	int ret = -ENOSYS;
50 
51 	nvif_ioctl(object, "head scanoutpos size %d\n", size);
52 	if (!(ret = nvif_unpack(ret, &data, &size, args->v0, 0, 0, false))) {
53 		nvif_ioctl(object, "head scanoutpos vers %d\n",
54 			   args->v0.version);
55 
56 		head->func->state(head, &head->arm);
57 		args->v0.vtotal  = head->arm.vtotal;
58 		args->v0.vblanks = head->arm.vblanks;
59 		args->v0.vblanke = head->arm.vblanke;
60 		args->v0.htotal  = head->arm.htotal;
61 		args->v0.hblanks = head->arm.hblanks;
62 		args->v0.hblanke = head->arm.hblanke;
63 
64 		/* We don't support reading htotal/vtotal on pre-NV50 VGA,
65 		 * so we have to give up and trigger the timestamping
66 		 * fallback in the drm core.
67 		 */
68 		if (!args->v0.vtotal || !args->v0.htotal)
69 			return -ENOTSUPP;
70 
71 		args->v0.time[0] = ktime_to_ns(ktime_get());
72 		head->func->rgpos(head, &args->v0.hline, &args->v0.vline);
73 		args->v0.time[1] = ktime_to_ns(ktime_get());
74 	} else
75 		return ret;
76 
77 	return 0;
78 }
79 
80 void
nvkm_head_del(struct nvkm_head ** phead)81 nvkm_head_del(struct nvkm_head **phead)
82 {
83 	struct nvkm_head *head = *phead;
84 	if (head) {
85 		HEAD_DBG(head, "dtor");
86 		list_del(&head->head);
87 		kfree(*phead);
88 		*phead = NULL;
89 	}
90 }
91 
92 int
nvkm_head_new_(const struct nvkm_head_func * func,struct nvkm_disp * disp,int id)93 nvkm_head_new_(const struct nvkm_head_func *func,
94 	       struct nvkm_disp *disp, int id)
95 {
96 	struct nvkm_head *head;
97 	if (!(head = kzalloc(sizeof(*head), GFP_KERNEL)))
98 		return -ENOMEM;
99 	head->func = func;
100 	head->disp = disp;
101 	head->id = id;
102 	list_add_tail(&head->head, &disp->head);
103 	HEAD_DBG(head, "ctor");
104 	return 0;
105 }
106