radeon_pm.c
来自「优龙2410linux2.6.8内核源代码」· C语言 代码 · 共 944 行 · 第 1/2 页
C
944 行
#include "radeonfb.h"#include <linux/console.h>#include <linux/agp_backend.h>/* * Currently, only PowerMac do D2 state */#define CONFIG_RADEON_HAS_D2 CONFIG_PPC_PMAC#ifdef CONFIG_RADEON_HAS_D2/* * On PowerMac, we assume any mobility chip based machine does D2 */#ifdef CONFIG_PPC_PMACstatic inline int radeon_suspend_to_d2(struct radeonfb_info *rinfo, u32 state){ return rinfo->is_mobility;}#elsestatic inline int radeon_suspend_to_d2(struct radeonfb_info *rinfo, u32 state){ return 0;}#endif#endif /* CONFIG_RADEON_HAS_D2 *//* * Radeon M6, M7 and M9 Power Management code. This code currently * only supports the mobile chips in D2 mode, that is typically what * is used on Apple laptops, it's based from some informations provided * by ATI along with hours of tracing of MacOS drivers. * * New version of this code almost totally rewritten by ATI, many thanks * for their support. */void radeon_pm_disable_dynamic_mode(struct radeonfb_info *rinfo){ u32 sclk_cntl; u32 mclk_cntl; u32 sclk_more_cntl; u32 vclk_ecp_cntl; u32 pixclks_cntl; /* Mobility chips only, untested on M9+/M10/11 */ if (!rinfo->is_mobility) return; if (rinfo->family > CHIP_FAMILY_RV250) return; /* Force Core Clocks */ sclk_cntl = INPLL( pllSCLK_CNTL_M6); sclk_cntl |= SCLK_CNTL_M6__FORCE_CP| SCLK_CNTL_M6__FORCE_HDP| SCLK_CNTL_M6__FORCE_DISP1| SCLK_CNTL_M6__FORCE_DISP2| SCLK_CNTL_M6__FORCE_TOP| SCLK_CNTL_M6__FORCE_E2| SCLK_CNTL_M6__FORCE_SE| SCLK_CNTL_M6__FORCE_IDCT| SCLK_CNTL_M6__FORCE_VIP| SCLK_CNTL_M6__FORCE_RE| SCLK_CNTL_M6__FORCE_PB| SCLK_CNTL_M6__FORCE_TAM| SCLK_CNTL_M6__FORCE_TDM| SCLK_CNTL_M6__FORCE_RB| SCLK_CNTL_M6__FORCE_TV_SCLK| SCLK_CNTL_M6__FORCE_SUBPIC| SCLK_CNTL_M6__FORCE_OV0; OUTPLL( pllSCLK_CNTL_M6, sclk_cntl); sclk_more_cntl = INPLL(pllSCLK_MORE_CNTL); sclk_more_cntl |= SCLK_MORE_CNTL__FORCE_DISPREGS| SCLK_MORE_CNTL__FORCE_MC_GUI| SCLK_MORE_CNTL__FORCE_MC_HOST; OUTPLL(pllSCLK_MORE_CNTL, sclk_more_cntl); /* Force Display clocks */ vclk_ecp_cntl = INPLL( pllVCLK_ECP_CNTL); vclk_ecp_cntl &= ~( VCLK_ECP_CNTL__PIXCLK_ALWAYS_ONb | VCLK_ECP_CNTL__PIXCLK_DAC_ALWAYS_ONb); OUTPLL( pllVCLK_ECP_CNTL, vclk_ecp_cntl); pixclks_cntl = INPLL( pllPIXCLKS_CNTL); pixclks_cntl &= ~( PIXCLKS_CNTL__PIXCLK_GV_ALWAYS_ONb | PIXCLKS_CNTL__PIXCLK_BLEND_ALWAYS_ONb| PIXCLKS_CNTL__PIXCLK_DIG_TMDS_ALWAYS_ONb | PIXCLKS_CNTL__PIXCLK_LVDS_ALWAYS_ONb| PIXCLKS_CNTL__PIXCLK_TMDS_ALWAYS_ONb| PIXCLKS_CNTL__PIX2CLK_ALWAYS_ONb| PIXCLKS_CNTL__PIX2CLK_DAC_ALWAYS_ONb); OUTPLL( pllPIXCLKS_CNTL, pixclks_cntl); /* Force Memory Clocks */ mclk_cntl = INPLL( pllMCLK_CNTL_M6); mclk_cntl &= ~( MCLK_CNTL_M6__FORCE_MCLKA | MCLK_CNTL_M6__FORCE_MCLKB | MCLK_CNTL_M6__FORCE_YCLKA | MCLK_CNTL_M6__FORCE_YCLKB ); OUTPLL( pllMCLK_CNTL_M6, mclk_cntl);}void radeon_pm_enable_dynamic_mode(struct radeonfb_info *rinfo){ u32 clk_pwrmgt_cntl; u32 sclk_cntl; u32 sclk_more_cntl; u32 clk_pin_cntl; u32 pixclks_cntl; u32 vclk_ecp_cntl; u32 mclk_cntl; u32 mclk_misc; /* Mobility chips only, untested on M9+/M10/11 */ if (!rinfo->is_mobility) return; if (rinfo->family > CHIP_FAMILY_RV250) return; /* Set Latencies */ clk_pwrmgt_cntl = INPLL( pllCLK_PWRMGT_CNTL_M6); clk_pwrmgt_cntl &= ~( CLK_PWRMGT_CNTL_M6__ENGINE_DYNCLK_MODE_MASK| CLK_PWRMGT_CNTL_M6__ACTIVE_HILO_LAT_MASK| CLK_PWRMGT_CNTL_M6__DISP_DYN_STOP_LAT_MASK| CLK_PWRMGT_CNTL_M6__DYN_STOP_MODE_MASK); /* Mode 1 */ clk_pwrmgt_cntl = CLK_PWRMGT_CNTL_M6__MC_CH_MODE| CLK_PWRMGT_CNTL_M6__ENGINE_DYNCLK_MODE | (1<<CLK_PWRMGT_CNTL_M6__ACTIVE_HILO_LAT__SHIFT) | (0<<CLK_PWRMGT_CNTL_M6__DISP_DYN_STOP_LAT__SHIFT)| (0<<CLK_PWRMGT_CNTL_M6__DYN_STOP_MODE__SHIFT); OUTPLL( pllCLK_PWRMGT_CNTL_M6, clk_pwrmgt_cntl); clk_pin_cntl = INPLL( pllCLK_PIN_CNTL); clk_pin_cntl |= CLK_PIN_CNTL__SCLK_DYN_START_CNTL; OUTPLL( pllCLK_PIN_CNTL, clk_pin_cntl); /* Enable Dyanmic mode for SCLK */ sclk_cntl = INPLL( pllSCLK_CNTL_M6); sclk_cntl &= SCLK_CNTL_M6__SCLK_SRC_SEL_MASK; sclk_cntl |= SCLK_CNTL_M6__FORCE_VIP; OUTPLL( pllSCLK_CNTL_M6, sclk_cntl); sclk_more_cntl = INPLL(pllSCLK_MORE_CNTL); sclk_more_cntl &= ~(SCLK_MORE_CNTL__FORCE_DISPREGS); OUTPLL(pllSCLK_MORE_CNTL, sclk_more_cntl); /* Enable Dynamic mode for PIXCLK & PIX2CLK */ pixclks_cntl = INPLL( pllPIXCLKS_CNTL); pixclks_cntl|= PIXCLKS_CNTL__PIX2CLK_ALWAYS_ONb | PIXCLKS_CNTL__PIX2CLK_DAC_ALWAYS_ONb| PIXCLKS_CNTL__PIXCLK_BLEND_ALWAYS_ONb| PIXCLKS_CNTL__PIXCLK_GV_ALWAYS_ONb| PIXCLKS_CNTL__PIXCLK_DIG_TMDS_ALWAYS_ONb| PIXCLKS_CNTL__PIXCLK_LVDS_ALWAYS_ONb| PIXCLKS_CNTL__PIXCLK_TMDS_ALWAYS_ONb; OUTPLL( pllPIXCLKS_CNTL, pixclks_cntl); vclk_ecp_cntl = INPLL( pllVCLK_ECP_CNTL); vclk_ecp_cntl|= VCLK_ECP_CNTL__PIXCLK_ALWAYS_ONb | VCLK_ECP_CNTL__PIXCLK_DAC_ALWAYS_ONb; OUTPLL( pllVCLK_ECP_CNTL, vclk_ecp_cntl); /* Enable Dynamic mode for MCLK */ mclk_cntl = INPLL( pllMCLK_CNTL_M6); mclk_cntl |= MCLK_CNTL_M6__FORCE_MCLKA| MCLK_CNTL_M6__FORCE_MCLKB| MCLK_CNTL_M6__FORCE_YCLKA| MCLK_CNTL_M6__FORCE_YCLKB; OUTPLL( pllMCLK_CNTL_M6, mclk_cntl); mclk_misc = INPLL(pllMCLK_MISC); mclk_misc |= MCLK_MISC__MC_MCLK_MAX_DYN_STOP_LAT| MCLK_MISC__IO_MCLK_MAX_DYN_STOP_LAT| MCLK_MISC__MC_MCLK_DYN_ENABLE| MCLK_MISC__IO_MCLK_DYN_ENABLE; OUTPLL(pllMCLK_MISC, mclk_misc);}#ifdef CONFIG_PMstatic void OUTMC( struct radeonfb_info *rinfo, u8 indx, u32 value){ OUTREG( MC_IND_INDEX, indx | MC_IND_INDEX__MC_IND_WR_EN); OUTREG( MC_IND_DATA, value); }static u32 INMC(struct radeonfb_info *rinfo, u8 indx){ OUTREG( MC_IND_INDEX, indx); return INREG( MC_IND_DATA);}static void radeon_pm_save_regs(struct radeonfb_info *rinfo){ rinfo->save_regs[0] = INPLL(PLL_PWRMGT_CNTL); rinfo->save_regs[1] = INPLL(CLK_PWRMGT_CNTL); rinfo->save_regs[2] = INPLL(MCLK_CNTL); rinfo->save_regs[3] = INPLL(SCLK_CNTL); rinfo->save_regs[4] = INPLL(CLK_PIN_CNTL); rinfo->save_regs[5] = INPLL(VCLK_ECP_CNTL); rinfo->save_regs[6] = INPLL(PIXCLKS_CNTL); rinfo->save_regs[7] = INPLL(MCLK_MISC); rinfo->save_regs[8] = INPLL(P2PLL_CNTL); rinfo->save_regs[9] = INREG(DISP_MISC_CNTL); rinfo->save_regs[10] = INREG(DISP_PWR_MAN); rinfo->save_regs[11] = INREG(LVDS_GEN_CNTL); rinfo->save_regs[12] = INREG(LVDS_PLL_CNTL); rinfo->save_regs[13] = INREG(TV_DAC_CNTL); rinfo->save_regs[14] = INREG(BUS_CNTL1); rinfo->save_regs[15] = INREG(CRTC_OFFSET_CNTL); rinfo->save_regs[16] = INREG(AGP_CNTL); rinfo->save_regs[17] = (INREG(CRTC_GEN_CNTL) & 0xfdffffff) | 0x04000000; rinfo->save_regs[18] = (INREG(CRTC2_GEN_CNTL) & 0xfdffffff) | 0x04000000; rinfo->save_regs[19] = INREG(GPIOPAD_A); rinfo->save_regs[20] = INREG(GPIOPAD_EN); rinfo->save_regs[21] = INREG(GPIOPAD_MASK); rinfo->save_regs[22] = INREG(ZV_LCDPAD_A); rinfo->save_regs[23] = INREG(ZV_LCDPAD_EN); rinfo->save_regs[24] = INREG(ZV_LCDPAD_MASK); rinfo->save_regs[25] = INREG(GPIO_VGA_DDC); rinfo->save_regs[26] = INREG(GPIO_DVI_DDC); rinfo->save_regs[27] = INREG(GPIO_MONID); rinfo->save_regs[28] = INREG(GPIO_CRT2_DDC); rinfo->save_regs[29] = INREG(SURFACE_CNTL); rinfo->save_regs[30] = INREG(MC_FB_LOCATION); rinfo->save_regs[31] = INREG(DISPLAY_BASE_ADDR); rinfo->save_regs[32] = INREG(MC_AGP_LOCATION); rinfo->save_regs[33] = INREG(CRTC2_DISPLAY_BASE_ADDR);}static void radeon_pm_restore_regs(struct radeonfb_info *rinfo){ OUTPLL(P2PLL_CNTL, rinfo->save_regs[8] & 0xFFFFFFFE); /* First */ OUTPLL(PLL_PWRMGT_CNTL, rinfo->save_regs[0]); OUTPLL(CLK_PWRMGT_CNTL, rinfo->save_regs[1]); OUTPLL(MCLK_CNTL, rinfo->save_regs[2]); OUTPLL(SCLK_CNTL, rinfo->save_regs[3]); OUTPLL(CLK_PIN_CNTL, rinfo->save_regs[4]); OUTPLL(VCLK_ECP_CNTL, rinfo->save_regs[5]); OUTPLL(PIXCLKS_CNTL, rinfo->save_regs[6]); OUTPLL(MCLK_MISC, rinfo->save_regs[7]); OUTREG(SURFACE_CNTL, rinfo->save_regs[29]); OUTREG(MC_FB_LOCATION, rinfo->save_regs[30]); OUTREG(DISPLAY_BASE_ADDR, rinfo->save_regs[31]); OUTREG(MC_AGP_LOCATION, rinfo->save_regs[32]); OUTREG(CRTC2_DISPLAY_BASE_ADDR, rinfo->save_regs[33]); OUTREG(DISP_MISC_CNTL, rinfo->save_regs[9]); OUTREG(DISP_PWR_MAN, rinfo->save_regs[10]); OUTREG(LVDS_GEN_CNTL, rinfo->save_regs[11]); OUTREG(LVDS_PLL_CNTL,rinfo->save_regs[12]); OUTREG(TV_DAC_CNTL, rinfo->save_regs[13]); OUTREG(BUS_CNTL1, rinfo->save_regs[14]); OUTREG(CRTC_OFFSET_CNTL, rinfo->save_regs[15]); OUTREG(AGP_CNTL, rinfo->save_regs[16]); OUTREG(CRTC_GEN_CNTL, rinfo->save_regs[17]); OUTREG(CRTC2_GEN_CNTL, rinfo->save_regs[18]); // wait VBL before that one ? OUTPLL(P2PLL_CNTL, rinfo->save_regs[8]); OUTREG(GPIOPAD_A, rinfo->save_regs[19]); OUTREG(GPIOPAD_EN, rinfo->save_regs[20]); OUTREG(GPIOPAD_MASK, rinfo->save_regs[21]); OUTREG(ZV_LCDPAD_A, rinfo->save_regs[22]); OUTREG(ZV_LCDPAD_EN, rinfo->save_regs[23]); OUTREG(ZV_LCDPAD_MASK, rinfo->save_regs[24]); OUTREG(GPIO_VGA_DDC, rinfo->save_regs[25]); OUTREG(GPIO_DVI_DDC, rinfo->save_regs[26]); OUTREG(GPIO_MONID, rinfo->save_regs[27]); OUTREG(GPIO_CRT2_DDC, rinfo->save_regs[28]);}static void radeon_pm_disable_iopad(struct radeonfb_info *rinfo){ OUTREG(GPIOPAD_MASK, 0x0001ffff); OUTREG(GPIOPAD_EN, 0x00000400); OUTREG(GPIOPAD_A, 0x00000000); OUTREG(ZV_LCDPAD_MASK, 0x00000000); OUTREG(ZV_LCDPAD_EN, 0x00000000); OUTREG(ZV_LCDPAD_A, 0x00000000); OUTREG(GPIO_VGA_DDC, 0x00030000); OUTREG(GPIO_DVI_DDC, 0x00000000); OUTREG(GPIO_MONID, 0x00030000); OUTREG(GPIO_CRT2_DDC, 0x00000000);}static void radeon_pm_program_v2clk(struct radeonfb_info *rinfo){ /* we use __INPLL and _OUTPLL and do the locking ourselves... */ unsigned long flags; spin_lock_irqsave(&rinfo->reg_lock, flags); /* Set v2clk to 65MHz */ __OUTPLL(pllPIXCLKS_CNTL, __INPLL(rinfo, pllPIXCLKS_CNTL) & ~PIXCLKS_CNTL__PIX2CLK_SRC_SEL_MASK); __OUTPLL(pllP2PLL_REF_DIV, 0x0000000c); __OUTPLL(pllP2PLL_CNTL, 0x0000bf00); __OUTPLL(pllP2PLL_DIV_0, 0x00020074 | P2PLL_DIV_0__P2PLL_ATOMIC_UPDATE_W); __OUTPLL(pllP2PLL_CNTL, __INPLL(rinfo, pllP2PLL_CNTL) & ~P2PLL_CNTL__P2PLL_SLEEP); mdelay(1); __OUTPLL(pllP2PLL_CNTL, __INPLL(rinfo, pllP2PLL_CNTL) & ~P2PLL_CNTL__P2PLL_RESET); mdelay( 1); __OUTPLL(pllPIXCLKS_CNTL, (__INPLL(rinfo, pllPIXCLKS_CNTL) & ~PIXCLKS_CNTL__PIX2CLK_SRC_SEL_MASK) | (0x03 << PIXCLKS_CNTL__PIX2CLK_SRC_SEL__SHIFT)); mdelay( 1); spin_unlock_irqrestore(&rinfo->reg_lock, flags);}static void radeon_pm_low_current(struct radeonfb_info *rinfo){ u32 reg; reg = INREG(BUS_CNTL1); reg &= ~BUS_CNTL1_MOBILE_PLATFORM_SEL_MASK; reg |= BUS_CNTL1_AGPCLK_VALID | (1<<BUS_CNTL1_MOBILE_PLATFORM_SEL_SHIFT); OUTREG(BUS_CNTL1, reg); reg = INPLL(PLL_PWRMGT_CNTL); reg |= PLL_PWRMGT_CNTL_SPLL_TURNOFF | PLL_PWRMGT_CNTL_PPLL_TURNOFF | PLL_PWRMGT_CNTL_P2PLL_TURNOFF | PLL_PWRMGT_CNTL_TVPLL_TURNOFF; reg &= ~PLL_PWRMGT_CNTL_SU_MCLK_USE_BCLK; reg &= ~PLL_PWRMGT_CNTL_MOBILE_SU; OUTPLL(PLL_PWRMGT_CNTL, reg); reg = INREG(TV_DAC_CNTL); reg &= ~(TV_DAC_CNTL_BGADJ_MASK |TV_DAC_CNTL_DACADJ_MASK); reg |=TV_DAC_CNTL_BGSLEEP | TV_DAC_CNTL_RDACPD | TV_DAC_CNTL_GDACPD | TV_DAC_CNTL_BDACPD | (8<<TV_DAC_CNTL_BGADJ__SHIFT) | (8<<TV_DAC_CNTL_DACADJ__SHIFT); OUTREG(TV_DAC_CNTL, reg); reg = INREG(TMDS_TRANSMITTER_CNTL); reg &= ~(TMDS_PLL_EN | TMDS_PLLRST); OUTREG(TMDS_TRANSMITTER_CNTL, reg); reg = INREG(DAC_CNTL); reg &= ~DAC_CMP_EN; OUTREG(DAC_CNTL, reg); reg = INREG(DAC_CNTL2); reg &= ~DAC2_CMP_EN; OUTREG(DAC_CNTL2, reg); reg = INREG(TV_DAC_CNTL); reg &= ~TV_DAC_CNTL_DETECT; OUTREG(TV_DAC_CNTL, reg);}static void radeon_pm_setup_for_suspend(struct radeonfb_info *rinfo){ u32 sclk_cntl, mclk_cntl, sclk_more_cntl; u32 pll_pwrmgt_cntl; u32 clk_pwrmgt_cntl; u32 clk_pin_cntl; u32 vclk_ecp_cntl; u32 pixclks_cntl; u32 disp_mis_cntl; u32 disp_pwr_man; u32 tmp; /* Force Core Clocks */ sclk_cntl = INPLL( pllSCLK_CNTL_M6); sclk_cntl |= SCLK_CNTL_M6__IDCT_MAX_DYN_STOP_LAT| SCLK_CNTL_M6__VIP_MAX_DYN_STOP_LAT| SCLK_CNTL_M6__RE_MAX_DYN_STOP_LAT| SCLK_CNTL_M6__PB_MAX_DYN_STOP_LAT| SCLK_CNTL_M6__TAM_MAX_DYN_STOP_LAT| SCLK_CNTL_M6__TDM_MAX_DYN_STOP_LAT| SCLK_CNTL_M6__RB_MAX_DYN_STOP_LAT| SCLK_CNTL_M6__FORCE_DISP2| SCLK_CNTL_M6__FORCE_CP| SCLK_CNTL_M6__FORCE_HDP| SCLK_CNTL_M6__FORCE_DISP1| SCLK_CNTL_M6__FORCE_TOP| SCLK_CNTL_M6__FORCE_E2| SCLK_CNTL_M6__FORCE_SE| SCLK_CNTL_M6__FORCE_IDCT| SCLK_CNTL_M6__FORCE_VIP| SCLK_CNTL_M6__FORCE_RE| SCLK_CNTL_M6__FORCE_PB| SCLK_CNTL_M6__FORCE_TAM| SCLK_CNTL_M6__FORCE_TDM| SCLK_CNTL_M6__FORCE_RB| SCLK_CNTL_M6__FORCE_TV_SCLK| SCLK_CNTL_M6__FORCE_SUBPIC| SCLK_CNTL_M6__FORCE_OV0; OUTPLL( pllSCLK_CNTL_M6, sclk_cntl); sclk_more_cntl = INPLL(pllSCLK_MORE_CNTL); sclk_more_cntl |= SCLK_MORE_CNTL__FORCE_DISPREGS | SCLK_MORE_CNTL__FORCE_MC_GUI | SCLK_MORE_CNTL__FORCE_MC_HOST; OUTPLL(pllSCLK_MORE_CNTL, sclk_more_cntl); mclk_cntl = INPLL( pllMCLK_CNTL_M6); mclk_cntl &= ~( MCLK_CNTL_M6__FORCE_MCLKA | MCLK_CNTL_M6__FORCE_MCLKB | MCLK_CNTL_M6__FORCE_YCLKA | MCLK_CNTL_M6__FORCE_YCLKB | MCLK_CNTL_M6__FORCE_MC ); OUTPLL( pllMCLK_CNTL_M6, mclk_cntl); /* Force Display clocks */ vclk_ecp_cntl = INPLL( pllVCLK_ECP_CNTL); vclk_ecp_cntl &= ~(VCLK_ECP_CNTL__PIXCLK_ALWAYS_ONb |VCLK_ECP_CNTL__PIXCLK_DAC_ALWAYS_ONb); vclk_ecp_cntl |= VCLK_ECP_CNTL__ECP_FORCE_ON; OUTPLL( pllVCLK_ECP_CNTL, vclk_ecp_cntl); pixclks_cntl = INPLL( pllPIXCLKS_CNTL); pixclks_cntl &= ~( PIXCLKS_CNTL__PIXCLK_GV_ALWAYS_ONb | PIXCLKS_CNTL__PIXCLK_BLEND_ALWAYS_ONb| PIXCLKS_CNTL__PIXCLK_DIG_TMDS_ALWAYS_ONb | PIXCLKS_CNTL__PIXCLK_LVDS_ALWAYS_ONb| PIXCLKS_CNTL__PIXCLK_TMDS_ALWAYS_ONb| PIXCLKS_CNTL__PIX2CLK_ALWAYS_ONb| PIXCLKS_CNTL__PIX2CLK_DAC_ALWAYS_ONb); OUTPLL( pllPIXCLKS_CNTL, pixclks_cntl); /* Enable System power management */ pll_pwrmgt_cntl = INPLL( pllPLL_PWRMGT_CNTL);
⌨️ 快捷键说明
复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?