|
@@ -20,6 +20,8 @@
|
|
|
|
|
|
#include <asm/hypervisor.h>
|
|
|
#include <asm/spitfire.h>
|
|
|
+#include <asm/vdev.h>
|
|
|
+#include <asm/irq.h>
|
|
|
|
|
|
#if defined(CONFIG_MAGIC_SYSRQ)
|
|
|
#define SUPPORT_SYSRQ
|
|
@@ -407,6 +409,60 @@ static void __init sunhv_console_init(void)
|
|
|
register_console(&sunhv_console);
|
|
|
}
|
|
|
|
|
|
+static int __init hv_console_compatible(char *buf, int len)
|
|
|
+{
|
|
|
+ while (len) {
|
|
|
+ int this_len;
|
|
|
+
|
|
|
+ if (!strcmp(buf, "qcn"))
|
|
|
+ return 1;
|
|
|
+
|
|
|
+ this_len = strlen(buf) + 1;
|
|
|
+
|
|
|
+ buf += this_len;
|
|
|
+ len -= this_len;
|
|
|
+ }
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static unsigned int __init get_interrupt(void)
|
|
|
+{
|
|
|
+ const char *cons_str = "console";
|
|
|
+ const char *compat_str = "compatible";
|
|
|
+ int node = prom_getchild(sun4v_vdev_root);
|
|
|
+ unsigned int irq;
|
|
|
+ char buf[64];
|
|
|
+ int err, len;
|
|
|
+
|
|
|
+ node = prom_searchsiblings(node, cons_str);
|
|
|
+ if (!node)
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ len = prom_getproplen(node, compat_str);
|
|
|
+ if (len == 0 || len == -1)
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ err = prom_getproperty(node, compat_str, buf, 64);
|
|
|
+ if (err == -1)
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ if (!hv_console_compatible(buf, len))
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ /* Ok, the this is the OBP node for the sun4v hypervisor
|
|
|
+ * console device. Decode the interrupt.
|
|
|
+ */
|
|
|
+ err = prom_getproperty(node, "interrupts",
|
|
|
+ (char *) &irq, sizeof(irq));
|
|
|
+ if (err == -1)
|
|
|
+ return 0;
|
|
|
+
|
|
|
+ return sun4v_build_irq(sun4v_vdev_devhandle, irq, 4, 0);
|
|
|
+}
|
|
|
+
|
|
|
+static u32 sunhv_irq;
|
|
|
+
|
|
|
static int __init sunhv_init(void)
|
|
|
{
|
|
|
struct uart_port *port;
|
|
@@ -415,6 +471,10 @@ static int __init sunhv_init(void)
|
|
|
if (tlb_type != hypervisor)
|
|
|
return -ENODEV;
|
|
|
|
|
|
+ sunhv_irq = get_interrupt();
|
|
|
+ if (!sunhv_irq)
|
|
|
+ return -ENODEV;
|
|
|
+
|
|
|
port = kmalloc(sizeof(struct uart_port), GFP_KERNEL);
|
|
|
if (unlikely(!port))
|
|
|
return -ENOMEM;
|
|
@@ -424,22 +484,23 @@ static int __init sunhv_init(void)
|
|
|
port->type = PORT_SUNHV;
|
|
|
port->uartclk = ( 29491200 / 16 ); /* arbitrary */
|
|
|
|
|
|
- /* XXX Get interrupt. XXX */
|
|
|
- if (request_irq(0 /* XXX */, sunhv_interrupt,
|
|
|
+ if (request_irq(sunhv_irq, sunhv_interrupt,
|
|
|
SA_SHIRQ, "serial(sunhv)", port)) {
|
|
|
- printk("sunhv: Cannot get IRQ %x\n",
|
|
|
- 0 /* XXX */);
|
|
|
+ printk("sunhv: Cannot get IRQ %x\n", sunhv_irq);
|
|
|
kfree(port);
|
|
|
return -ENODEV;
|
|
|
}
|
|
|
|
|
|
+ printk("SUNHV: SUN4V virtual console, IRQ[%08x]\n",
|
|
|
+ sunhv_irq);
|
|
|
+
|
|
|
sunhv_reg.minor = sunserial_current_minor;
|
|
|
sunhv_reg.nr = 1;
|
|
|
sunhv_reg.cons = &sunhv_console;
|
|
|
|
|
|
ret = uart_register_driver(&sunhv_reg);
|
|
|
if (ret < 0) {
|
|
|
- free_irq(0 /* XXX */, up);
|
|
|
+ free_irq(sunhv_irq, up);
|
|
|
kfree(port);
|
|
|
|
|
|
return ret;
|
|
@@ -463,7 +524,7 @@ static void __exit sunhv_exit(void)
|
|
|
BUG_ON(!port);
|
|
|
|
|
|
uart_remove_one_port(&sunhv_reg, port);
|
|
|
- free_irq(0 /* XXX */, port);
|
|
|
+ free_irq(sunhv_irq, port);
|
|
|
|
|
|
sunserial_current_minor -= 1;
|
|
|
|