1#include <common.h>
2#include <commproc.h>
3
4#if defined(CONFIG_SYS_I2C_UCODE_PATCH) || defined(CONFIG_SYS_SPI_UCODE_PATCH) || \
5 defined(CONFIG_SYS_SMC_UCODE_PATCH)
6
7static void UcodeCopy (volatile cpm8xx_t *cpm);
8
9void cpm_load_patch (volatile immap_t *immr)
10{
11 immr->im_cpm.cp_rccr &= ~0x0003;
12
13 UcodeCopy ((cpm8xx_t *)&immr->im_cpm);
14#ifdef CONFIG_SYS_SPI_UCODE_PATCH
15 {
16 volatile spi_t *spi = (spi_t *) & immr->im_cpm.cp_dparam[PROFF_SPI];
17
18
19 immr->im_cpm.cp_cpmcr1 = 0x802a;
20 immr->im_cpm.cp_cpmcr2 = 0x8028;
21 spi->spi_rpbase = CONFIG_SYS_SPI_DPMEM_OFFSET;
22 }
23#endif
24
25#ifdef CONFIG_SYS_I2C_UCODE_PATCH
26 {
27 volatile iic_t *iip = (iic_t *) & immr->im_cpm.cp_dparam[PROFF_IIC];
28
29
30 immr->im_cpm.cp_cpmcr3 = 0x802e;
31 immr->im_cpm.cp_cpmcr4 = 0x802c;
32 iip->iic_rpbase = CONFIG_SYS_I2C_DPMEM_OFFSET;
33 }
34#endif
35
36#ifdef CONFIG_SYS_SMC_UCODE_PATCH
37 {
38 volatile smc_uart_t *up = (smc_uart_t *) & immr->im_cpm.cp_dparam[PROFF_SMC1];
39
40
41 immr->im_cpm.cp_cpmcr1 = 0x8080;
42 immr->im_cpm.cp_cpmcr2 = 0x8088;
43 up->smc_rpbase = CONFIG_SYS_SMC_DPMEM_OFFSET;
44 }
45#endif
46
47
48
49
50
51#ifdef CONFIG_SYS_SMC_UCODE_PATCH
52 immr->im_cpm.cp_rccr |= 0x0002;
53#else
54 immr->im_cpm.cp_rccr |= 0x0001;
55#endif
56}
57
58#if defined(CONFIG_SYS_I2C_UCODE_PATCH) || defined(CONFIG_SYS_SPI_UCODE_PATCh)
59static ulong patch_2000[] = {
60 0x7FFFEFD9, 0x3FFD0000, 0x7FFB49F7, 0x7FF90000,
61 0x5FEFADF7, 0x5F88ADF7, 0x5FEFAFF7, 0x5F88AFF7,
62 0x3A9CFBC8, 0x77CAE1BB, 0xF4DE7FAD, 0xABAE9330,
63 0x4E08FDCF, 0x6E0FAFF8, 0x7CCF76CF, 0xFDAFF9CF,
64 0xABF88DC8, 0xAB5879F7, 0xB0927383, 0xDFD079F7,
65 0xB090E6BB, 0xE5BBE74F, 0xB3FA6F0F, 0x6FFB76CE,
66 0xEE0CF9CF, 0x2BFBEFEF, 0xCFEEF9CF, 0x76CEAD23,
67 0x90B3DF99, 0x7FDDD0C1, 0x4BF847FD, 0x7CCF76CE,
68 0xCFEF77CA, 0x7EAF7FAD, 0x7DFDF0B7, 0xEF7A7FCA,
69 0x77CAFBC8, 0x6079E722, 0xFBC85FFF, 0xDFFF5FB3,
70 0xFFFBFBC8, 0xF3C894A5, 0xE7C9EDF9, 0x7F9A7FAD,
71 0x5F36AFE8, 0x5F5BFFDF, 0xDF95CB9E, 0xAF7D5FC3,
72 0xAFED8C1B, 0x5FC3AFDD, 0x5FC5DF99, 0x7EFDB0B3,
73 0x5FB3FFFE, 0xABAE5FB3, 0xFFFE5FD0, 0x600BE6BB,
74 0x600B5FD0, 0xDFC827FB, 0xEFDF5FCA, 0xCFDE3A9C,
75 0xE7C9EDF9, 0xF3C87F9E, 0x54CA7FED, 0x2D3A3637,
76 0x756F7E9A, 0xF1CE37EF, 0x2E677FEE, 0x10EBADF8,
77 0xEFDECFEA, 0xE52F7D9F, 0xE12BF1CE, 0x5F647E9A,
78 0x4DF8CFEA, 0x5F717D9B, 0xEFEECFEA, 0x5F73E522,
79 0xEFDE5F73, 0xCFDA0B61, 0x7385DF61, 0xE7C9EDF9,
80 0x7E9A30D5, 0x1458BFFF, 0xF3C85FFF, 0xDFFFA7F8,
81 0x5F5BBFFE, 0x7F7D10D0, 0x144D5F33, 0xBFFFAF78,
82 0x5F5BBFFD, 0xA7F85F33, 0xBFFE77FD, 0x30BD4E08,
83 0xFDCFE5FF, 0x6E0FAFF8, 0x7EEF7E9F, 0xFDEFF1CF,
84 0x5F17ABF8, 0x0D5B5F5B, 0xFFEF79F7, 0x309EAFDD,
85 0x5F3147F8, 0x5F31AFED, 0x7FDD50AF, 0x497847FD,
86 0x7F9E7FED, 0x7DFD70A9, 0xEF7E7ECE, 0x6BA07F9E,
87 0x2D227EFD, 0x30DB5F5B, 0xFFFD5F5B, 0xFFEF5F5B,
88 0xFFDF0C9C, 0xAFED0A9A, 0xAFDD0C37, 0x5F37AFBD,
89 0x7FBDB081, 0x5F8147F8,
90};
91
92static ulong patch_2F00[] = {
93 0x3E303430, 0x34343737, 0xABBF9B99, 0x4B4FBDBD,
94 0x59949334, 0x9FFF37FB, 0x9B177DD9, 0x936956BB,
95 0xFBDD697B, 0xDD2FD113, 0x1DB9F7BB, 0x36313963,
96 0x79373369, 0x3193137F, 0x7331737A, 0xF7BB9B99,
97 0x9BB19795, 0x77FDFD3D, 0x573B773F, 0x737933F7,
98 0xB991D115, 0x31699315, 0x31531694, 0xBF4FBDBD,
99 0x35931497, 0x35376956, 0xBD697B9D, 0x96931313,
100 0x19797937, 0x69350000,
101};
102#else
103
104static ulong patch_2000[] = {
105 0x3fff0000, 0x3ffd0000, 0x3ffb0000, 0x3ff90000,
106 0x5fefeff8, 0x5f91eff8, 0x3ff30000, 0x3ff10000,
107 0x3a11e710, 0xedf0ccb9, 0xf318ed66, 0x7f0e5fe2,
108 0x7fedbb38, 0x3afe7468, 0x7fedf4d8, 0x8ffbb92d,
109 0xb83b77fd, 0xb0bb5eb9, 0xdfda7fed, 0x90bde74d,
110 0x6f0dcbd3, 0xe7decfed, 0xcb50cfed, 0xcfeddf6d,
111 0x914d4f74, 0x5eaedfcb, 0x9ee0e7df, 0xefbb6ffb,
112 0xe7ef7f0e, 0x9ee57fed, 0xebb7effa, 0xeb30affb,
113 0x7fea90b3, 0x7e0cf09f, 0xbffff318, 0x5fffdfff,
114 0xac35efea, 0x7fce1fc1, 0xe2ff5fbd, 0xaffbe2ff,
115 0x5fbfaffb, 0xf9a87d0f, 0xaef8770f, 0x7d0fb0a2,
116 0xeffbbfff, 0xcfef5fba, 0x7d0fbfff, 0x5fba4cf8,
117 0x7fddd09b, 0x49f847fd, 0x7efdf097, 0x7fedfffd,
118 0x7dfdf093, 0xef7e7e1e, 0x5fba7f0e, 0x3a11e710,
119 0xedf0cc87, 0xfb18ad0a, 0x1f85bbb8, 0x74283b7e,
120 0x7375e4bb, 0x2ab64fb8, 0x5c7de4bb, 0x32fdffbf,
121 0x5f0843f8, 0x7ce3e1bb, 0xe74f7ded, 0x6f0f4fe8,
122 0xc7ba32be, 0x73f2efeb, 0x600b4f78, 0xe5bb760b,
123 0x5388aef8, 0x4ef80b6a, 0xcfef9ee5, 0xabf8751f,
124 0xefef5b88, 0x741f4fe8, 0x751e760d, 0x7fdb70dd,
125 0x741cafce, 0xefcc7fce, 0x751e7088, 0x741ce7bb,
126 0x334ecfed, 0xafdbefeb, 0xe5bb760b, 0x53ceaef8,
127 0xafe8e7eb, 0x4bf8771e, 0x7e007fed, 0x4fcbe2cc,
128 0x7fbc3085, 0x7b0f7a0f, 0x34b177fd, 0xb0e75e93,
129 0xdf313e3b, 0xaf78741f, 0x741f30cc, 0xcfef5f08,
130 0x741f3e88, 0xafb8771e, 0x5f437fed, 0x0bafe2cc,
131 0x741ccfec, 0xe5ca53a9, 0x6fcb4f74, 0x5e89df27,
132 0x2a923d14, 0x4b8fdf0c, 0x751f741c, 0x6c1eeffa,
133 0xefea7fce, 0x6ffc309a, 0xefec3fca, 0x308fdf0a,
134 0xadf85e7a, 0xaf7daefd, 0x5e7adf0a, 0x5e7aafdd,
135 0x761f1088, 0x1e7c7efd, 0x3089fffe, 0x4908fb18,
136 0x5fffdfff, 0xafbbf0f7, 0x4ef85f43, 0xadf81489,
137 0x7a0f7089, 0xcfef5089, 0x7a0fdf0c, 0x5e7cafed,
138 0xbc6e780f, 0xefef780f, 0xefef790f, 0xa7f85eeb,
139 0xffef790f, 0xefef790f, 0x1489df0a, 0x5e7aadfd,
140 0x5f09fffb, 0xe79aded9, 0xeff96079, 0x607ae79a,
141 0xded8eff9, 0x60795edb, 0x607acfef, 0xefefefdf,
142 0xefbfef7f, 0xeeffedff, 0xebffe7ff, 0xafefafdf,
143 0xafbfaf7f, 0xaeffadff, 0xabffa7ff, 0x6fef6fdf,
144 0x6fbf6f7f, 0x6eff6dff, 0x6bff67ff, 0x2fef2fdf,
145 0x2fbf2f7f, 0x2eff2dff, 0x2bff27ff, 0x4e08fd1f,
146 0xe5ff6e0f, 0xaff87eef, 0x7e0ffdef, 0xf11f6079,
147 0xabf8f51e, 0x7e0af11c, 0x37cfae16, 0x7fec909a,
148 0xadf8efdc, 0xcfeae52f, 0x7d0fe12b, 0xf11c6079,
149 0x7e0a4df8, 0xcfea5ea0, 0x7d0befec, 0xcfea5ea2,
150 0xe522efdc, 0x5ea2cfda, 0x4e08fd1f, 0x6e0faff8,
151 0x7c1f761f, 0xfdeff91f, 0x6079abf8, 0x761cee00,
152 0xf91f2bfb, 0xefefcfec, 0xf91f6079, 0x761c27fb,
153 0xefdf5e83, 0xcfdc7fdd, 0x50f84bf8, 0x47fd7c1f,
154 0x761ccfcf, 0x7eef7fed, 0x7dfd70ef, 0xef7e7f1e,
155 0x771efb18, 0x6079e722, 0xe6bbe5bb, 0x2e66e5bb,
156 0x600b2ee1, 0xe2bbe2bb, 0xe2bbe2bb, 0x2f5ee2bb,
157 0xe2bb2ff9, 0x6079e2bb,
158};
159
160static ulong patch_2F00[] = {
161 0x30303030, 0x3e3e3030, 0xaf79b9b3, 0xbaa3b979,
162 0x9693369f, 0x79f79777, 0x97333fff, 0xfb3b9e9f,
163 0x79b91d11, 0x9e13f3ff, 0x3f9b6bd9, 0xe173d136,
164 0x695669d1, 0x697b3daf, 0x79b93a3a, 0x3f979f91,
165 0x379ff976, 0xf99777fd, 0x9779737d, 0xe9d6bbf9,
166 0xbfffd9df, 0x97f7fd97, 0x6f7b9bff, 0xf9bd9683,
167 0x397db973, 0xd97b3b9f, 0xd7f9f733, 0x9993bb9e,
168 0xe1f9ef93, 0x73773337, 0xb936917d, 0x11f87379,
169 0xb979d336, 0x8b7ded73, 0x1b7d9337, 0x31f3f22f,
170 0x3f2327ee, 0xeeeeeeee, 0xeeeeeeee, 0xeeeeeeee,
171 0xeeeeee4b, 0xf4fbdbd2, 0x58bb1878, 0x577fdfd2,
172 0xd573b773, 0xf7374b4f, 0xbdbd25b8, 0xb177d2d1,
173 0x7376856b, 0xbfdd687b, 0xdd2fff8f, 0x78ffff8f,
174 0xf22f0000,
175};
176#endif
177
178static void UcodeCopy (volatile cpm8xx_t *cpm)
179{
180 vu_long *p;
181 int i;
182
183 p = (vu_long *)&(cpm->cp_dpmem[0x0000]);
184 for (i=0; i < sizeof(patch_2000)/4; ++i) {
185 p[i] = patch_2000[i];
186 }
187
188 p = (vu_long *)&(cpm->cp_dpmem[0x0F00]);
189 for (i=0; i < sizeof(patch_2F00)/4; ++i) {
190 p[i] = patch_2F00[i];
191 }
192}
193
194#endif
195
