blob: c217c88e59aec10c47bb547520d5eb7a1e61906c [file] [log] [blame]
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +01001/*
2 * Copyright (C) 2004-2007 ARM Limited.
3 * Copyright (C) 2008 Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
4 *
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License version 2
7 * as published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
17 *
18 * As a special exception, if other files instantiate templates or use macros
19 * or inline functions from this file, or you compile this file and link it
20 * with other works to produce a work based on this file, this file does not
21 * by itself cause the resulting work to be covered by the GNU General Public
22 * License. However the source code for this file must still be made available
23 * in accordance with section (3) of the GNU General Public License.
24
25 * This exception does not invalidate any other reasons why a work based on
26 * this file might be covered by the GNU General Public License.
27 */
28
29#include <common.h>
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +020030#include <stdio_dev.h>
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +010031
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +020032#if defined(CONFIG_CPU_V6)
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +010033/*
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +020034 * ARMV6
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +010035 */
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +020036#define DCC_RBIT (1 << 30)
37#define DCC_WBIT (1 << 29)
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +010038
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +020039#define write_dcc(x) \
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +010040 __asm__ volatile ("mcr p14, 0, %0, c0, c5, 0\n" : : "r" (x))
41
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +020042#define read_dcc(x) \
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +010043 __asm__ volatile ("mrc p14, 0, %0, c0, c5, 0\n" : "=r" (x))
44
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +020045#define status_dcc(x) \
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +010046 __asm__ volatile ("mrc p14, 0, %0, c0, c1, 0\n" : "=r" (x))
47
Jean-Christophe PLAGNIOL-VILLARD65a76d42009-05-15 23:47:14 +020048#elif defined(CONFIG_CPU_XSCALE)
49/*
50 * XSCALE
51 */
52#define DCC_RBIT (1 << 31)
53#define DCC_WBIT (1 << 28)
54
55#define write_dcc(x) \
56 __asm__ volatile ("mcr p14, 0, %0, c8, c0, 0\n" : : "r" (x))
57
58#define read_dcc(x) \
59 __asm__ volatile ("mrc p14, 0, %0, c9, c0, 0\n" : "=r" (x))
60
61#define status_dcc(x) \
62 __asm__ volatile ("mrc p14, 0, %0, c14, c0, 0\n" : "=r" (x))
63
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +020064#else
65#define DCC_RBIT (1 << 0)
66#define DCC_WBIT (1 << 1)
67
68#define write_dcc(x) \
69 __asm__ volatile ("mcr p14, 0, %0, c1, c0, 0\n" : : "r" (x))
70
71#define read_dcc(x) \
72 __asm__ volatile ("mrc p14, 0, %0, c1, c0, 0\n" : "=r" (x))
73
74#define status_dcc(x) \
75 __asm__ volatile ("mrc p14, 0, %0, c0, c0, 0\n" : "=r" (x))
76
77#endif
78
79#define can_read_dcc(x) do { \
80 status_dcc(x); \
81 x &= DCC_RBIT; \
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +010082 } while (0);
83
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +020084#define can_write_dcc(x) do { \
85 status_dcc(x); \
86 x &= DCC_WBIT; \
87 x = (x == 0); \
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +010088 } while (0);
89
90#define TIMEOUT_COUNT 0x4000000
91
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +010092int arm_dcc_init(void)
93{
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +010094 return 0;
95}
96
97int arm_dcc_getc(void)
98{
99 int ch;
100 register unsigned int reg;
101
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +0200102 do {
103 can_read_dcc(reg);
104 } while (!reg);
105 read_dcc(ch);
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +0100106
107 return ch;
108}
109
110void arm_dcc_putc(char ch)
111{
112 register unsigned int reg;
113 unsigned int timeout_count = TIMEOUT_COUNT;
114
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +0200115 while (--timeout_count) {
116 can_write_dcc(reg);
117 if (reg)
118 break;
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +0100119 }
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +0200120 if (timeout_count == 0)
121 return;
122 else
123 write_dcc(ch);
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +0100124}
125
126void arm_dcc_puts(const char *s)
127{
128 while (*s)
129 arm_dcc_putc(*s++);
130}
131
132int arm_dcc_tstc(void)
133{
134 register unsigned int reg;
135
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +0200136 can_read_dcc(reg);
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +0100137
138 return reg;
139}
140
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +0200141static struct stdio_dev arm_dcc_dev;
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +0100142
143int drv_arm_dcc_init(void)
144{
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +0100145 strcpy(arm_dcc_dev.name, "dcc");
146 arm_dcc_dev.ext = 0; /* No extensions */
147 arm_dcc_dev.flags = DEV_FLAGS_INPUT | DEV_FLAGS_OUTPUT;
148 arm_dcc_dev.tstc = arm_dcc_tstc; /* 'tstc' function */
149 arm_dcc_dev.getc = arm_dcc_getc; /* 'getc' function */
150 arm_dcc_dev.putc = arm_dcc_putc; /* 'putc' function */
151 arm_dcc_dev.puts = arm_dcc_puts; /* 'puts' function */
152
Jean-Christophe PLAGNIOL-VILLARD52cb4d42009-05-16 12:14:54 +0200153 return stdio_register(&arm_dcc_dev);
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +0100154}
Michal Simeke70fb532013-01-22 23:40:06 +0000155
156__weak struct serial_device *default_serial_console(void)
157{
158 return NULL;
159}