utils.c 2.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114
  1. /*
  2. * Copyright 2011 Linaro Limited
  3. * Aneesh V <aneesh@ti.com>
  4. *
  5. * SPDX-License-Identifier: GPL-2.0+
  6. */
  7. #include <common.h>
  8. #include <asm/setup.h>
  9. #include <asm/arch/sys_proto.h>
  10. static void do_cancel_out(u32 *num, u32 *den, u32 factor)
  11. {
  12. while (1) {
  13. if (((*num)/factor*factor == (*num)) &&
  14. ((*den)/factor*factor == (*den))) {
  15. (*num) /= factor;
  16. (*den) /= factor;
  17. } else
  18. break;
  19. }
  20. }
  21. /*
  22. * Cancel out the denominator and numerator of a fraction
  23. * to get smaller numerator and denominator.
  24. */
  25. void cancel_out(u32 *num, u32 *den, u32 den_limit)
  26. {
  27. do_cancel_out(num, den, 2);
  28. do_cancel_out(num, den, 3);
  29. do_cancel_out(num, den, 5);
  30. do_cancel_out(num, den, 7);
  31. do_cancel_out(num, den, 11);
  32. do_cancel_out(num, den, 13);
  33. do_cancel_out(num, den, 17);
  34. while ((*den) > den_limit) {
  35. *num /= 2;
  36. /*
  37. * Round up the denominator so that the final fraction
  38. * (num/den) is always <= the desired value
  39. */
  40. *den = (*den + 1) / 2;
  41. }
  42. }
  43. __weak void omap_die_id(unsigned int *die_id)
  44. {
  45. die_id[0] = die_id[1] = die_id[2] = die_id[3] = 0;
  46. }
  47. void omap_die_id_serial(void)
  48. {
  49. unsigned int die_id[4] = { 0 };
  50. char serial_string[17] = { 0 };
  51. omap_die_id((unsigned int *)&die_id);
  52. if (!getenv("serial#")) {
  53. snprintf(serial_string, sizeof(serial_string),
  54. "%08x%08x", die_id[0], die_id[3]);
  55. setenv("serial#", serial_string);
  56. }
  57. }
  58. void omap_die_id_get_board_serial(struct tag_serialnr *serialnr)
  59. {
  60. char *serial_string;
  61. unsigned long long serial;
  62. serial_string = getenv("serial#");
  63. if (serial_string) {
  64. serial = simple_strtoull(serial_string, NULL, 16);
  65. serialnr->high = (unsigned int) (serial >> 32);
  66. serialnr->low = (unsigned int) (serial & 0xffffffff);
  67. } else {
  68. serialnr->high = 0;
  69. serialnr->low = 0;
  70. }
  71. }
  72. void omap_die_id_usbethaddr(void)
  73. {
  74. unsigned int die_id[4] = { 0 };
  75. unsigned char mac[6] = { 0 };
  76. omap_die_id((unsigned int *)&die_id);
  77. if (!getenv("usbethaddr")) {
  78. /*
  79. * Create a fake MAC address from the processor ID code.
  80. * First byte is 0x02 to signify locally administered.
  81. */
  82. mac[0] = 0x02;
  83. mac[1] = die_id[3] & 0xff;
  84. mac[2] = die_id[2] & 0xff;
  85. mac[3] = die_id[1] & 0xff;
  86. mac[4] = die_id[0] & 0xff;
  87. mac[5] = (die_id[0] >> 8) & 0xff;
  88. eth_setenv_enetaddr("usbethaddr", mac);
  89. }
  90. }
  91. void omap_die_id_display(void)
  92. {
  93. unsigned int die_id[4] = { 0 };
  94. omap_die_id(die_id);
  95. printf("OMAP die ID: %08x%08x%08x%08x\n", die_id[3], die_id[2],
  96. die_id[1], die_id[0]);
  97. }