mirror of
				https://github.com/smaeul/u-boot.git
				synced 2025-10-30 03:28:16 +00:00 
			
		
		
		
	Replace the in-place ad-hoc implementation of serial_puts() within the drivers with default_serial_puts() call. This cuts down on the code duplication quite a bit. Signed-off-by: Marek Vasut <marex@denx.de> Cc: Marek Vasut <marek.vasut@gmail.com> Cc: Tom Rini <trini@ti.com>
		
			
				
	
	
		
			184 lines
		
	
	
		
			4.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			184 lines
		
	
	
		
			4.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * (C) Copyright 2003
 | |
|  * Martin Winistoerfer, martinwinistoerfer@gmx.ch.
 | |
|  *
 | |
|  * See file CREDITS for list of people who contributed to this
 | |
|  * project.
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or
 | |
|  * modify it under the terms of the GNU General Public License as
 | |
|  * published by the Free Software Foundation; either version 2 of
 | |
|  * the License, or (at your option) any later version.
 | |
|  *
 | |
|  * This program is distributed in the hope that it will be useful,
 | |
|  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | |
|  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | |
|  * GNU General Public License for more details.
 | |
|  *
 | |
|  * You should have received a copy of the GNU General Public License
 | |
|  * along with this program; if not, write to the Free Software
 | |
|  * Foundation,
 | |
|  */
 | |
| 
 | |
| /*
 | |
|  * File:		serial.c
 | |
|  *
 | |
|  * Discription:		Serial interface driver for SCI1 and SCI2.
 | |
|  *			Since this code will be called from ROM use
 | |
|  *			only non-static local variables.
 | |
|  *
 | |
|  */
 | |
| 
 | |
| #include <common.h>
 | |
| #include <watchdog.h>
 | |
| #include <command.h>
 | |
| #include <mpc5xx.h>
 | |
| #include <serial.h>
 | |
| #include <linux/compiler.h>
 | |
| 
 | |
| DECLARE_GLOBAL_DATA_PTR;
 | |
| 
 | |
| /*
 | |
|  * Local functions
 | |
|  */
 | |
| 
 | |
| static int ready_to_send(void)
 | |
