memory.c 6.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298
  1. // insert cool lengthy disclaimer here
  2. // memory.c: SRAM operations
  3. #include <stdint.h>
  4. #include <avr/pgmspace.h>
  5. #include <util/delay.h>
  6. #include "config.h"
  7. #include "uart.h"
  8. #include "fpga.h"
  9. #include "crc16.h"
  10. #include "ff.h"
  11. #include "fileops.h"
  12. #include "spi.h"
  13. #include "fpga_spi.h"
  14. #include "avrcompat.h"
  15. #include "led.h"
  16. #include "smc.h"
  17. #include "fpga_spi.h"
  18. #include "memory.h"
  19. #include "snes.h"
  20. char* hex = "0123456789ABCDEF";
  21. void sram_hexdump(uint32_t addr, uint32_t len) {
  22. static uint8_t buf[16];
  23. uint32_t ptr;
  24. for(ptr=0; ptr < len; ptr += 16) {
  25. sram_readblock((void*)buf, ptr+addr, 16);
  26. uart_trace(buf, 0, 16);
  27. }
  28. }
  29. void sram_writebyte(uint8_t val, uint32_t addr) {
  30. set_avr_addr(addr);
  31. spi_fpga();
  32. spiTransferByte(0x91); // WRITE
  33. spiTransferByte(val);
  34. spiTransferByte(0x00); // dummy
  35. spi_none();
  36. }
  37. uint8_t sram_readbyte(uint32_t addr) {
  38. set_avr_addr(addr);
  39. spi_fpga();
  40. spiTransferByte(0x81); // READ
  41. spiTransferByte(0x00); // dummy
  42. uint8_t val = spiTransferByte(0x00);
  43. spi_none();
  44. return val;
  45. }
  46. void sram_writeshort(uint16_t val, uint32_t addr) {
  47. set_avr_addr(addr);
  48. spi_fpga();
  49. spiTransferByte(0x91); // WRITE
  50. spiTransferByte(val&0xff); // 7-0
  51. spiTransferByte((val>>8)&0xff); // 15-8
  52. spiTransferByte(0x00); // dummy
  53. spi_none();
  54. }
  55. void sram_writelong(uint32_t val, uint32_t addr) {
  56. set_avr_addr(addr);
  57. spi_fpga();
  58. spiTransferByte(0x91); // WRITE
  59. spiTransferByte(val&0xff); // 7-0
  60. spiTransferByte((val>>8)&0xff); // 15-8
  61. spiTransferByte((val>>16)&0xff); // 23-15
  62. spiTransferByte((val>>24)&0xff); // 31-24
  63. spiTransferByte(0x00); // dummy
  64. spi_none();
  65. }
  66. uint16_t sram_readshort(uint32_t addr) {
  67. set_avr_addr(addr);
  68. spi_fpga();
  69. spiTransferByte(0x81);
  70. spiTransferByte(0x00);
  71. uint32_t val = spiTransferByte(0x00);
  72. val |= ((uint32_t)spiTransferByte(0x00)<<8);
  73. spi_none();
  74. return val;
  75. }
  76. uint32_t sram_readlong(uint32_t addr) {
  77. set_avr_addr(addr);
  78. spi_fpga();
  79. spiTransferByte(0x81);
  80. spiTransferByte(0x00);
  81. uint32_t val = spiTransferByte(0x00);
  82. val |= ((uint32_t)spiTransferByte(0x00)<<8);
  83. val |= ((uint32_t)spiTransferByte(0x00)<<16);
  84. val |= ((uint32_t)spiTransferByte(0x00)<<24);
  85. spi_none();
  86. return val;
  87. }
  88. void sram_readblock(void* buf, uint32_t addr, uint16_t size) {
  89. uint16_t count=size;
  90. uint8_t* tgt = buf;
  91. set_avr_addr(addr);
  92. spi_fpga();
  93. spiTransferByte(0x81); // READ
  94. spiTransferByte(0x00); // dummy
  95. while(count--) {
  96. *(tgt++) = spiTransferByte(0x00);
  97. }
  98. spi_none();
  99. }
  100. void sram_writeblock(void* buf, uint32_t addr, uint16_t size) {
  101. uint16_t count=size;
  102. uint8_t* src = buf;
  103. set_avr_addr(addr);
  104. spi_fpga();
  105. spiTransferByte(0x91); // WRITE
  106. while(count--) {
  107. spiTransferByte(*src++);
  108. }
  109. spiTransferByte(0x00); // dummy
  110. spi_none();
  111. }
  112. uint32_t load_rom(uint8_t* filename) {
  113. uint8_t dummy;
  114. set_avr_bank(0);
  115. UINT bytes_read;
  116. DWORD filesize;
  117. UINT count=0;
  118. file_open(filename, FA_READ);
  119. filesize = file_handle.fsize;
  120. smc_id(&romprops);
  121. if(file_res) {
  122. uart_putc('?');
  123. uart_putc(0x30+file_res);
  124. return 0;
  125. }
  126. f_lseek(&file_handle, romprops.offset);
  127. for(;;) {
  128. spi_none();
  129. bytes_read = file_read();
  130. spi_none();
  131. if (file_res || !bytes_read) break;
  132. spi_fpga();
  133. spiTransferByte(0x91); // write w/ increment
  134. if(!(count++ % 8)) {
  135. // toggle_busy_led();
  136. bounce_busy_led();
  137. uart_putc('.');
  138. }
  139. for(int j=0; j<bytes_read; j++) {
  140. // spiTransferByte(file_buf[j]);
  141. SPDR = file_buf[j];
  142. loop_until_bit_is_set(SPSR, SPIF);
  143. dummy = SPDR;
  144. }
  145. spiTransferByte(0x00); // dummy tx for increment+write pulse
  146. }
  147. file_close();
  148. spi_none();
  149. set_avr_mapper(romprops.mapper_id);
  150. uart_puthex(romprops.header.map);
  151. uart_putc(0x30+romprops.mapper_id);
  152. uint32_t rammask;
  153. uint32_t rommask;
  154. if(filesize > (romprops.romsize_bytes + romprops.offset)) {
  155. romprops.romsize_bytes <<= 1;
  156. }
  157. if(romprops.header.ramsize == 0) {
  158. rammask = 0;
  159. } else {
  160. rammask = romprops.ramsize_bytes - 1;
  161. }
  162. rommask = romprops.romsize_bytes - 1;
  163. uart_putc(' ');
  164. uart_puthex(romprops.header.ramsize);
  165. uart_putc('-');
  166. uart_puthexlong(rammask);
  167. uart_putc(' ');
  168. uart_puthex(romprops.header.romsize);
  169. uart_putc('-');
  170. uart_puthexlong(rommask);
  171. set_saveram_mask(rammask);
  172. set_rom_mask(rommask);
  173. return (uint32_t)filesize;
  174. }
  175. uint32_t load_sram(uint8_t* filename, uint32_t base_addr) {
  176. set_avr_addr(base_addr);
  177. UINT bytes_read;
  178. DWORD filesize;
  179. file_open(filename, FA_READ);
  180. filesize = file_handle.fsize;
  181. if(file_res) return 0;
  182. for(;;) {
  183. FPGA_SS_HIGH();
  184. SPI_SS_LOW();
  185. bytes_read = file_read();
  186. SPI_SS_HIGH();
  187. if (file_res || !bytes_read) break;
  188. FPGA_SS_LOW();
  189. spiTransferByte(0x91);
  190. for(int j=0; j<bytes_read; j++) {
  191. spiTransferByte(file_buf[j]);
  192. }
  193. spiTransferByte(0x00); // dummy tx
  194. FPGA_SS_HIGH();
  195. }
  196. file_close();
  197. return (uint32_t)filesize;
  198. }
  199. void save_sram(uint8_t* filename, uint32_t sram_size, uint32_t base_addr) {
  200. uint32_t count = 0;
  201. uint32_t num = 0;
  202. spi_none();
  203. file_open(filename, FA_CREATE_ALWAYS | FA_WRITE);
  204. if(file_res) {
  205. uart_putc(0x30+file_res);
  206. }
  207. while(count<sram_size) {
  208. set_avr_addr(base_addr+count);
  209. spi_fpga();
  210. spiTransferByte(0x81); // read
  211. spiTransferByte(0); // dummy
  212. for(int j=0; j<sizeof(file_buf); j++) {
  213. file_buf[j] = spiTransferByte(0x00);
  214. count++;
  215. }
  216. spi_none();
  217. num = file_write();
  218. if(file_res) {
  219. uart_putc(0x30+file_res);
  220. }
  221. }
  222. file_close();
  223. }
  224. uint32_t calc_sram_crc(uint32_t base_addr, uint32_t size) {
  225. uint8_t data;
  226. uint32_t count;
  227. uint16_t crc;
  228. crc=0;
  229. crc_valid=1;
  230. set_avr_addr(base_addr);
  231. spi_fpga();
  232. spiTransferByte(0x81);
  233. spiTransferByte(0x00);
  234. for(count=0; count<size; count++) {
  235. data = spiTransferByte(0);
  236. if(get_snes_reset()) {
  237. crc_valid = 0;
  238. break;
  239. }
  240. crc += crc16_update(crc, &data, 1);
  241. }
  242. spi_none();
  243. return crc;
  244. }
  245. uint8_t sram_reliable() {
  246. uint16_t score=0;
  247. uint32_t val;
  248. // uint32_t val = sram_readlong(SRAM_SCRATCHPAD);
  249. uint8_t result = 0;
  250. /* while(score<SRAM_RELIABILITY_SCORE) {
  251. if(sram_readlong(SRAM_SCRATCHPAD)==val) {
  252. score++;
  253. } else {
  254. set_pwr_led(0);
  255. score=0;
  256. }
  257. }*/
  258. for(uint16_t i = 0; i < SRAM_RELIABILITY_SCORE; i++) {
  259. val=sram_readlong(SRAM_SCRATCHPAD);
  260. if(val==0x12345678) {
  261. score++;
  262. }
  263. }
  264. if(score<SRAM_RELIABILITY_SCORE) {
  265. result = 0;
  266. dprintf("score=%d\n", score);
  267. } else {
  268. result = 1;
  269. }
  270. set_pwr_led(result);
  271. return result;
  272. }