OMAP3: Serial context save/restore

Index: linux-omap-2.6/arch/arm/mach-omap2/serial.c
===================================================================
@@ -68,6 +68,17 @@ static const u32 omap3_uart_wk_bit[OMAP_
 	OMAP3430_ST_UART2,
 	OMAP3430_ST_UART3,
 };
+
+struct omap3_uart_regs {
+	u16 dll;
+	u16 dlh;
+	u16 ier;
+	u16 sysc;
+	u16 scr;
+	u16 wer;
+};
+
+static struct omap3_uart_regs uart_context[OMAP_MAX_NR_PORTS];
 #endif
 
 static const u32 *omap_uart_wk_st;

@@ -315,6 +326,60 @@ static ssize_t awake_store(struct kobjec
 	return n;
 }
 
+#ifdef CONFIG_ARCH_OMAP3
+void omap3_uart_save_context(int unum)
+{
+	u16 lcr = 0;
+
+	struct plat_serial8250_port *p = serial_platform_data + unum;
+
+	if (uart_ick[unum] == NULL)
+		return;
+
+	lcr = serial_read_reg(p, UART_LCR);
+	serial_write_reg(p, UART_LCR, 0xBF);
+	uart_context[unum].dll = serial_read_reg(p, UART_DLL);
+	uart_context[unum].dlh = serial_read_reg(p, UART_DLM);
+	serial_write_reg(p, UART_LCR, lcr);
+	uart_context[unum].ier = serial_read_reg(p, UART_IER);
+	uart_context[unum].sysc = serial_read_reg(p, UART_OMAP_SYSC);
+	uart_context[unum].scr = serial_read_reg(p, UART_OMAP_SCR);
+	uart_context[unum].wer = serial_read_reg(p, UART_OMAP_WER);
+}
+EXPORT_SYMBOL(omap3_uart_save_context);
+
+void omap3_uart_restore_context(int unum)
+{
+	u16 efr = 0;
+
+	struct plat_serial8250_port *p = serial_platform_data + unum;
+
+	if (uart_ick[unum] == NULL)
+		return;
+
+	serial_write_reg(p, UART_OMAP_MDR1, 0x7);
+	serial_write_reg(p, UART_LCR, 0xBF); /* Config B mode */
+	efr = serial_read_reg(p, UART_EFR);
+	serial_write_reg(p, UART_EFR, UART_EFR_ECB);
+	serial_write_reg(p, UART_LCR, 0x0); /* Operational mode */
+	serial_write_reg(p, UART_IER, 0x0);
+	serial_write_reg(p, UART_LCR, 0xBF); /* Config B mode */
+	serial_write_reg(p, UART_DLL, uart_context[unum].dll);
+	serial_write_reg(p, UART_DLM, uart_context[unum].dlh);
+	serial_write_reg(p, UART_LCR, 0x0); /* Operational mode */
+	serial_write_reg(p, UART_IER, uart_context[unum].ier);
+	serial_write_reg(p, UART_FCR, 0xA1);
+	serial_write_reg(p, UART_LCR, 0xBF); /* Config B mode */
+	serial_write_reg(p, UART_EFR, efr);
+	serial_write_reg(p, UART_LCR, UART_LCR_WLEN8);
+	serial_write_reg(p, UART_OMAP_SCR, uart_context[unum].scr);
+	serial_write_reg(p, UART_OMAP_WER, uart_context[unum].wer);
+	serial_write_reg(p, UART_OMAP_SYSC, uart_context[unum].sysc);
+	serial_write_reg(p, UART_OMAP_MDR1, 0x00); /* UART 16x mode */
+}
+EXPORT_SYMBOL(omap3_uart_restore_context);
+#endif /* CONFIG_ARCH_OMAP3 */
+
 static struct platform_device serial_device = {
 	.name			= "serial8250",
 	.id			= PLAT8250_DEV_PLATFORM,

Index: linux-omap-2.6/include/linux/serial_reg.h
===================================================================
@@ -323,6 +323,7 @@
 #define UART_OMAP_MVER		0x14	/* Module version register */
 #define UART_OMAP_SYSC		0x15	/* System configuration register */
 #define UART_OMAP_SYSS		0x16	/* System status register */
+#define UART_OMAP_WER		0x17	/* Wake-up enable register */
 
 #endif /* _LINUX_SERIAL_REG_H */
 

Index: linux-omap-2.6/arch/arm/plat-omap/include/mach/serial.h
===================================================================
@@ -40,4 +40,8 @@
 			__ret;						\
 			})
 
+#ifndef __ASSEMBLY__
+extern void omap3_uart_save_context(int unum);
+extern void omap3_uart_restore_context(int unum);
+#endif /* __ASSEMBLY__ */
 #endif