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 */ 28fbbbd160SSam Ravnborg 29fbbbd160SSam Ravnborg #include <linux/pci.h> 30312fec14SDave Airlie 314961eb60SThomas Zimmermann #include <drm/drm_atomic_helper.h> 32fbe01716SThomas Zimmermann #include <drm/drm_drv.h> 33fbbbd160SSam Ravnborg #include <drm/drm_gem.h> 344bc85b82SThomas Zimmermann #include <drm/drm_managed.h> 35fbbbd160SSam Ravnborg 36fbbbd160SSam Ravnborg #include "ast_drv.h" 37312fec14SDave Airlie 38*48b6701eSThomas Zimmermann static int ast_init_pci_config(struct pci_dev *pdev) 39*48b6701eSThomas Zimmermann { 40*48b6701eSThomas Zimmermann int err; 41*48b6701eSThomas Zimmermann u16 pcis04; 42*48b6701eSThomas Zimmermann 43*48b6701eSThomas Zimmermann err = pci_read_config_word(pdev, PCI_COMMAND, &pcis04); 44*48b6701eSThomas Zimmermann if (err) 45*48b6701eSThomas Zimmermann goto out; 46*48b6701eSThomas Zimmermann 47*48b6701eSThomas Zimmermann pcis04 |= PCI_COMMAND_MEMORY | PCI_COMMAND_IO; 48*48b6701eSThomas Zimmermann 49*48b6701eSThomas Zimmermann err = pci_write_config_word(pdev, PCI_COMMAND, pcis04); 50*48b6701eSThomas Zimmermann 51*48b6701eSThomas Zimmermann out: 52*48b6701eSThomas Zimmermann return pcibios_err_to_errno(err); 53*48b6701eSThomas Zimmermann } 54*48b6701eSThomas Zimmermann 5571f677a9SRussell Currey static void ast_detect_config_mode(struct drm_device *dev, u32 *scu_rev) 5671f677a9SRussell Currey { 5746fb883cSThomas Zimmermann struct device_node *np = dev->dev->of_node; 585abaa683SThomas Zimmermann struct ast_device *ast = to_ast_device(dev); 5946fb883cSThomas Zimmermann struct pci_dev *pdev = to_pci_dev(dev->dev); 6071f677a9SRussell Currey uint32_t data, jregd0, jregd1; 6171f677a9SRussell Currey 6271f677a9SRussell Currey /* Defaults */ 6371f677a9SRussell Currey ast->config_mode = ast_use_defaults; 6471f677a9SRussell Currey 6571f677a9SRussell Currey /* Check if we have device-tree properties */ 6671f677a9SRussell Currey if (np && !of_property_read_u32(np, "aspeed,scu-revision-id", 6771f677a9SRussell Currey scu_rev)) { 6871f677a9SRussell Currey /* We do, disable P2A access */ 6971f677a9SRussell Currey ast->config_mode = ast_use_dt; 701a19b4cbSThomas Zimmermann drm_info(dev, "Using device-tree for configuration\n"); 7171f677a9SRussell Currey return; 7271f677a9SRussell Currey } 7371f677a9SRussell Currey 7471f677a9SRussell Currey /* Not all families have a P2A bridge */ 7546fb883cSThomas Zimmermann if (pdev->device != PCI_CHIP_AST2000) 7671f677a9SRussell Currey return; 7771f677a9SRussell Currey 7871f677a9SRussell Currey /* 7971f677a9SRussell Currey * The BMC will set SCU 0x40 D[12] to 1 if the P2 bridge 8071f677a9SRussell Currey * is disabled. We force using P2A if VGA only mode bit 8171f677a9SRussell Currey * is set D[7] 8271f677a9SRussell Currey */ 8371f677a9SRussell Currey jregd0 = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd0, 0xff); 8471f677a9SRussell Currey jregd1 = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd1, 0xff); 8571f677a9SRussell Currey if (!(jregd0 & 0x80) || !(jregd1 & 0x10)) { 86f34bf652SKuoHsiang Chou /* Patch AST2500 */ 87f34bf652SKuoHsiang Chou if (((pdev->revision & 0xF0) == 0x40) 88f34bf652SKuoHsiang Chou && ((jregd0 & AST_VRAM_INIT_STATUS_MASK) == 0)) 89f34bf652SKuoHsiang Chou ast_patch_ahb_2500(ast); 90f34bf652SKuoHsiang Chou 9171f677a9SRussell Currey /* Double check it's actually working */ 9271f677a9SRussell Currey data = ast_read32(ast, 0xf004); 93ba4e0339SKuoHsiang Chou if ((data != 0xFFFFFFFF) && (data != 0x00)) { 9471f677a9SRussell Currey /* P2A works, grab silicon revision */ 9571f677a9SRussell Currey ast->config_mode = ast_use_p2a; 9671f677a9SRussell Currey 971a19b4cbSThomas Zimmermann drm_info(dev, "Using P2A bridge for configuration\n"); 9871f677a9SRussell Currey 9971f677a9SRussell Currey /* Read SCU7c (silicon revision register) */ 10071f677a9SRussell Currey ast_write32(ast, 0xf004, 0x1e6e0000); 10171f677a9SRussell Currey ast_write32(ast, 0xf000, 0x1); 10271f677a9SRussell Currey *scu_rev = ast_read32(ast, 0x1207c); 10371f677a9SRussell Currey return; 10471f677a9SRussell Currey } 10571f677a9SRussell Currey } 10671f677a9SRussell Currey 10771f677a9SRussell Currey /* We have a P2A bridge but it's disabled */ 1081a19b4cbSThomas Zimmermann drm_info(dev, "P2A bridge disabled, using default configuration\n"); 10971f677a9SRussell Currey } 110312fec14SDave Airlie 1113bfe25b5SThomas Zimmermann static int ast_detect_chip(struct drm_device *dev, bool need_post, u32 scu_rev) 112312fec14SDave Airlie { 1135abaa683SThomas Zimmermann struct ast_device *ast = to_ast_device(dev); 11446fb883cSThomas Zimmermann struct pci_dev *pdev = to_pci_dev(dev->dev); 1153bfe25b5SThomas Zimmermann uint32_t jreg; 11671f677a9SRussell Currey 11771f677a9SRussell Currey /* Identify chipset */ 11846fb883cSThomas Zimmermann if (pdev->revision >= 0x50) { 119f9bd00e0SKuoHsiang Chou ast->chip = AST2600; 120f9bd00e0SKuoHsiang Chou drm_info(dev, "AST 2600 detected\n"); 12146fb883cSThomas Zimmermann } else if (pdev->revision >= 0x40) { 1229f93c8b3SY.C. Chen ast->chip = AST2500; 1231a19b4cbSThomas Zimmermann drm_info(dev, "AST 2500 detected\n"); 12446fb883cSThomas Zimmermann } else if (pdev->revision >= 0x30) { 1251453bf4cSDave Airlie ast->chip = AST2400; 1261a19b4cbSThomas Zimmermann drm_info(dev, "AST 2400 detected\n"); 12746fb883cSThomas Zimmermann } else if (pdev->revision >= 0x20) { 128312fec14SDave Airlie ast->chip = AST2300; 1291a19b4cbSThomas Zimmermann drm_info(dev, "AST 2300 detected\n"); 13046fb883cSThomas Zimmermann } else if (pdev->revision >= 0x10) { 13171f677a9SRussell Currey switch (scu_rev & 0x0300) { 132312fec14SDave Airlie case 0x0200: 133312fec14SDave Airlie ast->chip = AST1100; 1341a19b4cbSThomas Zimmermann drm_info(dev, "AST 1100 detected\n"); 135312fec14SDave Airlie break; 136312fec14SDave Airlie case 0x0100: 137312fec14SDave Airlie ast->chip = AST2200; 1381a19b4cbSThomas Zimmermann drm_info(dev, "AST 2200 detected\n"); 139312fec14SDave Airlie break; 140312fec14SDave Airlie case 0x0000: 141312fec14SDave Airlie ast->chip = AST2150; 1421a19b4cbSThomas Zimmermann drm_info(dev, "AST 2150 detected\n"); 143312fec14SDave Airlie break; 144312fec14SDave Airlie default: 145312fec14SDave Airlie ast->chip = AST2100; 1461a19b4cbSThomas Zimmermann drm_info(dev, "AST 2100 detected\n"); 147312fec14SDave Airlie break; 148312fec14SDave Airlie } 149312fec14SDave Airlie } else { 15083502a5dSY.C. Chen ast->chip = AST2000; 1511a19b4cbSThomas Zimmermann drm_info(dev, "AST 2000 detected\n"); 152312fec14SDave Airlie } 153f1f62f2cSDave Airlie 154d1b98557SBenjamin Herrenschmidt /* Check if we support wide screen */ 155f1f62f2cSDave Airlie switch (ast->chip) { 156f1f62f2cSDave Airlie case AST2000: 157f1f62f2cSDave Airlie ast->support_wide_screen = false; 158f1f62f2cSDave Airlie break; 159f1f62f2cSDave Airlie default: 160f1f62f2cSDave Airlie jreg = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd0, 0xff); 161f1f62f2cSDave Airlie if (!(jreg & 0x80)) 162f1f62f2cSDave Airlie ast->support_wide_screen = true; 163f1f62f2cSDave Airlie else if (jreg & 0x01) 164f1f62f2cSDave Airlie ast->support_wide_screen = true; 165f1f62f2cSDave Airlie else { 166f1f62f2cSDave Airlie ast->support_wide_screen = false; 16771f677a9SRussell Currey if (ast->chip == AST2300 && 16871f677a9SRussell Currey (scu_rev & 0x300) == 0x0) /* ast1300 */ 169f1f62f2cSDave Airlie ast->support_wide_screen = true; 17071f677a9SRussell Currey if (ast->chip == AST2400 && 17171f677a9SRussell Currey (scu_rev & 0x300) == 0x100) /* ast1400 */ 1721453bf4cSDave Airlie ast->support_wide_screen = true; 1739f93c8b3SY.C. Chen if (ast->chip == AST2500 && 1749f93c8b3SY.C. Chen scu_rev == 0x100) /* ast2510 */ 1759f93c8b3SY.C. Chen ast->support_wide_screen = true; 17659a39fccSKuoHsiang Chou if (ast->chip == AST2600) /* ast2600 */ 17759a39fccSKuoHsiang Chou ast->support_wide_screen = true; 178f1f62f2cSDave Airlie } 179f1f62f2cSDave Airlie break; 180f1f62f2cSDave Airlie } 181f1f62f2cSDave Airlie 182d1b98557SBenjamin Herrenschmidt /* Check 3rd Tx option (digital output afaik) */ 1837f35680aSThomas Zimmermann ast->tx_chip_types |= AST_TX_NONE_BIT; 184d1b98557SBenjamin Herrenschmidt 185d1b98557SBenjamin Herrenschmidt /* 186d1b98557SBenjamin Herrenschmidt * VGACRA3 Enhanced Color Mode Register, check if DVO is already 187d1b98557SBenjamin Herrenschmidt * enabled, in that case, assume we have a SIL164 TMDS transmitter 18842fb1427SBenjamin Herrenschmidt * 18942fb1427SBenjamin Herrenschmidt * Don't make that assumption if we the chip wasn't enabled and 19042fb1427SBenjamin Herrenschmidt * is at power-on reset, otherwise we'll incorrectly "detect" a 19142fb1427SBenjamin Herrenschmidt * SIL164 when there is none. 192d1b98557SBenjamin Herrenschmidt */ 1933bfe25b5SThomas Zimmermann if (!need_post) { 19483c6620bSDave Airlie jreg = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xa3, 0xff); 19583c6620bSDave Airlie if (jreg & 0x80) 1967f35680aSThomas Zimmermann ast->tx_chip_types = AST_TX_SIL164_BIT; 19742fb1427SBenjamin Herrenschmidt } 198d1b98557SBenjamin Herrenschmidt 199594e9c04SKuoHsiang Chou if ((ast->chip == AST2300) || (ast->chip == AST2400) || (ast->chip == AST2500)) { 200d1b98557SBenjamin Herrenschmidt /* 201d1b98557SBenjamin Herrenschmidt * On AST2300 and 2400, look the configuration set by the SoC in 202d1b98557SBenjamin Herrenschmidt * the SOC scratch register #1 bits 11:8 (interestingly marked 20342fb1427SBenjamin Herrenschmidt * as "reserved" in the spec) 204d1b98557SBenjamin Herrenschmidt */ 20583c6620bSDave Airlie jreg = ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xd1, 0xff); 20683c6620bSDave Airlie switch (jreg) { 20783c6620bSDave Airlie case 0x04: 2087f35680aSThomas Zimmermann ast->tx_chip_types = AST_TX_SIL164_BIT; 20983c6620bSDave Airlie break; 21083c6620bSDave Airlie case 0x08: 2114bc85b82SThomas Zimmermann ast->dp501_fw_addr = drmm_kzalloc(dev, 32*1024, GFP_KERNEL); 21283c6620bSDave Airlie if (ast->dp501_fw_addr) { 21383c6620bSDave Airlie /* backup firmware */ 21483c6620bSDave Airlie if (ast_backup_fw(dev, ast->dp501_fw_addr, 32*1024)) { 2154bc85b82SThomas Zimmermann drmm_kfree(dev, ast->dp501_fw_addr); 21683c6620bSDave Airlie ast->dp501_fw_addr = NULL; 21783c6620bSDave Airlie } 21883c6620bSDave Airlie } 219df561f66SGustavo A. R. Silva fallthrough; 22083c6620bSDave Airlie case 0x0c: 2217f35680aSThomas Zimmermann ast->tx_chip_types = AST_TX_DP501_BIT; 22283c6620bSDave Airlie } 223bed61c8fSJammy Huang } else if (ast->chip == AST2600) { 224bed61c8fSJammy Huang if (ast_get_index_reg_mask(ast, AST_IO_CRTC_PORT, 0xD1, TX_TYPE_MASK) == 225bed61c8fSJammy Huang ASTDP_DPMCU_TX) { 226bed61c8fSJammy Huang ast->tx_chip_types = AST_TX_ASTDP_BIT; 227bed61c8fSJammy Huang ast_dp_launch(&ast->base); 228bed61c8fSJammy Huang } 229bed61c8fSJammy Huang } 23083c6620bSDave Airlie 231d1b98557SBenjamin Herrenschmidt /* Print stuff for diagnostic purposes */ 2327f35680aSThomas Zimmermann if (ast->tx_chip_types & AST_TX_NONE_BIT) 2337f35680aSThomas Zimmermann drm_info(dev, "Using analog VGA\n"); 2347f35680aSThomas Zimmermann if (ast->tx_chip_types & AST_TX_SIL164_BIT) 2351a19b4cbSThomas Zimmermann drm_info(dev, "Using Sil164 TMDS transmitter\n"); 2367f35680aSThomas Zimmermann if (ast->tx_chip_types & AST_TX_DP501_BIT) 2371a19b4cbSThomas Zimmermann drm_info(dev, "Using DP501 DisplayPort transmitter\n"); 238bed61c8fSJammy Huang if (ast->tx_chip_types & AST_TX_ASTDP_BIT) 239bed61c8fSJammy Huang drm_info(dev, "Using ASPEED DisplayPort transmitter\n"); 2407f35680aSThomas Zimmermann 241312fec14SDave Airlie return 0; 242312fec14SDave Airlie } 243312fec14SDave Airlie 244312fec14SDave Airlie static int ast_get_dram_info(struct drm_device *dev) 245312fec14SDave Airlie { 24646fb883cSThomas Zimmermann struct device_node *np = dev->dev->of_node; 2475abaa683SThomas Zimmermann struct ast_device *ast = to_ast_device(dev); 24871f677a9SRussell Currey uint32_t mcr_cfg, mcr_scu_mpll, mcr_scu_strap; 24971f677a9SRussell Currey uint32_t denum, num, div, ref_pll, dsel; 250312fec14SDave Airlie 25171f677a9SRussell Currey switch (ast->config_mode) { 25271f677a9SRussell Currey case ast_use_dt: 25371f677a9SRussell Currey /* 25471f677a9SRussell Currey * If some properties are missing, use reasonable 25571f677a9SRussell Currey * defaults for AST2400 25671f677a9SRussell Currey */ 25771f677a9SRussell Currey if (of_property_read_u32(np, "aspeed,mcr-configuration", 25871f677a9SRussell Currey &mcr_cfg)) 25971f677a9SRussell Currey mcr_cfg = 0x00000577; 26071f677a9SRussell Currey if (of_property_read_u32(np, "aspeed,mcr-scu-mpll", 26171f677a9SRussell Currey &mcr_scu_mpll)) 26271f677a9SRussell Currey mcr_scu_mpll = 0x000050C0; 26371f677a9SRussell Currey if (of_property_read_u32(np, "aspeed,mcr-scu-strap", 26471f677a9SRussell Currey &mcr_scu_strap)) 26571f677a9SRussell Currey mcr_scu_strap = 0; 26671f677a9SRussell Currey break; 26771f677a9SRussell Currey case ast_use_p2a: 26871f677a9SRussell Currey ast_write32(ast, 0xf004, 0x1e6e0000); 26971f677a9SRussell Currey ast_write32(ast, 0xf000, 0x1); 27071f677a9SRussell Currey mcr_cfg = ast_read32(ast, 0x10004); 27171f677a9SRussell Currey mcr_scu_mpll = ast_read32(ast, 0x10120); 27271f677a9SRussell Currey mcr_scu_strap = ast_read32(ast, 0x10170); 27371f677a9SRussell Currey break; 27471f677a9SRussell Currey case ast_use_defaults: 27571f677a9SRussell Currey default: 2766c971c09SY.C. Chen ast->dram_bus_width = 16; 2776c971c09SY.C. Chen ast->dram_type = AST_DRAM_1Gx16; 2789f93c8b3SY.C. Chen if (ast->chip == AST2500) 2799f93c8b3SY.C. Chen ast->mclk = 800; 2809f93c8b3SY.C. Chen else 2816c971c09SY.C. Chen ast->mclk = 396; 28271f677a9SRussell Currey return 0; 2836c971c09SY.C. Chen } 284312fec14SDave Airlie 28571f677a9SRussell Currey if (mcr_cfg & 0x40) 286312fec14SDave Airlie ast->dram_bus_width = 16; 287312fec14SDave Airlie else 288312fec14SDave Airlie ast->dram_bus_width = 32; 289312fec14SDave Airlie 2909f93c8b3SY.C. Chen if (ast->chip == AST2500) { 2919f93c8b3SY.C. Chen switch (mcr_cfg & 0x03) { 2929f93c8b3SY.C. Chen case 0: 2939f93c8b3SY.C. Chen ast->dram_type = AST_DRAM_1Gx16; 2949f93c8b3SY.C. Chen break; 2959f93c8b3SY.C. Chen default: 2969f93c8b3SY.C. Chen case 1: 2979f93c8b3SY.C. Chen ast->dram_type = AST_DRAM_2Gx16; 2989f93c8b3SY.C. Chen break; 2999f93c8b3SY.C. Chen case 2: 3009f93c8b3SY.C. Chen ast->dram_type = AST_DRAM_4Gx16; 3019f93c8b3SY.C. Chen break; 3029f93c8b3SY.C. Chen case 3: 3039f93c8b3SY.C. Chen ast->dram_type = AST_DRAM_8Gx16; 3049f93c8b3SY.C. Chen break; 3059f93c8b3SY.C. Chen } 3069f93c8b3SY.C. Chen } else if (ast->chip == AST2300 || ast->chip == AST2400) { 30771f677a9SRussell Currey switch (mcr_cfg & 0x03) { 308312fec14SDave Airlie case 0: 309312fec14SDave Airlie ast->dram_type = AST_DRAM_512Mx16; 310312fec14SDave Airlie break; 311312fec14SDave Airlie default: 312312fec14SDave Airlie case 1: 313312fec14SDave Airlie ast->dram_type = AST_DRAM_1Gx16; 314312fec14SDave Airlie break; 315312fec14SDave Airlie case 2: 316312fec14SDave Airlie ast->dram_type = AST_DRAM_2Gx16; 317312fec14SDave Airlie break; 318312fec14SDave Airlie case 3: 319312fec14SDave Airlie ast->dram_type = AST_DRAM_4Gx16; 320312fec14SDave Airlie break; 321312fec14SDave Airlie } 322312fec14SDave Airlie } else { 32371f677a9SRussell Currey switch (mcr_cfg & 0x0c) { 324312fec14SDave Airlie case 0: 325312fec14SDave Airlie case 4: 326312fec14SDave Airlie ast->dram_type = AST_DRAM_512Mx16; 327312fec14SDave Airlie break; 328312fec14SDave Airlie case 8: 32971f677a9SRussell Currey if (mcr_cfg & 0x40) 330312fec14SDave Airlie ast->dram_type = AST_DRAM_1Gx16; 331312fec14SDave Airlie else 332312fec14SDave Airlie ast->dram_type = AST_DRAM_512Mx32; 333312fec14SDave Airlie break; 334312fec14SDave Airlie case 0xc: 335312fec14SDave Airlie ast->dram_type = AST_DRAM_1Gx32; 336312fec14SDave Airlie break; 337312fec14SDave Airlie } 338312fec14SDave Airlie } 339312fec14SDave Airlie 34071f677a9SRussell Currey if (mcr_scu_strap & 0x2000) 341312fec14SDave Airlie ref_pll = 14318; 342312fec14SDave Airlie else 343312fec14SDave Airlie ref_pll = 12000; 344312fec14SDave Airlie 34571f677a9SRussell Currey denum = mcr_scu_mpll & 0x1f; 34671f677a9SRussell Currey num = (mcr_scu_mpll & 0x3fe0) >> 5; 34771f677a9SRussell Currey dsel = (mcr_scu_mpll & 0xc000) >> 14; 34871f677a9SRussell Currey switch (dsel) { 349312fec14SDave Airlie case 3: 350312fec14SDave Airlie div = 0x4; 351312fec14SDave Airlie break; 352312fec14SDave Airlie case 2: 353312fec14SDave Airlie case 1: 354312fec14SDave Airlie div = 0x2; 355312fec14SDave Airlie break; 356312fec14SDave Airlie default: 357312fec14SDave Airlie div = 0x1; 358312fec14SDave Airlie break; 359312fec14SDave Airlie } 3606475a7ccSBenjamin Herrenschmidt ast->mclk = ref_pll * (num + 2) / ((denum + 2) * (div * 1000)); 361312fec14SDave Airlie return 0; 362312fec14SDave Airlie } 363312fec14SDave Airlie 364cff0adcaSThomas Zimmermann /* 365cff0adcaSThomas Zimmermann * Run this function as part of the HW device cleanup; not 366cff0adcaSThomas Zimmermann * when the DRM device gets released. 367cff0adcaSThomas Zimmermann */ 368cff0adcaSThomas Zimmermann static void ast_device_release(void *data) 369cff0adcaSThomas Zimmermann { 37037b42cf9SThomas Zimmermann struct ast_device *ast = data; 371cff0adcaSThomas Zimmermann 372cff0adcaSThomas Zimmermann /* enable standard VGA decode */ 373cff0adcaSThomas Zimmermann ast_set_index_reg(ast, AST_IO_CRTC_PORT, 0xa1, 0x04); 374cff0adcaSThomas Zimmermann } 375cff0adcaSThomas Zimmermann 37637b42cf9SThomas Zimmermann struct ast_device *ast_device_create(const struct drm_driver *drv, 377fbe01716SThomas Zimmermann struct pci_dev *pdev, 378fbe01716SThomas Zimmermann unsigned long flags) 379312fec14SDave Airlie { 380fbe01716SThomas Zimmermann struct drm_device *dev; 38137b42cf9SThomas Zimmermann struct ast_device *ast; 3823bfe25b5SThomas Zimmermann bool need_post = false; 383312fec14SDave Airlie int ret = 0; 3843bfe25b5SThomas Zimmermann u32 scu_rev = 0xffffffff; 385312fec14SDave Airlie 38637b42cf9SThomas Zimmermann ast = devm_drm_dev_alloc(&pdev->dev, drv, struct ast_device, base); 387e0f5a738SThomas Zimmermann if (IS_ERR(ast)) 388e0f5a738SThomas Zimmermann return ast; 389e0f5a738SThomas Zimmermann dev = &ast->base; 390fbe01716SThomas Zimmermann 391fbe01716SThomas Zimmermann pci_set_drvdata(pdev, dev); 392fbe01716SThomas Zimmermann 393f870231fSThomas Zimmermann ret = drmm_mutex_init(dev, &ast->ioregs_lock); 394f870231fSThomas Zimmermann if (ret) 395f870231fSThomas Zimmermann return ERR_PTR(ret); 396f870231fSThomas Zimmermann 3979ea172a9STakashi Iwai ast->regs = pcim_iomap(pdev, 1, 0); 398e0f5a738SThomas Zimmermann if (!ast->regs) 399e0f5a738SThomas Zimmermann return ERR_PTR(-EIO); 4000dd68309SBenjamin Herrenschmidt 4010dd68309SBenjamin Herrenschmidt /* 4024327a613SJammy Huang * After AST2500, MMIO is enabled by default, and it should be adopted 4034327a613SJammy Huang * to be compatible with Arm. 4040dd68309SBenjamin Herrenschmidt */ 4054327a613SJammy Huang if (pdev->revision >= 0x40) { 4064327a613SJammy Huang ast->ioregs = ast->regs + AST_IO_MM_OFFSET; 4074327a613SJammy Huang } else if (!(pci_resource_flags(pdev, 2) & IORESOURCE_IO)) { 4081a19b4cbSThomas Zimmermann drm_info(dev, "platform has no IO space, trying MMIO\n"); 4090dd68309SBenjamin Herrenschmidt ast->ioregs = ast->regs + AST_IO_MM_OFFSET; 4100dd68309SBenjamin Herrenschmidt } 4110dd68309SBenjamin Herrenschmidt 4120dd68309SBenjamin Herrenschmidt /* "map" IO regs if the above hasn't done so already */ 4130dd68309SBenjamin Herrenschmidt if (!ast->ioregs) { 4149ea172a9STakashi Iwai ast->ioregs = pcim_iomap(pdev, 2, 0); 415e0f5a738SThomas Zimmermann if (!ast->ioregs) 416e0f5a738SThomas Zimmermann return ERR_PTR(-EIO); 4170dd68309SBenjamin Herrenschmidt } 418312fec14SDave Airlie 419*48b6701eSThomas Zimmermann ret = ast_init_pci_config(pdev); 420*48b6701eSThomas Zimmermann if (ret) 421*48b6701eSThomas Zimmermann return ERR_PTR(ret); 422*48b6701eSThomas Zimmermann 4233bfe25b5SThomas Zimmermann if (!ast_is_vga_enabled(dev)) { 4243bfe25b5SThomas Zimmermann drm_info(dev, "VGA not enabled on entry, requesting chip POST\n"); 4253bfe25b5SThomas Zimmermann need_post = true; 4263bfe25b5SThomas Zimmermann } 4273bfe25b5SThomas Zimmermann 4283bfe25b5SThomas Zimmermann /* 4293bfe25b5SThomas Zimmermann * If VGA isn't enabled, we need to enable now or subsequent 4303bfe25b5SThomas Zimmermann * access to the scratch registers will fail. 4313bfe25b5SThomas Zimmermann */ 4323bfe25b5SThomas Zimmermann if (need_post) 4333bfe25b5SThomas Zimmermann ast_enable_vga(dev); 4343bfe25b5SThomas Zimmermann 4353bfe25b5SThomas Zimmermann /* Enable extended register access */ 4363bfe25b5SThomas Zimmermann ast_open_key(ast); 4373bfe25b5SThomas Zimmermann ast_enable_mmio(dev); 4383bfe25b5SThomas Zimmermann 4393bfe25b5SThomas Zimmermann /* Find out whether P2A works or whether to use device-tree */ 4403bfe25b5SThomas Zimmermann ast_detect_config_mode(dev, &scu_rev); 4413bfe25b5SThomas Zimmermann 4423bfe25b5SThomas Zimmermann ast_detect_chip(dev, need_post, scu_rev); 443312fec14SDave Airlie 444298360afSRussell Currey ret = ast_get_dram_info(dev); 445298360afSRussell Currey if (ret) 446e0f5a738SThomas Zimmermann return ERR_PTR(ret); 447e0f5a738SThomas Zimmermann 4480149e780SThomas Zimmermann drm_info(dev, "dram MCLK=%u Mhz type=%d bus_width=%d\n", 4490149e780SThomas Zimmermann ast->mclk, ast->dram_type, ast->dram_bus_width); 450312fec14SDave Airlie 451244d0128SThomas Zimmermann if (need_post) 452244d0128SThomas Zimmermann ast_post_gpu(dev); 453244d0128SThomas Zimmermann 454312fec14SDave Airlie ret = ast_mm_init(ast); 455312fec14SDave Airlie if (ret) 456e0f5a738SThomas Zimmermann return ERR_PTR(ret); 457312fec14SDave Airlie 458ba4e0339SKuoHsiang Chou /* map reserved buffer */ 459ba4e0339SKuoHsiang Chou ast->dp501_fw_buf = NULL; 460f2fa5a99SThomas Zimmermann if (ast->vram_size < pci_resource_len(pdev, 0)) { 461f2fa5a99SThomas Zimmermann ast->dp501_fw_buf = pci_iomap_range(pdev, 0, ast->vram_size, 0); 462ba4e0339SKuoHsiang Chou if (!ast->dp501_fw_buf) 463ba4e0339SKuoHsiang Chou drm_info(dev, "failed to map reserved buffer!\n"); 464ba4e0339SKuoHsiang Chou } 465ba4e0339SKuoHsiang Chou 466e6949ff3SThomas Zimmermann ret = ast_mode_config_init(ast); 4671728bf64SThomas Zimmermann if (ret) 468e0f5a738SThomas Zimmermann return ERR_PTR(ret); 469312fec14SDave Airlie 470cff0adcaSThomas Zimmermann ret = devm_add_action_or_reset(dev->dev, ast_device_release, ast); 471cff0adcaSThomas Zimmermann if (ret) 472cff0adcaSThomas Zimmermann return ERR_PTR(ret); 473312fec14SDave Airlie 474cff0adcaSThomas Zimmermann return ast; 475312fec14SDave Airlie } 476