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>
31 #include <linux/export.h>
32 #include <linux/pci.h>
34 #include <drm/drm_crtc.h>
35 #include <drm/drm_crtc_helper.h>
36 #include <drm/drm_fourcc.h>
37 #include <drm/drm_gem_vram_helper.h>
38 #include <drm/drm_plane_helper.h>
39 #include <drm/drm_probe_helper.h>
42 #include "ast_tables.h"
44 static struct ast_i2c_chan
*ast_i2c_create(struct drm_device
*dev
);
45 static void ast_i2c_destroy(struct ast_i2c_chan
*i2c
);
46 static int ast_cursor_set(struct drm_crtc
*crtc
,
47 struct drm_file
*file_priv
,
51 static int ast_cursor_move(struct drm_crtc
*crtc
,
54 static inline void ast_load_palette_index(struct ast_private
*ast
,
55 u8 index
, u8 red
, u8 green
,
58 ast_io_write8(ast
, AST_IO_DAC_INDEX_WRITE
, index
);
59 ast_io_read8(ast
, AST_IO_SEQ_PORT
);
60 ast_io_write8(ast
, AST_IO_DAC_DATA
, red
);
61 ast_io_read8(ast
, AST_IO_SEQ_PORT
);
62 ast_io_write8(ast
, AST_IO_DAC_DATA
, green
);
63 ast_io_read8(ast
, AST_IO_SEQ_PORT
);
64 ast_io_write8(ast
, AST_IO_DAC_DATA
, blue
);
65 ast_io_read8(ast
, AST_IO_SEQ_PORT
);
68 static void ast_crtc_load_lut(struct drm_crtc
*crtc
)
70 struct ast_private
*ast
= crtc
->dev
->dev_private
;
77 r
= crtc
->gamma_store
;
78 g
= r
+ crtc
->gamma_size
;
79 b
= g
+ crtc
->gamma_size
;
81 for (i
= 0; i
< 256; i
++)
82 ast_load_palette_index(ast
, i
, *r
++ >> 8, *g
++ >> 8, *b
++ >> 8);
85 static bool ast_get_vbios_mode_info(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
86 struct drm_display_mode
*adjusted_mode
,
87 struct ast_vbios_mode_info
*vbios_mode
)
89 struct ast_private
*ast
= crtc
->dev
->dev_private
;
90 const struct drm_framebuffer
*fb
= crtc
->primary
->fb
;
91 u32 refresh_rate_index
= 0, mode_id
, color_index
, refresh_rate
;
92 const struct ast_vbios_enhtable
*best
= NULL
;
96 switch (fb
->format
->cpp
[0] * 8) {
98 vbios_mode
->std_table
= &vbios_stdtable
[VGAModeIndex
];
99 color_index
= VGAModeIndex
- 1;
102 vbios_mode
->std_table
= &vbios_stdtable
[HiCModeIndex
];
103 color_index
= HiCModeIndex
;
107 vbios_mode
->std_table
= &vbios_stdtable
[TrueCModeIndex
];
108 color_index
= TrueCModeIndex
;
114 switch (crtc
->mode
.crtc_hdisplay
) {
116 vbios_mode
->enh_table
= &res_640x480
[refresh_rate_index
];
119 vbios_mode
->enh_table
= &res_800x600
[refresh_rate_index
];
122 vbios_mode
->enh_table
= &res_1024x768
[refresh_rate_index
];
125 if (crtc
->mode
.crtc_vdisplay
== 800)
126 vbios_mode
->enh_table
= &res_1280x800
[refresh_rate_index
];
128 vbios_mode
->enh_table
= &res_1280x1024
[refresh_rate_index
];
131 vbios_mode
->enh_table
= &res_1360x768
[refresh_rate_index
];
134 vbios_mode
->enh_table
= &res_1440x900
[refresh_rate_index
];
137 if (crtc
->mode
.crtc_vdisplay
== 900)
138 vbios_mode
->enh_table
= &res_1600x900
[refresh_rate_index
];
140 vbios_mode
->enh_table
= &res_1600x1200
[refresh_rate_index
];
143 vbios_mode
->enh_table
= &res_1680x1050
[refresh_rate_index
];
146 if (crtc
->mode
.crtc_vdisplay
== 1080)
147 vbios_mode
->enh_table
= &res_1920x1080
[refresh_rate_index
];
149 vbios_mode
->enh_table
= &res_1920x1200
[refresh_rate_index
];
155 refresh_rate
= drm_mode_vrefresh(mode
);
156 check_sync
= vbios_mode
->enh_table
->flags
& WideScreenMode
;
158 const struct ast_vbios_enhtable
*loop
= vbios_mode
->enh_table
;
160 while (loop
->refresh_rate
!= 0xff) {
162 (((mode
->flags
& DRM_MODE_FLAG_NVSYNC
) &&
163 (loop
->flags
& PVSync
)) ||
164 ((mode
->flags
& DRM_MODE_FLAG_PVSYNC
) &&
165 (loop
->flags
& NVSync
)) ||
166 ((mode
->flags
& DRM_MODE_FLAG_NHSYNC
) &&
167 (loop
->flags
& PHSync
)) ||
168 ((mode
->flags
& DRM_MODE_FLAG_PHSYNC
) &&
169 (loop
->flags
& NHSync
)))) {
173 if (loop
->refresh_rate
<= refresh_rate
174 && (!best
|| loop
->refresh_rate
> best
->refresh_rate
))
178 if (best
|| !check_sync
)
183 vbios_mode
->enh_table
= best
;
185 hborder
= (vbios_mode
->enh_table
->flags
& HBorder
) ? 8 : 0;
186 vborder
= (vbios_mode
->enh_table
->flags
& VBorder
) ? 8 : 0;
188 adjusted_mode
->crtc_htotal
= vbios_mode
->enh_table
->ht
;
189 adjusted_mode
->crtc_hblank_start
= vbios_mode
->enh_table
->hde
+ hborder
;
190 adjusted_mode
->crtc_hblank_end
= vbios_mode
->enh_table
->ht
- hborder
;
191 adjusted_mode
->crtc_hsync_start
= vbios_mode
->enh_table
->hde
+ hborder
+
192 vbios_mode
->enh_table
->hfp
;
193 adjusted_mode
->crtc_hsync_end
= (vbios_mode
->enh_table
->hde
+ hborder
+
194 vbios_mode
->enh_table
->hfp
+
195 vbios_mode
->enh_table
->hsync
);
197 adjusted_mode
->crtc_vtotal
= vbios_mode
->enh_table
->vt
;
198 adjusted_mode
->crtc_vblank_start
= vbios_mode
->enh_table
->vde
+ vborder
;
199 adjusted_mode
->crtc_vblank_end
= vbios_mode
->enh_table
->vt
- vborder
;
200 adjusted_mode
->crtc_vsync_start
= vbios_mode
->enh_table
->vde
+ vborder
+
201 vbios_mode
->enh_table
->vfp
;
202 adjusted_mode
->crtc_vsync_end
= (vbios_mode
->enh_table
->vde
+ vborder
+
203 vbios_mode
->enh_table
->vfp
+
204 vbios_mode
->enh_table
->vsync
);
206 refresh_rate_index
= vbios_mode
->enh_table
->refresh_rate_index
;
207 mode_id
= vbios_mode
->enh_table
->mode_id
;
209 if (ast
->chip
== AST1180
) {
212 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x8c, (u8
)((color_index
& 0xf) << 4));
213 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x8d, refresh_rate_index
& 0xff);
214 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x8e, mode_id
& 0xff);
216 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x91, 0x00);
217 if (vbios_mode
->enh_table
->flags
& NewModeInfo
) {
218 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x91, 0xa8);
219 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x92,
220 fb
->format
->cpp
[0] * 8);
221 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x93, adjusted_mode
->clock
/ 1000);
222 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x94, adjusted_mode
->crtc_hdisplay
);
223 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x95, adjusted_mode
->crtc_hdisplay
>> 8);
225 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x96, adjusted_mode
->crtc_vdisplay
);
226 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x97, adjusted_mode
->crtc_vdisplay
>> 8);
234 static void ast_set_std_reg(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
235 struct ast_vbios_mode_info
*vbios_mode
)
237 struct ast_private
*ast
= crtc
->dev
->dev_private
;
238 const struct ast_vbios_stdtable
*stdtable
;
242 stdtable
= vbios_mode
->std_table
;
244 jreg
= stdtable
->misc
;
245 ast_io_write8(ast
, AST_IO_MISC_PORT_WRITE
, jreg
);
248 ast_set_index_reg(ast
, AST_IO_SEQ_PORT
, 0x00, 0x03);
249 for (i
= 0; i
< 4; i
++) {
250 jreg
= stdtable
->seq
[i
];
253 ast_set_index_reg(ast
, AST_IO_SEQ_PORT
, (i
+ 1) , jreg
);
257 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x11, 0x7f, 0x00);
258 for (i
= 0; i
< 25; i
++)
259 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, i
, stdtable
->crtc
[i
]);
262 jreg
= ast_io_read8(ast
, AST_IO_INPUT_STATUS1_READ
);
263 for (i
= 0; i
< 20; i
++) {
264 jreg
= stdtable
->ar
[i
];
265 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, (u8
)i
);
266 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, jreg
);
268 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, 0x14);
269 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, 0x00);
271 jreg
= ast_io_read8(ast
, AST_IO_INPUT_STATUS1_READ
);
272 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, 0x20);
275 for (i
= 0; i
< 9; i
++)
276 ast_set_index_reg(ast
, AST_IO_GR_PORT
, i
, stdtable
->gr
[i
]);
279 static void ast_set_crtc_reg(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
280 struct ast_vbios_mode_info
*vbios_mode
)
282 struct ast_private
*ast
= crtc
->dev
->dev_private
;
283 u8 jreg05
= 0, jreg07
= 0, jreg09
= 0, jregAC
= 0, jregAD
= 0, jregAE
= 0;
284 u16 temp
, precache
= 0;
286 if ((ast
->chip
== AST2500
) &&
287 (vbios_mode
->enh_table
->flags
& AST2500PreCatchCRT
))
290 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x11, 0x7f, 0x00);
292 temp
= (mode
->crtc_htotal
>> 3) - 5;
294 jregAC
|= 0x01; /* HT D[8] */
295 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x00, 0x00, temp
);
297 temp
= (mode
->crtc_hdisplay
>> 3) - 1;
299 jregAC
|= 0x04; /* HDE D[8] */
300 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x01, 0x00, temp
);
302 temp
= (mode
->crtc_hblank_start
>> 3) - 1;
304 jregAC
|= 0x10; /* HBS D[8] */
305 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x02, 0x00, temp
);
307 temp
= ((mode
->crtc_hblank_end
>> 3) - 1) & 0x7f;
309 jreg05
|= 0x80; /* HBE D[5] */
311 jregAD
|= 0x01; /* HBE D[5] */
312 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x03, 0xE0, (temp
& 0x1f));
314 temp
= ((mode
->crtc_hsync_start
-precache
) >> 3) - 1;
316 jregAC
|= 0x40; /* HRS D[5] */
317 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x04, 0x00, temp
);
319 temp
= (((mode
->crtc_hsync_end
-precache
) >> 3) - 1) & 0x3f;
321 jregAD
|= 0x04; /* HRE D[5] */
322 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x05, 0x60, (u8
)((temp
& 0x1f) | jreg05
));
324 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xAC, 0x00, jregAC
);
325 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xAD, 0x00, jregAD
);
328 temp
= (mode
->crtc_vtotal
) - 2;
335 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x06, 0x00, temp
);
337 temp
= (mode
->crtc_vsync_start
) - 1;
344 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x10, 0x00, temp
);
346 temp
= (mode
->crtc_vsync_end
- 1) & 0x3f;
351 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x11, 0x70, temp
& 0xf);
353 temp
= mode
->crtc_vdisplay
- 1;
360 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x12, 0x00, temp
);
362 temp
= mode
->crtc_vblank_start
- 1;
369 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x15, 0x00, temp
);
371 temp
= mode
->crtc_vblank_end
- 1;
374 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x16, 0x00, temp
);
376 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x07, 0x00, jreg07
);
377 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x09, 0xdf, jreg09
);
378 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xAE, 0x00, (jregAE
| 0x80));
381 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb6, 0x3f, 0x80);
383 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb6, 0x3f, 0x00);
385 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x11, 0x7f, 0x80);
388 static void ast_set_offset_reg(struct drm_crtc
*crtc
)
390 struct ast_private
*ast
= crtc
->dev
->dev_private
;
391 const struct drm_framebuffer
*fb
= crtc
->primary
->fb
;
395 offset
= fb
->pitches
[0] >> 3;
396 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x13, (offset
& 0xff));
397 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xb0, (offset
>> 8) & 0x3f);
400 static void ast_set_dclk_reg(struct drm_device
*dev
, struct drm_display_mode
*mode
,
401 struct ast_vbios_mode_info
*vbios_mode
)
403 struct ast_private
*ast
= dev
->dev_private
;
404 const struct ast_vbios_dclk_info
*clk_info
;
406 if (ast
->chip
== AST2500
)
407 clk_info
= &dclk_table_ast2500
[vbios_mode
->enh_table
->dclk_index
];
409 clk_info
= &dclk_table
[vbios_mode
->enh_table
->dclk_index
];
411 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xc0, 0x00, clk_info
->param1
);
412 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xc1, 0x00, clk_info
->param2
);
413 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xbb, 0x0f,
414 (clk_info
->param3
& 0xc0) |
415 ((clk_info
->param3
& 0x3) << 4));
418 static void ast_set_ext_reg(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
419 struct ast_vbios_mode_info
*vbios_mode
)
421 struct ast_private
*ast
= crtc
->dev
->dev_private
;
422 const struct drm_framebuffer
*fb
= crtc
->primary
->fb
;
423 u8 jregA0
= 0, jregA3
= 0, jregA8
= 0;
425 switch (fb
->format
->cpp
[0] * 8) {
444 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xa0, 0x8f, jregA0
);
445 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xa3, 0xf0, jregA3
);
446 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xa8, 0xfd, jregA8
);
449 if (ast
->chip
== AST2300
|| ast
->chip
== AST2400
||
450 ast
->chip
== AST2500
) {
451 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa7, 0x78);
452 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa6, 0x60);
453 } else if (ast
->chip
== AST2100
||
454 ast
->chip
== AST1100
||
455 ast
->chip
== AST2200
||
456 ast
->chip
== AST2150
) {
457 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa7, 0x3f);
458 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa6, 0x2f);
460 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa7, 0x2f);
461 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa6, 0x1f);
465 static void ast_set_sync_reg(struct drm_device
*dev
, struct drm_display_mode
*mode
,
466 struct ast_vbios_mode_info
*vbios_mode
)
468 struct ast_private
*ast
= dev
->dev_private
;
471 jreg
= ast_io_read8(ast
, AST_IO_MISC_PORT_READ
);
473 if (vbios_mode
->enh_table
->flags
& NVSync
) jreg
|= 0x80;
474 if (vbios_mode
->enh_table
->flags
& NHSync
) jreg
|= 0x40;
475 ast_io_write8(ast
, AST_IO_MISC_PORT_WRITE
, jreg
);
478 static bool ast_set_dac_reg(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
479 struct ast_vbios_mode_info
*vbios_mode
)
481 const struct drm_framebuffer
*fb
= crtc
->primary
->fb
;
483 switch (fb
->format
->cpp
[0] * 8) {
492 static void ast_set_start_address_crt1(struct drm_crtc
*crtc
, unsigned offset
)
494 struct ast_private
*ast
= crtc
->dev
->dev_private
;
498 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x0d, (u8
)(addr
& 0xff));
499 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x0c, (u8
)((addr
>> 8) & 0xff));
500 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xaf, (u8
)((addr
>> 16) & 0xff));
504 static void ast_crtc_dpms(struct drm_crtc
*crtc
, int mode
)
506 struct ast_private
*ast
= crtc
->dev
->dev_private
;
508 if (ast
->chip
== AST1180
)
512 case DRM_MODE_DPMS_ON
:
513 case DRM_MODE_DPMS_STANDBY
:
514 case DRM_MODE_DPMS_SUSPEND
:
515 ast_set_index_reg_mask(ast
, AST_IO_SEQ_PORT
, 0x1, 0xdf, 0);
516 if (ast
->tx_chip_type
== AST_TX_DP501
)
517 ast_set_dp501_video_output(crtc
->dev
, 1);
518 ast_crtc_load_lut(crtc
);
520 case DRM_MODE_DPMS_OFF
:
521 if (ast
->tx_chip_type
== AST_TX_DP501
)
522 ast_set_dp501_video_output(crtc
->dev
, 0);
523 ast_set_index_reg_mask(ast
, AST_IO_SEQ_PORT
, 0x1, 0xdf, 0x20);
528 static int ast_crtc_do_set_base(struct drm_crtc
*crtc
,
529 struct drm_framebuffer
*fb
,
530 int x
, int y
, int atomic
)
532 struct drm_gem_vram_object
*gbo
;
537 gbo
= drm_gem_vram_of_gem(fb
->obj
[0]);
538 drm_gem_vram_unpin(gbo
);
541 gbo
= drm_gem_vram_of_gem(crtc
->primary
->fb
->obj
[0]);
543 ret
= drm_gem_vram_pin(gbo
, DRM_GEM_VRAM_PL_FLAG_VRAM
);
546 gpu_addr
= drm_gem_vram_offset(gbo
);
549 goto err_drm_gem_vram_unpin
;
552 ast_set_offset_reg(crtc
);
553 ast_set_start_address_crt1(crtc
, (u32
)gpu_addr
);
557 err_drm_gem_vram_unpin
:
558 drm_gem_vram_unpin(gbo
);
562 static int ast_crtc_mode_set_base(struct drm_crtc
*crtc
, int x
, int y
,
563 struct drm_framebuffer
*old_fb
)
565 return ast_crtc_do_set_base(crtc
, old_fb
, x
, y
, 0);
568 static int ast_crtc_mode_set(struct drm_crtc
*crtc
,
569 struct drm_display_mode
*mode
,
570 struct drm_display_mode
*adjusted_mode
,
572 struct drm_framebuffer
*old_fb
)
574 struct drm_device
*dev
= crtc
->dev
;
575 struct ast_private
*ast
= crtc
->dev
->dev_private
;
576 struct ast_vbios_mode_info vbios_mode
;
578 if (ast
->chip
== AST1180
) {
579 DRM_ERROR("AST 1180 modesetting not supported\n");
583 ret
= ast_get_vbios_mode_info(crtc
, mode
, adjusted_mode
, &vbios_mode
);
588 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa1, 0x06);
590 ast_set_std_reg(crtc
, adjusted_mode
, &vbios_mode
);
591 ast_set_crtc_reg(crtc
, adjusted_mode
, &vbios_mode
);
592 ast_set_offset_reg(crtc
);
593 ast_set_dclk_reg(dev
, adjusted_mode
, &vbios_mode
);
594 ast_set_ext_reg(crtc
, adjusted_mode
, &vbios_mode
);
595 ast_set_sync_reg(dev
, adjusted_mode
, &vbios_mode
);
596 ast_set_dac_reg(crtc
, adjusted_mode
, &vbios_mode
);
598 ast_crtc_mode_set_base(crtc
, x
, y
, old_fb
);
603 static void ast_crtc_disable(struct drm_crtc
*crtc
)
606 ast_crtc_dpms(crtc
, DRM_MODE_DPMS_OFF
);
607 if (crtc
->primary
->fb
) {
608 struct drm_framebuffer
*fb
= crtc
->primary
->fb
;
609 struct drm_gem_vram_object
*gbo
=
610 drm_gem_vram_of_gem(fb
->obj
[0]);
612 drm_gem_vram_unpin(gbo
);
614 crtc
->primary
->fb
= NULL
;
617 static void ast_crtc_prepare(struct drm_crtc
*crtc
)
622 static void ast_crtc_commit(struct drm_crtc
*crtc
)
624 struct ast_private
*ast
= crtc
->dev
->dev_private
;
625 ast_set_index_reg_mask(ast
, AST_IO_SEQ_PORT
, 0x1, 0xdf, 0);
626 ast_crtc_load_lut(crtc
);
630 static const struct drm_crtc_helper_funcs ast_crtc_helper_funcs
= {
631 .dpms
= ast_crtc_dpms
,
632 .mode_set
= ast_crtc_mode_set
,
633 .mode_set_base
= ast_crtc_mode_set_base
,
634 .disable
= ast_crtc_disable
,
635 .prepare
= ast_crtc_prepare
,
636 .commit
= ast_crtc_commit
,
640 static void ast_crtc_reset(struct drm_crtc
*crtc
)
645 static int ast_crtc_gamma_set(struct drm_crtc
*crtc
, u16
*red
, u16
*green
,
646 u16
*blue
, uint32_t size
,
647 struct drm_modeset_acquire_ctx
*ctx
)
649 ast_crtc_load_lut(crtc
);
655 static void ast_crtc_destroy(struct drm_crtc
*crtc
)
657 drm_crtc_cleanup(crtc
);
661 static const struct drm_crtc_funcs ast_crtc_funcs
= {
662 .cursor_set
= ast_cursor_set
,
663 .cursor_move
= ast_cursor_move
,
664 .reset
= ast_crtc_reset
,
665 .set_config
= drm_crtc_helper_set_config
,
666 .gamma_set
= ast_crtc_gamma_set
,
667 .destroy
= ast_crtc_destroy
,
670 static int ast_crtc_init(struct drm_device
*dev
)
672 struct ast_crtc
*crtc
;
674 crtc
= kzalloc(sizeof(struct ast_crtc
), GFP_KERNEL
);
678 drm_crtc_init(dev
, &crtc
->base
, &ast_crtc_funcs
);
679 drm_mode_crtc_set_gamma_size(&crtc
->base
, 256);
680 drm_crtc_helper_add(&crtc
->base
, &ast_crtc_helper_funcs
);
684 static void ast_encoder_destroy(struct drm_encoder
*encoder
)
686 drm_encoder_cleanup(encoder
);
690 static const struct drm_encoder_funcs ast_enc_funcs
= {
691 .destroy
= ast_encoder_destroy
,
694 static void ast_encoder_dpms(struct drm_encoder
*encoder
, int mode
)
699 static void ast_encoder_mode_set(struct drm_encoder
*encoder
,
700 struct drm_display_mode
*mode
,
701 struct drm_display_mode
*adjusted_mode
)
705 static void ast_encoder_prepare(struct drm_encoder
*encoder
)
710 static void ast_encoder_commit(struct drm_encoder
*encoder
)
716 static const struct drm_encoder_helper_funcs ast_enc_helper_funcs
= {
717 .dpms
= ast_encoder_dpms
,
718 .prepare
= ast_encoder_prepare
,
719 .commit
= ast_encoder_commit
,
720 .mode_set
= ast_encoder_mode_set
,
723 static int ast_encoder_init(struct drm_device
*dev
)
725 struct ast_encoder
*ast_encoder
;
727 ast_encoder
= kzalloc(sizeof(struct ast_encoder
), GFP_KERNEL
);
731 drm_encoder_init(dev
, &ast_encoder
->base
, &ast_enc_funcs
,
732 DRM_MODE_ENCODER_DAC
, NULL
);
733 drm_encoder_helper_add(&ast_encoder
->base
, &ast_enc_helper_funcs
);
735 ast_encoder
->base
.possible_crtcs
= 1;
739 static int ast_get_modes(struct drm_connector
*connector
)
741 struct ast_connector
*ast_connector
= to_ast_connector(connector
);
742 struct ast_private
*ast
= connector
->dev
->dev_private
;
746 if (ast
->tx_chip_type
== AST_TX_DP501
) {
747 ast
->dp501_maxclk
= 0xff;
748 edid
= kmalloc(128, GFP_KERNEL
);
752 flags
= ast_dp501_read_edid(connector
->dev
, (u8
*)edid
);
754 ast
->dp501_maxclk
= ast_get_dp501_max_clk(connector
->dev
);
759 edid
= drm_get_edid(connector
, &ast_connector
->i2c
->adapter
);
761 drm_connector_update_edid_property(&ast_connector
->base
, edid
);
762 ret
= drm_add_edid_modes(connector
, edid
);
766 drm_connector_update_edid_property(&ast_connector
->base
, NULL
);
770 static enum drm_mode_status
ast_mode_valid(struct drm_connector
*connector
,
771 struct drm_display_mode
*mode
)
773 struct ast_private
*ast
= connector
->dev
->dev_private
;
774 int flags
= MODE_NOMODE
;
777 if (ast
->support_wide_screen
) {
778 if ((mode
->hdisplay
== 1680) && (mode
->vdisplay
== 1050))
780 if ((mode
->hdisplay
== 1280) && (mode
->vdisplay
== 800))
782 if ((mode
->hdisplay
== 1440) && (mode
->vdisplay
== 900))
784 if ((mode
->hdisplay
== 1360) && (mode
->vdisplay
== 768))
786 if ((mode
->hdisplay
== 1600) && (mode
->vdisplay
== 900))
789 if ((ast
->chip
== AST2100
) || (ast
->chip
== AST2200
) ||
790 (ast
->chip
== AST2300
) || (ast
->chip
== AST2400
) ||
791 (ast
->chip
== AST2500
) || (ast
->chip
== AST1180
)) {
792 if ((mode
->hdisplay
== 1920) && (mode
->vdisplay
== 1080))
795 if ((mode
->hdisplay
== 1920) && (mode
->vdisplay
== 1200)) {
796 jtemp
= ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xd1, 0xff);
804 switch (mode
->hdisplay
) {
806 if (mode
->vdisplay
== 480) flags
= MODE_OK
;
809 if (mode
->vdisplay
== 600) flags
= MODE_OK
;
812 if (mode
->vdisplay
== 768) flags
= MODE_OK
;
815 if (mode
->vdisplay
== 1024) flags
= MODE_OK
;
818 if (mode
->vdisplay
== 1200) flags
= MODE_OK
;
827 static void ast_connector_destroy(struct drm_connector
*connector
)
829 struct ast_connector
*ast_connector
= to_ast_connector(connector
);
830 ast_i2c_destroy(ast_connector
->i2c
);
831 drm_connector_unregister(connector
);
832 drm_connector_cleanup(connector
);
836 static const struct drm_connector_helper_funcs ast_connector_helper_funcs
= {
837 .mode_valid
= ast_mode_valid
,
838 .get_modes
= ast_get_modes
,
841 static const struct drm_connector_funcs ast_connector_funcs
= {
842 .dpms
= drm_helper_connector_dpms
,
843 .fill_modes
= drm_helper_probe_single_connector_modes
,
844 .destroy
= ast_connector_destroy
,
847 static int ast_connector_init(struct drm_device
*dev
)
849 struct ast_connector
*ast_connector
;
850 struct drm_connector
*connector
;
851 struct drm_encoder
*encoder
;
853 ast_connector
= kzalloc(sizeof(struct ast_connector
), GFP_KERNEL
);
857 connector
= &ast_connector
->base
;
858 ast_connector
->i2c
= ast_i2c_create(dev
);
859 if (!ast_connector
->i2c
)
860 DRM_ERROR("failed to add ddc bus for connector\n");
862 drm_connector_init_with_ddc(dev
, connector
,
863 &ast_connector_funcs
,
864 DRM_MODE_CONNECTOR_VGA
,
865 &ast_connector
->i2c
->adapter
);
867 drm_connector_helper_add(connector
, &ast_connector_helper_funcs
);
869 connector
->interlace_allowed
= 0;
870 connector
->doublescan_allowed
= 0;
872 drm_connector_register(connector
);
874 connector
->polled
= DRM_CONNECTOR_POLL_CONNECT
;
876 encoder
= list_first_entry(&dev
->mode_config
.encoder_list
, struct drm_encoder
, head
);
877 drm_connector_attach_encoder(connector
, encoder
);
882 /* allocate cursor cache and pin at start of VRAM */
883 static int ast_cursor_init(struct drm_device
*dev
)
885 struct ast_private
*ast
= dev
->dev_private
;
888 struct drm_gem_object
*obj
;
889 struct drm_gem_vram_object
*gbo
;
893 size
= (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
) * AST_DEFAULT_HWC_NUM
;
895 ret
= ast_gem_create(dev
, size
, true, &obj
);
898 gbo
= drm_gem_vram_of_gem(obj
);
899 ret
= drm_gem_vram_pin(gbo
, DRM_GEM_VRAM_PL_FLAG_VRAM
);
902 gpu_addr
= drm_gem_vram_offset(gbo
);
904 drm_gem_vram_unpin(gbo
);
909 /* kmap the object */
910 base
= drm_gem_vram_kmap(gbo
, true, NULL
);
916 ast
->cursor_cache
= obj
;
922 static void ast_cursor_fini(struct drm_device
*dev
)
924 struct ast_private
*ast
= dev
->dev_private
;
925 struct drm_gem_vram_object
*gbo
=
926 drm_gem_vram_of_gem(ast
->cursor_cache
);
927 drm_gem_vram_kunmap(gbo
);
928 drm_gem_vram_unpin(gbo
);
929 drm_gem_object_put_unlocked(ast
->cursor_cache
);
932 int ast_mode_init(struct drm_device
*dev
)
934 ast_cursor_init(dev
);
936 ast_encoder_init(dev
);
937 ast_connector_init(dev
);
941 void ast_mode_fini(struct drm_device
*dev
)
943 ast_cursor_fini(dev
);
946 static int get_clock(void *i2c_priv
)
948 struct ast_i2c_chan
*i2c
= i2c_priv
;
949 struct ast_private
*ast
= i2c
->dev
->dev_private
;
950 uint32_t val
, val2
, count
, pass
;
954 val
= (ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x10) >> 4) & 0x01;
956 val2
= (ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x10) >> 4) & 0x01;
961 val
= (ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x10) >> 4) & 0x01;
963 } while ((pass
< 5) && (count
++ < 0x10000));
965 return val
& 1 ? 1 : 0;
968 static int get_data(void *i2c_priv
)
970 struct ast_i2c_chan
*i2c
= i2c_priv
;
971 struct ast_private
*ast
= i2c
->dev
->dev_private
;
972 uint32_t val
, val2
, count
, pass
;
976 val
= (ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x20) >> 5) & 0x01;
978 val2
= (ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x20) >> 5) & 0x01;
983 val
= (ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x20) >> 5) & 0x01;
985 } while ((pass
< 5) && (count
++ < 0x10000));
987 return val
& 1 ? 1 : 0;
990 static void set_clock(void *i2c_priv
, int clock
)
992 struct ast_i2c_chan
*i2c
= i2c_priv
;
993 struct ast_private
*ast
= i2c
->dev
->dev_private
;
997 for (i
= 0; i
< 0x10000; i
++) {
998 ujcrb7
= ((clock
& 0x01) ? 0 : 1);
999 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0xf4, ujcrb7
);
1000 jtemp
= ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x01);
1001 if (ujcrb7
== jtemp
)
1006 static void set_data(void *i2c_priv
, int data
)
1008 struct ast_i2c_chan
*i2c
= i2c_priv
;
1009 struct ast_private
*ast
= i2c
->dev
->dev_private
;
1013 for (i
= 0; i
< 0x10000; i
++) {
1014 ujcrb7
= ((data
& 0x01) ? 0 : 1) << 2;
1015 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0xf1, ujcrb7
);
1016 jtemp
= ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x04);
1017 if (ujcrb7
== jtemp
)
1022 static struct ast_i2c_chan
*ast_i2c_create(struct drm_device
*dev
)
1024 struct ast_i2c_chan
*i2c
;
1027 i2c
= kzalloc(sizeof(struct ast_i2c_chan
), GFP_KERNEL
);
1031 i2c
->adapter
.owner
= THIS_MODULE
;
1032 i2c
->adapter
.class = I2C_CLASS_DDC
;
1033 i2c
->adapter
.dev
.parent
= &dev
->pdev
->dev
;
1035 i2c_set_adapdata(&i2c
->adapter
, i2c
);
1036 snprintf(i2c
->adapter
.name
, sizeof(i2c
->adapter
.name
),
1038 i2c
->adapter
.algo_data
= &i2c
->bit
;
1040 i2c
->bit
.udelay
= 20;
1041 i2c
->bit
.timeout
= 2;
1042 i2c
->bit
.data
= i2c
;
1043 i2c
->bit
.setsda
= set_data
;
1044 i2c
->bit
.setscl
= set_clock
;
1045 i2c
->bit
.getsda
= get_data
;
1046 i2c
->bit
.getscl
= get_clock
;
1047 ret
= i2c_bit_add_bus(&i2c
->adapter
);
1049 DRM_ERROR("Failed to register bit i2c\n");
1059 static void ast_i2c_destroy(struct ast_i2c_chan
*i2c
)
1063 i2c_del_adapter(&i2c
->adapter
);
1067 static void ast_show_cursor(struct drm_crtc
*crtc
)
1069 struct ast_private
*ast
= crtc
->dev
->dev_private
;
1073 /* enable ARGB cursor */
1075 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xcb, 0xfc, jreg
);
1078 static void ast_hide_cursor(struct drm_crtc
*crtc
)
1080 struct ast_private
*ast
= crtc
->dev
->dev_private
;
1081 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xcb, 0xfc, 0x00);
1084 static u32
copy_cursor_image(u8
*src
, u8
*dst
, int width
, int height
)
1089 } srcdata32
[2], data32
;
1095 s32 alpha_dst_delta
, last_alpha_dst_delta
;
1096 u8
*srcxor
, *dstxor
;
1098 u32 per_pixel_copy
, two_pixel_copy
;
1100 alpha_dst_delta
= AST_MAX_HWC_WIDTH
<< 1;
1101 last_alpha_dst_delta
= alpha_dst_delta
- (width
<< 1);
1104 dstxor
= (u8
*)dst
+ last_alpha_dst_delta
+ (AST_MAX_HWC_HEIGHT
- height
) * alpha_dst_delta
;
1105 per_pixel_copy
= width
& 1;
1106 two_pixel_copy
= width
>> 1;
1108 for (j
= 0; j
< height
; j
++) {
1109 for (i
= 0; i
< two_pixel_copy
; i
++) {
1110 srcdata32
[0].ul
= *((u32
*)srcxor
) & 0xf0f0f0f0;
1111 srcdata32
[1].ul
= *((u32
*)(srcxor
+ 4)) & 0xf0f0f0f0;
1112 data32
.b
[0] = srcdata32
[0].b
[1] | (srcdata32
[0].b
[0] >> 4);
1113 data32
.b
[1] = srcdata32
[0].b
[3] | (srcdata32
[0].b
[2] >> 4);
1114 data32
.b
[2] = srcdata32
[1].b
[1] | (srcdata32
[1].b
[0] >> 4);
1115 data32
.b
[3] = srcdata32
[1].b
[3] | (srcdata32
[1].b
[2] >> 4);
1117 writel(data32
.ul
, dstxor
);
1125 for (i
= 0; i
< per_pixel_copy
; i
++) {
1126 srcdata32
[0].ul
= *((u32
*)srcxor
) & 0xf0f0f0f0;
1127 data16
.b
[0] = srcdata32
[0].b
[1] | (srcdata32
[0].b
[0] >> 4);
1128 data16
.b
[1] = srcdata32
[0].b
[3] | (srcdata32
[0].b
[2] >> 4);
1129 writew(data16
.us
, dstxor
);
1130 csum
+= (u32
)data16
.us
;
1135 dstxor
+= last_alpha_dst_delta
;
1140 static int ast_cursor_set(struct drm_crtc
*crtc
,
1141 struct drm_file
*file_priv
,
1146 struct ast_private
*ast
= crtc
->dev
->dev_private
;
1147 struct ast_crtc
*ast_crtc
= to_ast_crtc(crtc
);
1148 struct drm_gem_object
*obj
;
1149 struct drm_gem_vram_object
*gbo
;
1157 ast_hide_cursor(crtc
);
1161 if (width
> AST_MAX_HWC_WIDTH
|| height
> AST_MAX_HWC_HEIGHT
)
1164 obj
= drm_gem_object_lookup(file_priv
, handle
);
1166 DRM_ERROR("Cannot find cursor object %x for crtc\n", handle
);
1169 gbo
= drm_gem_vram_of_gem(obj
);
1170 src
= drm_gem_vram_vmap(gbo
);
1173 goto err_drm_gem_object_put_unlocked
;
1176 dst
= drm_gem_vram_kmap(drm_gem_vram_of_gem(ast
->cursor_cache
),
1180 goto err_drm_gem_vram_vunmap
;
1182 dst_gpu
= drm_gem_vram_offset(drm_gem_vram_of_gem(ast
->cursor_cache
));
1185 goto err_drm_gem_vram_vunmap
;
1188 dst
+= (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
)*ast
->next_cursor
;
1190 /* do data transfer to cursor cache */
1191 csum
= copy_cursor_image(src
, dst
, width
, height
);
1193 /* write checksum + signature */
1195 struct drm_gem_vram_object
*dst_gbo
=
1196 drm_gem_vram_of_gem(ast
->cursor_cache
);
1197 u8
*dst
= drm_gem_vram_kmap(dst_gbo
, false, NULL
);
1198 dst
+= (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
)*ast
->next_cursor
+ AST_HWC_SIZE
;
1200 writel(width
, dst
+ AST_HWC_SIGNATURE_SizeX
);
1201 writel(height
, dst
+ AST_HWC_SIGNATURE_SizeY
);
1202 writel(0, dst
+ AST_HWC_SIGNATURE_HOTSPOTX
);
1203 writel(0, dst
+ AST_HWC_SIGNATURE_HOTSPOTY
);
1205 /* set pattern offset */
1206 gpu_addr
= (u64
)dst_gpu
;
1207 gpu_addr
+= (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
)*ast
->next_cursor
;
1209 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc8, gpu_addr
& 0xff);
1210 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc9, (gpu_addr
>> 8) & 0xff);
1211 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xca, (gpu_addr
>> 16) & 0xff);
1213 ast_crtc
->offset_x
= AST_MAX_HWC_WIDTH
- width
;
1214 ast_crtc
->offset_y
= AST_MAX_HWC_WIDTH
- height
;
1216 ast
->next_cursor
= (ast
->next_cursor
+ 1) % AST_DEFAULT_HWC_NUM
;
1218 ast_show_cursor(crtc
);
1220 drm_gem_vram_vunmap(gbo
, src
);
1221 drm_gem_object_put_unlocked(obj
);
1225 err_drm_gem_vram_vunmap
:
1226 drm_gem_vram_vunmap(gbo
, src
);
1227 err_drm_gem_object_put_unlocked
:
1228 drm_gem_object_put_unlocked(obj
);
1232 static int ast_cursor_move(struct drm_crtc
*crtc
,
1235 struct ast_crtc
*ast_crtc
= to_ast_crtc(crtc
);
1236 struct ast_private
*ast
= crtc
->dev
->dev_private
;
1237 int x_offset
, y_offset
;
1240 sig
= drm_gem_vram_kmap(drm_gem_vram_of_gem(ast
->cursor_cache
),
1242 sig
+= (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
)*ast
->next_cursor
+ AST_HWC_SIZE
;
1243 writel(x
, sig
+ AST_HWC_SIGNATURE_X
);
1244 writel(y
, sig
+ AST_HWC_SIGNATURE_Y
);
1246 x_offset
= ast_crtc
->offset_x
;
1247 y_offset
= ast_crtc
->offset_y
;
1249 x_offset
= (-x
) + ast_crtc
->offset_x
;
1254 y_offset
= (-y
) + ast_crtc
->offset_y
;
1257 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc2, x_offset
);
1258 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc3, y_offset
);
1259 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc4, (x
& 0xff));
1260 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc5, ((x
>> 8) & 0x0f));
1261 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc6, (y
& 0xff));
1262 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc7, ((y
>> 8) & 0x07));
1264 /* dummy write to fire HWC */
1265 ast_show_cursor(crtc
);