drivers/input/ps2ser.c

   1 /***********************************************************************
   2  *
   3  * (C) Copyright 2004
   4  * DENX Software Engineering
   5  * Wolfgang Denk, wd@denx.de
   6  * All rights reserved.
   7  *
   8  * Simple 16550A serial driver
   9  *
  10  * Originally from linux source (drivers/char/ps2ser.c)
  11  *
  12  * Used by the PS/2 multiplexer driver (ps2mult.c)
  13  *
  14  ***********************************************************************/
  15
  16 #include <common.h>
  17
  18 #ifdef CONFIG_PS2SERIAL
  19
  20 #include <asm/io.h>
  21 #include <asm/atomic.h>
  22 #include <ps2mult.h>
  23 #if defined(CFG_NS16550) || defined(CONFIG_MPC85xx)
  24 #include <ns16550.h>
  25 #endif
  26
  27 DECLARE_GLOBAL_DATA_PTR;
  28
  29 /* #define      DEBUG */
  30
  31 #define PS2SER_BAUD     57600
  32
  33 #ifdef CONFIG_MPC5xxx
  34 #if CONFIG_PS2SERIAL == 1
  35 #define PSC_BASE MPC5XXX_PSC1
  36 #elif CONFIG_PS2SERIAL == 2
  37 #define PSC_BASE MPC5XXX_PSC2
  38 #elif CONFIG_PS2SERIAL == 3
  39 #define PSC_BASE MPC5XXX_PSC3
  40 #elif defined(CONFIG_MGT5100)
  41 #error CONFIG_PS2SERIAL must be in 1, 2 or 3
  42 #elif CONFIG_PS2SERIAL == 4
  43 #define PSC_BASE MPC5XXX_PSC4
  44 #elif CONFIG_PS2SERIAL == 5
  45 #define PSC_BASE MPC5XXX_PSC5
  46 #elif CONFIG_PS2SERIAL == 6
  47 #define PSC_BASE MPC5XXX_PSC6
  48 #else
  49 #error CONFIG_PS2SERIAL must be in 1 ... 6
  50 #endif
  51
  52 #elif defined(CONFIG_MPC8540) || defined(CONFIG_MPC8541) || \
  53       defined(CONFIG_MPC8548) || defined(CONFIG_MPC8555)
  54
  55 #if CONFIG_PS2SERIAL == 1
  56 #define COM_BASE (CFG_CCSRBAR+0x4500)
  57 #elif CONFIG_PS2SERIAL == 2
  58 #define COM_BASE (CFG_CCSRBAR+0x4600)
  59 #else
  60 #error CONFIG_PS2SERIAL must be in 1 ... 2
  61 #endif
  62
  63 #endif /* CONFIG_MPC5xxx / CONFIG_MPC8540 / other */
  64
  65 static int      ps2ser_getc_hw(void);
  66 static void     ps2ser_interrupt(void *dev_id);
  67
  68 extern struct   serial_state rs_table[]; /* in serial.c */
  69 #if !defined(CONFIG_MPC5xxx) && !defined(CONFIG_MPC8540) && \
  70     !defined(CONFIG_MPC8541) && !defined(CONFIG_MPC8548) && \
  71     !defined(CONFIG_MPC8555)
  72 static struct   serial_state *state;
  73 #endif
  74
  75 static u_char   ps2buf[PS2BUF_SIZE];
  76 static atomic_t ps2buf_cnt;
  77 static int      ps2buf_in_idx;
  78 static int      ps2buf_out_idx;
  79
  80 #ifdef CONFIG_MPC5xxx
  81 int ps2ser_init(void)
  82 {
  83         volatile struct mpc5xxx_psc *psc = (struct mpc5xxx_psc *)PSC_BASE;
  84         unsigned long baseclk;
  85         int div;
  86
  87         /* reset PSC */
  88         psc->command = PSC_SEL_MODE_REG_1;
  89
  90         /* select clock sources */
  91 #if defined(CONFIG_MGT5100)
  92         psc->psc_clock_select = 0xdd00;
  93         baseclk = (CFG_MPC5XXX_CLKIN + 16) / 32;
  94 #elif defined(CONFIG_MPC5200)
  95         psc->psc_clock_select = 0;
  96         baseclk = (gd->ipb_clk + 16) / 32;
  97 #endif
  98
  99         /* switch to UART mode */
 100         psc->sicr = 0;
 101
 102         /* configure parity, bit length and so on */
 103 #if defined(CONFIG_MGT5100)
 104         psc->mode = PSC_MODE_ERR | PSC_MODE_8_BITS | PSC_MODE_PARNONE;
 105 #elif defined(CONFIG_MPC5200)
 106         psc->mode = PSC_MODE_8_BITS | PSC_MODE_PARNONE;
 107 #endif
 108         psc->mode = PSC_MODE_ONE_STOP;
 109
 110         /* set up UART divisor */
 111         div = (baseclk + (PS2SER_BAUD/2)) / PS2SER_BAUD;
 112         psc->ctur = (div >> 8) & 0xff;
 113         psc->ctlr = div & 0xff;
 114
 115         /* disable all interrupts */
 116         psc->psc_imr = 0;
 117
 118         /* reset and enable Rx/Tx */
 119         psc->command = PSC_RST_RX;
 120         psc->command = PSC_RST_TX;
 121         psc->command = PSC_RX_ENABLE | PSC_TX_ENABLE;
 122
 123         return (0);
 124 }
 125
 126 #elif defined(CONFIG_MPC8540) || defined(CONFIG_MPC8541) || \
 127       defined(CONFIG_MPC8548) || defined(CONFIG_MPC8555)
 128 int ps2ser_init(void)
 129 {
 130         NS16550_t com_port = (NS16550_t)COM_BASE;
 131
 132         com_port->ier = 0x00;
 133         com_port->lcr = LCR_BKSE | LCR_8N1;
 134         com_port->dll = (CFG_NS16550_CLK / 16 / PS2SER_BAUD) & 0xff;
 135         com_port->dlm = ((CFG_NS16550_CLK / 16 / PS2SER_BAUD) >> 8) & 0xff;
 136         com_port->lcr = LCR_8N1;
 137         com_port->mcr = (MCR_DTR | MCR_RTS);
 138         com_port->fcr = (FCR_FIFO_EN | FCR_RXSR | FCR_TXSR);
 139
 140         return (0);
 141 }
 142
 143 #else /* !CONFIG_MPC5xxx && !CONFIG_MPC8540 / other */
 144
 145 static inline unsigned int ps2ser_in(int offset)
 146 {
 147         return readb((unsigned long) state->iomem_base + offset);
 148 }
 149
 150 static inline void ps2ser_out(int offset, int value)
 151 {
 152         writeb(value, (unsigned long) state->iomem_base + offset);
 153 }
 154
 155 int ps2ser_init(void)
 156 {
 157         int quot;
 158         unsigned cval;
 159
 160         state = rs_table + CONFIG_PS2SERIAL;
 161
 162         quot = state->baud_base / PS2SER_BAUD;
 163         cval = 0x3; /* 8N1 - 8 data bits, no parity bits, 1 stop bit */
 164
 165           /* Set speed, enable interrupts, enable FIFO
 166            */
 167         ps2ser_out(UART_LCR, cval | UART_LCR_DLAB);
 168         ps2ser_out(UART_DLL, quot & 0xff);
 169         ps2ser_out(UART_DLM, quot >> 8);
 170         ps2ser_out(UART_LCR, cval);
 171         ps2ser_out(UART_IER, UART_IER_RDI);
 172         ps2ser_out(UART_MCR, UART_MCR_OUT2 | UART_MCR_DTR | UART_MCR_RTS);
 173         ps2ser_out(UART_FCR,
 174             UART_FCR_ENABLE_FIFO | UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT);
 175
 176         /* If we read 0xff from the LSR, there is no UART here
 177          */
 178         if (ps2ser_in(UART_LSR) == 0xff) {
 179                 printf ("ps2ser.c: no UART found\n");
 180                 return -1;
 181         }
 182
 183         irq_install_handler(state->irq, ps2ser_interrupt, NULL);
 184
 185         return 0;
 186 }
 187 #endif /* CONFIG_MPC5xxx / CONFIG_MPC8540 / other */
 188
 189 void ps2ser_putc(int chr)
 190 {
 191 #ifdef CONFIG_MPC5xxx
 192         volatile struct mpc5xxx_psc *psc = (struct mpc5xxx_psc *)PSC_BASE;
 193 #elif defined(CONFIG_MPC8540) || defined(CONFIG_MPC8541) || \
 194       defined(CONFIG_MPC8548) || defined(CONFIG_MPC8555)
 195         NS16550_t com_port = (NS16550_t)COM_BASE;
 196 #endif
 197 #ifdef DEBUG
 198         printf(">>>> 0x%02x\n", chr);
 199 #endif
 200
 201 #ifdef CONFIG_MPC5xxx
 202         while (!(psc->psc_status & PSC_SR_TXRDY));
 203
 204         psc->psc_buffer_8 = chr;
 205 #elif defined(CONFIG_MPC8540) || defined(CONFIG_MPC8541) || \
 206       defined(CONFIG_MPC8548) || defined(CONFIG_MPC8555)
 207         while ((com_port->lsr & LSR_THRE) == 0);
 208         com_port->thr = chr;
 209 #else
 210         while (!(ps2ser_in(UART_LSR) & UART_LSR_THRE));
 211
 212         ps2ser_out(UART_TX, chr);
 213 #endif
 214 }
 215
 216 static int ps2ser_getc_hw(void)
 217 {
 218 #ifdef CONFIG_MPC5xxx
 219         volatile struct mpc5xxx_psc *psc = (struct mpc5xxx_psc *)PSC_BASE;
 220 #elif defined(CONFIG_MPC8540) || defined(CONFIG_MPC8541) || \
 221       defined(CONFIG_MPC8548) || defined(CONFIG_MPC8555)
 222         NS16550_t com_port = (NS16550_t)COM_BASE;
 223 #endif
 224         int res = -1;
 225
 226 #ifdef CONFIG_MPC5xxx
 227         if (psc->psc_status & PSC_SR_RXRDY) {
 228                 res = (psc->psc_buffer_8);
 229         }
 230 #elif defined(CONFIG_MPC8540) || defined(CONFIG_MPC8541) || \
 231       defined(CONFIG_MPC8548) || defined(CONFIG_MPC8555)
 232         if (com_port->lsr & LSR_DR) {
 233                 res = com_port->rbr;
 234         }
 235 #else
 236         if (ps2ser_in(UART_LSR) & UART_LSR_DR) {
 237                 res = (ps2ser_in(UART_RX));
 238         }
 239 #endif
 240
 241         return res;
 242 }
 243
 244 int ps2ser_getc(void)
 245 {
 246         volatile int chr;
 247         int flags;
 248
 249 #ifdef DEBUG
 250         printf("<< ");
 251 #endif
 252
 253         flags = disable_interrupts();
 254
 255         do {
 256                 if (atomic_read(&ps2buf_cnt) != 0) {
 257                         chr = ps2buf[ps2buf_out_idx++];
 258                         ps2buf_out_idx &= (PS2BUF_SIZE - 1);
 259                         atomic_dec(&ps2buf_cnt);
 260                 } else {
 261                         chr = ps2ser_getc_hw();
 262                 }
 263         }
 264         while (chr < 0);
 265
 266         if (flags) enable_interrupts();
 267
 268 #ifdef DEBUG
 269         printf("0x%02x\n", chr);
 270 #endif
 271
 272         return chr;
 273 }
 274
 275 int ps2ser_check(void)
 276 {
 277         int flags;
 278
 279         flags = disable_interrupts();
 280         ps2ser_interrupt(NULL);
 281         if (flags) enable_interrupts();
 282
 283         return atomic_read(&ps2buf_cnt);
 284 }
 285
 286 static void ps2ser_interrupt(void *dev_id)
 287 {
 288 #ifdef CONFIG_MPC5xxx
 289         volatile struct mpc5xxx_psc *psc = (struct mpc5xxx_psc *)PSC_BASE;
 290 #elif defined(CONFIG_MPC8540) || defined(CONFIG_MPC8541) || \
 291       defined(CONFIG_MPC8548) || defined(CONFIG_MPC8555)
 292         NS16550_t com_port = (NS16550_t)COM_BASE;
 293 #endif
 294         int chr;
 295         int status;
 296
 297         do {
 298                 chr = ps2ser_getc_hw();
 299 #ifdef CONFIG_MPC5xxx
 300                 status = psc->psc_status;
 301 #elif defined(CONFIG_MPC8540) || defined(CONFIG_MPC8541) || \
 302       defined(CONFIG_MPC8548) || defined(CONFIG_MPC8555)
 303                 status = com_port->lsr;
 304 #else
 305                 status = ps2ser_in(UART_IIR);
 306 #endif
 307                 if (chr < 0) continue;
 308
 309                 if (atomic_read(&ps2buf_cnt) < PS2BUF_SIZE) {
 310                         ps2buf[ps2buf_in_idx++] = chr;
 311                         ps2buf_in_idx &= (PS2BUF_SIZE - 1);
 312                         atomic_inc(&ps2buf_cnt);
 313                 } else {
 314                         printf ("ps2ser.c: buffer overflow\n");
 315                 }
 316 #ifdef CONFIG_MPC5xxx
 317         } while (status & PSC_SR_RXRDY);
 318 #elif defined(CONFIG_MPC8540) || defined(CONFIG_MPC8541) || \
 319       defined(CONFIG_MPC8548) || defined(CONFIG_MPC8555)
 320         } while (status & LSR_DR);
 321 #else
 322         } while (status & UART_IIR_RDI);
 323 #endif
 324
 325         if (atomic_read(&ps2buf_cnt)) {
 326                 ps2mult_callback(atomic_read(&ps2buf_cnt));
 327         }
 328 }
 329
 330 #endif /* CONFIG_PS2SERIAL */