2 * Copyright 2012 Red Hat Inc.
3 * Parts based on xf86-video-ast
4 * Copyright (c) 2005 ASPEED Technology Inc.
6 * Permission is hereby granted, free of charge, to any person obtaining a
7 * copy of this software and associated documentation files (the
8 * "Software"), to deal in the Software without restriction, including
9 * without limitation the rights to use, copy, modify, merge, publish,
10 * distribute, sub license, and/or sell copies of the Software, and to
11 * permit persons to whom the Software is furnished to do so, subject to
12 * the following conditions:
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 NON-INFRINGEMENT. IN NO EVENT SHALL
17 * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
18 * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
19 * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
20 * USE OR OTHER DEALINGS IN THE SOFTWARE.
22 * The above copyright notice and this permission notice (including the
23 * next paragraph) shall be included in all copies or substantial portions
28 * Authors: Dave Airlie <airlied@redhat.com>
30 #include <linux/export.h>
32 #include <drm/drm_crtc.h>
33 #include <drm/drm_crtc_helper.h>
36 #include "ast_tables.h"
38 static struct ast_i2c_chan
*ast_i2c_create(struct drm_device
*dev
);
39 static void ast_i2c_destroy(struct ast_i2c_chan
*i2c
);
40 static int ast_cursor_set(struct drm_crtc
*crtc
,
41 struct drm_file
*file_priv
,
45 static int ast_cursor_move(struct drm_crtc
*crtc
,
48 static inline void ast_load_palette_index(struct ast_private
*ast
,
49 u8 index
, u8 red
, u8 green
,
52 ast_io_write8(ast
, AST_IO_DAC_INDEX_WRITE
, index
);
53 ast_io_read8(ast
, AST_IO_SEQ_PORT
);
54 ast_io_write8(ast
, AST_IO_DAC_DATA
, red
);
55 ast_io_read8(ast
, AST_IO_SEQ_PORT
);
56 ast_io_write8(ast
, AST_IO_DAC_DATA
, green
);
57 ast_io_read8(ast
, AST_IO_SEQ_PORT
);
58 ast_io_write8(ast
, AST_IO_DAC_DATA
, blue
);
59 ast_io_read8(ast
, AST_IO_SEQ_PORT
);
62 static void ast_crtc_load_lut(struct drm_crtc
*crtc
)
64 struct ast_private
*ast
= crtc
->dev
->dev_private
;
65 struct ast_crtc
*ast_crtc
= to_ast_crtc(crtc
);
71 for (i
= 0; i
< 256; i
++)
72 ast_load_palette_index(ast
, i
, ast_crtc
->lut_r
[i
],
73 ast_crtc
->lut_g
[i
], ast_crtc
->lut_b
[i
]);
76 static bool ast_get_vbios_mode_info(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
77 struct drm_display_mode
*adjusted_mode
,
78 struct ast_vbios_mode_info
*vbios_mode
)
80 struct ast_private
*ast
= crtc
->dev
->dev_private
;
81 u32 refresh_rate_index
= 0, mode_id
, color_index
, refresh_rate
;
84 switch (crtc
->fb
->bits_per_pixel
) {
86 vbios_mode
->std_table
= &vbios_stdtable
[VGAModeIndex
];
87 color_index
= VGAModeIndex
- 1;
90 vbios_mode
->std_table
= &vbios_stdtable
[HiCModeIndex
];
91 color_index
= HiCModeIndex
;
95 vbios_mode
->std_table
= &vbios_stdtable
[TrueCModeIndex
];
96 color_index
= TrueCModeIndex
;
102 switch (crtc
->mode
.crtc_hdisplay
) {
104 vbios_mode
->enh_table
= &res_640x480
[refresh_rate_index
];
107 vbios_mode
->enh_table
= &res_800x600
[refresh_rate_index
];
110 vbios_mode
->enh_table
= &res_1024x768
[refresh_rate_index
];
113 if (crtc
->mode
.crtc_vdisplay
== 800)
114 vbios_mode
->enh_table
= &res_1280x800
[refresh_rate_index
];
116 vbios_mode
->enh_table
= &res_1280x1024
[refresh_rate_index
];
119 vbios_mode
->enh_table
= &res_1440x900
[refresh_rate_index
];
122 vbios_mode
->enh_table
= &res_1600x1200
[refresh_rate_index
];
125 vbios_mode
->enh_table
= &res_1680x1050
[refresh_rate_index
];
128 if (crtc
->mode
.crtc_vdisplay
== 1080)
129 vbios_mode
->enh_table
= &res_1920x1080
[refresh_rate_index
];
131 vbios_mode
->enh_table
= &res_1920x1200
[refresh_rate_index
];
137 refresh_rate
= drm_mode_vrefresh(mode
);
138 while (vbios_mode
->enh_table
->refresh_rate
< refresh_rate
) {
139 vbios_mode
->enh_table
++;
140 if ((vbios_mode
->enh_table
->refresh_rate
> refresh_rate
) ||
141 (vbios_mode
->enh_table
->refresh_rate
== 0xff)) {
142 vbios_mode
->enh_table
--;
147 hborder
= (vbios_mode
->enh_table
->flags
& HBorder
) ? 8 : 0;
148 vborder
= (vbios_mode
->enh_table
->flags
& VBorder
) ? 8 : 0;
150 adjusted_mode
->crtc_htotal
= vbios_mode
->enh_table
->ht
;
151 adjusted_mode
->crtc_hblank_start
= vbios_mode
->enh_table
->hde
+ hborder
;
152 adjusted_mode
->crtc_hblank_end
= vbios_mode
->enh_table
->ht
- hborder
;
153 adjusted_mode
->crtc_hsync_start
= vbios_mode
->enh_table
->hde
+ hborder
+
154 vbios_mode
->enh_table
->hfp
;
155 adjusted_mode
->crtc_hsync_end
= (vbios_mode
->enh_table
->hde
+ hborder
+
156 vbios_mode
->enh_table
->hfp
+
157 vbios_mode
->enh_table
->hsync
);
159 adjusted_mode
->crtc_vtotal
= vbios_mode
->enh_table
->vt
;
160 adjusted_mode
->crtc_vblank_start
= vbios_mode
->enh_table
->vde
+ vborder
;
161 adjusted_mode
->crtc_vblank_end
= vbios_mode
->enh_table
->vt
- vborder
;
162 adjusted_mode
->crtc_vsync_start
= vbios_mode
->enh_table
->vde
+ vborder
+
163 vbios_mode
->enh_table
->vfp
;
164 adjusted_mode
->crtc_vsync_end
= (vbios_mode
->enh_table
->vde
+ vborder
+
165 vbios_mode
->enh_table
->vfp
+
166 vbios_mode
->enh_table
->vsync
);
168 refresh_rate_index
= vbios_mode
->enh_table
->refresh_rate_index
;
169 mode_id
= vbios_mode
->enh_table
->mode_id
;
171 if (ast
->chip
== AST1180
) {
174 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x8c, (u8
)((color_index
& 0xf) << 4));
175 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x8d, refresh_rate_index
& 0xff);
176 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x8e, mode_id
& 0xff);
178 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x91, 0xa8);
179 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x92, crtc
->fb
->bits_per_pixel
);
180 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x93, adjusted_mode
->clock
/ 1000);
181 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x94, adjusted_mode
->crtc_hdisplay
);
182 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x95, adjusted_mode
->crtc_hdisplay
>> 8);
184 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x96, adjusted_mode
->crtc_vdisplay
);
185 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x97, adjusted_mode
->crtc_vdisplay
>> 8);
192 static void ast_set_std_reg(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
193 struct ast_vbios_mode_info
*vbios_mode
)
195 struct ast_private
*ast
= crtc
->dev
->dev_private
;
196 struct ast_vbios_stdtable
*stdtable
;
200 stdtable
= vbios_mode
->std_table
;
202 jreg
= stdtable
->misc
;
203 ast_io_write8(ast
, AST_IO_MISC_PORT_WRITE
, jreg
);
206 ast_set_index_reg(ast
, AST_IO_SEQ_PORT
, 0x00, 0x03);
207 for (i
= 0; i
< 4; i
++) {
208 jreg
= stdtable
->seq
[i
];
211 ast_set_index_reg(ast
, AST_IO_SEQ_PORT
, (i
+ 1) , jreg
);
215 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x11, 0x7f, 0x00);
216 for (i
= 0; i
< 25; i
++)
217 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, i
, stdtable
->crtc
[i
]);
220 jreg
= ast_io_read8(ast
, AST_IO_INPUT_STATUS1_READ
);
221 for (i
= 0; i
< 20; i
++) {
222 jreg
= stdtable
->ar
[i
];
223 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, (u8
)i
);
224 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, jreg
);
226 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, 0x14);
227 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, 0x00);
229 jreg
= ast_io_read8(ast
, AST_IO_INPUT_STATUS1_READ
);
230 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, 0x20);
233 for (i
= 0; i
< 9; i
++)
234 ast_set_index_reg(ast
, AST_IO_GR_PORT
, i
, stdtable
->gr
[i
]);
237 static void ast_set_crtc_reg(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
238 struct ast_vbios_mode_info
*vbios_mode
)
240 struct ast_private
*ast
= crtc
->dev
->dev_private
;
241 u8 jreg05
= 0, jreg07
= 0, jreg09
= 0, jregAC
= 0, jregAD
= 0, jregAE
= 0;
244 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x11, 0x7f, 0x00);
246 temp
= (mode
->crtc_htotal
>> 3) - 5;
248 jregAC
|= 0x01; /* HT D[8] */
249 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x00, 0x00, temp
);
251 temp
= (mode
->crtc_hdisplay
>> 3) - 1;
253 jregAC
|= 0x04; /* HDE D[8] */
254 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x01, 0x00, temp
);
256 temp
= (mode
->crtc_hblank_start
>> 3) - 1;
258 jregAC
|= 0x10; /* HBS D[8] */
259 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x02, 0x00, temp
);
261 temp
= ((mode
->crtc_hblank_end
>> 3) - 1) & 0x7f;
263 jreg05
|= 0x80; /* HBE D[5] */
265 jregAD
|= 0x01; /* HBE D[5] */
266 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x03, 0xE0, (temp
& 0x1f));
268 temp
= (mode
->crtc_hsync_start
>> 3) - 1;
270 jregAC
|= 0x40; /* HRS D[5] */
271 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x04, 0x00, temp
);
273 temp
= ((mode
->crtc_hsync_end
>> 3) - 1) & 0x3f;
275 jregAD
|= 0x04; /* HRE D[5] */
276 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x05, 0x60, (u8
)((temp
& 0x1f) | jreg05
));
278 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xAC, 0x00, jregAC
);
279 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xAD, 0x00, jregAD
);
282 temp
= (mode
->crtc_vtotal
) - 2;
289 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x06, 0x00, temp
);
291 temp
= (mode
->crtc_vsync_start
) - 1;
298 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x10, 0x00, temp
);
300 temp
= (mode
->crtc_vsync_end
- 1) & 0x3f;
305 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x11, 0x70, temp
& 0xf);
307 temp
= mode
->crtc_vdisplay
- 1;
314 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x12, 0x00, temp
);
316 temp
= mode
->crtc_vblank_start
- 1;
323 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x15, 0x00, temp
);
325 temp
= mode
->crtc_vblank_end
- 1;
328 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x16, 0x00, temp
);
330 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x07, 0x00, jreg07
);
331 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x09, 0xdf, jreg09
);
332 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xAE, 0x00, (jregAE
| 0x80));
334 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x11, 0x7f, 0x80);
337 static void ast_set_offset_reg(struct drm_crtc
*crtc
)
339 struct ast_private
*ast
= crtc
->dev
->dev_private
;
343 offset
= crtc
->fb
->pitches
[0] >> 3;
344 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x13, (offset
& 0xff));
345 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xb0, (offset
>> 8) & 0x3f);
348 static void ast_set_dclk_reg(struct drm_device
*dev
, struct drm_display_mode
*mode
,
349 struct ast_vbios_mode_info
*vbios_mode
)
351 struct ast_private
*ast
= dev
->dev_private
;
352 struct ast_vbios_dclk_info
*clk_info
;
354 clk_info
= &dclk_table
[vbios_mode
->enh_table
->dclk_index
];
356 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xc0, 0x00, clk_info
->param1
);
357 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xc1, 0x00, clk_info
->param2
);
358 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xbb, 0x0f,
359 (clk_info
->param3
& 0x80) | ((clk_info
->param3
& 0x3) << 4));
362 static void ast_set_ext_reg(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
363 struct ast_vbios_mode_info
*vbios_mode
)
365 struct ast_private
*ast
= crtc
->dev
->dev_private
;
366 u8 jregA0
= 0, jregA3
= 0, jregA8
= 0;
368 switch (crtc
->fb
->bits_per_pixel
) {
387 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xa0, 0x8f, jregA0
);
388 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xa3, 0xf0, jregA3
);
389 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xa8, 0xfd, jregA8
);
392 if (ast
->chip
== AST2300
) {
393 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa7, 0x78);
394 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa6, 0x60);
395 } else if (ast
->chip
== AST2100
||
396 ast
->chip
== AST1100
||
397 ast
->chip
== AST2200
||
398 ast
->chip
== AST2150
) {
399 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa7, 0x3f);
400 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa6, 0x2f);
402 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa7, 0x2f);
403 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa6, 0x1f);
407 static void ast_set_sync_reg(struct drm_device
*dev
, struct drm_display_mode
*mode
,
408 struct ast_vbios_mode_info
*vbios_mode
)
410 struct ast_private
*ast
= dev
->dev_private
;
413 jreg
= ast_io_read8(ast
, AST_IO_MISC_PORT_READ
);
414 jreg
|= (vbios_mode
->enh_table
->flags
& SyncNN
);
415 ast_io_write8(ast
, AST_IO_MISC_PORT_WRITE
, jreg
);
418 static bool ast_set_dac_reg(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
419 struct ast_vbios_mode_info
*vbios_mode
)
421 switch (crtc
->fb
->bits_per_pixel
) {
430 static void ast_set_start_address_crt1(struct drm_crtc
*crtc
, unsigned offset
)
432 struct ast_private
*ast
= crtc
->dev
->dev_private
;
436 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x0d, (u8
)(addr
& 0xff));
437 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x0c, (u8
)((addr
>> 8) & 0xff));
438 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xaf, (u8
)((addr
>> 16) & 0xff));
442 static void ast_crtc_dpms(struct drm_crtc
*crtc
, int mode
)
444 struct ast_private
*ast
= crtc
->dev
->dev_private
;
446 if (ast
->chip
== AST1180
)
450 case DRM_MODE_DPMS_ON
:
451 case DRM_MODE_DPMS_STANDBY
:
452 case DRM_MODE_DPMS_SUSPEND
:
453 ast_set_index_reg_mask(ast
, AST_IO_SEQ_PORT
, 0x1, 0xdf, 0);
454 ast_crtc_load_lut(crtc
);
456 case DRM_MODE_DPMS_OFF
:
457 ast_set_index_reg_mask(ast
, AST_IO_SEQ_PORT
, 0x1, 0xdf, 0x20);
462 static bool ast_crtc_mode_fixup(struct drm_crtc
*crtc
,
463 const struct drm_display_mode
*mode
,
464 struct drm_display_mode
*adjusted_mode
)
469 /* ast is different - we will force move buffers out of VRAM */
470 static int ast_crtc_do_set_base(struct drm_crtc
*crtc
,
471 struct drm_framebuffer
*fb
,
472 int x
, int y
, int atomic
)
474 struct ast_private
*ast
= crtc
->dev
->dev_private
;
475 struct drm_gem_object
*obj
;
476 struct ast_framebuffer
*ast_fb
;
481 /* push the previous fb to system ram */
483 ast_fb
= to_ast_framebuffer(fb
);
485 bo
= gem_to_ast_bo(obj
);
486 ret
= ast_bo_reserve(bo
, false);
489 ast_bo_push_sysram(bo
);
490 ast_bo_unreserve(bo
);
493 ast_fb
= to_ast_framebuffer(crtc
->fb
);
495 bo
= gem_to_ast_bo(obj
);
497 ret
= ast_bo_reserve(bo
, false);
501 ret
= ast_bo_pin(bo
, TTM_PL_FLAG_VRAM
, &gpu_addr
);
503 ast_bo_unreserve(bo
);
507 if (&ast
->fbdev
->afb
== ast_fb
) {
508 /* if pushing console in kmap it */
509 ret
= ttm_bo_kmap(&bo
->bo
, 0, bo
->bo
.num_pages
, &bo
->kmap
);
511 DRM_ERROR("failed to kmap fbcon\n");
513 ast_bo_unreserve(bo
);
515 ast_set_start_address_crt1(crtc
, (u32
)gpu_addr
);
520 static int ast_crtc_mode_set_base(struct drm_crtc
*crtc
, int x
, int y
,
521 struct drm_framebuffer
*old_fb
)
523 return ast_crtc_do_set_base(crtc
, old_fb
, x
, y
, 0);
526 static int ast_crtc_mode_set(struct drm_crtc
*crtc
,
527 struct drm_display_mode
*mode
,
528 struct drm_display_mode
*adjusted_mode
,
530 struct drm_framebuffer
*old_fb
)
532 struct drm_device
*dev
= crtc
->dev
;
533 struct ast_private
*ast
= crtc
->dev
->dev_private
;
534 struct ast_vbios_mode_info vbios_mode
;
536 if (ast
->chip
== AST1180
) {
537 DRM_ERROR("AST 1180 modesetting not supported\n");
541 ret
= ast_get_vbios_mode_info(crtc
, mode
, adjusted_mode
, &vbios_mode
);
546 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xa1, 0xff, 0x04);
548 ast_set_std_reg(crtc
, adjusted_mode
, &vbios_mode
);
549 ast_set_crtc_reg(crtc
, adjusted_mode
, &vbios_mode
);
550 ast_set_offset_reg(crtc
);
551 ast_set_dclk_reg(dev
, adjusted_mode
, &vbios_mode
);
552 ast_set_ext_reg(crtc
, adjusted_mode
, &vbios_mode
);
553 ast_set_sync_reg(dev
, adjusted_mode
, &vbios_mode
);
554 ast_set_dac_reg(crtc
, adjusted_mode
, &vbios_mode
);
556 ast_crtc_mode_set_base(crtc
, x
, y
, old_fb
);
561 static void ast_crtc_disable(struct drm_crtc
*crtc
)
566 static void ast_crtc_prepare(struct drm_crtc
*crtc
)
571 static void ast_crtc_commit(struct drm_crtc
*crtc
)
573 struct ast_private
*ast
= crtc
->dev
->dev_private
;
574 ast_set_index_reg_mask(ast
, AST_IO_SEQ_PORT
, 0x1, 0xdf, 0);
578 static const struct drm_crtc_helper_funcs ast_crtc_helper_funcs
= {
579 .dpms
= ast_crtc_dpms
,
580 .mode_fixup
= ast_crtc_mode_fixup
,
581 .mode_set
= ast_crtc_mode_set
,
582 .mode_set_base
= ast_crtc_mode_set_base
,
583 .disable
= ast_crtc_disable
,
584 .load_lut
= ast_crtc_load_lut
,
585 .prepare
= ast_crtc_prepare
,
586 .commit
= ast_crtc_commit
,
590 static void ast_crtc_reset(struct drm_crtc
*crtc
)
595 static void ast_crtc_gamma_set(struct drm_crtc
*crtc
, u16
*red
, u16
*green
,
596 u16
*blue
, uint32_t start
, uint32_t size
)
598 struct ast_crtc
*ast_crtc
= to_ast_crtc(crtc
);
599 int end
= (start
+ size
> 256) ? 256 : start
+ size
, i
;
601 /* userspace palettes are always correct as is */
602 for (i
= start
; i
< end
; i
++) {
603 ast_crtc
->lut_r
[i
] = red
[i
] >> 8;
604 ast_crtc
->lut_g
[i
] = green
[i
] >> 8;
605 ast_crtc
->lut_b
[i
] = blue
[i
] >> 8;
607 ast_crtc_load_lut(crtc
);
611 static void ast_crtc_destroy(struct drm_crtc
*crtc
)
613 drm_crtc_cleanup(crtc
);
617 static const struct drm_crtc_funcs ast_crtc_funcs
= {
618 .cursor_set
= ast_cursor_set
,
619 .cursor_move
= ast_cursor_move
,
620 .reset
= ast_crtc_reset
,
621 .set_config
= drm_crtc_helper_set_config
,
622 .gamma_set
= ast_crtc_gamma_set
,
623 .destroy
= ast_crtc_destroy
,
626 static int ast_crtc_init(struct drm_device
*dev
)
628 struct ast_crtc
*crtc
;
631 crtc
= kzalloc(sizeof(struct ast_crtc
), GFP_KERNEL
);
635 drm_crtc_init(dev
, &crtc
->base
, &ast_crtc_funcs
);
636 drm_mode_crtc_set_gamma_size(&crtc
->base
, 256);
637 drm_crtc_helper_add(&crtc
->base
, &ast_crtc_helper_funcs
);
639 for (i
= 0; i
< 256; i
++) {
647 static void ast_encoder_destroy(struct drm_encoder
*encoder
)
649 drm_encoder_cleanup(encoder
);
654 static struct drm_encoder
*ast_best_single_encoder(struct drm_connector
*connector
)
656 int enc_id
= connector
->encoder_ids
[0];
657 struct drm_mode_object
*obj
;
658 struct drm_encoder
*encoder
;
660 /* pick the encoder ids */
662 obj
= drm_mode_object_find(connector
->dev
, enc_id
, DRM_MODE_OBJECT_ENCODER
);
665 encoder
= obj_to_encoder(obj
);
672 static const struct drm_encoder_funcs ast_enc_funcs
= {
673 .destroy
= ast_encoder_destroy
,
676 static void ast_encoder_dpms(struct drm_encoder
*encoder
, int mode
)
681 static bool ast_mode_fixup(struct drm_encoder
*encoder
,
682 const struct drm_display_mode
*mode
,
683 struct drm_display_mode
*adjusted_mode
)
688 static void ast_encoder_mode_set(struct drm_encoder
*encoder
,
689 struct drm_display_mode
*mode
,
690 struct drm_display_mode
*adjusted_mode
)
694 static void ast_encoder_prepare(struct drm_encoder
*encoder
)
699 static void ast_encoder_commit(struct drm_encoder
*encoder
)
705 static const struct drm_encoder_helper_funcs ast_enc_helper_funcs
= {
706 .dpms
= ast_encoder_dpms
,
707 .mode_fixup
= ast_mode_fixup
,
708 .prepare
= ast_encoder_prepare
,
709 .commit
= ast_encoder_commit
,
710 .mode_set
= ast_encoder_mode_set
,
713 static int ast_encoder_init(struct drm_device
*dev
)
715 struct ast_encoder
*ast_encoder
;
717 ast_encoder
= kzalloc(sizeof(struct ast_encoder
), GFP_KERNEL
);
721 drm_encoder_init(dev
, &ast_encoder
->base
, &ast_enc_funcs
,
722 DRM_MODE_ENCODER_DAC
);
723 drm_encoder_helper_add(&ast_encoder
->base
, &ast_enc_helper_funcs
);
725 ast_encoder
->base
.possible_crtcs
= 1;
729 static int ast_get_modes(struct drm_connector
*connector
)
731 struct ast_connector
*ast_connector
= to_ast_connector(connector
);
735 edid
= drm_get_edid(connector
, &ast_connector
->i2c
->adapter
);
737 drm_mode_connector_update_edid_property(&ast_connector
->base
, edid
);
738 ret
= drm_add_edid_modes(connector
, edid
);
742 drm_mode_connector_update_edid_property(&ast_connector
->base
, NULL
);
746 static int ast_mode_valid(struct drm_connector
*connector
,
747 struct drm_display_mode
*mode
)
752 static void ast_connector_destroy(struct drm_connector
*connector
)
754 struct ast_connector
*ast_connector
= to_ast_connector(connector
);
755 ast_i2c_destroy(ast_connector
->i2c
);
756 drm_sysfs_connector_remove(connector
);
757 drm_connector_cleanup(connector
);
761 static enum drm_connector_status
762 ast_connector_detect(struct drm_connector
*connector
, bool force
)
764 return connector_status_connected
;
767 static const struct drm_connector_helper_funcs ast_connector_helper_funcs
= {
768 .mode_valid
= ast_mode_valid
,
769 .get_modes
= ast_get_modes
,
770 .best_encoder
= ast_best_single_encoder
,
773 static const struct drm_connector_funcs ast_connector_funcs
= {
774 .dpms
= drm_helper_connector_dpms
,
775 .detect
= ast_connector_detect
,
776 .fill_modes
= drm_helper_probe_single_connector_modes
,
777 .destroy
= ast_connector_destroy
,
780 static int ast_connector_init(struct drm_device
*dev
)
782 struct ast_connector
*ast_connector
;
783 struct drm_connector
*connector
;
784 struct drm_encoder
*encoder
;
786 ast_connector
= kzalloc(sizeof(struct ast_connector
), GFP_KERNEL
);
790 connector
= &ast_connector
->base
;
791 drm_connector_init(dev
, connector
, &ast_connector_funcs
, DRM_MODE_CONNECTOR_VGA
);
793 drm_connector_helper_add(connector
, &ast_connector_helper_funcs
);
795 connector
->interlace_allowed
= 0;
796 connector
->doublescan_allowed
= 0;
798 drm_sysfs_connector_add(connector
);
800 connector
->polled
= DRM_CONNECTOR_POLL_CONNECT
;
802 encoder
= list_first_entry(&dev
->mode_config
.encoder_list
, struct drm_encoder
, head
);
803 drm_mode_connector_attach_encoder(connector
, encoder
);
805 ast_connector
->i2c
= ast_i2c_create(dev
);
806 if (!ast_connector
->i2c
)
807 DRM_ERROR("failed to add ddc bus for connector\n");
812 /* allocate cursor cache and pin at start of VRAM */
813 static int ast_cursor_init(struct drm_device
*dev
)
815 struct ast_private
*ast
= dev
->dev_private
;
818 struct drm_gem_object
*obj
;
822 size
= (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
) * AST_DEFAULT_HWC_NUM
;
824 ret
= ast_gem_create(dev
, size
, true, &obj
);
827 bo
= gem_to_ast_bo(obj
);
828 ret
= ast_bo_reserve(bo
, false);
829 if (unlikely(ret
!= 0))
832 ret
= ast_bo_pin(bo
, TTM_PL_FLAG_VRAM
, &gpu_addr
);
833 ast_bo_unreserve(bo
);
837 /* kmap the object */
838 ret
= ttm_bo_kmap(&bo
->bo
, 0, bo
->bo
.num_pages
, &ast
->cache_kmap
);
842 ast
->cursor_cache
= obj
;
843 ast
->cursor_cache_gpu_addr
= gpu_addr
;
844 DRM_DEBUG_KMS("pinned cursor cache at %llx\n", ast
->cursor_cache_gpu_addr
);
850 static void ast_cursor_fini(struct drm_device
*dev
)
852 struct ast_private
*ast
= dev
->dev_private
;
853 ttm_bo_kunmap(&ast
->cache_kmap
);
854 drm_gem_object_unreference_unlocked(ast
->cursor_cache
);
857 int ast_mode_init(struct drm_device
*dev
)
859 ast_cursor_init(dev
);
861 ast_encoder_init(dev
);
862 ast_connector_init(dev
);
866 void ast_mode_fini(struct drm_device
*dev
)
868 ast_cursor_fini(dev
);
871 static int get_clock(void *i2c_priv
)
873 struct ast_i2c_chan
*i2c
= i2c_priv
;
874 struct ast_private
*ast
= i2c
->dev
->dev_private
;
877 val
= ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x10) >> 4;
878 return val
& 1 ? 1 : 0;
881 static int get_data(void *i2c_priv
)
883 struct ast_i2c_chan
*i2c
= i2c_priv
;
884 struct ast_private
*ast
= i2c
->dev
->dev_private
;
887 val
= ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x20) >> 5;
888 return val
& 1 ? 1 : 0;
891 static void set_clock(void *i2c_priv
, int clock
)
893 struct ast_i2c_chan
*i2c
= i2c_priv
;
894 struct ast_private
*ast
= i2c
->dev
->dev_private
;
898 for (i
= 0; i
< 0x10000; i
++) {
899 ujcrb7
= ((clock
& 0x01) ? 0 : 1);
900 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0xfe, ujcrb7
);
901 jtemp
= ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x01);
907 static void set_data(void *i2c_priv
, int data
)
909 struct ast_i2c_chan
*i2c
= i2c_priv
;
910 struct ast_private
*ast
= i2c
->dev
->dev_private
;
914 for (i
= 0; i
< 0x10000; i
++) {
915 ujcrb7
= ((data
& 0x01) ? 0 : 1) << 2;
916 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0xfb, ujcrb7
);
917 jtemp
= ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x04);
923 static struct ast_i2c_chan
*ast_i2c_create(struct drm_device
*dev
)
925 struct ast_i2c_chan
*i2c
;
928 i2c
= kzalloc(sizeof(struct ast_i2c_chan
), GFP_KERNEL
);
932 i2c
->adapter
.owner
= THIS_MODULE
;
933 i2c
->adapter
.class = I2C_CLASS_DDC
;
934 i2c
->adapter
.dev
.parent
= &dev
->pdev
->dev
;
936 i2c_set_adapdata(&i2c
->adapter
, i2c
);
937 snprintf(i2c
->adapter
.name
, sizeof(i2c
->adapter
.name
),
939 i2c
->adapter
.algo_data
= &i2c
->bit
;
941 i2c
->bit
.udelay
= 20;
942 i2c
->bit
.timeout
= 2;
944 i2c
->bit
.setsda
= set_data
;
945 i2c
->bit
.setscl
= set_clock
;
946 i2c
->bit
.getsda
= get_data
;
947 i2c
->bit
.getscl
= get_clock
;
948 ret
= i2c_bit_add_bus(&i2c
->adapter
);
950 DRM_ERROR("Failed to register bit i2c\n");
960 static void ast_i2c_destroy(struct ast_i2c_chan
*i2c
)
964 i2c_del_adapter(&i2c
->adapter
);
968 static void ast_show_cursor(struct drm_crtc
*crtc
)
970 struct ast_private
*ast
= crtc
->dev
->dev_private
;
974 /* enable ARGB cursor */
976 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xcb, 0xfc, jreg
);
979 static void ast_hide_cursor(struct drm_crtc
*crtc
)
981 struct ast_private
*ast
= crtc
->dev
->dev_private
;
982 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xcb, 0xfc, 0x00);
985 static u32
copy_cursor_image(u8
*src
, u8
*dst
, int width
, int height
)
990 } srcdata32
[2], data32
;
996 s32 alpha_dst_delta
, last_alpha_dst_delta
;
999 u32 per_pixel_copy
, two_pixel_copy
;
1001 alpha_dst_delta
= AST_MAX_HWC_WIDTH
<< 1;
1002 last_alpha_dst_delta
= alpha_dst_delta
- (width
<< 1);
1005 dstxor
= (u8
*)dst
+ last_alpha_dst_delta
+ (AST_MAX_HWC_HEIGHT
- height
) * alpha_dst_delta
;
1006 per_pixel_copy
= width
& 1;
1007 two_pixel_copy
= width
>> 1;
1009 for (j
= 0; j
< height
; j
++) {
1010 for (i
= 0; i
< two_pixel_copy
; i
++) {
1011 srcdata32
[0].ul
= *((u32
*)srcxor
) & 0xf0f0f0f0;
1012 srcdata32
[1].ul
= *((u32
*)(srcxor
+ 4)) & 0xf0f0f0f0;
1013 data32
.b
[0] = srcdata32
[0].b
[1] | (srcdata32
[0].b
[0] >> 4);
1014 data32
.b
[1] = srcdata32
[0].b
[3] | (srcdata32
[0].b
[2] >> 4);
1015 data32
.b
[2] = srcdata32
[0].b
[1] | (srcdata32
[1].b
[0] >> 4);
1016 data32
.b
[3] = srcdata32
[0].b
[3] | (srcdata32
[1].b
[2] >> 4);
1018 writel(data32
.ul
, dstxor
);
1026 for (i
= 0; i
< per_pixel_copy
; i
++) {
1027 srcdata32
[0].ul
= *((u32
*)srcxor
) & 0xf0f0f0f0;
1028 data16
.b
[0] = srcdata32
[0].b
[1] | (srcdata32
[0].b
[0] >> 4);
1029 data16
.b
[1] = srcdata32
[0].b
[3] | (srcdata32
[0].b
[2] >> 4);
1030 writew(data16
.us
, dstxor
);
1031 csum
+= (u32
)data16
.us
;
1036 dstxor
+= last_alpha_dst_delta
;
1041 static int ast_cursor_set(struct drm_crtc
*crtc
,
1042 struct drm_file
*file_priv
,
1047 struct ast_private
*ast
= crtc
->dev
->dev_private
;
1048 struct ast_crtc
*ast_crtc
= to_ast_crtc(crtc
);
1049 struct drm_gem_object
*obj
;
1054 struct ttm_bo_kmap_obj uobj_map
;
1056 bool src_isiomem
, dst_isiomem
;
1058 ast_hide_cursor(crtc
);
1062 if (width
> AST_MAX_HWC_WIDTH
|| height
> AST_MAX_HWC_HEIGHT
)
1065 obj
= drm_gem_object_lookup(crtc
->dev
, file_priv
, handle
);
1067 DRM_ERROR("Cannot find cursor object %x for crtc\n", handle
);
1070 bo
= gem_to_ast_bo(obj
);
1072 ret
= ast_bo_reserve(bo
, false);
1076 ret
= ttm_bo_kmap(&bo
->bo
, 0, bo
->bo
.num_pages
, &uobj_map
);
1078 src
= ttm_kmap_obj_virtual(&uobj_map
, &src_isiomem
);
1079 dst
= ttm_kmap_obj_virtual(&ast
->cache_kmap
, &dst_isiomem
);
1081 if (src_isiomem
== true)
1082 DRM_ERROR("src cursor bo should be in main memory\n");
1083 if (dst_isiomem
== false)
1084 DRM_ERROR("dst bo should be in VRAM\n");
1086 dst
+= (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
)*ast
->next_cursor
;
1088 /* do data transfer to cursor cache */
1089 csum
= copy_cursor_image(src
, dst
, width
, height
);
1091 /* write checksum + signature */
1092 ttm_bo_kunmap(&uobj_map
);
1093 ast_bo_unreserve(bo
);
1095 u8
*dst
= (u8
*)ast
->cache_kmap
.virtual + (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
)*ast
->next_cursor
+ AST_HWC_SIZE
;
1097 writel(width
, dst
+ AST_HWC_SIGNATURE_SizeX
);
1098 writel(height
, dst
+ AST_HWC_SIGNATURE_SizeY
);
1099 writel(0, dst
+ AST_HWC_SIGNATURE_HOTSPOTX
);
1100 writel(0, dst
+ AST_HWC_SIGNATURE_HOTSPOTY
);
1102 /* set pattern offset */
1103 gpu_addr
= ast
->cursor_cache_gpu_addr
;
1104 gpu_addr
+= (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
)*ast
->next_cursor
;
1106 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc8, gpu_addr
& 0xff);
1107 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc9, (gpu_addr
>> 8) & 0xff);
1108 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xca, (gpu_addr
>> 16) & 0xff);
1110 ast_crtc
->cursor_width
= width
;
1111 ast_crtc
->cursor_height
= height
;
1112 ast_crtc
->offset_x
= AST_MAX_HWC_WIDTH
- width
;
1113 ast_crtc
->offset_y
= AST_MAX_HWC_WIDTH
- height
;
1115 ast
->next_cursor
= (ast
->next_cursor
+ 1) % AST_DEFAULT_HWC_NUM
;
1117 ast_show_cursor(crtc
);
1119 drm_gem_object_unreference_unlocked(obj
);
1122 drm_gem_object_unreference_unlocked(obj
);
1126 static int ast_cursor_move(struct drm_crtc
*crtc
,
1129 struct ast_crtc
*ast_crtc
= to_ast_crtc(crtc
);
1130 struct ast_private
*ast
= crtc
->dev
->dev_private
;
1131 int x_offset
, y_offset
;
1134 sig
= (u8
*)ast
->cache_kmap
.virtual + (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
)*ast
->next_cursor
+ AST_HWC_SIZE
;
1135 writel(x
, sig
+ AST_HWC_SIGNATURE_X
);
1136 writel(y
, sig
+ AST_HWC_SIGNATURE_Y
);
1138 x_offset
= ast_crtc
->offset_x
;
1139 y_offset
= ast_crtc
->offset_y
;
1141 x_offset
= (-x
) + ast_crtc
->offset_x
;
1146 y_offset
= (-y
) + ast_crtc
->offset_y
;
1149 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc2, x_offset
);
1150 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc3, y_offset
);
1151 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc4, (x
& 0xff));
1152 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc5, ((x
>> 8) & 0x0f));
1153 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc6, (y
& 0xff));
1154 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc7, ((y
>> 8) & 0x07));
1156 /* dummy write to fire HWC */
1157 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xCB, 0xFF, 0x00);