22317f968381b86ec2d9d84eb245d19816d72c25
[openwrt.git] / target / linux / adm5120 / image / lzma-loader / src / board.c
1 /*
2  * ADM5120 specific board support for LZMA decompressor
3  *
4  * Copyright (C) 2007 OpenWrt.org
5  * Copyright (C) 2007 Gabor Juhos <juhosg at openwrt.org>
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2 of the License, or
10  * (at your option) any later version.
11  *
12  * This program is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15  * General Public License for more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with this program; if not, write to the Free Software
19  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20  */
21
22 #include <stddef.h>
23
24 #define READREG(r)      *(volatile unsigned int *)(r)
25 #define WRITEREG(r,v)   *(volatile unsigned int *)(r) = v
26
27 /*
28  * INTC definitions
29  */
30 #define INTC_BASE       0xB2200000
31
32 /* INTC registers */
33 #define INTC_REG_IRQ_DISABLE    0x0C
34
35 /*
36  * UART definitions
37  */
38 #define UART_BASE       0xB2600000
39 /* UART registers */
40 #define UART_REG_DATA   0x00    /* Data register */
41 #define UART_REG_ECR    0x04    /* Error Clear register */
42 #define UART_REG_LCRH   0x08    /* Line Control High register */
43 #define UART_REG_LCRM   0x0C    /* Line Control Middle register */
44 #define UART_REG_LCRL   0x10    /* Line Control Low register */
45 #define UART_REG_CTRL   0x14    /* Control register */
46 #define UART_REG_FLAG   0x18    /* Flag register */
47
48 /* Control register bits */
49 #define UART_CTRL_EN    ( 1 << 0 )      /* UART enable */
50
51 /* Line Control High register bits */
52 #define UART_LCRH_FEN   ( 1 << 4 )      /* FIFO enable */
53
54 /* Flag register bits */
55 #define UART_FLAG_CTS   ( 1 << 0 )
56 #define UART_FLAG_DSR   ( 1 << 1 )
57 #define UART_FLAG_DCD   ( 1 << 2 )
58 #define UART_FLAG_BUSY  ( 1 << 3 )
59 #define UART_FLAG_RXFE  ( 1 << 4 )      /* RX FIFO empty */
60 #define UART_FLAG_TXFF  ( 1 << 5 )      /* TX FIFO full */
61 #define UART_FLAG_RXFF  ( 1 << 6 )      /* RX FIFO full */
62 #define UART_FLAG_TXFE  ( 1 << 7 )      /* TX FIFO empty */
63
64 /*
65  * SWITCH definitions
66  */
67 #define SWITCH_BASE     0xB2000000
68
69 #define SWITCH_REG_CPUP_CONF    0x0024
70 #define SWITCH_REG_PORT_CONF0   0x0028
71
72 #define SWITCH_REG_GPIO_CONF0   0x00B8
73 #define SWITCH_REG_GPIO_CONF2   0x00BC
74
75 #define SWITCH_REG_PORT0_LED    0x0100
76 #define SWITCH_REG_PORT1_LED    0x0104
77 #define SWITCH_REG_PORT2_LED    0x0108
78 #define SWITCH_REG_PORT3_LED    0x010C
79 #define SWITCH_REG_PORT4_LED    0x0110
80
81 #define SWITCH_PORTS_HW         0x3F            /* Hardware Ports */
82
83 /* CPUP_CONF register bits */
84 #define CPUP_CONF_DCPUP         ( 1 << 0 )      /* Disable CPU port */
85
86 /* PORT_CONF0 register bits */
87 #define PORT_CONF0_DP_SHIFT     0       /* disable port shift*/
88
89
90 /*
91  * UART routines
92  */
93
94 #define UART_READ(r)    READREG(UART_BASE+(r))
95 #define UART_WRITE(r,v) WRITEREG(UART_BASE+(r),(v))
96
97 static void uart_init(void)
98 {
99 #if 0
100         unsigned int t;
101
102         /* disable uart */
103         UART_WRITE(UART_REG_CTRL, 0);
104
105         /* keep current baud rate */
106         t = UART_READ(UART_REG_LCRM);
107         UART_WRITE(UART_REG_LCRM, t);
108         t = UART_READ(UART_REG_LCRL);
109         UART_WRITE(UART_REG_LCRL, t);
110
111         /* keep data, stop, and parity bits, but disable FIFO */
112         t = UART_READ(UART_REG_LCRH);
113         t &= ~(UART_LCRH_FEN);
114         UART_WRITE(UART_REG_LCRH, t );
115
116         /* clear error bits */
117         UART_WRITE(UART_REG_ECR, 0xFF);
118
119         /* enable uart, and disable interrupts */
120         UART_WRITE(UART_REG_CTRL, UART_CTRL_EN);
121 #endif
122 }
123
124 /*
125  * INTC routines
126  */
127
128 #define INTC_READ(r)    READREG(INTC_BASE+(r))
129 #define INTC_WRITE(r,v) WRITEREG(INTC_BASE+(r),v)
130
131 static void intc_init(void)
132 {
133         INTC_WRITE(INTC_REG_IRQ_DISABLE, 0xFFFFFFFF);
134 }
135
136 /*
137  * SWITCH routines
138  */
139
140 #define SWITCH_READ(r)          READREG(SWITCH_BASE+(r))
141 #define SWITCH_WRITE(r,v)       WRITEREG(SWITCH_BASE+(r),v)
142
143 static void switch_init(void)
144 {
145         /* disable PHYS ports */
146         SWITCH_WRITE(SWITCH_REG_PORT_CONF0,
147             (SWITCH_PORTS_HW << PORT_CONF0_DP_SHIFT));
148
149         /* disable CPU port */
150         SWITCH_WRITE(SWITCH_REG_CPUP_CONF, CPUP_CONF_DCPUP);
151
152         /* disable GPIO lines */
153         SWITCH_WRITE(SWITCH_REG_GPIO_CONF0, 0);
154         SWITCH_WRITE(SWITCH_REG_GPIO_CONF2, 0);
155
156         /* disable LED lines */
157         SWITCH_WRITE(SWITCH_REG_PORT0_LED, 0);
158         SWITCH_WRITE(SWITCH_REG_PORT1_LED, 0);
159         SWITCH_WRITE(SWITCH_REG_PORT2_LED, 0);
160         SWITCH_WRITE(SWITCH_REG_PORT3_LED, 0);
161         SWITCH_WRITE(SWITCH_REG_PORT4_LED, 0);
162 }
163
164 void board_putc(int ch)
165 {
166         while ((UART_READ(UART_REG_FLAG) & UART_FLAG_TXFE) == 0);
167
168         UART_WRITE(UART_REG_DATA, ch);
169
170         while ((UART_READ(UART_REG_FLAG) & UART_FLAG_TXFE) == 0);
171 }
172
173 void board_init(void)
174 {
175         intc_init();
176         switch_init();
177         uart_init();
178 }