1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include "head.h"
23#include "core.h"
24
25void
26head907d_or(struct nv50_head *head, struct nv50_head_atom *asyh)
27{
28 struct nv50_dmac *core = &nv50_disp(head->base.base.dev)->core->chan;
29 u32 *push;
30 if ((push = evo_wait(core, 3))) {
31 evo_mthd(push, 0x0404 + (head->base.index * 0x300), 2);
32 evo_data(push, 0x00000001 | asyh->or.depth << 6 |
33 asyh->or.nvsync << 4 |
34 asyh->or.nhsync << 3);
35 evo_data(push, 0x31ec6000 | head->base.index << 25 |
36 asyh->mode.interlace);
37 evo_kick(push, core);
38 }
39}
40
41void
42head907d_procamp(struct nv50_head *head, struct nv50_head_atom *asyh)
43{
44 struct nv50_dmac *core = &nv50_disp(head->base.base.dev)->core->chan;
45 u32 *push;
46 if ((push = evo_wait(core, 2))) {
47 evo_mthd(push, 0x0498 + (head->base.index * 0x300), 1);
48 evo_data(push, asyh->procamp.sat.sin << 20 |
49 asyh->procamp.sat.cos << 8);
50 evo_kick(push, core);
51 }
52}
53
54static void
55head907d_dither(struct nv50_head *head, struct nv50_head_atom *asyh)
56{
57 struct nv50_dmac *core = &nv50_disp(head->base.base.dev)->core->chan;
58 u32 *push;
59 if ((push = evo_wait(core, 2))) {
60 evo_mthd(push, 0x0490 + (head->base.index * 0x0300), 1);
61 evo_data(push, asyh->dither.mode << 3 |
62 asyh->dither.bits << 1 |
63 asyh->dither.enable);
64 evo_kick(push, core);
65 }
66}
67
68void
69head907d_ovly(struct nv50_head *head, struct nv50_head_atom *asyh)
70{
71 struct nv50_dmac *core = &nv50_disp(head->base.base.dev)->core->chan;
72 u32 bounds = 0;
73 u32 *push;
74
75 if (asyh->ovly.cpp) {
76 switch (asyh->ovly.cpp) {
77 case 8: bounds |= 0x00000500; break;
78 case 4: bounds |= 0x00000300; break;
79 case 2: bounds |= 0x00000100; break;
80 default:
81 WARN_ON(1);
82 break;
83 }
84 bounds |= 0x00000001;
85 } else {
86 bounds |= 0x00000100;
87 }
88
89 if ((push = evo_wait(core, 2))) {
90 evo_mthd(push, 0x04d4 + head->base.index * 0x300, 1);
91 evo_data(push, bounds);
92 evo_kick(push, core);
93 }
94}
95
96static void
97head907d_base(struct nv50_head *head, struct nv50_head_atom *asyh)
98{
99 struct nv50_dmac *core = &nv50_disp(head->base.base.dev)->core->chan;
100 u32 bounds = 0;
101 u32 *push;
102
103 if (asyh->base.cpp) {
104 switch (asyh->base.cpp) {
105 case 8: bounds |= 0x00000500; break;
106 case 4: bounds |= 0x00000300; break;
107 case 2: bounds |= 0x00000100; break;
108 case 1: bounds |= 0x00000000; break;
109 default:
110 WARN_ON(1);
111 break;
112 }
113 bounds |= 0x00000001;
114 }
115
116 if ((push = evo_wait(core, 2))) {
117 evo_mthd(push, 0x04d0 + head->base.index * 0x300, 1);
118 evo_data(push, bounds);
119 evo_kick(push, core);
120 }
121}
122
123void
124head907d_curs_clr(struct nv50_head *head)
125{
126 struct nv50_dmac *core = &nv50_disp(head->base.base.dev)->core->chan;
127 u32 *push;
128 if ((push = evo_wait(core, 4))) {
129 evo_mthd(push, 0x0480 + head->base.index * 0x300, 1);
130 evo_data(push, 0x05000000);
131 evo_mthd(push, 0x048c + head->base.index * 0x300, 1);
132 evo_data(push, 0x00000000);
133 evo_kick(push, core);
134 }
135}
136
137void
138head907d_curs_set(struct nv50_head *head, struct nv50_head_atom *asyh)
139{
140 struct nv50_dmac *core = &nv50_disp(head->base.base.dev)->core->chan;
141 u32 *push;
142 if ((push = evo_wait(core, 5))) {
143 evo_mthd(push, 0x0480 + head->base.index * 0x300, 2);
144 evo_data(push, 0x80000000 | asyh->curs.layout << 26 |
145 asyh->curs.format << 24);
146 evo_data(push, asyh->curs.offset >> 8);
147 evo_mthd(push, 0x048c + head->base.index * 0x300, 1);
148 evo_data(push, asyh->curs.handle);
149 evo_kick(push, core);
150 }
151}
152
153void
154head907d_core_clr(struct nv50_head *head)
155{
156 struct nv50_dmac *core = &nv50_disp(head->base.base.dev)->core->chan;
157 u32 *push;
158 if ((push = evo_wait(core, 2))) {
159 evo_mthd(push, 0x0474 + head->base.index * 0x300, 1);
160 evo_data(push, 0x00000000);
161 evo_kick(push, core);
162 }
163}
164
165void
166head907d_core_set(struct nv50_head *head, struct nv50_head_atom *asyh)
167{
168 struct nv50_dmac *core = &nv50_disp(head->base.base.dev)->core->chan;
169 u32 *push;
170 if ((push = evo_wait(core, 9))) {
171 evo_mthd(push, 0x0460 + head->base.index * 0x300, 1);
172 evo_data(push, asyh->core.offset >> 8);
173 evo_mthd(push, 0x0468 + head->base.index * 0x300, 4);
174 evo_data(push, asyh->core.h << 16 | asyh->core.w);
175 evo_data(push, asyh->core.layout << 24 |
176 (asyh->core.pitch >> 8) << 8 |
177 asyh->core.blocks << 8 |
178 asyh->core.blockh);
179 evo_data(push, asyh->core.format << 8);
180 evo_data(push, asyh->core.handle);
181 evo_mthd(push, 0x04b0 + head->base.index * 0x300, 1);
182 evo_data(push, asyh->core.y << 16 | asyh->core.x);
183 evo_kick(push, core);
184 }
185}
186
187void
188head907d_olut_clr(struct nv50_head *head)
189{
190 struct nv50_dmac *core = &nv50_disp(head->base.base.dev)->core->chan;
191 u32 *push;
192 if ((push = evo_wait(core, 4))) {
193 evo_mthd(push, 0x0448 + (head->base.index * 0x300), 1);
194 evo_data(push, 0x00000000);
195 evo_mthd(push, 0x045c + (head->base.index * 0x300), 1);
196 evo_data(push, 0x00000000);
197 evo_kick(push, core);
198 }
199}
200
201void
202head907d_olut_set(struct nv50_head *head, struct nv50_head_atom *asyh)
203{
204 struct nv50_dmac *core = &nv50_disp(head->base.base.dev)->core->chan;
205 u32 *push;
206 if ((push = evo_wait(core, 5))) {
207 evo_mthd(push, 0x0448 + (head->base.index * 0x300), 2);
208 evo_data(push, 0x80000000 | asyh->olut.mode << 24);
209 evo_data(push, asyh->olut.offset >> 8);
210 evo_mthd(push, 0x045c + (head->base.index * 0x300), 1);
211 evo_data(push, asyh->olut.handle);
212 evo_kick(push, core);
213 }
214}
215
216void
217head907d_olut_load(struct drm_color_lut *in, int size, void __iomem *mem)
218{
219 for (; size--; in++, mem += 8) {
220 writew(drm_color_lut_extract(in-> red, 14) + 0x6000, mem + 0);
221 writew(drm_color_lut_extract(in->green, 14) + 0x6000, mem + 2);
222 writew(drm_color_lut_extract(in-> blue, 14) + 0x6000, mem + 4);
223 }
224
225
226
227
228 writew(readw(mem - 8), mem + 0);
229 writew(readw(mem - 6), mem + 2);
230 writew(readw(mem - 4), mem + 4);
231}
232
233void
234head907d_olut(struct nv50_head *head, struct nv50_head_atom *asyh)
235{
236 asyh->olut.mode = 7;
237 asyh->olut.load = head907d_olut_load;
238}
239
240void
241head907d_mode(struct nv50_head *head, struct nv50_head_atom *asyh)
242{
243 struct nv50_dmac *core = &nv50_disp(head->base.base.dev)->core->chan;
244 struct nv50_head_mode *m = &asyh->mode;
245 u32 *push;
246 if ((push = evo_wait(core, 14))) {
247 evo_mthd(push, 0x0410 + (head->base.index * 0x300), 6);
248 evo_data(push, 0x00000000);
249 evo_data(push, m->v.active << 16 | m->h.active );
250 evo_data(push, m->v.synce << 16 | m->h.synce );
251 evo_data(push, m->v.blanke << 16 | m->h.blanke );
252 evo_data(push, m->v.blanks << 16 | m->h.blanks );
253 evo_data(push, m->v.blank2e << 16 | m->v.blank2s);
254 evo_mthd(push, 0x042c + (head->base.index * 0x300), 2);
255 evo_data(push, 0x00000000);
256 evo_data(push, 0xffffff00);
257 evo_mthd(push, 0x0450 + (head->base.index * 0x300), 3);
258 evo_data(push, m->clock * 1000);
259 evo_data(push, 0x00200000);
260 evo_data(push, m->clock * 1000);
261 evo_kick(push, core);
262 }
263}
264
265void
266head907d_view(struct nv50_head *head, struct nv50_head_atom *asyh)
267{
268 struct nv50_dmac *core = &nv50_disp(head->base.base.dev)->core->chan;
269 u32 *push;
270 if ((push = evo_wait(core, 8))) {
271 evo_mthd(push, 0x0494 + (head->base.index * 0x300), 1);
272 evo_data(push, 0x00000000);
273 evo_mthd(push, 0x04b8 + (head->base.index * 0x300), 1);
274 evo_data(push, asyh->view.iH << 16 | asyh->view.iW);
275 evo_mthd(push, 0x04c0 + (head->base.index * 0x300), 3);
276 evo_data(push, asyh->view.oH << 16 | asyh->view.oW);
277 evo_data(push, asyh->view.oH << 16 | asyh->view.oW);
278 evo_data(push, asyh->view.oH << 16 | asyh->view.oW);
279 evo_kick(push, core);
280 }
281}
282
283const struct nv50_head_func
284head907d = {
285 .view = head907d_view,
286 .mode = head907d_mode,
287 .olut = head907d_olut,
288 .olut_set = head907d_olut_set,
289 .olut_clr = head907d_olut_clr,
290 .core_calc = head507d_core_calc,
291 .core_set = head907d_core_set,
292 .core_clr = head907d_core_clr,
293 .curs_layout = head507d_curs_layout,
294 .curs_format = head507d_curs_format,
295 .curs_set = head907d_curs_set,
296 .curs_clr = head907d_curs_clr,
297 .base = head907d_base,
298 .ovly = head907d_ovly,
299 .dither = head907d_dither,
300 .procamp = head907d_procamp,
301 .or = head907d_or,
302};
303