2 * Support for features of the OLPC XO-1 laptop
4 * Copyright (C) 2010 Andres Salomon <dilinger@queued.net>
5 * Copyright (C) 2010 One Laptop per Child
6 * Copyright (C) 2006 Red Hat, Inc.
7 * Copyright (C) 2006 Advanced Micro Devices, Inc.
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
15 #include <linux/module.h>
16 #include <linux/platform_device.h>
18 #include <linux/mfd/core.h>
23 #define DRV_NAME "olpc-xo1"
25 /* PMC registers (PMS block) */
27 #define PM_IN_SLPCTL 0x20
32 /* PM registers (ACPI block) */
34 #define PM_GPE0_STS 0x18
36 static unsigned long acpi_base
;
37 static unsigned long pms_base
;
39 static void xo1_power_off(void)
41 printk(KERN_INFO
"OLPC XO-1 power off sequence...\n");
43 /* Enable all of these controls with 0 delay */
44 outl(0x40000000, pms_base
+ PM_SCLK
);
45 outl(0x40000000, pms_base
+ PM_IN_SLPCTL
);
46 outl(0x40000000, pms_base
+ PM_WKXD
);
47 outl(0x40000000, pms_base
+ PM_WKD
);
49 /* Clear status bits (possibly unnecessary) */
50 outl(0x0002ffff, pms_base
+ PM_SSC
);
51 outl(0xffffffff, acpi_base
+ PM_GPE0_STS
);
53 /* Write SLP_EN bit to start the machinery */
54 outl(0x00002000, acpi_base
+ PM1_CNT
);
57 static int __devinit
olpc_xo1_probe(struct platform_device
*pdev
)
62 /* don't run on non-XOs */
63 if (!machine_is_olpc())
66 err
= mfd_cell_enable(pdev
);
70 res
= platform_get_resource(pdev
, IORESOURCE_IO
, 0);
72 dev_err(&pdev
->dev
, "can't fetch device resource info\n");
75 if (strcmp(pdev
->name
, "cs5535-pms") == 0)
76 pms_base
= res
->start
;
77 else if (strcmp(pdev
->name
, "olpc-xo1-pm-acpi") == 0)
78 acpi_base
= res
->start
;
80 /* If we have both addresses, we can override the poweroff hook */
81 if (pms_base
&& acpi_base
) {
82 pm_power_off
= xo1_power_off
;
83 printk(KERN_INFO
"OLPC XO-1 support registered\n");
89 static int __devexit
olpc_xo1_remove(struct platform_device
*pdev
)
91 mfd_cell_disable(pdev
);
93 if (strcmp(pdev
->name
, "cs5535-pms") == 0)
95 else if (strcmp(pdev
->name
, "olpc-xo1-pm-acpi") == 0)
102 static struct platform_driver cs5535_pms_drv
= {
104 .name
= "cs5535-pms",
105 .owner
= THIS_MODULE
,
107 .probe
= olpc_xo1_probe
,
108 .remove
= __devexit_p(olpc_xo1_remove
),
111 static struct platform_driver cs5535_acpi_drv
= {
113 .name
= "olpc-xo1-pm-acpi",
114 .owner
= THIS_MODULE
,
116 .probe
= olpc_xo1_probe
,
117 .remove
= __devexit_p(olpc_xo1_remove
),
120 static int __init
olpc_xo1_init(void)
124 r
= platform_driver_register(&cs5535_pms_drv
);
128 r
= platform_driver_register(&cs5535_acpi_drv
);
130 platform_driver_unregister(&cs5535_pms_drv
);
135 static void __exit
olpc_xo1_exit(void)
137 platform_driver_unregister(&cs5535_acpi_drv
);
138 platform_driver_unregister(&cs5535_pms_drv
);
141 MODULE_AUTHOR("Daniel Drake <dsd@laptop.org>");
142 MODULE_LICENSE("GPL");
143 MODULE_ALIAS("platform:cs5535-pms");
145 module_init(olpc_xo1_init
);
146 module_exit(olpc_xo1_exit
);