GD2.h 31 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148
  1. /*
  2. * Copyright (C) 2013-2016 by James Bowman <jamesb@excamera.com>
  3. * Gameduino 2 library for Arduino, Arduino Due, Raspberry Pi.
  4. *
  5. */
  6. #ifndef _GD2_H_INCLUDED
  7. #define _GD2_H_INCLUDED
  8. #if defined(RASPBERRY_PI) || defined(DUMPDEV)
  9. #include "wiring.h"
  10. #endif
  11. #include "Arduino.h"
  12. #include <stdarg.h>
  13. #define RGB(r, g, b) ((uint32_t)((((r) & 0xffL) << 16) | (((g) & 0xffL) << 8) | ((b) & 0xffL)))
  14. #define F8(x) (int((x) * 256L))
  15. #define F16(x) ((int32_t)((x) * 65536L))
  16. #define GD_CALIBRATE 1
  17. #define GD_TRIM 2
  18. #define GD_STORAGE 4
  19. #ifdef __SAM3X8E__
  20. #define __DUE__ 1
  21. #endif
  22. ////////////////////////////////////////////////////////////////////////
  23. // Decide if we want to compile in SDcard support
  24. //
  25. // For stock Arduino models: yes
  26. // Raspberry PI: no
  27. // Arduino Due: no
  28. //
  29. #if !defined(RASPBERRY_PI) && !defined(DUMPDEV)
  30. #define SDCARD 1
  31. #else
  32. #define SDCARD 0
  33. #endif
  34. #if defined(__DUE__)
  35. #define MOSI 11
  36. #define MISO 12
  37. #define SCK 13 // B.27
  38. class ASPI_t {
  39. public:
  40. void begin(void) {
  41. pinMode(MOSI, OUTPUT);
  42. pinMode(MISO, INPUT);
  43. pinMode(SCK, OUTPUT);
  44. digitalWrite(SCK, 0);
  45. // PIOB->PIO_PER = PIO_PB27;
  46. // PIOB->PIO_CODR = PIO_PB27;
  47. // PIOB->PIO_PUDR = PIO_PB27;
  48. }
  49. byte transfer(byte x ) {
  50. byte r = 0;
  51. for (byte i = 8; i; i--) {
  52. if (x & 0x80)
  53. PIOD->PIO_SODR = PIO_PD7;
  54. else
  55. PIOD->PIO_CODR = PIO_PD7;
  56. // digitalWrite(MOSI, (x >> 7) & 1);
  57. x <<= 1;
  58. // digitalWrite(SCK, 1);
  59. PIOB->PIO_SODR = PIO_PB27;
  60. r <<= 1;
  61. r |= digitalRead(MISO);
  62. // digitalWrite(SCK, 0);
  63. PIOB->PIO_CODR = PIO_PB27;
  64. }
  65. return r;
  66. }
  67. };
  68. static class ASPI_t ASPI;
  69. #define SPI ASPI
  70. #endif
  71. #if SDCARD
  72. #if defined(VERBOSE) && (VERBOSE > 0)
  73. #define INFO(X) Serial.println((X))
  74. #if defined(RASPBERRY_PI)
  75. #define REPORT(VAR) fprintf(stderr, #VAR "=%d\n", (VAR))
  76. #else
  77. #define REPORT(VAR) (Serial.print(#VAR "="), Serial.print(VAR, DEC), Serial.print(' '), Serial.println(VAR, HEX))
  78. #endif
  79. #else
  80. #define INFO(X)
  81. #define REPORT(X)
  82. #endif
  83. struct dirent {
  84. char name[8];
  85. char ext[3];
  86. byte attribute;
  87. byte reserved[8];
  88. uint16_t cluster_hi; // FAT32 only
  89. uint16_t time;
  90. uint16_t date;
  91. uint16_t cluster;
  92. uint32_t size;
  93. };
  94. // https://www.sdcard.org/downloads/pls/simplified_specs/Part_1_Physical_Layer_Simplified_Specification_Ver_3.01_Final_100518.pdf
  95. // page 22
  96. // http://mac6.ma.psu.edu/space2008/RockSat/microController/sdcard_appnote_foust.pdf
  97. // http://elm-chan.org/docs/mmc/mmc_e.html
  98. // http://www.pjrc.com/tech/8051/ide/fat32.html
  99. #define FAT16 0
  100. #define FAT32 1
  101. #define DD
  102. class sdcard {
  103. public:
  104. void sel() {
  105. digitalWrite(pin, LOW);
  106. delay(1);
  107. }
  108. void desel() {
  109. digitalWrite(pin, HIGH);
  110. SPI.transfer(0xff); // force DO release
  111. }
  112. void sd_delay(byte n) {
  113. while (n--) {
  114. DD SPI.transfer(0xff);
  115. }
  116. }
  117. void cmd(byte cmd, uint32_t lba = 0, uint8_t crc = 0x95) {
  118. #if VERBOSE > 1
  119. Serial.print("cmd ");
  120. Serial.print(cmd, DEC);
  121. Serial.print(" ");
  122. Serial.print(lba, HEX);
  123. Serial.println();
  124. #endif
  125. sel();
  126. // DD SPI.transfer(0xff);
  127. DD SPI.transfer(0x40 | cmd);
  128. DD SPI.transfer(0xff & (lba >> 24));
  129. DD SPI.transfer(0xff & (lba >> 16));
  130. DD SPI.transfer(0xff & (lba >> 8));
  131. DD SPI.transfer(0xff & (lba));
  132. DD SPI.transfer(crc);
  133. // DD SPI.transfer(0xff);
  134. }
  135. byte response() {
  136. byte r;
  137. DD
  138. r = SPI.transfer(0xff);
  139. while (r & 0x80) {
  140. DD
  141. r = SPI.transfer(0xff);
  142. }
  143. return r;
  144. }
  145. byte R1() { // read response R1
  146. byte r = response();
  147. desel();
  148. SPI.transfer(0xff); // trailing byte
  149. return r;
  150. }
  151. byte sdR3(uint32_t &ocr) { // read response R3
  152. byte r = response();
  153. for (byte i = 4; i; i--)
  154. ocr = (ocr << 8) | SPI.transfer(0xff);
  155. SPI.transfer(0xff); // trailing byte
  156. desel();
  157. return r;
  158. }
  159. byte sdR7() { // read response R3
  160. byte r = response();
  161. for (byte i = 4; i; i--)
  162. // Serial.println(SPI.transfer(0xff), HEX);
  163. SPI.transfer(0xff);
  164. desel();
  165. return r;
  166. }
  167. void appcmd(byte cc, uint32_t lba = 0) {
  168. cmd(55); R1();
  169. cmd(cc, lba);
  170. }
  171. void begin(byte p) {
  172. byte type_code;
  173. byte sdhc;
  174. pin = p;
  175. pinMode(pin, OUTPUT);
  176. #if !defined(__DUE__) && !defined(TEENSYDUINO)
  177. SPI.setClockDivider(SPI_CLOCK_DIV64);
  178. #endif
  179. desel();
  180. // for (;;) SPI.transfer(0xff);
  181. delay(10); // wait for boot
  182. sd_delay(10); // deselected, 80 pulses
  183. INFO("Attempting card reset... ");
  184. byte r1;
  185. static int attempts;
  186. attempts = 0;
  187. do { // reset, enter idle
  188. cmd(0);
  189. while ((r1 = SPI.transfer(0xff)) & 0x80)
  190. if (++attempts == 1000)
  191. goto finished;
  192. desel();
  193. SPI.transfer(0xff); // trailing byte
  194. REPORT(r1);
  195. } while (r1 != 1);
  196. INFO("reset ok\n");
  197. sdhc = 0;
  198. cmd(8, 0x1aa, 0x87);
  199. r1 = sdR7();
  200. sdhc = (r1 == 1);
  201. REPORT(sdhc);
  202. INFO("Sending card init command");
  203. while (1) {
  204. appcmd(41, sdhc ? (1UL << 30) : 0); // card init
  205. r1 = R1();
  206. #if VERBOSE
  207. Serial.println(r1, HEX);
  208. #endif
  209. if ((r1 & 1) == 0)
  210. break;
  211. delay(1);
  212. }
  213. INFO("OK");
  214. if (sdhc) {
  215. cmd(58);
  216. uint32_t OCR = 0;
  217. sdR3(OCR);
  218. REPORT(OCR);
  219. ccs = 1UL & (OCR >> 30);
  220. } else {
  221. ccs = 0;
  222. }
  223. REPORT(ccs);
  224. // Test point: dump sector 0 to serial.
  225. // should see first 512 bytes of card, ending 55 AA.
  226. #if 0
  227. if (0) {
  228. cmd17(0);
  229. for (int i = 0; i < 512; i++) {
  230. delay(10);
  231. byte b = SPI.transfer(0xff);
  232. Serial.print(b, HEX);
  233. Serial.print(' ');
  234. if ((i & 15) == 15)
  235. Serial.println();
  236. }
  237. desel();
  238. for (;;);
  239. }
  240. #endif
  241. #if !defined(__DUE__)
  242. SPI.setClockDivider(SPI_CLOCK_DIV2);
  243. SPSR = (1 << SPI2X);
  244. #endif
  245. type_code = rd(0x1be + 0x4);
  246. switch (type_code) {
  247. default:
  248. type = FAT16;
  249. break;
  250. case 0x0b:
  251. case 0x0c:
  252. type = FAT32;
  253. break;
  254. }
  255. REPORT(type_code);
  256. o_partition = 512L * rd4(0x1be + 0x8);
  257. sectors_per_cluster = rd(o_partition + 0xd);
  258. reserved_sectors = rd2(o_partition + 0xe);
  259. cluster_size = 512L * sectors_per_cluster;
  260. REPORT(sectors_per_cluster);
  261. // Serial.println("Bytes per sector: %d\n", rd2(o_partition + 0xb));
  262. // Serial.println("Sectors per cluster: %d\n", sectors_per_cluster);
  263. if (type == FAT16) {
  264. max_root_dir_entries = rd2(o_partition + 0x11);
  265. sectors_per_fat = rd2(o_partition + 0x16);
  266. o_fat = o_partition + 512L * reserved_sectors;
  267. o_root = o_fat + (2 * 512L * sectors_per_fat);
  268. // data area starts with cluster 2, so offset it here
  269. o_data = o_root + (max_root_dir_entries * 32L) - (2L * cluster_size);
  270. } else {
  271. uint32_t sectors_per_fat = rd4(o_partition + 0x24);
  272. root_dir_first_cluster = rd4(o_partition + 0x2c);
  273. uint32_t fat_begin_lba = (o_partition >> 9) + reserved_sectors;
  274. uint32_t cluster_begin_lba = (o_partition >> 9) + reserved_sectors + (2 * sectors_per_fat);
  275. o_fat = 512L * fat_begin_lba;
  276. o_root = (512L * (cluster_begin_lba + (root_dir_first_cluster - 2) * sectors_per_cluster));
  277. o_data = (512L * (cluster_begin_lba - 2 * sectors_per_cluster));
  278. }
  279. finished:
  280. INFO("finished");
  281. ;
  282. }
  283. void cmd17(uint32_t off) {
  284. if (ccs)
  285. cmd(17, off >> 9);
  286. else
  287. cmd(17, off & ~511L);
  288. R1();
  289. sel();
  290. while (SPI.transfer(0xff) != 0xfe)
  291. ;
  292. }
  293. void rdn(byte *d, uint32_t off, uint16_t n) {
  294. cmd17(off);
  295. uint16_t i;
  296. uint16_t bo = (off & 511);
  297. for (i = 0; i < bo; i++)
  298. SPI.transfer(0xff);
  299. for (i = 0; i < n; i++)
  300. *d++ = SPI.transfer(0xff);
  301. for (i = 0; i < (514 - bo - n); i++)
  302. SPI.transfer(0xff);
  303. desel();
  304. }
  305. uint32_t rd4(uint32_t off) {
  306. uint32_t r;
  307. rdn((byte*)&r, off, sizeof(r));
  308. return r;
  309. }
  310. uint16_t rd2(uint32_t off) {
  311. uint16_t r;
  312. rdn((byte*)&r, off, sizeof(r));
  313. return r;
  314. }
  315. byte rd(uint32_t off) {
  316. byte r;
  317. rdn((byte*)&r, off, sizeof(r));
  318. return r;
  319. }
  320. byte pin;
  321. byte ccs;
  322. byte type;
  323. uint16_t sectors_per_cluster;
  324. uint16_t reserved_sectors;
  325. uint16_t max_root_dir_entries;
  326. uint16_t sectors_per_fat;
  327. uint16_t cluster_size;
  328. uint32_t root_dir_first_cluster;
  329. // These are all linear addresses, hence the o_ prefix
  330. uint32_t o_partition;
  331. uint32_t o_fat;
  332. uint32_t o_root;
  333. uint32_t o_data;
  334. };
  335. static void dos83(byte dst[11], const char *ps)
  336. {
  337. byte i = 0;
  338. while (*ps) {
  339. if (*ps != '.')
  340. dst[i++] = toupper(*ps);
  341. else {
  342. while (i < 8)
  343. dst[i++] = ' ';
  344. }
  345. ps++;
  346. }
  347. while (i < 11)
  348. dst[i++] = ' ';
  349. }
  350. #else
  351. class sdcard {
  352. public:
  353. void begin(int p) {};
  354. };
  355. #endif
  356. ////////////////////////////////////////////////////////////////////////
  357. class xy {
  358. public:
  359. int x, y;
  360. void set(int _x, int _y);
  361. void rmove(int distance, int angle);
  362. int angleto(class xy &other);
  363. void draw(byte offset = 0);
  364. int onscreen(void);
  365. class xy operator+=(class xy &other);
  366. class xy operator-=(class xy &other);
  367. long operator*(class xy &other);
  368. class xy operator*=(int);
  369. int nearer_than(int distance, xy &other);
  370. };
  371. ////////////////////////////////////////////////////////////////////////
  372. class GDClass {
  373. public:
  374. int w, h;
  375. void begin(uint8_t options = (GD_CALIBRATE | GD_TRIM | GD_STORAGE));
  376. uint16_t random();
  377. uint16_t random(uint16_t n);
  378. void seed(uint16_t n);
  379. int16_t rsin(int16_t r, uint16_t th);
  380. int16_t rcos(int16_t r, uint16_t th);
  381. void polar(int &x, int &y, int16_t r, uint16_t th);
  382. uint16_t atan2(int16_t y, int16_t x);
  383. void copy(const PROGMEM uint8_t *src, int count);
  384. void copyram(byte *src, int count);
  385. void self_calibrate(void);
  386. void swap(void);
  387. void flush(void);
  388. void finish(void);
  389. void play(uint8_t instrument, uint8_t note = 0);
  390. void sample(uint32_t start, uint32_t len, uint16_t freq, uint16_t format, int loop = 0);
  391. void get_inputs(void);
  392. void get_accel(int &x, int &y, int &z);
  393. struct {
  394. uint16_t track_tag;
  395. uint16_t track_val;
  396. uint16_t rz;
  397. uint16_t __dummy_1;
  398. int16_t y;
  399. int16_t x;
  400. int16_t tag_y;
  401. int16_t tag_x;
  402. uint8_t tag;
  403. uint8_t ptag;
  404. uint8_t touching;
  405. xy xytouch;
  406. } inputs;
  407. void AlphaFunc(byte func, byte ref);
  408. void Begin(byte prim);
  409. void BitmapHandle(byte handle);
  410. void BitmapLayout(byte format, uint16_t linestride, uint16_t height);
  411. void BitmapSize(byte filter, byte wrapx, byte wrapy, uint16_t width, uint16_t height);
  412. void BitmapSource(uint32_t addr);
  413. void BitmapTransformA(int32_t a);
  414. void BitmapTransformB(int32_t b);
  415. void BitmapTransformC(int32_t c);
  416. void BitmapTransformD(int32_t d);
  417. void BitmapTransformE(int32_t e);
  418. void BitmapTransformF(int32_t f);
  419. void BlendFunc(byte src, byte dst);
  420. void Call(uint16_t dest);
  421. void Cell(byte cell);
  422. void ClearColorA(byte alpha);
  423. void ClearColorRGB(byte red, byte green, byte blue);
  424. void ClearColorRGB(uint32_t rgb);
  425. void Clear(byte c, byte s, byte t);
  426. void Clear(void);
  427. void ClearStencil(byte s);
  428. void ClearTag(byte s);
  429. void ColorA(byte alpha);
  430. void ColorMask(byte r, byte g, byte b, byte a);
  431. void ColorRGB(byte red, byte green, byte blue);
  432. void ColorRGB(uint32_t rgb);
  433. void Display(void);
  434. void End(void);
  435. void Jump(uint16_t dest);
  436. void LineWidth(uint16_t width);
  437. void Macro(byte m);
  438. void PointSize(uint16_t size);
  439. void RestoreContext(void);
  440. void Return(void);
  441. void SaveContext(void);
  442. void ScissorSize(uint16_t width, uint16_t height);
  443. void ScissorXY(uint16_t x, uint16_t y);
  444. void StencilFunc(byte func, byte ref, byte mask);
  445. void StencilMask(byte mask);
  446. void StencilOp(byte sfail, byte spass);
  447. void TagMask(byte mask);
  448. void Tag(byte s);
  449. void Vertex2f(int16_t x, int16_t y);
  450. void Vertex2ii(uint16_t x, uint16_t y, byte handle = 0, byte cell = 0);
  451. void VertexFormat(byte frac);
  452. void BitmapLayoutH(byte linestride, byte height);
  453. void BitmapSizeH(byte width, byte height);
  454. void PaletteSource(uint32_t addr);
  455. void VertexTranslateX(uint32_t x);
  456. void VertexTranslateY(uint32_t y);
  457. void Nop(void);
  458. // Higher-level graphics commands
  459. void cmd_append(uint32_t ptr, uint32_t num);
  460. void cmd_bgcolor(uint32_t c);
  461. void cmd_button(int16_t x, int16_t y, uint16_t w, uint16_t h, byte font, uint16_t options, const char *s);
  462. void cmd_calibrate(void);
  463. void cmd_clock(int16_t x, int16_t y, int16_t r, uint16_t options, uint16_t h, uint16_t m, uint16_t s, uint16_t ms);
  464. void cmd_coldstart(void);
  465. void cmd_dial(int16_t x, int16_t y, int16_t r, uint16_t options, uint16_t val);
  466. void cmd_dlstart(void);
  467. void cmd_fgcolor(uint32_t c);
  468. void cmd_gauge(int16_t x, int16_t y, int16_t r, uint16_t options, uint16_t major, uint16_t minor, uint16_t val, uint16_t range);
  469. void cmd_getmatrix(void);
  470. void cmd_getprops(uint32_t &ptr, uint32_t &w, uint32_t &h);
  471. void cmd_getptr(void);
  472. void cmd_gradcolor(uint32_t c);
  473. void cmd_gradient(int16_t x0, int16_t y0, uint32_t rgb0, int16_t x1, int16_t y1, uint32_t rgb1);
  474. void cmd_inflate(uint32_t ptr);
  475. void cmd_interrupt(uint32_t ms);
  476. void cmd_keys(int16_t x, int16_t y, int16_t w, int16_t h, byte font, uint16_t options, const char*s);
  477. void cmd_loadidentity(void);
  478. void cmd_loadimage(uint32_t ptr, int32_t options);
  479. void cmd_memcpy(uint32_t dest, uint32_t src, uint32_t num);
  480. void cmd_memset(uint32_t ptr, byte value, uint32_t num);
  481. uint32_t cmd_memcrc(uint32_t ptr, uint32_t num);
  482. void cmd_memwrite(uint32_t ptr, uint32_t num);
  483. void cmd_regwrite(uint32_t ptr, uint32_t val);
  484. void cmd_number(int16_t x, int16_t y, byte font, uint16_t options, uint32_t n);
  485. void cmd_progress(int16_t x, int16_t y, int16_t w, int16_t h, uint16_t options, uint16_t val, uint16_t range);
  486. void cmd_regread(uint32_t ptr);
  487. void cmd_rotate(int32_t a);
  488. void cmd_scale(int32_t sx, int32_t sy);
  489. void cmd_screensaver(void);
  490. void cmd_scrollbar(int16_t x, int16_t y, int16_t w, int16_t h, uint16_t options, uint16_t val, uint16_t size, uint16_t range);
  491. void cmd_setfont(byte font, uint32_t ptr);
  492. void cmd_setmatrix(void);
  493. void cmd_sketch(int16_t x, int16_t y, uint16_t w, uint16_t h, uint32_t ptr, uint16_t format);
  494. void cmd_slider(int16_t x, int16_t y, uint16_t w, uint16_t h, uint16_t options, uint16_t val, uint16_t range);
  495. void cmd_snapshot(uint32_t ptr);
  496. void cmd_spinner(int16_t x, int16_t y, byte style, byte scale);
  497. void cmd_stop(void);
  498. void cmd_swap(void);
  499. void cmd_text(int16_t x, int16_t y, byte font, uint16_t options, const char *s);
  500. void cmd_toggle(int16_t x, int16_t y, int16_t w, byte font, uint16_t options, uint16_t state, const char *s);
  501. void cmd_track(int16_t x, int16_t y, uint16_t w, uint16_t h, byte tag);
  502. void cmd_translate(int32_t tx, int32_t ty);
  503. void cmd_playvideo(int32_t options);
  504. void cmd_romfont(uint32_t font, uint32_t romslot);
  505. void cmd_mediafifo(uint32_t ptr, uint32_t size);
  506. void cmd_setbase(uint32_t b);
  507. void cmd_videoframe(uint32_t dst, uint32_t ptr);
  508. void cmd_snapshot2(uint32_t fmt, uint32_t ptr, int16_t x, int16_t y, int16_t w, int16_t h);
  509. void cmd_setfont2(uint32_t font, uint32_t ptr, uint32_t firstchar);
  510. void cmd_setrotate(uint32_t r);
  511. void cmd_videostart();
  512. void cmd_setbitmap(uint32_t source, uint16_t fmt, uint16_t w, uint16_t h);
  513. byte rd(uint32_t addr);
  514. void wr(uint32_t addr, uint8_t v);
  515. uint16_t rd16(uint32_t addr);
  516. void wr16(uint32_t addr, uint16_t v);
  517. uint32_t rd32(uint32_t addr);
  518. void wr32(uint32_t addr, uint32_t v);
  519. void wr_n(uint32_t addr, byte *src, uint32_t n);
  520. void cmd32(uint32_t b);
  521. void bulkrd(uint32_t a);
  522. void resume(void);
  523. void __end(void);
  524. void reset(void);
  525. void dumpscreen(void);
  526. byte load(const char *filename, void (*progress)(long, long) = NULL);
  527. void safeload(const char *filename);
  528. void alert(const char *message);
  529. void textsize(int &w, int &h, int font, const char *s);
  530. sdcard SD;
  531. void storage(void);
  532. void tune(void);
  533. private:
  534. static void cFFFFFF(byte v);
  535. static void cI(uint32_t);
  536. static void ci(int32_t);
  537. static void cH(uint16_t);
  538. static void ch(int16_t);
  539. static void cs(const char *);
  540. static void fmtcmd(const char *fmt, ...);
  541. static void align(byte n);
  542. void cmdbyte(uint8_t b);
  543. uint32_t measure_freq(void);
  544. uint16_t rseed;
  545. };
  546. extern GDClass GD;
  547. extern byte ft8xx_model;
  548. #if SDCARD
  549. class Reader {
  550. public:
  551. int openfile(const char *filename) {
  552. int i = 0;
  553. byte dosname[11];
  554. dirent de;
  555. dos83(dosname, filename);
  556. do {
  557. GD.SD.rdn((byte*)&de, GD.SD.o_root + i * 32, sizeof(de));
  558. // Serial.println(de.name);
  559. if (0 == memcmp(de.name, dosname, 11)) {
  560. begin(de);
  561. return 1;
  562. }
  563. i++;
  564. } while (de.name[0]);
  565. return 0;
  566. }
  567. void begin(dirent &de) {
  568. nseq = 0;
  569. size = de.size;
  570. cluster0 = de.cluster;
  571. if (GD.SD.type == FAT32)
  572. cluster0 |= ((long)de.cluster_hi << 16);
  573. rewind();
  574. }
  575. void rewind(void) {
  576. cluster = cluster0;
  577. sector = 0;
  578. offset = 0;
  579. }
  580. void nextcluster() {
  581. if (GD.SD.type == FAT16)
  582. cluster = GD.SD.rd2(GD.SD.o_fat + 2 * cluster);
  583. else
  584. cluster = GD.SD.rd4(GD.SD.o_fat + 4 * cluster);
  585. #if VERBOSE
  586. Serial.print("nextcluster=");
  587. Serial.println(cluster, DEC);
  588. #endif
  589. }
  590. void fetch512(byte *dst) {
  591. #if defined(__DUE__) || defined(TEENSYDUINO)
  592. for (int i = 0; i < 512; i++)
  593. *dst++ = SPI.transfer(0xff);
  594. SPI.transfer(0xff); // consume CRC
  595. SPI.transfer(0xff);
  596. #else
  597. SPDR = 0xff;
  598. while (!(SPSR & _BV(SPIF))) ;
  599. for (int i = 0; i < 512; i++) {
  600. asm volatile("nop");
  601. asm volatile("nop");
  602. asm volatile("nop");
  603. asm volatile("nop");
  604. asm volatile("nop");
  605. asm volatile("nop");
  606. asm volatile("nop");
  607. asm volatile("nop");
  608. asm volatile("nop");
  609. asm volatile("nop");
  610. asm volatile("nop");
  611. *dst++ = SPDR;
  612. SPDR = 0xff;
  613. }
  614. while (!(SPSR & _BV(SPIF))) ;
  615. SPI.transfer(0xff);
  616. #endif
  617. GD.SD.desel();
  618. }
  619. void nextcluster2(byte *dst) {
  620. if (nseq) {
  621. nseq--;
  622. cluster++;
  623. return;
  624. }
  625. uint32_t off = GD.SD.o_fat + 4 * cluster;
  626. GD.SD.cmd17(off & ~511L);
  627. fetch512(dst);
  628. int i = off & 511;
  629. cluster = *(uint32_t*)&dst[i];
  630. uint32_t c = cluster;
  631. nseq = 0;
  632. for (uint32_t c = cluster;
  633. (i < 512) && *(uint32_t*)&dst[i] == c;
  634. i += 4, c++)
  635. nseq++;
  636. }
  637. void skipcluster() {
  638. nextcluster();
  639. offset += GD.SD.cluster_size;
  640. }
  641. void skipsector() {
  642. if (sector == GD.SD.sectors_per_cluster) {
  643. sector = 0;
  644. nextcluster();
  645. }
  646. sector++;
  647. offset += 512;
  648. }
  649. void seek(uint32_t o) {
  650. union {
  651. uint8_t buf[512];
  652. uint32_t fat32[128];
  653. uint16_t fat16[256];
  654. };
  655. uint32_t co = ~0;
  656. if (o < offset)
  657. rewind();
  658. while (offset < o) {
  659. if ((sector == GD.SD.sectors_per_cluster) && ((o - offset) > (long)GD.SD.cluster_size)) {
  660. uint32_t o;
  661. if (GD.SD.type == FAT16)
  662. o = (GD.SD.o_fat + 2 * cluster) & ~511;
  663. else
  664. o = (GD.SD.o_fat + 4 * cluster) & ~511;
  665. if (o != co) {
  666. GD.SD.rdn(buf, o, 512);
  667. co = o;
  668. }
  669. cluster = fat32[cluster & 127];
  670. offset += GD.SD.cluster_size;
  671. } else
  672. skipsector();
  673. }
  674. }
  675. void readsector(byte *dst) {
  676. if (sector == GD.SD.sectors_per_cluster) {
  677. sector = 0;
  678. nextcluster2(dst);
  679. }
  680. uint32_t off = GD.SD.o_data + ((long)GD.SD.cluster_size * cluster) + (512L * sector);
  681. GD.SD.cmd17(off & ~511L);
  682. sector++;
  683. offset += 512;
  684. fetch512(dst);
  685. }
  686. int eof(void) {
  687. return size <= offset;
  688. }
  689. uint32_t cluster, cluster0;
  690. uint32_t offset;
  691. uint32_t size;
  692. byte sector;
  693. byte nseq;
  694. };
  695. #endif
  696. typedef struct {
  697. byte handle;
  698. uint16_t w, h;
  699. uint16_t size;
  700. } shape_t;
  701. // convert integer pixels to subpixels
  702. #define PIXELS(x) int((x) * 16)
  703. // Convert degrees to Furmans
  704. #define DEGREES(n) ((65536UL * (n)) / 360)
  705. #define NEVER 0
  706. #define LESS 1
  707. #define LEQUAL 2
  708. #define GREATER 3
  709. #define GEQUAL 4
  710. #define EQUAL 5
  711. #define NOTEQUAL 6
  712. #define ALWAYS 7
  713. #define ARGB1555 0
  714. #define L1 1
  715. #define L4 2
  716. #define L8 3
  717. #define RGB332 4
  718. #define ARGB2 5
  719. #define ARGB4 6
  720. #define RGB565 7
  721. #define PALETTED 8
  722. #define TEXT8X8 9
  723. #define TEXTVGA 10
  724. #define BARGRAPH 11
  725. #define NEAREST 0
  726. #define BILINEAR 1
  727. #define BORDER 0
  728. #define REPEAT 1
  729. #define KEEP 1
  730. #define REPLACE 2
  731. #define INCR 3
  732. #define DECR 4
  733. #define INVERT 5
  734. #define DLSWAP_DONE 0
  735. #define DLSWAP_LINE 1
  736. #define DLSWAP_FRAME 2
  737. #define INT_SWAP 1
  738. #define INT_TOUCH 2
  739. #define INT_TAG 4
  740. #define INT_SOUND 8
  741. #define INT_PLAYBACK 16
  742. #define INT_CMDEMPTY 32
  743. #define INT_CMDFLAG 64
  744. #define INT_CONVCOMPLETE 128
  745. #define TOUCHMODE_OFF 0
  746. #define TOUCHMODE_ONESHOT 1
  747. #define TOUCHMODE_FRAME 2
  748. #define TOUCHMODE_CONTINUOUS 3
  749. #define ZERO 0
  750. #define ONE 1
  751. #define SRC_ALPHA 2
  752. #define DST_ALPHA 3
  753. #define ONE_MINUS_SRC_ALPHA 4
  754. #define ONE_MINUS_DST_ALPHA 5
  755. #define BITMAPS 1
  756. #define POINTS 2
  757. #define LINES 3
  758. #define LINE_STRIP 4
  759. #define EDGE_STRIP_R 5
  760. #define EDGE_STRIP_L 6
  761. #define EDGE_STRIP_A 7
  762. #define EDGE_STRIP_B 8
  763. #define RECTS 9
  764. #define OPT_MONO 1
  765. #define OPT_NODL 2
  766. #define OPT_FLAT 256
  767. #define OPT_CENTERX 512
  768. #define OPT_CENTERY 1024
  769. #define OPT_CENTER (OPT_CENTERX | OPT_CENTERY)
  770. #define OPT_NOBACK 4096
  771. #define OPT_NOTICKS 8192
  772. #define OPT_NOHM 16384
  773. #define OPT_NOPOINTER 16384
  774. #define OPT_NOSECS 32768
  775. #define OPT_NOHANDS 49152
  776. #define OPT_RIGHTX 2048
  777. #define OPT_SIGNED 256
  778. #define OPT_NOTEAR 4
  779. #define OPT_FULLSCREEN 8
  780. #define OPT_MEDIAFIFO 16
  781. #define LINEAR_SAMPLES 0
  782. #define ULAW_SAMPLES 1
  783. #define ADPCM_SAMPLES 2
  784. // 'instrument' argument to GD.play()
  785. #define SILENCE 0x00
  786. #define SQUAREWAVE 0x01
  787. #define SINEWAVE 0x02
  788. #define SAWTOOTH 0x03
  789. #define TRIANGLE 0x04
  790. #define BEEPING 0x05
  791. #define ALARM 0x06
  792. #define WARBLE 0x07
  793. #define CAROUSEL 0x08
  794. #define PIPS(n) (0x0f + (n))
  795. #define HARP 0x40
  796. #define XYLOPHONE 0x41
  797. #define TUBA 0x42
  798. #define GLOCKENSPIEL 0x43
  799. #define ORGAN 0x44
  800. #define TRUMPET 0x45
  801. #define PIANO 0x46
  802. #define CHIMES 0x47
  803. #define MUSICBOX 0x48
  804. #define BELL 0x49
  805. #define CLICK 0x50
  806. #define SWITCH 0x51
  807. #define COWBELL 0x52
  808. #define NOTCH 0x53
  809. #define HIHAT 0x54
  810. #define KICKDRUM 0x55
  811. #define POP 0x56
  812. #define CLACK 0x57
  813. #define CHACK 0x58
  814. #define MUTE 0x60
  815. #define UNMUTE 0x61
  816. #define RAM_PAL 1056768UL
  817. #define RAM_CMD (ft8xx_model ? 0x308000UL : 0x108000UL)
  818. #define RAM_DL (ft8xx_model ? 0x300000UL : 0x100000UL)
  819. #define REG_CLOCK (ft8xx_model ? 0x302008UL : 0x102408UL)
  820. #define REG_CMD_DL (ft8xx_model ? 0x302100UL : 0x1024ecUL)
  821. #define REG_CMD_READ (ft8xx_model ? 0x3020f8UL : 0x1024e4UL)
  822. #define REG_CMD_WRITE (ft8xx_model ? 0x3020fcUL : 0x1024e8UL)
  823. #define REG_CPURESET (ft8xx_model ? 0x302020UL : 0x10241cUL)
  824. #define REG_CSPREAD (ft8xx_model ? 0x302068UL : 0x102464UL)
  825. #define REG_DITHER (ft8xx_model ? 0x302060UL : 0x10245cUL)
  826. #define REG_DLSWAP (ft8xx_model ? 0x302054UL : 0x102450UL)
  827. #define REG_FRAMES (ft8xx_model ? 0x302004UL : 0x102404UL)
  828. #define REG_FREQUENCY (ft8xx_model ? 0x30200cUL : 0x10240cUL)
  829. #define REG_GPIO (ft8xx_model ? 0x302094UL : 0x102490UL)
  830. #define REG_GPIO_DIR (ft8xx_model ? 0x302090UL : 0x10248cUL)
  831. #define REG_HCYCLE (ft8xx_model ? 0x30202cUL : 0x102428UL)
  832. #define REG_HOFFSET (ft8xx_model ? 0x302030UL : 0x10242cUL)
  833. #define REG_HSIZE (ft8xx_model ? 0x302034UL : 0x102430UL)
  834. #define REG_HSYNC0 (ft8xx_model ? 0x302038UL : 0x102434UL)
  835. #define REG_HSYNC1 (ft8xx_model ? 0x30203cUL : 0x102438UL)
  836. #define REG_ID (ft8xx_model ? 0x302000UL : 0x102400UL)
  837. #define REG_INT_EN (ft8xx_model ? 0x3020acUL : 0x10249cUL)
  838. #define REG_INT_FLAGS (ft8xx_model ? 0x3020a8UL : 0x102498UL)
  839. #define REG_INT_MASK (ft8xx_model ? 0x3020b0UL : 0x1024a0UL)
  840. #define REG_MACRO_0 (ft8xx_model ? 0x3020d8UL : 0x1024c8UL)
  841. #define REG_MACRO_1 (ft8xx_model ? 0x3020dcUL : 0x1024ccUL)
  842. #define REG_OUTBITS (ft8xx_model ? 0x30205cUL : 0x102458UL)
  843. #define REG_PCLK (ft8xx_model ? 0x302070UL : 0x10246cUL)
  844. #define REG_PCLK_POL (ft8xx_model ? 0x30206cUL : 0x102468UL)
  845. #define REG_PLAY (ft8xx_model ? 0x30208cUL : 0x102488UL)
  846. #define REG_PLAYBACK_FORMAT (ft8xx_model ? 0x3020c4UL : 0x1024b4UL)
  847. #define REG_PLAYBACK_FREQ (ft8xx_model ? 0x3020c0UL : 0x1024b0UL)
  848. #define REG_PLAYBACK_LENGTH (ft8xx_model ? 0x3020b8UL : 0x1024a8UL)
  849. #define REG_PLAYBACK_LOOP (ft8xx_model ? 0x3020c8UL : 0x1024b8UL)
  850. #define REG_PLAYBACK_PLAY (ft8xx_model ? 0x3020ccUL : 0x1024bcUL)
  851. #define REG_PLAYBACK_READPTR (ft8xx_model ? 0x3020bcUL : 0x1024acUL)
  852. #define REG_PLAYBACK_START (ft8xx_model ? 0x3020b4UL : 0x1024a4UL)
  853. #define REG_PWM_DUTY (ft8xx_model ? 0x3020d4UL : 0x1024c4UL)
  854. #define REG_PWM_HZ (ft8xx_model ? 0x3020d0UL : 0x1024c0UL)
  855. #define REG_ROTATE (ft8xx_model ? 0x302058UL : 0x102454UL)
  856. #define REG_SOUND (ft8xx_model ? 0x302088UL : 0x102484UL)
  857. #define REG_SWIZZLE (ft8xx_model ? 0x302064UL : 0x102460UL)
  858. #define REG_TAG (ft8xx_model ? 0x30207cUL : 0x102478UL)
  859. #define REG_TAG_X (ft8xx_model ? 0x302074UL : 0x102470UL)
  860. #define REG_TAG_Y (ft8xx_model ? 0x302078UL : 0x102474UL)
  861. #define REG_TOUCH_ADC_MODE (ft8xx_model ? 0x302108UL : 0x1024f4UL)
  862. #define REG_TOUCH_CHARGE (ft8xx_model ? 0x30210cUL : 0x1024f8UL)
  863. #define REG_TOUCH_DIRECT_XY (ft8xx_model ? 0x30218cUL : 0x102574UL)
  864. #define REG_TOUCH_DIRECT_Z1Z2 (ft8xx_model ? 0x302190UL : 0x102578UL)
  865. #define REG_TOUCH_MODE (ft8xx_model ? 0x302104UL : 0x1024f0UL)
  866. #define REG_TOUCH_OVERSAMPLE (ft8xx_model ? 0x302114UL : 0x102500UL)
  867. #define REG_TOUCH_RAW_XY (ft8xx_model ? 0x30211cUL : 0x102508UL)
  868. #define REG_TOUCH_RZ (ft8xx_model ? 0x302120UL : 0x10250cUL)
  869. #define REG_TOUCH_RZTHRESH (ft8xx_model ? 0x302118UL : 0x102504UL)
  870. #define REG_TOUCH_SCREEN_XY (ft8xx_model ? 0x302124UL : 0x102510UL)
  871. #define REG_TOUCH_SETTLE (ft8xx_model ? 0x302110UL : 0x1024fcUL)
  872. #define REG_TOUCH_TAG (ft8xx_model ? 0x30212cUL : 0x102518UL)
  873. #define REG_TOUCH_TAG_XY (ft8xx_model ? 0x302128UL : 0x102514UL)
  874. #define REG_TOUCH_TRANSFORM_A (ft8xx_model ? 0x302150UL : 0x10251cUL)
  875. #define REG_TOUCH_TRANSFORM_B (ft8xx_model ? 0x302154UL : 0x102520UL)
  876. #define REG_TOUCH_TRANSFORM_C (ft8xx_model ? 0x302158UL : 0x102524UL)
  877. #define REG_TOUCH_TRANSFORM_D (ft8xx_model ? 0x30215cUL : 0x102528UL)
  878. #define REG_TOUCH_TRANSFORM_E (ft8xx_model ? 0x302160UL : 0x10252cUL)
  879. #define REG_TOUCH_TRANSFORM_F (ft8xx_model ? 0x302164UL : 0x102530UL)
  880. #define REG_TRACKER (ft8xx_model ? 0x309000UL : 0x109000UL)
  881. #define REG_TRIM (ft8xx_model ? 0x302180UL : 0x10256cUL)
  882. #define REG_VCYCLE (ft8xx_model ? 0x302040UL : 0x10243cUL)
  883. #define REG_VOFFSET (ft8xx_model ? 0x302044UL : 0x102440UL)
  884. #define REG_VOL_PB (ft8xx_model ? 0x302080UL : 0x10247cUL)
  885. #define REG_VOL_SOUND (ft8xx_model ? 0x302084UL : 0x102480UL)
  886. #define REG_VSIZE (ft8xx_model ? 0x302048UL : 0x102444UL)
  887. #define REG_VSYNC0 (ft8xx_model ? 0x30204cUL : 0x102448UL)
  888. #define REG_VSYNC1 (ft8xx_model ? 0x302050UL : 0x10244cUL)
  889. #define FONT_ROOT (ft8xx_model ? 0x2ffffcUL : 0x0ffffcUL)
  890. #define REG_MEDIAFIFO_READ 0x309014
  891. #define REG_MEDIAFIFO_WRITE 0x309018
  892. #define VERTEX2II(x, y, handle, cell) \
  893. ((2UL << 30) | (((x) & 511UL) << 21) | (((y) & 511UL) << 12) | (((handle) & 31) << 7) | (((cell) & 127) << 0))
  894. #define ROM_PIXEL_FF 0xc0400UL
  895. class Poly {
  896. int x0, y0, x1, y1;
  897. int x[8], y[8];
  898. byte n;
  899. void restart() {
  900. n = 0;
  901. x0 = 16 * 480;
  902. x1 = 0;
  903. y0 = 16 * 272;
  904. y1 = 0;
  905. }
  906. void perim() {
  907. for (byte i = 0; i < n; i++)
  908. GD.Vertex2f(x[i], y[i]);
  909. GD.Vertex2f(x[0], y[0]);
  910. }
  911. public:
  912. void begin() {
  913. restart();
  914. GD.ColorMask(0,0,0,0);
  915. GD.StencilOp(KEEP, INVERT);
  916. GD.StencilFunc(ALWAYS, 255, 255);
  917. }
  918. void v(int _x, int _y) {
  919. x0 = min(x0, _x >> 4);
  920. x1 = max(x1, _x >> 4);
  921. y0 = min(y0, _y >> 4);
  922. y1 = max(y1, _y >> 4);
  923. x[n] = _x;
  924. y[n] = _y;
  925. n++;
  926. }
  927. void paint() {
  928. x0 = max(0, x0);
  929. y0 = max(0, y0);
  930. x1 = min(16 * 480, x1);
  931. y1 = min(16 * 272, y1);
  932. GD.ScissorXY(x0, y0);
  933. GD.ScissorSize(x1 - x0 + 1, y1 - y0 + 1);
  934. GD.Begin(EDGE_STRIP_B);
  935. perim();
  936. }
  937. void finish() {
  938. GD.ColorMask(1,1,1,1);
  939. GD.StencilFunc(EQUAL, 255, 255);
  940. GD.Begin(EDGE_STRIP_B);
  941. GD.Vertex2ii(0, 0);
  942. GD.Vertex2ii(511, 0);
  943. }
  944. void draw() {
  945. paint();
  946. finish();
  947. }
  948. void outline() {
  949. GD.Begin(LINE_STRIP);
  950. perim();
  951. }
  952. };
  953. #if SDCARD
  954. class Streamer {
  955. public:
  956. void begin(const char *rawsamples,
  957. uint16_t freq = 44100,
  958. byte format = ADPCM_SAMPLES,
  959. uint32_t _base = (0x40000UL - 8192), uint16_t size = 8192) {
  960. GD.__end();
  961. r.openfile(rawsamples);
  962. GD.resume();
  963. base = _base;
  964. mask = size - 1;
  965. wp = 0;
  966. for (byte i = 10; i; i--)
  967. feed();
  968. GD.sample(base, size, freq, format, 1);
  969. }
  970. int feed() {
  971. uint16_t rp = GD.rd32(REG_PLAYBACK_READPTR) - base;
  972. uint16_t freespace = mask & ((rp - 1) - wp);
  973. if (freespace >= 512) {
  974. // REPORT(base);
  975. // REPORT(rp);
  976. // REPORT(wp);
  977. // REPORT(freespace);
  978. // Serial.println();
  979. byte buf[512];
  980. // uint16_t n = min(512, r.size - r.offset);
  981. // n = (n + 3) & ~3; // force 32-bit alignment
  982. GD.__end();
  983. r.readsector(buf);
  984. GD.resume();
  985. GD.cmd_memwrite(base + wp, 512);
  986. GD.copyram(buf, 512);
  987. wp = (wp + 512) & mask;
  988. }
  989. return r.offset < r.size;
  990. }
  991. void progress(uint16_t &val, uint16_t &range) {
  992. uint32_t m = r.size;
  993. uint32_t p = min(r.offset, m);
  994. while (m > 0x10000) {
  995. m >>= 1;
  996. p >>= 1;
  997. }
  998. val = p;
  999. range = m;
  1000. }
  1001. private:
  1002. Reader r;
  1003. uint32_t base;
  1004. uint16_t mask;
  1005. uint16_t wp;
  1006. };
  1007. #else
  1008. class Streamer {
  1009. public:
  1010. void begin(const char *rawsamples,
  1011. uint16_t freq = 44100,
  1012. byte format = ADPCM_SAMPLES,
  1013. uint32_t _base = (0x40000UL - 4096), uint16_t size = 4096) {}
  1014. int feed() {}
  1015. void progress(uint16_t &val, uint16_t &range) {}
  1016. };
  1017. #endif
  1018. #endif