From: Ahmad Fatoum <ah...@a3f.at>

For use in PBL, import dbgu init code from:
https://github.com/linux4sam/at91bootstrap/blob/v3.8.12/driver/at91_usart.c

Signed-off-by: Ahmad Fatoum <a.fat...@pengutronix.de>
---
 arch/arm/mach-at91/include/mach/at91_dbgu.h | 57 ++++++++++++++++++++-
 1 file changed, 56 insertions(+), 1 deletion(-)

diff --git a/arch/arm/mach-at91/include/mach/at91_dbgu.h 
b/arch/arm/mach-at91/include/mach/at91_dbgu.h
index 3b5948566e52..a6f44f744f2a 100644
--- a/arch/arm/mach-at91/include/mach/at91_dbgu.h
+++ b/arch/arm/mach-at91/include/mach/at91_dbgu.h
@@ -5,7 +5,7 @@
  * Copyright (C) SAN People
  *
  * Debug Unit (DBGU) - System peripherals registers.
- * Based on AT91RM9200 datasheet revision E.
+ * Based on AT91RM9200 datasheet revision E and SAMA5D3 datasheet revision B.
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
@@ -16,9 +16,37 @@
 #ifndef AT91_DBGU_H
 #define AT91_DBGU_H
 
+#include <asm/io.h>
+
 #if !defined(CONFIG_ARCH_AT91X40)
 #define AT91_DBGU_CR           (0x00)  /* Control Register */
+#define        AT91_DBGU_RSTRX         (1 << 2)                /* Reset 
Receiver */
+#define        AT91_DBGU_RSTTX         (1 << 3)                /* Reset 
Transmitter */
+#define        AT91_DBGU_RXEN          (1 << 4)                /* Receiver 
Enable */
+#define        AT91_DBGU_RXDIS         (1 << 5)                /* Receiver 
Disable */
+#define        AT91_DBGU_TXEN          (1 << 6)                /* Transmitter 
Enable */
+#define        AT91_DBGU_TXDIS         (1 << 7)                /* Transmitter 
Disable */
+#define        AT91_DBGU_RSTSTA        (1 << 8)                /* Reset Status 
Bits */
 #define AT91_DBGU_MR           (0x04)  /* Mode Register */
+#define                AT91_DBGU_NBSTOP_1BIT           (0 << 12) /* 1 stop bit 
*/
+#define                AT91_DBGU_NBSTOP_1_5BIT (1 << 12) /* 1.5 stop bits */
+#define                AT91_DBGU_NBSTOP_2BIT           (2 << 12) /* 2 stop 
bits */
+
+#define                AT91_DBGU_CHRL_5BIT     (0 << 6) /* 5 bit character 
length */
+#define                AT91_DBGU_CHRL_6BIT     (1 << 6) /* 6 bit character 
length */
+#define                AT91_DBGU_CHRL_7BIT     (2 << 6) /* 7 bit character 
length */
+#define                AT91_DBGU_CHRL_8BIT     (3 << 6) /* 8 bit character 
length */
+
+#define        AT91_DBGU_PAR_EVEN      (0 << 9)                /* Even Parity 
*/
+#define        AT91_DBGU_PAR_ODD       (1 << 9)                /* Odd Parity */
+#define        AT91_DBGU_PAR_SPACE     (2 << 9)                /* Space: Force 
Parity to 0 */
+#define        AT91_DBGU_PAR_MARK      (3 << 9)                /* Mark: Force 
Parity to 1 */
+#define        AT91_DBGU_PAR_NONE      (4 << 9)                /* No Parity */
+
+#define        AT91_DBGU_CHMODE_NORMAL (0 << 14) /* Normal mode */
+#define        AT91_DBGU_CHMODE_AUTO           (1 << 14) /* Automatic Echo */
+#define        AT91_DBGU_CHMODE_LOCAL          (2 << 14) /* Local Loopback */
+#define        AT91_DBGU_CHMODE_REMOTE (3 << 14) /* Remote Loopback */
 #define AT91_DBGU_IER          (0x08)  /* Interrupt Enable Register */
 #define                AT91_DBGU_TXRDY         (1 << 1)                /* 
Transmitter Ready */
 #define                AT91_DBGU_TXEMPTY       (1 << 9)                /* 
Transmitter Empty */
@@ -63,4 +91,31 @@
 #define                AT91_CIDR_NVPTYP        (7    << 28)            /* 
Nonvolatile Program Memory Type */
 #define                AT91_CIDR_EXT           (1    << 31)            /* 
Extension Flag */
 
+#ifndef __ASSEMBLY__
+#ifdef CONFIG_DEBUG_LL
+static inline void at91_dbgu_setup_ll(unsigned long dbgu_base, unsigned 
baudrate)
+{
+       __raw_writel(~0, dbgu_base + AT91_DBGU_IDR);
+
+       __raw_writel(AT91_DBGU_RSTRX
+                    | AT91_DBGU_RSTTX
+                    | AT91_DBGU_RXDIS
+                    | AT91_DBGU_TXDIS,
+                    dbgu_base + AT91_DBGU_CR);
+
+       __raw_writel(baudrate, dbgu_base + AT91_DBGU_BRGR);
+
+       __raw_writel(AT91_DBGU_PAR_NONE
+                    | AT91_DBGU_CHMODE_NORMAL
+                    | AT91_DBGU_CHRL_8BIT
+                    | AT91_DBGU_NBSTOP_1BIT,
+                    dbgu_base + AT91_DBGU_MR);
+
+       __raw_writel(AT91_DBGU_RXEN | AT91_DBGU_TXEN, dbgu_base + AT91_DBGU_CR);
+}
+#else
+static inline void at91_dbgu_setup_ll(unsigned long dbgu_base, unsigned 
baudrate) {}
+#endif
+#endif
+
 #endif
-- 
2.20.1


_______________________________________________
barebox mailing list
barebox@lists.infradead.org
http://lists.infradead.org/mailman/listinfo/barebox

Reply via email to