cpu.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673
  1. /*
  2. * Copyright (C) 2004-2006 Freescale Semiconductor, Inc.
  3. *
  4. * See file CREDITS for list of people who contributed to this
  5. * project.
  6. *
  7. * This program is free software; you can redistribute it and/or
  8. * modify it under the terms of the GNU General Public License as
  9. * published by the Free Software Foundation; either version 2 of
  10. * the License, or (at your option) any later version.
  11. *
  12. * This program is distributed in the hope that it will be useful,
  13. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  15. * GNU General Public License for more details.
  16. *
  17. * You should have received a copy of the GNU General Public License
  18. * along with this program; if not, write to the Free Software
  19. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  20. * MA 02111-1307 USA
  21. */
  22. /*
  23. * CPU specific code for the MPC83xx family.
  24. *
  25. * Derived from the MPC8260 and MPC85xx.
  26. */
  27. #include <common.h>
  28. #include <watchdog.h>
  29. #include <command.h>
  30. #include <mpc83xx.h>
  31. #include <asm/processor.h>
  32. #if defined(CONFIG_OF_FLAT_TREE)
  33. #include <ft_build.h>
  34. #endif
  35. #if defined(CONFIG_OF_LIBFDT)
  36. #include <libfdt.h>
  37. #include <libfdt_env.h>
  38. #endif
  39. DECLARE_GLOBAL_DATA_PTR;
  40. int checkcpu(void)
  41. {
  42. volatile immap_t *immr;
  43. ulong clock = gd->cpu_clk;
  44. u32 pvr = get_pvr();
  45. u32 spridr;
  46. char buf[32];
  47. immr = (immap_t *)CFG_IMMR;
  48. puts("CPU: ");
  49. switch (pvr & 0xffff0000) {
  50. case PVR_E300C1:
  51. printf("e300c1, ");
  52. break;
  53. case PVR_E300C2:
  54. printf("e300c2, ");
  55. break;
  56. case PVR_E300C3:
  57. printf("e300c3, ");
  58. break;
  59. default:
  60. printf("Unknown core, ");
  61. }
  62. spridr = immr->sysconf.spridr;
  63. switch(spridr) {
  64. case SPR_8349E_REV10:
  65. case SPR_8349E_REV11:
  66. case SPR_8349E_REV31:
  67. puts("MPC8349E, ");
  68. break;
  69. case SPR_8349_REV10:
  70. case SPR_8349_REV11:
  71. case SPR_8349_REV31:
  72. puts("MPC8349, ");
  73. break;
  74. case SPR_8347E_REV10_TBGA:
  75. case SPR_8347E_REV11_TBGA:
  76. case SPR_8347E_REV31_TBGA:
  77. case SPR_8347E_REV10_PBGA:
  78. case SPR_8347E_REV11_PBGA:
  79. case SPR_8347E_REV31_PBGA:
  80. puts("MPC8347E, ");
  81. break;
  82. case SPR_8347_REV10_TBGA:
  83. case SPR_8347_REV11_TBGA:
  84. case SPR_8347_REV31_TBGA:
  85. case SPR_8347_REV10_PBGA:
  86. case SPR_8347_REV11_PBGA:
  87. case SPR_8347_REV31_PBGA:
  88. puts("MPC8347, ");
  89. break;
  90. case SPR_8343E_REV10:
  91. case SPR_8343E_REV11:
  92. case SPR_8343E_REV31:
  93. puts("MPC8343E, ");
  94. break;
  95. case SPR_8343_REV10:
  96. case SPR_8343_REV11:
  97. case SPR_8343_REV31:
  98. puts("MPC8343, ");
  99. break;
  100. case SPR_8360E_REV10:
  101. case SPR_8360E_REV11:
  102. case SPR_8360E_REV12:
  103. case SPR_8360E_REV20:
  104. puts("MPC8360E, ");
  105. break;
  106. case SPR_8360_REV10:
  107. case SPR_8360_REV11:
  108. case SPR_8360_REV12:
  109. case SPR_8360_REV20:
  110. puts("MPC8360, ");
  111. break;
  112. case SPR_8323E_REV10:
  113. case SPR_8323E_REV11:
  114. puts("MPC8323E, ");
  115. break;
  116. case SPR_8323_REV10:
  117. case SPR_8323_REV11:
  118. puts("MPC8323, ");
  119. break;
  120. case SPR_8321E_REV10:
  121. case SPR_8321E_REV11:
  122. puts("MPC8321E, ");
  123. break;
  124. case SPR_8321_REV10:
  125. case SPR_8321_REV11:
  126. puts("MPC8321, ");
  127. break;
  128. case SPR_8311_REV10:
  129. puts("MPC8311, ");
  130. break;
  131. case SPR_8311E_REV10:
  132. puts("MPC8311E, ");
  133. break;
  134. case SPR_8313_REV10:
  135. puts("MPC8313, ");
  136. break;
  137. case SPR_8313E_REV10:
  138. puts("MPC8313E, ");
  139. break;
  140. default:
  141. puts("Rev: Unknown revision number.\nWarning: Unsupported cpu revision!\n");
  142. return 0;
  143. }
  144. #if defined(CONFIG_MPC834X)
  145. /* Multiple revisons of 834x processors may have the same SPRIDR value.
  146. * So use PVR to identify the revision number.
  147. */
  148. printf("Rev: %02x at %s MHz", PVR_MAJ(pvr)<<4 | PVR_MIN(pvr), strmhz(buf, clock));
  149. #else
  150. printf("Rev: %02x at %s MHz", spridr & 0x0000FFFF, strmhz(buf, clock));
  151. #endif
  152. printf(", CSB: %4d MHz\n", gd->csb_clk / 1000000);
  153. return 0;
  154. }
  155. /*
  156. * Program a UPM with the code supplied in the table.
  157. *
  158. * The 'dummy' variable is used to increment the MAD. 'dummy' is
  159. * supposed to be a pointer to the memory of the device being
  160. * programmed by the UPM. The data in the MDR is written into
  161. * memory and the MAD is incremented every time there's a read
  162. * from 'dummy'. Unfortunately, the current prototype for this
  163. * function doesn't allow for passing the address of this
  164. * device, and changing the prototype will break a number lots
  165. * of other code, so we need to use a round-about way of finding
  166. * the value for 'dummy'.
  167. *
  168. * The value can be extracted from the base address bits of the
  169. * Base Register (BR) associated with the specific UPM. To find
  170. * that BR, we need to scan all 8 BRs until we find the one that
  171. * has its MSEL bits matching the UPM we want. Once we know the
  172. * right BR, we can extract the base address bits from it.
  173. *
  174. * The MxMR and the BR and OR of the chosen bank should all be
  175. * configured before calling this function.
  176. *
  177. * Parameters:
  178. * upm: 0=UPMA, 1=UPMB, 2=UPMC
  179. * table: Pointer to an array of values to program
  180. * size: Number of elements in the array. Must be 64 or less.
  181. */
  182. void upmconfig (uint upm, uint *table, uint size)
  183. {
  184. #if defined(CONFIG_MPC834X)
  185. volatile immap_t *immap = (immap_t *) CFG_IMMR;
  186. volatile lbus83xx_t *lbus = &immap->lbus;
  187. volatile uchar *dummy = NULL;
  188. const u32 msel = (upm + 4) << BR_MSEL_SHIFT; /* What the MSEL field in BRn should be */
  189. volatile u32 *mxmr = &lbus->mamr + upm; /* Pointer to mamr, mbmr, or mcmr */
  190. uint i;
  191. /* Scan all the banks to determine the base address of the device */
  192. for (i = 0; i < 8; i++) {
  193. if ((lbus->bank[i].br & BR_MSEL) == msel) {
  194. dummy = (uchar *) (lbus->bank[i].br & BR_BA);
  195. break;
  196. }
  197. }
  198. if (!dummy) {
  199. printf("Error: %s() could not find matching BR\n", __FUNCTION__);
  200. hang();
  201. }
  202. /* Set the OP field in the MxMR to "write" and the MAD field to 000000 */
  203. *mxmr = (*mxmr & 0xCFFFFFC0) | 0x10000000;
  204. for (i = 0; i < size; i++) {
  205. lbus->mdr = table[i];
  206. __asm__ __volatile__ ("sync");
  207. *dummy; /* Write the value to memory and increment MAD */
  208. __asm__ __volatile__ ("sync");
  209. }
  210. /* Set the OP field in the MxMR to "normal" and the MAD field to 000000 */
  211. *mxmr &= 0xCFFFFFC0;
  212. #else
  213. printf("Error: %s() not defined for this configuration.\n", __FUNCTION__);
  214. hang();
  215. #endif
  216. }
  217. int
  218. do_reset (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
  219. {
  220. ulong msr;
  221. #ifndef MPC83xx_RESET
  222. ulong addr;
  223. #endif
  224. volatile immap_t *immap = (immap_t *) CFG_IMMR;
  225. #ifdef MPC83xx_RESET
  226. /* Interrupts and MMU off */
  227. __asm__ __volatile__ ("mfmsr %0":"=r" (msr):);
  228. msr &= ~( MSR_EE | MSR_IR | MSR_DR);
  229. __asm__ __volatile__ ("mtmsr %0"::"r" (msr));
  230. /* enable Reset Control Reg */
  231. immap->reset.rpr = 0x52535445;
  232. __asm__ __volatile__ ("sync");
  233. __asm__ __volatile__ ("isync");
  234. /* confirm Reset Control Reg is enabled */
  235. while(!((immap->reset.rcer) & RCER_CRE));
  236. printf("Resetting the board.");
  237. printf("\n");
  238. udelay(200);
  239. /* perform reset, only one bit */
  240. immap->reset.rcr = RCR_SWHR;
  241. #else /* ! MPC83xx_RESET */
  242. immap->reset.rmr = RMR_CSRE; /* Checkstop Reset enable */
  243. /* Interrupts and MMU off */
  244. __asm__ __volatile__ ("mfmsr %0":"=r" (msr):);
  245. msr &= ~(MSR_ME | MSR_EE | MSR_IR | MSR_DR);
  246. __asm__ __volatile__ ("mtmsr %0"::"r" (msr));
  247. /*
  248. * Trying to execute the next instruction at a non-existing address
  249. * should cause a machine check, resulting in reset
  250. */
  251. addr = CFG_RESET_ADDRESS;
  252. printf("resetting the board.");
  253. printf("\n");
  254. ((void (*)(void)) addr) ();
  255. #endif /* MPC83xx_RESET */
  256. return 1;
  257. }
  258. /*
  259. * Get timebase clock frequency (like cpu_clk in Hz)
  260. */
  261. unsigned long get_tbclk(void)
  262. {
  263. ulong tbclk;
  264. tbclk = (gd->bus_clk + 3L) / 4L;
  265. return tbclk;
  266. }
  267. #if defined(CONFIG_WATCHDOG)
  268. void watchdog_reset (void)
  269. {
  270. int re_enable = disable_interrupts();
  271. /* Reset the 83xx watchdog */
  272. volatile immap_t *immr = (immap_t *) CFG_IMMR;
  273. immr->wdt.swsrr = 0x556c;
  274. immr->wdt.swsrr = 0xaa39;
  275. if (re_enable)
  276. enable_interrupts ();
  277. }
  278. #endif
  279. #if defined(CONFIG_OF_LIBFDT)
  280. /*
  281. * "Setter" functions used to add/modify FDT entries.
  282. */
  283. static int fdt_set_eth0(void *fdt, int nodeoffset, const char *name, bd_t *bd)
  284. {
  285. /*
  286. * Fix it up if it exists, don't create it if it doesn't exist.
  287. */
  288. if (fdt_get_property(fdt, nodeoffset, name, 0)) {
  289. return fdt_setprop(fdt, nodeoffset, name, bd->bi_enetaddr, 6);
  290. }
  291. return -FDT_ERR_NOTFOUND;
  292. }
  293. #ifdef CONFIG_HAS_ETH1
  294. /* second onboard ethernet port */
  295. static int fdt_set_eth1(void *fdt, int nodeoffset, const char *name, bd_t *bd)
  296. {
  297. /*
  298. * Fix it up if it exists, don't create it if it doesn't exist.
  299. */
  300. if (fdt_get_property(fdt, nodeoffset, name, 0)) {
  301. return fdt_setprop(fdt, nodeoffset, name, bd->bi_enet1addr, 6);
  302. }
  303. return -FDT_ERR_NOTFOUND;
  304. }
  305. #endif
  306. #ifdef CONFIG_HAS_ETH2
  307. /* third onboard ethernet port */
  308. static int fdt_set_eth2(void *fdt, int nodeoffset, const char *name, bd_t *bd)
  309. {
  310. /*
  311. * Fix it up if it exists, don't create it if it doesn't exist.
  312. */
  313. if (fdt_get_property(fdt, nodeoffset, name, 0)) {
  314. return fdt_setprop(fdt, nodeoffset, name, bd->bi_enet2addr, 6);
  315. }
  316. return -FDT_ERR_NOTFOUND;
  317. }
  318. #endif
  319. #ifdef CONFIG_HAS_ETH3
  320. /* fourth onboard ethernet port */
  321. static int fdt_set_eth3(void *fdt, int nodeoffset, const char *name, bd_t *bd)
  322. {
  323. /*
  324. * Fix it up if it exists, don't create it if it doesn't exist.
  325. */
  326. if (fdt_get_property(fdt, nodeoffset, name, 0)) {
  327. return fdt_setprop(fdt, nodeoffset, name, bd->bi_enet3addr, 6);
  328. }
  329. return -FDT_ERR_NOTFOUND;
  330. }
  331. #endif
  332. static int fdt_set_busfreq(void *fdt, int nodeoffset, const char *name, bd_t *bd)
  333. {
  334. u32 tmp;
  335. /*
  336. * Create or update the property.
  337. */
  338. tmp = cpu_to_be32(bd->bi_busfreq);
  339. return fdt_setprop(fdt, nodeoffset, name, &tmp, sizeof(tmp));
  340. }
  341. /*
  342. * Fixups to the fdt. If "create" is TRUE, the node is created
  343. * unconditionally. If "create" is FALSE, the node is updated
  344. * only if it already exists.
  345. */
  346. static const struct {
  347. char *node;
  348. char *prop;
  349. int (*set_fn)(void *fdt, int nodeoffset, const char *name, bd_t *bd);
  350. } fixup_props[] = {
  351. { "/cpus/" OF_CPU,
  352. "bus-frequency",
  353. fdt_set_busfreq
  354. },
  355. { "/cpus/" OF_SOC,
  356. "bus-frequency",
  357. fdt_set_busfreq
  358. },
  359. { "/" OF_SOC "/serial@4500/",
  360. "clock-frequency",
  361. fdt_set_busfreq
  362. },
  363. { "/" OF_SOC "/serial@4600/",
  364. "clock-frequency",
  365. fdt_set_busfreq
  366. },
  367. #ifdef CONFIG_MPC83XX_TSEC1
  368. { "/" OF_SOC "/ethernet@24000,
  369. "mac-address",
  370. fdt_set_eth0
  371. },
  372. { "/" OF_SOC "/ethernet@24000,
  373. "local-mac-address",
  374. fdt_set_eth0
  375. },
  376. #endif
  377. #ifdef CONFIG_MPC83XX_TSEC2
  378. { "/" OF_SOC "/ethernet@25000,
  379. "mac-address",
  380. fdt_set_eth1
  381. },
  382. { "/" OF_SOC "/ethernet@25000,
  383. "local-mac-address",
  384. fdt_set_eth1
  385. },
  386. #endif
  387. #ifdef CONFIG_UEC_ETH1
  388. #if CFG_UEC1_UCC_NUM == 0 /* UCC1 */
  389. { "/" OF_QE "/ucc@2000/mac-address",
  390. "mac-address",
  391. fdt_set_eth0
  392. },
  393. { "/" OF_QE "/ucc@2000/mac-address",
  394. "local-mac-address",
  395. fdt_set_eth0
  396. },
  397. #elif CFG_UEC1_UCC_NUM == 2 /* UCC3 */
  398. { "/" OF_QE "/ucc@2200/mac-address",
  399. "mac-address",
  400. fdt_set_eth0
  401. },
  402. { "/" OF_QE "/ucc@2200/mac-address",
  403. "local-mac-address",
  404. fdt_set_eth0
  405. },
  406. #endif
  407. #endif
  408. #ifdef CONFIG_UEC_ETH2
  409. #if CFG_UEC2_UCC_NUM == 1 /* UCC2 */
  410. { "/" OF_QE "/ucc@3000/mac-address",
  411. "mac-address",
  412. fdt_set_eth1
  413. },
  414. { "/" OF_QE "/ucc@3000/mac-address",
  415. "local-mac-address",
  416. fdt_set_eth1
  417. },
  418. #elif CFG_UEC1_UCC_NUM == 3 /* UCC4 */
  419. { "/" OF_QE "/ucc@3200/mac-address",
  420. "mac-address",
  421. fdt_set_eth1
  422. },
  423. { "/" OF_QE "/ucc@3200/mac-address",
  424. "local-mac-address",
  425. fdt_set_eth1
  426. },
  427. #endif
  428. #endif
  429. };
  430. void
  431. ft_cpu_setup(void *blob, bd_t *bd)
  432. {
  433. int nodeoffset;
  434. int err;
  435. int j;
  436. for (j = 0; j < (sizeof(fixup_props) / sizeof(fixup_props[0])); j++) {
  437. nodeoffset = fdt_path_offset(fdt, fixup_props[j].node);
  438. if (nodeoffset >= 0) {
  439. err = (*fixup_props[j].set_fn)(blob, nodeoffset, fixup_props[j].prop, bd);
  440. if (err < 0)
  441. printf("set_fn/libfdt: %s %s returned %s\n",
  442. fixup_props[j].node,
  443. fixup_props[j].prop,
  444. fdt_strerror(err));
  445. }
  446. }
  447. }
  448. #endif
  449. #if defined(CONFIG_OF_FLAT_TREE)
  450. void
  451. ft_cpu_setup(void *blob, bd_t *bd)
  452. {
  453. u32 *p;
  454. int len;
  455. ulong clock;
  456. clock = bd->bi_busfreq;
  457. p = ft_get_prop(blob, "/cpus/" OF_CPU "/bus-frequency", &len);
  458. if (p != NULL)
  459. *p = cpu_to_be32(clock);
  460. p = ft_get_prop(blob, "/" OF_SOC "/bus-frequency", &len);
  461. if (p != NULL)
  462. *p = cpu_to_be32(clock);
  463. p = ft_get_prop(blob, "/" OF_SOC "/serial@4500/clock-frequency", &len);
  464. if (p != NULL)
  465. *p = cpu_to_be32(clock);
  466. p = ft_get_prop(blob, "/" OF_SOC "/serial@4600/clock-frequency", &len);
  467. if (p != NULL)
  468. *p = cpu_to_be32(clock);
  469. #ifdef CONFIG_MPC83XX_TSEC1
  470. p = ft_get_prop(blob, "/" OF_SOC "/ethernet@24000/mac-address", &len);
  471. if (p != NULL)
  472. memcpy(p, bd->bi_enetaddr, 6);
  473. p = ft_get_prop(blob, "/" OF_SOC "/ethernet@24000/local-mac-address", &len);
  474. if (p != NULL)
  475. memcpy(p, bd->bi_enetaddr, 6);
  476. #endif
  477. #ifdef CONFIG_MPC83XX_TSEC2
  478. p = ft_get_prop(blob, "/" OF_SOC "/ethernet@25000/mac-address", &len);
  479. if (p != NULL)
  480. memcpy(p, bd->bi_enet1addr, 6);
  481. p = ft_get_prop(blob, "/" OF_SOC "/ethernet@25000/local-mac-address", &len);
  482. if (p != NULL)
  483. memcpy(p, bd->bi_enet1addr, 6);
  484. #endif
  485. #ifdef CONFIG_UEC_ETH1
  486. #if CFG_UEC1_UCC_NUM == 0 /* UCC1 */
  487. p = ft_get_prop(blob, "/" OF_QE "/ucc@2000/mac-address", &len);
  488. if (p != NULL)
  489. memcpy(p, bd->bi_enetaddr, 6);
  490. p = ft_get_prop(blob, "/" OF_QE "/ucc@2000/local-mac-address", &len);
  491. if (p != NULL)
  492. memcpy(p, bd->bi_enetaddr, 6);
  493. #elif CFG_UEC1_UCC_NUM == 2 /* UCC3 */
  494. p = ft_get_prop(blob, "/" OF_QE "/ucc@2200/mac-address", &len);
  495. if (p != NULL)
  496. memcpy(p, bd->bi_enetaddr, 6);
  497. p = ft_get_prop(blob, "/" OF_QE "/ucc@2200/local-mac-address", &len);
  498. if (p != NULL)
  499. memcpy(p, bd->bi_enetaddr, 6);
  500. #endif
  501. #endif
  502. #ifdef CONFIG_UEC_ETH2
  503. #if CFG_UEC2_UCC_NUM == 1 /* UCC2 */
  504. p = ft_get_prop(blob, "/" OF_QE "/ucc@3000/mac-address", &len);
  505. if (p != NULL)
  506. memcpy(p, bd->bi_enet1addr, 6);
  507. p = ft_get_prop(blob, "/" OF_QE "/ucc@3000/local-mac-address", &len);
  508. if (p != NULL)
  509. memcpy(p, bd->bi_enet1addr, 6);
  510. #elif CFG_UEC2_UCC_NUM == 3 /* UCC4 */
  511. p = ft_get_prop(blob, "/" OF_QE "/ucc@3200/mac-address", &len);
  512. if (p != NULL)
  513. memcpy(p, bd->bi_enet1addr, 6);
  514. p = ft_get_prop(blob, "/" OF_QE "/ucc@3200/local-mac-address", &len);
  515. if (p != NULL)
  516. memcpy(p, bd->bi_enet1addr, 6);
  517. #endif
  518. #endif
  519. }
  520. #endif
  521. #if defined(CONFIG_DDR_ECC)
  522. void dma_init(void)
  523. {
  524. volatile immap_t *immap = (immap_t *)CFG_IMMR;
  525. volatile dma83xx_t *dma = &immap->dma;
  526. volatile u32 status = swab32(dma->dmasr0);
  527. volatile u32 dmamr0 = swab32(dma->dmamr0);
  528. debug("DMA-init\n");
  529. /* initialize DMASARn, DMADAR and DMAABCRn */
  530. dma->dmadar0 = (u32)0;
  531. dma->dmasar0 = (u32)0;
  532. dma->dmabcr0 = 0;
  533. __asm__ __volatile__ ("sync");
  534. __asm__ __volatile__ ("isync");
  535. /* clear CS bit */
  536. dmamr0 &= ~DMA_CHANNEL_START;
  537. dma->dmamr0 = swab32(dmamr0);
  538. __asm__ __volatile__ ("sync");
  539. __asm__ __volatile__ ("isync");
  540. /* while the channel is busy, spin */
  541. while(status & DMA_CHANNEL_BUSY) {
  542. status = swab32(dma->dmasr0);
  543. }
  544. debug("DMA-init end\n");
  545. }
  546. uint dma_check(void)
  547. {
  548. volatile immap_t *immap = (immap_t *)CFG_IMMR;
  549. volatile dma83xx_t *dma = &immap->dma;
  550. volatile u32 status = swab32(dma->dmasr0);
  551. volatile u32 byte_count = swab32(dma->dmabcr0);
  552. /* while the channel is busy, spin */
  553. while (status & DMA_CHANNEL_BUSY) {
  554. status = swab32(dma->dmasr0);
  555. }
  556. if (status & DMA_CHANNEL_TRANSFER_ERROR) {
  557. printf ("DMA Error: status = %x @ %d\n", status, byte_count);
  558. }
  559. return status;
  560. }
  561. int dma_xfer(void *dest, u32 count, void *src)
  562. {
  563. volatile immap_t *immap = (immap_t *)CFG_IMMR;
  564. volatile dma83xx_t *dma = &immap->dma;
  565. volatile u32 dmamr0;
  566. /* initialize DMASARn, DMADAR and DMAABCRn */
  567. dma->dmadar0 = swab32((u32)dest);
  568. dma->dmasar0 = swab32((u32)src);
  569. dma->dmabcr0 = swab32(count);
  570. __asm__ __volatile__ ("sync");
  571. __asm__ __volatile__ ("isync");
  572. /* init direct transfer, clear CS bit */
  573. dmamr0 = (DMA_CHANNEL_TRANSFER_MODE_DIRECT |
  574. DMA_CHANNEL_SOURCE_ADDRESS_HOLD_8B |
  575. DMA_CHANNEL_SOURCE_ADRESSS_HOLD_EN);
  576. dma->dmamr0 = swab32(dmamr0);
  577. __asm__ __volatile__ ("sync");
  578. __asm__ __volatile__ ("isync");
  579. /* set CS to start DMA transfer */
  580. dmamr0 |= DMA_CHANNEL_START;
  581. dma->dmamr0 = swab32(dmamr0);
  582. __asm__ __volatile__ ("sync");
  583. __asm__ __volatile__ ("isync");
  584. return ((int)dma_check());
  585. }
  586. #endif /*CONFIG_DDR_ECC*/