6ab3d5624e
Signed-off-by: Jörn Engel <joern@wohnheim.fh-wedel.de> Signed-off-by: Adrian Bunk <bunk@stusta.de>
364 lines
9.7 KiB
C
364 lines
9.7 KiB
C
/*
|
|
* Bootloader version of the embedded MPSC/UART driver for the Marvell 64x60.
|
|
* Note: Due to a GT64260A erratum, DMA will be used for UART input (via SDMA).
|
|
*
|
|
* Author: Mark A. Greer <mgreer@mvista.com>
|
|
*
|
|
* 2001 (c) MontaVista Software, Inc. 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.
|
|
*/
|
|
|
|
/* This code assumes that the data cache has been disabled (L1, L2, L3). */
|
|
|
|
#include <linux/types.h>
|
|
#include <linux/serial_reg.h>
|
|
#include <asm/serial.h>
|
|
#include <asm/io.h>
|
|
#include <asm/mv64x60_defs.h>
|
|
#include <mpsc_defs.h>
|
|
|
|
#ifdef CONFIG_EV64360
|
|
#include <platforms/ev64360.h>
|
|
u32 mv64x60_console_baud = EV64360_DEFAULT_BAUD;
|
|
u32 mv64x60_mpsc_clk_src = EV64360_MPSC_CLK_SRC; /* TCLK */
|
|
u32 mv64x60_mpsc_clk_freq = EV64360_MPSC_CLK_FREQ;
|
|
#else
|
|
u32 mv64x60_console_baud = 9600;
|
|
u32 mv64x60_mpsc_clk_src = 8; /* TCLK */
|
|
u32 mv64x60_mpsc_clk_freq = 100000000;
|
|
#endif
|
|
|
|
extern void udelay(long);
|
|
static void stop_dma(int chan);
|
|
|
|
static void __iomem *mv64x60_base = (void __iomem *)CONFIG_MV64X60_NEW_BASE;
|
|
|
|
struct sdma_regs {
|
|
u32 sdc;
|
|
u32 sdcm;
|
|
u32 rx_desc;
|
|
u32 rx_buf_ptr;
|
|
u32 scrdp;
|
|
u32 tx_desc;
|
|
u32 sctdp;
|
|
u32 sftdp;
|
|
};
|
|
|
|
static struct sdma_regs sdma_regs[2];
|
|
|
|
#define SDMA_REGS_INIT(s, reg_base) { \
|
|
(s)->sdc = (reg_base) + SDMA_SDC; \
|
|
(s)->sdcm = (reg_base) + SDMA_SDCM; \
|
|
(s)->rx_desc = (reg_base) + SDMA_RX_DESC; \
|
|
(s)->rx_buf_ptr = (reg_base) + SDMA_RX_BUF_PTR; \
|
|
(s)->scrdp = (reg_base) + SDMA_SCRDP; \
|
|
(s)->tx_desc = (reg_base) + SDMA_TX_DESC; \
|
|
(s)->sctdp = (reg_base) + SDMA_SCTDP; \
|
|
(s)->sftdp = (reg_base) + SDMA_SFTDP; \
|
|
}
|
|
|
|
static u32 mpsc_base[2] = { MV64x60_MPSC_0_OFFSET, MV64x60_MPSC_1_OFFSET };
|
|
|
|
struct mv64x60_rx_desc {
|
|
u16 bufsize;
|
|
u16 bytecnt;
|
|
u32 cmd_stat;
|
|
u32 next_desc_ptr;
|
|
u32 buffer;
|
|
};
|
|
|
|
struct mv64x60_tx_desc {
|
|
u16 bytecnt;
|
|
u16 shadow;
|
|
u32 cmd_stat;
|
|
u32 next_desc_ptr;
|
|
u32 buffer;
|
|
};
|
|
|
|
#define MAX_RESET_WAIT 10000
|
|
#define MAX_TX_WAIT 10000
|
|
|
|
#define RX_NUM_DESC 2
|
|
#define TX_NUM_DESC 2
|
|
|
|
#define RX_BUF_SIZE 32
|
|
#define TX_BUF_SIZE 32
|
|
|
|
static struct mv64x60_rx_desc rd[2][RX_NUM_DESC] __attribute__ ((aligned(32)));
|
|
static struct mv64x60_tx_desc td[2][TX_NUM_DESC] __attribute__ ((aligned(32)));
|
|
|
|
static char rx_buf[2][RX_NUM_DESC * RX_BUF_SIZE] __attribute__ ((aligned(32)));
|
|
static char tx_buf[2][TX_NUM_DESC * TX_BUF_SIZE] __attribute__ ((aligned(32)));
|
|
|
|
static int cur_rd[2] = { 0, 0 };
|
|
static int cur_td[2] = { 0, 0 };
|
|
|
|
static char chan_initialized[2] = { 0, 0 };
|
|
|
|
|
|
#define RX_INIT_RDP(rdp) { \
|
|
(rdp)->bufsize = 2; \
|
|
(rdp)->bytecnt = 0; \
|
|
(rdp)->cmd_stat = SDMA_DESC_CMDSTAT_L | SDMA_DESC_CMDSTAT_F | \
|
|
SDMA_DESC_CMDSTAT_O; \
|
|
}
|
|
|
|
#ifdef CONFIG_MV64360
|
|
static u32 cpu2mem_tab[MV64x60_CPU2MEM_WINDOWS][2] = {
|
|
{ MV64x60_CPU2MEM_0_BASE, MV64x60_CPU2MEM_0_SIZE },
|
|
{ MV64x60_CPU2MEM_1_BASE, MV64x60_CPU2MEM_1_SIZE },
|
|
{ MV64x60_CPU2MEM_2_BASE, MV64x60_CPU2MEM_2_SIZE },
|
|
{ MV64x60_CPU2MEM_3_BASE, MV64x60_CPU2MEM_3_SIZE }
|
|
};
|
|
|
|
static u32 com2mem_tab[MV64x60_CPU2MEM_WINDOWS][2] = {
|
|
{ MV64360_MPSC2MEM_0_BASE, MV64360_MPSC2MEM_0_SIZE },
|
|
{ MV64360_MPSC2MEM_1_BASE, MV64360_MPSC2MEM_1_SIZE },
|
|
{ MV64360_MPSC2MEM_2_BASE, MV64360_MPSC2MEM_2_SIZE },
|
|
{ MV64360_MPSC2MEM_3_BASE, MV64360_MPSC2MEM_3_SIZE }
|
|
};
|
|
|
|
static u32 dram_selects[MV64x60_CPU2MEM_WINDOWS] = { 0xe, 0xd, 0xb, 0x7 };
|
|
#endif
|
|
|
|
unsigned long
|
|
serial_init(int chan, void *ignored)
|
|
{
|
|
u32 mpsc_routing_base, sdma_base, brg_bcr, cdv;
|
|
int i;
|
|
|
|
chan = (chan == 1); /* default to chan 0 if anything but 1 */
|
|
|
|
if (chan_initialized[chan])
|
|
return chan;
|
|
|
|
chan_initialized[chan] = 1;
|
|
|
|
if (chan == 0) {
|
|
sdma_base = MV64x60_SDMA_0_OFFSET;
|
|
brg_bcr = MV64x60_BRG_0_OFFSET + BRG_BCR;
|
|
SDMA_REGS_INIT(&sdma_regs[0], MV64x60_SDMA_0_OFFSET);
|
|
} else {
|
|
sdma_base = MV64x60_SDMA_1_OFFSET;
|
|
brg_bcr = MV64x60_BRG_1_OFFSET + BRG_BCR;
|
|
SDMA_REGS_INIT(&sdma_regs[0], MV64x60_SDMA_1_OFFSET);
|
|
}
|
|
|
|
mpsc_routing_base = MV64x60_MPSC_ROUTING_OFFSET;
|
|
|
|
stop_dma(chan);
|
|
|
|
/* Set up ring buffers */
|
|
for (i=0; i<RX_NUM_DESC; i++) {
|
|
RX_INIT_RDP(&rd[chan][i]);
|
|
rd[chan][i].buffer = (u32)&rx_buf[chan][i * RX_BUF_SIZE];
|
|
rd[chan][i].next_desc_ptr = (u32)&rd[chan][i+1];
|
|
}
|
|
rd[chan][RX_NUM_DESC - 1].next_desc_ptr = (u32)&rd[chan][0];
|
|
|
|
for (i=0; i<TX_NUM_DESC; i++) {
|
|
td[chan][i].bytecnt = 0;
|
|
td[chan][i].shadow = 0;
|
|
td[chan][i].buffer = (u32)&tx_buf[chan][i * TX_BUF_SIZE];
|
|
td[chan][i].cmd_stat = SDMA_DESC_CMDSTAT_F|SDMA_DESC_CMDSTAT_L;
|
|
td[chan][i].next_desc_ptr = (u32)&td[chan][i+1];
|
|
}
|
|
td[chan][TX_NUM_DESC - 1].next_desc_ptr = (u32)&td[chan][0];
|
|
|
|
/* Set MPSC Routing */
|
|
out_le32(mv64x60_base + mpsc_routing_base + MPSC_MRR, 0x3ffffe38);
|
|
|
|
#ifdef CONFIG_GT64260
|
|
out_le32(mv64x60_base + GT64260_MPP_SERIAL_PORTS_MULTIPLEX, 0x00001102);
|
|
#else /* Must be MV64360 or MV64460 */
|
|
{
|
|
u32 enables, prot_bits, v;
|
|
|
|
/* Set up comm unit to memory mapping windows */
|
|
/* Note: Assumes MV64x60_CPU2MEM_WINDOWS == 4 */
|
|
|
|
enables = in_le32(mv64x60_base + MV64360_CPU_BAR_ENABLE) & 0xf;
|
|
prot_bits = 0;
|
|
|
|
for (i=0; i<MV64x60_CPU2MEM_WINDOWS; i++) {
|
|
if (!(enables & (1 << i))) {
|
|
v = in_le32(mv64x60_base + cpu2mem_tab[i][0]);
|
|
v = ((v & 0xffff) << 16) | (dram_selects[i] << 8);
|
|
out_le32(mv64x60_base + com2mem_tab[i][0], v);
|
|
|
|
v = in_le32(mv64x60_base + cpu2mem_tab[i][1]);
|
|
v = (v & 0xffff) << 16;
|
|
out_le32(mv64x60_base + com2mem_tab[i][1], v);
|
|
|
|
prot_bits |= (0x3 << (i << 1)); /* r/w access */
|
|
}
|
|
}
|
|
|
|
out_le32(mv64x60_base + MV64360_MPSC_0_REMAP, 0);
|
|
out_le32(mv64x60_base + MV64360_MPSC_1_REMAP, 0);
|
|
out_le32(mv64x60_base + MV64360_MPSC2MEM_ACC_PROT_0, prot_bits);
|
|
out_le32(mv64x60_base + MV64360_MPSC2MEM_ACC_PROT_1, prot_bits);
|
|
out_le32(mv64x60_base + MV64360_MPSC2MEM_BAR_ENABLE, enables);
|
|
}
|
|
#endif
|
|
|
|
/* MPSC 0/1 Rx & Tx get clocks BRG0/1 */
|
|
out_le32(mv64x60_base + mpsc_routing_base + MPSC_RCRR, 0x00000100);
|
|
out_le32(mv64x60_base + mpsc_routing_base + MPSC_TCRR, 0x00000100);
|
|
|
|
/* clear pending interrupts */
|
|
out_le32(mv64x60_base + MV64x60_SDMA_INTR_OFFSET + SDMA_INTR_MASK, 0);
|
|
|
|
out_le32(mv64x60_base + SDMA_SCRDP + sdma_base, (int)&rd[chan][0]);
|
|
out_le32(mv64x60_base + SDMA_SCTDP + sdma_base,
|
|
(int)&td[chan][TX_NUM_DESC - 1]);
|
|
out_le32(mv64x60_base + SDMA_SFTDP + sdma_base,
|
|
(int)&td[chan][TX_NUM_DESC - 1]);
|
|
|
|
out_le32(mv64x60_base + SDMA_SDC + sdma_base,
|
|
SDMA_SDC_RFT | SDMA_SDC_SFM | SDMA_SDC_BLMR | SDMA_SDC_BLMT |
|
|
(3 << 12));
|
|
|
|
cdv = ((mv64x60_mpsc_clk_freq/(32*mv64x60_console_baud))-1);
|
|
out_le32(mv64x60_base + brg_bcr,
|
|
((mv64x60_mpsc_clk_src << 18) | (1 << 16) | cdv));
|
|
|
|
/* Put MPSC into UART mode, no null modem, 16x clock mode */
|
|
out_le32(mv64x60_base + MPSC_MMCRL + mpsc_base[chan], 0x000004c4);
|
|
out_le32(mv64x60_base + MPSC_MMCRH + mpsc_base[chan], 0x04400400);
|
|
|
|
out_le32(mv64x60_base + MPSC_CHR_1 + mpsc_base[chan], 0);
|
|
out_le32(mv64x60_base + MPSC_CHR_9 + mpsc_base[chan], 0);
|
|
out_le32(mv64x60_base + MPSC_CHR_10 + mpsc_base[chan], 0);
|
|
out_le32(mv64x60_base + MPSC_CHR_3 + mpsc_base[chan], 4);
|
|
out_le32(mv64x60_base + MPSC_CHR_4 + mpsc_base[chan], 0);
|
|
out_le32(mv64x60_base + MPSC_CHR_5 + mpsc_base[chan], 0);
|
|
out_le32(mv64x60_base + MPSC_CHR_6 + mpsc_base[chan], 0);
|
|
out_le32(mv64x60_base + MPSC_CHR_7 + mpsc_base[chan], 0);
|
|
out_le32(mv64x60_base + MPSC_CHR_8 + mpsc_base[chan], 0);
|
|
|
|
/* 8 data bits, 1 stop bit */
|
|
out_le32(mv64x60_base + MPSC_MPCR + mpsc_base[chan], (3 << 12));
|
|
out_le32(mv64x60_base + SDMA_SDCM + sdma_base, SDMA_SDCM_ERD);
|
|
out_le32(mv64x60_base + MPSC_CHR_2 + mpsc_base[chan], MPSC_CHR_2_EH);
|
|
|
|
udelay(100);
|
|
|
|
return chan;
|
|
}
|
|
|
|
static void
|
|
stop_dma(int chan)
|
|
{
|
|
int i;
|
|
|
|
/* Abort MPSC Rx (aborting Tx messes things up) */
|
|
out_le32(mv64x60_base + MPSC_CHR_2 + mpsc_base[chan], MPSC_CHR_2_RA);
|
|
|
|
/* Abort SDMA Rx, Tx */
|
|
out_le32(mv64x60_base + sdma_regs[chan].sdcm,
|
|
SDMA_SDCM_AR | SDMA_SDCM_STD);
|
|
|
|
for (i=0; i<MAX_RESET_WAIT; i++) {
|
|
if ((in_le32(mv64x60_base + sdma_regs[chan].sdcm) &
|
|
(SDMA_SDCM_AR | SDMA_SDCM_AT)) == 0)
|
|
break;
|
|
|
|
udelay(100);
|
|
}
|
|
}
|
|
|
|
static int
|
|
wait_for_ownership(int chan)
|
|
{
|
|
int i;
|
|
|
|
for (i=0; i<MAX_TX_WAIT; i++) {
|
|
if ((in_le32(mv64x60_base + sdma_regs[chan].sdcm) &
|
|
SDMA_SDCM_TXD) == 0)
|
|
break;
|
|
|
|
udelay(1000);
|
|
}
|
|
|
|
return (i < MAX_TX_WAIT);
|
|
}
|
|
|
|
void
|
|
serial_putc(unsigned long com_port, unsigned char c)
|
|
{
|
|
struct mv64x60_tx_desc *tdp;
|
|
|
|
if (wait_for_ownership(com_port) == 0)
|
|
return;
|
|
|
|
tdp = &td[com_port][cur_td[com_port]];
|
|
if (++cur_td[com_port] >= TX_NUM_DESC)
|
|
cur_td[com_port] = 0;
|
|
|
|
*(unchar *)(tdp->buffer ^ 7) = c;
|
|
tdp->bytecnt = 1;
|
|
tdp->shadow = 1;
|
|
tdp->cmd_stat = SDMA_DESC_CMDSTAT_L | SDMA_DESC_CMDSTAT_F |
|
|
SDMA_DESC_CMDSTAT_O;
|
|
|
|
out_le32(mv64x60_base + sdma_regs[com_port].sctdp, (int)tdp);
|
|
out_le32(mv64x60_base + sdma_regs[com_port].sftdp, (int)tdp);
|
|
out_le32(mv64x60_base + sdma_regs[com_port].sdcm,
|
|
in_le32(mv64x60_base + sdma_regs[com_port].sdcm) |
|
|
SDMA_SDCM_TXD);
|
|
}
|
|
|
|
unsigned char
|
|
serial_getc(unsigned long com_port)
|
|
{
|
|
struct mv64x60_rx_desc *rdp;
|
|
unchar c = '\0';
|
|
|
|
rdp = &rd[com_port][cur_rd[com_port]];
|
|
|
|
if ((rdp->cmd_stat & (SDMA_DESC_CMDSTAT_O|SDMA_DESC_CMDSTAT_ES)) == 0) {
|
|
c = *(unchar *)(rdp->buffer ^ 7);
|
|
RX_INIT_RDP(rdp);
|
|
if (++cur_rd[com_port] >= RX_NUM_DESC)
|
|
cur_rd[com_port] = 0;
|
|
}
|
|
|
|
return c;
|
|
}
|
|
|
|
int
|
|
serial_tstc(unsigned long com_port)
|
|
{
|
|
struct mv64x60_rx_desc *rdp;
|
|
int loop_count = 0;
|
|
int rc = 0;
|
|
|
|
rdp = &rd[com_port][cur_rd[com_port]];
|
|
|
|
/* Go thru rcv desc's until empty looking for one with data (no error)*/
|
|
while (((rdp->cmd_stat & SDMA_DESC_CMDSTAT_O) == 0) &&
|
|
(loop_count++ < RX_NUM_DESC)) {
|
|
|
|
/* If there was an error, reinit the desc & continue */
|
|
if ((rdp->cmd_stat & SDMA_DESC_CMDSTAT_ES) != 0) {
|
|
RX_INIT_RDP(rdp);
|
|
if (++cur_rd[com_port] >= RX_NUM_DESC)
|
|
cur_rd[com_port] = 0;
|
|
rdp = (struct mv64x60_rx_desc *)rdp->next_desc_ptr;
|
|
} else {
|
|
rc = 1;
|
|
break;
|
|
}
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
void
|
|
serial_close(unsigned long com_port)
|
|
{
|
|
stop_dma(com_port);
|
|
}
|