[deliverable/linux.git] / drivers / gpu / drm / radeon / rs400.c

/*
 * Copyright 2008 Advanced Micro Devices, Inc.
 * Copyright 2008 Red Hat Inc.
 * Copyright 2009 Jerome Glisse.
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
 * OTHER DEALINGS IN THE SOFTWARE.
 *
 * Authors: Dave Airlie
 *          Alex Deucher
 *          Jerome Glisse
 */
#include <linux/seq_file.h>
#include <linux/slab.h>
#include <drm/drmP.h>
#include "radeon.h"
#include "radeon_asic.h"
#include "rs400d.h"

/* This files gather functions specifics to : rs400,rs480 */
static int rs400_debugfs_pcie_gart_info_init(struct radeon_device *rdev);

void rs400_gart_adjust_size(struct radeon_device *rdev)
{
	/* Check gart size */
	switch (rdev->mc.gtt_size/(1024*1024)) {
	case 32:
	case 64:
	case 128:
	case 256:
	case 512:
	case 1024:
	case 2048:
		break;
	default:
		DRM_ERROR("Unable to use IGP GART size %uM\n",
			  (unsigned)(rdev->mc.gtt_size >> 20));
		DRM_ERROR("Valid GART size for IGP are 32M,64M,128M,256M,512M,1G,2G\n");
		DRM_ERROR("Forcing to 32M GART size\n");
		rdev->mc.gtt_size = 32 * 1024 * 1024;
		return;
	}
}

void rs400_gart_tlb_flush(struct radeon_device *rdev)
{
	uint32_t tmp;
	unsigned int timeout = rdev->usec_timeout;

	WREG32_MC(RS480_GART_CACHE_CNTRL, RS480_GART_CACHE_INVALIDATE);
	do {
		tmp = RREG32_MC(RS480_GART_CACHE_CNTRL);
		if ((tmp & RS480_GART_CACHE_INVALIDATE) == 0)
			break;
		DRM_UDELAY(1);
		timeout--;
	} while (timeout > 0);
	WREG32_MC(RS480_GART_CACHE_CNTRL, 0);
}

int rs400_gart_init(struct radeon_device *rdev)
{
	int r;

	if (rdev->gart.ptr) {
		WARN(1, "RS400 GART already initialized\n");
		return 0;
	}
	/* Check gart size */
	switch(rdev->mc.gtt_size / (1024 * 1024)) {
	case 32:
	case 64:
	case 128:
	case 256:
	case 512:
	case 1024:
	case 2048:
		break;
	default:
		return -EINVAL;
	}
	/* Initialize common gart structure */
	r = radeon_gart_init(rdev);
	if (r)
		return r;
	if (rs400_debugfs_pcie_gart_info_init(rdev))
		DRM_ERROR("Failed to register debugfs file for RS400 GART !\n");
	rdev->gart.table_size = rdev->gart.num_gpu_pages * 4;
	return radeon_gart_table_ram_alloc(rdev);
}

int rs400_gart_enable(struct radeon_device *rdev)
{
	uint32_t size_reg;
	uint32_t tmp;

	tmp = RREG32_MC(RS690_AIC_CTRL_SCRATCH);
	tmp |= RS690_DIS_OUT_OF_PCI_GART_ACCESS;
	WREG32_MC(RS690_AIC_CTRL_SCRATCH, tmp);
	/* Check gart size */
	switch(rdev->mc.gtt_size / (1024 * 1024)) {
	case 32:
		size_reg = RS480_VA_SIZE_32MB;
		break;
	case 64:
		size_reg = RS480_VA_SIZE_64MB;
		break;
	case 128:
		size_reg = RS480_VA_SIZE_128MB;
		break;
	case 256:
		size_reg = RS480_VA_SIZE_256MB;
		break;
	case 512:
		size_reg = RS480_VA_SIZE_512MB;
		break;
	case 1024:
		size_reg = RS480_VA_SIZE_1GB;
		break;
	case 2048:
		size_reg = RS480_VA_SIZE_2GB;
		break;
	default:
		return -EINVAL;
	}
	/* It should be fine to program it to max value */
	if (rdev->family == CHIP_RS690 || (rdev->family == CHIP_RS740)) {
		WREG32_MC(RS690_MCCFG_AGP_BASE, 0xFFFFFFFF);
		WREG32_MC(RS690_MCCFG_AGP_BASE_2, 0);
	} else {
		WREG32(RADEON_AGP_BASE, 0xFFFFFFFF);
		WREG32(RS480_AGP_BASE_2, 0);
	}
	tmp = REG_SET(RS690_MC_AGP_TOP, rdev->mc.gtt_end >> 16);
	tmp |= REG_SET(RS690_MC_AGP_START, rdev->mc.gtt_start >> 16);
	if ((rdev->family == CHIP_RS690) || (rdev->family == CHIP_RS740)) {
		WREG32_MC(RS690_MCCFG_AGP_LOCATION, tmp);
		tmp = RREG32(RADEON_BUS_CNTL) & ~RS600_BUS_MASTER_DIS;
		WREG32(RADEON_BUS_CNTL, tmp);
	} else {
		WREG32(RADEON_MC_AGP_LOCATION, tmp);
		tmp = RREG32(RADEON_BUS_CNTL) & ~RADEON_BUS_MASTER_DIS;
		WREG32(RADEON_BUS_CNTL, tmp);
	}
	/* Table should be in 32bits address space so ignore bits above. */
	tmp = (u32)rdev->gart.table_addr & 0xfffff000;
	tmp |= (upper_32_bits(rdev->gart.table_addr) & 0xff) << 4;

	WREG32_MC(RS480_GART_BASE, tmp);
	/* TODO: more tweaking here */
	WREG32_MC(RS480_GART_FEATURE_ID,
		  (RS480_TLB_ENABLE |
		   RS480_GTW_LAC_EN | RS480_1LEVEL_GART));
	/* Disable snooping */
	WREG32_MC(RS480_AGP_MODE_CNTL,
		  (1 << RS480_REQ_TYPE_SNOOP_SHIFT) | RS480_REQ_TYPE_SNOOP_DIS);
	/* Disable AGP mode */
	/* FIXME: according to doc we should set HIDE_MMCFG_BAR=0,
	 * AGPMODE30=0 & AGP30ENHANCED=0 in NB_CNTL */
	if ((rdev->family == CHIP_RS690) || (rdev->family == CHIP_RS740)) {
		tmp = RREG32_MC(RS480_MC_MISC_CNTL);
		tmp |= RS480_GART_INDEX_REG_EN | RS690_BLOCK_GFX_D3_EN;
		WREG32_MC(RS480_MC_MISC_CNTL, tmp);
	} else {
		tmp = RREG32_MC(RS480_MC_MISC_CNTL);
		tmp |= RS480_GART_INDEX_REG_EN;
		WREG32_MC(RS480_MC_MISC_CNTL, tmp);
	}
	/* Enable gart */
	WREG32_MC(RS480_AGP_ADDRESS_SPACE_SIZE, (RS480_GART_EN | size_reg));
	rs400_gart_tlb_flush(rdev);
	DRM_INFO("PCIE GART of %uM enabled (table at 0x%016llX).\n",
		 (unsigned)(rdev->mc.gtt_size >> 20),
		 (unsigned long long)rdev->gart.table_addr);
	rdev->gart.ready = true;
	return 0;
}

