1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154
|
/*
* (C) Copyright 2004, Psyent Corporation <www.psyent.com>
* Scott McNutt <smcnutt@psyent.com>
*
* SPDX-License-Identifier: GPL-2.0+
*/
#include <common.h>
#include <dm.h>
#include <errno.h>
#include <serial.h>
#include <asm/io.h>
DECLARE_GLOBAL_DATA_PTR;
/* data register */
#define ALTERA_JTAG_RVALID BIT(15) /* Read valid */
/* control register */
#define ALTERA_JTAG_AC BIT(10) /* activity indicator */
#define ALTERA_JTAG_RRDY BIT(12) /* read available */
#define ALTERA_JTAG_WSPACE(d) ((d) >> 16) /* Write space avail */
/* Write fifo size. FIXME: this should be extracted with sopc2dts */
#define ALTERA_JTAG_WRITE_DEPTH 64
struct altera_jtaguart_regs {
u32 data; /* Data register */
u32 control; /* Control register */
};
struct altera_jtaguart_platdata {
struct altera_jtaguart_regs *regs;
};
static int altera_jtaguart_setbrg(struct udevice *dev, int baudrate)
{
return 0;
}
static int altera_jtaguart_putc(struct udevice *dev, const char ch)
{
struct altera_jtaguart_platdata *plat = dev->platdata;
struct altera_jtaguart_regs *const regs = plat->regs;
u32 st = readl(®s->control);
#ifdef CONFIG_ALTERA_JTAG_UART_BYPASS
if (!(st & ALTERA_JTAG_AC)) /* no connection yet */
return -ENETUNREACH;
#endif
if (ALTERA_JTAG_WSPACE(st) == 0)
return -EAGAIN;
writel(ch, ®s->data);
return 0;
}
static int altera_jtaguart_pending(struct udevice *dev, bool input)
{
struct altera_jtaguart_platdata *plat = dev->platdata;
struct altera_jtaguart_regs *const regs = plat->regs;
u32 st = readl(®s->control);
if (input)
return st & ALTERA_JTAG_RRDY ? 1 : 0;
else
return !(ALTERA_JTAG_WSPACE(st) == ALTERA_JTAG_WRITE_DEPTH);
}
static int altera_jtaguart_getc(struct udevice *dev)
{
struct altera_jtaguart_platdata *plat = dev->platdata;
struct altera_jtaguart_regs *const regs = plat->regs;
u32 val;
val = readl(®s->data);
if (!(val & ALTERA_JTAG_RVALID))
return -EAGAIN;
return val & 0xff;
}
static int altera_jtaguart_probe(struct udevice *dev)
{
#ifdef CONFIG_ALTERA_JTAG_UART_BYPASS
struct altera_jtaguart_platdata *plat = dev->platdata;
struct altera_jtaguart_regs *const regs = plat->regs;
writel(ALTERA_JTAG_AC, ®s->control); /* clear AC flag */
#endif
return 0;
}
static int altera_jtaguart_ofdata_to_platdata(struct udevice *dev)
{
struct altera_jtaguart_platdata *plat = dev_get_platdata(dev);
plat->regs = map_physmem(dev_get_addr(dev),
sizeof(struct altera_jtaguart_regs),
MAP_NOCACHE);
return 0;
}
static const struct dm_serial_ops altera_jtaguart_ops = {
.putc = altera_jtaguart_putc,
.pending = altera_jtaguart_pending,
.getc = altera_jtaguart_getc,
.setbrg = altera_jtaguart_setbrg,
};
static const struct udevice_id altera_jtaguart_ids[] = {
{ .compatible = "altr,juart-1.0" },
{}
};
U_BOOT_DRIVER(altera_jtaguart) = {
.name = "altera_jtaguart",
.id = UCLASS_SERIAL,
.of_match = altera_jtaguart_ids,
.ofdata_to_platdata = altera_jtaguart_ofdata_to_platdata,
.platdata_auto_alloc_size = sizeof(struct altera_jtaguart_platdata),
.probe = altera_jtaguart_probe,
.ops = &altera_jtaguart_ops,
.flags = DM_FLAG_PRE_RELOC,
};
#ifdef CONFIG_DEBUG_UART_ALTERA_JTAGUART
#include <debug_uart.h>
static inline void _debug_uart_init(void)
{
}
static inline void _debug_uart_putc(int ch)
{
struct altera_jtaguart_regs *regs = (void *)CONFIG_DEBUG_UART_BASE;
while (1) {
u32 st = readl(®s->control);
if (ALTERA_JTAG_WSPACE(st))
break;
}
writel(ch, ®s->data);
}
DEBUG_UART_FUNCS
#endif
|