drivers/serial/opencores_yanu.c

   1 /*
   2  * Copyright 2010, Renato Andreola <renato.andreola@imagos.it>
   3  *
   4  * SPDX-License-Identifier:     GPL-2.0+
   5  */
   6
   7 #include <common.h>
   8 #include <watchdog.h>
   9 #include <asm/io.h>
  10 #include <nios2-yanu.h>
  11 #include <serial.h>
  12
  13 DECLARE_GLOBAL_DATA_PTR;
  14
  15 /*-----------------------------------------------------------------*/
  16 /* YANU Imagos serial port */
  17 /*-----------------------------------------------------------------*/
  18
  19 static yanu_uart_t *uart = (yanu_uart_t *)CONFIG_SYS_NIOS_CONSOLE;
  20
  21 #if defined(CONFIG_SYS_NIOS_FIXEDBAUD)
  22
  23 /* Everything's already setup for fixed-baud PTF assignment*/
  24
  25 static void oc_serial_setbrg(void)
  26 {
  27         int n, k;
  28         const unsigned max_uns = 0xFFFFFFFF;
  29         unsigned best_n, best_m, baud;
  30
  31         /* compute best N and M couple */
  32         best_n = YANU_MAX_PRESCALER_N;
  33         for (n = YANU_MAX_PRESCALER_N; n >= 0; n--) {
  34                 if ((unsigned)CONFIG_SYS_CLK_FREQ / (1 << (n + 4)) >=
  35                     (unsigned)CONFIG_BAUDRATE) {
  36                         best_n = n;
  37                         break;
  38                 }
  39         }
  40         for (k = 0;; k++) {
  41                 if ((unsigned)CONFIG_BAUDRATE <= (max_uns >> (15+n-k)))
  42                         break;
  43         }
  44         best_m =
  45             ((unsigned)CONFIG_BAUDRATE * (1 << (15 + n - k))) /
  46             ((unsigned)CONFIG_SYS_CLK_FREQ >> k);
  47
  48         baud = best_m + best_n * YANU_BAUDE;
  49         writel(baud, &uart->baud);
  50
  51         return;
  52 }
  53
  54 #else
  55
  56 static void oc_serial_setbrg(void)
  57 {
  58         int n, k;
  59         const unsigned max_uns = 0xFFFFFFFF;
  60         unsigned best_n, best_m, baud;
  61
  62         /* compute best N and M couple */
  63         best_n = YANU_MAX_PRESCALER_N;
  64         for (n = YANU_MAX_PRESCALER_N; n >= 0; n--) {
  65                 if ((unsigned)CONFIG_SYS_CLK_FREQ / (1 << (n + 4)) >=
  66                     gd->baudrate) {
  67                         best_n = n;
  68                         break;
  69                 }
  70         }
  71         for (k = 0;; k++) {
  72                 if (gd->baudrate <= (max_uns >> (15+n-k)))
  73                         break;
  74         }
  75         best_m =
  76             (gd->baudrate * (1 << (15 + n - k))) /
  77             ((unsigned)CONFIG_SYS_CLK_FREQ >> k);
  78
  79         baud = best_m + best_n * YANU_BAUDE;
  80         writel(baud, &uart->baud);
  81
  82         return;
  83 }
  84
  85
  86 #endif /* CONFIG_SYS_NIOS_FIXEDBAUD */
  87
  88 static int oc_serial_init(void)
  89 {
  90         unsigned action,control;
  91
  92         /* status register cleanup */
  93         action =  YANU_ACTION_RRRDY     |
  94                 YANU_ACTION_RTRDY       |
  95                 YANU_ACTION_ROE         |
  96                 YANU_ACTION_RBRK        |
  97                 YANU_ACTION_RFE         |
  98                 YANU_ACTION_RPE         |
  99             YANU_ACTION_RFE | YANU_ACTION_RFIFO_CLEAR | YANU_ACTION_TFIFO_CLEAR;
 100
 101         writel(action, &uart->action);
 102
 103         /*
 104          * control register cleanup
 105          * no interrupts enabled
 106          * one stop bit
 107          * hardware flow control disabled
 108          * 8 bits
 109          */
 110         control = (0x7 << YANU_CONTROL_BITS_POS);
 111         /* enven parity just to be clean */
 112         control |= YANU_CONTROL_PAREVEN;
 113         /* we set threshold for fifo */
 114         control |= YANU_CONTROL_RDYDLY * YANU_RXFIFO_DLY;
 115         control |= YANU_CONTROL_TXTHR *  YANU_TXFIFO_THR;
 116
 117         writel(control, &uart->control);
 118
 119         /* to set baud rate */
 120         serial_setbrg();
 121
 122         return (0);
 123 }
 124
 125
 126 /*-----------------------------------------------------------------------
 127  * YANU CONSOLE
 128  *---------------------------------------------------------------------*/
 129 static void oc_serial_putc(char c)
 130 {
 131         int tx_chars;
 132         unsigned status;
 133
 134         if (c == '\n')
 135                 serial_putc ('\r');
 136
 137         while (1) {
 138                 status = readl(&uart->status);
 139                 tx_chars = (status>>YANU_TFIFO_CHARS_POS)
 140                         & ((1<<YANU_TFIFO_CHARS_N)-1);
 141                 if (tx_chars < YANU_TXFIFO_SIZE-1)
 142                         break;
 143                 WATCHDOG_RESET ();
 144         }
 145
 146         writel((unsigned char)c, &uart->data);
 147 }
 148
 149 static int oc_serial_tstc(void)
 150 {
 151         unsigned status ;
 152
 153         status = readl(&uart->status);
 154         return (((status >> YANU_RFIFO_CHARS_POS) &
 155                  ((1 << YANU_RFIFO_CHARS_N) - 1)) > 0);
 156 }
 157
 158 static int oc_serial_getc(void)
 159 {
 160         while (serial_tstc() == 0)
 161                 WATCHDOG_RESET ();
 162
 163         /* first we pull the char */
 164         writel(YANU_ACTION_RFIFO_PULL, &uart->action);
 165
 166         return(readl(&uart->data) & YANU_DATA_CHAR_MASK);
 167 }
 168
 169 static struct serial_device oc_serial_drv = {
 170         .name   = "oc_serial",
 171         .start  = oc_serial_init,
 172         .stop   = NULL,
 173         .setbrg = oc_serial_setbrg,
 174         .putc   = oc_serial_putc,
 175         .puts   = default_serial_puts,
 176         .getc   = oc_serial_getc,
 177         .tstc   = oc_serial_tstc,
 178 };
 179
 180 void oc_serial_initialize(void)
 181 {
 182         serial_register(&oc_serial_drv);
 183 }
 184
 185 __weak struct serial_device *default_serial_console(void)
 186 {
 187         return &oc_serial_drv;
 188 }