| {
 | |
| 	volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
 | |
| 	volatile short status;
 | |
| 
 | |
| 	do {
 | |
| #if defined(CONFIG_5xx_CONS_SCI1)
 | |
| 		status = immr->im_qsmcm.qsmcm_sc1sr;
 | |
| #else
 | |
| 		status = immr->im_qsmcm.qsmcm_sc2sr;
 | |
| #endif
 | |
| 
 | |
| #if defined(CONFIG_WATCHDOG)
 | |
| 		reset_5xx_watchdog (immr);
 | |
| #endif
 | |
| 	} while ((status & SCI_TDRE) == 0);
 | |
| 	return 1;
 | |
| 
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Minimal global serial functions needed to use one of the SCI modules.
 | |
|  */
 | |
| 
 | |
| static int mpc5xx_serial_init(void)
 | |
| {
 | |
| 	volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
 | |
| 
 | |
| 	serial_setbrg();
 | |
| 
 | |
| #if defined(CONFIG_5xx_CONS_SCI1)
 | |
| 	/* 10-Bit, 1 start bit, 8 data bit, no parity, 1 stop bit */
 | |
| 	immr->im_qsmcm.qsmcm_scc1r1 = SCI_M_10;
 | |
| 	immr->im_qsmcm.qsmcm_scc1r1 = SCI_TE | SCI_RE;
 | |
| #else
 | |
| 	immr->im_qsmcm.qsmcm_scc2r1 = SCI_M_10;
 | |
| 	immr->im_qsmcm.qsmcm_scc2r1 = SCI_TE | SCI_RE;
 | |
| #endif
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void mpc5xx_serial_putc(const char c)
 | |
| {
 | |
| 	volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
 | |
| 
 | |
| 	/* Test for completition */
 | |
| 	if(ready_to_send()) {
 | |
| #if defined(CONFIG_5xx_CONS_SCI1)
 | |
| 		immr->im_qsmcm.qsmcm_sc1dr = (short)c;
 | |
| #else
 | |
| 		immr->im_qsmcm.qsmcm_sc2dr = (short)c;
 | |
| #endif
 | |
| 		if(c == '\n') {
 | |
| 			if(ready_to_send());
 | |
| #if defined(CONFIG_5xx_CONS_SCI1)
 | |
| 			immr->im_qsmcm.qsmcm_sc1dr = (short)'\r';
 | |
| #else
 | |
| 			immr->im_qsmcm.qsmcm_sc2dr = (short)'\r';
 | |
| #endif
 | |
| 		}
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int mpc5xx_serial_getc(void)
 | |
| {
 | |
| 	volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
 | |
| 	volatile short status;
 | |
| 	unsigned char tmp;
 | |
| 
 | |
| 	/* New data ? */
 | |
| 	do {
 | |
| #if defined(CONFIG_5xx_CONS_SCI1)
 | |
| 		status = immr->im_qsmcm.qsmcm_sc1sr;
 | |
| #else
 | |
| 		status = immr->im_qsmcm.qsmcm_sc2sr;
 | |
| #endif
 | |
| 
 | |
| #if defined(CONFIG_WATCHDOG)
 | |
| 		reset_5xx_watchdog (immr);
 | |
| #endif
 | |
| 	} while ((status & SCI_RDRF) == 0);
 | |
| 
 | |
| 	/* Read data */
 | |
| #if defined(CONFIG_5xx_CONS_SCI1)
 | |
| 	tmp = (unsigned char)(immr->im_qsmcm.qsmcm_sc1dr & SCI_SCXDR_MK);
 | |
| #else
 | |
| 	tmp = (unsigned char)( immr->im_qsmcm.qsmcm_sc2dr & SCI_SCXDR_MK);
 | |
| #endif
 | |
| 	return	tmp;
 | |
| }
 | |
| 
 | |
| static int mpc5xx_serial_tstc(void)
 | |
| {
 | |
| 	volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
 | |
| 	short status;
 | |
| 
 | |
| 	/* New data character ? */
 | |
| #if defined(CONFIG_5xx_CONS_SCI1)
 | |
| 	status = immr->im_qsmcm.qsmcm_sc1sr;
 | |
| #else
 | |
| 	status = immr->im_qsmcm.qsmcm_sc2sr;
 | |
| #endif
 | |
| 	return (status & SCI_RDRF);
 | |
| }
 | |
| 
 | |
| static void mpc5xx_serial_setbrg(void)
 | |
| {
 | |
| 	volatile immap_t *immr = (immap_t *)CONFIG_SYS_IMMR;
 | |
| 	short scxbr;
 | |
| 
 | |
| 	/* Set baudrate */
 | |
| 	scxbr = (gd->cpu_clk / (32 * gd->baudrate));
 | |
| #if defined(CONFIG_5xx_CONS_SCI1)
 | |
| 	immr->im_qsmcm.qsmcm_scc1r0 = (scxbr & SCI_SCXBR_MK);
 | |
| #else
 | |
| 	immr->im_qsmcm.qsmcm_scc2r0 = (scxbr & SCI_SCXBR_MK);
 | |
| #endif
 | |
| }
 | |
| 
 | |
| static struct serial_device mpc5xx_serial_drv = {
 | |
| 	.name	= "mpc5xx_serial",
 | |
| 	.start	= mpc5xx_serial_init,
 | |
| 	.stop	= NULL,
 | |
| 	.setbrg	= mpc5xx_serial_setbrg,
 | |
| 	.putc	= mpc5xx_serial_putc,
 | |
| 	.puts	= default_serial_puts,
 | |
| 	.getc	= mpc5xx_serial_getc,
 | |
| 	.tstc	= mpc5xx_serial_tstc,
 | |
| };
 | |
| 
 | |
| void mpc5xx_serial_initialize(void)
 | |
| {
 | |
| 	serial_register(&mpc5xx_serial_drv);
 | |
| }
 | |
| 
 | |
| __weak struct serial_device *default_serial_console(void)
 | |
| {
 | |
| 	return &mpc5xx_serial_drv;
 | |
| }
 |