void rs400_gart_disable(struct radeon_device *rdev)
{
	uint32_t tmp;

	tmp = RREG32_MC(RS690_AIC_CTRL_SCRATCH);
	tmp |= RS690_DIS_OUT_OF_PCI_GART_ACCESS;
	WREG32_MC(RS690_AIC_CTRL_SCRATCH, tmp);
	WREG32_MC(RS480_AGP_ADDRESS_SPACE_SIZE, 0);
}

void rs400_gart_fini(struct radeon_device *rdev)
{
	radeon_gart_fini(rdev);
	rs400_gart_disable(rdev);
	radeon_gart_table_ram_free(rdev);
}

#define RS400_PTE_WRITEABLE (1 << 2)
#define RS400_PTE_READABLE  (1 << 3)

void rs400_gart_set_page(struct radeon_device *rdev, unsigned i, uint64_t addr)
{
	uint32_t entry;
	u32 *gtt = rdev->gart.ptr;

	entry = (lower_32_bits(addr) & PAGE_MASK) |
		((upper_32_bits(addr) & 0xff) << 4) |
		RS400_PTE_WRITEABLE | RS400_PTE_READABLE;
	entry = cpu_to_le32(entry);
	gtt[i] = entry;
}

int rs400_mc_wait_for_idle(struct radeon_device *rdev)
{
	unsigned i;
	uint32_t tmp;

	for (i = 0; i < rdev->usec_timeout; i++) {
		/* read MC_STATUS */
		tmp = RREG32(RADEON_MC_STATUS);
		if (tmp & RADEON_MC_IDLE) {
			return 0;
		}
		DRM_UDELAY(1);
	}
	return -1;
}

static void rs400_gpu_init(struct radeon_device *rdev)
{
	/* FIXME: is this correct ? */
	r420_pipes_init(rdev);
	if (rs400_mc_wait_for_idle(rdev)) {
		printk(KERN_WARNING "rs400: Failed to wait MC idle while "
		       "programming pipes. Bad things might happen. %08x\n", RREG32(RADEON_MC_STATUS));
	}
}

static void rs400_mc_init(struct radeon_device *rdev)
{
	u64 base;

	rs400_gart_adjust_size(rdev);
	rdev->mc.igp_sideport_enabled = radeon_combios_sideport_present(rdev);
	/* DDR for all card after R300 & IGP */
	rdev->mc.vram_is_ddr = true;
	rdev->mc.vram_width = 128;
	r100_vram_init_sizes(rdev);
	base = (RREG32(RADEON_NB_TOM) & 0xffff) << 16;
	radeon_vram_location(rdev, &rdev->mc, base);
	rdev->mc.gtt_base_align = rdev->mc.gtt_size - 1;
	radeon_gtt_location(rdev, &rdev->mc);
	radeon_update_bandwidth_info(rdev);
}

uint32_t rs400_mc_rreg(struct radeon_device *rdev, uint32_t reg)
{
	unsigned long flags;
	uint32_t r;

	spin_lock_irqsave(&rdev->mc_idx_lock, flags);
	WREG32(RS480_NB_MC_INDEX, reg & 0xff);
	r = RREG32(RS480_NB_MC_DATA);
	WREG32(RS480_NB_MC_INDEX, 0xff);
	spin_unlock_irqrestore(&rdev->mc_idx_lock, flags);
	return r;
}

void rs400_mc_wreg(struct radeon_device *rdev, uint32_t reg, uint32_t v)
{
	unsigned long flags;

	spin_lock_irqsave(&rdev->mc_idx_lock, flags);
	WREG32(RS480_NB_MC_INDEX, ((reg) & 0xff) | RS480_NB_MC_IND_WR_EN);
	WREG32(RS480_NB_MC_DATA, (v));
	WREG32(RS480_NB_MC_INDEX, 0xff);
	spin_unlock_irqrestore(&rdev->mc_idx_lock, flags);
}

