drivers/gpu/drm/ast/ast_post.c

   1 /*
   2  * Copyright 2012 Red Hat Inc.
   3  *
   4  * Permission is hereby granted, free of charge, to any person obtaining a
   5  * copy of this software and associated documentation files (the
   6  * "Software"), to deal in the Software without restriction, including
   7  * without limitation the rights to use, copy, modify, merge, publish,
   8  * distribute, sub license, and/or sell copies of the Software, and to
   9  * permit persons to whom the Software is furnished to do so, subject to
  10  * the following conditions:
  11  *
  12  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  13  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  14  * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
  15  * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
  16  * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
  17  * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
  18  * USE OR OTHER DEALINGS IN THE SOFTWARE.
  19  *
  20  * The above copyright notice and this permission notice (including the
  21  * next paragraph) shall be included in all copies or substantial portions
  22  * of the Software.
  23  *
  24  */
  25 /*
  26  * Authors: Dave Airlie <[email protected]>
  27  */
  28
  29 #include <linux/delay.h>
  30 #include <linux/pci.h>
  31
  32 #include <drm/drm_print.h>
  33
  34 #include "ast_dram_tables.h"
  35 #include "ast_drv.h"
  36
  37 static void ast_post_chip_2300(struct drm_device *dev);
  38 static void ast_post_chip_2500(struct drm_device *dev);
  39
  40 void ast_enable_vga(struct drm_device *dev)
  41 {
  42         struct ast_private *ast = to_ast_private(dev);
  43
  44         ast_io_write8(ast, AST_IO_VGA_ENABLE_PORT, 0x01);
  45         ast_io_write8(ast, AST_IO_MISC_PORT_WRITE, 0x01);
  46 }
  47
  48 void ast_enable_mmio(struct drm_device *dev)
  49 {
  50         struct ast_private *ast = to_ast_private(dev);
  51
  52         ast_set_index_reg(ast, AST_IO_CRTC_PORT, 0xa1, 0x06);
  53 }
  54
  55
  56 bool ast_is_vga_enabled(struct drm_device *dev)
  57 {
  58         struct ast_private *ast = to_ast_private(dev);
  59         u8 ch;
  60
  61         ch = ast_io_read8(ast, AST_IO_VGA_ENABLE_PORT);
  62
  63         return !!(ch & 0x01);
  64 }
  65
  66 static const u8 extreginfo[] = { 0x0f, 0x04, 0x1c, 0xff };
  67 static const u8 extreginfo_ast2300a0[] = { 0x0f, 0x04, 0x1c, 0xff };
  68 static const u8 extreginfo_ast2300[] = { 0x0f, 0x04, 0x1f, 0xff };
  69
  70 static void
  71 ast_set_def_ext_reg(struct drm_device *dev)
  72 {
  73         struct ast_private *ast = to_ast_private(dev);
  74         struct pci_dev *pdev = to_pci_dev(dev->dev);
  75         u8 i, index, reg;
  76         const u8 *ext_reg_info;
  77
  78         /* reset scratch */
  79         for (i = 0x81; i <= 0x9f; i++)
  80                 ast_set_index_reg(ast, AST_IO_CRTC_PORT, i, 0x00);
  81
  82         if (ast->chip == AST2300 || ast->chip == AST2400 ||
  83             ast->chip == AST2500) {
  84                 if (pdev->revision >= 0x20)
  85                         ext_reg_info = extreginfo_ast2300;
  86                 else
  87                         ext_reg_info = extreginfo_ast2300a0;
  88         } else
  89                 ext_reg_info = extreginfo;
  90
  91         index = 0xa0;
  92         while (*ext_reg_info != 0xff) {
  93                 ast_set_index_reg_mask(ast, AST_IO_CRTC_PORT, index, 0x00, *ext_reg_info);
  94                 index++;
  95                 ext_reg_info++;
  96         }
  97
  98         /* disable standard IO/MEM decode if secondary */
  99         /* ast_set_index_reg-mask(ast, AST_IO_CRTC_PORT, 0xa1, 0xff, 0x3); */
 100
 101         /* Set Ext. Default */
 102         ast_set_index_reg_mask(ast, AST_IO_CRTC_PORT, 0x8c, 0x00, 0x01);
 103         ast_set_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xb7, 0x00, 0x00);
 104
 105         /* Enable RAMDAC for A1 */
 106         reg = 0x04;
 107         if (ast->chip == AST2300 || ast->chip == AST2400 ||
 108             ast->chip == AST2500)
 109                 reg |= 0x20;
 110         ast_set_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xb6, 0xff, reg);
 111 }
 112
 113 u32 ast_mindwm(struct ast_private *ast, u32 r)
 114 {
 115         uint32_t data;
 116
 117         ast_write32(ast, 0xf004, r & 0xffff0000);
 118         ast_write32(ast, 0xf000, 0x1);
 119
 120         do {
 121                 data = ast_read32(ast, 0xf004) & 0xffff0000;
 122         } while (data != (r & 0xffff0000));
 123         return ast_read32(ast, 0x10000 + (r & 0x0000ffff));
 124 }
 125
 126 void ast_moutdwm(struct ast_private *ast, u32 r, u32 v)
 127 {
 128         uint32_t data;
 129         ast_write32(ast, 0xf004, r & 0xffff0000);
 130         ast_write32(ast, 0xf000, 0x1);
 131         do {
 132                 data = ast_read32(ast, 0xf004) & 0xffff0000;
 133         } while (data != (r & 0xffff0000));
 134         ast_write32(ast, 0x10000 + (r & 0x0000ffff), v);
 135 }
 136
 137 /*
 138  * AST2100/2150 DLL CBR Setting
 139  */
 140 #define CBR_SIZE_AST2150             ((16 << 10) - 1)
 141 #define CBR_PASSNUM_AST2150          5
 142 #define CBR_THRESHOLD_AST2150        10
 143 #define CBR_THRESHOLD2_AST2150       10
 144 #define TIMEOUT_AST2150              5000000
 145
 146 #define CBR_PATNUM_AST2150           8
 147
 148 static const u32 pattern_AST2150[14] = {
 149         0xFF00FF00,
 150         0xCC33CC33,
 151         0xAA55AA55,
 152         0xFFFE0001,
 153         0x683501FE,
 154         0x0F1929B0,
 155         0x2D0B4346,
 156         0x60767F02,
 157         0x6FBE36A6,
 158         0x3A253035,
 159         0x3019686D,
 160         0x41C6167E,
 161         0x620152BF,
 162         0x20F050E0
 163 };
 164
 165 static u32 mmctestburst2_ast2150(struct ast_private *ast, u32 datagen)
 166 {
 167         u32 data, timeout;
 168
 169         ast_moutdwm(ast, 0x1e6e0070, 0x00000000);
 170         ast_moutdwm(ast, 0x1e6e0070, 0x00000001 | (datagen << 3));
 171         timeout = 0;
 172         do {
 173                 data = ast_mindwm(ast, 0x1e6e0070) & 0x40;
 174                 if (++timeout > TIMEOUT_AST2150) {
 175                         ast_moutdwm(ast, 0x1e6e0070, 0x00000000);
 176                         return 0xffffffff;
 177                 }
 178         } while (!data);
 179         ast_moutdwm(ast, 0x1e6e0070, 0x00000000);
 180         ast_moutdwm(ast, 0x1e6e0070, 0x00000003 | (datagen << 3));
 181         timeout = 0;
 182         do {
 183                 data = ast_mindwm(ast, 0x1e6e0070) & 0x40;
 184                 if (++timeout > TIMEOUT_AST2150) {
 185                         ast_moutdwm(ast, 0x1e6e0070, 0x00000000);
 186                         return 0xffffffff;
 187                 }
 188         } while (!data);
 189         data = (ast_mindwm(ast, 0x1e6e0070) & 0x80) >> 7;
 190         ast_moutdwm(ast, 0x1e6e0070, 0x00000000);
 191         return data;
 192 }
 193
 194 #if 0 /* unused in DDX driver - here for completeness */
 195 static u32 mmctestsingle2_ast2150(struct ast_private *ast, u32 datagen)
 196 {
 197         u32 data, timeout;
 198
 199         ast_moutdwm(ast, 0x1e6e0070, 0x00000000);
 200         ast_moutdwm(ast, 0x1e6e0070, 0x00000005 | (datagen << 3));
 201         timeout = 0;
 202         do {
 203                 data = ast_mindwm(ast, 0x1e6e0070) & 0x40;
 204                 if (++timeout > TIMEOUT_AST2150) {
 205                         ast_moutdwm(ast, 0x1e6e0070, 0x00000000);
 206                         return 0xffffffff;
 207                 }
 208         } while (!data);
 209         data = (ast_mindwm(ast, 0x1e6e0070) & 0x80) >> 7;
 210         ast_moutdwm(ast, 0x1e6e0070, 0x00000000);
 211         return data;
 212 }
 213 #endif
 214
 215 static int cbrtest_ast2150(struct ast_private *ast)
 216 {
 217         int i;
 218
 219         for (i = 0; i < 8; i++)
 220                 if (mmctestburst2_ast2150(ast, i))
 221                         return 0;
 222         return 1;
 223 }
 224
 225 static int cbrscan_ast2150(struct ast_private *ast, int busw)
 226 {
 227         u32 patcnt, loop;
 228
 229         for (patcnt = 0; patcnt < CBR_PATNUM_AST2150; patcnt++) {
 230                 ast_moutdwm(ast, 0x1e6e007c, pattern_AST2150[patcnt]);
 231                 for (loop = 0; loop < CBR_PASSNUM_AST2150; loop++) {
 232                         if (cbrtest_ast2150(ast))
 233                                 break;
 234                 }
 235                 if (loop == CBR_PASSNUM_AST2150)
 236                         return 0;
 237         }
 238         return 1;
 239 }
 240
 241
 242 static void cbrdlli_ast2150(struct ast_private *ast, int busw)
 243 {
 244         u32 dll_min[4], dll_max[4], dlli, data, passcnt;
 245
 246 cbr_start:
 247         dll_min[0] = dll_min[1] = dll_min[2] = dll_min[3] = 0xff;
 248         dll_max[0] = dll_max[1] = dll_max[2] = dll_max[3] = 0x0;
 249         passcnt = 0;
 250
 251         for (dlli = 0; dlli < 100; dlli++) {
 252                 ast_moutdwm(ast, 0x1e6e0068, dlli | (dlli << 8) | (dlli << 16) | (dlli << 24));
 253                 data = cbrscan_ast2150(ast, busw);
 254                 if (data != 0) {
 255                         if (data & 0x1) {
 256                                 if (dll_min[0] > dlli)
 257                                         dll_min[0] = dlli;
 258                                 if (dll_max[0] < dlli)
 259                                         dll_max[0] = dlli;
 260                         }
 261                         passcnt++;
 262                 } else if (passcnt >= CBR_THRESHOLD_AST2150)
 263                         goto cbr_start;
 264         }
 265         if (dll_max[0] == 0 || (dll_max[0]-dll_min[0]) < CBR_THRESHOLD_AST2150)
 266                 goto cbr_start;
 267
 268         dlli = dll_min[0] + (((dll_max[0] - dll_min[0]) * 7) >> 4);
 269         ast_moutdwm(ast, 0x1e6e0068, dlli | (dlli << 8) | (dlli << 16) | (dlli << 24));
 270 }
 271
 272
 273
 274 static void ast_init_dram_reg(struct drm_device *dev)
 275 {
 276         struct ast_private *ast = to_ast_private(dev);
 277         u8 j;
 278         u32 data, temp, i;
 279         const struct ast_dramstruct *dram_reg_info;
 280
 281         j = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd0, 0xff);
 282
 283         if ((j & 0x80) == 0) { /* VGA only */
 284                 if (ast->chip == AST2000) {
 285                         dram_reg_info = ast2000_dram_table_data;
 286                         ast_write32(ast, 0xf004, 0x1e6e0000);
 287                         ast_write32(ast, 0xf000, 0x1);
 288                         ast_write32(ast, 0x10100, 0xa8);
 289
 290                         do {
 291                                 ;
 292                         } while (ast_read32(ast, 0x10100) != 0xa8);
 293                 } else {/* AST2100/1100 */
 294                         if (ast->chip == AST2100 || ast->chip == 2200)
 295                                 dram_reg_info = ast2100_dram_table_data;
 296                         else
 297                                 dram_reg_info = ast1100_dram_table_data;
 298
 299                         ast_write32(ast, 0xf004, 0x1e6e0000);
 300                         ast_write32(ast, 0xf000, 0x1);
 301                         ast_write32(ast, 0x12000, 0x1688A8A8);
 302                         do {
 303                                 ;
 304                         } while (ast_read32(ast, 0x12000) != 0x01);
 305
 306                         ast_write32(ast, 0x10000, 0xfc600309);
 307                         do {
 308                                 ;
 309                         } while (ast_read32(ast, 0x10000) != 0x01);
 310                 }
 311
 312                 while (dram_reg_info->index != 0xffff) {
 313                         if (dram_reg_info->index == 0xff00) {/* delay fn */
 314                                 for (i = 0; i < 15; i++)
 315                                         udelay(dram_reg_info->data);
 316                         } else if (dram_reg_info->index == 0x4 && ast->chip != AST2000) {
 317                                 data = dram_reg_info->data;
 318                                 if (ast->dram_type == AST_DRAM_1Gx16)
 319                                         data = 0x00000d89;
 320                                 else if (ast->dram_type == AST_DRAM_1Gx32)
 321                                         data = 0x00000c8d;
 322
 323                                 temp = ast_read32(ast, 0x12070);
 324                                 temp &= 0xc;
 325                                 temp <<= 2;
 326                                 ast_write32(ast, 0x10000 + dram_reg_info->index, data | temp);
 327                         } else
 328                                 ast_write32(ast, 0x10000 + dram_reg_info->index, dram_reg_info->data);
 329                         dram_reg_info++;
 330                 }
 331
 332                 /* AST 2100/2150 DRAM calibration */
 333                 data = ast_read32(ast, 0x10120);
 334                 if (data == 0x5061) { /* 266Mhz */
 335                         data = ast_read32(ast, 0x10004);
 336                         if (data & 0x40)
 337                                 cbrdlli_ast2150(ast, 16); /* 16 bits */
 338                         else
 339                                 cbrdlli_ast2150(ast, 32); /* 32 bits */
 340                 }
 341
 342                 switch (ast->chip) {
 343                 case AST2000:
 344                         temp = ast_read32(ast, 0x10140);
 345                         ast_write32(ast, 0x10140, temp | 0x40);
 346                         break;
 347                 case AST1100:
 348                 case AST2100:
 349                 case AST2200:
 350                 case AST2150:
 351                         temp = ast_read32(ast, 0x1200c);
 352                         ast_write32(ast, 0x1200c, temp & 0xfffffffd);
 353                         temp = ast_read32(ast, 0x12040);
 354                         ast_write32(ast, 0x12040, temp | 0x40);
 355                         break;
 356                 default:
 357                         break;
 358                 }
 359         }
 360
 361         /* wait ready */
 362         do {
 363                 j = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd0, 0xff);
 364         } while ((j & 0x40) == 0);
 365 }
 366
 367 void ast_post_gpu(struct drm_device *dev)
 368 {
 369         struct ast_private *ast = to_ast_private(dev);
 370         struct pci_dev *pdev = to_pci_dev(dev->dev);
 371         u32 reg;
 372
 373         pci_read_config_dword(pdev, 0x04, &reg);
 374         reg |= 0x3;
 375         pci_write_config_dword(pdev, 0x04, reg);
 376
 377         ast_enable_vga(dev);
 378         ast_open_key(ast);
 379         ast_enable_mmio(dev);
 380         ast_set_def_ext_reg(dev);
 381
 382         if (ast->config_mode == ast_use_p2a) {
 383                 if (ast->chip == AST2500)
 384                         ast_post_chip_2500(dev);
 385                 else if (ast->chip == AST2300 || ast->chip == AST2400)
 386                         ast_post_chip_2300(dev);
 387                 else
 388                         ast_init_dram_reg(dev);
 389
 390                 ast_init_3rdtx(dev);
 391         } else {
 392                 if (ast->tx_chip_type != AST_TX_NONE)
 393                         ast_set_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xa3, 0xcf, 0x80);        /* Enable DVO */
 394         }
 395 }
 396
 397 /* AST 2300 DRAM settings */
 398 #define AST_DDR3 0
 399 #define AST_DDR2 1
 400
 401 struct ast2300_dram_param {
 402         u32 dram_type;
 403         u32 dram_chipid;
 404         u32 dram_freq;
 405         u32 vram_size;
 406         u32 odt;
 407         u32 wodt;
 408         u32 rodt;
 409         u32 dram_config;
 410         u32 reg_PERIOD;
 411         u32 reg_MADJ;
 412         u32 reg_SADJ;
 413         u32 reg_MRS;
 414         u32 reg_EMRS;
 415         u32 reg_AC1;
 416         u32 reg_AC2;
 417         u32 reg_DQSIC;
 418         u32 reg_DRV;
 419         u32 reg_IOZ;
 420         u32 reg_DQIDLY;
 421         u32 reg_FREQ;
 422         u32 madj_max;
 423         u32 dll2_finetune_step;
 424 };
 425
 426 /*
 427  * DQSI DLL CBR Setting
 428  */
 429 #define CBR_SIZE0            ((1  << 10) - 1)
 430 #define CBR_SIZE1            ((4  << 10) - 1)
 431 #define CBR_SIZE2            ((64 << 10) - 1)
 432 #define CBR_PASSNUM          5
 433 #define CBR_PASSNUM2         5
 434 #define CBR_THRESHOLD        10
 435 #define CBR_THRESHOLD2       10
 436 #define TIMEOUT              5000000
 437 #define CBR_PATNUM           8
 438
 439 static const u32 pattern[8] = {
 440         0xFF00FF00,
 441         0xCC33CC33,
 442         0xAA55AA55,
 443         0x88778877,
 444         0x92CC4D6E,
 445         0x543D3CDE,
 446         0xF1E843C7,
 447         0x7C61D253
 448 };
 449
 450 static bool mmc_test(struct ast_private *ast, u32 datagen, u8 test_ctl)
 451 {
 452         u32 data, timeout;
 453
 454         ast_moutdwm(ast, 0x1e6e0070, 0x00000000);
 455         ast_moutdwm(ast, 0x1e6e0070, (datagen << 3) | test_ctl);
 456         timeout = 0;
 457         do {
 458                 data = ast_mindwm(ast, 0x1e6e0070) & 0x3000;
 459                 if (data & 0x2000)
 460                         return false;
 461                 if (++timeout > TIMEOUT) {
 462                         ast_moutdwm(ast, 0x1e6e0070, 0x00000000);
 463                         return false;
 464                 }
 465         } while (!data);
 466         ast_moutdwm(ast, 0x1e6e0070, 0x0);
 467         return true;
 468 }
 469
 470 static u32 mmc_test2(struct ast_private *ast, u32 datagen, u8 test_ctl)
 471 {
 472         u32 data, timeout;
 473
 474         ast_moutdwm(ast, 0x1e6e0070, 0x00000000);
 475         ast_moutdwm(ast, 0x1e6e0070, (datagen << 3) | test_ctl);
 476         timeout = 0;
 477         do {
 478                 data = ast_mindwm(ast, 0x1e6e0070) & 0x1000;
 479                 if (++timeout > TIMEOUT) {
 480                         ast_moutdwm(ast, 0x1e6e0070, 0x0);
 481                         return 0xffffffff;
 482                 }
 483         } while (!data);
 484         data = ast_mindwm(ast, 0x1e6e0078);
 485         data = (data | (data >> 16)) & 0xffff;
 486         ast_moutdwm(ast, 0x1e6e0070, 0x00000000);
 487         return data;
 488 }
 489
 490
 491 static bool mmc_test_burst(struct ast_private *ast, u32 datagen)
 492 {
 493         return mmc_test(ast, datagen, 0xc1);
 494 }
 495
 496 static u32 mmc_test_burst2(struct ast_private *ast, u32 datagen)
 497 {
 498         return mmc_test2(ast, datagen, 0x41);
 499 }
 500
 501 static bool mmc_test_single(struct ast_private *ast, u32 datagen)
 502 {
 503         return mmc_test(ast, datagen, 0xc5);
 504 }
 505
 506 static u32 mmc_test_single2(struct ast_private *ast, u32 datagen)
 507 {
 508         return mmc_test2(ast, datagen, 0x05);
 509 }
 510
 511 static bool mmc_test_single_2500(struct ast_private *ast, u32 datagen)
 512 {
 513         return mmc_test(ast, datagen, 0x85);
 514 }
 515
 516 static int cbr_test(struct ast_private *ast)
 517 {
 518         u32 data;
 519         int i;
 520         data = mmc_test_single2(ast, 0);
 521         if ((data & 0xff) && (data & 0xff00))
 522                 return 0;
 523         for (i = 0; i < 8; i++) {
 524                 data = mmc_test_burst2(ast, i);
 525                 if ((data & 0xff) && (data & 0xff00))
 526                         return 0;
 527         }
 528         if (!data)
 529                 return 3;
 530         else if (data & 0xff)
 531                 return 2;
 532         return 1;
 533 }
 534
 535 static int cbr_scan(struct ast_private *ast)
 536 {
 537         u32 data, data2, patcnt, loop;
 538
 539         data2 = 3;
 540         for (patcnt = 0; patcnt < CBR_PATNUM; patcnt++) {
 541                 ast_moutdwm(ast, 0x1e6e007c, pattern[patcnt]);
 542                 for (loop = 0; loop < CBR_PASSNUM2; loop++) {
 543                         if ((data = cbr_test(ast)) != 0) {
 544                                 data2 &= data;
 545                                 if (!data2)
 546                                         return 0;
 547                                 break;
 548                         }
 549                 }
 550                 if (loop == CBR_PASSNUM2)
 551                         return 0;
 552         }
 553         return data2;
 554 }
 555
 556 static u32 cbr_test2(struct ast_private *ast)
 557 {
 558         u32 data;
 559
 560         data = mmc_test_burst2(ast, 0);
 561         if (data == 0xffff)
 562                 return 0;
 563         data |= mmc_test_single2(ast, 0);
 564         if (data == 0xffff)
 565                 return 0;
 566
 567         return ~data & 0xffff;
 568 }
 569
 570 static u32 cbr_scan2(struct ast_private *ast)
 571 {
 572         u32 data, data2, patcnt, loop;
 573
 574         data2 = 0xffff;
 575         for (patcnt = 0; patcnt < CBR_PATNUM; patcnt++) {
 576                 ast_moutdwm(ast, 0x1e6e007c, pattern[patcnt]);
 577                 for (loop = 0; loop < CBR_PASSNUM2; loop++) {
 578                         if ((data = cbr_test2(ast)) != 0) {
 579                                 data2 &= data;
 580                                 if (!data2)
 581                                         return 0;
 582                                 break;
 583                         }
 584                 }
 585                 if (loop == CBR_PASSNUM2)
 586                         return 0;
 587         }
 588         return data2;
 589 }
 590
 591 static bool cbr_test3(struct ast_private *ast)
 592 {
 593         if (!mmc_test_burst(ast, 0))
 594                 return false;
 595         if (!mmc_test_single(ast, 0))
 596                 return false;
 597         return true;
 598 }
 599
 600 static bool cbr_scan3(struct ast_private *ast)
 601 {
 602         u32 patcnt, loop;
 603
 604         for (patcnt = 0; patcnt < CBR_PATNUM; patcnt++) {
 605                 ast_moutdwm(ast, 0x1e6e007c, pattern[patcnt]);
 606                 for (loop = 0; loop < 2; loop++) {
 607                         if (cbr_test3(ast))
 608                                 break;
 609                 }
 610                 if (loop == 2)
 611                         return false;
 612         }
 613         return true;
 614 }
 615
 616 static bool finetuneDQI_L(struct ast_private *ast, struct ast2300_dram_param *param)
 617 {
 618         u32 gold_sadj[2], dllmin[16], dllmax[16], dlli, data, cnt, mask, passcnt, retry = 0;
 619         bool status = false;
 620 FINETUNE_START:
 621         for (cnt = 0; cnt < 16; cnt++) {
 622                 dllmin[cnt] = 0xff;
 623                 dllmax[cnt] = 0x0;
 624         }
 625         passcnt = 0;
 626         for (dlli = 0; dlli < 76; dlli++) {
 627                 ast_moutdwm(ast, 0x1E6E0068, 0x00001400 | (dlli << 16) | (dlli << 24));
 628                 ast_moutdwm(ast, 0x1E6E0074, CBR_SIZE1);
 629                 data = cbr_scan2(ast);
 630                 if (data != 0) {
 631                         mask = 0x00010001;
 632                         for (cnt = 0; cnt < 16; cnt++) {
 633                                 if (data & mask) {
 634                                         if (dllmin[cnt] > dlli) {
 635                                                 dllmin[cnt] = dlli;
 636                                         }
 637                                         if (dllmax[cnt] < dlli) {
 638                                                 dllmax[cnt] = dlli;
 639                                         }
 640                                 }
 641                                 mask <<= 1;
 642                         }
 643                         passcnt++;
 644                 } else if (passcnt >= CBR_THRESHOLD2) {
 645                         break;
 646                 }
 647         }
 648         gold_sadj[0] = 0x0;
 649         passcnt = 0;
 650         for (cnt = 0; cnt < 16; cnt++) {
 651                 if ((dllmax[cnt] > dllmin[cnt]) && ((dllmax[cnt] - dllmin[cnt]) >= CBR_THRESHOLD2)) {
 652                         gold_sadj[0] += dllmin[cnt];
 653                         passcnt++;
 654                 }
 655         }
 656         if (retry++ > 10)
 657                 goto FINETUNE_DONE;
 658         if (passcnt != 16) {
 659                 goto FINETUNE_START;
 660         }
 661         status = true;
 662 FINETUNE_DONE:
 663         gold_sadj[0] = gold_sadj[0] >> 4;
 664         gold_sadj[1] = gold_sadj[0];
 665
 666         data = 0;
 667         for (cnt = 0; cnt < 8; cnt++) {
 668                 data >>= 3;
 669                 if ((dllmax[cnt] > dllmin[cnt]) && ((dllmax[cnt] - dllmin[cnt]) >= CBR_THRESHOLD2)) {
 670                         dlli = dllmin[cnt];
 671                         if (gold_sadj[0] >= dlli) {
 672                                 dlli = ((gold_sadj[0] - dlli) * 19) >> 5;
 673                                 if (dlli > 3) {
 674                                         dlli = 3;
 675                                 }
 676                         } else {
 677                                 dlli = ((dlli - gold_sadj[0]) * 19) >> 5;
 678                                 if (dlli > 4) {
 679                                         dlli = 4;
 680                                 }
 681                                 dlli = (8 - dlli) & 0x7;
 682                         }
 683                         data |= dlli << 21;
 684                 }
 685         }
 686         ast_moutdwm(ast, 0x1E6E0080, data);
 687
 688         data = 0;
 689         for (cnt = 8; cnt < 16; cnt++) {
 690                 data >>= 3;
 691                 if ((dllmax[cnt] > dllmin[cnt]) && ((dllmax[cnt] - dllmin[cnt]) >= CBR_THRESHOLD2)) {
 692                         dlli = dllmin[cnt];
 693                         if (gold_sadj[1] >= dlli) {
 694                                 dlli = ((gold_sadj[1] - dlli) * 19) >> 5;
 695                                 if (dlli > 3) {
 696                                         dlli = 3;
 697                                 } else {
 698                                         dlli = (dlli - 1) & 0x7;
 699                                 }
 700                         } else {
 701                                 dlli = ((dlli - gold_sadj[1]) * 19) >> 5;
 702                                 dlli += 1;
 703                                 if (dlli > 4) {
 704                                         dlli = 4;
 705                                 }
 706                                 dlli = (8 - dlli) & 0x7;
 707                         }
 708                         data |= dlli << 21;
 709                 }
 710         }
 711         ast_moutdwm(ast, 0x1E6E0084, data);
 712         return status;
 713 } /* finetuneDQI_L */
 714
 715 static void finetuneDQSI(struct ast_private *ast)
 716 {
 717         u32 dlli, dqsip, dqidly;
 718         u32 reg_mcr18, reg_mcr0c, passcnt[2], diff;
 719         u32 g_dqidly, g_dqsip, g_margin, g_side;
 720         u16 pass[32][2][2];
 721         char tag[2][76];
 722
 723         /* Disable DQI CBR */
 724         reg_mcr0c  = ast_mindwm(ast, 0x1E6E000C);
 725         reg_mcr18  = ast_mindwm(ast, 0x1E6E0018);
 726         reg_mcr18 &= 0x0000ffff;
 727         ast_moutdwm(ast, 0x1E6E0018, reg_mcr18);
 728
 729         for (dlli = 0; dlli < 76; dlli++) {
 730                 tag[0][dlli] = 0x0;
 731                 tag[1][dlli] = 0x0;
 732         }
 733         for (dqidly = 0; dqidly < 32; dqidly++) {
 734                 pass[dqidly][0][0] = 0xff;
 735                 pass[dqidly][0][1] = 0x0;
 736                 pass[dqidly][1][0] = 0xff;
 737                 pass[dqidly][1][1] = 0x0;
 738         }
 739         for (dqidly = 0; dqidly < 32; dqidly++) {
 740                 passcnt[0] = passcnt[1] = 0;
 741                 for (dqsip = 0; dqsip < 2; dqsip++) {
 742                         ast_moutdwm(ast, 0x1E6E000C, 0);
 743                         ast_moutdwm(ast, 0x1E6E0018, reg_mcr18 | (dqidly << 16) | (dqsip << 23));
 744                         ast_moutdwm(ast, 0x1E6E000C, reg_mcr0c);
 745                         for (dlli = 0; dlli < 76; dlli++) {
 746                                 ast_moutdwm(ast, 0x1E6E0068, 0x00001300 | (dlli << 16) | (dlli << 24));
 747                                 ast_moutdwm(ast, 0x1E6E0070, 0);
 748                                 ast_moutdwm(ast, 0x1E6E0074, CBR_SIZE0);
 749                                 if (cbr_scan3(ast)) {
 750                                         if (dlli == 0)
 751                                                 break;
 752                                         passcnt[dqsip]++;
 753                                         tag[dqsip][dlli] = 'P';
 754                                         if (dlli < pass[dqidly][dqsip][0])
 755                                                 pass[dqidly][dqsip][0] = (u16) dlli;
 756                                         if (dlli > pass[dqidly][dqsip][1])
 757                                                 pass[dqidly][dqsip][1] = (u16) dlli;
 758                                 } else if (passcnt[dqsip] >= 5)
 759                                         break;
 760                                 else {
 761                                         pass[dqidly][dqsip][0] = 0xff;
 762                                         pass[dqidly][dqsip][1] = 0x0;
 763                                 }
 764                         }
 765                 }
 766                 if (passcnt[0] == 0 && passcnt[1] == 0)
 767                         dqidly++;
 768         }
 769         /* Search margin */
 770         g_dqidly = g_dqsip = g_margin = g_side = 0;
 771
 772         for (dqidly = 0; dqidly < 32; dqidly++) {
 773                 for (dqsip = 0; dqsip < 2; dqsip++) {
 774                         if (pass[dqidly][dqsip][0] > pass[dqidly][dqsip][1])
 775                                 continue;
 776                         diff = pass[dqidly][dqsip][1] - pass[dqidly][dqsip][0];
 777                         if ((diff+2) < g_margin)
 778                                 continue;
 779                         passcnt[0] = passcnt[1] = 0;
 780                         for (dlli = pass[dqidly][dqsip][0]; dlli > 0  && tag[dqsip][dlli] != 0; dlli--, passcnt[0]++);
 781                         for (dlli = pass[dqidly][dqsip][1]; dlli < 76 && tag[dqsip][dlli] != 0; dlli++, passcnt[1]++);
 782                         if (passcnt[0] > passcnt[1])
 783                                 passcnt[0] = passcnt[1];
 784                         passcnt[1] = 0;
 785                         if (passcnt[0] > g_side)
 786                                 passcnt[1] = passcnt[0] - g_side;
 787                         if (diff > (g_margin+1) && (passcnt[1] > 0 || passcnt[0] > 8)) {
 788                                 g_margin = diff;
 789                                 g_dqidly = dqidly;
 790                                 g_dqsip  = dqsip;
 791                                 g_side   = passcnt[0];
 792                         } else if (passcnt[1] > 1 && g_side < 8) {
 793                                 if (diff > g_margin)
 794                                         g_margin = diff;
 795                                 g_dqidly = dqidly;
 796                                 g_dqsip  = dqsip;
 797                                 g_side   = passcnt[0];
 798                         }
 799                 }
 800         }
 801         reg_mcr18 = reg_mcr18 | (g_dqidly << 16) | (g_dqsip << 23);
 802         ast_moutdwm(ast, 0x1E6E0018, reg_mcr18);
 803
 804 }
 805 static bool cbr_dll2(struct ast_private *ast, struct ast2300_dram_param *param)
 806 {
 807         u32 dllmin[2], dllmax[2], dlli, data, passcnt, retry = 0;
 808         bool status = false;
 809
 810         finetuneDQSI(ast);
 811         if (finetuneDQI_L(ast, param) == false)
 812                 return status;
 813
 814 CBR_START2:
 815         dllmin[0] = dllmin[1] = 0xff;
 816         dllmax[0] = dllmax[1] = 0x0;
 817         passcnt = 0;
 818         for (dlli = 0; dlli < 76; dlli++) {
 819                 ast_moutdwm(ast, 0x1E6E0068, 0x00001300 | (dlli << 16) | (dlli << 24));
 820                 ast_moutdwm(ast, 0x1E6E0074, CBR_SIZE2);
 821                 data = cbr_scan(ast);
 822                 if (data != 0) {
 823                         if (data & 0x1) {
 824                                 if (dllmin[0] > dlli) {
 825                                         dllmin[0] = dlli;
 826                                 }
 827                                 if (dllmax[0] < dlli) {
 828                                         dllmax[0] = dlli;
 829                                 }
 830                         }
 831                         if (data & 0x2) {
 832                                 if (dllmin[1] > dlli) {
 833                                         dllmin[1] = dlli;
 834                                 }
 835                                 if (dllmax[1] < dlli) {
 836                                         dllmax[1] = dlli;
 837                                 }
 838                         }
 839                         passcnt++;
 840                 } else if (passcnt >= CBR_THRESHOLD) {
 841                         break;
 842                 }
 843         }
 844         if (retry++ > 10)
 845                 goto CBR_DONE2;
 846         if (dllmax[0] == 0 || (dllmax[0]-dllmin[0]) < CBR_THRESHOLD) {
 847                 goto CBR_START2;
 848         }
 849         if (dllmax[1] == 0 || (dllmax[1]-dllmin[1]) < CBR_THRESHOLD) {
 850                 goto CBR_START2;
 851         }
 852         status = true;
 853 CBR_DONE2:
 854         dlli  = (dllmin[1] + dllmax[1]) >> 1;
 855         dlli <<= 8;
 856         dlli += (dllmin[0] + dllmax[0]) >> 1;
 857         ast_moutdwm(ast, 0x1E6E0068, ast_mindwm(ast, 0x1E720058) | (dlli << 16));
 858         return status;
 859 } /* CBRDLL2 */
 860
 861 static void get_ddr3_info(struct ast_private *ast, struct ast2300_dram_param *param)
 862 {
 863         u32 trap, trap_AC2, trap_MRS;
 864
 865         ast_moutdwm(ast, 0x1E6E2000, 0x1688A8A8);
 866
 867         /* Ger trap info */
 868         trap = (ast_mindwm(ast, 0x1E6E2070) >> 25) & 0x3;
 869         trap_AC2  = 0x00020000 + (trap << 16);
 870         trap_AC2 |= 0x00300000 + ((trap & 0x2) << 19);
 871         trap_MRS  = 0x00000010 + (trap << 4);
 872         trap_MRS |= ((trap & 0x2) << 18);
 873
 874         param->reg_MADJ       = 0x00034C4C;
 875         param->reg_SADJ       = 0x00001800;
 876         param->reg_DRV        = 0x000000F0;
 877         param->reg_PERIOD     = param->dram_freq;
 878         param->rodt           = 0;
 879
 880         switch (param->dram_freq) {
 881         case 336:
 882                 ast_moutdwm(ast, 0x1E6E2020, 0x0190);
 883                 param->wodt          = 0;
 884                 param->reg_AC1       = 0x22202725;
 885                 param->reg_AC2       = 0xAA007613 | trap_AC2;
 886                 param->reg_DQSIC     = 0x000000BA;
 887                 param->reg_MRS       = 0x04001400 | trap_MRS;
 888                 param->reg_EMRS      = 0x00000000;
 889                 param->reg_IOZ       = 0x00000023;
 890                 param->reg_DQIDLY    = 0x00000074;
 891                 param->reg_FREQ      = 0x00004DC0;
 892                 param->madj_max      = 96;
 893                 param->dll2_finetune_step = 3;
 894                 switch (param->dram_chipid) {
 895                 default:
 896                 case AST_DRAM_512Mx16:
 897                 case AST_DRAM_1Gx16:
 898                         param->reg_AC2   = 0xAA007613 | trap_AC2;
 899                         break;
 900                 case AST_DRAM_2Gx16:
 901                         param->reg_AC2   = 0xAA00761C | trap_AC2;
 902                         break;
 903                 case AST_DRAM_4Gx16:
 904                         param->reg_AC2   = 0xAA007636 | trap_AC2;
 905                         break;
 906                 }
 907                 break;
 908         default:
 909         case 396:
 910                 ast_moutdwm(ast, 0x1E6E2020, 0x03F1);
 911                 param->wodt          = 1;
 912                 param->reg_AC1       = 0x33302825;
 913                 param->reg_AC2       = 0xCC009617 | trap_AC2;
 914                 param->reg_DQSIC     = 0x000000E2;
 915                 param->reg_MRS       = 0x04001600 | trap_MRS;
 916                 param->reg_EMRS      = 0x00000000;
 917                 param->reg_IOZ       = 0x00000034;
 918                 param->reg_DRV       = 0x000000FA;
 919                 param->reg_DQIDLY    = 0x00000089;
 920                 param->reg_FREQ      = 0x00005040;
 921                 param->madj_max      = 96;
 922                 param->dll2_finetune_step = 4;
 923
 924                 switch (param->dram_chipid) {
 925                 default:
 926                 case AST_DRAM_512Mx16:
 927                 case AST_DRAM_1Gx16:
 928                         param->reg_AC2   = 0xCC009617 | trap_AC2;
 929                         break;
 930                 case AST_DRAM_2Gx16:
 931                         param->reg_AC2   = 0xCC009622 | trap_AC2;
 932                         break;
 933                 case AST_DRAM_4Gx16:
 934                         param->reg_AC2   = 0xCC00963F | trap_AC2;
 935                         break;
 936                 }
 937                 break;
 938
 939         case 408:
 940                 ast_moutdwm(ast, 0x1E6E2020, 0x01F0);
 941                 param->wodt          = 1;
 942                 param->reg_AC1       = 0x33302825;
 943                 param->reg_AC2       = 0xCC009617 | trap_AC2;
 944                 param->reg_DQSIC     = 0x000000E2;
 945                 param->reg_MRS       = 0x04001600 | trap_MRS;
 946                 param->reg_EMRS      = 0x00000000;
 947                 param->reg_IOZ       = 0x00000023;
 948                 param->reg_DRV       = 0x000000FA;
 949                 param->reg_DQIDLY    = 0x00000089;
 950                 param->reg_FREQ      = 0x000050C0;
 951                 param->madj_max      = 96;
 952                 param->dll2_finetune_step = 4;
 953
 954                 switch (param->dram_chipid) {
 955                 default:
 956                 case AST_DRAM_512Mx16:
 957                 case AST_DRAM_1Gx16:
 958                         param->reg_AC2   = 0xCC009617 | trap_AC2;
 959                         break;
 960                 case AST_DRAM_2Gx16:
 961                         param->reg_AC2   = 0xCC009622 | trap_AC2;
 962                         break;
 963                 case AST_DRAM_4Gx16:
 964                         param->reg_AC2   = 0xCC00963F | trap_AC2;
 965                         break;
 966                 }
 967
 968                 break;
 969         case 456:
 970                 ast_moutdwm(ast, 0x1E6E2020, 0x0230);
 971                 param->wodt          = 0;
 972                 param->reg_AC1       = 0x33302926;
 973                 param->reg_AC2       = 0xCD44961A;
 974                 param->reg_DQSIC     = 0x000000FC;
 975                 param->reg_MRS       = 0x00081830;
 976                 param->reg_EMRS      = 0x00000000;
 977                 param->reg_IOZ       = 0x00000045;
 978                 param->reg_DQIDLY    = 0x00000097;
 979                 param->reg_FREQ      = 0x000052C0;
 980                 param->madj_max      = 88;
 981                 param->dll2_finetune_step = 4;
 982                 break;
 983         case 504:
 984                 ast_moutdwm(ast, 0x1E6E2020, 0x0270);
 985                 param->wodt          = 1;
 986                 param->reg_AC1       = 0x33302926;
 987                 param->reg_AC2       = 0xDE44A61D;
 988                 param->reg_DQSIC     = 0x00000117;
 989                 param->reg_MRS       = 0x00081A30;
 990                 param->reg_EMRS      = 0x00000000;
 991                 param->reg_IOZ       = 0x070000BB;
 992                 param->reg_DQIDLY    = 0x000000A0;
 993                 param->reg_FREQ      = 0x000054C0;
 994                 param->madj_max      = 79;
 995                 param->dll2_finetune_step = 4;
 996                 break;
 997         case 528:
 998                 ast_moutdwm(ast, 0x1E6E2020, 0x0290);
 999                 param->wodt          = 1;
1000                 param->rodt          = 1;
1001                 param->reg_AC1       = 0x33302926;
1002                 param->reg_AC2       = 0xEF44B61E;
1003                 param->reg_DQSIC     = 0x00000125;
1004                 param->reg_MRS       = 0x00081A30;
1005                 param->reg_EMRS      = 0x00000040;
1006                 param->reg_DRV       = 0x000000F5;
1007                 param->reg_IOZ       = 0x00000023;
1008                 param->reg_DQIDLY    = 0x00000088;
1009                 param->reg_FREQ      = 0x000055C0;
1010                 param->madj_max      = 76;
1011                 param->dll2_finetune_step = 3;
1012                 break;
1013         case 576:
1014                 ast_moutdwm(ast, 0x1E6E2020, 0x0140);
1015                 param->reg_MADJ      = 0x00136868;
1016                 param->reg_SADJ      = 0x00004534;
1017                 param->wodt          = 1;
1018                 param->rodt          = 1;
1019                 param->reg_AC1       = 0x33302A37;
1020                 param->reg_AC2       = 0xEF56B61E;
1021                 param->reg_DQSIC     = 0x0000013F;
1022                 param->reg_MRS       = 0x00101A50;
1023                 param->reg_EMRS      = 0x00000040;
1024                 param->reg_DRV       = 0x000000FA;
1025                 param->reg_IOZ       = 0x00000023;
1026                 param->reg_DQIDLY    = 0x00000078;
1027                 param->reg_FREQ      = 0x000057C0;
1028                 param->madj_max      = 136;
1029                 param->dll2_finetune_step = 3;
1030                 break;
1031         case 600:
1032                 ast_moutdwm(ast, 0x1E6E2020, 0x02E1);
1033                 param->reg_MADJ      = 0x00136868;
1034                 param->reg_SADJ      = 0x00004534;
1035                 param->wodt          = 1;
1036                 param->rodt          = 1;
1037                 param->reg_AC1       = 0x32302A37;
1038                 param->reg_AC2       = 0xDF56B61F;
1039                 param->reg_DQSIC     = 0x0000014D;
1040                 param->reg_MRS       = 0x00101A50;
1041                 param->reg_EMRS      = 0x00000004;
1042                 param->reg_DRV       = 0x000000F5;
1043                 param->reg_IOZ       = 0x00000023;
1044                 param->reg_DQIDLY    = 0x00000078;
1045                 param->reg_FREQ      = 0x000058C0;
1046                 param->madj_max      = 132;
1047                 param->dll2_finetune_step = 3;
1048                 break;
1049         case 624:
1050                 ast_moutdwm(ast, 0x1E6E2020, 0x0160);
1051                 param->reg_MADJ      = 0x00136868;
1052                 param->reg_SADJ      = 0x00004534;
1053                 param->wodt          = 1;
1054                 param->rodt          = 1;
1055                 param->reg_AC1       = 0x32302A37;
1056                 param->reg_AC2       = 0xEF56B621;
1057                 param->reg_DQSIC     = 0x0000015A;
1058                 param->reg_MRS       = 0x02101A50;
1059                 param->reg_EMRS      = 0x00000004;
1060                 param->reg_DRV       = 0x000000F5;
1061                 param->reg_IOZ       = 0x00000034;
1062                 param->reg_DQIDLY    = 0x00000078;
1063                 param->reg_FREQ      = 0x000059C0;
1064                 param->madj_max      = 128;
1065                 param->dll2_finetune_step = 3;
1066                 break;
1067         } /* switch freq */
1068
1069         switch (param->dram_chipid) {
1070         case AST_DRAM_512Mx16:
1071                 param->dram_config = 0x130;
1072                 break;
1073         default:
1074         case AST_DRAM_1Gx16:
1075                 param->dram_config = 0x131;
1076                 break;
1077         case AST_DRAM_2Gx16:
1078                 param->dram_config = 0x132;
1079                 break;
1080         case AST_DRAM_4Gx16:
1081                 param->dram_config = 0x133;
1082                 break;
1083         } /* switch size */
1084
1085         switch (param->vram_size) {
1086         default:
1087         case AST_VIDMEM_SIZE_8M:
1088                 param->dram_config |= 0x00;
1089                 break;
1090         case AST_VIDMEM_SIZE_16M:
1091                 param->dram_config |= 0x04;
1092                 break;
1093         case AST_VIDMEM_SIZE_32M:
1094                 param->dram_config |= 0x08;
1095                 break;
1096         case AST_VIDMEM_SIZE_64M:
1097                 param->dram_config |= 0x0c;
1098                 break;
1099         }
1100
1101 }
1102
1103 static void ddr3_init(struct ast_private *ast, struct ast2300_dram_param *param)
1104 {
1105         u32 data, data2, retry = 0;
1106
1107 ddr3_init_start:
1108         ast_moutdwm(ast, 0x1E6E0000, 0xFC600309);
1109         ast_moutdwm(ast, 0x1E6E0018, 0x00000100);
1110         ast_moutdwm(ast, 0x1E6E0024, 0x00000000);
1111         ast_moutdwm(ast, 0x1E6E0034, 0x00000000);
1112         udelay(10);
1113         ast_moutdwm(ast, 0x1E6E0064, param->reg_MADJ);
1114         ast_moutdwm(ast, 0x1E6E0068, param->reg_SADJ);
1115         udelay(10);
1116         ast_moutdwm(ast, 0x1E6E0064, param->reg_MADJ | 0xC0000);
1117         udelay(10);
1118
1119         ast_moutdwm(ast, 0x1E6E0004, param->dram_config);
1120         ast_moutdwm(ast, 0x1E6E0008, 0x90040f);
1121         ast_moutdwm(ast, 0x1E6E0010, param->reg_AC1);
1122         ast_moutdwm(ast, 0x1E6E0014, param->reg_AC2);
1123         ast_moutdwm(ast, 0x1E6E0020, param->reg_DQSIC);
1124         ast_moutdwm(ast, 0x1E6E0080, 0x00000000);
1125         ast_moutdwm(ast, 0x1E6E0084, 0x00000000);
1126         ast_moutdwm(ast, 0x1E6E0088, param->reg_DQIDLY);
1127         ast_moutdwm(ast, 0x1E6E0018, 0x4000A170);
1128         ast_moutdwm(ast, 0x1E6E0018, 0x00002370);
1129         ast_moutdwm(ast, 0x1E6E0038, 0x00000000);
1130         ast_moutdwm(ast, 0x1E6E0040, 0xFF444444);
1131         ast_moutdwm(ast, 0x1E6E0044, 0x22222222);
1132         ast_moutdwm(ast, 0x1E6E0048, 0x22222222);
1133         ast_moutdwm(ast, 0x1E6E004C, 0x00000002);
1134         ast_moutdwm(ast, 0x1E6E0050, 0x80000000);
1135         ast_moutdwm(ast, 0x1E6E0050, 0x00000000);
1136         ast_moutdwm(ast, 0x1E6E0054, 0);
1137         ast_moutdwm(ast, 0x1E6E0060, param->reg_DRV);
1138         ast_moutdwm(ast, 0x1E6E006C, param->reg_IOZ);
1139         ast_moutdwm(ast, 0x1E6E0070, 0x00000000);
1140         ast_moutdwm(ast, 0x1E6E0074, 0x00000000);
1141         ast_moutdwm(ast, 0x1E6E0078, 0x00000000);
1142         ast_moutdwm(ast, 0x1E6E007C, 0x00000000);
1143         /* Wait MCLK2X lock to MCLK */
1144         do {
1145                 data = ast_mindwm(ast, 0x1E6E001C);
1146         } while (!(data & 0x08000000));
1147         data = ast_mindwm(ast, 0x1E6E001C);
1148         data = (data >> 8) & 0xff;
1149         while ((data & 0x08) || ((data & 0x7) < 2) || (data < 4)) {
1150                 data2 = (ast_mindwm(ast, 0x1E6E0064) & 0xfff3ffff) + 4;
1151                 if ((data2 & 0xff) > param->madj_max) {
1152                         break;
1153                 }
1154                 ast_moutdwm(ast, 0x1E6E0064, data2);
1155                 if (data2 & 0x00100000) {
1156                         data2 = ((data2 & 0xff) >> 3) + 3;
1157                 } else {
1158                         data2 = ((data2 & 0xff) >> 2) + 5;
1159                 }
1160                 data = ast_mindwm(ast, 0x1E6E0068) & 0xffff00ff;
1161                 data2 += data & 0xff;
1162                 data = data | (data2 << 8);
1163                 ast_moutdwm(ast, 0x1E6E0068, data);
1164                 udelay(10);
1165                 ast_moutdwm(ast, 0x1E6E0064, ast_mindwm(ast, 0x1E6E0064) | 0xC0000);
1166                 udelay(10);
1167                 data = ast_mindwm(ast, 0x1E6E0018) & 0xfffff1ff;
1168                 ast_moutdwm(ast, 0x1E6E0018, data);
1169                 data = data | 0x200;
1170                 ast_moutdwm(ast, 0x1E6E0018, data);
1171                 do {
1172                         data = ast_mindwm(ast, 0x1E6E001C);
1173                 } while (!(data & 0x08000000));
1174
1175                 data = ast_mindwm(ast, 0x1E6E001C);
1176                 data = (data >> 8) & 0xff;
1177         }
1178         ast_moutdwm(ast, 0x1E720058, ast_mindwm(ast, 0x1E6E0068) & 0xffff);
1179         data = ast_mindwm(ast, 0x1E6E0018) | 0xC00;
1180         ast_moutdwm(ast, 0x1E6E0018, data);
1181
1182         ast_moutdwm(ast, 0x1E6E0034, 0x00000001);
1183         ast_moutdwm(ast, 0x1E6E000C, 0x00000040);
1184         udelay(50);
1185         /* Mode Register Setting */
1186         ast_moutdwm(ast, 0x1E6E002C, param->reg_MRS | 0x100);
1187         ast_moutdwm(ast, 0x1E6E0030, param->reg_EMRS);
1188         ast_moutdwm(ast, 0x1E6E0028, 0x00000005);
1189         ast_moutdwm(ast, 0x1E6E0028, 0x00000007);
1190         ast_moutdwm(ast, 0x1E6E0028, 0x00000003);
1191         ast_moutdwm(ast, 0x1E6E0028, 0x00000001);
1192         ast_moutdwm(ast, 0x1E6E002C, param->reg_MRS);
1193         ast_moutdwm(ast, 0x1E6E000C, 0x00005C08);
1194         ast_moutdwm(ast, 0x1E6E0028, 0x00000001);
1195
1196         ast_moutdwm(ast, 0x1E6E000C, 0x00005C01);
1197         data = 0;
1198         if (param->wodt) {
1199                 data = 0x300;
1200         }
1201         if (param->rodt) {
1202                 data = data | 0x3000 | ((param->reg_AC2 & 0x60000) >> 3);
1203         }
1204         ast_moutdwm(ast, 0x1E6E0034, data | 0x3);
1205
1206         /* Calibrate the DQSI delay */
1207         if ((cbr_dll2(ast, param) == false) && (retry++ < 10))
1208                 goto ddr3_init_start;
1209
1210         ast_moutdwm(ast, 0x1E6E0120, param->reg_FREQ);
1211         /* ECC Memory Initialization */
1212 #ifdef ECC
1213         ast_moutdwm(ast, 0x1E6E007C, 0x00000000);
1214         ast_moutdwm(ast, 0x1E6E0070, 0x221);
1215         do {
1216                 data = ast_mindwm(ast, 0x1E6E0070);
1217         } while (!(data & 0x00001000));
1218         ast_moutdwm(ast, 0x1E6E0070, 0x00000000);
1219         ast_moutdwm(ast, 0x1E6E0050, 0x80000000);
1220         ast_moutdwm(ast, 0x1E6E0050, 0x00000000);
1221 #endif
1222
1223
1224 }
1225
1226 static void get_ddr2_info(struct ast_private *ast, struct ast2300_dram_param *param)
1227 {
1228         u32 trap, trap_AC2, trap_MRS;
1229
1230         ast_moutdwm(ast, 0x1E6E2000, 0x1688A8A8);
1231
1232         /* Ger trap info */
1233         trap = (ast_mindwm(ast, 0x1E6E2070) >> 25) & 0x3;
1234         trap_AC2  = (trap << 20) | (trap << 16);
1235         trap_AC2 += 0x00110000;
1236         trap_MRS  = 0x00000040 | (trap << 4);
1237
1238
1239         param->reg_MADJ       = 0x00034C4C;
1240         param->reg_SADJ       = 0x00001800;
1241         param->reg_DRV        = 0x000000F0;
1242         param->reg_PERIOD     = param->dram_freq;
1243         param->rodt           = 0;
1244
1245         switch (param->dram_freq) {
1246         case 264:
1247                 ast_moutdwm(ast, 0x1E6E2020, 0x0130);
1248                 param->wodt          = 0;
1249                 param->reg_AC1       = 0x11101513;
1250                 param->reg_AC2       = 0x78117011;
1251                 param->reg_DQSIC     = 0x00000092;
1252                 param->reg_MRS       = 0x00000842;
1253                 param->reg_EMRS      = 0x00000000;
1254                 param->reg_DRV       = 0x000000F0;
1255                 param->reg_IOZ       = 0x00000034;
1256                 param->reg_DQIDLY    = 0x0000005A;
1257                 param->reg_FREQ      = 0x00004AC0;
1258                 param->madj_max      = 138;
1259                 param->dll2_finetune_step = 3;
1260                 break;
1261         case 336:
1262                 ast_moutdwm(ast, 0x1E6E2020, 0x0190);
1263                 param->wodt          = 1;
1264                 param->reg_AC1       = 0x22202613;
1265                 param->reg_AC2       = 0xAA009016 | trap_AC2;
1266                 param->reg_DQSIC     = 0x000000BA;
1267                 param->reg_MRS       = 0x00000A02 | trap_MRS;
1268                 param->reg_EMRS      = 0x00000040;
1269                 param->reg_DRV       = 0x000000FA;
1270                 param->reg_IOZ       = 0x00000034;
1271                 param->reg_DQIDLY    = 0x00000074;
1272                 param->reg_FREQ      = 0x00004DC0;
1273                 param->madj_max      = 96;
1274                 param->dll2_finetune_step = 3;
1275                 switch (param->dram_chipid) {
1276                 default:
1277                 case AST_DRAM_512Mx16:
1278                         param->reg_AC2   = 0xAA009012 | trap_AC2;
1279                         break;
1280                 case AST_DRAM_1Gx16:
1281                         param->reg_AC2   = 0xAA009016 | trap_AC2;
1282                         break;
1283                 case AST_DRAM_2Gx16:
1284                         param->reg_AC2   = 0xAA009023 | trap_AC2;
1285                         break;
1286                 case AST_DRAM_4Gx16:
1287                         param->reg_AC2   = 0xAA00903B | trap_AC2;
1288                         break;
1289                 }
1290                 break;
1291         default:
1292         case 396:
1293                 ast_moutdwm(ast, 0x1E6E2020, 0x03F1);
1294                 param->wodt          = 1;
1295                 param->rodt          = 0;
1296                 param->reg_AC1       = 0x33302714;
1297                 param->reg_AC2       = 0xCC00B01B | trap_AC2;
1298                 param->reg_DQSIC     = 0x000000E2;
1299                 param->reg_MRS       = 0x00000C02 | trap_MRS;
1300                 param->reg_EMRS      = 0x00000040;
1301                 param->reg_DRV       = 0x000000FA;
1302                 param->reg_IOZ       = 0x00000034;
1303                 param->reg_DQIDLY    = 0x00000089;
1304                 param->reg_FREQ      = 0x00005040;
1305                 param->madj_max      = 96;
1306                 param->dll2_finetune_step = 4;
1307
1308                 switch (param->dram_chipid) {
1309                 case AST_DRAM_512Mx16:
1310                         param->reg_AC2   = 0xCC00B016 | trap_AC2;
1311                         break;
1312                 default:
1313                 case AST_DRAM_1Gx16:
1314                         param->reg_AC2   = 0xCC00B01B | trap_AC2;
1315                         break;
1316                 case AST_DRAM_2Gx16:
1317                         param->reg_AC2   = 0xCC00B02B | trap_AC2;
1318                         break;
1319                 case AST_DRAM_4Gx16:
1320                         param->reg_AC2   = 0xCC00B03F | trap_AC2;
1321                         break;
1322                 }
1323
1324                 break;
1325
1326         case 408:
1327                 ast_moutdwm(ast, 0x1E6E2020, 0x01F0);
1328                 param->wodt          = 1;
1329                 param->rodt          = 0;
1330                 param->reg_AC1       = 0x33302714;
1331                 param->reg_AC2       = 0xCC00B01B | trap_AC2;
1332                 param->reg_DQSIC     = 0x000000E2;
1333                 param->reg_MRS       = 0x00000C02 | trap_MRS;
1334                 param->reg_EMRS      = 0x00000040;
1335                 param->reg_DRV       = 0x000000FA;
1336                 param->reg_IOZ       = 0x00000034;
1337                 param->reg_DQIDLY    = 0x00000089;
1338                 param->reg_FREQ      = 0x000050C0;
1339                 param->madj_max      = 96;
1340                 param->dll2_finetune_step = 4;
1341
1342                 switch (param->dram_chipid) {
1343                 case AST_DRAM_512Mx16:
1344                         param->reg_AC2   = 0xCC00B016 | trap_AC2;
1345                         break;
1346                 default:
1347                 case AST_DRAM_1Gx16:
1348                         param->reg_AC2   = 0xCC00B01B | trap_AC2;
1349                         break;
1350                 case AST_DRAM_2Gx16:
1351                         param->reg_AC2   = 0xCC00B02B | trap_AC2;
1352                         break;
1353                 case AST_DRAM_4Gx16:
1354                         param->reg_AC2   = 0xCC00B03F | trap_AC2;
1355                         break;
1356                 }
1357
1358                 break;
1359         case 456:
1360                 ast_moutdwm(ast, 0x1E6E2020, 0x0230);
1361                 param->wodt          = 0;
1362                 param->reg_AC1       = 0x33302815;
1363                 param->reg_AC2       = 0xCD44B01E;
1364                 param->reg_DQSIC     = 0x000000FC;
1365                 param->reg_MRS       = 0x00000E72;
1366                 param->reg_EMRS      = 0x00000000;
1367                 param->reg_DRV       = 0x00000000;
1368                 param->reg_IOZ       = 0x00000034;
1369                 param->reg_DQIDLY    = 0x00000097;
1370                 param->reg_FREQ      = 0x000052C0;
1371                 param->madj_max      = 88;
1372                 param->dll2_finetune_step = 3;
1373                 break;
1374         case 504:
1375                 ast_moutdwm(ast, 0x1E6E2020, 0x0261);
1376                 param->wodt          = 1;
1377                 param->rodt          = 1;
1378                 param->reg_AC1       = 0x33302815;
1379                 param->reg_AC2       = 0xDE44C022;
1380                 param->reg_DQSIC     = 0x00000117;
1381                 param->reg_MRS       = 0x00000E72;
1382                 param->reg_EMRS      = 0x00000040;
1383                 param->reg_DRV       = 0x0000000A;
1384                 param->reg_IOZ       = 0x00000045;
1385                 param->reg_DQIDLY    = 0x000000A0;
1386                 param->reg_FREQ      = 0x000054C0;
1387                 param->madj_max      = 79;
1388                 param->dll2_finetune_step = 3;
1389                 break;
1390         case 528:
1391                 ast_moutdwm(ast, 0x1E6E2020, 0x0120);
1392                 param->wodt          = 1;
1393                 param->rodt          = 1;
1394                 param->reg_AC1       = 0x33302815;
1395                 param->reg_AC2       = 0xEF44D024;
1396                 param->reg_DQSIC     = 0x00000125;
1397                 param->reg_MRS       = 0x00000E72;
1398                 param->reg_EMRS      = 0x00000004;
1399                 param->reg_DRV       = 0x000000F9;
1400                 param->reg_IOZ       = 0x00000045;
1401                 param->reg_DQIDLY    = 0x000000A7;
1402                 param->reg_FREQ      = 0x000055C0;
1403                 param->madj_max      = 76;
1404                 param->dll2_finetune_step = 3;
1405                 break;
1406         case 552:
1407                 ast_moutdwm(ast, 0x1E6E2020, 0x02A1);
1408                 param->wodt          = 1;
1409                 param->rodt          = 1;
1410                 param->reg_AC1       = 0x43402915;
1411                 param->reg_AC2       = 0xFF44E025;
1412                 param->reg_DQSIC     = 0x00000132;
1413                 param->reg_MRS       = 0x00000E72;
1414                 param->reg_EMRS      = 0x00000040;
1415                 param->reg_DRV       = 0x0000000A;
1416                 param->reg_IOZ       = 0x00000045;
1417                 param->reg_DQIDLY    = 0x000000AD;
1418                 param->reg_FREQ      = 0x000056C0;
1419                 param->madj_max      = 76;
1420                 param->dll2_finetune_step = 3;
1421                 break;
1422         case 576:
1423                 ast_moutdwm(ast, 0x1E6E2020, 0x0140);
1424                 param->wodt          = 1;
1425                 param->rodt          = 1;
1426                 param->reg_AC1       = 0x43402915;
1427                 param->reg_AC2       = 0xFF44E027;
1428                 param->reg_DQSIC     = 0x0000013F;
1429                 param->reg_MRS       = 0x00000E72;
1430                 param->reg_EMRS      = 0x00000004;
1431                 param->reg_DRV       = 0x000000F5;
1432                 param->reg_IOZ       = 0x00000045;
1433                 param->reg_DQIDLY    = 0x000000B3;
1434                 param->reg_FREQ      = 0x000057C0;
1435                 param->madj_max      = 76;
1436                 param->dll2_finetune_step = 3;
1437                 break;
1438         }
1439
1440         switch (param->dram_chipid) {
1441         case AST_DRAM_512Mx16:
1442                 param->dram_config = 0x100;
1443                 break;
1444         default:
1445         case AST_DRAM_1Gx16:
1446                 param->dram_config = 0x121;
1447                 break;
1448         case AST_DRAM_2Gx16:
1449                 param->dram_config = 0x122;
1450                 break;
1451         case AST_DRAM_4Gx16:
1452                 param->dram_config = 0x123;
1453                 break;
1454         } /* switch size */
1455
1456         switch (param->vram_size) {
1457         default:
1458         case AST_VIDMEM_SIZE_8M:
1459                 param->dram_config |= 0x00;
1460                 break;
1461         case AST_VIDMEM_SIZE_16M:
1462                 param->dram_config |= 0x04;
1463                 break;
1464         case AST_VIDMEM_SIZE_32M:
1465                 param->dram_config |= 0x08;
1466                 break;
1467         case AST_VIDMEM_SIZE_64M:
1468                 param->dram_config |= 0x0c;
1469                 break;
1470         }
1471 }
1472
1473 static void ddr2_init(struct ast_private *ast, struct ast2300_dram_param *param)
1474 {
1475         u32 data, data2, retry = 0;
1476
1477 ddr2_init_start:
1478         ast_moutdwm(ast, 0x1E6E0000, 0xFC600309);
1479         ast_moutdwm(ast, 0x1E6E0018, 0x00000100);
1480         ast_moutdwm(ast, 0x1E6E0024, 0x00000000);
1481         ast_moutdwm(ast, 0x1E6E0064, param->reg_MADJ);
1482         ast_moutdwm(ast, 0x1E6E0068, param->reg_SADJ);
1483         udelay(10);
1484         ast_moutdwm(ast, 0x1E6E0064, param->reg_MADJ | 0xC0000);
1485         udelay(10);
1486
1487         ast_moutdwm(ast, 0x1E6E0004, param->dram_config);
1488         ast_moutdwm(ast, 0x1E6E0008, 0x90040f);
1489         ast_moutdwm(ast, 0x1E6E0010, param->reg_AC1);
1490         ast_moutdwm(ast, 0x1E6E0014, param->reg_AC2);
1491         ast_moutdwm(ast, 0x1E6E0020, param->reg_DQSIC);
1492         ast_moutdwm(ast, 0x1E6E0080, 0x00000000);
1493         ast_moutdwm(ast, 0x1E6E0084, 0x00000000);
1494         ast_moutdwm(ast, 0x1E6E0088, param->reg_DQIDLY);
1495         ast_moutdwm(ast, 0x1E6E0018, 0x4000A130);
1496         ast_moutdwm(ast, 0x1E6E0018, 0x00002330);
1497         ast_moutdwm(ast, 0x1E6E0038, 0x00000000);
1498         ast_moutdwm(ast, 0x1E6E0040, 0xFF808000);
1499         ast_moutdwm(ast, 0x1E6E0044, 0x88848466);
1500         ast_moutdwm(ast, 0x1E6E0048, 0x44440008);
1501         ast_moutdwm(ast, 0x1E6E004C, 0x00000000);
1502         ast_moutdwm(ast, 0x1E6E0050, 0x80000000);
1503         ast_moutdwm(ast, 0x1E6E0050, 0x00000000);
1504         ast_moutdwm(ast, 0x1E6E0054, 0);
1505         ast_moutdwm(ast, 0x1E6E0060, param->reg_DRV);
1506         ast_moutdwm(ast, 0x1E6E006C, param->reg_IOZ);
1507         ast_moutdwm(ast, 0x1E6E0070, 0x00000000);
1508         ast_moutdwm(ast, 0x1E6E0074, 0x00000000);
1509         ast_moutdwm(ast, 0x1E6E0078, 0x00000000);
1510         ast_moutdwm(ast, 0x1E6E007C, 0x00000000);
1511
1512         /* Wait MCLK2X lock to MCLK */
1513         do {
1514                 data = ast_mindwm(ast, 0x1E6E001C);
1515         } while (!(data & 0x08000000));
1516         data = ast_mindwm(ast, 0x1E6E001C);
1517         data = (data >> 8) & 0xff;
1518         while ((data & 0x08) || ((data & 0x7) < 2) || (data < 4)) {
1519                 data2 = (ast_mindwm(ast, 0x1E6E0064) & 0xfff3ffff) + 4;
1520                 if ((data2 & 0xff) > param->madj_max) {
1521                         break;
1522                 }
1523                 ast_moutdwm(ast, 0x1E6E0064, data2);
1524                 if (data2 & 0x00100000) {
1525                         data2 = ((data2 & 0xff) >> 3) + 3;
1526                 } else {
1527                         data2 = ((data2 & 0xff) >> 2) + 5;
1528                 }
1529                 data = ast_mindwm(ast, 0x1E6E0068) & 0xffff00ff;
1530                 data2 += data & 0xff;
1531                 data = data | (data2 << 8);
1532                 ast_moutdwm(ast, 0x1E6E0068, data);
1533                 udelay(10);
1534                 ast_moutdwm(ast, 0x1E6E0064, ast_mindwm(ast, 0x1E6E0064) | 0xC0000);
1535                 udelay(10);
1536                 data = ast_mindwm(ast, 0x1E6E0018) & 0xfffff1ff;
1537                 ast_moutdwm(ast, 0x1E6E0018, data);
1538                 data = data | 0x200;
1539                 ast_moutdwm(ast, 0x1E6E0018, data);
1540                 do {
1541                         data = ast_mindwm(ast, 0x1E6E001C);
1542                 } while (!(data & 0x08000000));
1543
1544                 data = ast_mindwm(ast, 0x1E6E001C);
1545                 data = (data >> 8) & 0xff;
1546         }
1547         ast_moutdwm(ast, 0x1E720058, ast_mindwm(ast, 0x1E6E0008) & 0xffff);
1548         data = ast_mindwm(ast, 0x1E6E0018) | 0xC00;
1549         ast_moutdwm(ast, 0x1E6E0018, data);
1550
1551         ast_moutdwm(ast, 0x1E6E0034, 0x00000001);
1552         ast_moutdwm(ast, 0x1E6E000C, 0x00000000);
1553         udelay(50);
1554         /* Mode Register Setting */
1555         ast_moutdwm(ast, 0x1E6E002C, param->reg_MRS | 0x100);
1556         ast_moutdwm(ast, 0x1E6E0030, param->reg_EMRS);
1557         ast_moutdwm(ast, 0x1E6E0028, 0x00000005);
1558         ast_moutdwm(ast, 0x1E6E0028, 0x00000007);
1559         ast_moutdwm(ast, 0x1E6E0028, 0x00000003);
1560         ast_moutdwm(ast, 0x1E6E0028, 0x00000001);
1561
1562         ast_moutdwm(ast, 0x1E6E000C, 0x00005C08);
1563         ast_moutdwm(ast, 0x1E6E002C, param->reg_MRS);
1564         ast_moutdwm(ast, 0x1E6E0028, 0x00000001);
1565         ast_moutdwm(ast, 0x1E6E0030, param->reg_EMRS | 0x380);
1566         ast_moutdwm(ast, 0x1E6E0028, 0x00000003);
1567         ast_moutdwm(ast, 0x1E6E0030, param->reg_EMRS);
1568         ast_moutdwm(ast, 0x1E6E0028, 0x00000003);
1569
1570         ast_moutdwm(ast, 0x1E6E000C, 0x7FFF5C01);
1571         data = 0;
1572         if (param->wodt) {
1573                 data = 0x500;
1574         }
1575         if (param->rodt) {
1576                 data = data | 0x3000 | ((param->reg_AC2 & 0x60000) >> 3);
1577         }
1578         ast_moutdwm(ast, 0x1E6E0034, data | 0x3);
1579         ast_moutdwm(ast, 0x1E6E0120, param->reg_FREQ);
1580
1581         /* Calibrate the DQSI delay */
1582         if ((cbr_dll2(ast, param) == false) && (retry++ < 10))
1583                 goto ddr2_init_start;
1584
1585         /* ECC Memory Initialization */
1586 #ifdef ECC
1587         ast_moutdwm(ast, 0x1E6E007C, 0x00000000);
1588         ast_moutdwm(ast, 0x1E6E0070, 0x221);
1589         do {
1590                 data = ast_mindwm(ast, 0x1E6E0070);
1591         } while (!(data & 0x00001000));
1592         ast_moutdwm(ast, 0x1E6E0070, 0x00000000);
1593         ast_moutdwm(ast, 0x1E6E0050, 0x80000000);
1594         ast_moutdwm(ast, 0x1E6E0050, 0x00000000);
1595 #endif
1596
1597 }
1598
1599 static void ast_post_chip_2300(struct drm_device *dev)
1600 {
1601         struct ast_private *ast = to_ast_private(dev);
1602         struct ast2300_dram_param param;
1603         u32 temp;
1604         u8 reg;
1605
1606         reg = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd0, 0xff);
1607         if ((reg & 0x80) == 0) {/* vga only */
1608                 ast_write32(ast, 0xf004, 0x1e6e0000);
1609                 ast_write32(ast, 0xf000, 0x1);
1610                 ast_write32(ast, 0x12000, 0x1688a8a8);
1611                 do {
1612                         ;
1613                 } while (ast_read32(ast, 0x12000) != 0x1);
1614
1615                 ast_write32(ast, 0x10000, 0xfc600309);
1616                 do {
1617                         ;
1618                 } while (ast_read32(ast, 0x10000) != 0x1);
1619
1620                 /* Slow down CPU/AHB CLK in VGA only mode */
1621                 temp = ast_read32(ast, 0x12008);
1622                 temp |= 0x73;
1623                 ast_write32(ast, 0x12008, temp);
1624
1625                 param.dram_freq = 396;
1626                 param.dram_type = AST_DDR3;
1627                 temp = ast_mindwm(ast, 0x1e6e2070);
1628                 if (temp & 0x01000000)
1629                         param.dram_type = AST_DDR2;
1630                 switch (temp & 0x18000000) {
1631                 case 0:
1632                         param.dram_chipid = AST_DRAM_512Mx16;
1633                         break;
1634                 default:
1635                 case 0x08000000:
1636                         param.dram_chipid = AST_DRAM_1Gx16;
1637                         break;
1638                 case 0x10000000:
1639                         param.dram_chipid = AST_DRAM_2Gx16;
1640                         break;
1641                 case 0x18000000:
1642                         param.dram_chipid = AST_DRAM_4Gx16;
1643                         break;
1644                 }
1645                 switch (temp & 0x0c) {
1646                 default:
1647                 case 0x00:
1648                         param.vram_size = AST_VIDMEM_SIZE_8M;
1649                         break;
1650
1651                 case 0x04:
1652                         param.vram_size = AST_VIDMEM_SIZE_16M;
1653                         break;
1654
1655                 case 0x08:
1656                         param.vram_size = AST_VIDMEM_SIZE_32M;
1657                         break;
1658
1659                 case 0x0c:
1660                         param.vram_size = AST_VIDMEM_SIZE_64M;
1661                         break;
1662                 }
1663
1664                 if (param.dram_type == AST_DDR3) {
1665                         get_ddr3_info(ast, &param);
1666                         ddr3_init(ast, &param);
1667                 } else {
1668                         get_ddr2_info(ast, &param);
1669                         ddr2_init(ast, &param);
1670                 }
1671
1672                 temp = ast_mindwm(ast, 0x1e6e2040);
1673                 ast_moutdwm(ast, 0x1e6e2040, temp | 0x40);
1674         }
1675
1676         /* wait ready */
1677         do {
1678                 reg = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd0, 0xff);
1679         } while ((reg & 0x40) == 0);
1680 }
1681
1682 static bool cbr_test_2500(struct ast_private *ast)
1683 {
1684         ast_moutdwm(ast, 0x1E6E0074, 0x0000FFFF);
1685         ast_moutdwm(ast, 0x1E6E007C, 0xFF00FF00);
1686         if (!mmc_test_burst(ast, 0))
1687                 return false;
1688         if (!mmc_test_single_2500(ast, 0))
1689                 return false;
1690         return true;
1691 }
1692
1693 static bool ddr_test_2500(struct ast_private *ast)
1694 {
1695         ast_moutdwm(ast, 0x1E6E0074, 0x0000FFFF);
1696         ast_moutdwm(ast, 0x1E6E007C, 0xFF00FF00);
1697         if (!mmc_test_burst(ast, 0))
1698                 return false;
1699         if (!mmc_test_burst(ast, 1))
1700                 return false;
1701         if (!mmc_test_burst(ast, 2))
1702                 return false;
1703         if (!mmc_test_burst(ast, 3))
1704                 return false;
1705         if (!mmc_test_single_2500(ast, 0))
1706                 return false;
1707         return true;
1708 }
1709
1710 static void ddr_init_common_2500(struct ast_private *ast)
1711 {
1712         ast_moutdwm(ast, 0x1E6E0034, 0x00020080);
1713         ast_moutdwm(ast, 0x1E6E0008, 0x2003000F);
1714         ast_moutdwm(ast, 0x1E6E0038, 0x00000FFF);
1715         ast_moutdwm(ast, 0x1E6E0040, 0x88448844);
1716         ast_moutdwm(ast, 0x1E6E0044, 0x24422288);
1717         ast_moutdwm(ast, 0x1E6E0048, 0x22222222);
1718         ast_moutdwm(ast, 0x1E6E004C, 0x22222222);
1719         ast_moutdwm(ast, 0x1E6E0050, 0x80000000);
1720         ast_moutdwm(ast, 0x1E6E0208, 0x00000000);
1721         ast_moutdwm(ast, 0x1E6E0218, 0x00000000);
1722         ast_moutdwm(ast, 0x1E6E0220, 0x00000000);
1723         ast_moutdwm(ast, 0x1E6E0228, 0x00000000);
1724         ast_moutdwm(ast, 0x1E6E0230, 0x00000000);
1725         ast_moutdwm(ast, 0x1E6E02A8, 0x00000000);
1726         ast_moutdwm(ast, 0x1E6E02B0, 0x00000000);
1727         ast_moutdwm(ast, 0x1E6E0240, 0x86000000);
1728         ast_moutdwm(ast, 0x1E6E0244, 0x00008600);
1729         ast_moutdwm(ast, 0x1E6E0248, 0x80000000);
1730         ast_moutdwm(ast, 0x1E6E024C, 0x80808080);
1731 }
1732
1733 static void ddr_phy_init_2500(struct ast_private *ast)
1734 {
1735         u32 data, pass, timecnt;
1736
1737         pass = 0;
1738         ast_moutdwm(ast, 0x1E6E0060, 0x00000005);
1739         while (!pass) {
1740                 for (timecnt = 0; timecnt < TIMEOUT; timecnt++) {
1741                         data = ast_mindwm(ast, 0x1E6E0060) & 0x1;
1742                         if (!data)
1743                                 break;
1744                 }
1745                 if (timecnt != TIMEOUT) {
1746                         data = ast_mindwm(ast, 0x1E6E0300) & 0x000A0000;
1747                         if (!data)
1748                                 pass = 1;
1749                 }
1750                 if (!pass) {
1751                         ast_moutdwm(ast, 0x1E6E0060, 0x00000000);
1752                         udelay(10); /* delay 10 us */
1753                         ast_moutdwm(ast, 0x1E6E0060, 0x00000005);
1754                 }
1755         }
1756
1757         ast_moutdwm(ast, 0x1E6E0060, 0x00000006);
1758 }
1759
1760 /*
1761  * Check DRAM Size
1762  * 1Gb : 0x80000000 ~ 0x87FFFFFF
1763  * 2Gb : 0x80000000 ~ 0x8FFFFFFF
1764  * 4Gb : 0x80000000 ~ 0x9FFFFFFF
1765  * 8Gb : 0x80000000 ~ 0xBFFFFFFF
1766  */
1767 static void check_dram_size_2500(struct ast_private *ast, u32 tRFC)
1768 {
1769         u32 reg_04, reg_14;
1770
1771         reg_04 = ast_mindwm(ast, 0x1E6E0004) & 0xfffffffc;
1772         reg_14 = ast_mindwm(ast, 0x1E6E0014) & 0xffffff00;
1773
1774         ast_moutdwm(ast, 0xA0100000, 0x41424344);
1775         ast_moutdwm(ast, 0x90100000, 0x35363738);
1776         ast_moutdwm(ast, 0x88100000, 0x292A2B2C);
1777         ast_moutdwm(ast, 0x80100000, 0x1D1E1F10);
1778
1779         /* Check 8Gbit */
1780         if (ast_mindwm(ast, 0xA0100000) == 0x41424344) {
1781                 reg_04 |= 0x03;
1782                 reg_14 |= (tRFC >> 24) & 0xFF;
1783                 /* Check 4Gbit */
1784         } else if (ast_mindwm(ast, 0x90100000) == 0x35363738) {
1785                 reg_04 |= 0x02;
1786                 reg_14 |= (tRFC >> 16) & 0xFF;
1787                 /* Check 2Gbit */
1788         } else if (ast_mindwm(ast, 0x88100000) == 0x292A2B2C) {
1789                 reg_04 |= 0x01;
1790                 reg_14 |= (tRFC >> 8) & 0xFF;
1791         } else {
1792                 reg_14 |= tRFC & 0xFF;
1793         }
1794         ast_moutdwm(ast, 0x1E6E0004, reg_04);
1795         ast_moutdwm(ast, 0x1E6E0014, reg_14);
1796 }
1797
1798 static void enable_cache_2500(struct ast_private *ast)
1799 {
1800         u32 reg_04, data;
1801
1802         reg_04 = ast_mindwm(ast, 0x1E6E0004);
1803         ast_moutdwm(ast, 0x1E6E0004, reg_04 | 0x1000);
1804
1805         do
1806                 data = ast_mindwm(ast, 0x1E6E0004);
1807         while (!(data & 0x80000));
1808         ast_moutdwm(ast, 0x1E6E0004, reg_04 | 0x400);
1809 }
1810
1811 static void set_mpll_2500(struct ast_private *ast)
1812 {
1813         u32 addr, data, param;
1814
1815         /* Reset MMC */
1816         ast_moutdwm(ast, 0x1E6E0000, 0xFC600309);
1817         ast_moutdwm(ast, 0x1E6E0034, 0x00020080);
1818         for (addr = 0x1e6e0004; addr < 0x1e6e0090;) {
1819                 ast_moutdwm(ast, addr, 0x0);
1820                 addr += 4;
1821         }
1822         ast_moutdwm(ast, 0x1E6E0034, 0x00020000);
1823
1824         ast_moutdwm(ast, 0x1E6E2000, 0x1688A8A8);
1825         data = ast_mindwm(ast, 0x1E6E2070) & 0x00800000;
1826         if (data) {
1827                 /* CLKIN = 25MHz */
1828                 param = 0x930023E0;
1829                 ast_moutdwm(ast, 0x1E6E2160, 0x00011320);
1830         } else {
1831                 /* CLKIN = 24MHz */
1832                 param = 0x93002400;
1833         }
1834         ast_moutdwm(ast, 0x1E6E2020, param);
1835         udelay(100);
1836 }
1837
1838 static void reset_mmc_2500(struct ast_private *ast)
1839 {
1840         ast_moutdwm(ast, 0x1E78505C, 0x00000004);
1841         ast_moutdwm(ast, 0x1E785044, 0x00000001);
1842         ast_moutdwm(ast, 0x1E785048, 0x00004755);
1843         ast_moutdwm(ast, 0x1E78504C, 0x00000013);
1844         mdelay(100);
1845         ast_moutdwm(ast, 0x1E785054, 0x00000077);
1846         ast_moutdwm(ast, 0x1E6E0000, 0xFC600309);
1847 }
1848
1849 static void ddr3_init_2500(struct ast_private *ast, const u32 *ddr_table)
1850 {
1851
1852         ast_moutdwm(ast, 0x1E6E0004, 0x00000303);
1853         ast_moutdwm(ast, 0x1E6E0010, ddr_table[REGIDX_010]);
1854         ast_moutdwm(ast, 0x1E6E0014, ddr_table[REGIDX_014]);
1855         ast_moutdwm(ast, 0x1E6E0018, ddr_table[REGIDX_018]);
1856         ast_moutdwm(ast, 0x1E6E0020, ddr_table[REGIDX_020]);         /* MODEREG4/6 */
1857         ast_moutdwm(ast, 0x1E6E0024, ddr_table[REGIDX_024]);         /* MODEREG5 */
1858         ast_moutdwm(ast, 0x1E6E002C, ddr_table[REGIDX_02C] | 0x100); /* MODEREG0/2 */
1859         ast_moutdwm(ast, 0x1E6E0030, ddr_table[REGIDX_030]);         /* MODEREG1/3 */
1860
1861         /* DDR PHY Setting */
1862         ast_moutdwm(ast, 0x1E6E0200, 0x02492AAE);
1863         ast_moutdwm(ast, 0x1E6E0204, 0x00001001);
1864         ast_moutdwm(ast, 0x1E6E020C, 0x55E00B0B);
1865         ast_moutdwm(ast, 0x1E6E0210, 0x20000000);
1866         ast_moutdwm(ast, 0x1E6E0214, ddr_table[REGIDX_214]);
1867         ast_moutdwm(ast, 0x1E6E02E0, ddr_table[REGIDX_2E0]);
1868         ast_moutdwm(ast, 0x1E6E02E4, ddr_table[REGIDX_2E4]);
1869         ast_moutdwm(ast, 0x1E6E02E8, ddr_table[REGIDX_2E8]);
1870         ast_moutdwm(ast, 0x1E6E02EC, ddr_table[REGIDX_2EC]);
1871         ast_moutdwm(ast, 0x1E6E02F0, ddr_table[REGIDX_2F0]);
1872         ast_moutdwm(ast, 0x1E6E02F4, ddr_table[REGIDX_2F4]);
1873         ast_moutdwm(ast, 0x1E6E02F8, ddr_table[REGIDX_2F8]);
1874         ast_moutdwm(ast, 0x1E6E0290, 0x00100008);
1875         ast_moutdwm(ast, 0x1E6E02C0, 0x00000006);
1876
1877         /* Controller Setting */
1878         ast_moutdwm(ast, 0x1E6E0034, 0x00020091);
1879
1880         /* Wait DDR PHY init done */
1881         ddr_phy_init_2500(ast);
1882
1883         ast_moutdwm(ast, 0x1E6E0120, ddr_table[REGIDX_PLL]);
1884         ast_moutdwm(ast, 0x1E6E000C, 0x42AA5C81);
1885         ast_moutdwm(ast, 0x1E6E0034, 0x0001AF93);
1886
1887         check_dram_size_2500(ast, ddr_table[REGIDX_RFC]);
1888         enable_cache_2500(ast);
1889         ast_moutdwm(ast, 0x1E6E001C, 0x00000008);
1890         ast_moutdwm(ast, 0x1E6E0038, 0xFFFFFF00);
1891 }
1892
1893 static void ddr4_init_2500(struct ast_private *ast, const u32 *ddr_table)
1894 {
1895         u32 data, data2, pass, retrycnt;
1896         u32 ddr_vref, phy_vref;
1897         u32 min_ddr_vref = 0, min_phy_vref = 0;
1898         u32 max_ddr_vref = 0, max_phy_vref = 0;
1899
1900         ast_moutdwm(ast, 0x1E6E0004, 0x00000313);
1901         ast_moutdwm(ast, 0x1E6E0010, ddr_table[REGIDX_010]);
1902         ast_moutdwm(ast, 0x1E6E0014, ddr_table[REGIDX_014]);
1903         ast_moutdwm(ast, 0x1E6E0018, ddr_table[REGIDX_018]);
1904         ast_moutdwm(ast, 0x1E6E0020, ddr_table[REGIDX_020]);         /* MODEREG4/6 */
1905         ast_moutdwm(ast, 0x1E6E0024, ddr_table[REGIDX_024]);         /* MODEREG5 */
1906         ast_moutdwm(ast, 0x1E6E002C, ddr_table[REGIDX_02C] | 0x100); /* MODEREG0/2 */
1907         ast_moutdwm(ast, 0x1E6E0030, ddr_table[REGIDX_030]);         /* MODEREG1/3 */
1908
1909         /* DDR PHY Setting */
1910         ast_moutdwm(ast, 0x1E6E0200, 0x42492AAE);
1911         ast_moutdwm(ast, 0x1E6E0204, 0x09002000);
1912         ast_moutdwm(ast, 0x1E6E020C, 0x55E00B0B);
1913         ast_moutdwm(ast, 0x1E6E0210, 0x20000000);
1914         ast_moutdwm(ast, 0x1E6E0214, ddr_table[REGIDX_214]);
1915         ast_moutdwm(ast, 0x1E6E02E0, ddr_table[REGIDX_2E0]);
1916         ast_moutdwm(ast, 0x1E6E02E4, ddr_table[REGIDX_2E4]);
1917         ast_moutdwm(ast, 0x1E6E02E8, ddr_table[REGIDX_2E8]);
1918         ast_moutdwm(ast, 0x1E6E02EC, ddr_table[REGIDX_2EC]);
1919         ast_moutdwm(ast, 0x1E6E02F0, ddr_table[REGIDX_2F0]);
1920         ast_moutdwm(ast, 0x1E6E02F4, ddr_table[REGIDX_2F4]);
1921         ast_moutdwm(ast, 0x1E6E02F8, ddr_table[REGIDX_2F8]);
1922         ast_moutdwm(ast, 0x1E6E0290, 0x00100008);
1923         ast_moutdwm(ast, 0x1E6E02C4, 0x3C183C3C);
1924         ast_moutdwm(ast, 0x1E6E02C8, 0x00631E0E);
1925
1926         /* Controller Setting */
1927         ast_moutdwm(ast, 0x1E6E0034, 0x0001A991);
1928
1929         /* Train PHY Vref first */
1930         pass = 0;
1931
1932         for (retrycnt = 0; retrycnt < 4 && pass == 0; retrycnt++) {
1933                 max_phy_vref = 0x0;
1934                 pass = 0;
1935                 ast_moutdwm(ast, 0x1E6E02C0, 0x00001C06);
1936                 for (phy_vref = 0x40; phy_vref < 0x80; phy_vref++) {
1937                         ast_moutdwm(ast, 0x1E6E000C, 0x00000000);
1938                         ast_moutdwm(ast, 0x1E6E0060, 0x00000000);
1939                         ast_moutdwm(ast, 0x1E6E02CC, phy_vref | (phy_vref << 8));
1940                         /* Fire DFI Init */
1941                         ddr_phy_init_2500(ast);
1942                         ast_moutdwm(ast, 0x1E6E000C, 0x00005C01);
1943                         if (cbr_test_2500(ast)) {
1944                                 pass++;
1945                                 data = ast_mindwm(ast, 0x1E6E03D0);
1946                                 data2 = data >> 8;
1947                                 data  = data & 0xff;
1948                                 if (data > data2)
1949                                         data = data2;
1950                                 if (max_phy_vref < data) {
1951                                         max_phy_vref = data;
1952                                         min_phy_vref = phy_vref;
1953                                 }
1954                         } else if (pass > 0)
1955                                 break;
1956                 }
1957         }
1958         ast_moutdwm(ast, 0x1E6E02CC, min_phy_vref | (min_phy_vref << 8));
1959
1960         /* Train DDR Vref next */
1961         pass = 0;
1962
1963         for (retrycnt = 0; retrycnt < 4 && pass == 0; retrycnt++) {
1964                 min_ddr_vref = 0xFF;
1965                 max_ddr_vref = 0x0;
1966                 pass = 0;
1967                 for (ddr_vref = 0x00; ddr_vref < 0x40; ddr_vref++) {
1968                         ast_moutdwm(ast, 0x1E6E000C, 0x00000000);
1969                         ast_moutdwm(ast, 0x1E6E0060, 0x00000000);
1970                         ast_moutdwm(ast, 0x1E6E02C0, 0x00000006 | (ddr_vref << 8));
1971                         /* Fire DFI Init */
1972                         ddr_phy_init_2500(ast);
1973                         ast_moutdwm(ast, 0x1E6E000C, 0x00005C01);
1974                         if (cbr_test_2500(ast)) {
1975                                 pass++;
1976                                 if (min_ddr_vref > ddr_vref)
1977                                         min_ddr_vref = ddr_vref;
1978                                 if (max_ddr_vref < ddr_vref)
1979                                         max_ddr_vref = ddr_vref;
1980                         } else if (pass != 0)
1981                                 break;
1982                 }
1983         }
1984
1985         ast_moutdwm(ast, 0x1E6E000C, 0x00000000);
1986         ast_moutdwm(ast, 0x1E6E0060, 0x00000000);
1987         ddr_vref = (min_ddr_vref + max_ddr_vref + 1) >> 1;
1988         ast_moutdwm(ast, 0x1E6E02C0, 0x00000006 | (ddr_vref << 8));
1989
1990         /* Wait DDR PHY init done */
1991         ddr_phy_init_2500(ast);
1992
1993         ast_moutdwm(ast, 0x1E6E0120, ddr_table[REGIDX_PLL]);
1994         ast_moutdwm(ast, 0x1E6E000C, 0x42AA5C81);
1995         ast_moutdwm(ast, 0x1E6E0034, 0x0001AF93);
1996
1997         check_dram_size_2500(ast, ddr_table[REGIDX_RFC]);
1998         enable_cache_2500(ast);
1999         ast_moutdwm(ast, 0x1E6E001C, 0x00000008);
2000         ast_moutdwm(ast, 0x1E6E0038, 0xFFFFFF00);
2001 }
2002
2003 static bool ast_dram_init_2500(struct ast_private *ast)
2004 {
2005         u32 data;
2006         u32 max_tries = 5;
2007
2008         do {
2009                 if (max_tries-- == 0)
2010                         return false;
2011                 set_mpll_2500(ast);
2012                 reset_mmc_2500(ast);
2013                 ddr_init_common_2500(ast);
2014
2015                 data = ast_mindwm(ast, 0x1E6E2070);
2016                 if (data & 0x01000000)
2017                         ddr4_init_2500(ast, ast2500_ddr4_1600_timing_table);
2018                 else
2019                         ddr3_init_2500(ast, ast2500_ddr3_1600_timing_table);
2020         } while (!ddr_test_2500(ast));
2021
2022         ast_moutdwm(ast, 0x1E6E2040, ast_mindwm(ast, 0x1E6E2040) | 0x41);
2023
2024         /* Patch code */
2025         data = ast_mindwm(ast, 0x1E6E200C) & 0xF9FFFFFF;
2026         ast_moutdwm(ast, 0x1E6E200C, data | 0x10000000);
2027
2028         return true;
2029 }
2030
2031 void ast_post_chip_2500(struct drm_device *dev)
2032 {
2033         struct ast_private *ast = to_ast_private(dev);
2034         u32 temp;
2035         u8 reg;
2036
2037         reg = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd0, 0xff);
2038         if ((reg & 0x80) == 0) {/* vga only */
2039                 /* Clear bus lock condition */
2040                 ast_moutdwm(ast, 0x1e600000, 0xAEED1A03);
2041                 ast_moutdwm(ast, 0x1e600084, 0x00010000);
2042                 ast_moutdwm(ast, 0x1e600088, 0x00000000);
2043                 ast_moutdwm(ast, 0x1e6e2000, 0x1688A8A8);
2044                 ast_write32(ast, 0xf004, 0x1e6e0000);
2045                 ast_write32(ast, 0xf000, 0x1);
2046                 ast_write32(ast, 0x12000, 0x1688a8a8);
2047                 while (ast_read32(ast, 0x12000) != 0x1)
2048                         ;
2049
2050                 ast_write32(ast, 0x10000, 0xfc600309);
2051                 while (ast_read32(ast, 0x10000) != 0x1)
2052                         ;
2053
2054                 /* Slow down CPU/AHB CLK in VGA only mode */
2055                 temp = ast_read32(ast, 0x12008);
2056                 temp |= 0x73;
2057                 ast_write32(ast, 0x12008, temp);
2058
2059                 /* Reset USB port to patch USB unknown device issue */
2060                 ast_moutdwm(ast, 0x1e6e2090, 0x20000000);
2061                 temp  = ast_mindwm(ast, 0x1e6e2094);
2062                 temp |= 0x00004000;
2063                 ast_moutdwm(ast, 0x1e6e2094, temp);
2064                 temp  = ast_mindwm(ast, 0x1e6e2070);
2065                 if (temp & 0x00800000) {
2066                         ast_moutdwm(ast, 0x1e6e207c, 0x00800000);
2067                         mdelay(100);
2068                         ast_moutdwm(ast, 0x1e6e2070, 0x00800000);
2069                 }
2070
2071                 if (!ast_dram_init_2500(ast))
2072                         drm_err(dev, "DRAM init failed !\n");
2073
2074                 temp = ast_mindwm(ast, 0x1e6e2040);
2075                 ast_moutdwm(ast, 0x1e6e2040, temp | 0x40);
2076         }
2077
2078         /* wait ready */
2079         do {
2080                 reg = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd0, 0xff);
2081         } while ((reg & 0x40) == 0);
2082 }