提交 0c541b44 编写于 作者: B Benjamin Herrenschmidt 提交者: Linus Torvalds

[PATCH] ppc32: Fix AGP and sleep again

My previous patch that added sleep support for uninorth-agp and some AGP
"off" stuff in radeonfb and aty128fb is breaking some configs.  More
specifically, it has problems with rage128 setups since the DRI code for
these in X doesn't properly re-enable AGP on wakeup or console switch
(unlike the radeon DRM).

This patch fixes the problem for pmac once for all by using a different
approach.  The AGP driver "registers" special suspend/resume callbacks with
some arch code that the fbdev's can later on call to suspend and resume
AGP, making sure it's resumed back in the same state it was when suspended.
 This is platform specific for now.  It would be too complicated to try to
do a generic implementation of this at this point due to all sort of weird
things going on with AGP on other architectures.  We'll re-work that whole
problem cleanly once we finally merge fbdev's and DRI.

In the meantime, please apply this patch which brings back some r128 based
laptops into working condition as far as system sleep is concerned.
Signed-off-by: NBenjamin Herrenschmidt <benh@kernel.crashing.org>
Signed-off-by: NAndrew Morton <akpm@osdl.org>
Signed-off-by: NLinus Torvalds <torvalds@osdl.org>
上级 7a648b9e
...@@ -2944,3 +2944,48 @@ void __pmac pmac_call_early_video_resume(void) ...@@ -2944,3 +2944,48 @@ void __pmac pmac_call_early_video_resume(void)
if (pmac_early_vresume_proc) if (pmac_early_vresume_proc)
pmac_early_vresume_proc(pmac_early_vresume_data); pmac_early_vresume_proc(pmac_early_vresume_data);
} }
/*
* AGP related suspend/resume code
*/
static struct pci_dev *pmac_agp_bridge __pmacdata;
static int (*pmac_agp_suspend)(struct pci_dev *bridge) __pmacdata;
static int (*pmac_agp_resume)(struct pci_dev *bridge) __pmacdata;
void __pmac pmac_register_agp_pm(struct pci_dev *bridge,
int (*suspend)(struct pci_dev *bridge),
int (*resume)(struct pci_dev *bridge))
{
if (suspend || resume) {
pmac_agp_bridge = bridge;
pmac_agp_suspend = suspend;
pmac_agp_resume = resume;
return;
}
if (bridge != pmac_agp_bridge)
return;
pmac_agp_suspend = pmac_agp_resume = NULL;
return;
}
EXPORT_SYMBOL(pmac_register_agp_pm);
void __pmac pmac_suspend_agp_for_card(struct pci_dev *dev)
{
if (pmac_agp_bridge == NULL || pmac_agp_suspend == NULL)
return;
if (pmac_agp_bridge->bus != dev->bus)
return;
pmac_agp_suspend(pmac_agp_bridge);
}
EXPORT_SYMBOL(pmac_suspend_agp_for_card);
void __pmac pmac_resume_agp_for_card(struct pci_dev *dev)
{
if (pmac_agp_bridge == NULL || pmac_agp_resume == NULL)
return;
if (pmac_agp_bridge->bus != dev->bus)
return;
pmac_agp_resume(pmac_agp_bridge);
}
EXPORT_SYMBOL(pmac_resume_agp_for_card);
...@@ -674,3 +674,67 @@ void __init pmac_check_ht_link(void) ...@@ -674,3 +674,67 @@ void __init pmac_check_ht_link(void)
dump_HT_speeds("PCI-X HT Downlink", cfg, freq); dump_HT_speeds("PCI-X HT Downlink", cfg, freq);
#endif #endif
} }
/*
* Early video resume hook
*/
static void (*pmac_early_vresume_proc)(void *data) __pmacdata;
static void *pmac_early_vresume_data __pmacdata;
void pmac_set_early_video_resume(void (*proc)(void *data), void *data)
{
if (_machine != _MACH_Pmac)
return;
preempt_disable();
pmac_early_vresume_proc = proc;
pmac_early_vresume_data = data;
preempt_enable();
}
EXPORT_SYMBOL(pmac_set_early_video_resume);
/*
* AGP related suspend/resume code
*/
static struct pci_dev *pmac_agp_bridge __pmacdata;
static int (*pmac_agp_suspend)(struct pci_dev *bridge) __pmacdata;
static int (*pmac_agp_resume)(struct pci_dev *bridge) __pmacdata;
void __pmac pmac_register_agp_pm(struct pci_dev *bridge,
int (*suspend)(struct pci_dev *bridge),
int (*resume)(struct pci_dev *bridge))
{
if (suspend || resume) {
pmac_agp_bridge = bridge;
pmac_agp_suspend = suspend;
pmac_agp_resume = resume;
return;
}
if (bridge != pmac_agp_bridge)
return;
pmac_agp_suspend = pmac_agp_resume = NULL;
return;
}
EXPORT_SYMBOL(pmac_register_agp_pm);
void __pmac pmac_suspend_agp_for_card(struct pci_dev *dev)
{
if (pmac_agp_bridge == NULL || pmac_agp_suspend == NULL)
return;
if (pmac_agp_bridge->bus != dev->bus)
return;
pmac_agp_suspend(pmac_agp_bridge);
}
EXPORT_SYMBOL(pmac_suspend_agp_for_card);
void __pmac pmac_resume_agp_for_card(struct pci_dev *dev)
{
if (pmac_agp_bridge == NULL || pmac_agp_resume == NULL)
return;
if (pmac_agp_bridge->bus != dev->bus)
return;
pmac_agp_resume(pmac_agp_bridge);
}
EXPORT_SYMBOL(pmac_resume_agp_for_card);
...@@ -10,6 +10,7 @@ ...@@ -10,6 +10,7 @@
#include <asm/uninorth.h> #include <asm/uninorth.h>
#include <asm/pci-bridge.h> #include <asm/pci-bridge.h>
#include <asm/prom.h> #include <asm/prom.h>
#include <asm/pmac_feature.h>
#include "agp.h" #include "agp.h"
/* /*
...@@ -26,6 +27,7 @@ ...@@ -26,6 +27,7 @@
static int uninorth_rev; static int uninorth_rev;
static int is_u3; static int is_u3;
static int uninorth_fetch_size(void) static int uninorth_fetch_size(void)
{ {
int i; int i;
...@@ -264,7 +266,8 @@ static void uninorth_agp_enable(struct agp_bridge_data *bridge, u32 mode) ...@@ -264,7 +266,8 @@ static void uninorth_agp_enable(struct agp_bridge_data *bridge, u32 mode)
&scratch); &scratch);
} while ((scratch & PCI_AGP_COMMAND_AGP) == 0 && ++timeout < 1000); } while ((scratch & PCI_AGP_COMMAND_AGP) == 0 && ++timeout < 1000);
if ((scratch & PCI_AGP_COMMAND_AGP) == 0) if ((scratch & PCI_AGP_COMMAND_AGP) == 0)
printk(KERN_ERR PFX "failed to write UniNorth AGP command reg\n"); printk(KERN_ERR PFX "failed to write UniNorth AGP"
" command register\n");
if (uninorth_rev >= 0x30) { if (uninorth_rev >= 0x30) {
/* This is an AGP V3 */ /* This is an AGP V3 */
...@@ -278,13 +281,24 @@ static void uninorth_agp_enable(struct agp_bridge_data *bridge, u32 mode) ...@@ -278,13 +281,24 @@ static void uninorth_agp_enable(struct agp_bridge_data *bridge, u32 mode)
} }
#ifdef CONFIG_PM #ifdef CONFIG_PM
static int agp_uninorth_suspend(struct pci_dev *pdev, pm_message_t state) /*
* These Power Management routines are _not_ called by the normal PCI PM layer,
* but directly by the video driver through function pointers in the device
* tree.
*/
static int agp_uninorth_suspend(struct pci_dev *pdev)
{ {
struct agp_bridge_data *bridge;
u32 cmd; u32 cmd;
u8 agp; u8 agp;
struct pci_dev *device = NULL; struct pci_dev *device = NULL;
if (state != PMSG_SUSPEND) bridge = agp_find_bridge(pdev);
if (bridge == NULL)
return -ENODEV;
/* Only one suspend supported */
if (bridge->dev_private_data)
return 0; return 0;
/* turn off AGP on the video chip, if it was enabled */ /* turn off AGP on the video chip, if it was enabled */
...@@ -315,6 +329,7 @@ static int agp_uninorth_suspend(struct pci_dev *pdev, pm_message_t state) ...@@ -315,6 +329,7 @@ static int agp_uninorth_suspend(struct pci_dev *pdev, pm_message_t state)
/* turn off AGP on the bridge */ /* turn off AGP on the bridge */
agp = pci_find_capability(pdev, PCI_CAP_ID_AGP); agp = pci_find_capability(pdev, PCI_CAP_ID_AGP);
pci_read_config_dword(pdev, agp + PCI_AGP_COMMAND, &cmd); pci_read_config_dword(pdev, agp + PCI_AGP_COMMAND, &cmd);
bridge->dev_private_data = (void *)cmd;
if (cmd & PCI_AGP_COMMAND_AGP) { if (cmd & PCI_AGP_COMMAND_AGP) {
printk("uninorth-agp: disabling AGP on bridge %s\n", printk("uninorth-agp: disabling AGP on bridge %s\n",
pci_name(pdev)); pci_name(pdev));
...@@ -329,9 +344,23 @@ static int agp_uninorth_suspend(struct pci_dev *pdev, pm_message_t state) ...@@ -329,9 +344,23 @@ static int agp_uninorth_suspend(struct pci_dev *pdev, pm_message_t state)
static int agp_uninorth_resume(struct pci_dev *pdev) static int agp_uninorth_resume(struct pci_dev *pdev)
{ {
struct agp_bridge_data *bridge;
u32 command;
bridge = agp_find_bridge(pdev);
if (bridge == NULL)
return -ENODEV;
command = (u32)bridge->dev_private_data;
bridge->dev_private_data = NULL;
if (!(command & PCI_AGP_COMMAND_AGP))
return 0;
uninorth_agp_enable(bridge, command);
return 0; return 0;
} }
#endif #endif /* CONFIG_PM */
static int uninorth_create_gatt_table(struct agp_bridge_data *bridge) static int uninorth_create_gatt_table(struct agp_bridge_data *bridge)
{ {
...@@ -575,6 +604,12 @@ static int __devinit agp_uninorth_probe(struct pci_dev *pdev, ...@@ -575,6 +604,12 @@ static int __devinit agp_uninorth_probe(struct pci_dev *pdev,
of_node_put(uninorth_node); of_node_put(uninorth_node);
} }
#ifdef CONFIG_PM
/* Inform platform of our suspend/resume caps */
pmac_register_agp_pm(pdev, agp_uninorth_suspend, agp_uninorth_resume);
#endif
/* Allocate & setup our driver */
bridge = agp_alloc_bridge(); bridge = agp_alloc_bridge();
if (!bridge) if (!bridge)
return -ENOMEM; return -ENOMEM;
...@@ -599,6 +634,11 @@ static void __devexit agp_uninorth_remove(struct pci_dev *pdev) ...@@ -599,6 +634,11 @@ static void __devexit agp_uninorth_remove(struct pci_dev *pdev)
{ {
struct agp_bridge_data *bridge = pci_get_drvdata(pdev); struct agp_bridge_data *bridge = pci_get_drvdata(pdev);
#ifdef CONFIG_PM
/* Inform platform of our suspend/resume caps */
pmac_register_agp_pm(pdev, NULL, NULL);
#endif
agp_remove_bridge(bridge); agp_remove_bridge(bridge);
agp_put_bridge(bridge); agp_put_bridge(bridge);
} }
...@@ -622,10 +662,6 @@ static struct pci_driver agp_uninorth_pci_driver = { ...@@ -622,10 +662,6 @@ static struct pci_driver agp_uninorth_pci_driver = {
.id_table = agp_uninorth_pci_table, .id_table = agp_uninorth_pci_table,
.probe = agp_uninorth_probe, .probe = agp_uninorth_probe,
.remove = agp_uninorth_remove, .remove = agp_uninorth_remove,
#ifdef CONFIG_PM
.suspend = agp_uninorth_suspend,
.resume = agp_uninorth_resume,
#endif
}; };
static int __init agp_uninorth_init(void) static int __init agp_uninorth_init(void)
......
...@@ -2331,7 +2331,6 @@ static int aty128_pci_suspend(struct pci_dev *pdev, pm_message_t state) ...@@ -2331,7 +2331,6 @@ static int aty128_pci_suspend(struct pci_dev *pdev, pm_message_t state)
{ {
struct fb_info *info = pci_get_drvdata(pdev); struct fb_info *info = pci_get_drvdata(pdev);
struct aty128fb_par *par = info->par; struct aty128fb_par *par = info->par;
u8 agp;
/* We don't do anything but D2, for now we return 0, but /* We don't do anything but D2, for now we return 0, but
* we may want to change that. How do we know if the BIOS * we may want to change that. How do we know if the BIOS
...@@ -2369,26 +2368,13 @@ static int aty128_pci_suspend(struct pci_dev *pdev, pm_message_t state) ...@@ -2369,26 +2368,13 @@ static int aty128_pci_suspend(struct pci_dev *pdev, pm_message_t state)
par->asleep = 1; par->asleep = 1;
par->lock_blank = 1; par->lock_blank = 1;
/* Disable AGP. The AGP host should have done it, but since ordering #ifdef CONFIG_PPC_PMAC
* isn't always properly guaranteed in this specific case, let's make /* On powermac, we have hooks to properly suspend/resume AGP now,
* sure it's disabled on card side now. Ultimately, when merging fbdev * use them here. We'll ultimately need some generic support here,
* and dri into some common infrastructure, this will be handled * but the generic code isn't quite ready for that yet
* more nicely. The host bridge side will (or will not) be dealt with
* by the bridge AGP driver, we don't attempt to touch it here.
*/ */
agp = pci_find_capability(pdev, PCI_CAP_ID_AGP); pmac_suspend_agp_for_card(pdev);
if (agp) { #endif /* CONFIG_PPC_PMAC */
u32 cmd;
pci_read_config_dword(pdev, agp + PCI_AGP_COMMAND, &cmd);
if (cmd & PCI_AGP_COMMAND_AGP) {
printk(KERN_INFO "aty128fb: AGP was enabled, "
"disabling ...\n");
cmd &= ~PCI_AGP_COMMAND_AGP;
pci_write_config_dword(pdev, agp + PCI_AGP_COMMAND,
cmd);
}
}
/* We need a way to make sure the fbdev layer will _not_ touch the /* We need a way to make sure the fbdev layer will _not_ touch the
* framebuffer before we put the chip to suspend state. On 2.4, I * framebuffer before we put the chip to suspend state. On 2.4, I
...@@ -2432,6 +2418,14 @@ static int aty128_do_resume(struct pci_dev *pdev) ...@@ -2432,6 +2418,14 @@ static int aty128_do_resume(struct pci_dev *pdev)
par->lock_blank = 0; par->lock_blank = 0;
aty128fb_blank(0, info); aty128fb_blank(0, info);
#ifdef CONFIG_PPC_PMAC
/* On powermac, we have hooks to properly suspend/resume AGP now,
* use them here. We'll ultimately need some generic support here,
* but the generic code isn't quite ready for that yet
*/
pmac_resume_agp_for_card(pdev);
#endif /* CONFIG_PPC_PMAC */
pdev->dev.power.power_state = PMSG_ON; pdev->dev.power.power_state = PMSG_ON;
printk(KERN_DEBUG "aty128fb: resumed !\n"); printk(KERN_DEBUG "aty128fb: resumed !\n");
......
...@@ -2520,13 +2520,10 @@ static int radeon_restore_pci_cfg(struct radeonfb_info *rinfo) ...@@ -2520,13 +2520,10 @@ static int radeon_restore_pci_cfg(struct radeonfb_info *rinfo)
} }
static/*extern*/ int susdisking = 0;
int radeonfb_pci_suspend(struct pci_dev *pdev, pm_message_t state) int radeonfb_pci_suspend(struct pci_dev *pdev, pm_message_t state)
{ {
struct fb_info *info = pci_get_drvdata(pdev); struct fb_info *info = pci_get_drvdata(pdev);
struct radeonfb_info *rinfo = info->par; struct radeonfb_info *rinfo = info->par;
u8 agp;
int i; int i;
if (state == pdev->dev.power.power_state) if (state == pdev->dev.power.power_state)
...@@ -2542,11 +2539,6 @@ int radeonfb_pci_suspend(struct pci_dev *pdev, pm_message_t state) ...@@ -2542,11 +2539,6 @@ int radeonfb_pci_suspend(struct pci_dev *pdev, pm_message_t state)
*/ */
if (state != PM_SUSPEND_MEM) if (state != PM_SUSPEND_MEM)
goto done; goto done;
if (susdisking) {
printk("radeonfb (%s): suspending to disk but state = %d\n",
pci_name(pdev), state);
goto done;
}
acquire_console_sem(); acquire_console_sem();
...@@ -2567,27 +2559,13 @@ int radeonfb_pci_suspend(struct pci_dev *pdev, pm_message_t state) ...@@ -2567,27 +2559,13 @@ int radeonfb_pci_suspend(struct pci_dev *pdev, pm_message_t state)
rinfo->lock_blank = 1; rinfo->lock_blank = 1;
del_timer_sync(&rinfo->lvds_timer); del_timer_sync(&rinfo->lvds_timer);
/* Disable AGP. The AGP host should have done it, but since ordering #ifdef CONFIG_PPC_PMAC
* isn't always properly guaranteed in this specific case, let's make /* On powermac, we have hooks to properly suspend/resume AGP now,
* sure it's disabled on card side now. Ultimately, when merging fbdev * use them here. We'll ultimately need some generic support here,
* and dri into some common infrastructure, this will be handled * but the generic code isn't quite ready for that yet
* more nicely. The host bridge side will (or will not) be dealt with
* by the bridge AGP driver, we don't attempt to touch it here.
*/ */
agp = pci_find_capability(pdev, PCI_CAP_ID_AGP); pmac_suspend_agp_for_card(pdev);
if (agp) { #endif /* CONFIG_PPC_PMAC */
u32 cmd;
pci_read_config_dword(pdev, agp + PCI_AGP_COMMAND, &cmd);
if (cmd & PCI_AGP_COMMAND_AGP) {
printk(KERN_INFO "radeonfb (%s): AGP was enabled, "
"disabling ...\n",
pci_name(pdev));
cmd &= ~PCI_AGP_COMMAND_AGP;
pci_write_config_dword(pdev, agp + PCI_AGP_COMMAND,
cmd);
}
}
/* If we support wakeup from poweroff, we save all regs we can including cfg /* If we support wakeup from poweroff, we save all regs we can including cfg
* space * space
...@@ -2699,6 +2677,15 @@ int radeonfb_pci_resume(struct pci_dev *pdev) ...@@ -2699,6 +2677,15 @@ int radeonfb_pci_resume(struct pci_dev *pdev)
rinfo->lock_blank = 0; rinfo->lock_blank = 0;
radeon_screen_blank(rinfo, FB_BLANK_UNBLANK, 1); radeon_screen_blank(rinfo, FB_BLANK_UNBLANK, 1);
#ifdef CONFIG_PPC_PMAC
/* On powermac, we have hooks to properly suspend/resume AGP now,
* use them here. We'll ultimately need some generic support here,
* but the generic code isn't quite ready for that yet
*/
pmac_resume_agp_for_card(pdev);
#endif /* CONFIG_PPC_PMAC */
/* Check status of dynclk */ /* Check status of dynclk */
if (rinfo->dynclk == 1) if (rinfo->dynclk == 1)
radeon_pm_enable_dynamic_mode(rinfo); radeon_pm_enable_dynamic_mode(rinfo);
......
...@@ -305,6 +305,17 @@ extern void pmac_call_early_video_resume(void); ...@@ -305,6 +305,17 @@ extern void pmac_call_early_video_resume(void);
#define PMAC_FTR_DEF(x) ((_MACH_Pmac << 16) | (x)) #define PMAC_FTR_DEF(x) ((_MACH_Pmac << 16) | (x))
/* The AGP driver registers itself here */
extern void pmac_register_agp_pm(struct pci_dev *bridge,
int (*suspend)(struct pci_dev *bridge),
int (*resume)(struct pci_dev *bridge));
/* Those are meant to be used by video drivers to deal with AGP
* suspend resume properly
*/
extern void pmac_suspend_agp_for_card(struct pci_dev *dev);
extern void pmac_resume_agp_for_card(struct pci_dev *dev);
/* /*
* The part below is for use by macio_asic.c only, do not rely * The part below is for use by macio_asic.c only, do not rely
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册