#if defined(CONFIG_DEBUG_FS)
static int rs400_debugfs_gart_info(struct seq_file *m, void *data)
{
	struct drm_info_node *node = (struct drm_info_node *) m->private;
	struct drm_device *dev = node->minor->dev;
	struct radeon_device *rdev = dev->dev_private;
	uint32_t tmp;

	tmp = RREG32(RADEON_HOST_PATH_CNTL);
	seq_printf(m, "HOST_PATH_CNTL 0x%08x\n", tmp);
	tmp = RREG32(RADEON_BUS_CNTL);
	seq_printf(m, "BUS_CNTL 0x%08x\n", tmp);
	tmp = RREG32_MC(RS690_AIC_CTRL_SCRATCH);
	seq_printf(m, "AIC_CTRL_SCRATCH 0x%08x\n", tmp);
	if (rdev->family == CHIP_RS690 || (rdev->family == CHIP_RS740)) {
		tmp = RREG32_MC(RS690_MCCFG_AGP_BASE);
		seq_printf(m, "MCCFG_AGP_BASE 0x%08x\n", tmp);
		tmp = RREG32_MC(RS690_MCCFG_AGP_BASE_2);
		seq_printf(m, "MCCFG_AGP_BASE_2 0x%08x\n", tmp);
		tmp = RREG32_MC(RS690_MCCFG_AGP_LOCATION);
		seq_printf(m, "MCCFG_AGP_LOCATION 0x%08x\n", tmp);
		tmp = RREG32_MC(RS690_MCCFG_FB_LOCATION);
		seq_printf(m, "MCCFG_FB_LOCATION 0x%08x\n", tmp);
		tmp = RREG32(RS690_HDP_FB_LOCATION);
		seq_printf(m, "HDP_FB_LOCATION 0x%08x\n", tmp);
	} else {
		tmp = RREG32(RADEON_AGP_BASE);
		seq_printf(m, "AGP_BASE 0x%08x\n", tmp);
		tmp = RREG32(RS480_AGP_BASE_2);
		seq_printf(m, "AGP_BASE_2 0x%08x\n", tmp);
		tmp = RREG32(RADEON_MC_AGP_LOCATION);
		seq_printf(m, "MC_AGP_LOCATION 0x%08x\n", tmp);
	}
	tmp = RREG32_MC(RS480_GART_BASE);
	seq_printf(m, "GART_BASE 0x%08x\n", tmp);
	tmp = RREG32_MC(RS480_GART_FEATURE_ID);
	seq_printf(m, "GART_FEATURE_ID 0x%08x\n", tmp);
	tmp = RREG32_MC(RS480_AGP_MODE_CNTL);
	seq_printf(m, "AGP_MODE_CONTROL 0x%08x\n", tmp);
	tmp = RREG32_MC(RS480_MC_MISC_CNTL);
	seq_printf(m, "MC_MISC_CNTL 0x%08x\n", tmp);
	tmp = RREG32_MC(0x5F);
	seq_printf(m, "MC_MISC_UMA_CNTL 0x%08x\n", tmp);
	tmp = RREG32_MC(RS480_AGP_ADDRESS_SPACE_SIZE);
	seq_printf(m, "AGP_ADDRESS_SPACE_SIZE 0x%08x\n", tmp);
	tmp = RREG32_MC(RS480_GART_CACHE_CNTRL);
	seq_printf(m, "GART_CACHE_CNTRL 0x%08x\n", tmp);
	tmp = RREG32_MC(0x3B);
	seq_printf(m, "MC_GART_ERROR_ADDRESS 0x%08x\n", tmp);
	tmp = RREG32_MC(0x3C);
	seq_printf(m, "MC_GART_ERROR_ADDRESS_HI 0x%08x\n", tmp);
	tmp = RREG32_MC(0x30);
	seq_printf(m, "GART_ERROR_0 0x%08x\n", tmp);
	tmp = RREG32_MC(0x31);
	seq_printf(m, "GART_ERROR_1 0x%08x\n", tmp);
	tmp = RREG32_MC(0x32);
	seq_printf(m, "GART_ERROR_2 0x%08x\n", tmp);
	tmp = RREG32_MC(0x33);
	seq_printf(m, "GART_ERROR_3 0x%08x\n", tmp);
	tmp = RREG32_MC(0x34);
	seq_printf(m, "GART_ERROR_4 0x%08x\n", tmp);
	tmp = RREG32_MC(0x35);
	seq_printf(m, "GART_ERROR_5 0x%08x\n", tmp);
	tmp = RREG32_MC(0x36);
	seq_printf(m, "GART_ERROR_6 0x%08x\n", tmp);
	tmp = RREG32_MC(0x37);
	seq_printf(m, "GART_ERROR_7 0x%08x\n", tmp);
	return 0;
}

static struct drm_info_list rs400_gart_info_list[] = {
	{"rs400_gart_info", rs400_debugfs_gart_info, 0, NULL},
};
#endif

static int rs400_debugfs_pcie_gart_info_init(struct radeon_device *rdev)
{
#if defined(CONFIG_DEBUG_FS)
	return radeon_debugfs_add_files(rdev, rs400_gart_info_list, 1);
#else
	return 0;
#endif
}

static void rs400_mc_program(struct radeon_device *rdev)
{
	struct r100_mc_save save;

	/* Stops all mc clients */
	r100_mc_stop(rdev, &save);

	/* Wait for mc idle */
	if (rs400_mc_wait_for_idle(rdev))
		dev_warn(rdev->dev, "rs400: Wait MC idle timeout before updating MC.\n");
	WREG32(R_000148_MC_FB_LOCATION,
		S_000148_MC_FB_START(rdev->mc.vram_start >> 16) |
		S_000148_MC_FB_TOP(rdev->mc.vram_end >> 16));

	r100_mc_resume(rdev, &save);
}

static int rs400_startup(struct radeon_device *rdev)
{
	int r;

	r100_set_common_regs(rdev);

	rs400_mc_program(rdev);
	/* Resume clock */
	r300_clock_startup(rdev);
	/* Initialize GPU configuration (# pipes, ...) */
	rs400_gpu_init(rdev);
	r100_enable_bm(rdev);
	/* Initialize GART (initialize after TTM so we can allocate
	 * memory through TTM but finalize after TTM) */
	r = rs400_gart_enable(rdev);
	if (r)
		return r;

	/* allocate wb buffer */
	r = radeon_wb_init(rdev);
	if (r)
		return r;

	r = radeon_fence_driver_start_ring(rdev, RADEON_RING_TYPE_GFX_INDEX);
	if (r) {
		dev_err(rdev->dev, "failed initializing CP fences (%d).\n", r);
		return r;
	}

	/* Enable IRQ */
	if (!rdev->irq.installed) {
		r = radeon_irq_kms_init(rdev);
		if (r)
			return r;
	}

	r100_irq_set(rdev);
	rdev->config.r300.hdp_cntl = RREG32(RADEON_HOST_PATH_CNTL);
	/* 1M ring buffer */
	r = r100_cp_init(rdev, 1024 * 1024);
	if (r) {
		dev_err(rdev->dev, "failed initializing CP (%d).\n", r);
		return r;
	}

	r = radeon_ib_pool_init(rdev);
	if (r) {
		dev_err(rdev->dev, "IB initialization failed (%d).\n", r);
		return r;
	}

	return 0;
}

int rs400_resume(struct radeon_device *rdev)
{
	int r;

	/* Make sur GART are not working */
	rs400_gart_disable(rdev);
	/* Resume clock before doing reset */
	r300_clock_startup(rdev);
	/* setup MC before calling post tables */
	rs400_mc_program(rdev);
	/* Reset gpu before posting otherwise ATOM will enter infinite loop */
	if (radeon_asic_reset(rdev)) {
		dev_warn(rdev->dev, "GPU reset failed ! (0xE40=0x%08X, 0x7C0=0x%08X)\n",
			RREG32(R_000E40_RBBM_STATUS),
			RREG32(R_0007C0_CP_STAT));
	}
	/* post */
	radeon_combios_asic_init(rdev->ddev);
	/* Resume clock after posting */
	r300_clock_startup(rdev);
	/* Initialize surface registers */
	radeon_surface_init(rdev);

	rdev->accel_working = true;
	r = rs400_startup(rdev);
	if (r) {
		rdev->accel_working = false;
	}
	return r;
}

int rs400_suspend(struct radeon_device *rdev)
{
	radeon_pm_suspend(rdev);
	r100_cp_disable(rdev);
	radeon_wb_disable(rdev);
	r100_irq_disable(rdev);
	rs400_gart_disable(rdev);
	return 0;
}

