[PATCH] powerpc: Only calculate htab_size in one place for kexec
[linux-3.10.git] / arch / ppc / xmon / adb.c
1 /*
2  * Copyright (C) 1996 Paul Mackerras.
3  */
4 #include "nonstdio.h"
5 #include "privinst.h"
6
7 #define scanhex xmon_scanhex
8 #define skipbl  xmon_skipbl
9
10 #define ADB_B           (*(volatile unsigned char *)0xf3016000)
11 #define ADB_SR          (*(volatile unsigned char *)0xf3017400)
12 #define ADB_ACR         (*(volatile unsigned char *)0xf3017600)
13 #define ADB_IFR         (*(volatile unsigned char *)0xf3017a00)
14
15 static inline void eieio(void) { asm volatile ("eieio" : :); }
16
17 #define N_ADB_LOG       1000
18 struct adb_log {
19     unsigned char b;
20     unsigned char ifr;
21     unsigned char acr;
22     unsigned int time;
23 } adb_log[N_ADB_LOG];
24 int n_adb_log;
25
26 void
27 init_adb_log(void)
28 {
29     adb_log[0].b = ADB_B;
30     adb_log[0].ifr = ADB_IFR;
31     adb_log[0].acr = ADB_ACR;
32     adb_log[0].time = get_dec();
33     n_adb_log = 0;
34 }
35
36 void
37 dump_adb_log(void)
38 {
39     unsigned t, t0;
40     struct adb_log *ap;
41     int i;
42
43     ap = adb_log;
44     t0 = ap->time;
45     for (i = 0; i <= n_adb_log; ++i, ++ap) {
46         t = t0 - ap->time;
47         printf("b=%x ifr=%x acr=%x at %d.%.7d\n", ap->b, ap->ifr, ap->acr,
48                t / 1000000000, (t % 1000000000) / 100);
49     }
50 }
51
52 void
53 adb_chklog(void)
54 {
55     struct adb_log *ap = &adb_log[n_adb_log + 1];
56
57     ap->b = ADB_B;
58     ap->ifr = ADB_IFR;
59     ap->acr = ADB_ACR;
60     if (ap->b != ap[-1].b || (ap->ifr & 4) != (ap[-1].ifr & 4)
61         || ap->acr != ap[-1].acr) {
62         ap->time = get_dec();
63         ++n_adb_log;
64     }
65 }
66
67 int
68 adb_bitwait(int bmask, int bval, int fmask, int fval)
69 {
70     int i;
71     struct adb_log *ap;
72
73     for (i = 10000; i > 0; --i) {
74         adb_chklog();
75         ap = &adb_log[n_adb_log];
76         if ((ap->b & bmask) == bval && (ap->ifr & fmask) == fval)
77             return 0;
78     }
79     return -1;
80 }
81
82 int
83 adb_wait(void)
84 {
85     if (adb_bitwait(0, 0, 4, 4) < 0) {
86         printf("adb: ready wait timeout\n");
87         return -1;
88     }
89     return 0;
90 }
91
92 void
93 adb_readin(void)
94 {
95     int i, j;
96     unsigned char d[64];
97
98     if (ADB_B & 8) {
99         printf("ADB_B: %x\n", ADB_B);
100         return;
101     }
102     i = 0;
103     adb_wait();
104     j = ADB_SR;
105     eieio();
106     ADB_B &= ~0x20;
107     eieio();
108     for (;;) {
109         if (adb_wait() < 0)
110             break;
111         d[i++] = ADB_SR;
112         eieio();
113         if (ADB_B & 8)
114             break;
115         ADB_B ^= 0x10;
116         eieio();
117     }
118     ADB_B |= 0x30;
119     if (adb_wait() == 0)
120         j = ADB_SR;
121     for (j = 0; j < i; ++j)
122         printf("%.2x ", d[j]);
123     printf("\n");
124 }
125
126 int
127 adb_write(unsigned char *d, int i)
128 {
129     int j;
130     unsigned x;
131
132     if ((ADB_B & 8) == 0) {
133         printf("r: ");
134         adb_readin();
135     }
136     for (;;) {
137         ADB_ACR = 0x1c;
138         eieio();
139         ADB_SR = d[0];
140         eieio();
141         ADB_B &= ~0x20;
142         eieio();
143         if (ADB_B & 8)
144             break;
145         ADB_ACR = 0xc;
146         eieio();
147         ADB_B |= 0x20;
148         eieio();
149         adb_readin();
150     }
151     adb_wait();
152     for (j = 1; j < i; ++j) {
153         ADB_SR = d[j];
154         eieio();
155         ADB_B ^= 0x10;
156         eieio();
157         if (adb_wait() < 0)
158             break;
159     }
160     ADB_ACR = 0xc;
161     eieio();
162     x = ADB_SR;
163     eieio();
164     ADB_B |= 0x30;
165     return j;
166 }
167
168 void
169 adbcmds(void)
170 {
171     char cmd;
172     unsigned rtcu, rtcl, dec, pdec, x;
173     int i, j;
174     unsigned char d[64];
175
176     cmd = skipbl();
177     switch (cmd) {
178     case 't':
179         for (;;) {
180             rtcl = get_rtcl();
181             rtcu = get_rtcu();
182             dec = get_dec();
183             printf("rtc u=%u l=%u dec=%x (%d = %d.%.7d)\n",
184                    rtcu, rtcl, dec, pdec - dec, (pdec - dec) / 1000000000,
185                    ((pdec - dec) % 1000000000) / 100);
186             pdec = dec;
187             if (cmd == 'x')
188                 break;
189             while (xmon_read(stdin, &cmd, 1) != 1)
190                 ;
191         }
192         break;
193     case 'r':
194         init_adb_log();
195         while (adb_bitwait(8, 0, 0, 0) == 0)
196             adb_readin();
197         break;
198     case 'w':
199         i = 0;
200         while (scanhex(&x))
201             d[i++] = x;
202         init_adb_log();
203         j = adb_write(d, i);
204         printf("sent %d bytes\n", j);
205         while (adb_bitwait(8, 0, 0, 0) == 0)
206             adb_readin();
207         break;
208     case 'l':
209         dump_adb_log();
210         break;
211     }
212 }