misc.c 1.1 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Miscellaneous Snapdragon functionality
  4. *
  5. * (C) Copyright 2018 Ramon Fried <ramon.fried@gmail.com>
  6. *
  7. */
  8. #include <common.h>
  9. #include <mmc.h>
  10. #include <asm/arch/misc.h>
  11. /* UNSTUFF_BITS macro taken from Linux Kernel: drivers/mmc/core/sd.c */
  12. #define UNSTUFF_BITS(resp, start, size) \
  13. ({ \
  14. const int __size = size; \
  15. const u32 __mask = (__size < 32 ? 1 << __size : 0) - 1; \
  16. const int __off = 3 - ((start) / 32); \
  17. const int __shft = (start) & 31; \
  18. u32 __res; \
  19. \
  20. __res = resp[__off] >> __shft; \
  21. if (__size + __shft > 32) \
  22. __res |= resp[__off - 1] << ((32 - __shft) % 32); \
  23. __res & __mask; \
  24. })
  25. u32 msm_board_serial(void)
  26. {
  27. struct mmc *mmc_dev;
  28. mmc_dev = find_mmc_device(0);
  29. if (!mmc_dev)
  30. return 0;
  31. return UNSTUFF_BITS(mmc_dev->cid, 16, 32);
  32. }
  33. void msm_generate_mac_addr(u8 *mac)
  34. {
  35. int i;
  36. char sn[9];
  37. snprintf(sn, 8, "%08x", msm_board_serial());
  38. /* fill in the mac with serialno, use locally adminstrated pool */
  39. mac[0] = 0x02;
  40. mac[1] = 00;
  41. for (i = 3; i >= 0; i--) {
  42. mac[i + 2] = simple_strtoul(&sn[2 * i], NULL, 16);
  43. sn[2 * i] = 0;
  44. }
  45. }