void rs400_fini(struct radeon_device *rdev)
{
	radeon_pm_fini(rdev);
	r100_cp_fini(rdev);
	radeon_wb_fini(rdev);
	radeon_ib_pool_fini(rdev);
	radeon_gem_fini(rdev);
	rs400_gart_fini(rdev);
	radeon_irq_kms_fini(rdev);
	radeon_fence_driver_fini(rdev);
	radeon_bo_fini(rdev);
	radeon_atombios_fini(rdev);
	kfree(rdev->bios);
	rdev->bios = NULL;
}

int rs400_init(struct radeon_device *rdev)
{
	int r;

	/* Disable VGA */
	r100_vga_render_disable(rdev);
	/* Initialize scratch registers */
	radeon_scratch_init(rdev);
	/* Initialize surface registers */
	radeon_surface_init(rdev);
	/* TODO: disable VGA need to use VGA request */
	/* restore some register to sane defaults */
	r100_restore_sanity(rdev);
	/* BIOS*/
	if (!radeon_get_bios(rdev)) {
		if (ASIC_IS_AVIVO(rdev))
			return -EINVAL;
	}
	if (rdev->is_atom_bios) {
		dev_err(rdev->dev, "Expecting combios for RS400/RS480 GPU\n");
		return -EINVAL;
	} else {
		r = radeon_combios_init(rdev);
		if (r)
			return r;
	}
	/* Reset gpu before posting otherwise ATOM will enter infinite loop */
	if (radeon_asic_reset(rdev)) {
		dev_warn(rdev->dev,
			"GPU reset failed ! (0xE40=0x%08X, 0x7C0=0x%08X)\n",
			RREG32(R_000E40_RBBM_STATUS),
			RREG32(R_0007C0_CP_STAT));
	}
	/* check if cards are posted or not */
	if (radeon_boot_test_post_card(rdev) == false)
		return -EINVAL;

	/* Initialize clocks */
	radeon_get_clock_info(rdev->ddev);
	/* initialize memory controller */
	rs400_mc_init(rdev);
	/* Fence driver */
	r = radeon_fence_driver_init(rdev);
	if (r)
		return r;
	/* Memory manager */
	r = radeon_bo_init(rdev);
	if (r)
		return r;
	r = rs400_gart_init(rdev);
	if (r)
		return r;
	r300_set_reg_safe(rdev);

	/* Initialize power management */
	radeon_pm_init(rdev);

	rdev->accel_working = true;
	r = rs400_startup(rdev);
	if (r) {
		/* Somethings want wront with the accel init stop accel */
		dev_err(rdev->dev, "Disabling GPU acceleration\n");
		r100_cp_fini(rdev);
		radeon_wb_fini(rdev);
		radeon_ib_pool_fini(rdev);
		rs400_gart_fini(rdev);
		radeon_irq_kms_fini(rdev);
		rdev->accel_working = false;
	}
	return 0;
}
Commit	Line	Data
771fe6b9 JG	1	/*
	2	* Copyright 2008 Advanced Micro Devices, Inc.
	3	* Copyright 2008 Red Hat Inc.
	4	* Copyright 2009 Jerome Glisse.
	5	*
	6	* Permission is hereby granted, free of charge, to any person obtaining a
	7	* copy of this software and associated documentation files (the "Software"),
	8	* to deal in the Software without restriction, including without limitation
	9	* the rights to use, copy, modify, merge, publish, distribute, sublicense,
	10	* and/or sell copies of the Software, and to permit persons to whom the
	11	* Software is furnished to do so, subject to the following conditions:
	12	*
	13	* The above copyright notice and this permission notice shall be included in
	14	* all copies or substantial portions of the Software.
	15	*
	16	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	17	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	18	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
	19	* THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
	20	* OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
	21	* ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
	22	* OTHER DEALINGS IN THE SOFTWARE.
	23	*
	24	* Authors: Dave Airlie
	25	* Alex Deucher
	26	* Jerome Glisse
	27	*/
	28	#include <linux/seq_file.h>
5a0e3ad6	29	#include <linux/slab.h>
771fe6b9	30	#include <drm/drmP.h>
771fe6b9	31	#include "radeon.h"
e6990375	32	#include "radeon_asic.h"
ca6ffc64	33	#include "rs400d.h"
771fe6b9	34
ca6ffc64 JG	35	/* This files gather functions specifics to : rs400,rs480 */
ca6ffc64 JG	36	static int rs400_debugfs_pcie_gart_info_init(struct radeon_device *rdev);
771fe6b9	37
771fe6b9 JG	38	void rs400_gart_adjust_size(struct radeon_device *rdev)
	39	{
	40	/* Check gart size */
	41	switch (rdev->mc.gtt_size/(1024*1024)) {
	42	case 32:
	43	case 64:
	44	case 128:
	45	case 256:
	46	case 512:
	47	case 1024:
	48	case 2048:
	49	break;
	50	default:
	51	DRM_ERROR("Unable to use IGP GART size %uM\n",
3ce0a23d	52	(unsigned)(rdev->mc.gtt_size >> 20));
771fe6b9 JG	53	DRM_ERROR("Valid GART size for IGP are 32M,64M,128M,256M,512M,1G,2G\n");
	54	DRM_ERROR("Forcing to 32M GART size\n");
	55	rdev->mc.gtt_size = 32 * 1024 * 1024;
	56	return;
	57	}
771fe6b9 JG	58	}
	59
	60	void rs400_gart_tlb_flush(struct radeon_device *rdev)
	61	{
	62	uint32_t tmp;
	63	unsigned int timeout = rdev->usec_timeout;
	64
	65	WREG32_MC(RS480_GART_CACHE_CNTRL, RS480_GART_CACHE_INVALIDATE);
	66	do {
	67	tmp = RREG32_MC(RS480_GART_CACHE_CNTRL);
	68	if ((tmp & RS480_GART_CACHE_INVALIDATE) == 0)
	69	break;
	70	DRM_UDELAY(1);
	71	timeout--;
	72	} while (timeout > 0);
	73	WREG32_MC(RS480_GART_CACHE_CNTRL, 0);
	74	}
	75
