1312fec14SDave Airlie /* 2312fec14SDave Airlie * Copyright 2012 Red Hat Inc. 3312fec14SDave Airlie * 4312fec14SDave Airlie * Permission is hereby granted, free of charge, to any person obtaining a 5312fec14SDave Airlie * copy of this software and associated documentation files (the 6312fec14SDave Airlie * "Software"), to deal in the Software without restriction, including 7312fec14SDave Airlie * without limitation the rights to use, copy, modify, merge, publish, 8312fec14SDave Airlie * distribute, sub license, and/or sell copies of the Software, and to 9312fec14SDave Airlie * permit persons to whom the Software is furnished to do so, subject to 10312fec14SDave Airlie * the following conditions: 11312fec14SDave Airlie * 12312fec14SDave Airlie * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 13312fec14SDave Airlie * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 14312fec14SDave Airlie * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL 15312fec14SDave Airlie * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, 16312fec14SDave Airlie * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR 17312fec14SDave Airlie * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE 18312fec14SDave Airlie * USE OR OTHER DEALINGS IN THE SOFTWARE. 19312fec14SDave Airlie * 20312fec14SDave Airlie * The above copyright notice and this permission notice (including the 21312fec14SDave Airlie * next paragraph) shall be included in all copies or substantial portions 22312fec14SDave Airlie * of the Software. 23312fec14SDave Airlie * 24312fec14SDave Airlie */ 25312fec14SDave Airlie /* 26312fec14SDave Airlie * Authors: Dave Airlie <airlied@redhat.com> 27312fec14SDave Airlie */ 28312fec14SDave Airlie 29760285e7SDavid Howells #include <drm/drmP.h> 30312fec14SDave Airlie #include "ast_drv.h" 31312fec14SDave Airlie 32312fec14SDave Airlie #include "ast_dram_tables.h" 33312fec14SDave Airlie 34312fec14SDave Airlie static void ast_init_dram_2300(struct drm_device *dev); 35312fec14SDave Airlie 36d1b98557SBenjamin Herrenschmidt void ast_enable_vga(struct drm_device *dev) 37312fec14SDave Airlie { 38312fec14SDave Airlie struct ast_private *ast = dev->dev_private; 39312fec14SDave Airlie 40d1b98557SBenjamin Herrenschmidt ast_io_write8(ast, AST_IO_VGA_ENABLE_PORT, 0x01); 41d1b98557SBenjamin Herrenschmidt ast_io_write8(ast, AST_IO_MISC_PORT_WRITE, 0x01); 42312fec14SDave Airlie } 43312fec14SDave Airlie 44d1b98557SBenjamin Herrenschmidt void ast_enable_mmio(struct drm_device *dev) 45d1b98557SBenjamin Herrenschmidt { 46d1b98557SBenjamin Herrenschmidt struct ast_private *ast = dev->dev_private; 47d1b98557SBenjamin Herrenschmidt 48d1b98557SBenjamin Herrenschmidt ast_set_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xa1, 0xff, 0x04); 49d1b98557SBenjamin Herrenschmidt } 50d1b98557SBenjamin Herrenschmidt 51d1b98557SBenjamin Herrenschmidt 52d1b98557SBenjamin Herrenschmidt bool ast_is_vga_enabled(struct drm_device *dev) 53312fec14SDave Airlie { 54312fec14SDave Airlie struct ast_private *ast = dev->dev_private; 55312fec14SDave Airlie u8 ch; 56312fec14SDave Airlie 57312fec14SDave Airlie if (ast->chip == AST1180) { 58312fec14SDave Airlie /* TODO 1180 */ 59312fec14SDave Airlie } else { 60d1b98557SBenjamin Herrenschmidt ch = ast_io_read8(ast, AST_IO_VGA_ENABLE_PORT); 61312fec14SDave Airlie if (ch) { 62312fec14SDave Airlie ast_open_key(ast); 63312fec14SDave Airlie ch = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xb6, 0xff); 64312fec14SDave Airlie return ch & 0x04; 65312fec14SDave Airlie } 66312fec14SDave Airlie } 67312fec14SDave Airlie return 0; 68312fec14SDave Airlie } 69312fec14SDave Airlie 70312fec14SDave Airlie static const u8 extreginfo[] = { 0x0f, 0x04, 0x1c, 0xff }; 71312fec14SDave Airlie static const u8 extreginfo_ast2300a0[] = { 0x0f, 0x04, 0x1c, 0xff }; 72312fec14SDave Airlie static const u8 extreginfo_ast2300[] = { 0x0f, 0x04, 0x1f, 0xff }; 73312fec14SDave Airlie 74312fec14SDave Airlie static void 75312fec14SDave Airlie ast_set_def_ext_reg(struct drm_device *dev) 76312fec14SDave Airlie { 77312fec14SDave Airlie struct ast_private *ast = dev->dev_private; 78312fec14SDave Airlie u8 i, index, reg; 79312fec14SDave Airlie const u8 *ext_reg_info; 80312fec14SDave Airlie 81312fec14SDave Airlie /* reset scratch */ 82312fec14SDave Airlie for (i = 0x81; i <= 0x8f; i++) 83312fec14SDave Airlie ast_set_index_reg(ast, AST_IO_CRTC_PORT, i, 0x00); 84312fec14SDave Airlie 851453bf4cSDave Airlie if (ast->chip == AST2300 || ast->chip == AST2400) { 86312fec14SDave Airlie if (dev->pdev->revision >= 0x20) 87312fec14SDave Airlie ext_reg_info = extreginfo_ast2300; 88312fec14SDave Airlie else 89312fec14SDave Airlie ext_reg_info = extreginfo_ast2300a0; 90312fec14SDave Airlie } else 91312fec14SDave Airlie ext_reg_info = extreginfo; 92312fec14SDave Airlie 93312fec14SDave Airlie index = 0xa0; 94312fec14SDave Airlie while (*ext_reg_info != 0xff) { 95312fec14SDave Airlie ast_set_index_reg_mask(ast, AST_IO_CRTC_PORT, index, 0x00, *ext_reg_info); 96312fec14SDave Airlie index++; 97312fec14SDave Airlie ext_reg_info++; 98312fec14SDave Airlie } 99312fec14SDave Airlie 100312fec14SDave Airlie /* disable standard IO/MEM decode if secondary */ 101312fec14SDave Airlie /* ast_set_index_reg-mask(ast, AST_IO_CRTC_PORT, 0xa1, 0xff, 0x3); */ 102312fec14SDave Airlie 103312fec14SDave Airlie /* Set Ext. Default */ 104312fec14SDave Airlie ast_set_index_reg_mask(ast, AST_IO_CRTC_PORT, 0x8c, 0x00, 0x01); 105312fec14SDave Airlie ast_set_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xb7, 0x00, 0x00); 106312fec14SDave Airlie 107312fec14SDave Airlie /* Enable RAMDAC for A1 */ 108312fec14SDave Airlie reg = 0x04; 1091453bf4cSDave Airlie if (ast->chip == AST2300 || ast->chip == AST2400) 110312fec14SDave Airlie reg |= 0x20; 111312fec14SDave Airlie ast_set_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xb6, 0xff, reg); 112312fec14SDave Airlie } 113312fec14SDave Airlie 11483c6620bSDave Airlie u32 ast_mindwm(struct ast_private *ast, u32 r) 115312fec14SDave Airlie { 116318cfa29SDave Airlie uint32_t data; 117318cfa29SDave Airlie 118312fec14SDave Airlie ast_write32(ast, 0xf004, r & 0xffff0000); 119312fec14SDave Airlie ast_write32(ast, 0xf000, 0x1); 120312fec14SDave Airlie 121318cfa29SDave Airlie do { 122318cfa29SDave Airlie data = ast_read32(ast, 0xf004) & 0xffff0000; 123318cfa29SDave Airlie } while (data != (r & 0xffff0000)); 124312fec14SDave Airlie return ast_read32(ast, 0x10000 + (r & 0x0000ffff)); 125312fec14SDave Airlie } 126312fec14SDave Airlie 12783c6620bSDave Airlie void ast_moutdwm(struct ast_private *ast, u32 r, u32 v) 128312fec14SDave Airlie { 129318cfa29SDave Airlie uint32_t data; 130312fec14SDave Airlie ast_write32(ast, 0xf004, r & 0xffff0000); 131312fec14SDave Airlie ast_write32(ast, 0xf000, 0x1); 132318cfa29SDave Airlie do { 133318cfa29SDave Airlie data = ast_read32(ast, 0xf004) & 0xffff0000; 134318cfa29SDave Airlie } while (data != (r & 0xffff0000)); 135312fec14SDave Airlie ast_write32(ast, 0x10000 + (r & 0x0000ffff), v); 136312fec14SDave Airlie } 137312fec14SDave Airlie 138312fec14SDave Airlie /* 139312fec14SDave Airlie * AST2100/2150 DLL CBR Setting 140312fec14SDave Airlie */ 141312fec14SDave Airlie #define CBR_SIZE_AST2150 ((16 << 10) - 1) 142312fec14SDave Airlie #define CBR_PASSNUM_AST2150 5 143312fec14SDave Airlie #define CBR_THRESHOLD_AST2150 10 144312fec14SDave Airlie #define CBR_THRESHOLD2_AST2150 10 145312fec14SDave Airlie #define TIMEOUT_AST2150 5000000 146312fec14SDave Airlie 147312fec14SDave Airlie #define CBR_PATNUM_AST2150 8 148312fec14SDave Airlie 149312fec14SDave Airlie static const u32 pattern_AST2150[14] = { 150312fec14SDave Airlie 0xFF00FF00, 151312fec14SDave Airlie 0xCC33CC33, 152312fec14SDave Airlie 0xAA55AA55, 153312fec14SDave Airlie 0xFFFE0001, 154312fec14SDave Airlie 0x683501FE, 155312fec14SDave Airlie 0x0F1929B0, 156312fec14SDave Airlie 0x2D0B4346, 157312fec14SDave Airlie 0x60767F02, 158312fec14SDave Airlie 0x6FBE36A6, 159312fec14SDave Airlie 0x3A253035, 160312fec14SDave Airlie 0x3019686D, 161312fec14SDave Airlie 0x41C6167E, 162312fec14SDave Airlie 0x620152BF, 163312fec14SDave Airlie 0x20F050E0 164312fec14SDave Airlie }; 165312fec14SDave Airlie 166312fec14SDave Airlie static u32 mmctestburst2_ast2150(struct ast_private *ast, u32 datagen) 167312fec14SDave Airlie { 168312fec14SDave Airlie u32 data, timeout; 169312fec14SDave Airlie 1700e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 1710e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000001 | (datagen << 3)); 172312fec14SDave Airlie timeout = 0; 173312fec14SDave Airlie do { 1740e5ce924SDave Airlie data = ast_mindwm(ast, 0x1e6e0070) & 0x40; 175312fec14SDave Airlie if (++timeout > TIMEOUT_AST2150) { 1760e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 177312fec14SDave Airlie return 0xffffffff; 178312fec14SDave Airlie } 179312fec14SDave Airlie } while (!data); 1800e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 1810e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000003 | (datagen << 3)); 182312fec14SDave Airlie timeout = 0; 183312fec14SDave Airlie do { 1840e5ce924SDave Airlie data = ast_mindwm(ast, 0x1e6e0070) & 0x40; 185312fec14SDave Airlie if (++timeout > TIMEOUT_AST2150) { 1860e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 187312fec14SDave Airlie return 0xffffffff; 188312fec14SDave Airlie } 189312fec14SDave Airlie } while (!data); 1900e5ce924SDave Airlie data = (ast_mindwm(ast, 0x1e6e0070) & 0x80) >> 7; 1910e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 192312fec14SDave Airlie return data; 193312fec14SDave Airlie } 194312fec14SDave Airlie 195312fec14SDave Airlie #if 0 /* unused in DDX driver - here for completeness */ 196312fec14SDave Airlie static u32 mmctestsingle2_ast2150(struct ast_private *ast, u32 datagen) 197312fec14SDave Airlie { 198312fec14SDave Airlie u32 data, timeout; 199312fec14SDave Airlie 2000e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 2010e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000005 | (datagen << 3)); 202312fec14SDave Airlie timeout = 0; 203312fec14SDave Airlie do { 2040e5ce924SDave Airlie data = ast_mindwm(ast, 0x1e6e0070) & 0x40; 205312fec14SDave Airlie if (++timeout > TIMEOUT_AST2150) { 2060e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 207312fec14SDave Airlie return 0xffffffff; 208312fec14SDave Airlie } 209312fec14SDave Airlie } while (!data); 2100e5ce924SDave Airlie data = (ast_mindwm(ast, 0x1e6e0070) & 0x80) >> 7; 2110e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 212312fec14SDave Airlie return data; 213312fec14SDave Airlie } 214312fec14SDave Airlie #endif 215312fec14SDave Airlie 216312fec14SDave Airlie static int cbrtest_ast2150(struct ast_private *ast) 217312fec14SDave Airlie { 218312fec14SDave Airlie int i; 219312fec14SDave Airlie 220312fec14SDave Airlie for (i = 0; i < 8; i++) 221312fec14SDave Airlie if (mmctestburst2_ast2150(ast, i)) 222312fec14SDave Airlie return 0; 223312fec14SDave Airlie return 1; 224312fec14SDave Airlie } 225312fec14SDave Airlie 226312fec14SDave Airlie static int cbrscan_ast2150(struct ast_private *ast, int busw) 227312fec14SDave Airlie { 228312fec14SDave Airlie u32 patcnt, loop; 229312fec14SDave Airlie 230312fec14SDave Airlie for (patcnt = 0; patcnt < CBR_PATNUM_AST2150; patcnt++) { 2310e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e007c, pattern_AST2150[patcnt]); 232312fec14SDave Airlie for (loop = 0; loop < CBR_PASSNUM_AST2150; loop++) { 233312fec14SDave Airlie if (cbrtest_ast2150(ast)) 234312fec14SDave Airlie break; 235312fec14SDave Airlie } 236312fec14SDave Airlie if (loop == CBR_PASSNUM_AST2150) 237312fec14SDave Airlie return 0; 238312fec14SDave Airlie } 239312fec14SDave Airlie return 1; 240312fec14SDave Airlie } 241312fec14SDave Airlie 242312fec14SDave Airlie 243312fec14SDave Airlie static void cbrdlli_ast2150(struct ast_private *ast, int busw) 244312fec14SDave Airlie { 245312fec14SDave Airlie u32 dll_min[4], dll_max[4], dlli, data, passcnt; 246312fec14SDave Airlie 247312fec14SDave Airlie cbr_start: 248312fec14SDave Airlie dll_min[0] = dll_min[1] = dll_min[2] = dll_min[3] = 0xff; 249312fec14SDave Airlie dll_max[0] = dll_max[1] = dll_max[2] = dll_max[3] = 0x0; 250312fec14SDave Airlie passcnt = 0; 251312fec14SDave Airlie 252312fec14SDave Airlie for (dlli = 0; dlli < 100; dlli++) { 2530e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0068, dlli | (dlli << 8) | (dlli << 16) | (dlli << 24)); 254312fec14SDave Airlie data = cbrscan_ast2150(ast, busw); 255312fec14SDave Airlie if (data != 0) { 256312fec14SDave Airlie if (data & 0x1) { 257312fec14SDave Airlie if (dll_min[0] > dlli) 258312fec14SDave Airlie dll_min[0] = dlli; 259312fec14SDave Airlie if (dll_max[0] < dlli) 260312fec14SDave Airlie dll_max[0] = dlli; 261312fec14SDave Airlie } 262312fec14SDave Airlie passcnt++; 263312fec14SDave Airlie } else if (passcnt >= CBR_THRESHOLD_AST2150) 264312fec14SDave Airlie goto cbr_start; 265312fec14SDave Airlie } 266312fec14SDave Airlie if (dll_max[0] == 0 || (dll_max[0]-dll_min[0]) < CBR_THRESHOLD_AST2150) 267312fec14SDave Airlie goto cbr_start; 268312fec14SDave Airlie 269312fec14SDave Airlie dlli = dll_min[0] + (((dll_max[0] - dll_min[0]) * 7) >> 4); 2700e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0068, dlli | (dlli << 8) | (dlli << 16) | (dlli << 24)); 271312fec14SDave Airlie } 272312fec14SDave Airlie 273312fec14SDave Airlie 274312fec14SDave Airlie 275312fec14SDave Airlie static void ast_init_dram_reg(struct drm_device *dev) 276312fec14SDave Airlie { 277312fec14SDave Airlie struct ast_private *ast = dev->dev_private; 278312fec14SDave Airlie u8 j; 279312fec14SDave Airlie u32 data, temp, i; 280312fec14SDave Airlie const struct ast_dramstruct *dram_reg_info; 281312fec14SDave Airlie 282312fec14SDave Airlie j = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd0, 0xff); 283312fec14SDave Airlie 284312fec14SDave Airlie if ((j & 0x80) == 0) { /* VGA only */ 285312fec14SDave Airlie if (ast->chip == AST2000) { 286312fec14SDave Airlie dram_reg_info = ast2000_dram_table_data; 287312fec14SDave Airlie ast_write32(ast, 0xf004, 0x1e6e0000); 288312fec14SDave Airlie ast_write32(ast, 0xf000, 0x1); 289312fec14SDave Airlie ast_write32(ast, 0x10100, 0xa8); 290312fec14SDave Airlie 291312fec14SDave Airlie do { 292312fec14SDave Airlie ; 293312fec14SDave Airlie } while (ast_read32(ast, 0x10100) != 0xa8); 294312fec14SDave Airlie } else {/* AST2100/1100 */ 295312fec14SDave Airlie if (ast->chip == AST2100 || ast->chip == 2200) 296312fec14SDave Airlie dram_reg_info = ast2100_dram_table_data; 297312fec14SDave Airlie else 298312fec14SDave Airlie dram_reg_info = ast1100_dram_table_data; 299312fec14SDave Airlie 300312fec14SDave Airlie ast_write32(ast, 0xf004, 0x1e6e0000); 301312fec14SDave Airlie ast_write32(ast, 0xf000, 0x1); 302312fec14SDave Airlie ast_write32(ast, 0x12000, 0x1688A8A8); 303312fec14SDave Airlie do { 304312fec14SDave Airlie ; 305312fec14SDave Airlie } while (ast_read32(ast, 0x12000) != 0x01); 306312fec14SDave Airlie 307312fec14SDave Airlie ast_write32(ast, 0x10000, 0xfc600309); 308312fec14SDave Airlie do { 309312fec14SDave Airlie ; 310312fec14SDave Airlie } while (ast_read32(ast, 0x10000) != 0x01); 311312fec14SDave Airlie } 312312fec14SDave Airlie 313312fec14SDave Airlie while (dram_reg_info->index != 0xffff) { 314312fec14SDave Airlie if (dram_reg_info->index == 0xff00) {/* delay fn */ 315312fec14SDave Airlie for (i = 0; i < 15; i++) 316312fec14SDave Airlie udelay(dram_reg_info->data); 317312fec14SDave Airlie } else if (dram_reg_info->index == 0x4 && ast->chip != AST2000) { 318312fec14SDave Airlie data = dram_reg_info->data; 319312fec14SDave Airlie if (ast->dram_type == AST_DRAM_1Gx16) 320312fec14SDave Airlie data = 0x00000d89; 321312fec14SDave Airlie else if (ast->dram_type == AST_DRAM_1Gx32) 322312fec14SDave Airlie data = 0x00000c8d; 323312fec14SDave Airlie 324312fec14SDave Airlie temp = ast_read32(ast, 0x12070); 325312fec14SDave Airlie temp &= 0xc; 326312fec14SDave Airlie temp <<= 2; 327312fec14SDave Airlie ast_write32(ast, 0x10000 + dram_reg_info->index, data | temp); 328312fec14SDave Airlie } else 329312fec14SDave Airlie ast_write32(ast, 0x10000 + dram_reg_info->index, dram_reg_info->data); 330312fec14SDave Airlie dram_reg_info++; 331312fec14SDave Airlie } 332312fec14SDave Airlie 333312fec14SDave Airlie /* AST 2100/2150 DRAM calibration */ 334312fec14SDave Airlie data = ast_read32(ast, 0x10120); 335312fec14SDave Airlie if (data == 0x5061) { /* 266Mhz */ 336312fec14SDave Airlie data = ast_read32(ast, 0x10004); 337312fec14SDave Airlie if (data & 0x40) 338312fec14SDave Airlie cbrdlli_ast2150(ast, 16); /* 16 bits */ 339312fec14SDave Airlie else 340312fec14SDave Airlie cbrdlli_ast2150(ast, 32); /* 32 bits */ 341312fec14SDave Airlie } 342312fec14SDave Airlie 343312fec14SDave Airlie switch (ast->chip) { 344312fec14SDave Airlie case AST2000: 345312fec14SDave Airlie temp = ast_read32(ast, 0x10140); 346312fec14SDave Airlie ast_write32(ast, 0x10140, temp | 0x40); 347312fec14SDave Airlie break; 348312fec14SDave Airlie case AST1100: 349312fec14SDave Airlie case AST2100: 350312fec14SDave Airlie case AST2200: 351312fec14SDave Airlie case AST2150: 352312fec14SDave Airlie temp = ast_read32(ast, 0x1200c); 353312fec14SDave Airlie ast_write32(ast, 0x1200c, temp & 0xfffffffd); 354312fec14SDave Airlie temp = ast_read32(ast, 0x12040); 355312fec14SDave Airlie ast_write32(ast, 0x12040, temp | 0x40); 356312fec14SDave Airlie break; 357312fec14SDave Airlie default: 358312fec14SDave Airlie break; 359312fec14SDave Airlie } 360312fec14SDave Airlie } 361312fec14SDave Airlie 362312fec14SDave Airlie /* wait ready */ 363312fec14SDave Airlie do { 364312fec14SDave Airlie j = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd0, 0xff); 365312fec14SDave Airlie } while ((j & 0x40) == 0); 366312fec14SDave Airlie } 367312fec14SDave Airlie 368312fec14SDave Airlie void ast_post_gpu(struct drm_device *dev) 369312fec14SDave Airlie { 370312fec14SDave Airlie u32 reg; 371312fec14SDave Airlie struct ast_private *ast = dev->dev_private; 372312fec14SDave Airlie 373312fec14SDave Airlie pci_read_config_dword(ast->dev->pdev, 0x04, ®); 374312fec14SDave Airlie reg |= 0x3; 375312fec14SDave Airlie pci_write_config_dword(ast->dev->pdev, 0x04, reg); 376312fec14SDave Airlie 377312fec14SDave Airlie ast_enable_vga(dev); 378d1b98557SBenjamin Herrenschmidt ast_enable_mmio(dev); 379312fec14SDave Airlie ast_open_key(ast); 380312fec14SDave Airlie ast_set_def_ext_reg(dev); 381312fec14SDave Airlie 3821453bf4cSDave Airlie if (ast->chip == AST2300 || ast->chip == AST2400) 383312fec14SDave Airlie ast_init_dram_2300(dev); 384312fec14SDave Airlie else 385312fec14SDave Airlie ast_init_dram_reg(dev); 38683c6620bSDave Airlie 38783c6620bSDave Airlie ast_init_3rdtx(dev); 388312fec14SDave Airlie } 389312fec14SDave Airlie 390312fec14SDave Airlie /* AST 2300 DRAM settings */ 391312fec14SDave Airlie #define AST_DDR3 0 392312fec14SDave Airlie #define AST_DDR2 1 393312fec14SDave Airlie 394312fec14SDave Airlie struct ast2300_dram_param { 395312fec14SDave Airlie u32 dram_type; 396312fec14SDave Airlie u32 dram_chipid; 397312fec14SDave Airlie u32 dram_freq; 398312fec14SDave Airlie u32 vram_size; 399312fec14SDave Airlie u32 odt; 400312fec14SDave Airlie u32 wodt; 401312fec14SDave Airlie u32 rodt; 402312fec14SDave Airlie u32 dram_config; 403312fec14SDave Airlie u32 reg_PERIOD; 404312fec14SDave Airlie u32 reg_MADJ; 405312fec14SDave Airlie u32 reg_SADJ; 406312fec14SDave Airlie u32 reg_MRS; 407312fec14SDave Airlie u32 reg_EMRS; 408312fec14SDave Airlie u32 reg_AC1; 409312fec14SDave Airlie u32 reg_AC2; 410312fec14SDave Airlie u32 reg_DQSIC; 411312fec14SDave Airlie u32 reg_DRV; 412312fec14SDave Airlie u32 reg_IOZ; 413312fec14SDave Airlie u32 reg_DQIDLY; 414312fec14SDave Airlie u32 reg_FREQ; 415312fec14SDave Airlie u32 madj_max; 416312fec14SDave Airlie u32 dll2_finetune_step; 417312fec14SDave Airlie }; 418312fec14SDave Airlie 419312fec14SDave Airlie /* 420312fec14SDave Airlie * DQSI DLL CBR Setting 421312fec14SDave Airlie */ 422318cfa29SDave Airlie #define CBR_SIZE0 ((1 << 10) - 1) 423312fec14SDave Airlie #define CBR_SIZE1 ((4 << 10) - 1) 424312fec14SDave Airlie #define CBR_SIZE2 ((64 << 10) - 1) 425312fec14SDave Airlie #define CBR_PASSNUM 5 426312fec14SDave Airlie #define CBR_PASSNUM2 5 427312fec14SDave Airlie #define CBR_THRESHOLD 10 428312fec14SDave Airlie #define CBR_THRESHOLD2 10 429312fec14SDave Airlie #define TIMEOUT 5000000 430312fec14SDave Airlie #define CBR_PATNUM 8 431312fec14SDave Airlie 432312fec14SDave Airlie static const u32 pattern[8] = { 433312fec14SDave Airlie 0xFF00FF00, 434312fec14SDave Airlie 0xCC33CC33, 435312fec14SDave Airlie 0xAA55AA55, 436312fec14SDave Airlie 0x88778877, 437312fec14SDave Airlie 0x92CC4D6E, 438312fec14SDave Airlie 0x543D3CDE, 439312fec14SDave Airlie 0xF1E843C7, 440312fec14SDave Airlie 0x7C61D253 441312fec14SDave Airlie }; 442312fec14SDave Airlie 443312fec14SDave Airlie static int mmc_test_burst(struct ast_private *ast, u32 datagen) 444312fec14SDave Airlie { 445312fec14SDave Airlie u32 data, timeout; 446312fec14SDave Airlie 4470e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 4480e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x000000c1 | (datagen << 3)); 449312fec14SDave Airlie timeout = 0; 450312fec14SDave Airlie do { 4510e5ce924SDave Airlie data = ast_mindwm(ast, 0x1e6e0070) & 0x3000; 452312fec14SDave Airlie if (data & 0x2000) { 453312fec14SDave Airlie return 0; 454312fec14SDave Airlie } 455312fec14SDave Airlie if (++timeout > TIMEOUT) { 4560e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 457312fec14SDave Airlie return 0; 458312fec14SDave Airlie } 459312fec14SDave Airlie } while (!data); 4600e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 461312fec14SDave Airlie return 1; 462312fec14SDave Airlie } 463312fec14SDave Airlie 464312fec14SDave Airlie static int mmc_test_burst2(struct ast_private *ast, u32 datagen) 465312fec14SDave Airlie { 466312fec14SDave Airlie u32 data, timeout; 467312fec14SDave Airlie 4680e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 4690e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000041 | (datagen << 3)); 470312fec14SDave Airlie timeout = 0; 471312fec14SDave Airlie do { 4720e5ce924SDave Airlie data = ast_mindwm(ast, 0x1e6e0070) & 0x1000; 473312fec14SDave Airlie if (++timeout > TIMEOUT) { 4740e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x0); 475312fec14SDave Airlie return -1; 476312fec14SDave Airlie } 477312fec14SDave Airlie } while (!data); 4780e5ce924SDave Airlie data = ast_mindwm(ast, 0x1e6e0078); 479312fec14SDave Airlie data = (data | (data >> 16)) & 0xffff; 4800e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x0); 481312fec14SDave Airlie return data; 482312fec14SDave Airlie } 483312fec14SDave Airlie 484312fec14SDave Airlie static int mmc_test_single(struct ast_private *ast, u32 datagen) 485312fec14SDave Airlie { 486312fec14SDave Airlie u32 data, timeout; 487312fec14SDave Airlie 4880e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 4890e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x000000c5 | (datagen << 3)); 490312fec14SDave Airlie timeout = 0; 491312fec14SDave Airlie do { 4920e5ce924SDave Airlie data = ast_mindwm(ast, 0x1e6e0070) & 0x3000; 493312fec14SDave Airlie if (data & 0x2000) 494312fec14SDave Airlie return 0; 495312fec14SDave Airlie if (++timeout > TIMEOUT) { 4960e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x0); 497312fec14SDave Airlie return 0; 498312fec14SDave Airlie } 499312fec14SDave Airlie } while (!data); 5000e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x0); 501312fec14SDave Airlie return 1; 502312fec14SDave Airlie } 503312fec14SDave Airlie 504312fec14SDave Airlie static int mmc_test_single2(struct ast_private *ast, u32 datagen) 505312fec14SDave Airlie { 506312fec14SDave Airlie u32 data, timeout; 507312fec14SDave Airlie 5080e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000000); 5090e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x00000005 | (datagen << 3)); 510312fec14SDave Airlie timeout = 0; 511312fec14SDave Airlie do { 5120e5ce924SDave Airlie data = ast_mindwm(ast, 0x1e6e0070) & 0x1000; 513312fec14SDave Airlie if (++timeout > TIMEOUT) { 5140e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x0); 515312fec14SDave Airlie return -1; 516312fec14SDave Airlie } 517312fec14SDave Airlie } while (!data); 5180e5ce924SDave Airlie data = ast_mindwm(ast, 0x1e6e0078); 519312fec14SDave Airlie data = (data | (data >> 16)) & 0xffff; 5200e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e0070, 0x0); 521312fec14SDave Airlie return data; 522312fec14SDave Airlie } 523312fec14SDave Airlie 524312fec14SDave Airlie static int cbr_test(struct ast_private *ast) 525312fec14SDave Airlie { 526312fec14SDave Airlie u32 data; 527312fec14SDave Airlie int i; 528312fec14SDave Airlie data = mmc_test_single2(ast, 0); 529312fec14SDave Airlie if ((data & 0xff) && (data & 0xff00)) 530312fec14SDave Airlie return 0; 531312fec14SDave Airlie for (i = 0; i < 8; i++) { 532312fec14SDave Airlie data = mmc_test_burst2(ast, i); 533312fec14SDave Airlie if ((data & 0xff) && (data & 0xff00)) 534312fec14SDave Airlie return 0; 535312fec14SDave Airlie } 536312fec14SDave Airlie if (!data) 537312fec14SDave Airlie return 3; 538312fec14SDave Airlie else if (data & 0xff) 539312fec14SDave Airlie return 2; 540312fec14SDave Airlie return 1; 541312fec14SDave Airlie } 542312fec14SDave Airlie 543312fec14SDave Airlie static int cbr_scan(struct ast_private *ast) 544312fec14SDave Airlie { 545312fec14SDave Airlie u32 data, data2, patcnt, loop; 546312fec14SDave Airlie 547312fec14SDave Airlie data2 = 3; 548312fec14SDave Airlie for (patcnt = 0; patcnt < CBR_PATNUM; patcnt++) { 5490e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e007c, pattern[patcnt]); 550312fec14SDave Airlie for (loop = 0; loop < CBR_PASSNUM2; loop++) { 551312fec14SDave Airlie if ((data = cbr_test(ast)) != 0) { 552312fec14SDave Airlie data2 &= data; 553312fec14SDave Airlie if (!data2) 554312fec14SDave Airlie return 0; 555312fec14SDave Airlie break; 556312fec14SDave Airlie } 557312fec14SDave Airlie } 558312fec14SDave Airlie if (loop == CBR_PASSNUM2) 559312fec14SDave Airlie return 0; 560312fec14SDave Airlie } 561312fec14SDave Airlie return data2; 562312fec14SDave Airlie } 563312fec14SDave Airlie 564312fec14SDave Airlie static u32 cbr_test2(struct ast_private *ast) 565312fec14SDave Airlie { 566312fec14SDave Airlie u32 data; 567312fec14SDave Airlie 568312fec14SDave Airlie data = mmc_test_burst2(ast, 0); 569312fec14SDave Airlie if (data == 0xffff) 570312fec14SDave Airlie return 0; 571312fec14SDave Airlie data |= mmc_test_single2(ast, 0); 572312fec14SDave Airlie if (data == 0xffff) 573312fec14SDave Airlie return 0; 574312fec14SDave Airlie 575312fec14SDave Airlie return ~data & 0xffff; 576312fec14SDave Airlie } 577312fec14SDave Airlie 578312fec14SDave Airlie static u32 cbr_scan2(struct ast_private *ast) 579312fec14SDave Airlie { 580312fec14SDave Airlie u32 data, data2, patcnt, loop; 581312fec14SDave Airlie 582312fec14SDave Airlie data2 = 0xffff; 583312fec14SDave Airlie for (patcnt = 0; patcnt < CBR_PATNUM; patcnt++) { 5840e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e007c, pattern[patcnt]); 585312fec14SDave Airlie for (loop = 0; loop < CBR_PASSNUM2; loop++) { 586312fec14SDave Airlie if ((data = cbr_test2(ast)) != 0) { 587312fec14SDave Airlie data2 &= data; 588a82049b1SDave Airlie if (!data2) 589312fec14SDave Airlie return 0; 590312fec14SDave Airlie break; 591312fec14SDave Airlie } 592312fec14SDave Airlie } 593312fec14SDave Airlie if (loop == CBR_PASSNUM2) 594312fec14SDave Airlie return 0; 595312fec14SDave Airlie } 596312fec14SDave Airlie return data2; 597312fec14SDave Airlie } 598312fec14SDave Airlie 599318cfa29SDave Airlie static u32 cbr_test3(struct ast_private *ast) 600312fec14SDave Airlie { 601318cfa29SDave Airlie if (!mmc_test_burst(ast, 0)) 602318cfa29SDave Airlie return 0; 603318cfa29SDave Airlie if (!mmc_test_single(ast, 0)) 604318cfa29SDave Airlie return 0; 605318cfa29SDave Airlie return 1; 606318cfa29SDave Airlie } 607312fec14SDave Airlie 608318cfa29SDave Airlie static u32 cbr_scan3(struct ast_private *ast) 609318cfa29SDave Airlie { 610318cfa29SDave Airlie u32 patcnt, loop; 611312fec14SDave Airlie 612318cfa29SDave Airlie for (patcnt = 0; patcnt < CBR_PATNUM; patcnt++) { 6130e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e007c, pattern[patcnt]); 614318cfa29SDave Airlie for (loop = 0; loop < 2; loop++) { 615318cfa29SDave Airlie if (cbr_test3(ast)) 616312fec14SDave Airlie break; 617312fec14SDave Airlie } 618318cfa29SDave Airlie if (loop == 2) 619318cfa29SDave Airlie return 0; 620312fec14SDave Airlie } 621318cfa29SDave Airlie return 1; 622312fec14SDave Airlie } 623312fec14SDave Airlie 624318cfa29SDave Airlie static bool finetuneDQI_L(struct ast_private *ast, struct ast2300_dram_param *param) 625312fec14SDave Airlie { 626318cfa29SDave Airlie u32 gold_sadj[2], dllmin[16], dllmax[16], dlli, data, cnt, mask, passcnt, retry = 0; 627318cfa29SDave Airlie bool status = false; 628312fec14SDave Airlie FINETUNE_START: 629312fec14SDave Airlie for (cnt = 0; cnt < 16; cnt++) { 630312fec14SDave Airlie dllmin[cnt] = 0xff; 631312fec14SDave Airlie dllmax[cnt] = 0x0; 632312fec14SDave Airlie } 633312fec14SDave Airlie passcnt = 0; 634312fec14SDave Airlie for (dlli = 0; dlli < 76; dlli++) { 6350e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0068, 0x00001400 | (dlli << 16) | (dlli << 24)); 6360e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0074, CBR_SIZE1); 637312fec14SDave Airlie data = cbr_scan2(ast); 638312fec14SDave Airlie if (data != 0) { 639312fec14SDave Airlie mask = 0x00010001; 640312fec14SDave Airlie for (cnt = 0; cnt < 16; cnt++) { 641312fec14SDave Airlie if (data & mask) { 642312fec14SDave Airlie if (dllmin[cnt] > dlli) { 643312fec14SDave Airlie dllmin[cnt] = dlli; 644312fec14SDave Airlie } 645312fec14SDave Airlie if (dllmax[cnt] < dlli) { 646312fec14SDave Airlie dllmax[cnt] = dlli; 647312fec14SDave Airlie } 648312fec14SDave Airlie } 649312fec14SDave Airlie mask <<= 1; 650312fec14SDave Airlie } 651312fec14SDave Airlie passcnt++; 652312fec14SDave Airlie } else if (passcnt >= CBR_THRESHOLD2) { 653312fec14SDave Airlie break; 654312fec14SDave Airlie } 655312fec14SDave Airlie } 656312fec14SDave Airlie gold_sadj[0] = 0x0; 657312fec14SDave Airlie passcnt = 0; 658312fec14SDave Airlie for (cnt = 0; cnt < 16; cnt++) { 659312fec14SDave Airlie if ((dllmax[cnt] > dllmin[cnt]) && ((dllmax[cnt] - dllmin[cnt]) >= CBR_THRESHOLD2)) { 660312fec14SDave Airlie gold_sadj[0] += dllmin[cnt]; 661312fec14SDave Airlie passcnt++; 662312fec14SDave Airlie } 663312fec14SDave Airlie } 664318cfa29SDave Airlie if (retry++ > 10) 665318cfa29SDave Airlie goto FINETUNE_DONE; 666312fec14SDave Airlie if (passcnt != 16) { 667312fec14SDave Airlie goto FINETUNE_START; 668312fec14SDave Airlie } 669318cfa29SDave Airlie status = true; 670318cfa29SDave Airlie FINETUNE_DONE: 671312fec14SDave Airlie gold_sadj[0] = gold_sadj[0] >> 4; 672312fec14SDave Airlie gold_sadj[1] = gold_sadj[0]; 673312fec14SDave Airlie 674312fec14SDave Airlie data = 0; 675312fec14SDave Airlie for (cnt = 0; cnt < 8; cnt++) { 676312fec14SDave Airlie data >>= 3; 677312fec14SDave Airlie if ((dllmax[cnt] > dllmin[cnt]) && ((dllmax[cnt] - dllmin[cnt]) >= CBR_THRESHOLD2)) { 678312fec14SDave Airlie dlli = dllmin[cnt]; 679312fec14SDave Airlie if (gold_sadj[0] >= dlli) { 680312fec14SDave Airlie dlli = ((gold_sadj[0] - dlli) * 19) >> 5; 681312fec14SDave Airlie if (dlli > 3) { 682312fec14SDave Airlie dlli = 3; 683312fec14SDave Airlie } 684312fec14SDave Airlie } else { 685312fec14SDave Airlie dlli = ((dlli - gold_sadj[0]) * 19) >> 5; 686312fec14SDave Airlie if (dlli > 4) { 687312fec14SDave Airlie dlli = 4; 688312fec14SDave Airlie } 689312fec14SDave Airlie dlli = (8 - dlli) & 0x7; 690312fec14SDave Airlie } 691312fec14SDave Airlie data |= dlli << 21; 692312fec14SDave Airlie } 693312fec14SDave Airlie } 6940e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0080, data); 695312fec14SDave Airlie 696312fec14SDave Airlie data = 0; 697312fec14SDave Airlie for (cnt = 8; cnt < 16; cnt++) { 698312fec14SDave Airlie data >>= 3; 699312fec14SDave Airlie if ((dllmax[cnt] > dllmin[cnt]) && ((dllmax[cnt] - dllmin[cnt]) >= CBR_THRESHOLD2)) { 700312fec14SDave Airlie dlli = dllmin[cnt]; 701312fec14SDave Airlie if (gold_sadj[1] >= dlli) { 702312fec14SDave Airlie dlli = ((gold_sadj[1] - dlli) * 19) >> 5; 703312fec14SDave Airlie if (dlli > 3) { 704312fec14SDave Airlie dlli = 3; 705312fec14SDave Airlie } else { 706312fec14SDave Airlie dlli = (dlli - 1) & 0x7; 707312fec14SDave Airlie } 708312fec14SDave Airlie } else { 709312fec14SDave Airlie dlli = ((dlli - gold_sadj[1]) * 19) >> 5; 710312fec14SDave Airlie dlli += 1; 711312fec14SDave Airlie if (dlli > 4) { 712312fec14SDave Airlie dlli = 4; 713312fec14SDave Airlie } 714312fec14SDave Airlie dlli = (8 - dlli) & 0x7; 715312fec14SDave Airlie } 716312fec14SDave Airlie data |= dlli << 21; 717312fec14SDave Airlie } 718312fec14SDave Airlie } 7190e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0084, data); 720318cfa29SDave Airlie return status; 721312fec14SDave Airlie } /* finetuneDQI_L */ 722312fec14SDave Airlie 723318cfa29SDave Airlie static void finetuneDQSI(struct ast_private *ast) 724312fec14SDave Airlie { 725318cfa29SDave Airlie u32 dlli, dqsip, dqidly; 726318cfa29SDave Airlie u32 reg_mcr18, reg_mcr0c, passcnt[2], diff; 727318cfa29SDave Airlie u32 g_dqidly, g_dqsip, g_margin, g_side; 728318cfa29SDave Airlie u16 pass[32][2][2]; 729318cfa29SDave Airlie char tag[2][76]; 730312fec14SDave Airlie 731318cfa29SDave Airlie /* Disable DQI CBR */ 7320e5ce924SDave Airlie reg_mcr0c = ast_mindwm(ast, 0x1E6E000C); 7330e5ce924SDave Airlie reg_mcr18 = ast_mindwm(ast, 0x1E6E0018); 734318cfa29SDave Airlie reg_mcr18 &= 0x0000ffff; 7350e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, reg_mcr18); 736318cfa29SDave Airlie 737312fec14SDave Airlie for (dlli = 0; dlli < 76; dlli++) { 738318cfa29SDave Airlie tag[0][dlli] = 0x0; 739318cfa29SDave Airlie tag[1][dlli] = 0x0; 740312fec14SDave Airlie } 741318cfa29SDave Airlie for (dqidly = 0; dqidly < 32; dqidly++) { 742318cfa29SDave Airlie pass[dqidly][0][0] = 0xff; 743318cfa29SDave Airlie pass[dqidly][0][1] = 0x0; 744318cfa29SDave Airlie pass[dqidly][1][0] = 0xff; 745318cfa29SDave Airlie pass[dqidly][1][1] = 0x0; 746312fec14SDave Airlie } 747318cfa29SDave Airlie for (dqidly = 0; dqidly < 32; dqidly++) { 748318cfa29SDave Airlie passcnt[0] = passcnt[1] = 0; 749318cfa29SDave Airlie for (dqsip = 0; dqsip < 2; dqsip++) { 7500e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E000C, 0); 7510e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, reg_mcr18 | (dqidly << 16) | (dqsip << 23)); 7520e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E000C, reg_mcr0c); 753318cfa29SDave Airlie for (dlli = 0; dlli < 76; dlli++) { 7540e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0068, 0x00001300 | (dlli << 16) | (dlli << 24)); 7550e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0070, 0); 7560e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0074, CBR_SIZE0); 757318cfa29SDave Airlie if (cbr_scan3(ast)) { 758318cfa29SDave Airlie if (dlli == 0) 759312fec14SDave Airlie break; 760318cfa29SDave Airlie passcnt[dqsip]++; 761318cfa29SDave Airlie tag[dqsip][dlli] = 'P'; 762318cfa29SDave Airlie if (dlli < pass[dqidly][dqsip][0]) 763318cfa29SDave Airlie pass[dqidly][dqsip][0] = (u16) dlli; 764318cfa29SDave Airlie if (dlli > pass[dqidly][dqsip][1]) 765318cfa29SDave Airlie pass[dqidly][dqsip][1] = (u16) dlli; 766318cfa29SDave Airlie } else if (passcnt[dqsip] >= 5) 767318cfa29SDave Airlie break; 768318cfa29SDave Airlie else { 769318cfa29SDave Airlie pass[dqidly][dqsip][0] = 0xff; 770318cfa29SDave Airlie pass[dqidly][dqsip][1] = 0x0; 771312fec14SDave Airlie } 772312fec14SDave Airlie } 773312fec14SDave Airlie } 774318cfa29SDave Airlie if (passcnt[0] == 0 && passcnt[1] == 0) 775318cfa29SDave Airlie dqidly++; 776318cfa29SDave Airlie } 777318cfa29SDave Airlie /* Search margin */ 778318cfa29SDave Airlie g_dqidly = g_dqsip = g_margin = g_side = 0; 779312fec14SDave Airlie 780318cfa29SDave Airlie for (dqidly = 0; dqidly < 32; dqidly++) { 781318cfa29SDave Airlie for (dqsip = 0; dqsip < 2; dqsip++) { 782318cfa29SDave Airlie if (pass[dqidly][dqsip][0] > pass[dqidly][dqsip][1]) 783318cfa29SDave Airlie continue; 784318cfa29SDave Airlie diff = pass[dqidly][dqsip][1] - pass[dqidly][dqsip][0]; 785318cfa29SDave Airlie if ((diff+2) < g_margin) 786318cfa29SDave Airlie continue; 787318cfa29SDave Airlie passcnt[0] = passcnt[1] = 0; 788318cfa29SDave Airlie for (dlli = pass[dqidly][dqsip][0]; dlli > 0 && tag[dqsip][dlli] != 0; dlli--, passcnt[0]++); 789318cfa29SDave Airlie for (dlli = pass[dqidly][dqsip][1]; dlli < 76 && tag[dqsip][dlli] != 0; dlli++, passcnt[1]++); 790318cfa29SDave Airlie if (passcnt[0] > passcnt[1]) 791318cfa29SDave Airlie passcnt[0] = passcnt[1]; 792318cfa29SDave Airlie passcnt[1] = 0; 793318cfa29SDave Airlie if (passcnt[0] > g_side) 794318cfa29SDave Airlie passcnt[1] = passcnt[0] - g_side; 795318cfa29SDave Airlie if (diff > (g_margin+1) && (passcnt[1] > 0 || passcnt[0] > 8)) { 796318cfa29SDave Airlie g_margin = diff; 797318cfa29SDave Airlie g_dqidly = dqidly; 798318cfa29SDave Airlie g_dqsip = dqsip; 799318cfa29SDave Airlie g_side = passcnt[0]; 800318cfa29SDave Airlie } else if (passcnt[1] > 1 && g_side < 8) { 801318cfa29SDave Airlie if (diff > g_margin) 802318cfa29SDave Airlie g_margin = diff; 803318cfa29SDave Airlie g_dqidly = dqidly; 804318cfa29SDave Airlie g_dqsip = dqsip; 805318cfa29SDave Airlie g_side = passcnt[0]; 806312fec14SDave Airlie } 807312fec14SDave Airlie } 808312fec14SDave Airlie } 809318cfa29SDave Airlie reg_mcr18 = reg_mcr18 | (g_dqidly << 16) | (g_dqsip << 23); 8100e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, reg_mcr18); 811312fec14SDave Airlie 812312fec14SDave Airlie } 813318cfa29SDave Airlie static bool cbr_dll2(struct ast_private *ast, struct ast2300_dram_param *param) 814312fec14SDave Airlie { 815318cfa29SDave Airlie u32 dllmin[2], dllmax[2], dlli, data, passcnt, retry = 0; 816318cfa29SDave Airlie bool status = false; 817312fec14SDave Airlie 818318cfa29SDave Airlie finetuneDQSI(ast); 819318cfa29SDave Airlie if (finetuneDQI_L(ast, param) == false) 820318cfa29SDave Airlie return status; 821312fec14SDave Airlie 822312fec14SDave Airlie CBR_START2: 823312fec14SDave Airlie dllmin[0] = dllmin[1] = 0xff; 824312fec14SDave Airlie dllmax[0] = dllmax[1] = 0x0; 825312fec14SDave Airlie passcnt = 0; 826312fec14SDave Airlie for (dlli = 0; dlli < 76; dlli++) { 8270e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0068, 0x00001300 | (dlli << 16) | (dlli << 24)); 8280e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0074, CBR_SIZE2); 829312fec14SDave Airlie data = cbr_scan(ast); 830312fec14SDave Airlie if (data != 0) { 831312fec14SDave Airlie if (data & 0x1) { 832312fec14SDave Airlie if (dllmin[0] > dlli) { 833312fec14SDave Airlie dllmin[0] = dlli; 834312fec14SDave Airlie } 835312fec14SDave Airlie if (dllmax[0] < dlli) { 836312fec14SDave Airlie dllmax[0] = dlli; 837312fec14SDave Airlie } 838312fec14SDave Airlie } 839312fec14SDave Airlie if (data & 0x2) { 840312fec14SDave Airlie if (dllmin[1] > dlli) { 841312fec14SDave Airlie dllmin[1] = dlli; 842312fec14SDave Airlie } 843312fec14SDave Airlie if (dllmax[1] < dlli) { 844312fec14SDave Airlie dllmax[1] = dlli; 845312fec14SDave Airlie } 846312fec14SDave Airlie } 847312fec14SDave Airlie passcnt++; 848312fec14SDave Airlie } else if (passcnt >= CBR_THRESHOLD) { 849312fec14SDave Airlie break; 850312fec14SDave Airlie } 851312fec14SDave Airlie } 852318cfa29SDave Airlie if (retry++ > 10) 853318cfa29SDave Airlie goto CBR_DONE2; 854312fec14SDave Airlie if (dllmax[0] == 0 || (dllmax[0]-dllmin[0]) < CBR_THRESHOLD) { 855312fec14SDave Airlie goto CBR_START2; 856312fec14SDave Airlie } 857312fec14SDave Airlie if (dllmax[1] == 0 || (dllmax[1]-dllmin[1]) < CBR_THRESHOLD) { 858312fec14SDave Airlie goto CBR_START2; 859312fec14SDave Airlie } 860318cfa29SDave Airlie status = true; 861318cfa29SDave Airlie CBR_DONE2: 862312fec14SDave Airlie dlli = (dllmin[1] + dllmax[1]) >> 1; 863312fec14SDave Airlie dlli <<= 8; 864312fec14SDave Airlie dlli += (dllmin[0] + dllmax[0]) >> 1; 8650e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0068, ast_mindwm(ast, 0x1E720058) | (dlli << 16)); 866318cfa29SDave Airlie return status; 867312fec14SDave Airlie } /* CBRDLL2 */ 868312fec14SDave Airlie 869312fec14SDave Airlie static void get_ddr3_info(struct ast_private *ast, struct ast2300_dram_param *param) 870312fec14SDave Airlie { 871312fec14SDave Airlie u32 trap, trap_AC2, trap_MRS; 872312fec14SDave Airlie 8730e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2000, 0x1688A8A8); 874312fec14SDave Airlie 875312fec14SDave Airlie /* Ger trap info */ 8760e5ce924SDave Airlie trap = (ast_mindwm(ast, 0x1E6E2070) >> 25) & 0x3; 877312fec14SDave Airlie trap_AC2 = 0x00020000 + (trap << 16); 878312fec14SDave Airlie trap_AC2 |= 0x00300000 + ((trap & 0x2) << 19); 879312fec14SDave Airlie trap_MRS = 0x00000010 + (trap << 4); 880312fec14SDave Airlie trap_MRS |= ((trap & 0x2) << 18); 881312fec14SDave Airlie 882312fec14SDave Airlie param->reg_MADJ = 0x00034C4C; 883312fec14SDave Airlie param->reg_SADJ = 0x00001800; 884312fec14SDave Airlie param->reg_DRV = 0x000000F0; 885312fec14SDave Airlie param->reg_PERIOD = param->dram_freq; 886312fec14SDave Airlie param->rodt = 0; 887312fec14SDave Airlie 888312fec14SDave Airlie switch (param->dram_freq) { 889312fec14SDave Airlie case 336: 8900e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x0190); 891312fec14SDave Airlie param->wodt = 0; 892312fec14SDave Airlie param->reg_AC1 = 0x22202725; 893312fec14SDave Airlie param->reg_AC2 = 0xAA007613 | trap_AC2; 894312fec14SDave Airlie param->reg_DQSIC = 0x000000BA; 895312fec14SDave Airlie param->reg_MRS = 0x04001400 | trap_MRS; 896312fec14SDave Airlie param->reg_EMRS = 0x00000000; 897318cfa29SDave Airlie param->reg_IOZ = 0x00000023; 898312fec14SDave Airlie param->reg_DQIDLY = 0x00000074; 899312fec14SDave Airlie param->reg_FREQ = 0x00004DC0; 900312fec14SDave Airlie param->madj_max = 96; 901312fec14SDave Airlie param->dll2_finetune_step = 3; 902318cfa29SDave Airlie switch (param->dram_chipid) { 903318cfa29SDave Airlie default: 904318cfa29SDave Airlie case AST_DRAM_512Mx16: 905318cfa29SDave Airlie case AST_DRAM_1Gx16: 906318cfa29SDave Airlie param->reg_AC2 = 0xAA007613 | trap_AC2; 907318cfa29SDave Airlie break; 908318cfa29SDave Airlie case AST_DRAM_2Gx16: 909318cfa29SDave Airlie param->reg_AC2 = 0xAA00761C | trap_AC2; 910318cfa29SDave Airlie break; 911318cfa29SDave Airlie case AST_DRAM_4Gx16: 912318cfa29SDave Airlie param->reg_AC2 = 0xAA007636 | trap_AC2; 913318cfa29SDave Airlie break; 914318cfa29SDave Airlie } 915312fec14SDave Airlie break; 916312fec14SDave Airlie default: 917312fec14SDave Airlie case 396: 9180e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x03F1); 919312fec14SDave Airlie param->wodt = 1; 920312fec14SDave Airlie param->reg_AC1 = 0x33302825; 921312fec14SDave Airlie param->reg_AC2 = 0xCC009617 | trap_AC2; 922312fec14SDave Airlie param->reg_DQSIC = 0x000000E2; 923312fec14SDave Airlie param->reg_MRS = 0x04001600 | trap_MRS; 924312fec14SDave Airlie param->reg_EMRS = 0x00000000; 925312fec14SDave Airlie param->reg_IOZ = 0x00000034; 926312fec14SDave Airlie param->reg_DRV = 0x000000FA; 927312fec14SDave Airlie param->reg_DQIDLY = 0x00000089; 928318cfa29SDave Airlie param->reg_FREQ = 0x00005040; 929312fec14SDave Airlie param->madj_max = 96; 930312fec14SDave Airlie param->dll2_finetune_step = 4; 931312fec14SDave Airlie 932312fec14SDave Airlie switch (param->dram_chipid) { 933312fec14SDave Airlie default: 934312fec14SDave Airlie case AST_DRAM_512Mx16: 935312fec14SDave Airlie case AST_DRAM_1Gx16: 936312fec14SDave Airlie param->reg_AC2 = 0xCC009617 | trap_AC2; 937312fec14SDave Airlie break; 938312fec14SDave Airlie case AST_DRAM_2Gx16: 939312fec14SDave Airlie param->reg_AC2 = 0xCC009622 | trap_AC2; 940312fec14SDave Airlie break; 941312fec14SDave Airlie case AST_DRAM_4Gx16: 942312fec14SDave Airlie param->reg_AC2 = 0xCC00963F | trap_AC2; 943312fec14SDave Airlie break; 944312fec14SDave Airlie } 945312fec14SDave Airlie break; 946312fec14SDave Airlie 947312fec14SDave Airlie case 408: 9480e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x01F0); 949312fec14SDave Airlie param->wodt = 1; 950312fec14SDave Airlie param->reg_AC1 = 0x33302825; 951312fec14SDave Airlie param->reg_AC2 = 0xCC009617 | trap_AC2; 952312fec14SDave Airlie param->reg_DQSIC = 0x000000E2; 953312fec14SDave Airlie param->reg_MRS = 0x04001600 | trap_MRS; 954312fec14SDave Airlie param->reg_EMRS = 0x00000000; 955318cfa29SDave Airlie param->reg_IOZ = 0x00000023; 956312fec14SDave Airlie param->reg_DRV = 0x000000FA; 957312fec14SDave Airlie param->reg_DQIDLY = 0x00000089; 958312fec14SDave Airlie param->reg_FREQ = 0x000050C0; 959312fec14SDave Airlie param->madj_max = 96; 960312fec14SDave Airlie param->dll2_finetune_step = 4; 961312fec14SDave Airlie 962312fec14SDave Airlie switch (param->dram_chipid) { 963312fec14SDave Airlie default: 964312fec14SDave Airlie case AST_DRAM_512Mx16: 965312fec14SDave Airlie case AST_DRAM_1Gx16: 966312fec14SDave Airlie param->reg_AC2 = 0xCC009617 | trap_AC2; 967312fec14SDave Airlie break; 968312fec14SDave Airlie case AST_DRAM_2Gx16: 969312fec14SDave Airlie param->reg_AC2 = 0xCC009622 | trap_AC2; 970312fec14SDave Airlie break; 971312fec14SDave Airlie case AST_DRAM_4Gx16: 972312fec14SDave Airlie param->reg_AC2 = 0xCC00963F | trap_AC2; 973312fec14SDave Airlie break; 974312fec14SDave Airlie } 975312fec14SDave Airlie 976312fec14SDave Airlie break; 977312fec14SDave Airlie case 456: 9780e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x0230); 979312fec14SDave Airlie param->wodt = 0; 980312fec14SDave Airlie param->reg_AC1 = 0x33302926; 981312fec14SDave Airlie param->reg_AC2 = 0xCD44961A; 982312fec14SDave Airlie param->reg_DQSIC = 0x000000FC; 983312fec14SDave Airlie param->reg_MRS = 0x00081830; 984312fec14SDave Airlie param->reg_EMRS = 0x00000000; 985312fec14SDave Airlie param->reg_IOZ = 0x00000045; 986312fec14SDave Airlie param->reg_DQIDLY = 0x00000097; 987312fec14SDave Airlie param->reg_FREQ = 0x000052C0; 988312fec14SDave Airlie param->madj_max = 88; 989312fec14SDave Airlie param->dll2_finetune_step = 4; 990312fec14SDave Airlie break; 991312fec14SDave Airlie case 504: 9920e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x0270); 993312fec14SDave Airlie param->wodt = 1; 994312fec14SDave Airlie param->reg_AC1 = 0x33302926; 995312fec14SDave Airlie param->reg_AC2 = 0xDE44A61D; 996312fec14SDave Airlie param->reg_DQSIC = 0x00000117; 997312fec14SDave Airlie param->reg_MRS = 0x00081A30; 998312fec14SDave Airlie param->reg_EMRS = 0x00000000; 999312fec14SDave Airlie param->reg_IOZ = 0x070000BB; 1000312fec14SDave Airlie param->reg_DQIDLY = 0x000000A0; 1001312fec14SDave Airlie param->reg_FREQ = 0x000054C0; 1002312fec14SDave Airlie param->madj_max = 79; 1003312fec14SDave Airlie param->dll2_finetune_step = 4; 1004312fec14SDave Airlie break; 1005312fec14SDave Airlie case 528: 10060e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x0290); 1007312fec14SDave Airlie param->wodt = 1; 1008312fec14SDave Airlie param->rodt = 1; 1009312fec14SDave Airlie param->reg_AC1 = 0x33302926; 1010312fec14SDave Airlie param->reg_AC2 = 0xEF44B61E; 1011312fec14SDave Airlie param->reg_DQSIC = 0x00000125; 1012312fec14SDave Airlie param->reg_MRS = 0x00081A30; 1013312fec14SDave Airlie param->reg_EMRS = 0x00000040; 1014312fec14SDave Airlie param->reg_DRV = 0x000000F5; 1015312fec14SDave Airlie param->reg_IOZ = 0x00000023; 1016312fec14SDave Airlie param->reg_DQIDLY = 0x00000088; 1017312fec14SDave Airlie param->reg_FREQ = 0x000055C0; 1018312fec14SDave Airlie param->madj_max = 76; 1019312fec14SDave Airlie param->dll2_finetune_step = 3; 1020312fec14SDave Airlie break; 1021312fec14SDave Airlie case 576: 10220e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x0140); 1023312fec14SDave Airlie param->reg_MADJ = 0x00136868; 1024312fec14SDave Airlie param->reg_SADJ = 0x00004534; 1025312fec14SDave Airlie param->wodt = 1; 1026312fec14SDave Airlie param->rodt = 1; 1027312fec14SDave Airlie param->reg_AC1 = 0x33302A37; 1028312fec14SDave Airlie param->reg_AC2 = 0xEF56B61E; 1029312fec14SDave Airlie param->reg_DQSIC = 0x0000013F; 1030312fec14SDave Airlie param->reg_MRS = 0x00101A50; 1031312fec14SDave Airlie param->reg_EMRS = 0x00000040; 1032312fec14SDave Airlie param->reg_DRV = 0x000000FA; 1033312fec14SDave Airlie param->reg_IOZ = 0x00000023; 1034312fec14SDave Airlie param->reg_DQIDLY = 0x00000078; 1035312fec14SDave Airlie param->reg_FREQ = 0x000057C0; 1036312fec14SDave Airlie param->madj_max = 136; 1037312fec14SDave Airlie param->dll2_finetune_step = 3; 1038312fec14SDave Airlie break; 1039312fec14SDave Airlie case 600: 10400e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x02E1); 1041312fec14SDave Airlie param->reg_MADJ = 0x00136868; 1042312fec14SDave Airlie param->reg_SADJ = 0x00004534; 1043312fec14SDave Airlie param->wodt = 1; 1044312fec14SDave Airlie param->rodt = 1; 1045312fec14SDave Airlie param->reg_AC1 = 0x32302A37; 1046312fec14SDave Airlie param->reg_AC2 = 0xDF56B61F; 1047312fec14SDave Airlie param->reg_DQSIC = 0x0000014D; 1048312fec14SDave Airlie param->reg_MRS = 0x00101A50; 1049312fec14SDave Airlie param->reg_EMRS = 0x00000004; 1050312fec14SDave Airlie param->reg_DRV = 0x000000F5; 1051312fec14SDave Airlie param->reg_IOZ = 0x00000023; 1052312fec14SDave Airlie param->reg_DQIDLY = 0x00000078; 1053312fec14SDave Airlie param->reg_FREQ = 0x000058C0; 1054312fec14SDave Airlie param->madj_max = 132; 1055312fec14SDave Airlie param->dll2_finetune_step = 3; 1056312fec14SDave Airlie break; 1057312fec14SDave Airlie case 624: 10580e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x0160); 1059312fec14SDave Airlie param->reg_MADJ = 0x00136868; 1060312fec14SDave Airlie param->reg_SADJ = 0x00004534; 1061312fec14SDave Airlie param->wodt = 1; 1062312fec14SDave Airlie param->rodt = 1; 1063312fec14SDave Airlie param->reg_AC1 = 0x32302A37; 1064312fec14SDave Airlie param->reg_AC2 = 0xEF56B621; 1065312fec14SDave Airlie param->reg_DQSIC = 0x0000015A; 1066312fec14SDave Airlie param->reg_MRS = 0x02101A50; 1067312fec14SDave Airlie param->reg_EMRS = 0x00000004; 1068312fec14SDave Airlie param->reg_DRV = 0x000000F5; 1069312fec14SDave Airlie param->reg_IOZ = 0x00000034; 1070312fec14SDave Airlie param->reg_DQIDLY = 0x00000078; 1071312fec14SDave Airlie param->reg_FREQ = 0x000059C0; 1072312fec14SDave Airlie param->madj_max = 128; 1073312fec14SDave Airlie param->dll2_finetune_step = 3; 1074312fec14SDave Airlie break; 1075312fec14SDave Airlie } /* switch freq */ 1076312fec14SDave Airlie 1077312fec14SDave Airlie switch (param->dram_chipid) { 1078312fec14SDave Airlie case AST_DRAM_512Mx16: 1079312fec14SDave Airlie param->dram_config = 0x130; 1080312fec14SDave Airlie break; 1081312fec14SDave Airlie default: 1082312fec14SDave Airlie case AST_DRAM_1Gx16: 1083312fec14SDave Airlie param->dram_config = 0x131; 1084312fec14SDave Airlie break; 1085312fec14SDave Airlie case AST_DRAM_2Gx16: 1086312fec14SDave Airlie param->dram_config = 0x132; 1087312fec14SDave Airlie break; 1088312fec14SDave Airlie case AST_DRAM_4Gx16: 1089312fec14SDave Airlie param->dram_config = 0x133; 1090312fec14SDave Airlie break; 109110d9b4edSDamien Lespiau } /* switch size */ 1092312fec14SDave Airlie 1093312fec14SDave Airlie switch (param->vram_size) { 1094312fec14SDave Airlie default: 1095312fec14SDave Airlie case AST_VIDMEM_SIZE_8M: 1096312fec14SDave Airlie param->dram_config |= 0x00; 1097312fec14SDave Airlie break; 1098312fec14SDave Airlie case AST_VIDMEM_SIZE_16M: 1099312fec14SDave Airlie param->dram_config |= 0x04; 1100312fec14SDave Airlie break; 1101312fec14SDave Airlie case AST_VIDMEM_SIZE_32M: 1102312fec14SDave Airlie param->dram_config |= 0x08; 1103312fec14SDave Airlie break; 1104312fec14SDave Airlie case AST_VIDMEM_SIZE_64M: 1105312fec14SDave Airlie param->dram_config |= 0x0c; 1106312fec14SDave Airlie break; 1107312fec14SDave Airlie } 1108312fec14SDave Airlie 1109312fec14SDave Airlie } 1110312fec14SDave Airlie 1111312fec14SDave Airlie static void ddr3_init(struct ast_private *ast, struct ast2300_dram_param *param) 1112312fec14SDave Airlie { 1113318cfa29SDave Airlie u32 data, data2, retry = 0; 1114312fec14SDave Airlie 1115318cfa29SDave Airlie ddr3_init_start: 11160e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0000, 0xFC600309); 11170e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, 0x00000100); 11180e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0024, 0x00000000); 11190e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0034, 0x00000000); 1120312fec14SDave Airlie udelay(10); 11210e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0064, param->reg_MADJ); 11220e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0068, param->reg_SADJ); 1123312fec14SDave Airlie udelay(10); 11240e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0064, param->reg_MADJ | 0xC0000); 1125312fec14SDave Airlie udelay(10); 1126312fec14SDave Airlie 11270e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0004, param->dram_config); 11280e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0008, 0x90040f); 11290e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0010, param->reg_AC1); 11300e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0014, param->reg_AC2); 11310e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0020, param->reg_DQSIC); 11320e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0080, 0x00000000); 11330e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0084, 0x00000000); 11340e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0088, param->reg_DQIDLY); 11350e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, 0x4000A170); 11360e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, 0x00002370); 11370e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0038, 0x00000000); 11380e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0040, 0xFF444444); 11390e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0044, 0x22222222); 11400e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0048, 0x22222222); 11410e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E004C, 0x00000002); 11420e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0050, 0x80000000); 11430e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0050, 0x00000000); 11440e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0054, 0); 11450e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0060, param->reg_DRV); 11460e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E006C, param->reg_IOZ); 11470e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0070, 0x00000000); 11480e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0074, 0x00000000); 11490e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0078, 0x00000000); 11500e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E007C, 0x00000000); 1151312fec14SDave Airlie /* Wait MCLK2X lock to MCLK */ 1152312fec14SDave Airlie do { 11530e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E001C); 1154312fec14SDave Airlie } while (!(data & 0x08000000)); 11550e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E001C); 1156312fec14SDave Airlie data = (data >> 8) & 0xff; 1157312fec14SDave Airlie while ((data & 0x08) || ((data & 0x7) < 2) || (data < 4)) { 11580e5ce924SDave Airlie data2 = (ast_mindwm(ast, 0x1E6E0064) & 0xfff3ffff) + 4; 1159312fec14SDave Airlie if ((data2 & 0xff) > param->madj_max) { 1160312fec14SDave Airlie break; 1161312fec14SDave Airlie } 11620e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0064, data2); 1163312fec14SDave Airlie if (data2 & 0x00100000) { 1164312fec14SDave Airlie data2 = ((data2 & 0xff) >> 3) + 3; 1165312fec14SDave Airlie } else { 1166312fec14SDave Airlie data2 = ((data2 & 0xff) >> 2) + 5; 1167312fec14SDave Airlie } 11680e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E0068) & 0xffff00ff; 1169312fec14SDave Airlie data2 += data & 0xff; 1170312fec14SDave Airlie data = data | (data2 << 8); 11710e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0068, data); 1172312fec14SDave Airlie udelay(10); 11730e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0064, ast_mindwm(ast, 0x1E6E0064) | 0xC0000); 1174312fec14SDave Airlie udelay(10); 11750e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E0018) & 0xfffff1ff; 11760e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, data); 1177312fec14SDave Airlie data = data | 0x200; 11780e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, data); 1179312fec14SDave Airlie do { 11800e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E001C); 1181312fec14SDave Airlie } while (!(data & 0x08000000)); 1182312fec14SDave Airlie 11830e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E001C); 1184312fec14SDave Airlie data = (data >> 8) & 0xff; 1185312fec14SDave Airlie } 11860e5ce924SDave Airlie ast_moutdwm(ast, 0x1E720058, ast_mindwm(ast, 0x1E6E0068) & 0xffff); 11870e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E0018) | 0xC00; 11880e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, data); 1189312fec14SDave Airlie 11900e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0034, 0x00000001); 11910e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E000C, 0x00000040); 1192312fec14SDave Airlie udelay(50); 1193312fec14SDave Airlie /* Mode Register Setting */ 11940e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E002C, param->reg_MRS | 0x100); 11950e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0030, param->reg_EMRS); 11960e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0028, 0x00000005); 11970e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0028, 0x00000007); 11980e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0028, 0x00000003); 11990e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0028, 0x00000001); 12000e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E002C, param->reg_MRS); 12010e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E000C, 0x00005C08); 12020e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0028, 0x00000001); 1203312fec14SDave Airlie 12040e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E000C, 0x00005C01); 1205312fec14SDave Airlie data = 0; 1206312fec14SDave Airlie if (param->wodt) { 1207312fec14SDave Airlie data = 0x300; 1208312fec14SDave Airlie } 1209312fec14SDave Airlie if (param->rodt) { 1210312fec14SDave Airlie data = data | 0x3000 | ((param->reg_AC2 & 0x60000) >> 3); 1211312fec14SDave Airlie } 12120e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0034, data | 0x3); 1213312fec14SDave Airlie 1214312fec14SDave Airlie /* Calibrate the DQSI delay */ 1215318cfa29SDave Airlie if ((cbr_dll2(ast, param) == false) && (retry++ < 10)) 1216318cfa29SDave Airlie goto ddr3_init_start; 1217312fec14SDave Airlie 12180e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0120, param->reg_FREQ); 1219312fec14SDave Airlie /* ECC Memory Initialization */ 1220312fec14SDave Airlie #ifdef ECC 12210e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E007C, 0x00000000); 12220e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0070, 0x221); 1223312fec14SDave Airlie do { 12240e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E0070); 1225312fec14SDave Airlie } while (!(data & 0x00001000)); 12260e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0070, 0x00000000); 12270e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0050, 0x80000000); 12280e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0050, 0x00000000); 1229312fec14SDave Airlie #endif 1230312fec14SDave Airlie 1231312fec14SDave Airlie 1232312fec14SDave Airlie } 1233312fec14SDave Airlie 1234312fec14SDave Airlie static void get_ddr2_info(struct ast_private *ast, struct ast2300_dram_param *param) 1235312fec14SDave Airlie { 1236312fec14SDave Airlie u32 trap, trap_AC2, trap_MRS; 1237312fec14SDave Airlie 12380e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2000, 0x1688A8A8); 1239312fec14SDave Airlie 1240312fec14SDave Airlie /* Ger trap info */ 12410e5ce924SDave Airlie trap = (ast_mindwm(ast, 0x1E6E2070) >> 25) & 0x3; 1242312fec14SDave Airlie trap_AC2 = (trap << 20) | (trap << 16); 1243312fec14SDave Airlie trap_AC2 += 0x00110000; 1244312fec14SDave Airlie trap_MRS = 0x00000040 | (trap << 4); 1245312fec14SDave Airlie 1246312fec14SDave Airlie 1247312fec14SDave Airlie param->reg_MADJ = 0x00034C4C; 1248312fec14SDave Airlie param->reg_SADJ = 0x00001800; 1249312fec14SDave Airlie param->reg_DRV = 0x000000F0; 1250312fec14SDave Airlie param->reg_PERIOD = param->dram_freq; 1251312fec14SDave Airlie param->rodt = 0; 1252312fec14SDave Airlie 1253312fec14SDave Airlie switch (param->dram_freq) { 1254312fec14SDave Airlie case 264: 12550e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x0130); 1256312fec14SDave Airlie param->wodt = 0; 1257312fec14SDave Airlie param->reg_AC1 = 0x11101513; 1258312fec14SDave Airlie param->reg_AC2 = 0x78117011; 1259312fec14SDave Airlie param->reg_DQSIC = 0x00000092; 1260312fec14SDave Airlie param->reg_MRS = 0x00000842; 1261312fec14SDave Airlie param->reg_EMRS = 0x00000000; 1262312fec14SDave Airlie param->reg_DRV = 0x000000F0; 1263312fec14SDave Airlie param->reg_IOZ = 0x00000034; 1264312fec14SDave Airlie param->reg_DQIDLY = 0x0000005A; 1265312fec14SDave Airlie param->reg_FREQ = 0x00004AC0; 1266312fec14SDave Airlie param->madj_max = 138; 1267312fec14SDave Airlie param->dll2_finetune_step = 3; 1268312fec14SDave Airlie break; 1269312fec14SDave Airlie case 336: 12700e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x0190); 1271312fec14SDave Airlie param->wodt = 1; 1272312fec14SDave Airlie param->reg_AC1 = 0x22202613; 1273312fec14SDave Airlie param->reg_AC2 = 0xAA009016 | trap_AC2; 1274312fec14SDave Airlie param->reg_DQSIC = 0x000000BA; 1275312fec14SDave Airlie param->reg_MRS = 0x00000A02 | trap_MRS; 1276312fec14SDave Airlie param->reg_EMRS = 0x00000040; 1277312fec14SDave Airlie param->reg_DRV = 0x000000FA; 1278312fec14SDave Airlie param->reg_IOZ = 0x00000034; 1279312fec14SDave Airlie param->reg_DQIDLY = 0x00000074; 1280312fec14SDave Airlie param->reg_FREQ = 0x00004DC0; 1281312fec14SDave Airlie param->madj_max = 96; 1282312fec14SDave Airlie param->dll2_finetune_step = 3; 1283318cfa29SDave Airlie switch (param->dram_chipid) { 1284318cfa29SDave Airlie default: 1285318cfa29SDave Airlie case AST_DRAM_512Mx16: 1286318cfa29SDave Airlie param->reg_AC2 = 0xAA009012 | trap_AC2; 1287318cfa29SDave Airlie break; 1288318cfa29SDave Airlie case AST_DRAM_1Gx16: 1289318cfa29SDave Airlie param->reg_AC2 = 0xAA009016 | trap_AC2; 1290318cfa29SDave Airlie break; 1291318cfa29SDave Airlie case AST_DRAM_2Gx16: 1292318cfa29SDave Airlie param->reg_AC2 = 0xAA009023 | trap_AC2; 1293318cfa29SDave Airlie break; 1294318cfa29SDave Airlie case AST_DRAM_4Gx16: 1295318cfa29SDave Airlie param->reg_AC2 = 0xAA00903B | trap_AC2; 1296318cfa29SDave Airlie break; 1297318cfa29SDave Airlie } 1298312fec14SDave Airlie break; 1299312fec14SDave Airlie default: 1300312fec14SDave Airlie case 396: 13010e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x03F1); 1302312fec14SDave Airlie param->wodt = 1; 1303312fec14SDave Airlie param->rodt = 0; 1304312fec14SDave Airlie param->reg_AC1 = 0x33302714; 1305312fec14SDave Airlie param->reg_AC2 = 0xCC00B01B | trap_AC2; 1306312fec14SDave Airlie param->reg_DQSIC = 0x000000E2; 1307312fec14SDave Airlie param->reg_MRS = 0x00000C02 | trap_MRS; 1308312fec14SDave Airlie param->reg_EMRS = 0x00000040; 1309312fec14SDave Airlie param->reg_DRV = 0x000000FA; 1310312fec14SDave Airlie param->reg_IOZ = 0x00000034; 1311312fec14SDave Airlie param->reg_DQIDLY = 0x00000089; 1312318cfa29SDave Airlie param->reg_FREQ = 0x00005040; 1313312fec14SDave Airlie param->madj_max = 96; 1314312fec14SDave Airlie param->dll2_finetune_step = 4; 1315312fec14SDave Airlie 1316312fec14SDave Airlie switch (param->dram_chipid) { 1317312fec14SDave Airlie case AST_DRAM_512Mx16: 1318312fec14SDave Airlie param->reg_AC2 = 0xCC00B016 | trap_AC2; 1319312fec14SDave Airlie break; 1320312fec14SDave Airlie default: 1321312fec14SDave Airlie case AST_DRAM_1Gx16: 1322312fec14SDave Airlie param->reg_AC2 = 0xCC00B01B | trap_AC2; 1323312fec14SDave Airlie break; 1324312fec14SDave Airlie case AST_DRAM_2Gx16: 1325312fec14SDave Airlie param->reg_AC2 = 0xCC00B02B | trap_AC2; 1326312fec14SDave Airlie break; 1327312fec14SDave Airlie case AST_DRAM_4Gx16: 1328312fec14SDave Airlie param->reg_AC2 = 0xCC00B03F | trap_AC2; 1329312fec14SDave Airlie break; 1330312fec14SDave Airlie } 1331312fec14SDave Airlie 1332312fec14SDave Airlie break; 1333312fec14SDave Airlie 1334312fec14SDave Airlie case 408: 13350e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x01F0); 1336312fec14SDave Airlie param->wodt = 1; 1337312fec14SDave Airlie param->rodt = 0; 1338312fec14SDave Airlie param->reg_AC1 = 0x33302714; 1339312fec14SDave Airlie param->reg_AC2 = 0xCC00B01B | trap_AC2; 1340312fec14SDave Airlie param->reg_DQSIC = 0x000000E2; 1341312fec14SDave Airlie param->reg_MRS = 0x00000C02 | trap_MRS; 1342312fec14SDave Airlie param->reg_EMRS = 0x00000040; 1343312fec14SDave Airlie param->reg_DRV = 0x000000FA; 1344312fec14SDave Airlie param->reg_IOZ = 0x00000034; 1345312fec14SDave Airlie param->reg_DQIDLY = 0x00000089; 1346312fec14SDave Airlie param->reg_FREQ = 0x000050C0; 1347312fec14SDave Airlie param->madj_max = 96; 1348312fec14SDave Airlie param->dll2_finetune_step = 4; 1349312fec14SDave Airlie 1350312fec14SDave Airlie switch (param->dram_chipid) { 1351312fec14SDave Airlie case AST_DRAM_512Mx16: 1352312fec14SDave Airlie param->reg_AC2 = 0xCC00B016 | trap_AC2; 1353312fec14SDave Airlie break; 1354312fec14SDave Airlie default: 1355312fec14SDave Airlie case AST_DRAM_1Gx16: 1356312fec14SDave Airlie param->reg_AC2 = 0xCC00B01B | trap_AC2; 1357312fec14SDave Airlie break; 1358312fec14SDave Airlie case AST_DRAM_2Gx16: 1359312fec14SDave Airlie param->reg_AC2 = 0xCC00B02B | trap_AC2; 1360312fec14SDave Airlie break; 1361312fec14SDave Airlie case AST_DRAM_4Gx16: 1362312fec14SDave Airlie param->reg_AC2 = 0xCC00B03F | trap_AC2; 1363312fec14SDave Airlie break; 1364312fec14SDave Airlie } 1365312fec14SDave Airlie 1366312fec14SDave Airlie break; 1367312fec14SDave Airlie case 456: 13680e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x0230); 1369312fec14SDave Airlie param->wodt = 0; 1370312fec14SDave Airlie param->reg_AC1 = 0x33302815; 1371312fec14SDave Airlie param->reg_AC2 = 0xCD44B01E; 1372312fec14SDave Airlie param->reg_DQSIC = 0x000000FC; 1373312fec14SDave Airlie param->reg_MRS = 0x00000E72; 1374312fec14SDave Airlie param->reg_EMRS = 0x00000000; 1375312fec14SDave Airlie param->reg_DRV = 0x00000000; 1376312fec14SDave Airlie param->reg_IOZ = 0x00000034; 1377312fec14SDave Airlie param->reg_DQIDLY = 0x00000097; 1378312fec14SDave Airlie param->reg_FREQ = 0x000052C0; 1379312fec14SDave Airlie param->madj_max = 88; 1380312fec14SDave Airlie param->dll2_finetune_step = 3; 1381312fec14SDave Airlie break; 1382312fec14SDave Airlie case 504: 13830e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x0261); 1384312fec14SDave Airlie param->wodt = 1; 1385312fec14SDave Airlie param->rodt = 1; 1386312fec14SDave Airlie param->reg_AC1 = 0x33302815; 1387312fec14SDave Airlie param->reg_AC2 = 0xDE44C022; 1388312fec14SDave Airlie param->reg_DQSIC = 0x00000117; 1389312fec14SDave Airlie param->reg_MRS = 0x00000E72; 1390312fec14SDave Airlie param->reg_EMRS = 0x00000040; 1391312fec14SDave Airlie param->reg_DRV = 0x0000000A; 1392312fec14SDave Airlie param->reg_IOZ = 0x00000045; 1393312fec14SDave Airlie param->reg_DQIDLY = 0x000000A0; 1394312fec14SDave Airlie param->reg_FREQ = 0x000054C0; 1395312fec14SDave Airlie param->madj_max = 79; 1396312fec14SDave Airlie param->dll2_finetune_step = 3; 1397312fec14SDave Airlie break; 1398312fec14SDave Airlie case 528: 13990e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x0120); 1400312fec14SDave Airlie param->wodt = 1; 1401312fec14SDave Airlie param->rodt = 1; 1402312fec14SDave Airlie param->reg_AC1 = 0x33302815; 1403312fec14SDave Airlie param->reg_AC2 = 0xEF44D024; 1404312fec14SDave Airlie param->reg_DQSIC = 0x00000125; 1405312fec14SDave Airlie param->reg_MRS = 0x00000E72; 1406312fec14SDave Airlie param->reg_EMRS = 0x00000004; 1407312fec14SDave Airlie param->reg_DRV = 0x000000F9; 1408312fec14SDave Airlie param->reg_IOZ = 0x00000045; 1409312fec14SDave Airlie param->reg_DQIDLY = 0x000000A7; 1410312fec14SDave Airlie param->reg_FREQ = 0x000055C0; 1411312fec14SDave Airlie param->madj_max = 76; 1412312fec14SDave Airlie param->dll2_finetune_step = 3; 1413312fec14SDave Airlie break; 1414312fec14SDave Airlie case 552: 14150e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x02A1); 1416312fec14SDave Airlie param->wodt = 1; 1417312fec14SDave Airlie param->rodt = 1; 1418312fec14SDave Airlie param->reg_AC1 = 0x43402915; 1419312fec14SDave Airlie param->reg_AC2 = 0xFF44E025; 1420312fec14SDave Airlie param->reg_DQSIC = 0x00000132; 1421312fec14SDave Airlie param->reg_MRS = 0x00000E72; 1422312fec14SDave Airlie param->reg_EMRS = 0x00000040; 1423312fec14SDave Airlie param->reg_DRV = 0x0000000A; 1424312fec14SDave Airlie param->reg_IOZ = 0x00000045; 1425312fec14SDave Airlie param->reg_DQIDLY = 0x000000AD; 1426312fec14SDave Airlie param->reg_FREQ = 0x000056C0; 1427312fec14SDave Airlie param->madj_max = 76; 1428312fec14SDave Airlie param->dll2_finetune_step = 3; 1429312fec14SDave Airlie break; 1430312fec14SDave Airlie case 576: 14310e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E2020, 0x0140); 1432312fec14SDave Airlie param->wodt = 1; 1433312fec14SDave Airlie param->rodt = 1; 1434312fec14SDave Airlie param->reg_AC1 = 0x43402915; 1435312fec14SDave Airlie param->reg_AC2 = 0xFF44E027; 1436312fec14SDave Airlie param->reg_DQSIC = 0x0000013F; 1437312fec14SDave Airlie param->reg_MRS = 0x00000E72; 1438312fec14SDave Airlie param->reg_EMRS = 0x00000004; 1439312fec14SDave Airlie param->reg_DRV = 0x000000F5; 1440312fec14SDave Airlie param->reg_IOZ = 0x00000045; 1441312fec14SDave Airlie param->reg_DQIDLY = 0x000000B3; 1442312fec14SDave Airlie param->reg_FREQ = 0x000057C0; 1443312fec14SDave Airlie param->madj_max = 76; 1444312fec14SDave Airlie param->dll2_finetune_step = 3; 1445312fec14SDave Airlie break; 1446312fec14SDave Airlie } 1447312fec14SDave Airlie 1448312fec14SDave Airlie switch (param->dram_chipid) { 1449312fec14SDave Airlie case AST_DRAM_512Mx16: 1450312fec14SDave Airlie param->dram_config = 0x100; 1451312fec14SDave Airlie break; 1452312fec14SDave Airlie default: 1453312fec14SDave Airlie case AST_DRAM_1Gx16: 1454312fec14SDave Airlie param->dram_config = 0x121; 1455312fec14SDave Airlie break; 1456312fec14SDave Airlie case AST_DRAM_2Gx16: 1457312fec14SDave Airlie param->dram_config = 0x122; 1458312fec14SDave Airlie break; 1459312fec14SDave Airlie case AST_DRAM_4Gx16: 1460312fec14SDave Airlie param->dram_config = 0x123; 1461312fec14SDave Airlie break; 146210d9b4edSDamien Lespiau } /* switch size */ 1463312fec14SDave Airlie 1464312fec14SDave Airlie switch (param->vram_size) { 1465312fec14SDave Airlie default: 1466312fec14SDave Airlie case AST_VIDMEM_SIZE_8M: 1467312fec14SDave Airlie param->dram_config |= 0x00; 1468312fec14SDave Airlie break; 1469312fec14SDave Airlie case AST_VIDMEM_SIZE_16M: 1470312fec14SDave Airlie param->dram_config |= 0x04; 1471312fec14SDave Airlie break; 1472312fec14SDave Airlie case AST_VIDMEM_SIZE_32M: 1473312fec14SDave Airlie param->dram_config |= 0x08; 1474312fec14SDave Airlie break; 1475312fec14SDave Airlie case AST_VIDMEM_SIZE_64M: 1476312fec14SDave Airlie param->dram_config |= 0x0c; 1477312fec14SDave Airlie break; 1478312fec14SDave Airlie } 1479312fec14SDave Airlie } 1480312fec14SDave Airlie 1481312fec14SDave Airlie static void ddr2_init(struct ast_private *ast, struct ast2300_dram_param *param) 1482312fec14SDave Airlie { 1483318cfa29SDave Airlie u32 data, data2, retry = 0; 1484312fec14SDave Airlie 1485318cfa29SDave Airlie ddr2_init_start: 14860e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0000, 0xFC600309); 14870e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, 0x00000100); 14880e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0024, 0x00000000); 14890e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0064, param->reg_MADJ); 14900e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0068, param->reg_SADJ); 1491312fec14SDave Airlie udelay(10); 14920e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0064, param->reg_MADJ | 0xC0000); 1493312fec14SDave Airlie udelay(10); 1494312fec14SDave Airlie 14950e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0004, param->dram_config); 14960e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0008, 0x90040f); 14970e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0010, param->reg_AC1); 14980e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0014, param->reg_AC2); 14990e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0020, param->reg_DQSIC); 15000e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0080, 0x00000000); 15010e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0084, 0x00000000); 15020e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0088, param->reg_DQIDLY); 15030e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, 0x4000A130); 15040e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, 0x00002330); 15050e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0038, 0x00000000); 15060e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0040, 0xFF808000); 15070e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0044, 0x88848466); 15080e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0048, 0x44440008); 15090e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E004C, 0x00000000); 15100e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0050, 0x80000000); 15110e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0050, 0x00000000); 15120e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0054, 0); 15130e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0060, param->reg_DRV); 15140e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E006C, param->reg_IOZ); 15150e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0070, 0x00000000); 15160e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0074, 0x00000000); 15170e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0078, 0x00000000); 15180e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E007C, 0x00000000); 1519312fec14SDave Airlie 1520312fec14SDave Airlie /* Wait MCLK2X lock to MCLK */ 1521312fec14SDave Airlie do { 15220e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E001C); 1523312fec14SDave Airlie } while (!(data & 0x08000000)); 15240e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E001C); 1525312fec14SDave Airlie data = (data >> 8) & 0xff; 1526312fec14SDave Airlie while ((data & 0x08) || ((data & 0x7) < 2) || (data < 4)) { 15270e5ce924SDave Airlie data2 = (ast_mindwm(ast, 0x1E6E0064) & 0xfff3ffff) + 4; 1528312fec14SDave Airlie if ((data2 & 0xff) > param->madj_max) { 1529312fec14SDave Airlie break; 1530312fec14SDave Airlie } 15310e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0064, data2); 1532312fec14SDave Airlie if (data2 & 0x00100000) { 1533312fec14SDave Airlie data2 = ((data2 & 0xff) >> 3) + 3; 1534312fec14SDave Airlie } else { 1535312fec14SDave Airlie data2 = ((data2 & 0xff) >> 2) + 5; 1536312fec14SDave Airlie } 15370e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E0068) & 0xffff00ff; 1538312fec14SDave Airlie data2 += data & 0xff; 1539312fec14SDave Airlie data = data | (data2 << 8); 15400e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0068, data); 1541312fec14SDave Airlie udelay(10); 15420e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0064, ast_mindwm(ast, 0x1E6E0064) | 0xC0000); 1543312fec14SDave Airlie udelay(10); 15440e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E0018) & 0xfffff1ff; 15450e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, data); 1546312fec14SDave Airlie data = data | 0x200; 15470e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, data); 1548312fec14SDave Airlie do { 15490e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E001C); 1550312fec14SDave Airlie } while (!(data & 0x08000000)); 1551312fec14SDave Airlie 15520e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E001C); 1553312fec14SDave Airlie data = (data >> 8) & 0xff; 1554312fec14SDave Airlie } 15550e5ce924SDave Airlie ast_moutdwm(ast, 0x1E720058, ast_mindwm(ast, 0x1E6E0008) & 0xffff); 15560e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E0018) | 0xC00; 15570e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0018, data); 1558312fec14SDave Airlie 15590e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0034, 0x00000001); 15600e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E000C, 0x00000000); 1561312fec14SDave Airlie udelay(50); 1562312fec14SDave Airlie /* Mode Register Setting */ 15630e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E002C, param->reg_MRS | 0x100); 15640e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0030, param->reg_EMRS); 15650e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0028, 0x00000005); 15660e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0028, 0x00000007); 15670e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0028, 0x00000003); 15680e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0028, 0x00000001); 1569312fec14SDave Airlie 15700e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E000C, 0x00005C08); 15710e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E002C, param->reg_MRS); 15720e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0028, 0x00000001); 15730e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0030, param->reg_EMRS | 0x380); 15740e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0028, 0x00000003); 15750e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0030, param->reg_EMRS); 15760e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0028, 0x00000003); 1577312fec14SDave Airlie 15780e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E000C, 0x7FFF5C01); 1579312fec14SDave Airlie data = 0; 1580312fec14SDave Airlie if (param->wodt) { 1581312fec14SDave Airlie data = 0x500; 1582312fec14SDave Airlie } 1583312fec14SDave Airlie if (param->rodt) { 1584312fec14SDave Airlie data = data | 0x3000 | ((param->reg_AC2 & 0x60000) >> 3); 1585312fec14SDave Airlie } 15860e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0034, data | 0x3); 15870e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0120, param->reg_FREQ); 1588312fec14SDave Airlie 1589312fec14SDave Airlie /* Calibrate the DQSI delay */ 1590318cfa29SDave Airlie if ((cbr_dll2(ast, param) == false) && (retry++ < 10)) 1591318cfa29SDave Airlie goto ddr2_init_start; 1592312fec14SDave Airlie 1593312fec14SDave Airlie /* ECC Memory Initialization */ 1594312fec14SDave Airlie #ifdef ECC 15950e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E007C, 0x00000000); 15960e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0070, 0x221); 1597312fec14SDave Airlie do { 15980e5ce924SDave Airlie data = ast_mindwm(ast, 0x1E6E0070); 1599312fec14SDave Airlie } while (!(data & 0x00001000)); 16000e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0070, 0x00000000); 16010e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0050, 0x80000000); 16020e5ce924SDave Airlie ast_moutdwm(ast, 0x1E6E0050, 0x00000000); 1603312fec14SDave Airlie #endif 1604312fec14SDave Airlie 1605312fec14SDave Airlie } 1606312fec14SDave Airlie 1607312fec14SDave Airlie static void ast_init_dram_2300(struct drm_device *dev) 1608312fec14SDave Airlie { 1609312fec14SDave Airlie struct ast_private *ast = dev->dev_private; 1610312fec14SDave Airlie struct ast2300_dram_param param; 1611312fec14SDave Airlie u32 temp; 1612312fec14SDave Airlie u8 reg; 1613312fec14SDave Airlie 1614312fec14SDave Airlie reg = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd0, 0xff); 1615312fec14SDave Airlie if ((reg & 0x80) == 0) {/* vga only */ 1616312fec14SDave Airlie ast_write32(ast, 0xf004, 0x1e6e0000); 1617312fec14SDave Airlie ast_write32(ast, 0xf000, 0x1); 1618312fec14SDave Airlie ast_write32(ast, 0x12000, 0x1688a8a8); 1619312fec14SDave Airlie do { 1620312fec14SDave Airlie ; 1621312fec14SDave Airlie } while (ast_read32(ast, 0x12000) != 0x1); 1622312fec14SDave Airlie 1623312fec14SDave Airlie ast_write32(ast, 0x10000, 0xfc600309); 1624312fec14SDave Airlie do { 1625312fec14SDave Airlie ; 1626312fec14SDave Airlie } while (ast_read32(ast, 0x10000) != 0x1); 1627312fec14SDave Airlie 1628312fec14SDave Airlie /* Slow down CPU/AHB CLK in VGA only mode */ 1629312fec14SDave Airlie temp = ast_read32(ast, 0x12008); 1630312fec14SDave Airlie temp |= 0x73; 1631312fec14SDave Airlie ast_write32(ast, 0x12008, temp); 1632312fec14SDave Airlie 1633312fec14SDave Airlie param.dram_type = AST_DDR3; 1634312fec14SDave Airlie if (temp & 0x01000000) 1635312fec14SDave Airlie param.dram_type = AST_DDR2; 1636312fec14SDave Airlie param.dram_chipid = ast->dram_type; 1637312fec14SDave Airlie param.dram_freq = ast->mclk; 1638312fec14SDave Airlie param.vram_size = ast->vram_size; 1639312fec14SDave Airlie 1640312fec14SDave Airlie if (param.dram_type == AST_DDR3) { 1641312fec14SDave Airlie get_ddr3_info(ast, ¶m); 1642312fec14SDave Airlie ddr3_init(ast, ¶m); 1643312fec14SDave Airlie } else { 1644312fec14SDave Airlie get_ddr2_info(ast, ¶m); 1645312fec14SDave Airlie ddr2_init(ast, ¶m); 1646312fec14SDave Airlie } 1647312fec14SDave Airlie 16480e5ce924SDave Airlie temp = ast_mindwm(ast, 0x1e6e2040); 16490e5ce924SDave Airlie ast_moutdwm(ast, 0x1e6e2040, temp | 0x40); 1650312fec14SDave Airlie } 1651312fec14SDave Airlie 1652312fec14SDave Airlie /* wait ready */ 1653312fec14SDave Airlie do { 1654312fec14SDave Airlie reg = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd0, 0xff); 1655312fec14SDave Airlie } while ((reg & 0x40) == 0); 1656312fec14SDave Airlie } 1657312fec14SDave Airlie 1658