arch/nios2/boot/compressed/console.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  *  Copyright (C) 2008-2010 Thomas Chou <thomas@wytron.com.tw>
   4  */
   5
   6 #include <linux/io.h>
   7
   8 #if (defined(CONFIG_SERIAL_ALTERA_JTAGUART_CONSOLE) && defined(JTAG_UART_BASE))\
   9         || (defined(CONFIG_SERIAL_ALTERA_UART_CONSOLE) && defined(UART0_BASE))
  10 static void *my_ioremap(unsigned long physaddr)
  11 {
  12         return (void *)(physaddr | CONFIG_NIOS2_IO_REGION_BASE);
  13 }
  14 #endif
  15
  16 #if defined(CONFIG_SERIAL_ALTERA_JTAGUART_CONSOLE) && defined(JTAG_UART_BASE)
  17
  18 #define ALTERA_JTAGUART_SIZE                            8
  19 #define ALTERA_JTAGUART_DATA_REG                        0
  20 #define ALTERA_JTAGUART_CONTROL_REG                     4
  21 #define ALTERA_JTAGUART_CONTROL_AC_MSK                  (0x00000400)
  22 #define ALTERA_JTAGUART_CONTROL_WSPACE_MSK              (0xFFFF0000)
  23 static void *uartbase;
  24
  25 #if defined(CONFIG_SERIAL_ALTERA_JTAGUART_CONSOLE_BYPASS)
  26 static void jtag_putc(int ch)
  27 {
  28         if (readl(uartbase + ALTERA_JTAGUART_CONTROL_REG) &
  29                 ALTERA_JTAGUART_CONTROL_WSPACE_MSK)
  30                 writeb(ch, uartbase + ALTERA_JTAGUART_DATA_REG);
  31 }
  32 #else
  33 static void jtag_putc(int ch)
  34 {
  35         while ((readl(uartbase + ALTERA_JTAGUART_CONTROL_REG) &
  36                 ALTERA_JTAGUART_CONTROL_WSPACE_MSK) == 0)
  37                 ;
  38         writeb(ch, uartbase + ALTERA_JTAGUART_DATA_REG);
  39 }
  40 #endif
  41
  42 static int putchar(int ch)
  43 {
  44         jtag_putc(ch);
  45         return ch;
  46 }
  47
  48 static void console_init(void)
  49 {
  50         uartbase = my_ioremap((unsigned long) JTAG_UART_BASE);
  51         writel(ALTERA_JTAGUART_CONTROL_AC_MSK,
  52                 uartbase + ALTERA_JTAGUART_CONTROL_REG);
  53 }
  54
  55 #elif defined(CONFIG_SERIAL_ALTERA_UART_CONSOLE) && defined(UART0_BASE)
  56
  57 #define ALTERA_UART_SIZE                32
  58 #define ALTERA_UART_TXDATA_REG          4
  59 #define ALTERA_UART_STATUS_REG          8
  60 #define ALTERA_UART_DIVISOR_REG         16
  61 #define ALTERA_UART_STATUS_TRDY_MSK     (0x40)
  62 static unsigned uartbase;
  63
  64 static void uart_putc(int ch)
  65 {
  66         int i;
  67
  68         for (i = 0; (i < 0x10000); i++) {
  69                 if (readw(uartbase + ALTERA_UART_STATUS_REG) &
  70                         ALTERA_UART_STATUS_TRDY_MSK)
  71                         break;
  72         }
  73         writeb(ch, uartbase + ALTERA_UART_TXDATA_REG);
  74 }
  75
  76 static int putchar(int ch)
  77 {
  78         uart_putc(ch);
  79         if (ch == '\n')
  80                 uart_putc('\r');
  81         return ch;
  82 }
  83
  84 static void console_init(void)
  85 {
  86         unsigned int baud, baudclk;
  87
  88         uartbase = (unsigned long) my_ioremap((unsigned long) UART0_BASE);
  89         baud = CONFIG_SERIAL_ALTERA_UART_BAUDRATE;
  90         baudclk = UART0_FREQ / baud;
  91         writew(baudclk, uartbase + ALTERA_UART_DIVISOR_REG);
  92 }
  93
  94 #else
  95
  96 static int putchar(int ch)
  97 {
  98         return ch;
  99 }
 100
 101 static void console_init(void)
 102 {
 103 }
 104
 105 #endif
 106
 107 static int puts(const char *s)
 108 {
 109         while (*s)
 110                 putchar(*s++);
 111         return 0;
 112 }