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->heads, 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->heads);
103 HEAD_DBG(head, "ctor");
104 return 0;
105 }
106