 17c5c20936
			
		
	
	
	17c5c20936
	
	
	
		
			
			Fixes inverted logic in uartlite_getc Signed-off-by: Grant Likely <grant.likely@secretlab.ca>
		
			
				
	
	
		
			79 lines
		
	
	
	
		
			1.7 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			79 lines
		
	
	
	
		
			1.7 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Xilinx UARTLITE bootloader driver
 | |
|  *
 | |
|  * Copyright (C) 2007 Secret Lab Technologies Ltd.
 | |
|  *
 | |
|  * This file is licensed under the terms of the GNU General Public License
 | |
|  * version 2. This program is licensed "as is" without any warranty of any
 | |
|  * kind, whether express or implied.
 | |
|  */
 | |
| 
 | |
| #include <stdarg.h>
 | |
| #include <stddef.h>
 | |
| #include "types.h"
 | |
| #include "string.h"
 | |
| #include "stdio.h"
 | |
| #include "io.h"
 | |
| #include "ops.h"
 | |
| 
 | |
| #define ULITE_RX		0x00
 | |
| #define ULITE_TX		0x04
 | |
| #define ULITE_STATUS		0x08
 | |
| #define ULITE_CONTROL		0x0c
 | |
| 
 | |
| #define ULITE_STATUS_RXVALID	0x01
 | |
| #define ULITE_STATUS_TXFULL	0x08
 | |
| 
 | |
| #define ULITE_CONTROL_RST_RX	0x02
 | |
| 
 | |
| static void * reg_base;
 | |
| 
 | |
| static int uartlite_open(void)
 | |
| {
 | |
| 	/* Clear the RX FIFO */
 | |
| 	out_be32(reg_base + ULITE_CONTROL, ULITE_CONTROL_RST_RX);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void uartlite_putc(unsigned char c)
 | |
| {
 | |
| 	u32 reg = ULITE_STATUS_TXFULL;
 | |
| 	while (reg & ULITE_STATUS_TXFULL) /* spin on TXFULL bit */
 | |
| 		reg = in_be32(reg_base + ULITE_STATUS);
 | |
| 	out_be32(reg_base + ULITE_TX, c);
 | |
| }
 | |
| 
 | |
| static unsigned char uartlite_getc(void)
 | |
| {
 | |
| 	u32 reg = 0;
 | |
| 	while (!(reg & ULITE_STATUS_RXVALID)) /* spin waiting for RXVALID bit */
 | |
| 		reg = in_be32(reg_base + ULITE_STATUS);
 | |
| 	return in_be32(reg_base + ULITE_RX);
 | |
| }
 | |
| 
 | |
| static u8 uartlite_tstc(void)
 | |
| {
 | |
| 	u32 reg = in_be32(reg_base + ULITE_STATUS);
 | |
| 	return reg & ULITE_STATUS_RXVALID;
 | |
| }
 | |
| 
 | |
| int uartlite_console_init(void *devp, struct serial_console_data *scdp)
 | |
| {
 | |
| 	int n;
 | |
| 	unsigned long reg_phys;
 | |
| 
 | |
| 	n = getprop(devp, "virtual-reg", ®_base, sizeof(reg_base));
 | |
| 	if (n != sizeof(reg_base)) {
 | |
| 		if (!dt_xlate_reg(devp, 0, ®_phys, NULL))
 | |
| 			return -1;
 | |
| 
 | |
| 		reg_base = (void *)reg_phys;
 | |
| 	}
 | |
| 
 | |
| 	scdp->open = uartlite_open;
 | |
| 	scdp->putc = uartlite_putc;
 | |
| 	scdp->getc = uartlite_getc;
 | |
| 	scdp->tstc = uartlite_tstc;
 | |
| 	scdp->close = NULL;
 | |
| 	return 0;
 | |
| }
 |