]>
git.ipfire.org Git - people/ms/u-boot.git/blob - drivers/input/ps2ser.c
a655a16d7555b4955faae01c53bcaf066c11366f
1 /***********************************************************************
3 * (C) Copyright 2004-2009
4 * DENX Software Engineering
5 * Wolfgang Denk, wd@denx.de
7 * Simple 16550A serial driver
9 * Originally from linux source (drivers/char/ps2ser.c)
11 * Used by the PS/2 multiplexer driver (ps2mult.c)
13 ***********************************************************************/
18 #include <asm/atomic.h>
20 /* This is needed for ns16550.h */
21 #ifndef CONFIG_SYS_NS16550_REG_SIZE
22 #define CONFIG_SYS_NS16550_REG_SIZE 1
26 DECLARE_GLOBAL_DATA_PTR
;
30 #define PS2SER_BAUD 57600
33 #if CONFIG_PS2SERIAL == 1
34 #define PSC_BASE MPC5XXX_PSC1
35 #elif CONFIG_PS2SERIAL == 2
36 #define PSC_BASE MPC5XXX_PSC2
37 #elif CONFIG_PS2SERIAL == 3
38 #define PSC_BASE MPC5XXX_PSC3
39 #elif CONFIG_PS2SERIAL == 4
40 #define PSC_BASE MPC5XXX_PSC4
41 #elif CONFIG_PS2SERIAL == 5
42 #define PSC_BASE MPC5XXX_PSC5
43 #elif CONFIG_PS2SERIAL == 6
44 #define PSC_BASE MPC5XXX_PSC6
46 #error CONFIG_PS2SERIAL must be in 1 ... 6
51 #if CONFIG_PS2SERIAL == 1
52 #define COM_BASE (CONFIG_SYS_CCSRBAR+0x4500)
53 #elif CONFIG_PS2SERIAL == 2
54 #define COM_BASE (CONFIG_SYS_CCSRBAR+0x4600)
56 #error CONFIG_PS2SERIAL must be in 1 ... 2
59 #endif /* CONFIG_MPC5xxx / other */
61 static int ps2ser_getc_hw(void);
62 static void ps2ser_interrupt(void *dev_id
);
64 extern struct serial_state rs_table
[]; /* in serial.c */
66 static u_char ps2buf
[PS2BUF_SIZE
];
67 static atomic_t ps2buf_cnt
;
68 static int ps2buf_in_idx
;
69 static int ps2buf_out_idx
;
74 volatile struct mpc5xxx_psc
*psc
= (struct mpc5xxx_psc
*)PSC_BASE
;
75 unsigned long baseclk
;
79 psc
->command
= PSC_SEL_MODE_REG_1
;
81 /* select clock sources */
82 psc
->psc_clock_select
= 0;
83 baseclk
= (gd
->ipb_clk
+ 16) / 32;
85 /* switch to UART mode */
88 /* configure parity, bit length and so on */
89 psc
->mode
= PSC_MODE_8_BITS
| PSC_MODE_PARNONE
;
90 psc
->mode
= PSC_MODE_ONE_STOP
;
92 /* set up UART divisor */
93 div
= (baseclk
+ (PS2SER_BAUD
/2)) / PS2SER_BAUD
;
94 psc
->ctur
= (div
>> 8) & 0xff;
95 psc
->ctlr
= div
& 0xff;
97 /* disable all interrupts */
100 /* reset and enable Rx/Tx */
101 psc
->command
= PSC_RST_RX
;
102 psc
->command
= PSC_RST_TX
;
103 psc
->command
= PSC_RX_ENABLE
| PSC_TX_ENABLE
;
110 int ps2ser_init(void)
112 NS16550_t com_port
= (NS16550_t
)COM_BASE
;
114 com_port
->ier
= 0x00;
115 com_port
->lcr
= UART_LCR_BKSE
| UART_LCR_8N1
;
116 com_port
->dll
= (CONFIG_SYS_NS16550_CLK
/ 16 / PS2SER_BAUD
) & 0xff;
117 com_port
->dlm
= ((CONFIG_SYS_NS16550_CLK
/ 16 / PS2SER_BAUD
) >> 8) & 0xff;
118 com_port
->lcr
= UART_LCR_8N1
;
119 com_port
->mcr
= (UART_MCR_DTR
| UART_MCR_RTS
);
120 com_port
->fcr
= (UART_FCR_FIFO_EN
| UART_FCR_RXSR
| UART_FCR_TXSR
);
125 #endif /* CONFIG_MPC5xxx / other */
127 void ps2ser_putc(int chr
)
129 #ifdef CONFIG_MPC5xxx
130 volatile struct mpc5xxx_psc
*psc
= (struct mpc5xxx_psc
*)PSC_BASE
;
132 NS16550_t com_port
= (NS16550_t
)COM_BASE
;
134 debug(">>>> 0x%02x\n", chr
);
136 #ifdef CONFIG_MPC5xxx
137 while (!(psc
->psc_status
& PSC_SR_TXRDY
));
139 psc
->psc_buffer_8
= chr
;
141 while ((com_port
->lsr
& UART_LSR_THRE
) == 0);
146 static int ps2ser_getc_hw(void)
148 #ifdef CONFIG_MPC5xxx
149 volatile struct mpc5xxx_psc
*psc
= (struct mpc5xxx_psc
*)PSC_BASE
;
151 NS16550_t com_port
= (NS16550_t
)COM_BASE
;
155 #ifdef CONFIG_MPC5xxx
156 if (psc
->psc_status
& PSC_SR_RXRDY
) {
157 res
= (psc
->psc_buffer_8
);
160 if (com_port
->lsr
& UART_LSR_DR
) {
168 int ps2ser_getc(void)
175 flags
= disable_interrupts();
178 if (atomic_read(&ps2buf_cnt
) != 0) {
179 chr
= ps2buf
[ps2buf_out_idx
++];
180 ps2buf_out_idx
&= (PS2BUF_SIZE
- 1);
181 atomic_dec(&ps2buf_cnt
);
183 chr
= ps2ser_getc_hw();
191 debug("0x%02x\n", chr
);
196 int ps2ser_check(void)
200 flags
= disable_interrupts();
201 ps2ser_interrupt(NULL
);
202 if (flags
) enable_interrupts();
204 return atomic_read(&ps2buf_cnt
);
207 static void ps2ser_interrupt(void *dev_id
)
209 #ifdef CONFIG_MPC5xxx
210 volatile struct mpc5xxx_psc
*psc
= (struct mpc5xxx_psc
*)PSC_BASE
;
212 NS16550_t com_port
= (NS16550_t
)COM_BASE
;
218 chr
= ps2ser_getc_hw();
219 #ifdef CONFIG_MPC5xxx
220 status
= psc
->psc_status
;
222 status
= com_port
->lsr
;
224 if (chr
< 0) continue;
226 if (atomic_read(&ps2buf_cnt
) < PS2BUF_SIZE
) {
227 ps2buf
[ps2buf_in_idx
++] = chr
;
228 ps2buf_in_idx
&= (PS2BUF_SIZE
- 1);
229 atomic_inc(&ps2buf_cnt
);
231 printf ("ps2ser.c: buffer overflow\n");
233 #ifdef CONFIG_MPC5xxx
234 } while (status
& PSC_SR_RXRDY
);
236 } while (status
& UART_LSR_DR
);
238 if (atomic_read(&ps2buf_cnt
)) {
239 ps2mult_callback(atomic_read(&ps2buf_cnt
));