romcopy.c 3.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125
  1. #include "fw.h"
  2. #include "console.h"
  3. #include "io.h"
  4. extern char __dram_init_start[];
  5. abssymval(_dram_init_len)
  6. extern char __dram_bss_start[];
  7. abssymval(_dram_bss_len)
  8. enum romcmd {
  9. ROM_WRITE_ENABLE = 0x06,
  10. ROM_VOLATILE_SR_WRITE_ENABLE = 0x50,
  11. ROM_WRITE_DISABLE = 0x04,
  12. ROM_RELEASE_POWERDOWN_ID = 0xab,
  13. ROM_MANUFACTURER_DEVICE_ID = 0x90,
  14. ROM_JEDEC_ID = 0x9f,
  15. ROM_READ_UNIQUE_ID = 0x4b,
  16. ROM_READ_DATA = 0x03, /* DO NOT USE */
  17. ROM_FAST_READ = 0x0b, /* Only for non-DMA */
  18. ROM_PAGE_PROGRAM = 0x02,
  19. ROM_ERASE_4K = 0x20,
  20. ROM_ERASE_32K = 0x52,
  21. ROM_ERASE_64K = 0xd8,
  22. ROM_ERASE_ALL = 0xc7,
  23. ROM_READ_SR1 = 0x05,
  24. ROM_WRITE_SR1 = 0x01,
  25. ROM_READ_SR2 = 0x35,
  26. ROM_WRITE_SR2 = 0x31,
  27. ROM_READ_SR3 = 0x15,
  28. ROM_WRITE_SR3 = 0x11,
  29. ROM_READ_SFPD = 0x5a,
  30. ROM_ERASE_SECURITY = 0x44,
  31. ROM_PROGRAM_SECURITY = 0x42,
  32. ROM_READ_SECURITY = 0x48,
  33. ROM_GLOBAL_BLOCK_LOCK = 0x7e,
  34. ROM_GLOBAL_BLOCK_UNLOCK = 0x98,
  35. ROM_READ_BLOCK_LOCK = 0x3d,
  36. ROM_ONE_BLOCK_LOCK = 0x36,
  37. ROM_ONE_BLOCK_UNLOCK = 0x39,
  38. ROM_ERASE_PROGRAM_SUSPEND = 0x75,
  39. ROM_ERASE_PROGRAM_RESUME = 0x7a,
  40. ROM_POWER_DOWN = 0xb9,
  41. ROM_ENABLE_RESET = 0x66,
  42. ROM_RESET = 0x99,
  43. ROM_FAST_READ_DUAL = 0x3b
  44. };
  45. void __hot romcopy_download(void *dst, size_t offset, size_t len)
  46. {
  47. ROMCOPY_RAMADDR = (size_t)dst;
  48. ROMCOPY_ROMCMD = __rom_offset + offset + (ROM_FAST_READ_DUAL << 24);
  49. ROMCOPY_DATALEN = len | ROMCOPY_SPI_CMDLEN(5) | ROMCOPY_SPI_DUAL;
  50. }
  51. void __hot romcopy_bzero(void *dst, size_t len)
  52. {
  53. ROMCOPY_RAMADDR = (size_t)dst;
  54. ROMCOPY_DATALEN = len | ROMCOPY_ZERO_BUFFER;
  55. }
  56. uint32_t __bss_hot romcopy_time[2];
  57. IRQHANDLER(romcopy)
  58. {
  59. static unsigned int romcopy_state;
  60. switch (romcopy_state++) {
  61. case 0:
  62. /* Copy DRAM data */
  63. romcopy_download(__dram_init_start, 0, _dram_init_len());
  64. break;
  65. case 1:
  66. /* Zero .dram.bss */
  67. romcopy_time[0] = rdtime() - time_zero;
  68. romcopy_bzero(__dram_bss_start, _dram_bss_len());
  69. break;
  70. default:
  71. romcopy_time[1] = rdtime() - romcopy_time[0];
  72. mask_irq(ROMCOPY_IRQ);
  73. return;
  74. }
  75. }
  76. /*
  77. * Read unique serial number programmed into ROM. Convert the serial
  78. * number to 12 characters in base36 (technically a wraparound that is
  79. * never going to matter.) It's more fun than plain hex... :)
  80. */
  81. char serial_str[16];
  82. uint64_t rom_get_serial(void)
  83. {
  84. union {
  85. uint32_t l[2];
  86. uint64_t q;
  87. } o;
  88. waitfor(ROMCOPY_IRQ);
  89. ROMCOPY_ROMCMD = ROM_READ_UNIQUE_ID << 24;
  90. ROMCOPY_DATALEN = ROMCOPY_SPI_CMDLEN(5) | ROMCOPY_SPI_MORE;
  91. waitfor(ROMCOPY_IRQ);
  92. ROMCOPY_DATALEN = ROMCOPY_SPI_CMDLEN(4) | ROMCOPY_SPI_MORE;
  93. waitfor(ROMCOPY_IRQ);
  94. o.l[1] = ROMCOPY_INPUT;
  95. ROMCOPY_DATALEN = ROMCOPY_SPI_CMDLEN(4);
  96. waitfor(ROMCOPY_IRQ);
  97. o.l[0] = ROMCOPY_INPUT;
  98. serial_str[12] = '\0';
  99. uint64_t v = o.q;
  100. for (int i = 11; i >= 0; i--) {
  101. unsigned int d = v % 36;
  102. v /= 36;
  103. serial_str[i] = d + '0' + ('A'-'0'-10)*(d >= 10);
  104. }
  105. if ( 1 )
  106. con_printf("ROM serial: %08x-%08x (%s)\n", o.l[1], o.l[0], serial_str);
  107. return o.q;
  108. }