add cpu_idle support for 21066A based lca systems

2 files changed, 31 insertions, 0 deletions

diff --git a/sys/alpha/pci/lca.c b/sys/alpha/pci/lca.c
index b00cadb..e279555 100644
--- a/sys/alpha/pci/lca.c
+++ b/sys/alpha/pci/lca.c
@@ -35,6 +35,8 @@ __FBSDID("$FreeBSD$");
 #include <sys/bus.h>
 #include <machine/bus.h>
 #include <sys/rman.h>
+#include <sys/proc.h>
+#include <sys/sched.h>
 
 #include <alpha/pci/lcareg.h>
 #include <alpha/pci/lcavar.h>
@@ -222,6 +224,8 @@ static void
 lca_machine_check(unsigned long mces, struct trapframe *framep,
     unsigned long vector, unsigned long param);
 
+static void lca_cpu_idle (void);
+
 static int
 lca_probe(device_t dev)
 {
@@ -234,6 +238,7 @@ lca_probe(device_t dev)
 	lca_init_sgmap();
 
 	platform.mcheck_handler = lca_machine_check;
+	platform.cpu_idle = lca_cpu_idle;
 
 	device_add_child(dev, "pcib", 0);
 
@@ -270,5 +275,29 @@ lca_machine_check(unsigned long mces, struct trapframe *framep,
 	REGVAL64(LCA_IOC_STAT0) = stat0;
 }
 
+void
+lca_cpu_idle (void)
+{
+	/*
+	 * 0x0 =  1
+	 * 0x1 =  1.5
+	 * 0x2 =  2
+	 * 0x3 =  4
+	 * 0x4 =  8
+	 * 0x5 = 16
+	 */
+	long override = 0x0;
+	long primary = 0x5;
+	long dma_ovr = 1;
+	long intr_ovr = 1;
+
+	REGVAL64(LCA_PMR) =
+	    (dma_ovr << 7) | (intr_ovr << 6) | (override << 3) | primary;
+	if (sched_runnable()) {
+		REGVAL64(LCA_PMR) =
+		    (override << 3) | override;
+	}
+}
+
 DRIVER_MODULE(lca, root, lca_driver, lca_devclass, 0, 0);
 
diff --git a/sys/alpha/pci/lcareg.h b/sys/alpha/pci/lcareg.h
index c79a991..c6255d8 100644
--- a/sys/alpha/pci/lcareg.h
+++ b/sys/alpha/pci/lcareg.h
@@ -44,6 +44,8 @@
 #define LCA_PCI_SPARSE	0x200000000L		/* PCI Sparse Space */
 #define LCA_PCI_DENSE	0x300000000L		/* PCI Dense Space */
 
+#define LCA_PMR		0x120000098L		/* Power Management (21066A)*/
+
 #define LCA_IOC_HAE	LCA_IOC_BASE		/* Host Address Ext. (64) */
 #define	IOC_HAE_ADDREXT	0x00000000f8000000UL
 #define	IOC_HAE_RSVSD	0xffffffff07ffffffUL