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