Fix regression in SMDK6400
[platform/kernel/u-boot.git] / drivers / serial / serial_lpc2292.c
1 /*
2  * (C) Copyright 2002-2004
3  * Wolfgang Denk, DENX Software Engineering, <wd@denx.de>
4  *
5  * (C) Copyright 2002
6  * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
7  * Marius Groeger <mgroeger@sysgo.de>
8  *
9  * (C) Copyright 2002
10  * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
11  * Alex Zuepke <azu@sysgo.de>
12  *
13  * Copyright (C) 1999 2000 2001 Erik Mouw (J.A.K.Mouw@its.tudelft.nl)
14  *
15  * This program is free software; you can redistribute it and/or modify
16  * it under the terms of the GNU General Public License as published by
17  * the Free Software Foundation; either version 2 of the License, or
18  * (at your option) any later version.
19  *
20  * This program is distributed in the hope that it will be useful,
21  * but WITHOUT ANY WARRANTY; without even the implied warranty of
22  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
23  * GNU General Public License for more details.
24  *
25  * You should have received a copy of the GNU General Public License
26  * along with this program; if not, write to the Free Software
27  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
28  *
29  */
30
31 #include <common.h>
32 #include <asm/arch/hardware.h>
33
34 DECLARE_GLOBAL_DATA_PTR;
35
36 void serial_setbrg (void)
37 {
38         unsigned short divisor = 0;
39
40         switch (gd->baudrate) {
41         case   1200:    divisor = 3072; break;
42         case   9600:    divisor =  384; break;
43         case  19200:    divisor =  192; break;
44         case  38400:    divisor =   96; break;
45         case  57600:    divisor =   64; break;
46         case 115200:    divisor =   32; break;
47         default:        hang ();        break;
48         }
49
50         /* init serial UART0 */
51         PUT8(U0LCR, 0);
52         PUT8(U0IER, 0);
53         PUT8(U0LCR, 0x80);      /* DLAB=1 */
54         PUT8(U0DLL, (unsigned char)(divisor & 0x00FF));
55         PUT8(U0DLM, (unsigned char)(divisor >> 8));
56         PUT8(U0LCR, 0x03);      /* 8N1, DLAB=0  */
57         PUT8(U0FCR, 1);         /* Enable RX and TX FIFOs */
58 }
59
60 int serial_init (void)
61 {
62         unsigned long pinsel0;
63
64         serial_setbrg ();
65
66         pinsel0 = GET32(PINSEL0);
67         pinsel0 &= ~(0x00000003);
68         pinsel0 |= 5;
69         PUT32(PINSEL0, pinsel0);
70
71         return (0);
72 }
73
74 void serial_putc (const char c)
75 {
76         if (c == '\n')
77         {
78                 while((GET8(U0LSR) & (1<<5)) == 0); /* Wait for empty U0THR */
79                 PUT8(U0THR, '\r');
80         }
81
82         while((GET8(U0LSR) & (1<<5)) == 0); /* Wait for empty U0THR */
83         PUT8(U0THR, c);
84 }
85
86 int serial_getc (void)
87 {
88         while((GET8(U0LSR) & 1) == 0);
89         return GET8(U0RBR);
90 }
91
92 void
93 serial_puts (const char *s)
94 {
95         while (*s) {
96                 serial_putc (*s++);
97         }
98 }
99
100 /* Test if there is a byte to read */
101 int serial_tstc (void)
102 {
103         return (GET8(U0LSR) & 1);
104 }