[ros-arm-bringup] 34472: - Implement KdPortPutByteEx and KdPortInitializeEx in KDCOM. Only supports Versatile for now, we can make this more portable later.

Author: ros-arm-bringup
Date: Sun Jul 13 17:16:48 2008
New Revision: 34472

URL: http://svn.reactos.org/svn/reactos?rev=34472&view=rev
Log:
- Implement KdPortPutByteEx and KdPortInitializeEx in KDCOM. Only supports Versatile for
now, we can make this more portable later.

Modified:
    trunk/reactos/drivers/base/kdcom/arm/kdbg.c

Modified: trunk/reactos/drivers/base/kdcom/arm/kdbg.c
URL:
http://svn.reactos.org/svn/reactos/trunk/reactos/drivers/base/kdcom/arm/kdb…
==============================================================================
--- trunk/reactos/drivers/base/kdcom/arm/kdbg.c [iso-8859-1] (original)
+++ trunk/reactos/drivers/base/kdcom/arm/kdbg.c [iso-8859-1] Sun Jul 13 17:16:48 2008
@@ -18,6 +18,7 @@
 #include "windbgkd.h"
 #include <kddll.h>
 #include <ioaccess.h>
+#include <arm/peripherals/pl011.h>
 
 /* GLOBALS ********************************************************************/
 
@@ -30,7 +31,65 @@
 
 KD_PORT_INFORMATION DefaultPort = {0, 0, 0};
 
+//
+// We need to build this in the configuration root and use KeFindConfigurationEntry
+// to recover it later.
+//
+#define HACK 24000000
+
 /* REACTOS FUNCTIONS **********************************************************/
+
+BOOLEAN
+NTAPI
+KdPortInitializeEx(IN PKD_PORT_INFORMATION PortInformation,
+                   IN ULONG Unknown1,
+                   IN ULONG Unknown2)
+{
+    ULONG Divider, Remainder, Fraction;
+    ULONG Baudrate = PortInformation->BaudRate;
+    
+    //
+    // Calculate baudrate clock divider and remainder
+    //
+    Divider   = HACK / (16 * Baudrate);
+    Remainder = HACK % (16 * Baudrate);
+    
+    //
+    // Calculate the fractional part
+    //
+    Fraction  = (8 * Remainder / Baudrate) >> 1;
+    Fraction += (8 * Remainder / Baudrate) & 1;
+    
+    //
+    // Disable interrupts
+    //
+    WRITE_REGISTER_ULONG(UART_PL011_CR, 0);
+    
+    //
+    // Set the baud rate
+    //
+    WRITE_REGISTER_ULONG(UART_PL011_IBRD, Divider);
+    WRITE_REGISTER_ULONG(UART_PL011_FBRD, Fraction);
+    
+    //
+    // Set 8 bits for data, 1 stop bit, no parity, FIFO enabled
+    //
+    WRITE_REGISTER_ULONG(UART_PL011_LCRH,
+                         UART_PL011_LCRH_WLEN_8 | UART_PL011_LCRH_FEN);
+    
+    //
+    // Clear and enable FIFO
+    //
+    WRITE_REGISTER_ULONG(UART_PL011_CR,
+                         UART_PL011_CR_UARTEN |
+                         UART_PL011_CR_TXE |
+                         UART_PL011_CR_RXE);
+    
+    //
+    // Done
+    //
+    return TRUE;
+}
 
 BOOLEAN
 NTAPI
@@ -38,19 +97,10 @@
                  IN ULONG Unknown1,
                  IN ULONG Unknown2)
 {
-    UNIMPLEMENTED;
-    while (TRUE);
-    return TRUE;
-}
-
-BOOLEAN
-NTAPI
-KdPortInitializeEx(IN PKD_PORT_INFORMATION PortInformation,
-                   IN ULONG Unknown1,
-                   IN ULONG Unknown2)
-{
-    UNIMPLEMENTED;
-    return FALSE;
+    //
+    // Call the extended version
+    //
+    return KdPortInitializeEx(PortInformation, Unknown1, Unknown2);
 }
 
 BOOLEAN
@@ -67,6 +117,9 @@
 NTAPI
 KdPortGetByte(OUT PUCHAR ByteReceived)
 {
+    //
+    // Call the extended version
+    //
     return KdPortGetByteEx(&DefaultPort, ByteReceived); 
 }
 
@@ -84,6 +137,9 @@
 NTAPI
 KdPortPollByte(OUT PUCHAR ByteReceived)
 {
+    //
+    // Call the extended version
+    //
     return KdPortPollByteEx(&DefaultPort, ByteReceived);
 }
 
@@ -92,14 +148,24 @@
 KdPortPutByteEx(IN PKD_PORT_INFORMATION PortInformation,
                 IN UCHAR ByteToSend)
 {
-    UNIMPLEMENTED;
-    while (TRUE);
+    //
+    // Wait for ready
+    //
+    while ((READ_REGISTER_ULONG(UART_PL01x_FR) & UART_PL01x_FR_TXFF) != 0);
+    
+    //
+    // Send the character
+    //
+    WRITE_REGISTER_ULONG(UART_PL01x_DR, ByteToSend);
 }
 
 VOID
 NTAPI
 KdPortPutByte(IN UCHAR ByteToSend)
 {
+    //
+    // Call the extended version
+    //
     KdPortPutByteEx(&DefaultPort, ByteToSend);
 }