kernel: write to all registered consoles with printk()

include/socks/console.h

@@ -43,6 +43,9 @@ struct console {
 extern kern_status_t console_register(struct console *con);
 extern kern_status_t console_unregister(struct console *con);
 
+extern struct queue *get_consoles(unsigned long *flags);
+extern void put_consoles(struct queue *consoles, unsigned long flags);
+
 extern void console_write(struct console *con, const char *s, unsigned int len);
 extern int console_read(struct console *con, char *s, unsigned int len);
 

kernel/console.c

@@ -34,6 +34,18 @@ kern_status_t console_unregister(struct console *con)
 	return KERN_OK;
 }
 
+struct queue *get_consoles(unsigned long *flags)
+{
+	spin_lock_irqsave(&consoles_lock, flags);
+	return &consoles;
+}
+
+void put_consoles(struct queue *consoles, unsigned long flags)
+{
+	(void)consoles;
+	spin_unlock_irqrestore(&consoles_lock, flags);
+}
+
 void console_write(struct console *con, const char *s, unsigned int len)
 {
 	if (con->c_write) {

kernel/printk.c

@@ -21,11 +21,21 @@ static unsigned int log_buffer_writep = 0;
 
 static void flush_log_buffer(void)
 {
+	/*
 	if (!early_console) {
 		return;
 	}
 
 	console_write(early_console, log_buffer + log_buffer_readp, log_buffer_writep - log_buffer_readp);
+	*/
+
+	unsigned long flags;
+	struct queue *consoles = get_consoles(&flags);
+	queue_foreach(struct console, con, consoles, c_list) {
+		console_write(con, log_buffer + log_buffer_readp, log_buffer_writep - log_buffer_readp);
+	}
+
+	put_consoles(consoles, flags);
 	log_buffer_readp = log_buffer_writep;
 }