4aac0473	76	int rs400_gart_init(struct radeon_device *rdev)
771fe6b9	77	{
771fe6b9 JG	78	int r;
771fe6b9 JG	79
c9a1be96	80	if (rdev->gart.ptr) {
fce7d61b	81	WARN(1, "RS400 GART already initialized\n");
4aac0473 JG	82	return 0;
	83	}
	84	/* Check gart size */
	85	switch(rdev->mc.gtt_size / (1024 * 1024)) {
	86	case 32:
	87	case 64:
	88	case 128:
	89	case 256:
	90	case 512:
	91	case 1024:
	92	case 2048:
	93	break;
	94	default:
	95	return -EINVAL;
	96	}
771fe6b9 JG	97	/* Initialize common gart structure */
771fe6b9 JG	98	r = radeon_gart_init(rdev);
4aac0473	99	if (r)
771fe6b9	100	return r;
4aac0473	101	if (rs400_debugfs_pcie_gart_info_init(rdev))
771fe6b9	102	DRM_ERROR("Failed to register debugfs file for RS400 GART !\n");
4aac0473 JG	103	rdev->gart.table_size = rdev->gart.num_gpu_pages * 4;
	104	return radeon_gart_table_ram_alloc(rdev);
	105	}
	106
	107	int rs400_gart_enable(struct radeon_device *rdev)
	108	{
	109	uint32_t size_reg;
	110	uint32_t tmp;
771fe6b9 JG	111
	112	tmp = RREG32_MC(RS690_AIC_CTRL_SCRATCH);
	113	tmp \|= RS690_DIS_OUT_OF_PCI_GART_ACCESS;
	114	WREG32_MC(RS690_AIC_CTRL_SCRATCH, tmp);
	115	/* Check gart size */
	116	switch(rdev->mc.gtt_size / (1024 * 1024)) {
	117	case 32:
	118	size_reg = RS480_VA_SIZE_32MB;
	119	break;
	120	case 64:
	121	size_reg = RS480_VA_SIZE_64MB;
	122	break;
	123	case 128:
	124	size_reg = RS480_VA_SIZE_128MB;
	125	break;
	126	case 256:
	127	size_reg = RS480_VA_SIZE_256MB;
	128	break;
	129	case 512:
	130	size_reg = RS480_VA_SIZE_512MB;
	131	break;
	132	case 1024:
	133	size_reg = RS480_VA_SIZE_1GB;
	134	break;
	135	case 2048:
	136	size_reg = RS480_VA_SIZE_2GB;
	137	break;
	138	default:
	139	return -EINVAL;
	140	}
771fe6b9 JG	141	/* It should be fine to program it to max value */
	142	if (rdev->family == CHIP_RS690 \|\| (rdev->family == CHIP_RS740)) {
	143	WREG32_MC(RS690_MCCFG_AGP_BASE, 0xFFFFFFFF);
	144	WREG32_MC(RS690_MCCFG_AGP_BASE_2, 0);
	145	} else {
	146	WREG32(RADEON_AGP_BASE, 0xFFFFFFFF);
	147	WREG32(RS480_AGP_BASE_2, 0);
	148	}
d594e46a JG	149	tmp = REG_SET(RS690_MC_AGP_TOP, rdev->mc.gtt_end >> 16);
d594e46a JG	150	tmp \|= REG_SET(RS690_MC_AGP_START, rdev->mc.gtt_start >> 16);
771fe6b9 JG	151	if ((rdev->family == CHIP_RS690) \|\| (rdev->family == CHIP_RS740)) {
	152	WREG32_MC(RS690_MCCFG_AGP_LOCATION, tmp);
	153	tmp = RREG32(RADEON_BUS_CNTL) & ~RS600_BUS_MASTER_DIS;
	154	WREG32(RADEON_BUS_CNTL, tmp);
	155	} else {
	156	WREG32(RADEON_MC_AGP_LOCATION, tmp);
	157	tmp = RREG32(RADEON_BUS_CNTL) & ~RADEON_BUS_MASTER_DIS;
	158	WREG32(RADEON_BUS_CNTL, tmp);
	159	}
	160	/* Table should be in 32bits address space so ignore bits above. */
ed10f95d DA	161	tmp = (u32)rdev->gart.table_addr & 0xfffff000;
	162	tmp \|= (upper_32_bits(rdev->gart.table_addr) & 0xff) << 4;
	163
771fe6b9 JG	164	WREG32_MC(RS480_GART_BASE, tmp);
	165	/* TODO: more tweaking here */
	166	WREG32_MC(RS480_GART_FEATURE_ID,
	167	(RS480_TLB_ENABLE \|
	168	RS480_GTW_LAC_EN \| RS480_1LEVEL_GART));
	169	/* Disable snooping */
	170	WREG32_MC(RS480_AGP_MODE_CNTL,
	171	(1 << RS480_REQ_TYPE_SNOOP_SHIFT) \| RS480_REQ_TYPE_SNOOP_DIS);
	172	/* Disable AGP mode */
	173	/* FIXME: according to doc we should set HIDE_MMCFG_BAR=0,
	174	* AGPMODE30=0 & AGP30ENHANCED=0 in NB_CNTL */
	175	if ((rdev->family == CHIP_RS690) \|\| (rdev->family == CHIP_RS740)) {
acf88deb AD	176	tmp = RREG32_MC(RS480_MC_MISC_CNTL);
	177	tmp \|= RS480_GART_INDEX_REG_EN \| RS690_BLOCK_GFX_D3_EN;
	178	WREG32_MC(RS480_MC_MISC_CNTL, tmp);
771fe6b9	179	} else {
acf88deb AD	180	tmp = RREG32_MC(RS480_MC_MISC_CNTL);
	181	tmp \|= RS480_GART_INDEX_REG_EN;
	182	WREG32_MC(RS480_MC_MISC_CNTL, tmp);
771fe6b9 JG	183	}
	184	/* Enable gart */
	185	WREG32_MC(RS480_AGP_ADDRESS_SPACE_SIZE, (RS480_GART_EN \| size_reg));
	186	rs400_gart_tlb_flush(rdev);
fcf4de5a TV	187	DRM_INFO("PCIE GART of %uM enabled (table at 0x%016llX).\n",
	188	(unsigned)(rdev->mc.gtt_size >> 20),
	189	(unsigned long long)rdev->gart.table_addr);
771fe6b9 JG	190	rdev->gart.ready = true;
	191	return 0;
	192	}
	193
	194	void rs400_gart_disable(struct radeon_device *rdev)
	195	{
	196	uint32_t tmp;
	197
	198	tmp = RREG32_MC(RS690_AIC_CTRL_SCRATCH);
	199	tmp \|= RS690_DIS_OUT_OF_PCI_GART_ACCESS;
	200	WREG32_MC(RS690_AIC_CTRL_SCRATCH, tmp);
	201	WREG32_MC(RS480_AGP_ADDRESS_SPACE_SIZE, 0);
	202	}
	203
