speed.c 1.8 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586
  1. /*
  2. *
  3. * (c) 2004 Sascha Hauer <sascha@saschahauer.de>
  4. *
  5. * SPDX-License-Identifier: GPL-2.0+
  6. */
  7. #include <common.h>
  8. #if defined (CONFIG_IMX)
  9. #include <asm/arch/imx-regs.h>
  10. /* ------------------------------------------------------------------------- */
  11. /* NOTE: This describes the proper use of this file.
  12. *
  13. * CONFIG_SYS_CLK_FREQ should be defined as the input frequency of the PLL.
  14. * SH FIXME: 16780000 in our case
  15. * get_FCLK(), get_HCLK(), get_PCLK() and get_UCLK() return the clock of
  16. * the specified bus in HZ.
  17. */
  18. /* ------------------------------------------------------------------------- */
  19. ulong get_systemPLLCLK(void)
  20. {
  21. /* FIXME: We assume System_SEL = 0 here */
  22. u32 spctl0 = SPCTL0;
  23. u32 mfi = (spctl0 >> 10) & 0xf;
  24. u32 mfn = spctl0 & 0x3f;
  25. u32 mfd = (spctl0 >> 16) & 0x3f;
  26. u32 pd = (spctl0 >> 26) & 0xf;
  27. mfi = mfi<=5 ? 5 : mfi;
  28. return (2*(CONFIG_SYSPLL_CLK_FREQ>>10)*( (mfi<<10) + (mfn<<10)/(mfd+1)))/(pd+1);
  29. }
  30. ulong get_mcuPLLCLK(void)
  31. {
  32. /* FIXME: We assume System_SEL = 0 here */
  33. u32 mpctl0 = MPCTL0;
  34. u32 mfi = (mpctl0 >> 10) & 0xf;
  35. u32 mfn = mpctl0 & 0x3f;
  36. u32 mfd = (mpctl0 >> 16) & 0x3f;
  37. u32 pd = (mpctl0 >> 26) & 0xf;
  38. mfi = mfi<=5 ? 5 : mfi;
  39. return (2*(CONFIG_SYS_CLK_FREQ>>10)*( (mfi<<10) + (mfn<<10)/(mfd+1)))/(pd+1);
  40. }
  41. ulong get_FCLK(void)
  42. {
  43. return (( CSCR>>15)&1) ? get_mcuPLLCLK()>>1 : get_mcuPLLCLK();
  44. }
  45. /* return HCLK frequency */
  46. ulong get_HCLK(void)
  47. {
  48. u32 bclkdiv = (( CSCR >> 10 ) & 0xf) + 1;
  49. printf("bclkdiv: %d\n", bclkdiv);
  50. return get_systemPLLCLK() / bclkdiv;
  51. }
  52. /* return BCLK frequency */
  53. ulong get_BCLK(void)
  54. {
  55. return get_HCLK();
  56. }
  57. ulong get_PERCLK1(void)
  58. {
  59. return get_systemPLLCLK() / (((PCDR) & 0xf)+1);
  60. }
  61. ulong get_PERCLK2(void)
  62. {
  63. return get_systemPLLCLK() / (((PCDR>>4) & 0xf)+1);
  64. }
  65. ulong get_PERCLK3(void)
  66. {
  67. return get_systemPLLCLK() / (((PCDR>>16) & 0x7f)+1);
  68. }
  69. #endif /* defined (CONFIG_IMX) */