1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include "head.h"
25
26#include <core/client.h>
27
28#include <nvif/cl0046.h>
29#include <nvif/unpack.h>
30
31struct nvkm_head *
32nvkm_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
42int
43nvkm_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
65
66
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
80void
81nvkm_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
92int
93nvkm_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