4aac0473 JG	204	void rs400_gart_fini(struct radeon_device *rdev)
4aac0473 JG	205	{
f9274562	206	radeon_gart_fini(rdev);
4aac0473 JG	207	rs400_gart_disable(rdev);
4aac0473 JG	208	radeon_gart_table_ram_free(rdev);
4aac0473 JG	209	}
4aac0473 JG	210
d75ee3be AD	211	#define RS400_PTE_WRITEABLE (1 << 2)
	212	#define RS400_PTE_READABLE (1 << 3)
	213
7f90fc96	214	void rs400_gart_set_page(struct radeon_device *rdev, unsigned i, uint64_t addr)
771fe6b9	215	{
ed10f95d	216	uint32_t entry;
c9a1be96	217	u32 *gtt = rdev->gart.ptr;
ed10f95d	218
ed10f95d DA	219	entry = (lower_32_bits(addr) & PAGE_MASK) \|
ed10f95d DA	220	((upper_32_bits(addr) & 0xff) << 4) \|
d75ee3be	221	RS400_PTE_WRITEABLE \| RS400_PTE_READABLE;
ed10f95d	222	entry = cpu_to_le32(entry);
c9a1be96	223	gtt[i] = entry;
771fe6b9 JG	224	}
771fe6b9 JG	225
a17538f9 DA	226	int rs400_mc_wait_for_idle(struct radeon_device *rdev)
	227	{
	228	unsigned i;
	229	uint32_t tmp;
	230
	231	for (i = 0; i < rdev->usec_timeout; i++) {
	232	/* read MC_STATUS */
d75ee3be AD	233	tmp = RREG32(RADEON_MC_STATUS);
d75ee3be AD	234	if (tmp & RADEON_MC_IDLE) {
a17538f9 DA	235	return 0;
	236	}
	237	DRM_UDELAY(1);
	238	}
	239	return -1;
	240	}
	241
1109ca09	242	static void rs400_gpu_init(struct radeon_device *rdev)
771fe6b9	243	{
771fe6b9 JG	244	/* FIXME: is this correct ? */
771fe6b9 JG	245	r420_pipes_init(rdev);
a17538f9 DA	246	if (rs400_mc_wait_for_idle(rdev)) {
a17538f9 DA	247	printk(KERN_WARNING "rs400: Failed to wait MC idle while "
d75ee3be	248	"programming pipes. Bad things might happen. %08x\n", RREG32(RADEON_MC_STATUS));
771fe6b9 JG	249	}
	250	}
	251
1109ca09	252	static void rs400_mc_init(struct radeon_device *rdev)
771fe6b9	253	{
d594e46a JG	254	u64 base;
d594e46a JG	255
771fe6b9	256	rs400_gart_adjust_size(rdev);
d594e46a	257	rdev->mc.igp_sideport_enabled = radeon_combios_sideport_present(rdev);
771fe6b9 JG	258	/* DDR for all card after R300 & IGP */
	259	rdev->mc.vram_is_ddr = true;
	260	rdev->mc.vram_width = 128;
2a0f8918	261	r100_vram_init_sizes(rdev);
d594e46a JG	262	base = (RREG32(RADEON_NB_TOM) & 0xffff) << 16;
d594e46a JG	263	radeon_vram_location(rdev, &rdev->mc, base);
8d369bb1	264	rdev->mc.gtt_base_align = rdev->mc.gtt_size - 1;
d594e46a	265	radeon_gtt_location(rdev, &rdev->mc);
b2f8ccd8	266	radeon_update_bandwidth_info(rdev);
771fe6b9 JG	267	}
771fe6b9 JG	268
771fe6b9 JG	269	uint32_t rs400_mc_rreg(struct radeon_device *rdev, uint32_t reg)
771fe6b9 JG	270	{
0a5b7b0b	271	unsigned long flags;
771fe6b9 JG	272	uint32_t r;
771fe6b9 JG	273
0a5b7b0b	274	spin_lock_irqsave(&rdev->mc_idx_lock, flags);
771fe6b9 JG	275	WREG32(RS480_NB_MC_INDEX, reg & 0xff);
	276	r = RREG32(RS480_NB_MC_DATA);
	277	WREG32(RS480_NB_MC_INDEX, 0xff);
0a5b7b0b	278	spin_unlock_irqrestore(&rdev->mc_idx_lock, flags);
771fe6b9 JG	279	return r;
	280	}
	281
	282	void rs400_mc_wreg(struct radeon_device *rdev, uint32_t reg, uint32_t v)
	283	{
0a5b7b0b AD	284	unsigned long flags;
	285
	286	spin_lock_irqsave(&rdev->mc_idx_lock, flags);
771fe6b9 JG	287	WREG32(RS480_NB_MC_INDEX, ((reg) & 0xff) \| RS480_NB_MC_IND_WR_EN);
	288	WREG32(RS480_NB_MC_DATA, (v));
	289	WREG32(RS480_NB_MC_INDEX, 0xff);
0a5b7b0b	290	spin_unlock_irqrestore(&rdev->mc_idx_lock, flags);
771fe6b9 JG	291	}
771fe6b9 JG	292
771fe6b9 JG	293	#if defined(CONFIG_DEBUG_FS)
	294	static int rs400_debugfs_gart_info(struct seq_file m, void data)
	295	{
	296	struct drm_info_node node = (struct drm_info_node ) m->private;
	297	struct drm_device *dev = node->minor->dev;
	298	struct radeon_device *rdev = dev->dev_private;
	299	uint32_t tmp;
	300
	301	tmp = RREG32(RADEON_HOST_PATH_CNTL);
	302	seq_printf(m, "HOST_PATH_CNTL 0x%08x\n", tmp);
	303	tmp = RREG32(RADEON_BUS_CNTL);
	304	seq_printf(m, "BUS_CNTL 0x%08x\n", tmp);
	305	tmp = RREG32_MC(RS690_AIC_CTRL_SCRATCH);
	306	seq_printf(m, "AIC_CTRL_SCRATCH 0x%08x\n", tmp);
	307	if (rdev->family == CHIP_RS690 \|\| (rdev->family == CHIP_RS740)) {
	308	tmp = RREG32_MC(RS690_MCCFG_AGP_BASE);
	309	seq_printf(m, "MCCFG_AGP_BASE 0x%08x\n", tmp);
	310	tmp = RREG32_MC(RS690_MCCFG_AGP_BASE_2);
	311	seq_printf(m, "MCCFG_AGP_BASE_2 0x%08x\n", tmp);
	312	tmp = RREG32_MC(RS690_MCCFG_AGP_LOCATION);
	313	seq_printf(m, "MCCFG_AGP_LOCATION 0x%08x\n", tmp);
d75ee3be	314	tmp = RREG32_MC(RS690_MCCFG_FB_LOCATION);
771fe6b9	315	seq_printf(m, "MCCFG_FB_LOCATION 0x%08x\n", tmp);
d75ee3be	316	tmp = RREG32(RS690_HDP_FB_LOCATION);
771fe6b9 JG	317	seq_printf(m, "HDP_FB_LOCATION 0x%08x\n", tmp);
	318	} else {
	319	tmp = RREG32(RADEON_AGP_BASE);
	320	seq_printf(m, "AGP_BASE 0x%08x\n", tmp);
	321	tmp = RREG32(RS480_AGP_BASE_2);
	322	seq_printf(m, "AGP_BASE_2 0x%08x\n", tmp);
	323	tmp = RREG32(RADEON_MC_AGP_LOCATION);
	324	seq_printf(m, "MC_AGP_LOCATION 0x%08x\n", tmp);
	325	}
	326	tmp = RREG32_MC(RS480_GART_BASE);
	327	seq_printf(m, "GART_BASE 0x%08x\n", tmp);
	328	tmp = RREG32_MC(RS480_GART_FEATURE_ID);
	329	seq_printf(m, "GART_FEATURE_ID 0x%08x\n", tmp);
	330	tmp = RREG32_MC(RS480_AGP_MODE_CNTL);
	331	seq_printf(m, "AGP_MODE_CONTROL 0x%08x\n", tmp);
	332	tmp = RREG32_MC(RS480_MC_MISC_CNTL);
	333	seq_printf(m, "MC_MISC_CNTL 0x%08x\n", tmp);
	334	tmp = RREG32_MC(0x5F);
	335	seq_printf(m, "MC_MISC_UMA_CNTL 0x%08x\n", tmp);
	336	tmp = RREG32_MC(RS480_AGP_ADDRESS_SPACE_SIZE);
	337	seq_printf(m, "AGP_ADDRESS_SPACE_SIZE 0x%08x\n", tmp);
	338	tmp = RREG32_MC(RS480_GART_CACHE_CNTRL);
	339	seq_printf(m, "GART_CACHE_CNTRL 0x%08x\n", tmp);
	340	tmp = RREG32_MC(0x3B);
	341	seq_printf(m, "MC_GART_ERROR_ADDRESS 0x%08x\n", tmp);
	342	tmp = RREG32_MC(0x3C);
	343	seq_printf(m, "MC_GART_ERROR_ADDRESS_HI 0x%08x\n", tmp);
	344	tmp = RREG32_MC(0x30);
	345	seq_printf(m, "GART_ERROR_0 0x%08x\n", tmp);
	346	tmp = RREG32_MC(0x31);
	347	seq_printf(m, "GART_ERROR_1 0x%08x\n", tmp);
	348	tmp = RREG32_MC(0x32);
	349	seq_printf(m, "GART_ERROR_2 0x%08x\n", tmp);
	350	tmp = RREG32_MC(0x33);
	351	seq_printf(m, "GART_ERROR_3 0x%08x\n", tmp);
	352	tmp = RREG32_MC(0x34);
	353	seq_printf(m, "GART_ERROR_4 0x%08x\n", tmp);
	354	tmp = RREG32_MC(0x35);
	355	seq_printf(m, "GART_ERROR_5 0x%08x\n", tmp);
	356	tmp = RREG32_MC(0x36);
	357	seq_printf(m, "GART_ERROR_6 0x%08x\n", tmp);
	358	tmp = RREG32_MC(0x37);
	359	seq_printf(m, "GART_ERROR_7 0x%08x\n", tmp);
	360	return 0;
	361	}
	362
	363	static struct drm_info_list rs400_gart_info_list[] = {
	364	{"rs400_gart_info", rs400_debugfs_gart_info, 0, NULL},
	365	};
	366	#endif
	367
