selftest.ino 8.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406
  1. #include <SPI.h>
  2. #include <GD.h>
  3. int atxy(int x, int y)
  4. {
  5. return (y << 6) + x;
  6. }
  7. void readn(byte *dst, unsigned int addr, int c)
  8. {
  9. GD.__start(addr);
  10. while (c--)
  11. *dst++ = SPI.transfer(0);
  12. GD.__end();
  13. }
  14. static byte coll[256];
  15. static void debug_coll()
  16. {
  17. while (GD.rd(VBLANK) == 0) // Wait until vblank
  18. ;
  19. while (GD.rd(VBLANK) == 1) // Wait until display
  20. ;
  21. while (GD.rd(VBLANK) == 0) // Wait until vblank
  22. ;
  23. readn(coll, COLLISION, 256);
  24. }
  25. #define FAIL do { Serial.print("Fail at line: "); Serial.println(__LINE__, DEC); return 0; } while (0)
  26. int test_collision()
  27. {
  28. int i, j;
  29. #define NOCOLL 0xff
  30. GD.wr16(RAM_SPRPAL, 0x8000); // color 0 transparent, 1-255 0x5555 (pinkish)
  31. GD.fill(RAM_SPRPAL + 2, 0x55, 510);
  32. GD.fill(RAM_SPRIMG, 1, 256);
  33. for (i = 0; i < 256; i++)
  34. GD.sprite(i, 400, 400, 0, 0, 0);
  35. debug_coll();
  36. for (i = 0; i < 256; i++)
  37. if (coll[i] != NOCOLL)
  38. FAIL;
  39. GD.sprite(7, 200, 100, 0, 0, 0);
  40. GD.sprite(117, 200, 200, 0, 0, 0);
  41. byte jkmode, jk;
  42. for (jkmode = 0; jkmode < 2; jkmode++) {
  43. for (jk = 0; jk < 2; jk++) {
  44. GD.wr(JK_MODE, jkmode);
  45. for (i = -20; i < 20; i++) {
  46. GD.sprite(8, 200, 100 + i, 0, 0, 0, jk);
  47. GD.sprite(200, 200 + i, 200, 0, 0, 0, jk);
  48. debug_coll();
  49. byte expected = ((!jkmode || jk) && (abs(i) < 16)) ? 7 : NOCOLL;
  50. if (coll[8] != expected)
  51. FAIL;
  52. expected = ((!jkmode || jk) && (abs(i) < 16)) ? 117 : NOCOLL;
  53. if (coll[200] != expected)
  54. FAIL;
  55. }
  56. }
  57. }
  58. randomSeed(1);
  59. for (j = 100; j; j--) {
  60. for (i = 0; i < 256; i++) {
  61. GD.sprite(i, random(512), random(512), 0, 0, 0);
  62. }
  63. debug_coll();
  64. for (i = 0; i < 256; i++) {
  65. if (coll[i] != 0xff && (coll[i] >= i))
  66. FAIL;
  67. }
  68. }
  69. for (i = 0; i < 256; i++)
  70. GD.sprite(i, 400, 400, 0, 0, 0);
  71. return 1;
  72. }
  73. int test_ident()
  74. {
  75. byte id = GD.rd(IDENT);
  76. if (id != 0x6d) {
  77. Serial.println(id, HEX);
  78. FAIL;
  79. }
  80. return 1;
  81. }
  82. // low-level SPI test. Write a random pattern to the 16K image RAM,
  83. // then read it back, verifying the same random values. Meant to
  84. // catch SPI transmission errors.
  85. int test_spi()
  86. {
  87. int i;
  88. randomSeed(947);
  89. GD.__wstart(RAM_SPRIMG);
  90. for (i = 0; i < 16384; i++)
  91. SPI.transfer(random(256));
  92. GD.__end();
  93. randomSeed(947);
  94. GD.__start(RAM_SPRIMG);
  95. for (i = 0; i < 16384; i++)
  96. if (SPI.transfer(0) != random(256))
  97. FAIL;
  98. GD.__end();
  99. return 1;
  100. }
  101. // Test a RAM area (addr, c)
  102. int test_a_ram(unsigned int addr, int c)
  103. {
  104. while (c--) {
  105. byte prev = GD.rd(addr);
  106. GD.wr(addr, 0xff); if (GD.rd(addr) != 0xff) FAIL;
  107. GD.wr(addr, 0x00); if (GD.rd(addr) != 0x00) FAIL;
  108. GD.wr(addr, 0x47); if (GD.rd(addr) != 0x47) FAIL;
  109. GD.wr(addr, prev); if (GD.rd(addr) != prev) FAIL;
  110. addr++;
  111. }
  112. return 1;
  113. }
  114. // Write/read a simple pattern to each RAM byte.
  115. // (Restores RAM values so display is preserved.)
  116. int test_rams()
  117. {
  118. test_a_ram(0, (4 + 4 + 2) * 1024); /* Pic, chr and pal */
  119. test_a_ram(RAM_SPR, 0x5000); /* Sprites */
  120. test_a_ram(PALETTE16A, 64);
  121. test_a_ram(PALETTE4A, 16);
  122. test_a_ram(VOICES, 64 * 4);
  123. GD.wr(J1_RESET, 1);
  124. test_a_ram(J1_CODE, 256);
  125. return 1;
  126. }
  127. int test_audio_l()
  128. {
  129. GD.fill(VOICES, 0, 64 * 4);
  130. GD.voice(0, 0, 4 * 440, 255, 0);
  131. delay(1000);
  132. return 1;
  133. }
  134. int test_audio_r()
  135. {
  136. GD.fill(VOICES, 0, 64 * 4);
  137. GD.voice(0, 0, 4 * 440, 0, 255);
  138. delay(1000);
  139. GD.fill(VOICES, 0, 64 * 4);
  140. return 1;
  141. }
  142. int test_speed()
  143. {
  144. long t0 = millis();
  145. int i, j;
  146. for (i = 0; i < 1000; i++) {
  147. GD.fill(RAM_SPRIMG, 0x55, 1000);
  148. }
  149. Serial.print("(Took ");
  150. Serial.print(millis() - t0);
  151. Serial.print(")");
  152. return 1;
  153. }
  154. #include "lena.h"
  155. static void show_lena()
  156. {
  157. GD.copy(RAM_SPRPAL, lenapal, sizeof(lenapal));
  158. int i;
  159. for (i = 0; i < 64; i++)
  160. GD.sprite(i, 256 + ((i & 7) << 4), 64 + 2 * (i & 070), i, 0, 0);
  161. for (i = 64; i < 512; i++)
  162. GD.sprite(i, 400, 400, 0, 0, 0);
  163. GD.uncompress(RAM_SPRIMG, lenaimg);
  164. }
  165. void show_stripes()
  166. {
  167. int i;
  168. for (i = 0; i < 32; i++) {
  169. GD.wr16(RAM_PAL + (0x80 + i) * 8, RGB(8 * i, 0, 0));
  170. GD.wr16(RAM_PAL + (0xa0 + i) * 8, RGB(0, 8 * i, 0));
  171. GD.wr16(RAM_PAL + (0xc0 + i) * 8, RGB(0, 0, 8 * i));
  172. GD.wr(atxy(i, 24), 0x80 + i);
  173. GD.wr(atxy(i, 25), 0xa0 + i);
  174. GD.wr(atxy(i, 26), 0xc0 + i);
  175. }
  176. GD.putstr(0, 28, "R");
  177. GD.putstr(0, 29, "G");
  178. GD.putstr(0, 30, "B");
  179. GD.putstr(4, 31, "0");
  180. GD.putstr(8, 31, "1");
  181. GD.putstr(16, 31, "2");
  182. GD.wr(atxy(4, 28), 0x80 + 4);
  183. GD.wr(atxy(8, 28), 0x80 + 8);
  184. GD.wr(atxy(16, 28), 0x80 + 16);
  185. GD.wr(atxy(4, 29), 0xa0 + 4);
  186. GD.wr(atxy(8, 29), 0xa0 + 8);
  187. GD.wr(atxy(16, 29), 0xa0 + 16);
  188. GD.wr(atxy(4, 30), 0xc0 + 4);
  189. GD.wr(atxy(8, 30), 0xc0 + 8);
  190. GD.wr(atxy(16, 30), 0xc0 + 16);
  191. }
  192. byte y;
  193. static void logn(const char*s)
  194. {
  195. Serial.print(s);
  196. GD.putstr(0, y, s);
  197. }
  198. static void log(const char*s)
  199. {
  200. Serial.println(s);
  201. GD.putstr(16, y++, s);
  202. }
  203. #define RUNTEST(NAME) \
  204. do { \
  205. logn(#NAME ": "); \
  206. r = NAME(); \
  207. log(r ? "pass" : "FAIL"); \
  208. pass &= r; \
  209. } while (0)
  210. #include "selftest1.h"
  211. static unsigned long rd32()
  212. {
  213. return GD.rd16(COMM+0) + ((unsigned long)GD.rd16(COMM+2) << 16);
  214. }
  215. int test_coproc()
  216. {
  217. GD.microcode(selftest1_code, sizeof(selftest1_code));
  218. GD.wr(COMM+15, 0); // stop
  219. GD.wr16(COMM+0, 0);
  220. GD.wr16(COMM+2, 0);
  221. unsigned long started;
  222. unsigned long cycles0, cycles1;
  223. byte regime;
  224. int jj;
  225. for (regime = 0; regime < 6; regime++) {
  226. cycles0 = rd32();
  227. started = micros();
  228. GD.wr(COMM+15, 1); // go
  229. switch (regime) {
  230. case 0:
  231. delay(1000);
  232. break;
  233. case 1:
  234. GD.__start(0);
  235. delay(1000);
  236. GD.__end();
  237. break;
  238. case 2:
  239. GD.__start(0);
  240. SPI.transfer(0);
  241. delay(1000);
  242. GD.__end();
  243. break;
  244. case 3:
  245. GD.__start(0);
  246. for (jj = 0; jj < 1000; jj++) {
  247. SPI.transfer(0);
  248. delay(1);
  249. }
  250. GD.__end();
  251. break;
  252. case 4:
  253. for (jj = 0; jj < 1000; jj++) {
  254. GD.rd(0);
  255. delay(1);
  256. }
  257. break;
  258. case 5:
  259. while ((micros() - started) < 1000000) {
  260. GD.__start(0);
  261. for (jj = 0; jj < 1000; jj++)
  262. SPI.transfer(0);
  263. GD.__end();
  264. }
  265. break;
  266. }
  267. GD.wr(COMM+15, 0); // stop
  268. delay(1);
  269. cycles1 = rd32();
  270. long cps = long(1e6 * (cycles1 - cycles0) / (micros() - started));
  271. if (cps < 1000000)
  272. FAIL;
  273. // Serial.println(micros() - started, DEC);
  274. // Serial.print(regime, DEC);
  275. // Serial.print(' ');
  276. // Serial.println(cps, DEC);
  277. }
  278. return 1;
  279. }
  280. // See Atmel AT45DB021D datasheet:
  281. // http://www.atmel.com/dyn/resources/prod_documents/doc3638.pdf
  282. static int test_flash()
  283. {
  284. GD.wr(IOMODE, 'F');
  285. pinMode(2, OUTPUT);
  286. digitalWrite(2, HIGH);
  287. delay(1);
  288. digitalWrite(2, LOW);
  289. SPI.transfer(0xd7); // read SPI flash status
  290. byte status = SPI.transfer(0);
  291. digitalWrite(2, HIGH);
  292. if (status != 0x94) // 0x94 means "idle; all is well"
  293. FAIL;
  294. GD.wr(IOMODE, 0);
  295. return 1;
  296. }
  297. static void runtests()
  298. {
  299. char msg[50];
  300. GD.begin();
  301. GD.ascii();
  302. GD.fill(0, ' ', 4096);
  303. GD.putstr(0, 0,"<------------------- TOP LINE ------------------->");
  304. GD.putstr(0,36,"<----------------- BOTTOM LINE ------------------>");
  305. show_stripes();
  306. y = 3;
  307. byte r, pass = 1;
  308. log("Starting self-test");
  309. RUNTEST(test_ident);
  310. RUNTEST(test_flash);
  311. RUNTEST(test_audio_l);
  312. RUNTEST(test_audio_r);
  313. RUNTEST(test_coproc);
  314. RUNTEST(test_speed);
  315. RUNTEST(test_spi);
  316. RUNTEST(test_rams);
  317. RUNTEST(test_collision);
  318. if (pass) {
  319. log("All tests passed");
  320. show_lena();
  321. long seconds = millis() / 1000;
  322. long minutes = seconds / 60;
  323. sprintf(msg, "%d minutes", minutes);
  324. log(msg);
  325. // GD.screenshot(0);
  326. } else {
  327. for (;;) {
  328. GD.wr16(BG_COLOR, RGB(255,0,0));
  329. delay(100);
  330. GD.wr16(BG_COLOR, RGB(0,0,0));
  331. delay(100);
  332. }
  333. }
  334. byte i;
  335. for (i = 9; i; i--) {
  336. sprintf(msg, "Restarting in %d", i);
  337. GD.putstr(0, y, msg);
  338. delay(1000);
  339. }
  340. }
  341. void setup()
  342. {
  343. Serial.begin(1000000);
  344. runtests();
  345. }
  346. void loop()
  347. {
  348. runtests();
  349. }