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
|
#include <linux/device.h>
#include <linux/platform_device.h>
#include <linux/irq.h>
#include <linux/tty.h>
#include <linux/tty_flip.h>
#include <asm/fiq.h>
#include <asm/fiq_glue.h>
#include <asm/fiq_debugger.h>
#include <mach/irqs.h>
#include <mach/mt_reg_base.h>
#include <linux/uart/mtk_uart.h>
#include <linux/uart/mtk_uart_intf.h>
#define MT_UART_FIQ_ID MT_UART4_IRQ_ID
static void fiq_enable(struct platform_device *pdev, unsigned int fiq, bool enable)
{
if (enable)
enable_fiq(fiq);
else
disable_fiq(fiq);
}
static void fiq_dbg_force_irq(struct platform_device *pdev, unsigned int irq)
{
trigger_sw_irq(irq);
}
struct fiq_debugger_pdata fiq_serial_data = {
.uart_getc = &fiq_uart_getc,
.uart_putc = &fiq_uart_putc,
.fiq_enable = &fiq_enable,
.fiq_ack = 0,
.force_irq = &fiq_dbg_force_irq,
.force_irq_ack = 0,
};
struct resource fiq_resource[] = {
[0] = {
.start = FIQ_DBG_SGI,
.end = FIQ_DBG_SGI,
.flags = IORESOURCE_IRQ,
.name = "signal",
},
[1] = {
.start = MT_UART_FIQ_ID,
.end = MT_UART_FIQ_ID,
.flags = IORESOURCE_IRQ,
.name = "fiq",
},
};
struct platform_device mt_fiq_debugger = {
.name = "fiq_debugger",
.id = -1,
.dev = {
.platform_data = &fiq_serial_data,
},
.num_resources = ARRAY_SIZE(fiq_resource),
.resource = fiq_resource,
};
void mt_fiq_printf(const char *fmt, ...)
{
char buf[256];
va_list ap;
unsigned c;
char *s;
va_start(ap, fmt);
vsnprintf(buf, sizeof(buf), fmt, ap);
va_end(ap);
s = (char *)buf;
while ((c = *s++)) {
#if 0
if (c == '\n') {
fiq_uart_putc(NULL, '\r');
}
#endif
fiq_uart_putc(NULL, c);
}
}
|