ca6ffc64	368	static int rs400_debugfs_pcie_gart_info_init(struct radeon_device *rdev)
771fe6b9 JG	369	{
	370	#if defined(CONFIG_DEBUG_FS)
	371	return radeon_debugfs_add_files(rdev, rs400_gart_info_list, 1);
	372	#else
	373	return 0;
	374	#endif
	375	}
ca6ffc64	376
1109ca09	377	static void rs400_mc_program(struct radeon_device *rdev)
ca6ffc64 JG	378	{
	379	struct r100_mc_save save;
	380
	381	/* Stops all mc clients */
	382	r100_mc_stop(rdev, &save);
	383
	384	/* Wait for mc idle */
a17538f9 DA	385	if (rs400_mc_wait_for_idle(rdev))
a17538f9 DA	386	dev_warn(rdev->dev, "rs400: Wait MC idle timeout before updating MC.\n");
ca6ffc64 JG	387	WREG32(R_000148_MC_FB_LOCATION,
	388	S_000148_MC_FB_START(rdev->mc.vram_start >> 16) \|
	389	S_000148_MC_FB_TOP(rdev->mc.vram_end >> 16));
	390
	391	r100_mc_resume(rdev, &save);
	392	}
	393
	394	static int rs400_startup(struct radeon_device *rdev)
	395	{
	396	int r;
	397
08a370fa DA	398	r100_set_common_regs(rdev);
08a370fa DA	399
ca6ffc64 JG	400	rs400_mc_program(rdev);
	401	/* Resume clock */
	402	r300_clock_startup(rdev);
	403	/* Initialize GPU configuration (# pipes, ...) */
	404	rs400_gpu_init(rdev);
17e15b0c	405	r100_enable_bm(rdev);
ca6ffc64 JG	406	/* Initialize GART (initialize after TTM so we can allocate
	407	* memory through TTM but finalize after TTM) */
	408	r = rs400_gart_enable(rdev);
	409	if (r)
	410	return r;
724c80e1 AD	411
	412	/* allocate wb buffer */
	413	r = radeon_wb_init(rdev);
	414	if (r)
	415	return r;
	416
30eb77f4 JG	417	r = radeon_fence_driver_start_ring(rdev, RADEON_RING_TYPE_GFX_INDEX);
	418	if (r) {
	419	dev_err(rdev->dev, "failed initializing CP fences (%d).\n", r);
	420	return r;
	421	}
	422
ca6ffc64	423	/* Enable IRQ */
e49f3959 AH	424	if (!rdev->irq.installed) {
	425	r = radeon_irq_kms_init(rdev);
	426	if (r)
	427	return r;
	428	}
	429
ca6ffc64	430	r100_irq_set(rdev);
cafe6609	431	rdev->config.r300.hdp_cntl = RREG32(RADEON_HOST_PATH_CNTL);
ca6ffc64 JG	432	/* 1M ring buffer */
	433	r = r100_cp_init(rdev, 1024 * 1024);
	434	if (r) {
ec4f2ac4	435	dev_err(rdev->dev, "failed initializing CP (%d).\n", r);
ca6ffc64 JG	436	return r;
ca6ffc64 JG	437	}
b15ba512	438
2898c348 CK	439	r = radeon_ib_pool_init(rdev);
	440	if (r) {
	441	dev_err(rdev->dev, "IB initialization failed (%d).\n", r);
b15ba512	442	return r;
2898c348	443	}
b15ba512	444
ca6ffc64 JG	445	return 0;
	446	}
	447
	448	int rs400_resume(struct radeon_device *rdev)
	449	{
6b7746e8 JG	450	int r;
6b7746e8 JG	451
ca6ffc64 JG	452	/* Make sur GART are not working */
	453	rs400_gart_disable(rdev);
	454	/* Resume clock before doing reset */
	455	r300_clock_startup(rdev);
ea1495a6 DA	456	/* setup MC before calling post tables */
ea1495a6 DA	457	rs400_mc_program(rdev);
ca6ffc64	458	/* Reset gpu before posting otherwise ATOM will enter infinite loop */
a2d07b74	459	if (radeon_asic_reset(rdev)) {
ca6ffc64 JG	460	dev_warn(rdev->dev, "GPU reset failed ! (0xE40=0x%08X, 0x7C0=0x%08X)\n",
	461	RREG32(R_000E40_RBBM_STATUS),
	462	RREG32(R_0007C0_CP_STAT));
	463	}
	464	/* post */
	465	radeon_combios_asic_init(rdev->ddev);
	466	/* Resume clock after posting */
	467	r300_clock_startup(rdev);
550e2d92 DA	468	/* Initialize surface registers */
550e2d92 DA	469	radeon_surface_init(rdev);
b15ba512 JG	470
b15ba512 JG	471	rdev->accel_working = true;
6b7746e8 JG	472	r = rs400_startup(rdev);
	473	if (r) {
	474	rdev->accel_working = false;
	475	}
	476	return r;
ca6ffc64 JG	477	}
	478
	479	int rs400_suspend(struct radeon_device *rdev)
	480	{
6c7bccea	481	radeon_pm_suspend(rdev);
ca6ffc64	482	r100_cp_disable(rdev);
724c80e1	483	radeon_wb_disable(rdev);
ca6ffc64 JG	484	r100_irq_disable(rdev);
	485	rs400_gart_disable(rdev);
	486	return 0;
	487	}
	488
	489	void rs400_fini(struct radeon_device *rdev)
	490	{
6c7bccea	491	radeon_pm_fini(rdev);
ca6ffc64	492	r100_cp_fini(rdev);
724c80e1	493	radeon_wb_fini(rdev);
2898c348	494	radeon_ib_pool_fini(rdev);
ca6ffc64 JG	495	radeon_gem_fini(rdev);
	496	rs400_gart_fini(rdev);
	497	radeon_irq_kms_fini(rdev);
	498	radeon_fence_driver_fini(rdev);
4c788679	499	radeon_bo_fini(rdev);
ca6ffc64 JG	500	radeon_atombios_fini(rdev);
	501	kfree(rdev->bios);
	502	rdev->bios = NULL;
	503	}
	504
	505	int rs400_init(struct radeon_device *rdev)
	506	{
	507	int r;
	508
ca6ffc64 JG	509	/* Disable VGA */
	510	r100_vga_render_disable(rdev);
	511	/* Initialize scratch registers */
	512	radeon_scratch_init(rdev);
	513	/* Initialize surface registers */
	514	radeon_surface_init(rdev);
	515	/* TODO: disable VGA need to use VGA request */
4c712e6c DA	516	/* restore some register to sane defaults */
4c712e6c DA	517	r100_restore_sanity(rdev);
ca6ffc64 JG	518	/* BIOS*/
	519	if (!radeon_get_bios(rdev)) {
	520	if (ASIC_IS_AVIVO(rdev))
	521	return -EINVAL;
	522	}
	523	if (rdev->is_atom_bios) {
	524	dev_err(rdev->dev, "Expecting combios for RS400/RS480 GPU\n");
	525	return -EINVAL;
	526	} else {
	527	r = radeon_combios_init(rdev);
	528	if (r)
	529	return r;
	530	}
	531	/* Reset gpu before posting otherwise ATOM will enter infinite loop */
a2d07b74	532	if (radeon_asic_reset(rdev)) {
ca6ffc64 JG	533	dev_warn(rdev->dev,
	534	"GPU reset failed ! (0xE40=0x%08X, 0x7C0=0x%08X)\n",
	535	RREG32(R_000E40_RBBM_STATUS),
	536	RREG32(R_0007C0_CP_STAT));
	537	}
	538	/* check if cards are posted or not */
72542d77 DA	539	if (radeon_boot_test_post_card(rdev) == false)
	540	return -EINVAL;
	541
ca6ffc64 JG	542	/* Initialize clocks */
ca6ffc64 JG	543	radeon_get_clock_info(rdev->ddev);
d594e46a JG	544	/* initialize memory controller */
d594e46a JG	545	rs400_mc_init(rdev);
ca6ffc64	546	/* Fence driver */
30eb77f4	547	r = radeon_fence_driver_init(rdev);
ca6ffc64 JG	548	if (r)
	549	return r;
	550	/* Memory manager */
4c788679	551	r = radeon_bo_init(rdev);
ca6ffc64 JG	552	if (r)
	553	return r;
	554	r = rs400_gart_init(rdev);
	555	if (r)
	556	return r;
	557	r300_set_reg_safe(rdev);
b15ba512	558
6c7bccea AD	559	/* Initialize power management */
	560	radeon_pm_init(rdev);
	561
ca6ffc64 JG	562	rdev->accel_working = true;
	563	r = rs400_startup(rdev);
	564	if (r) {
	565	/* Somethings want wront with the accel init stop accel */
	566	dev_err(rdev->dev, "Disabling GPU acceleration\n");
ca6ffc64	567	r100_cp_fini(rdev);
724c80e1	568	radeon_wb_fini(rdev);
2898c348	569	radeon_ib_pool_fini(rdev);
ca6ffc64 JG	570	rs400_gart_fini(rdev);
	571	radeon_irq_kms_fini(rdev);
	572	rdev->accel_working = false;
	573	}
	574	return 0;
	575	}