mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-11-12 07:57:21 +00:00
0080931abf
clang-3.8 reports that serial_putc_raw_dev in serial_ns16550.c is unused. Further investigation shows that we have 3 places that implement this function and no callers, remove. Signed-off-by: Tom Rini <trini@konsulko.com> Reviewed-by: Bin Meng <bmeng.cn@gmail.com>
431 lines
9.8 KiB
C
431 lines
9.8 KiB
C
/*
|
|
* (C) Copyright 2000 - 2010
|
|
* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*
|
|
* Based ont the MPC5200 PSC driver.
|
|
* Adapted for MPC512x by Jan Wrobel <wrr@semihalf.com>
|
|
*/
|
|
|
|
/*
|
|
* Minimal serial functions needed to use one of the PSC ports
|
|
* as serial console interface.
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <linux/compiler.h>
|
|
#include <asm/io.h>
|
|
#include <asm/processor.h>
|
|
#include <serial.h>
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
#if defined(CONFIG_PSC_CONSOLE)
|
|
|
|
static void fifo_init (volatile psc512x_t *psc)
|
|
{
|
|
volatile immap_t *im = (immap_t *) CONFIG_SYS_IMMR;
|
|
u32 tfsize, rfsize;
|
|
|
|
/* reset Rx & Tx fifo slice */
|
|
out_be32(&psc->rfcmd, PSC_FIFO_RESET_SLICE);
|
|
out_be32(&psc->tfcmd, PSC_FIFO_RESET_SLICE);
|
|
|
|
/* disable Tx & Rx FIFO interrupts */
|
|
out_be32(&psc->rfintmask, 0);
|
|
out_be32(&psc->tfintmask, 0);
|
|
|
|
switch (((u32)psc & 0xf00) >> 8) {
|
|
case 0:
|
|
tfsize = FIFOC_PSC0_TX_SIZE | (FIFOC_PSC0_TX_ADDR << 16);
|
|
rfsize = FIFOC_PSC0_RX_SIZE | (FIFOC_PSC0_RX_ADDR << 16);
|
|
break;
|
|
case 1:
|
|
tfsize = FIFOC_PSC1_TX_SIZE | (FIFOC_PSC1_TX_ADDR << 16);
|
|
rfsize = FIFOC_PSC1_RX_SIZE | (FIFOC_PSC1_RX_ADDR << 16);
|
|
break;
|
|
case 2:
|
|
tfsize = FIFOC_PSC2_TX_SIZE | (FIFOC_PSC2_TX_ADDR << 16);
|
|
rfsize = FIFOC_PSC2_RX_SIZE | (FIFOC_PSC2_RX_ADDR << 16);
|
|
break;
|
|
case 3:
|
|
tfsize = FIFOC_PSC3_TX_SIZE | (FIFOC_PSC3_TX_ADDR << 16);
|
|
rfsize = FIFOC_PSC3_RX_SIZE | (FIFOC_PSC3_RX_ADDR << 16);
|
|
break;
|
|
case 4:
|
|
tfsize = FIFOC_PSC4_TX_SIZE | (FIFOC_PSC4_TX_ADDR << 16);
|
|
rfsize = FIFOC_PSC4_RX_SIZE | (FIFOC_PSC4_RX_ADDR << 16);
|
|
break;
|
|
case 5:
|
|
tfsize = FIFOC_PSC5_TX_SIZE | (FIFOC_PSC5_TX_ADDR << 16);
|
|
rfsize = FIFOC_PSC5_RX_SIZE | (FIFOC_PSC5_RX_ADDR << 16);
|
|
break;
|
|
case 6:
|
|
tfsize = FIFOC_PSC6_TX_SIZE | (FIFOC_PSC6_TX_ADDR << 16);
|
|
rfsize = FIFOC_PSC6_RX_SIZE | (FIFOC_PSC6_RX_ADDR << 16);
|
|
break;
|
|
case 7:
|
|
tfsize = FIFOC_PSC7_TX_SIZE | (FIFOC_PSC7_TX_ADDR << 16);
|
|
rfsize = FIFOC_PSC7_RX_SIZE | (FIFOC_PSC7_RX_ADDR << 16);
|
|
break;
|
|
case 8:
|
|
tfsize = FIFOC_PSC8_TX_SIZE | (FIFOC_PSC8_TX_ADDR << 16);
|
|
rfsize = FIFOC_PSC8_RX_SIZE | (FIFOC_PSC8_RX_ADDR << 16);
|
|
break;
|
|
case 9:
|
|
tfsize = FIFOC_PSC9_TX_SIZE | (FIFOC_PSC9_TX_ADDR << 16);
|
|
rfsize = FIFOC_PSC9_RX_SIZE | (FIFOC_PSC9_RX_ADDR << 16);
|
|
break;
|
|
case 10:
|
|
tfsize = FIFOC_PSC10_TX_SIZE | (FIFOC_PSC10_TX_ADDR << 16);
|
|
rfsize = FIFOC_PSC10_RX_SIZE | (FIFOC_PSC10_RX_ADDR << 16);
|
|
break;
|
|
case 11:
|
|
tfsize = FIFOC_PSC11_TX_SIZE | (FIFOC_PSC11_TX_ADDR << 16);
|
|
rfsize = FIFOC_PSC11_RX_SIZE | (FIFOC_PSC11_RX_ADDR << 16);
|
|
break;
|
|
default:
|
|
return;
|
|
}
|
|
|
|
out_be32(&psc->tfsize, tfsize);
|
|
out_be32(&psc->rfsize, rfsize);
|
|
|
|
/* enable Tx & Rx FIFO slice */
|
|
out_be32(&psc->rfcmd, PSC_FIFO_ENABLE_SLICE);
|
|
out_be32(&psc->tfcmd, PSC_FIFO_ENABLE_SLICE);
|
|
|
|
out_be32(&im->fifoc.fifoc_cmd, FIFOC_DISABLE_CLOCK_GATE);
|
|
__asm__ volatile ("sync");
|
|
}
|
|
|
|
void serial_setbrg_dev(unsigned int idx)
|
|
{
|
|
volatile immap_t *im = (immap_t *) CONFIG_SYS_IMMR;
|
|
volatile psc512x_t *psc = (psc512x_t *) &im->psc[idx];
|
|
unsigned long baseclk, div;
|
|
unsigned long baudrate;
|
|
char buf[16];
|
|
char *br_env;
|
|
|
|
baudrate = gd->baudrate;
|
|
if (idx != CONFIG_PSC_CONSOLE) {
|
|
/* Allows setting baudrate for other serial devices
|
|
* on PSCx using environment. If not specified, use
|
|
* the same baudrate as for console.
|
|
*/
|
|
sprintf(buf, "psc%d_baudrate", idx);
|
|
br_env = getenv(buf);
|
|
if (br_env)
|
|
baudrate = simple_strtoul(br_env, NULL, 10);
|
|
|
|
debug("%s: idx %d, baudrate %ld\n", __func__, idx, baudrate);
|
|
}
|
|
|
|
/* calculate divisor for setting PSC CTUR and CTLR registers */
|
|
baseclk = (gd->arch.ips_clk + 8) / 16;
|
|
div = (baseclk + (baudrate / 2)) / baudrate;
|
|
|
|
out_8(&psc->ctur, (div >> 8) & 0xff);
|
|
out_8(&psc->ctlr, div & 0xff); /* set baudrate */
|
|
}
|
|
|
|
int serial_init_dev(unsigned int idx)
|
|
{
|
|
volatile immap_t *im = (immap_t *) CONFIG_SYS_IMMR;
|
|
volatile psc512x_t *psc = (psc512x_t *) &im->psc[idx];
|
|
u32 reg;
|
|
|
|
reg = in_be32(&im->clk.sccr[0]);
|
|
out_be32(&im->clk.sccr[0], reg | CLOCK_SCCR1_PSC_EN(idx));
|
|
|
|
fifo_init (psc);
|
|
|
|
/* set MR register to point to MR1 */
|
|
out_8(&psc->command, PSC_SEL_MODE_REG_1);
|
|
|
|
/* disable Tx/Rx */
|
|
out_8(&psc->command, PSC_TX_DISABLE | PSC_RX_DISABLE);
|
|
|
|
/* choose the prescaler by 16 for the Tx/Rx clock generation */
|
|
out_be16(&psc->psc_clock_select, 0xdd00);
|
|
|
|
/* switch to UART mode */
|
|
out_be32(&psc->sicr, 0);
|
|
|
|
/* mode register points to mr1 */
|
|
/* configure parity, bit length and so on in mode register 1*/
|
|
out_8(&psc->mode, PSC_MODE_8_BITS | PSC_MODE_PARNONE);
|
|
/* now, mode register points to mr2 */
|
|
out_8(&psc->mode, PSC_MODE_1_STOPBIT);
|
|
|
|
/* set baudrate */
|
|
serial_setbrg_dev(idx);
|
|
|
|
/* disable all interrupts */
|
|
out_be16(&psc->psc_imr, 0);
|
|
|
|
/* reset and enable Rx/Tx */
|
|
out_8(&psc->command, PSC_RST_RX);
|
|
out_8(&psc->command, PSC_RST_TX);
|
|
out_8(&psc->command, PSC_RX_ENABLE | PSC_TX_ENABLE);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int serial_uninit_dev(unsigned int idx)
|
|
{
|
|
volatile immap_t *im = (immap_t *) CONFIG_SYS_IMMR;
|
|
volatile psc512x_t *psc = (psc512x_t *) &im->psc[idx];
|
|
u32 reg;
|
|
|
|
out_8(&psc->command, PSC_RX_DISABLE | PSC_TX_DISABLE);
|
|
reg = in_be32(&im->clk.sccr[0]);
|
|
reg &= ~CLOCK_SCCR1_PSC_EN(idx);
|
|
out_be32(&im->clk.sccr[0], reg);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void serial_putc_dev(unsigned int idx, const char c)
|
|
{
|
|
volatile immap_t *im = (immap_t *)CONFIG_SYS_IMMR;
|
|
volatile psc512x_t *psc = (psc512x_t *) &im->psc[idx];
|
|
|
|
if (c == '\n')
|
|
serial_putc_dev(idx, '\r');
|
|
|
|
/* Wait for last character to go. */
|
|
while (!(in_be16(&psc->psc_status) & PSC_SR_TXEMP))
|
|
;
|
|
|
|
out_8(&psc->tfdata_8, c);
|
|
}
|
|
|
|
void serial_puts_dev(unsigned int idx, const char *s)
|
|
{
|
|
while (*s)
|
|
serial_putc_dev(idx, *s++);
|
|
}
|
|
|
|
int serial_getc_dev(unsigned int idx)
|
|
{
|
|
volatile immap_t *im = (immap_t *) CONFIG_SYS_IMMR;
|
|
volatile psc512x_t *psc = (psc512x_t *) &im->psc[idx];
|
|
|
|
/* Wait for a character to arrive. */
|
|
while (in_be32(&psc->rfstat) & PSC_FIFO_EMPTY)
|
|
;
|
|
|
|
return in_8(&psc->rfdata_8);
|
|
}
|
|
|
|
int serial_tstc_dev(unsigned int idx)
|
|
{
|
|
volatile immap_t *im = (immap_t *) CONFIG_SYS_IMMR;
|
|
volatile psc512x_t *psc = (psc512x_t *) &im->psc[idx];
|
|
|
|
return !(in_be32(&psc->rfstat) & PSC_FIFO_EMPTY);
|
|
}
|
|
|
|
void serial_setrts_dev(unsigned int idx, int s)
|
|
{
|
|
volatile immap_t *im = (immap_t *) CONFIG_SYS_IMMR;
|
|
volatile psc512x_t *psc = (psc512x_t *) &im->psc[idx];
|
|
|
|
if (s) {
|
|
/* Assert RTS (become LOW) */
|
|
out_8(&psc->op1, 0x1);
|
|
}
|
|
else {
|
|
/* Negate RTS (become HIGH) */
|
|
out_8(&psc->op0, 0x1);
|
|
}
|
|
}
|
|
|
|
int serial_getcts_dev(unsigned int idx)
|
|
{
|
|
volatile immap_t *im = (immap_t *) CONFIG_SYS_IMMR;
|
|
volatile psc512x_t *psc = (psc512x_t *) &im->psc[idx];
|
|
|
|
return (in_8(&psc->ip) & 0x1) ? 0 : 1;
|
|
}
|
|
#endif /* CONFIG_PSC_CONSOLE */
|
|
|
|
#define DECLARE_PSC_SERIAL_FUNCTIONS(port) \
|
|
int serial##port##_init(void) \
|
|
{ \
|
|
return serial_init_dev(port); \
|
|
} \
|
|
int serial##port##_uninit(void) \
|
|
{ \
|
|
return serial_uninit_dev(port); \
|
|
} \
|
|
void serial##port##_setbrg(void) \
|
|
{ \
|
|
serial_setbrg_dev(port); \
|
|
} \
|
|
int serial##port##_getc(void) \
|
|
{ \
|
|
return serial_getc_dev(port); \
|
|
} \
|
|
int serial##port##_tstc(void) \
|
|
{ \
|
|
return serial_tstc_dev(port); \
|
|
} \
|
|
void serial##port##_putc(const char c) \
|
|
{ \
|
|
serial_putc_dev(port, c); \
|
|
} \
|
|
void serial##port##_puts(const char *s) \
|
|
{ \
|
|
serial_puts_dev(port, s); \
|
|
}
|
|
|
|
#define INIT_PSC_SERIAL_STRUCTURE(port, __name) { \
|
|
.name = __name, \
|
|
.start = serial##port##_init, \
|
|
.stop = serial##port##_uninit, \
|
|
.setbrg = serial##port##_setbrg, \
|
|
.getc = serial##port##_getc, \
|
|
.tstc = serial##port##_tstc, \
|
|
.putc = serial##port##_putc, \
|
|
.puts = serial##port##_puts, \
|
|
}
|
|
|
|
#if defined(CONFIG_SYS_PSC1)
|
|
DECLARE_PSC_SERIAL_FUNCTIONS(1);
|
|
struct serial_device serial1_device =
|
|
INIT_PSC_SERIAL_STRUCTURE(1, "psc1");
|
|
#endif
|
|
|
|
#if defined(CONFIG_SYS_PSC3)
|
|
DECLARE_PSC_SERIAL_FUNCTIONS(3);
|
|
struct serial_device serial3_device =
|
|
INIT_PSC_SERIAL_STRUCTURE(3, "psc3");
|
|
#endif
|
|
|
|
#if defined(CONFIG_SYS_PSC4)
|
|
DECLARE_PSC_SERIAL_FUNCTIONS(4);
|
|
struct serial_device serial4_device =
|
|
INIT_PSC_SERIAL_STRUCTURE(4, "psc4");
|
|
#endif
|
|
|
|
#if defined(CONFIG_SYS_PSC6)
|
|
DECLARE_PSC_SERIAL_FUNCTIONS(6);
|
|
struct serial_device serial6_device =
|
|
INIT_PSC_SERIAL_STRUCTURE(6, "psc6");
|
|
#endif
|
|
|
|
__weak struct serial_device *default_serial_console(void)
|
|
{
|
|
#if (CONFIG_PSC_CONSOLE == 3)
|
|
return &serial3_device;
|
|
#elif (CONFIG_PSC_CONSOLE == 6)
|
|
return &serial6_device;
|
|
#else
|
|
#error "invalid CONFIG_PSC_CONSOLE"
|
|
#endif
|
|
}
|
|
|
|
void mpc512x_serial_initialize(void)
|
|
{
|
|
#if defined(CONFIG_SYS_PSC1)
|
|
serial_register(&serial1_device);
|
|
#endif
|
|
#if defined(CONFIG_SYS_PSC3)
|
|
serial_register(&serial3_device);
|
|
#endif
|
|
#if defined(CONFIG_SYS_PSC4)
|
|
serial_register(&serial4_device);
|
|
#endif
|
|
#if defined(CONFIG_SYS_PSC6)
|
|
serial_register(&serial6_device);
|
|
#endif
|
|
}
|
|
|
|
#include <stdio_dev.h>
|
|
/*
|
|
* Routines for communication with serial devices over PSC
|
|
*/
|
|
/* Bitfield for initialized PSCs */
|
|
static unsigned int initialized;
|
|
|
|
struct stdio_dev *open_port(int num, int baudrate)
|
|
{
|
|
struct stdio_dev *port;
|
|
char env_var[16];
|
|
char env_val[10];
|
|
char name[7];
|
|
|
|
if (num < 0 || num > 11)
|
|
return NULL;
|
|
|
|
sprintf(name, "psc%d", num);
|
|
port = stdio_get_by_name(name);
|
|
if (!port)
|
|
return NULL;
|
|
|
|
if (!test_bit(num, &initialized)) {
|
|
sprintf(env_var, "psc%d_baudrate", num);
|
|
sprintf(env_val, "%d", baudrate);
|
|
setenv(env_var, env_val);
|
|
|
|
if (port->start(port))
|
|
return NULL;
|
|
|
|
set_bit(num, &initialized);
|
|
}
|
|
|
|
return port;
|
|
}
|
|
|
|
int close_port(int num)
|
|
{
|
|
struct stdio_dev *port;
|
|
int ret;
|
|
char name[7];
|
|
|
|
if (num < 0 || num > 11)
|
|
return -1;
|
|
|
|
sprintf(name, "psc%d", num);
|
|
port = stdio_get_by_name(name);
|
|
if (!port)
|
|
return -1;
|
|
|
|
ret = port->stop(port);
|
|
clear_bit(num, &initialized);
|
|
|
|
return ret;
|
|
}
|
|
|
|
int write_port(struct stdio_dev *port, char *buf)
|
|
{
|
|
if (!port || !buf)
|
|
return -1;
|
|
|
|
port->puts(port, buf);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int read_port(struct stdio_dev *port, char *buf, int size)
|
|
{
|
|
int cnt = 0;
|
|
|
|
if (!port || !buf)
|
|
return -1;
|
|
|
|
if (!size)
|
|
return 0;
|
|
|
|
while (port->tstc(port)) {
|
|
buf[cnt++] = port->getc(port);
|
|
if (cnt > size)
|
|
break;
|
|
}
|
|
|
|
return cnt;
|
|
}
|