blob: dca73b93d0024ea185ac16586c6e56a1a5575dab [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>
30#include <devices.h>
31
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 +010092#ifndef CONFIG_ARM_DCC_MULTI
93#define arm_dcc_init serial_init
94void serial_setbrg(void) {}
95#define arm_dcc_getc serial_getc
96#define arm_dcc_putc serial_putc
97#define arm_dcc_puts serial_puts
98#define arm_dcc_tstc serial_tstc
99#endif
100
101int arm_dcc_init(void)
102{
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +0100103 return 0;
104}
105
106int arm_dcc_getc(void)
107{
108 int ch;
109 register unsigned int reg;
110
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +0200111 do {
112 can_read_dcc(reg);
113 } while (!reg);
114 read_dcc(ch);
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +0100115
116 return ch;
117}
118
119void arm_dcc_putc(char ch)
120{
121 register unsigned int reg;
122 unsigned int timeout_count = TIMEOUT_COUNT;
123
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +0200124 while (--timeout_count) {
125 can_write_dcc(reg);
126 if (reg)
127 break;
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +0100128 }
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +0200129 if (timeout_count == 0)
130 return;
131 else
132 write_dcc(ch);
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +0100133}
134
135void arm_dcc_puts(const char *s)
136{
137 while (*s)
138 arm_dcc_putc(*s++);
139}
140
141int arm_dcc_tstc(void)
142{
143 register unsigned int reg;
144
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +0200145 can_read_dcc(reg);
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +0100146
147 return reg;
148}
149
150#ifdef CONFIG_ARM_DCC_MULTI
151static device_t arm_dcc_dev;
152
153int drv_arm_dcc_init(void)
154{
155 int rc;
156
157 /* Device initialization */
158 memset(&arm_dcc_dev, 0, sizeof(arm_dcc_dev));
159
160 strcpy(arm_dcc_dev.name, "dcc");
161 arm_dcc_dev.ext = 0; /* No extensions */
162 arm_dcc_dev.flags = DEV_FLAGS_INPUT | DEV_FLAGS_OUTPUT;
163 arm_dcc_dev.tstc = arm_dcc_tstc; /* 'tstc' function */
164 arm_dcc_dev.getc = arm_dcc_getc; /* 'getc' function */
165 arm_dcc_dev.putc = arm_dcc_putc; /* 'putc' function */
166 arm_dcc_dev.puts = arm_dcc_puts; /* 'puts' function */
167
Jean-Christophe PLAGNIOL-VILLARD66e8f9d2009-05-15 23:47:14 +0200168 return device_register(&arm_dcc_dev);
Jean-Christophe PLAGNIOL-VILLARD4f572892009-02-22 15:49:28 +0100169}
170#endif