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>
34 #include <drm/drm_plane_helper.h>
37 #include "ast_tables.h"
39 static struct ast_i2c_chan
*ast_i2c_create(struct drm_device
*dev
);
40 static void ast_i2c_destroy(struct ast_i2c_chan
*i2c
);
41 static int ast_cursor_set(struct drm_crtc
*crtc
,
42 struct drm_file
*file_priv
,
46 static int ast_cursor_move(struct drm_crtc
*crtc
,
49 static inline void ast_load_palette_index(struct ast_private
*ast
,
50 u8 index
, u8 red
, u8 green
,
53 ast_io_write8(ast
, AST_IO_DAC_INDEX_WRITE
, index
);
54 ast_io_read8(ast
, AST_IO_SEQ_PORT
);
55 ast_io_write8(ast
, AST_IO_DAC_DATA
, red
);
56 ast_io_read8(ast
, AST_IO_SEQ_PORT
);
57 ast_io_write8(ast
, AST_IO_DAC_DATA
, green
);
58 ast_io_read8(ast
, AST_IO_SEQ_PORT
);
59 ast_io_write8(ast
, AST_IO_DAC_DATA
, blue
);
60 ast_io_read8(ast
, AST_IO_SEQ_PORT
);
63 static void ast_crtc_load_lut(struct drm_crtc
*crtc
)
65 struct ast_private
*ast
= crtc
->dev
->dev_private
;
66 struct ast_crtc
*ast_crtc
= to_ast_crtc(crtc
);
72 for (i
= 0; i
< 256; i
++)
73 ast_load_palette_index(ast
, i
, ast_crtc
->lut_r
[i
],
74 ast_crtc
->lut_g
[i
], ast_crtc
->lut_b
[i
]);
77 static bool ast_get_vbios_mode_info(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
78 struct drm_display_mode
*adjusted_mode
,
79 struct ast_vbios_mode_info
*vbios_mode
)
81 struct ast_private
*ast
= crtc
->dev
->dev_private
;
82 u32 refresh_rate_index
= 0, mode_id
, color_index
, refresh_rate
;
85 struct ast_vbios_enhtable
*best
= NULL
;
87 switch (crtc
->primary
->fb
->bits_per_pixel
) {
89 vbios_mode
->std_table
= &vbios_stdtable
[VGAModeIndex
];
90 color_index
= VGAModeIndex
- 1;
93 vbios_mode
->std_table
= &vbios_stdtable
[HiCModeIndex
];
94 color_index
= HiCModeIndex
;
98 vbios_mode
->std_table
= &vbios_stdtable
[TrueCModeIndex
];
99 color_index
= TrueCModeIndex
;
105 switch (crtc
->mode
.crtc_hdisplay
) {
107 vbios_mode
->enh_table
= &res_640x480
[refresh_rate_index
];
110 vbios_mode
->enh_table
= &res_800x600
[refresh_rate_index
];
113 vbios_mode
->enh_table
= &res_1024x768
[refresh_rate_index
];
116 if (crtc
->mode
.crtc_vdisplay
== 800)
117 vbios_mode
->enh_table
= &res_1280x800
[refresh_rate_index
];
119 vbios_mode
->enh_table
= &res_1280x1024
[refresh_rate_index
];
122 vbios_mode
->enh_table
= &res_1360x768
[refresh_rate_index
];
125 vbios_mode
->enh_table
= &res_1440x900
[refresh_rate_index
];
128 if (crtc
->mode
.crtc_vdisplay
== 900)
129 vbios_mode
->enh_table
= &res_1600x900
[refresh_rate_index
];
131 vbios_mode
->enh_table
= &res_1600x1200
[refresh_rate_index
];
134 vbios_mode
->enh_table
= &res_1680x1050
[refresh_rate_index
];
137 if (crtc
->mode
.crtc_vdisplay
== 1080)
138 vbios_mode
->enh_table
= &res_1920x1080
[refresh_rate_index
];
140 vbios_mode
->enh_table
= &res_1920x1200
[refresh_rate_index
];
146 refresh_rate
= drm_mode_vrefresh(mode
);
147 check_sync
= vbios_mode
->enh_table
->flags
& WideScreenMode
;
149 struct ast_vbios_enhtable
*loop
= vbios_mode
->enh_table
;
151 while (loop
->refresh_rate
!= 0xff) {
153 (((mode
->flags
& DRM_MODE_FLAG_NVSYNC
) &&
154 (loop
->flags
& PVSync
)) ||
155 ((mode
->flags
& DRM_MODE_FLAG_PVSYNC
) &&
156 (loop
->flags
& NVSync
)) ||
157 ((mode
->flags
& DRM_MODE_FLAG_NHSYNC
) &&
158 (loop
->flags
& PHSync
)) ||
159 ((mode
->flags
& DRM_MODE_FLAG_PHSYNC
) &&
160 (loop
->flags
& NHSync
)))) {
164 if (loop
->refresh_rate
<= refresh_rate
165 && (!best
|| loop
->refresh_rate
> best
->refresh_rate
))
169 if (best
|| !check_sync
)
174 vbios_mode
->enh_table
= best
;
176 hborder
= (vbios_mode
->enh_table
->flags
& HBorder
) ? 8 : 0;
177 vborder
= (vbios_mode
->enh_table
->flags
& VBorder
) ? 8 : 0;
179 adjusted_mode
->crtc_htotal
= vbios_mode
->enh_table
->ht
;
180 adjusted_mode
->crtc_hblank_start
= vbios_mode
->enh_table
->hde
+ hborder
;
181 adjusted_mode
->crtc_hblank_end
= vbios_mode
->enh_table
->ht
- hborder
;
182 adjusted_mode
->crtc_hsync_start
= vbios_mode
->enh_table
->hde
+ hborder
+
183 vbios_mode
->enh_table
->hfp
;
184 adjusted_mode
->crtc_hsync_end
= (vbios_mode
->enh_table
->hde
+ hborder
+
185 vbios_mode
->enh_table
->hfp
+
186 vbios_mode
->enh_table
->hsync
);
188 adjusted_mode
->crtc_vtotal
= vbios_mode
->enh_table
->vt
;
189 adjusted_mode
->crtc_vblank_start
= vbios_mode
->enh_table
->vde
+ vborder
;
190 adjusted_mode
->crtc_vblank_end
= vbios_mode
->enh_table
->vt
- vborder
;
191 adjusted_mode
->crtc_vsync_start
= vbios_mode
->enh_table
->vde
+ vborder
+
192 vbios_mode
->enh_table
->vfp
;
193 adjusted_mode
->crtc_vsync_end
= (vbios_mode
->enh_table
->vde
+ vborder
+
194 vbios_mode
->enh_table
->vfp
+
195 vbios_mode
->enh_table
->vsync
);
197 refresh_rate_index
= vbios_mode
->enh_table
->refresh_rate_index
;
198 mode_id
= vbios_mode
->enh_table
->mode_id
;
200 if (ast
->chip
== AST1180
) {
203 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x8c, (u8
)((color_index
& 0xf) << 4));
204 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x8d, refresh_rate_index
& 0xff);
205 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x8e, mode_id
& 0xff);
207 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x91, 0x00);
208 if (vbios_mode
->enh_table
->flags
& NewModeInfo
) {
209 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x91, 0xa8);
210 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x92, crtc
->primary
->fb
->bits_per_pixel
);
211 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x93, adjusted_mode
->clock
/ 1000);
212 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x94, adjusted_mode
->crtc_hdisplay
);
213 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x95, adjusted_mode
->crtc_hdisplay
>> 8);
215 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x96, adjusted_mode
->crtc_vdisplay
);
216 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x97, adjusted_mode
->crtc_vdisplay
>> 8);
224 static void ast_set_std_reg(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
225 struct ast_vbios_mode_info
*vbios_mode
)
227 struct ast_private
*ast
= crtc
->dev
->dev_private
;
228 struct ast_vbios_stdtable
*stdtable
;
232 stdtable
= vbios_mode
->std_table
;
234 jreg
= stdtable
->misc
;
235 ast_io_write8(ast
, AST_IO_MISC_PORT_WRITE
, jreg
);
238 ast_set_index_reg(ast
, AST_IO_SEQ_PORT
, 0x00, 0x03);
239 for (i
= 0; i
< 4; i
++) {
240 jreg
= stdtable
->seq
[i
];
243 ast_set_index_reg(ast
, AST_IO_SEQ_PORT
, (i
+ 1) , jreg
);
247 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x11, 0x7f, 0x00);
248 for (i
= 0; i
< 25; i
++)
249 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, i
, stdtable
->crtc
[i
]);
252 jreg
= ast_io_read8(ast
, AST_IO_INPUT_STATUS1_READ
);
253 for (i
= 0; i
< 20; i
++) {
254 jreg
= stdtable
->ar
[i
];
255 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, (u8
)i
);
256 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, jreg
);
258 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, 0x14);
259 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, 0x00);
261 jreg
= ast_io_read8(ast
, AST_IO_INPUT_STATUS1_READ
);
262 ast_io_write8(ast
, AST_IO_AR_PORT_WRITE
, 0x20);
265 for (i
= 0; i
< 9; i
++)
266 ast_set_index_reg(ast
, AST_IO_GR_PORT
, i
, stdtable
->gr
[i
]);
269 static void ast_set_crtc_reg(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
270 struct ast_vbios_mode_info
*vbios_mode
)
272 struct ast_private
*ast
= crtc
->dev
->dev_private
;
273 u8 jreg05
= 0, jreg07
= 0, jreg09
= 0, jregAC
= 0, jregAD
= 0, jregAE
= 0;
276 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x11, 0x7f, 0x00);
278 temp
= (mode
->crtc_htotal
>> 3) - 5;
280 jregAC
|= 0x01; /* HT D[8] */
281 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x00, 0x00, temp
);
283 temp
= (mode
->crtc_hdisplay
>> 3) - 1;
285 jregAC
|= 0x04; /* HDE D[8] */
286 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x01, 0x00, temp
);
288 temp
= (mode
->crtc_hblank_start
>> 3) - 1;
290 jregAC
|= 0x10; /* HBS D[8] */
291 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x02, 0x00, temp
);
293 temp
= ((mode
->crtc_hblank_end
>> 3) - 1) & 0x7f;
295 jreg05
|= 0x80; /* HBE D[5] */
297 jregAD
|= 0x01; /* HBE D[5] */
298 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x03, 0xE0, (temp
& 0x1f));
300 temp
= (mode
->crtc_hsync_start
>> 3) - 1;
302 jregAC
|= 0x40; /* HRS D[5] */
303 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x04, 0x00, temp
);
305 temp
= ((mode
->crtc_hsync_end
>> 3) - 1) & 0x3f;
307 jregAD
|= 0x04; /* HRE D[5] */
308 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x05, 0x60, (u8
)((temp
& 0x1f) | jreg05
));
310 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xAC, 0x00, jregAC
);
311 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xAD, 0x00, jregAD
);
314 temp
= (mode
->crtc_vtotal
) - 2;
321 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x06, 0x00, temp
);
323 temp
= (mode
->crtc_vsync_start
) - 1;
330 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x10, 0x00, temp
);
332 temp
= (mode
->crtc_vsync_end
- 1) & 0x3f;
337 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x11, 0x70, temp
& 0xf);
339 temp
= mode
->crtc_vdisplay
- 1;
346 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x12, 0x00, temp
);
348 temp
= mode
->crtc_vblank_start
- 1;
355 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x15, 0x00, temp
);
357 temp
= mode
->crtc_vblank_end
- 1;
360 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x16, 0x00, temp
);
362 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x07, 0x00, jreg07
);
363 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x09, 0xdf, jreg09
);
364 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xAE, 0x00, (jregAE
| 0x80));
366 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0x11, 0x7f, 0x80);
369 static void ast_set_offset_reg(struct drm_crtc
*crtc
)
371 struct ast_private
*ast
= crtc
->dev
->dev_private
;
375 offset
= crtc
->primary
->fb
->pitches
[0] >> 3;
376 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x13, (offset
& 0xff));
377 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xb0, (offset
>> 8) & 0x3f);
380 static void ast_set_dclk_reg(struct drm_device
*dev
, struct drm_display_mode
*mode
,
381 struct ast_vbios_mode_info
*vbios_mode
)
383 struct ast_private
*ast
= dev
->dev_private
;
384 struct ast_vbios_dclk_info
*clk_info
;
386 clk_info
= &dclk_table
[vbios_mode
->enh_table
->dclk_index
];
388 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xc0, 0x00, clk_info
->param1
);
389 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xc1, 0x00, clk_info
->param2
);
390 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xbb, 0x0f,
391 (clk_info
->param3
& 0x80) | ((clk_info
->param3
& 0x3) << 4));
394 static void ast_set_ext_reg(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
395 struct ast_vbios_mode_info
*vbios_mode
)
397 struct ast_private
*ast
= crtc
->dev
->dev_private
;
398 u8 jregA0
= 0, jregA3
= 0, jregA8
= 0;
400 switch (crtc
->primary
->fb
->bits_per_pixel
) {
419 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xa0, 0x8f, jregA0
);
420 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xa3, 0xf0, jregA3
);
421 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xa8, 0xfd, jregA8
);
424 if (ast
->chip
== AST2300
|| ast
->chip
== AST2400
) {
425 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa7, 0x78);
426 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa6, 0x60);
427 } else if (ast
->chip
== AST2100
||
428 ast
->chip
== AST1100
||
429 ast
->chip
== AST2200
||
430 ast
->chip
== AST2150
) {
431 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa7, 0x3f);
432 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa6, 0x2f);
434 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa7, 0x2f);
435 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xa6, 0x1f);
439 static void ast_set_sync_reg(struct drm_device
*dev
, struct drm_display_mode
*mode
,
440 struct ast_vbios_mode_info
*vbios_mode
)
442 struct ast_private
*ast
= dev
->dev_private
;
445 jreg
= ast_io_read8(ast
, AST_IO_MISC_PORT_READ
);
447 if (vbios_mode
->enh_table
->flags
& NVSync
) jreg
|= 0x80;
448 if (vbios_mode
->enh_table
->flags
& NHSync
) jreg
|= 0x40;
449 ast_io_write8(ast
, AST_IO_MISC_PORT_WRITE
, jreg
);
452 static bool ast_set_dac_reg(struct drm_crtc
*crtc
, struct drm_display_mode
*mode
,
453 struct ast_vbios_mode_info
*vbios_mode
)
455 switch (crtc
->primary
->fb
->bits_per_pixel
) {
464 static void ast_set_start_address_crt1(struct drm_crtc
*crtc
, unsigned offset
)
466 struct ast_private
*ast
= crtc
->dev
->dev_private
;
470 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x0d, (u8
)(addr
& 0xff));
471 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0x0c, (u8
)((addr
>> 8) & 0xff));
472 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xaf, (u8
)((addr
>> 16) & 0xff));
476 static void ast_crtc_dpms(struct drm_crtc
*crtc
, int mode
)
478 struct ast_private
*ast
= crtc
->dev
->dev_private
;
480 if (ast
->chip
== AST1180
)
484 case DRM_MODE_DPMS_ON
:
485 case DRM_MODE_DPMS_STANDBY
:
486 case DRM_MODE_DPMS_SUSPEND
:
487 ast_set_index_reg_mask(ast
, AST_IO_SEQ_PORT
, 0x1, 0xdf, 0);
488 if (ast
->tx_chip_type
== AST_TX_DP501
)
489 ast_set_dp501_video_output(crtc
->dev
, 1);
490 ast_crtc_load_lut(crtc
);
492 case DRM_MODE_DPMS_OFF
:
493 if (ast
->tx_chip_type
== AST_TX_DP501
)
494 ast_set_dp501_video_output(crtc
->dev
, 0);
495 ast_set_index_reg_mask(ast
, AST_IO_SEQ_PORT
, 0x1, 0xdf, 0x20);
500 /* ast is different - we will force move buffers out of VRAM */
501 static int ast_crtc_do_set_base(struct drm_crtc
*crtc
,
502 struct drm_framebuffer
*fb
,
503 int x
, int y
, int atomic
)
505 struct ast_private
*ast
= crtc
->dev
->dev_private
;
506 struct drm_gem_object
*obj
;
507 struct ast_framebuffer
*ast_fb
;
512 /* push the previous fb to system ram */
514 ast_fb
= to_ast_framebuffer(fb
);
516 bo
= gem_to_ast_bo(obj
);
517 ret
= ast_bo_reserve(bo
, false);
520 ast_bo_push_sysram(bo
);
521 ast_bo_unreserve(bo
);
524 ast_fb
= to_ast_framebuffer(crtc
->primary
->fb
);
526 bo
= gem_to_ast_bo(obj
);
528 ret
= ast_bo_reserve(bo
, false);
532 ret
= ast_bo_pin(bo
, TTM_PL_FLAG_VRAM
, &gpu_addr
);
534 ast_bo_unreserve(bo
);
538 if (&ast
->fbdev
->afb
== ast_fb
) {
539 /* if pushing console in kmap it */
540 ret
= ttm_bo_kmap(&bo
->bo
, 0, bo
->bo
.num_pages
, &bo
->kmap
);
542 DRM_ERROR("failed to kmap fbcon\n");
544 ast_fbdev_set_base(ast
, gpu_addr
);
546 ast_bo_unreserve(bo
);
548 ast_set_start_address_crt1(crtc
, (u32
)gpu_addr
);
553 static int ast_crtc_mode_set_base(struct drm_crtc
*crtc
, int x
, int y
,
554 struct drm_framebuffer
*old_fb
)
556 return ast_crtc_do_set_base(crtc
, old_fb
, x
, y
, 0);
559 static int ast_crtc_mode_set(struct drm_crtc
*crtc
,
560 struct drm_display_mode
*mode
,
561 struct drm_display_mode
*adjusted_mode
,
563 struct drm_framebuffer
*old_fb
)
565 struct drm_device
*dev
= crtc
->dev
;
566 struct ast_private
*ast
= crtc
->dev
->dev_private
;
567 struct ast_vbios_mode_info vbios_mode
;
569 if (ast
->chip
== AST1180
) {
570 DRM_ERROR("AST 1180 modesetting not supported\n");
574 ret
= ast_get_vbios_mode_info(crtc
, mode
, adjusted_mode
, &vbios_mode
);
579 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xa1, 0xff, 0x04);
581 ast_set_std_reg(crtc
, adjusted_mode
, &vbios_mode
);
582 ast_set_crtc_reg(crtc
, adjusted_mode
, &vbios_mode
);
583 ast_set_offset_reg(crtc
);
584 ast_set_dclk_reg(dev
, adjusted_mode
, &vbios_mode
);
585 ast_set_ext_reg(crtc
, adjusted_mode
, &vbios_mode
);
586 ast_set_sync_reg(dev
, adjusted_mode
, &vbios_mode
);
587 ast_set_dac_reg(crtc
, adjusted_mode
, &vbios_mode
);
589 ast_crtc_mode_set_base(crtc
, x
, y
, old_fb
);
594 static void ast_crtc_disable(struct drm_crtc
*crtc
)
599 static void ast_crtc_prepare(struct drm_crtc
*crtc
)
604 static void ast_crtc_commit(struct drm_crtc
*crtc
)
606 struct ast_private
*ast
= crtc
->dev
->dev_private
;
607 ast_set_index_reg_mask(ast
, AST_IO_SEQ_PORT
, 0x1, 0xdf, 0);
611 static const struct drm_crtc_helper_funcs ast_crtc_helper_funcs
= {
612 .dpms
= ast_crtc_dpms
,
613 .mode_set
= ast_crtc_mode_set
,
614 .mode_set_base
= ast_crtc_mode_set_base
,
615 .disable
= ast_crtc_disable
,
616 .load_lut
= ast_crtc_load_lut
,
617 .prepare
= ast_crtc_prepare
,
618 .commit
= ast_crtc_commit
,
622 static void ast_crtc_reset(struct drm_crtc
*crtc
)
627 static void ast_crtc_gamma_set(struct drm_crtc
*crtc
, u16
*red
, u16
*green
,
628 u16
*blue
, uint32_t start
, uint32_t size
)
630 struct ast_crtc
*ast_crtc
= to_ast_crtc(crtc
);
631 int end
= (start
+ size
> 256) ? 256 : start
+ size
, i
;
633 /* userspace palettes are always correct as is */
634 for (i
= start
; i
< end
; i
++) {
635 ast_crtc
->lut_r
[i
] = red
[i
] >> 8;
636 ast_crtc
->lut_g
[i
] = green
[i
] >> 8;
637 ast_crtc
->lut_b
[i
] = blue
[i
] >> 8;
639 ast_crtc_load_lut(crtc
);
643 static void ast_crtc_destroy(struct drm_crtc
*crtc
)
645 drm_crtc_cleanup(crtc
);
649 static const struct drm_crtc_funcs ast_crtc_funcs
= {
650 .cursor_set
= ast_cursor_set
,
651 .cursor_move
= ast_cursor_move
,
652 .reset
= ast_crtc_reset
,
653 .set_config
= drm_crtc_helper_set_config
,
654 .gamma_set
= ast_crtc_gamma_set
,
655 .destroy
= ast_crtc_destroy
,
658 static int ast_crtc_init(struct drm_device
*dev
)
660 struct ast_crtc
*crtc
;
663 crtc
= kzalloc(sizeof(struct ast_crtc
), GFP_KERNEL
);
667 drm_crtc_init(dev
, &crtc
->base
, &ast_crtc_funcs
);
668 drm_mode_crtc_set_gamma_size(&crtc
->base
, 256);
669 drm_crtc_helper_add(&crtc
->base
, &ast_crtc_helper_funcs
);
671 for (i
= 0; i
< 256; i
++) {
679 static void ast_encoder_destroy(struct drm_encoder
*encoder
)
681 drm_encoder_cleanup(encoder
);
686 static struct drm_encoder
*ast_best_single_encoder(struct drm_connector
*connector
)
688 int enc_id
= connector
->encoder_ids
[0];
689 /* pick the encoder ids */
691 return drm_encoder_find(connector
->dev
, enc_id
);
696 static const struct drm_encoder_funcs ast_enc_funcs
= {
697 .destroy
= ast_encoder_destroy
,
700 static void ast_encoder_dpms(struct drm_encoder
*encoder
, int mode
)
705 static void ast_encoder_mode_set(struct drm_encoder
*encoder
,
706 struct drm_display_mode
*mode
,
707 struct drm_display_mode
*adjusted_mode
)
711 static void ast_encoder_prepare(struct drm_encoder
*encoder
)
716 static void ast_encoder_commit(struct drm_encoder
*encoder
)
722 static const struct drm_encoder_helper_funcs ast_enc_helper_funcs
= {
723 .dpms
= ast_encoder_dpms
,
724 .prepare
= ast_encoder_prepare
,
725 .commit
= ast_encoder_commit
,
726 .mode_set
= ast_encoder_mode_set
,
729 static int ast_encoder_init(struct drm_device
*dev
)
731 struct ast_encoder
*ast_encoder
;
733 ast_encoder
= kzalloc(sizeof(struct ast_encoder
), GFP_KERNEL
);
737 drm_encoder_init(dev
, &ast_encoder
->base
, &ast_enc_funcs
,
738 DRM_MODE_ENCODER_DAC
, NULL
);
739 drm_encoder_helper_add(&ast_encoder
->base
, &ast_enc_helper_funcs
);
741 ast_encoder
->base
.possible_crtcs
= 1;
745 static int ast_get_modes(struct drm_connector
*connector
)
747 struct ast_connector
*ast_connector
= to_ast_connector(connector
);
748 struct ast_private
*ast
= connector
->dev
->dev_private
;
752 if (ast
->tx_chip_type
== AST_TX_DP501
) {
753 ast
->dp501_maxclk
= 0xff;
754 edid
= kmalloc(128, GFP_KERNEL
);
758 flags
= ast_dp501_read_edid(connector
->dev
, (u8
*)edid
);
760 ast
->dp501_maxclk
= ast_get_dp501_max_clk(connector
->dev
);
765 edid
= drm_get_edid(connector
, &ast_connector
->i2c
->adapter
);
767 drm_mode_connector_update_edid_property(&ast_connector
->base
, edid
);
768 ret
= drm_add_edid_modes(connector
, edid
);
772 drm_mode_connector_update_edid_property(&ast_connector
->base
, NULL
);
776 static int ast_mode_valid(struct drm_connector
*connector
,
777 struct drm_display_mode
*mode
)
779 struct ast_private
*ast
= connector
->dev
->dev_private
;
780 int flags
= MODE_NOMODE
;
783 if (ast
->support_wide_screen
) {
784 if ((mode
->hdisplay
== 1680) && (mode
->vdisplay
== 1050))
786 if ((mode
->hdisplay
== 1280) && (mode
->vdisplay
== 800))
788 if ((mode
->hdisplay
== 1440) && (mode
->vdisplay
== 900))
790 if ((mode
->hdisplay
== 1360) && (mode
->vdisplay
== 768))
792 if ((mode
->hdisplay
== 1600) && (mode
->vdisplay
== 900))
795 if ((ast
->chip
== AST2100
) || (ast
->chip
== AST2200
) || (ast
->chip
== AST2300
) || (ast
->chip
== AST2400
) || (ast
->chip
== AST1180
)) {
796 if ((mode
->hdisplay
== 1920) && (mode
->vdisplay
== 1080))
799 if ((mode
->hdisplay
== 1920) && (mode
->vdisplay
== 1200)) {
800 jtemp
= ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xd1, 0xff);
808 switch (mode
->hdisplay
) {
810 if (mode
->vdisplay
== 480) flags
= MODE_OK
;
813 if (mode
->vdisplay
== 600) flags
= MODE_OK
;
816 if (mode
->vdisplay
== 768) flags
= MODE_OK
;
819 if (mode
->vdisplay
== 1024) flags
= MODE_OK
;
822 if (mode
->vdisplay
== 1200) flags
= MODE_OK
;
831 static void ast_connector_destroy(struct drm_connector
*connector
)
833 struct ast_connector
*ast_connector
= to_ast_connector(connector
);
834 ast_i2c_destroy(ast_connector
->i2c
);
835 drm_connector_unregister(connector
);
836 drm_connector_cleanup(connector
);
840 static enum drm_connector_status
841 ast_connector_detect(struct drm_connector
*connector
, bool force
)
843 return connector_status_connected
;
846 static const struct drm_connector_helper_funcs ast_connector_helper_funcs
= {
847 .mode_valid
= ast_mode_valid
,
848 .get_modes
= ast_get_modes
,
849 .best_encoder
= ast_best_single_encoder
,
852 static const struct drm_connector_funcs ast_connector_funcs
= {
853 .dpms
= drm_helper_connector_dpms
,
854 .detect
= ast_connector_detect
,
855 .fill_modes
= drm_helper_probe_single_connector_modes
,
856 .destroy
= ast_connector_destroy
,
859 static int ast_connector_init(struct drm_device
*dev
)
861 struct ast_connector
*ast_connector
;
862 struct drm_connector
*connector
;
863 struct drm_encoder
*encoder
;
865 ast_connector
= kzalloc(sizeof(struct ast_connector
), GFP_KERNEL
);
869 connector
= &ast_connector
->base
;
870 drm_connector_init(dev
, connector
, &ast_connector_funcs
, DRM_MODE_CONNECTOR_VGA
);
872 drm_connector_helper_add(connector
, &ast_connector_helper_funcs
);
874 connector
->interlace_allowed
= 0;
875 connector
->doublescan_allowed
= 0;
877 drm_connector_register(connector
);
879 connector
->polled
= DRM_CONNECTOR_POLL_CONNECT
;
881 encoder
= list_first_entry(&dev
->mode_config
.encoder_list
, struct drm_encoder
, head
);
882 drm_mode_connector_attach_encoder(connector
, encoder
);
884 ast_connector
->i2c
= ast_i2c_create(dev
);
885 if (!ast_connector
->i2c
)
886 DRM_ERROR("failed to add ddc bus for connector\n");
891 /* allocate cursor cache and pin at start of VRAM */
892 static int ast_cursor_init(struct drm_device
*dev
)
894 struct ast_private
*ast
= dev
->dev_private
;
897 struct drm_gem_object
*obj
;
901 size
= (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
) * AST_DEFAULT_HWC_NUM
;
903 ret
= ast_gem_create(dev
, size
, true, &obj
);
906 bo
= gem_to_ast_bo(obj
);
907 ret
= ast_bo_reserve(bo
, false);
908 if (unlikely(ret
!= 0))
911 ret
= ast_bo_pin(bo
, TTM_PL_FLAG_VRAM
, &gpu_addr
);
912 ast_bo_unreserve(bo
);
916 /* kmap the object */
917 ret
= ttm_bo_kmap(&bo
->bo
, 0, bo
->bo
.num_pages
, &ast
->cache_kmap
);
921 ast
->cursor_cache
= obj
;
922 ast
->cursor_cache_gpu_addr
= gpu_addr
;
923 DRM_DEBUG_KMS("pinned cursor cache at %llx\n", ast
->cursor_cache_gpu_addr
);
929 static void ast_cursor_fini(struct drm_device
*dev
)
931 struct ast_private
*ast
= dev
->dev_private
;
932 ttm_bo_kunmap(&ast
->cache_kmap
);
933 drm_gem_object_unreference_unlocked(ast
->cursor_cache
);
936 int ast_mode_init(struct drm_device
*dev
)
938 ast_cursor_init(dev
);
940 ast_encoder_init(dev
);
941 ast_connector_init(dev
);
945 void ast_mode_fini(struct drm_device
*dev
)
947 ast_cursor_fini(dev
);
950 static int get_clock(void *i2c_priv
)
952 struct ast_i2c_chan
*i2c
= i2c_priv
;
953 struct ast_private
*ast
= i2c
->dev
->dev_private
;
956 val
= ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x10) >> 4;
957 return val
& 1 ? 1 : 0;
960 static int get_data(void *i2c_priv
)
962 struct ast_i2c_chan
*i2c
= i2c_priv
;
963 struct ast_private
*ast
= i2c
->dev
->dev_private
;
966 val
= ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x20) >> 5;
967 return val
& 1 ? 1 : 0;
970 static void set_clock(void *i2c_priv
, int clock
)
972 struct ast_i2c_chan
*i2c
= i2c_priv
;
973 struct ast_private
*ast
= i2c
->dev
->dev_private
;
977 for (i
= 0; i
< 0x10000; i
++) {
978 ujcrb7
= ((clock
& 0x01) ? 0 : 1);
979 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0xfe, ujcrb7
);
980 jtemp
= ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x01);
986 static void set_data(void *i2c_priv
, int data
)
988 struct ast_i2c_chan
*i2c
= i2c_priv
;
989 struct ast_private
*ast
= i2c
->dev
->dev_private
;
993 for (i
= 0; i
< 0x10000; i
++) {
994 ujcrb7
= ((data
& 0x01) ? 0 : 1) << 2;
995 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0xfb, ujcrb7
);
996 jtemp
= ast_get_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xb7, 0x04);
1002 static struct ast_i2c_chan
*ast_i2c_create(struct drm_device
*dev
)
1004 struct ast_i2c_chan
*i2c
;
1007 i2c
= kzalloc(sizeof(struct ast_i2c_chan
), GFP_KERNEL
);
1011 i2c
->adapter
.owner
= THIS_MODULE
;
1012 i2c
->adapter
.class = I2C_CLASS_DDC
;
1013 i2c
->adapter
.dev
.parent
= &dev
->pdev
->dev
;
1015 i2c_set_adapdata(&i2c
->adapter
, i2c
);
1016 snprintf(i2c
->adapter
.name
, sizeof(i2c
->adapter
.name
),
1018 i2c
->adapter
.algo_data
= &i2c
->bit
;
1020 i2c
->bit
.udelay
= 20;
1021 i2c
->bit
.timeout
= 2;
1022 i2c
->bit
.data
= i2c
;
1023 i2c
->bit
.setsda
= set_data
;
1024 i2c
->bit
.setscl
= set_clock
;
1025 i2c
->bit
.getsda
= get_data
;
1026 i2c
->bit
.getscl
= get_clock
;
1027 ret
= i2c_bit_add_bus(&i2c
->adapter
);
1029 DRM_ERROR("Failed to register bit i2c\n");
1039 static void ast_i2c_destroy(struct ast_i2c_chan
*i2c
)
1043 i2c_del_adapter(&i2c
->adapter
);
1047 static void ast_show_cursor(struct drm_crtc
*crtc
)
1049 struct ast_private
*ast
= crtc
->dev
->dev_private
;
1053 /* enable ARGB cursor */
1055 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xcb, 0xfc, jreg
);
1058 static void ast_hide_cursor(struct drm_crtc
*crtc
)
1060 struct ast_private
*ast
= crtc
->dev
->dev_private
;
1061 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xcb, 0xfc, 0x00);
1064 static u32
copy_cursor_image(u8
*src
, u8
*dst
, int width
, int height
)
1069 } srcdata32
[2], data32
;
1075 s32 alpha_dst_delta
, last_alpha_dst_delta
;
1076 u8
*srcxor
, *dstxor
;
1078 u32 per_pixel_copy
, two_pixel_copy
;
1080 alpha_dst_delta
= AST_MAX_HWC_WIDTH
<< 1;
1081 last_alpha_dst_delta
= alpha_dst_delta
- (width
<< 1);
1084 dstxor
= (u8
*)dst
+ last_alpha_dst_delta
+ (AST_MAX_HWC_HEIGHT
- height
) * alpha_dst_delta
;
1085 per_pixel_copy
= width
& 1;
1086 two_pixel_copy
= width
>> 1;
1088 for (j
= 0; j
< height
; j
++) {
1089 for (i
= 0; i
< two_pixel_copy
; i
++) {
1090 srcdata32
[0].ul
= *((u32
*)srcxor
) & 0xf0f0f0f0;
1091 srcdata32
[1].ul
= *((u32
*)(srcxor
+ 4)) & 0xf0f0f0f0;
1092 data32
.b
[0] = srcdata32
[0].b
[1] | (srcdata32
[0].b
[0] >> 4);
1093 data32
.b
[1] = srcdata32
[0].b
[3] | (srcdata32
[0].b
[2] >> 4);
1094 data32
.b
[2] = srcdata32
[1].b
[1] | (srcdata32
[1].b
[0] >> 4);
1095 data32
.b
[3] = srcdata32
[1].b
[3] | (srcdata32
[1].b
[2] >> 4);
1097 writel(data32
.ul
, dstxor
);
1105 for (i
= 0; i
< per_pixel_copy
; i
++) {
1106 srcdata32
[0].ul
= *((u32
*)srcxor
) & 0xf0f0f0f0;
1107 data16
.b
[0] = srcdata32
[0].b
[1] | (srcdata32
[0].b
[0] >> 4);
1108 data16
.b
[1] = srcdata32
[0].b
[3] | (srcdata32
[0].b
[2] >> 4);
1109 writew(data16
.us
, dstxor
);
1110 csum
+= (u32
)data16
.us
;
1115 dstxor
+= last_alpha_dst_delta
;
1120 static int ast_cursor_set(struct drm_crtc
*crtc
,
1121 struct drm_file
*file_priv
,
1126 struct ast_private
*ast
= crtc
->dev
->dev_private
;
1127 struct ast_crtc
*ast_crtc
= to_ast_crtc(crtc
);
1128 struct drm_gem_object
*obj
;
1133 struct ttm_bo_kmap_obj uobj_map
;
1135 bool src_isiomem
, dst_isiomem
;
1137 ast_hide_cursor(crtc
);
1141 if (width
> AST_MAX_HWC_WIDTH
|| height
> AST_MAX_HWC_HEIGHT
)
1144 obj
= drm_gem_object_lookup(file_priv
, handle
);
1146 DRM_ERROR("Cannot find cursor object %x for crtc\n", handle
);
1149 bo
= gem_to_ast_bo(obj
);
1151 ret
= ast_bo_reserve(bo
, false);
1155 ret
= ttm_bo_kmap(&bo
->bo
, 0, bo
->bo
.num_pages
, &uobj_map
);
1157 src
= ttm_kmap_obj_virtual(&uobj_map
, &src_isiomem
);
1158 dst
= ttm_kmap_obj_virtual(&ast
->cache_kmap
, &dst_isiomem
);
1160 if (src_isiomem
== true)
1161 DRM_ERROR("src cursor bo should be in main memory\n");
1162 if (dst_isiomem
== false)
1163 DRM_ERROR("dst bo should be in VRAM\n");
1165 dst
+= (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
)*ast
->next_cursor
;
1167 /* do data transfer to cursor cache */
1168 csum
= copy_cursor_image(src
, dst
, width
, height
);
1170 /* write checksum + signature */
1171 ttm_bo_kunmap(&uobj_map
);
1172 ast_bo_unreserve(bo
);
1174 u8
*dst
= (u8
*)ast
->cache_kmap
.virtual + (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
)*ast
->next_cursor
+ AST_HWC_SIZE
;
1176 writel(width
, dst
+ AST_HWC_SIGNATURE_SizeX
);
1177 writel(height
, dst
+ AST_HWC_SIGNATURE_SizeY
);
1178 writel(0, dst
+ AST_HWC_SIGNATURE_HOTSPOTX
);
1179 writel(0, dst
+ AST_HWC_SIGNATURE_HOTSPOTY
);
1181 /* set pattern offset */
1182 gpu_addr
= ast
->cursor_cache_gpu_addr
;
1183 gpu_addr
+= (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
)*ast
->next_cursor
;
1185 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc8, gpu_addr
& 0xff);
1186 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc9, (gpu_addr
>> 8) & 0xff);
1187 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xca, (gpu_addr
>> 16) & 0xff);
1189 ast_crtc
->cursor_width
= width
;
1190 ast_crtc
->cursor_height
= height
;
1191 ast_crtc
->offset_x
= AST_MAX_HWC_WIDTH
- width
;
1192 ast_crtc
->offset_y
= AST_MAX_HWC_WIDTH
- height
;
1194 ast
->next_cursor
= (ast
->next_cursor
+ 1) % AST_DEFAULT_HWC_NUM
;
1196 ast_show_cursor(crtc
);
1198 drm_gem_object_unreference_unlocked(obj
);
1201 drm_gem_object_unreference_unlocked(obj
);
1205 static int ast_cursor_move(struct drm_crtc
*crtc
,
1208 struct ast_crtc
*ast_crtc
= to_ast_crtc(crtc
);
1209 struct ast_private
*ast
= crtc
->dev
->dev_private
;
1210 int x_offset
, y_offset
;
1213 sig
= (u8
*)ast
->cache_kmap
.virtual + (AST_HWC_SIZE
+ AST_HWC_SIGNATURE_SIZE
)*ast
->next_cursor
+ AST_HWC_SIZE
;
1214 writel(x
, sig
+ AST_HWC_SIGNATURE_X
);
1215 writel(y
, sig
+ AST_HWC_SIGNATURE_Y
);
1217 x_offset
= ast_crtc
->offset_x
;
1218 y_offset
= ast_crtc
->offset_y
;
1220 x_offset
= (-x
) + ast_crtc
->offset_x
;
1225 y_offset
= (-y
) + ast_crtc
->offset_y
;
1228 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc2, x_offset
);
1229 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc3, y_offset
);
1230 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc4, (x
& 0xff));
1231 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc5, ((x
>> 8) & 0x0f));
1232 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc6, (y
& 0xff));
1233 ast_set_index_reg(ast
, AST_IO_CRTC_PORT
, 0xc7, ((y
>> 8) & 0x07));
1235 /* dummy write to fire HWC */
1236 ast_set_index_reg_mask(ast
, AST_IO_CRTC_PORT
, 0xCB, 0xFF, 0x00);