Misc.c 14 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338
  1. // This is part of Pico Library
  2. // (c) Copyright 2006 notaz, All rights reserved.
  3. // Free for non-commercial use.
  4. // For commercial use, separate licencing terms must be obtained.
  5. #include "PicoInt.h"
  6. // H-counter table for hvcounter reads in 40col mode
  7. // based on Gens code
  8. const unsigned char hcounts_40[] = {
  9. 0x07,0x07,0x08,0x08,0x08,0x09,0x09,0x0a,0x0a,0x0b,0x0b,0x0b,0x0c,0x0c,0x0d,0x0d,
  10. 0x0e,0x0e,0x0e,0x0f,0x0f,0x10,0x10,0x10,0x11,0x11,0x12,0x12,0x13,0x13,0x13,0x14,
  11. 0x14,0x15,0x15,0x15,0x16,0x16,0x17,0x17,0x18,0x18,0x18,0x19,0x19,0x1a,0x1a,0x1b,
  12. 0x1b,0x1b,0x1c,0x1c,0x1d,0x1d,0x1d,0x1e,0x1e,0x1f,0x1f,0x20,0x20,0x20,0x21,0x21,
  13. 0x22,0x22,0x23,0x23,0x23,0x24,0x24,0x25,0x25,0x25,0x26,0x26,0x27,0x27,0x28,0x28,
  14. 0x28,0x29,0x29,0x2a,0x2a,0x2a,0x2b,0x2b,0x2c,0x2c,0x2d,0x2d,0x2d,0x2e,0x2e,0x2f,
  15. 0x2f,0x30,0x30,0x30,0x31,0x31,0x32,0x32,0x32,0x33,0x33,0x34,0x34,0x35,0x35,0x35,
  16. 0x36,0x36,0x37,0x37,0x38,0x38,0x38,0x39,0x39,0x3a,0x3a,0x3a,0x3b,0x3b,0x3c,0x3c,
  17. 0x3d,0x3d,0x3d,0x3e,0x3e,0x3f,0x3f,0x3f,0x40,0x40,0x41,0x41,0x42,0x42,0x42,0x43,
  18. 0x43,0x44,0x44,0x45,0x45,0x45,0x46,0x46,0x47,0x47,0x47,0x48,0x48,0x49,0x49,0x4a,
  19. 0x4a,0x4a,0x4b,0x4b,0x4c,0x4c,0x4d,0x4d,0x4d,0x4e,0x4e,0x4f,0x4f,0x4f,0x50,0x50,
  20. 0x51,0x51,0x52,0x52,0x52,0x53,0x53,0x54,0x54,0x55,0x55,0x55,0x56,0x56,0x57,0x57,
  21. 0x57,0x58,0x58,0x59,0x59,0x5a,0x5a,0x5a,0x5b,0x5b,0x5c,0x5c,0x5c,0x5d,0x5d,0x5e,
  22. 0x5e,0x5f,0x5f,0x5f,0x60,0x60,0x61,0x61,0x62,0x62,0x62,0x63,0x63,0x64,0x64,0x64,
  23. 0x65,0x65,0x66,0x66,0x67,0x67,0x67,0x68,0x68,0x69,0x69,0x6a,0x6a,0x6a,0x6b,0x6b,
  24. 0x6c,0x6c,0x6c,0x6d,0x6d,0x6e,0x6e,0x6f,0x6f,0x6f,0x70,0x70,0x71,0x71,0x71,0x72,
  25. 0x72,0x73,0x73,0x74,0x74,0x74,0x75,0x75,0x76,0x76,0x77,0x77,0x77,0x78,0x78,0x79,
  26. 0x79,0x79,0x7a,0x7a,0x7b,0x7b,0x7c,0x7c,0x7c,0x7d,0x7d,0x7e,0x7e,0x7f,0x7f,0x7f,
  27. 0x80,0x80,0x81,0x81,0x81,0x82,0x82,0x83,0x83,0x84,0x84,0x84,0x85,0x85,0x86,0x86,
  28. 0x86,0x87,0x87,0x88,0x88,0x89,0x89,0x89,0x8a,0x8a,0x8b,0x8b,0x8c,0x8c,0x8c,0x8d,
  29. 0x8d,0x8e,0x8e,0x8e,0x8f,0x8f,0x90,0x90,0x91,0x91,0x91,0x92,0x92,0x93,0x93,0x94,
  30. 0x94,0x94,0x95,0x95,0x96,0x96,0x96,0x97,0x97,0x98,0x98,0x99,0x99,0x99,0x9a,0x9a,
  31. 0x9b,0x9b,0x9b,0x9c,0x9c,0x9d,0x9d,0x9e,0x9e,0x9e,0x9f,0x9f,0xa0,0xa0,0xa1,0xa1,
  32. 0xa1,0xa2,0xa2,0xa3,0xa3,0xa3,0xa4,0xa4,0xa5,0xa5,0xa6,0xa6,0xa6,0xa7,0xa7,0xa8,
  33. 0xa8,0xa9,0xa9,0xa9,0xaa,0xaa,0xab,0xab,0xab,0xac,0xac,0xad,0xad,0xae,0xae,0xae,
  34. 0xaf,0xaf,0xb0,0xb0,
  35. 0xe4,0xe4,0xe4,0xe5,0xe5,0xe6,0xe6,0xe6,0xe7,0xe7,0xe8,0xe8,0xe9,0xe9,0xe9,0xea,
  36. 0xea,0xeb,0xeb,0xeb,0xec,0xec,0xed,0xed,0xee,0xee,0xee,0xef,0xef,0xf0,0xf0,0xf1,
  37. 0xf1,0xf1,0xf2,0xf2,0xf3,0xf3,0xf3,0xf4,0xf4,0xf5,0xf5,0xf6,0xf6,0xf6,0xf7,0xf7,
  38. 0xf8,0xf8,0xf9,0xf9,0xf9,0xfa,0xfa,0xfb,0xfb,0xfb,0xfc,0xfc,0xfd,0xfd,0xfe,0xfe,
  39. 0xfe,0xff,0xff,0x00,0x00,0x00,0x01,0x01,0x02,0x02,0x03,0x03,0x03,0x04,0x04,0x05,
  40. 0x05,0x06,0x06,0x06,
  41. 0x07,0x07,0x08,0x08,0x08,0x09,0x09,0x0a,0x0a,0x0b,0x0b,0x0b,0x0c,0x0c,0x0d,0x0d,
  42. 0x0e,0x0e,0x0e,0x0f,0x0f,0x10,0x10,0x10,
  43. };
  44. // H-counter table for hvcounter reads in 32col mode
  45. const unsigned char hcounts_32[] = {
  46. 0x05,0x05,0x05,0x06,0x06,0x07,0x07,0x07,0x08,0x08,0x08,0x09,0x09,0x09,0x0a,0x0a,
  47. 0x0a,0x0b,0x0b,0x0b,0x0c,0x0c,0x0c,0x0d,0x0d,0x0d,0x0e,0x0e,0x0f,0x0f,0x0f,0x10,
  48. 0x10,0x10,0x11,0x11,0x11,0x12,0x12,0x12,0x13,0x13,0x13,0x14,0x14,0x14,0x15,0x15,
  49. 0x15,0x16,0x16,0x17,0x17,0x17,0x18,0x18,0x18,0x19,0x19,0x19,0x1a,0x1a,0x1a,0x1b,
  50. 0x1b,0x1b,0x1c,0x1c,0x1c,0x1d,0x1d,0x1d,0x1e,0x1e,0x1f,0x1f,0x1f,0x20,0x20,0x20,
  51. 0x21,0x21,0x21,0x22,0x22,0x22,0x23,0x23,0x23,0x24,0x24,0x24,0x25,0x25,0x26,0x26,
  52. 0x26,0x27,0x27,0x27,0x28,0x28,0x28,0x29,0x29,0x29,0x2a,0x2a,0x2a,0x2b,0x2b,0x2b,
  53. 0x2c,0x2c,0x2c,0x2d,0x2d,0x2e,0x2e,0x2e,0x2f,0x2f,0x2f,0x30,0x30,0x30,0x31,0x31,
  54. 0x31,0x32,0x32,0x32,0x33,0x33,0x33,0x34,0x34,0x34,0x35,0x35,0x36,0x36,0x36,0x37,
  55. 0x37,0x37,0x38,0x38,0x38,0x39,0x39,0x39,0x3a,0x3a,0x3a,0x3b,0x3b,0x3b,0x3c,0x3c,
  56. 0x3d,0x3d,0x3d,0x3e,0x3e,0x3e,0x3f,0x3f,0x3f,0x40,0x40,0x40,0x41,0x41,0x41,0x42,
  57. 0x42,0x42,0x43,0x43,0x43,0x44,0x44,0x45,0x45,0x45,0x46,0x46,0x46,0x47,0x47,0x47,
  58. 0x48,0x48,0x48,0x49,0x49,0x49,0x4a,0x4a,0x4a,0x4b,0x4b,0x4b,0x4c,0x4c,0x4d,0x4d,
  59. 0x4d,0x4e,0x4e,0x4e,0x4f,0x4f,0x4f,0x50,0x50,0x50,0x51,0x51,0x51,0x52,0x52,0x52,
  60. 0x53,0x53,0x53,0x54,0x54,0x55,0x55,0x55,0x56,0x56,0x56,0x57,0x57,0x57,0x58,0x58,
  61. 0x58,0x59,0x59,0x59,0x5a,0x5a,0x5a,0x5b,0x5b,0x5c,0x5c,0x5c,0x5d,0x5d,0x5d,0x5e,
  62. 0x5e,0x5e,0x5f,0x5f,0x5f,0x60,0x60,0x60,0x61,0x61,0x61,0x62,0x62,0x62,0x63,0x63,
  63. 0x64,0x64,0x64,0x65,0x65,0x65,0x66,0x66,0x66,0x67,0x67,0x67,0x68,0x68,0x68,0x69,
  64. 0x69,0x69,0x6a,0x6a,0x6a,0x6b,0x6b,0x6c,0x6c,0x6c,0x6d,0x6d,0x6d,0x6e,0x6e,0x6e,
  65. 0x6f,0x6f,0x6f,0x70,0x70,0x70,0x71,0x71,0x71,0x72,0x72,0x72,0x73,0x73,0x74,0x74,
  66. 0x74,0x75,0x75,0x75,0x76,0x76,0x76,0x77,0x77,0x77,0x78,0x78,0x78,0x79,0x79,0x79,
  67. 0x7a,0x7a,0x7b,0x7b,0x7b,0x7c,0x7c,0x7c,0x7d,0x7d,0x7d,0x7e,0x7e,0x7e,0x7f,0x7f,
  68. 0x7f,0x80,0x80,0x80,0x81,0x81,0x81,0x82,0x82,0x83,0x83,0x83,0x84,0x84,0x84,0x85,
  69. 0x85,0x85,0x86,0x86,0x86,0x87,0x87,0x87,0x88,0x88,0x88,0x89,0x89,0x89,0x8a,0x8a,
  70. 0x8b,0x8b,0x8b,0x8c,0x8c,0x8c,0x8d,0x8d,0x8d,0x8e,0x8e,0x8e,0x8f,0x8f,0x8f,0x90,
  71. 0x90,0x90,0x91,0x91,
  72. 0xe8,0xe8,0xe8,0xe9,0xe9,0xe9,0xea,0xea,0xea,0xeb,0xeb,0xeb,0xec,0xec,0xec,0xed,
  73. 0xed,0xed,0xee,0xee,0xee,0xef,0xef,0xf0,0xf0,0xf0,0xf1,0xf1,0xf1,0xf2,0xf2,0xf2,
  74. 0xf3,0xf3,0xf3,0xf4,0xf4,0xf4,0xf5,0xf5,0xf5,0xf6,0xf6,0xf6,0xf7,0xf7,0xf8,0xf8,
  75. 0xf8,0xf9,0xf9,0xf9,0xfa,0xfa,0xfa,0xfb,0xfb,0xfb,0xfc,0xfc,0xfc,0xfd,0xfd,0xfd,
  76. 0xfe,0xfe,0xfe,0xff,0xff,0x00,0x00,0x00,0x01,0x01,0x01,0x02,0x02,0x02,0x03,0x03,
  77. 0x03,0x04,0x04,0x04,
  78. 0x05,0x05,0x05,0x06,0x06,0x07,0x07,0x07,0x08,0x08,0x08,0x09,0x09,0x09,0x0a,0x0a,
  79. 0x0a,0x0b,0x0b,0x0b,0x0c,0x0c,0x0c,0x0d,
  80. };
  81. // vcounter values for PicoFrameSimple
  82. const unsigned short vcounts[] = {
  83. 0, 0, 1, 1, 2, 2, 3, 3, 4, 4, 5, 5, 6, 6, 7, 7,
  84. 8, 8, 9, 9, 10, 11, 11, 12, 12, 13, 13, 14, 14, 15, 15, 16,
  85. 16, 17, 17, 18, 18, 19, 19, 20, 21, 21, 22, 22, 23, 23, 24, 24,
  86. 25, 25, 26, 26, 27, 27, 28, 28, 29, 29, 30, 31, 31, 32, 32, 33,
  87. 33, 34, 34, 35, 35, 36, 36, 37, 37, 38, 38, 39, 39, 40, 40, 41,
  88. 42, 42, 43, 43, 44, 44, 45, 45, 46, 46, 47, 47, 48, 48, 49, 49,
  89. 50, 50, 51, 52, 52, 53, 53, 54, 54, 55, 55, 56, 56, 57, 57, 58,
  90. 58, 59, 59, 60, 60, 61, 62, 62, 63, 63, 64, 64, 65, 65, 66, 66,
  91. 67, 67, 68, 68, 69, 69, 70, 70, 71, 71, 72, 73, 73, 74, 74, 75,
  92. 75, 76, 76, 77, 77, 78, 78, 79, 79, 80, 80, 81, 81, 82, 83, 83,
  93. 84, 84, 85, 85, 86, 86, 87, 87, 88, 88, 89, 89, 90, 90, 91, 91,
  94. 92, 93, 93, 94, 94, 95, 95, 96, 96, 97, 97, 98, 98, 99, 99,100,
  95. 100,101,101,102,102,103,104,104,105,105,106,106,107,107,108,108,
  96. 109,109,110,110,111,111,112,112,113,114,114,115,115,116,116,117,
  97. 117,118,118,119,119,120,120,121,121,122,122,123,124,124,125,125,
  98. 126,126,127,127,128,128,129,129,130,130,131,131,132,132,133,133,
  99. 134,135,135,136,136,137,137,138,138,139,139,140,140,141,141,142,
  100. 142,143,143,144,145,145,146,146,147,147,148,148,149,149,150,150,
  101. 151,151,152,152,153,153,154,155,155,156,156,157,157,158,158,159,
  102. 159,160,160,161,161,162,162,163,163,164,164,165,166,166,167,167,
  103. 168,168,169,169,170,170,171,171,172,172,173,173,174,174,175,176,
  104. 176,177,177,178,178,179,179,180,180,181,181,182,182,183,183,184,
  105. 184,185,186,186,187,187,188,188,189,189,190,190,191,191,192,192,
  106. 193,193,194,194,195,195,196,197,197,198,198,199,199,200,200,201,
  107. 201,202,202,203,203,204,204,205,205,206,207,207,208,208,209,209,
  108. 210,210,211,211,212,212,213,213,214,214,215,215,216,217,217,218,
  109. 218,219,219,220,220,221,221,222,222,223,223,224,224,225,225,226,
  110. 226,227,228,228,229,229,230,230,231,231,232,232,233,233,234,234,
  111. 235,235,236,236,237,238,238,239,239,240,240,241,241,242,242,243,
  112. 243,244,244,245,245,246,246,247,248,248,249,249,250,250,251,251,
  113. 252,252,253,253,254,254,255,255,256,256,257,257,258,259,259,260,
  114. 260,261,261,262,262,263,263,264,264,265,265,266,266,267,267,268,
  115. 269,269,270,270,271,271,272,272,273,273,274,274,275,275,276,276,
  116. 277,277,278,279,279,280,280,281,281,282,282,283,283,284,284,285,
  117. 285,286,286,287,287,288,288,289,290,290,291,291,292,292,293,293,
  118. 294,294,295,295,296,296,297,297,298,298,299,300,300,301,301,302,
  119. 302,303,303,304,304,305,305,306,306,307,307,308,308,309,310,310,
  120. 311,311,311,311,
  121. };
  122. // rarely used EEPROM SRAM code
  123. // known games which use this:
  124. // Wonder Boy in Monster World, Megaman - The Wily Wars (X24C01, 128 bytes)
  125. // NFL Quarterback Club*, Frank Thomas Big Hurt Baseball (X24C04?)
  126. // College Slam, Blockbuster World Video Game Championship II, NBA Jam (X24C04?)
  127. // HardBall '95
  128. // the above sports games use addr 0x200000 for SCL line (handled in Memory.c)
  129. unsigned int lastSSRamWrite = 0xffff0000;
  130. // sram_reg: LAtd sela (L=pending SCL, A=pending SDA, t=type(1==uses 0x200000 for SCL and 2K bytes),
  131. // d=SRAM was detected (header or by access), s=started, e=save is EEPROM, l=old SCL, a=old SDA)
  132. PICO_INTERNAL void SRAMWriteEEPROM(unsigned int d) // ???? ??la (l=SCL, a=SDA)
  133. {
  134. unsigned int sreg = Pico.m.sram_reg, saddr = Pico.m.sram_addr, scyc = Pico.m.sram_cycle, ssa = Pico.m.sram_slave;
  135. //dprintf("[%02x]", d);
  136. sreg |= saddr&0xc000; // we store word count in add reg: dw?a aaaa ... (d=word count detected, w=words(0==use 2 words, else 1))
  137. saddr&=0x1fff;
  138. if(sreg & d & 2) {
  139. // SCL was and is still high..
  140. if((sreg & 1) && !(d&1)) {
  141. // ..and SDA went low, means it's a start command, so clear internal addr reg and clock counter
  142. //dprintf("-start-");
  143. if(!(sreg&0x8000) && scyc >= 9) {
  144. if(scyc != 28) sreg |= 0x4000; // 1 word
  145. //dprintf("detected word count: %i", scyc==28 ? 2 : 1);
  146. sreg |= 0x8000;
  147. }
  148. //saddr = 0;
  149. scyc = 0;
  150. sreg |= 8;
  151. } else if(!(sreg & 1) && (d&1)) {
  152. // SDA went high == stop command
  153. //dprintf("-stop-");
  154. sreg &= ~8;
  155. }
  156. }
  157. else if((sreg & 8) && !(sreg & 2) && (d&2)) {
  158. // we are started and SCL went high - next cycle
  159. scyc++; // pre-increment
  160. if(sreg & 0x20) {
  161. // X24C02+
  162. if((ssa&1) && scyc == 18) {
  163. scyc = 9;
  164. saddr++; // next address in read mode
  165. if(sreg&0x4000) saddr&=0xff; else saddr&=0x1fff; // mask
  166. }
  167. else if((sreg&0x4000) && scyc == 27) scyc = 18;
  168. else if(scyc == 36) scyc = 27;
  169. } else {
  170. // X24C01
  171. if(scyc == 18) {
  172. scyc = 9; // wrap
  173. if(saddr&1) { saddr+=2; saddr&=0xff; } // next addr in read mode
  174. }
  175. }
  176. //dprintf("scyc: %i", scyc);
  177. }
  178. else if((sreg & 8) && (sreg & 2) && !(d&2)) {
  179. // we are started and SCL went low (falling edge)
  180. if(sreg & 0x20) {
  181. // X24C02+
  182. if(scyc == 9 || scyc == 18 || scyc == 27); // ACK cycles
  183. else if( (!(sreg&0x4000) && scyc > 27) || ((sreg&0x4000) && scyc > 18) ) {
  184. if(!(ssa&1)) {
  185. // data write
  186. unsigned char *pm=SRam.data+saddr;
  187. *pm <<= 1; *pm |= d&1;
  188. if(scyc == 26 || scyc == 35) {
  189. saddr=(saddr&~0xf)|((saddr+1)&0xf); // only 4 (?) lowest bits are incremented
  190. //dprintf("w done: %02x; addr inc: %x", *pm, saddr);
  191. }
  192. SRam.changed = 1;
  193. }
  194. } else if(scyc > 9) {
  195. if(!(ssa&1)) {
  196. // we latch another addr bit
  197. saddr<<=1;
  198. if(sreg&0x4000) saddr&=0xff; else saddr&=0x1fff; // mask
  199. saddr|=d&1;
  200. //if(scyc==17||scyc==26) dprintf("addr reg done: %x", saddr);
  201. }
  202. } else {
  203. // slave address
  204. ssa<<=1; ssa|=d&1;
  205. //if(scyc==8) dprintf("slave done: %x", ssa);
  206. }
  207. } else {
  208. // X24C01
  209. if(scyc == 9); // ACK cycle, do nothing
  210. else if(scyc > 9) {
  211. if(!(saddr&1)) {
  212. // data write
  213. unsigned char *pm=SRam.data+(saddr>>1);
  214. *pm <<= 1; *pm |= d&1;
  215. if(scyc == 17) {
  216. saddr=(saddr&0xf9)|((saddr+2)&6); // only 2 lowest bits are incremented
  217. //dprintf("addr inc: %x", saddr>>1);
  218. }
  219. SRam.changed = 1;
  220. }
  221. } else {
  222. // we latch another addr bit
  223. saddr<<=1; saddr|=d&1; saddr&=0xff;
  224. //if(scyc==8) dprintf("addr done: %x", saddr>>1);
  225. }
  226. }
  227. }
  228. sreg &= ~3; sreg |= d&3; // remember SCL and SDA
  229. Pico.m.sram_reg = (unsigned char) sreg;
  230. Pico.m.sram_addr = (unsigned short)(saddr|(sreg&0xc000));
  231. Pico.m.sram_cycle= (unsigned char) scyc;
  232. Pico.m.sram_slave= (unsigned char) ssa;
  233. }
  234. PICO_INTERNAL_ASM unsigned int SRAMReadEEPROM(void)
  235. {
  236. unsigned int shift, d=0;
  237. unsigned int sreg, saddr, scyc, ssa;
  238. // flush last pending write
  239. SRAMWriteEEPROM(Pico.m.sram_reg>>6);
  240. sreg = Pico.m.sram_reg; saddr = Pico.m.sram_addr&0x1fff; scyc = Pico.m.sram_cycle; ssa = Pico.m.sram_slave;
  241. // if(!(sreg & 2) && (sreg&0x80)) scyc++; // take care of raising edge now to compensate lag
  242. if(SekCyclesDoneT()-lastSSRamWrite < 46) {
  243. // data was just written, there was no time to respond (used by sports games)
  244. d = (sreg>>6)&1;
  245. } else if((sreg & 8) && scyc > 9 && scyc != 18 && scyc != 27) {
  246. // started and first command word received
  247. shift = 17-scyc;
  248. if(sreg & 0x20) {
  249. // X24C02+
  250. if(ssa&1) {
  251. //dprintf("read: addr %02x, cycle %i, reg %02x", saddr, scyc, sreg);
  252. d = (SRam.data[saddr]>>shift)&1;
  253. }
  254. } else {
  255. // X24C01
  256. if(saddr&1) {
  257. d = (SRam.data[saddr>>1]>>shift)&1;
  258. }
  259. }
  260. }
  261. //else dprintf("r ack");
  262. return d;
  263. }
  264. PICO_INTERNAL void SRAMUpdPending(unsigned int a, unsigned int d)
  265. {
  266. unsigned int sreg = Pico.m.sram_reg;
  267. if(!(a&1)) sreg|=0x20;
  268. if(sreg&0x20) { // address through 0x200000
  269. if(!(a&1)) {
  270. sreg&=~0x80;
  271. sreg|=d<<7;
  272. } else {
  273. sreg&=~0x40;
  274. sreg|=(d<<6)&0x40;
  275. }
  276. } else {
  277. sreg&=~0xc0;
  278. sreg|=d<<6;
  279. }
  280. Pico.m.sram_reg = (unsigned char) sreg;
  281. }
  282. #ifndef _ASM_MISC_C
  283. PICO_INTERNAL_ASM void memcpy16(unsigned short *dest, unsigned short *src, int count)
  284. {
  285. while (count--)
  286. *dest++ = *src++;
  287. }
  288. PICO_INTERNAL_ASM void memcpy16bswap(unsigned short *dest, void *src, int count)
  289. {
  290. unsigned char *src_ = src;
  291. for (; count; count--, src_ += 2)
  292. *dest++ = (src_[0] << 8) | src_[1];
  293. }
  294. PICO_INTERNAL_ASM void memcpy32(int *dest, int *src, int count)
  295. {
  296. while (count--)
  297. *dest++ = *src++;
  298. }
  299. PICO_INTERNAL_ASM void memset32(int *dest, int c, int count)
  300. {
  301. while (count--)
  302. *dest++ = c;
  303. }
  304. #endif