API tools faq
paste
Guest User

Untitled

a guest
Jan 7th, 2014
220
0
Never
Add comment
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 32.04 KB | None | 0 0
raw download clone embed print report
  1. /* Testing code for driving UG2828GDEAF01 1,5# OLED
  2. ZhangFeng, PRC.
  3. [email protected]
  4. http://vfdclock.jimdo.com
  5. 09-12-2013
  6. */
  7. #include <stdio.h>
  8. #include <stdlib.h>
  9. #include <math.h>
  10.  
  11. #define FASTIO 0
  12.  
  13. // 4-wire SPI(BS1=0; BS2=0)
  14. #define RST_PIN 8
  15. #define CS_PIN 9
  16. #define DC_PIN 10
  17. #define DIN_PIN 11
  18. #define CLK_PIN 12
  19. #define HVEN_PIN 13
  20.  
  21. #define DODELAY __asm__("nop\n\t""nop\n\t");
  22. #define COUNTOF(arr) (sizeof(arr) / sizeof(arr[0]))
  23.  
  24. #ifndef FASTIO
  25. // rst
  26. #define OLED_RES_1 digitalWrite(RST_PIN, HIGH)
  27. #define OLED_RES_0 digitalWrite(RST_PIN, LOW)
  28. // cs
  29. #define OLED_CS_1 digitalWrite(CS_PIN, HIGH)
  30. #define OLED_CS_0 digitalWrite(CS_PIN, LOW)
  31. // DC (Data or Command)
  32. #define OLED_DC_1 digitalWrite(DC_PIN, HIGH)
  33. #define OLED_DC_0 digitalWrite(DC_PIN, LOW)
  34. // data in
  35. #define OLED_DIN_1 digitalWrite(DIN_PIN, HIGH)
  36. #define OLED_DIN_0 digitalWrite(DIN_PIN, LOW)
  37. // clock
  38. #define OLED_CLK_1 digitalWrite(CLK_PIN, HIGH)
  39. #define OLED_CLK_0 digitalWrite(CLK_PIN, LOW)
  40.  
  41. // HVEN(optional)
  42. #define OLED_HVEN_1 digitalWrite(HVEN_PIN, HIGH)
  43. #define OLED_HVEN_0 digitalWrite(HVEN_PIN, LOW)
  44. #else
  45. // Fast IO version
  46. // pin map please check: http://arduino.cc/en/Hacking/Atmega168Hardware
  47. // pin11 = pb3; pin12 = pb4; pin15 = pb5
  48. #define GPIO_Pin_0 (0x01) /* Pin 0 selected */
  49. #define GPIO_Pin_1 (0x02) /* Pin 1 selected */
  50. #define GPIO_Pin_2 (0x04) /* Pin 2 selected */
  51. #define GPIO_Pin_3 (0x08) /* Pin 3 selected */
  52. #define GPIO_Pin_4 (0x10) /* Pin 4 selected */
  53. #define GPIO_Pin_5 (0x20) /* Pin 5 selected */
  54. #define GPIO_Pin_6 (0x40) /* Pin 6 selected */
  55. #define GPIO_Pin_7 (0x80) /* Pin 7 selected */
  56.  
  57. #define RES_PORT PORTB
  58. #define CS_PORT PORTB
  59. #define DC_PORT PORTB
  60. #define DIN_PORT PORTB
  61. #define CLK_PORT PORTB
  62. #define HVEN_PORT PORTB
  63. #define RES_PORTPIN GPIO_Pin_0
  64. #define CS_PORTPIN GPIO_Pin_1
  65. #define DC_PORTPIN GPIO_Pin_2
  66. #define DIN_PORTPIN GPIO_Pin_3
  67. #define CLK_PORTPIN GPIO_Pin_4
  68. #define HVEN_PORTPIN GPIO_Pin_5
  69.  
  70. #define OLED_RES_1 RES_PORT |= (RES_PORTPIN)
  71. #define OLED_RES_0 RES_PORT &= ~(RES_PORTPIN)
  72. #define OLED_CS_1 CS_PORT |= (CS_PORTPIN)
  73. #define OLED_CS_0 CS_PORT &= ~(CS_PORTPIN)
  74. #define OLED_DC_1 DC_PORT |= (DC_PORTPIN)
  75. #define OLED_DC_0 DC_PORT &= ~(DC_PORTPIN)
  76. #define OLED_DIN_1 DIN_PORT |= (DIN_PORTPIN)
  77. #define OLED_DIN_0 DIN_PORT &= ~(DIN_PORTPIN)
  78. #define OLED_CLK_1 CLK_PORT |= (CLK_PORTPIN)
  79. #define OLED_CLK_0 CLK_PORT &= ~(CLK_PORTPIN)
  80. #define OLED_HVEN_1 HVEN_PORT |= (HVEN_PORTPIN)
  81. #define OLED_HVEN_0 HVEN_PORT &= ~(HVEN_PORTPIN)
  82. #endif
  83.  
  84. #define Max_Column 0x7f // 128-1
  85. #define Max_Row 0x7f // 128-1
  86. #define Brightness 0x0F
  87.  
  88. #define MAKECOLOR64k(r,g,b) (unsigned short int)((((unsigned short int)(r)>>3)<<11)|(((unsigned short int)(g)>>2)<<5)|((unsigned short int)(b)>>3))
  89.  
  90. //-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  91. // Delay Time
  92. //-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  93. void uDelay(unsigned char l)
  94. {
  95. while(l--)
  96. {
  97. __asm__("nop\n\t""nop\n\t""nop\n\t""nop\n\t");
  98. __asm__("nop\n\t""nop\n\t""nop\n\t""nop\n\t");
  99. };
  100. }
  101.  
  102. void Write_Command(unsigned char Data)
  103. {
  104. unsigned char i;
  105. OLED_CS_0;
  106. OLED_DC_0;
  107. for (i=0; i<8; i++)
  108. {
  109. OLED_CLK_0;
  110. //((Data&0x80)>>7)?OLED_DIN_1:OLED_DIN_0;
  111. if((Data&0x80)>>7)
  112. OLED_DIN_1;
  113. else
  114. OLED_DIN_0;
  115. Data = Data << 1;
  116. uDelay(1);
  117. OLED_CLK_1;
  118. uDelay(1);
  119. }
  120. OLED_CLK_0;
  121. OLED_DC_1;
  122. OLED_CS_1;
  123. }
  124.  
  125. void Write_Data(unsigned char Data)
  126. {
  127. unsigned char i;
  128.  
  129. OLED_CS_0;
  130. OLED_DC_1;
  131. for (i=0; i<8; i++)
  132. {
  133. OLED_CLK_0;
  134. if((Data&0x80)>>7)
  135. OLED_DIN_1;
  136. else
  137. OLED_DIN_0;
  138. Data = Data << 1;
  139. uDelay(1);
  140. OLED_CLK_1;
  141. uDelay(1);
  142. }
  143. OLED_CLK_0;
  144. OLED_DC_1;
  145. OLED_CS_1;
  146. }
  147.  
  148. //-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  149. // Gray Scale Table Setting (Full Screen)
  150. //-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  151. void Set_Gray_Scale_Table(void)
  152. {
  153. Write_Command(0xB8);
  154. Write_Data(0x01); // Gray Scale Level 1
  155. Write_Data(0x03); // Gray Scale Level 3
  156. Write_Data(0x05); // Gray Scale Level 5
  157. Write_Data(0x07); // Gray Scale Level 7
  158. Write_Data(0x0B); // Gray Scale Level 9
  159. Write_Data(0x10); // Gray Scale Level 11
  160. Write_Data(0x16); // Gray Scale Level 13
  161. Write_Data(0x1A); // Gray Scale Level 15
  162. Write_Data(0x1F); // Gray Scale Level 17
  163. Write_Data(0x24); // Gray Scale Level 19
  164. Write_Data(0x29); // Gray Scale Level 21
  165. Write_Data(0x2E); // Gray Scale Level 23
  166. Write_Data(0x33); // Gray Scale Level 25
  167. Write_Data(0x38); // Gray Scale Level 27
  168. Write_Data(0x3D); // Gray Scale Level 29
  169. Write_Data(0x42); // Gray Scale Level 31
  170. Write_Data(0x47); // Gray Scale Level 33
  171. Write_Data(0x4C); // Gray Scale Level 35
  172. Write_Data(0x51); // Gray Scale Level 37
  173. Write_Data(0x56); // Gray Scale Level 39
  174. Write_Data(0x5A); // Gray Scale Level 41
  175. Write_Data(0x5E); // Gray Scale Level 43
  176. Write_Data(0x62); // Gray Scale Level 45
  177. Write_Data(0x65); // Gray Scale Level 47
  178. Write_Data(0x68); // Gray Scale Level 49
  179. Write_Data(0x6B); // Gray Scale Level 51
  180. Write_Data(0x6E); // Gray Scale Level 53
  181. Write_Data(0x71); // Gray Scale Level 55
  182. Write_Data(0x74); // Gray Scale Level 57
  183. Write_Data(0x77); // Gray Scale Level 59
  184. Write_Data(0x7A); // Gray Scale Level 61
  185. Write_Data(0x7D); // Gray Scale Level 63
  186. }
  187.  
  188. void Clear_Window(unsigned char a, unsigned char b, unsigned char c, unsigned char d)
  189. {
  190. Write_Command(0x8E);
  191. Write_Data(a); // Column Address of Start
  192. Write_Data(c); // Row Address of Start
  193. Write_Data(b); // Column Address of End
  194. Write_Data(d); // Row Address of End
  195. delay(10); // delay 5ms for its drawing
  196. }
  197.  
  198.  
  199. void OLED_InitIOs(void)
  200. {
  201. OLED_RES_1;
  202. OLED_CS_1;
  203. OLED_CLK_1;
  204. OLED_DIN_1;
  205. OLED_DC_1;
  206. }
  207.  
  208. //=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  209. // Initialization
  210. //=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  211. void OLED_Init(void)
  212. {
  213. unsigned char i;
  214.  
  215. OLED_RES_0;
  216. for(i=0;i<200;i++)
  217. {
  218. delay(1); // delay
  219. }
  220. OLED_RES_1;
  221.  
  222. // Display Off (0x00/0x01)
  223. Write_Command(0xAE);
  224. Write_Command(0xA0);
  225. Write_Data(0x74); // [0x74]: 64k Colors Mode; [0xB4]:262k Colors Mode;256 Colors Mode (0x34)
  226. Write_Command(0xA1);
  227. Write_Data(0x00);
  228. Write_Command(0xA2);
  229. Write_Data(0x80);
  230. Write_Command(0xA6);
  231. Write_Command(0xAD);
  232. Write_Data(0x8E);
  233. Write_Command(0xB0);
  234. Write_Data(0x05);
  235. Write_Command(0xB1);
  236. Write_Data(0x11);
  237. Write_Command(0xB3);
  238. Write_Data(0xF0);
  239. // gray table
  240. Set_Gray_Scale_Table();
  241.  
  242. Write_Command(0xBB);
  243. Write_Data(0x1C);
  244. Write_Data(0x1C);
  245. Write_Data(0x1C);
  246.  
  247. Write_Command(0xBE);
  248. Write_Data(0x3F);
  249.  
  250. Write_Command(0xC1);
  251. Write_Data(0xDC);
  252. Write_Data(0xD2);
  253. Write_Data(0xFF);
  254.  
  255. Write_Command(0xC7);
  256. Write_Data(0x0A);
  257.  
  258. Write_Command(0xCA);
  259. Write_Data(0x7F);
  260.  
  261. Write_Command(0xAF);
  262. }
  263.  
  264. void EnableFill(unsigned char d)
  265. {
  266. Write_Command(0x92);
  267. Write_Data(!!d); // Default => 0x00
  268. }
  269.  
  270. //===============================================================================//
  271. // Graphic Acceleration(by hardware)
  272. //===============================================================================//
  273. void Draw_Line64k(unsigned char x1, unsigned char y1, unsigned char x2, unsigned char y2, unsigned short int col)
  274. {
  275. Write_Command(0x83);
  276. Write_Data(x1); // Column Address of Start
  277. Write_Data(y1); // Row Address of Start
  278. Write_Data(x2); // Column Address of End
  279. Write_Data(y2); // Row Address of End
  280. Write_Data(col>>8); // Line Color - CCCCCBBB
  281. Write_Data(col&0xff); // Line Color - BBBAAAAA
  282. delay(1); // delay 5ms for its drawing
  283. }
  284.  
  285. void Draw_Rectangle64k(unsigned char xLeft, unsigned char yTop, unsigned char xRight, unsigned char yBottom, unsigned short int colOutline, unsigned short int colFill)
  286. {
  287. Write_Command(0x84);
  288. Write_Data(xLeft);
  289. Write_Data(yTop);
  290. Write_Data(xRight);
  291. Write_Data(yBottom);
  292. Write_Data(colOutline>>8); // Line Color - CCCCCBBB
  293. Write_Data(colOutline&0xff); // Line Color - BBBAAAAA
  294. Write_Data(colFill>>8); // Line Color - CCCCCBBB
  295. Write_Data(colFill&0xff); // Line Color - BBBAAAAA
  296. delay(2); // delay 5ms for its drawing
  297. }
  298.  
  299. void Draw_Circle64k(unsigned char x, unsigned char y, unsigned char r, unsigned short int colOutline, unsigned short int colFill)
  300. {
  301. Write_Command(0x86);
  302. Write_Data(x); // Column Address of Start
  303. Write_Data(y); // Row Address of Start
  304. Write_Data(r); // Radius
  305. Write_Data(colOutline>>8); // Line Color - CCCCCBBB
  306. Write_Data(colOutline&0xff); // Line Color - BBBAAAAA
  307. Write_Data(colFill>>8); // Fill Color - CCCCCBBB
  308. Write_Data(colFill&0xff); // Fill Color - BBBAAAAA
  309. delay(2); // delay 10ms for its drawing
  310. }
  311.  
  312. //-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  313. // Show Regular Pattern (Partial or Full Screen)
  314. //
  315. // a: Column Address of Start
  316. // b: Column Address of End
  317. // c: Row Address of Start
  318. // d: Row Address of End
  319. // e: BBBBBGGG
  320. // f: GGGRRRRR
  321. //-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  322. void Fill_Block64k(unsigned char xLeft, unsigned char yTop, unsigned char xRight, unsigned char yBottom, unsigned short int col)
  323. {
  324. EnableFill(0x01);
  325. Draw_Rectangle64k(xLeft, yTop, xRight, yBottom, col, col);
  326. EnableFill(0x00);
  327. }
  328.  
  329. void Fill_Block64k_Slow(unsigned char x1, unsigned char y1, unsigned char x2, unsigned char y2, unsigned short int col)
  330. {
  331. unsigned char i,j;
  332.  
  333. Set_Column_Address(x1,x2);
  334. Set_Row_Address(y1,y2);
  335. Set_Write_RAM();
  336.  
  337. for(i=0;i<(y2-y1+1);i++)
  338. {
  339. for(j=0;j<(x2-x1+1);j++)
  340. {
  341. Write_Data(col>>8); // Line Color - CCCCCBBB
  342. Write_Data(col&0xff); // Line Color - BBBAAAAA
  343. }
  344. }
  345. }
  346.  
  347. void Draw_Point64k_Slow(unsigned char x, unsigned char y, unsigned short int col)
  348. {
  349. Set_Column_Address(x,x);
  350. Set_Row_Address(y,y);
  351. Set_Write_RAM();
  352. Write_Data(col>>8); // Line Color - CCCCCBBB
  353. Write_Data(col&0xff); // Line Color - BBBAAAAA
  354. }
  355.  
  356. //-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  357. // Show Color Bar (Full Screen)
  358. //-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  359. void Rainbow(void)
  360. {
  361. // White => Column 1~16
  362. Fill_Block64k(0x00,0x00,0x0F,Max_Row,MAKECOLOR64k(0xFF,0xFF,0xFF));
  363.  
  364. // Yellow => Column 17~32
  365. Fill_Block64k(0x10,0x00,0x1F,Max_Row,MAKECOLOR64k(0xFF,0xFF,0x00));
  366.  
  367. // Purple => Column 33~48
  368. Fill_Block64k(0x20,0x00,0x2F,Max_Row,MAKECOLOR64k(0xFF,0x00,0xFF));
  369.  
  370. // Cyan => Column 49~64
  371. Fill_Block64k(0x30,0x00,0x3F,Max_Row,MAKECOLOR64k(0x00,0xFF,0xFF));
  372.  
  373. // Red => Column 65~80
  374. Fill_Block64k(0x40,0x00,0x4F,Max_Row,MAKECOLOR64k(0xFF,0x00,0x00));
  375.  
  376. // Green => Column 81~96
  377. Fill_Block64k(0x50,0x00,0x5F,Max_Row,MAKECOLOR64k(0x00,0xFF,0x00));
  378.  
  379. // Blue => Column 97~112
  380. Fill_Block64k(0x60,0x00,0x6F,Max_Row,MAKECOLOR64k(0x00,0x00,0xFF));
  381.  
  382. // Black => Column 113~128
  383. Fill_Block64k(0x70,0x00,Max_Column,Max_Row,MAKECOLOR64k(0x00,0x00,0x00));
  384. }
  385. //-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  386. // Instruction Setting
  387. //-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  388. void Set_Column_Address(unsigned char a, unsigned char b)
  389. {
  390. Write_Command(0x15);
  391. Write_Data(a); // Default => 0x00
  392. Write_Data(b); // Default => 0x83
  393. }
  394.  
  395. void Set_Row_Address(unsigned char a, unsigned char b)
  396. {
  397. Write_Command(0x75);
  398. Write_Data(a); // Default => 0x00
  399. Write_Data(b); // Default => 0x83
  400. }
  401.  
  402. void Set_Write_RAM(void)
  403. {
  404. Write_Command(0x5C); // Enable MCU to Write into RAM
  405. }
  406.  
  407. //=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  408. // Patterns
  409. //=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=
  410. void Show_64k_Pattern_BigEndian(unsigned char *Data_Pointer, unsigned char x1, unsigned char y1, unsigned char x2, unsigned char y2)
  411. {
  412. unsigned char *Src_Pointer;
  413. unsigned char i,j;
  414.  
  415. Src_Pointer=Data_Pointer;
  416. Set_Column_Address(x1,x2);
  417. Set_Row_Address(y1,y2);
  418. Set_Write_RAM();
  419.  
  420. for(i=0;i<(y2-y1+1);i++)
  421. {
  422. for(j=0;j<(x2-x1+1);j++)
  423. {
  424. Write_Data(*Src_Pointer);
  425. Src_Pointer++;
  426. Write_Data(*Src_Pointer);
  427. Src_Pointer++;
  428. }
  429. }
  430. }
  431.  
  432. void Show_64k_Pattern_LittleEndia(unsigned char *Data_Pointer, unsigned char x1, unsigned char y1, unsigned char x2, unsigned char y2)
  433. {
  434. unsigned char *Src_Pointer;
  435. unsigned char i,j;
  436.  
  437. Src_Pointer=Data_Pointer;
  438. Set_Column_Address(x1,x2);
  439. Set_Row_Address(y1,y2);
  440. Set_Write_RAM();
  441.  
  442. for(i=0;i<(y2-y1+1);i++)
  443. {
  444. for(j=0;j<(x2-x1+1);j++)
  445. {
  446. Write_Data(*(Src_Pointer+1));
  447. Write_Data(*(Src_Pointer));
  448. Src_Pointer+=2;
  449. }
  450. }
  451. }
  452.  
  453. void Show_256k_Pattern(unsigned char *Data_Pointer, unsigned char a, unsigned char b, unsigned char c, unsigned char d)
  454. {
  455. unsigned char *Src_Pointer;
  456. unsigned char i,j;
  457.  
  458. Src_Pointer=Data_Pointer;
  459. Set_Column_Address(a,b);
  460. Set_Row_Address(c,d);
  461. Set_Write_RAM();
  462.  
  463. for(i=0;i<(d-c+1);i++)
  464. {
  465. for(j=0;j<(b-a+1);j++)
  466. {
  467. Write_Data(*Src_Pointer);
  468. Src_Pointer++;
  469. Write_Data(*Src_Pointer);
  470. Src_Pointer++;
  471. Write_Data(*Src_Pointer);
  472. Src_Pointer++;
  473. }
  474. }
  475. }
  476.  
  477. const unsigned char Icon24x24x64k[] ={
  478. 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
  479. 0x7b,0xf7,0xd6,0xee,0x73,0xe6,0x52,0xe6,0x51,0xe6,0x93,0xe6,0xd6,0xee,0x7b,0xf7,
  480. 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
  481.  
  482. 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0x18,0xef,0x30,0xde,
  483. 0x0e,0xe6,0x6f,0xee,0x8f,0xee,0xd0,0xf6,0xf0,0xf6,0x90,0xee,0x6f,0xee,0x0e,0xe6,
  484. 0x10,0xe6,0xf8,0xee,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
  485.  
  486. 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xbd,0xff,0x52,0xe6,0x0e,0xe6,0xf1,0xf6,
  487. 0x50,0xff,0x2e,0xff,0x0c,0xff,0xec,0xfe,0xec,0xfe,0xec,0xfe,0x0d,0xff,0x10,0xff,
  488. 0xd0,0xf6,0x0d,0xe6,0x31,0xe6,0xbd,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
  489.  
  490. 0xff,0xff,0xff,0xff,0xff,0xff,0x9c,0xf7,0xef,0xdd,0x8f,0xee,0x2f,0xff,0xcb,0xfe,
  491. 0xa8,0xfe,0xc8,0xfe,0xa8,0xfe,0xa8,0xfe,0xa7,0xfe,0xa7,0xfe,0x87,0xfe,0x87,0xfe,
  492. 0x8a,0xfe,0xee,0xfe,0x4d,0xee,0xae,0xdd,0x9d,0xf7,0xff,0xff,0xff,0xff,0xff,0xff,
  493.  
  494. 0xff,0xff,0xff,0xff,0xbd,0xff,0xef,0xdd,0x8e,0xf6,0x0c,0xff,0xa8,0xfe,0xa8,0xfe,
  495. 0xa9,0xfe,0xc8,0xfe,0xa9,0xfe,0xa8,0xfe,0xa8,0xfe,0xa8,0xfe,0x68,0xfe,0x67,0xfe,
  496. 0x66,0xfe,0x66,0xfe,0xaa,0xfe,0x2c,0xee,0xce,0xdd,0xbd,0xff,0xff,0xff,0xff,0xff,
  497.  
  498. 0xff,0xff,0xff,0xff,0x93,0xe6,0x6c,0xee,0x0b,0xff,0xa8,0xfe,0xa9,0xfe,0xc9,0xfe,
  499. 0xa9,0xfe,0xa8,0xfe,0xa8,0xfe,0xa8,0xfe,0xa8,0xfe,0x88,0xfe,0x67,0xfe,0x67,0xfe,
  500. 0x67,0xfe,0x47,0xfe,0x06,0xfe,0x68,0xfe,0x0b,0xee,0x73,0xe6,0xff,0xff,0xff,0xff,
  501.  
  502. 0xff,0xff,0x5a,0xf7,0x0b,0xe6,0xca,0xfe,0xa8,0xfe,0xa9,0xfe,0xc9,0xfe,0xc9,0xfe,
  503. 0xc8,0xfe,0xc8,0xfe,0xa8,0xfe,0xa8,0xfe,0x88,0xfe,0x67,0xfe,0x87,0xfe,0x87,0xfe,
  504. 0x26,0xfe,0x26,0xfe,0x26,0xfe,0x25,0xfe,0x28,0xfe,0xaa,0xe5,0x39,0xef,0xff,0xff,
  505.  
  506. 0xff,0xff,0x52,0xe6,0x89,0xf6,0xe8,0xfe,0xc9,0xfe,0xa9,0xfe,0xa9,0xfe,0x88,0xfe,
  507. 0xc6,0xe5,0x27,0xee,0xa8,0xfe,0x67,0xfe,0x67,0xfe,0x67,0xfe,0xe6,0xed,0x65,0xe5,
  508. 0x26,0xfe,0x26,0xfe,0x26,0xfe,0xe6,0xfd,0xe5,0xfd,0xa6,0xf5,0x31,0xde,0xff,0xff,
  509.  
  510. 0x9d,0xf7,0xeb,0xe5,0x87,0xfe,0xc7,0xfe,0xc8,0xfe,0xa8,0xfe,0xe8,0xfe,0x45,0xd5,
  511. 0xc0,0x8a,0xa2,0xab,0x47,0xf6,0x87,0xfe,0x87,0xfe,0x06,0xf6,0x82,0xa3,0xe1,0x92,
  512. 0x24,0xdd,0x26,0xfe,0xe6,0xfd,0xe5,0xf5,0xa4,0xfd,0x44,0xfd,0x49,0xdd,0x9d,0xf7,
  513.  
  514. 0x19,0xef,0x86,0xe5,0x87,0xfe,0x67,0xfe,0x87,0xfe,0x87,0xfe,0xa7,0xfe,0xe3,0xb3,
  515. 0x80,0x8a,0xc0,0x92,0xa6,0xe5,0x67,0xfe,0x87,0xfe,0x45,0xe5,0xc0,0x92,0xa0,0x8a,
  516. 0x23,0xbc,0x06,0xfe,0xa5,0xf5,0x84,0xf5,0x44,0xf5,0x23,0xfd,0xe4,0xdc,0x39,0xef,
  517.  
  518. 0xd7,0xee,0xc5,0xe5,0x87,0xfe,0x67,0xfe,0x67,0xfe,0x67,0xfe,0x87,0xfe,0x66,0xbc,
  519. 0x00,0x72,0xe2,0x8a,0xc8,0xed,0x06,0xfe,0x06,0xfe,0x87,0xed,0xc2,0x8a,0x40,0x72,
  520. 0x45,0xc4,0xa5,0xfd,0x64,0xf5,0x64,0xf5,0x24,0xf5,0x03,0xfd,0xc3,0xe4,0xd5,0xee,
  521.  
  522. 0x95,0xe6,0xe5,0xed,0x87,0xfe,0x67,0xfe,0x67,0xfe,0x47,0xfe,0x26,0xfe,0x2b,0xf6,
  523. 0xec,0xbc,0x8c,0xd5,0x07,0xfe,0xe5,0xfd,0xc4,0xfd,0xc6,0xfd,0x2b,0xcd,0xab,0xbc,
  524. 0x89,0xf5,0x63,0xfd,0x44,0xf5,0x24,0xf5,0x24,0xf5,0x23,0xfd,0xc2,0xe4,0x73,0xe6,
  525.  
  526. 0xb6,0xee,0xa5,0xed,0x67,0xfe,0x67,0xfe,0x27,0xfe,0x26,0xfe,0x26,0xfe,0x26,0xfe,
  527. 0x8b,0xfe,0x49,0xfe,0xe5,0xfd,0xc6,0xf5,0xa5,0xfd,0x84,0xf5,0xe7,0xfd,0x09,0xfe,
  528. 0x64,0xfd,0x43,0xf5,0x24,0xf5,0x04,0xf5,0x24,0xf5,0x23,0xf5,0xc2,0xe4,0x94,0xe6,
  529.  
  530. 0xf8,0xee,0x85,0xe5,0x46,0xfe,0x27,0xfe,0x26,0xfe,0x25,0xfe,0xe5,0xf5,0xe6,0xf5,
  531. 0xe6,0xfd,0xe6,0xfd,0xe7,0xfd,0xc7,0xfd,0xa7,0xfd,0xa6,0xfd,0x65,0xf5,0x44,0xf5,
  532. 0x24,0xed,0x23,0xfd,0x24,0xfd,0x24,0xf5,0x04,0xf5,0x03,0xfd,0xa3,0xe4,0xf7,0xee,
  533.  
  534. 0x5b,0xf7,0x87,0xe5,0x26,0xfe,0x26,0xfe,0x26,0xfe,0x45,0xdd,0xe6,0xd4,0xe6,0xfd,
  535. 0x07,0xfe,0x29,0xfe,0x2b,0xfe,0x2b,0xfe,0x0b,0xfe,0xe9,0xfd,0xc8,0xfd,0x86,0xfd,
  536. 0xe5,0xe4,0x44,0xcc,0x03,0xf5,0x24,0xf5,0x04,0xf5,0xe3,0xfc,0xc5,0xdc,0x5b,0xf7,
  537.  
  538. 0xff,0xff,0xcd,0xdd,0xe5,0xf5,0x26,0xfe,0xe5,0xf5,0x07,0xcd,0x49,0xdd,0xe5,0xd4,
  539. 0x05,0xdd,0x87,0xed,0xea,0xf5,0x2c,0xfe,0x0c,0xfe,0xa9,0xf5,0x46,0xed,0x83,0xd4,
  540. 0x86,0xcc,0xa8,0xcc,0xa3,0xe4,0x03,0xfd,0x03,0xfd,0xc3,0xf4,0x6b,0xdd,0xde,0xff,
  541.  
  542. 0xff,0xff,0x95,0xe6,0x86,0xe5,0x06,0xfe,0xe6,0xfd,0xa8,0xed,0xe7,0xfd,0xa9,0xe5,
  543. 0xe9,0xcc,0x67,0xbc,0x67,0xbc,0x67,0xbc,0x47,0xbc,0x27,0xb4,0x47,0xb4,0xc9,0xc4,
  544. 0x48,0xed,0x26,0xf5,0x04,0xf5,0x03,0xfd,0x03,0xfd,0xc4,0xe4,0x95,0xe6,0xff,0xff,
  545.  
  546. 0xff,0xff,0xbe,0xff,0xac,0xdd,0xc6,0xf5,0xe6,0xfd,0xc6,0xfd,0x85,0xfd,0xc5,0xfd,
  547. 0xc7,0xfd,0xe9,0xf5,0xca,0xf5,0x8a,0xed,0x6a,0xed,0x8a,0xed,0xa9,0xf5,0x66,0xfd,
  548. 0x23,0xfd,0x04,0xf5,0x03,0xf5,0x03,0xfd,0x04,0xf5,0x6a,0xdd,0xbe,0xff,0xff,0xff,
  549.  
  550. 0xff,0xff,0xff,0xff,0x19,0xef,0x47,0xdd,0xc6,0xfd,0xa5,0xfd,0x64,0xf5,0x65,0xf5,
  551. 0x64,0xf5,0x43,0xfd,0x23,0xfd,0x23,0xfd,0x23,0xfd,0x03,0xfd,0x02,0xfd,0x03,0xf5,
  552. 0x03,0xf5,0x03,0xf5,0x23,0xfd,0x25,0xfd,0xe6,0xdc,0x18,0xef,0xff,0xff,0xff,0xff,
  553.  
  554. 0xff,0xff,0xff,0xff,0xff,0xff,0xb5,0xe6,0x26,0xd5,0xc7,0xf5,0x85,0xfd,0x44,0xf5,
  555. 0x24,0xf5,0x44,0xf5,0x23,0xf5,0x24,0xf5,0x23,0xf5,0x23,0xf5,0x03,0xf5,0xe3,0xf4,
  556. 0xe3,0xf4,0x45,0xfd,0x66,0xf5,0xe5,0xdc,0x95,0xee,0xff,0xff,0xff,0xff,0xff,0xff,
  557.  
  558. 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xb6,0xe6,0x49,0xdd,0x87,0xf5,0xa7,0xfd,
  559. 0x66,0xfd,0x24,0xf5,0x23,0xf5,0x23,0xf5,0x03,0xf5,0xe3,0xf4,0x04,0xf5,0x46,0xfd,
  560. 0x67,0xfd,0x46,0xed,0x07,0xd5,0xb6,0xe6,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
  561.  
  562. 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0x5a,0xf7,0xce,0xdd,0x27,0xdd,
  563. 0x47,0xed,0x67,0xf5,0x87,0xfd,0x67,0xfd,0x67,0xfd,0x87,0xfd,0x67,0xfd,0x46,0xed,
  564. 0x06,0xdd,0xad,0xdd,0x3a,0xf7,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
  565.  
  566. 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0x19,0xef,
  567. 0x10,0xe6,0x6b,0xdd,0x49,0xe5,0x48,0xe5,0x28,0xe5,0x48,0xdd,0x6a,0xdd,0x10,0xe6,
  568. 0x18,0xef,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
  569.  
  570. 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
  571. 0xff,0xff,0xff,0xff,0x7c,0xf7,0x5a,0xf7,0x5a,0xef,0x7c,0xf7,0xff,0xff,0xff,0xff,
  572. 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
  573.  
  574. 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
  575. 0xff,0xff,0xff,0xff,0x7c,0xf7,0x5a,0xf7,0x5a,0xef,0x7c,0xf7,0xff,0xff,0xff,0xff,
  576. 0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,0xff,
  577. };
  578.  
  579. void draw_lines(void)
  580. {
  581. unsigned char x1,y1,x2,y2;
  582. unsigned short int i;
  583.  
  584. // draw unfilled rectangles
  585. EnableFill(0x00);
  586. for (i=0; i<2000; i++) {
  587. x1=rand()%127;
  588. x2=rand()%127;
  589. y1=rand()%127;
  590. y2=rand()%127;
  591. Draw_Line64k(min(x1,x2),min(y1,y2),max(x1,x2),max(y1,y2), MAKECOLOR64k(rand(), rand(),rand()));
  592. }
  593. }
  594.  
  595. void draw_rects(void)
  596. {
  597. unsigned char x1,y1,x2,y2;
  598. unsigned short int i;
  599.  
  600. // draw unfilled rectangles
  601. EnableFill(0x00);
  602. for (i=0; i<2000; i++) {
  603. x1=rand()%127;
  604. x2=rand()%127;
  605. y1=rand()%127;
  606. y2=rand()%127;
  607. Draw_Rectangle64k(min(x1,x2),min(y1,y2),max(x1,x2),max(y1,y2), MAKECOLOR64k(rand(), rand(),rand()), 0x0000);
  608. }
  609.  
  610. // draw filled rectangles
  611. EnableFill(0x01);
  612. for (i=0; i<2000; i++) {
  613. x1=rand()%127;
  614. x2=rand()%127;
  615. y1=rand()%127;
  616. y2=rand()%127;
  617. Draw_Rectangle64k(min(x1,x2),min(y1,y2),max(x1,x2),max(y1,y2), MAKECOLOR64k(rand(), rand(),rand()), MAKECOLOR64k(rand(), rand(),rand()));
  618. }
  619. }
  620.  
  621. void draw_circles(void)
  622. {
  623. unsigned char x,y,r;
  624. unsigned short int i;
  625.  
  626. // draw unfilled circles
  627. EnableFill(0x00);
  628. for (i=0; i<2000; i++) {
  629. x=rand()%128;
  630. y=rand()%128;
  631. r=rand()%60;
  632. Draw_Circle64k(x, y, r, MAKECOLOR64k(rand(), rand(),rand()), 0x0000);
  633. }
  634.  
  635. // draw filled circles
  636. EnableFill(0x01);
  637. for (i=0; i<2000; i++) {
  638. x=rand()%128;
  639. y=rand()%128;
  640. r=rand()%60;
  641. Draw_Circle64k(x, y, r, MAKECOLOR64k(rand(), rand(),rand()), MAKECOLOR64k(rand(), rand(),rand()));
  642. }
  643. }
  644.  
  645. void draw_wheels(void)
  646. {
  647. float al,pi=3.14159;
  648. unsigned char l=25, x,y,i;
  649.  
  650. EnableFill(0x00);
  651. for (i=0; i<30; i++) {
  652. for (al=0; al<2*pi; al+=pi/24.0) {
  653. x=(unsigned char)(l*cos(al))+64;
  654. y=(unsigned char)(64-l*sin(al));
  655. Draw_Circle64k(x,y,25, MAKECOLOR64k(rand(), rand(),rand()), MAKECOLOR64k(rand(), rand(),rand()));
  656. }
  657. }
  658. }
  659.  
  660. void draw_lines_flower1(void)
  661. {
  662. float pi=3.14159,al,f;
  663. unsigned char x1,y1,x2,y2, d=30;
  664.  
  665. for(al=0.0; al<pi*2; al+=pi/360) {
  666. f=(d*(1.0+1.0/4.0*cos(12.0*al)))*(1.0+sin(4.0*al));
  667. x1=64+f*cos(al);
  668. x2=64+f*cos(al+pi/5.0);
  669. y1=64-f*sin(al);
  670. y2=64-f*sin(al+pi/5.0);
  671. Draw_Line64k(x1,y1,x2,y2, MAKECOLOR64k(rand(), rand(),rand()));
  672. }
  673. }
  674.  
  675. void draw_lines_flower(void)
  676. {
  677. float pi=3.14159,al,f;
  678. unsigned char x1,y1,x2,y2, d=30;
  679.  
  680. for(al=0.0; al<pi*2; al+=pi/360) {
  681. f=(d*(1.0+sin(4.0*al)));
  682. x1=64+f*cos(al);
  683. x2=64+f*cos(al+pi/5.0);
  684. y1=64-f*sin(al);
  685. y2=64-f*sin(al+pi/5.0);
  686. Draw_Line64k(x1,y1,x2,y2, MAKECOLOR64k(rand(), rand(),rand()));
  687. }
  688. }
  689.  
  690. extern "C" {
  691.  
  692. // 3D code from joaquim <[email protected]>
  693. typedef struct {
  694. double x, y, z;
  695. }
  696. Vector3D ;
  697.  
  698. typedef struct {
  699. int x;
  700. int y;
  701. int z;
  702. }
  703. ScreenPoint;
  704.  
  705. #define xAxis 64
  706. #define yAxis 64
  707. #define zAxis -350
  708. #define viewFov 80 // for big or small
  709. #define rotSpeed 5
  710. double thetaX = 0;
  711. #define FACENUMBER 72
  712.  
  713. #define xCenter 64
  714. #define yCenter 64
  715.  
  716. const uint16_t pontos[] = {
  717. 0, 0, 25,
  718. 60, 0, 25,
  719. 80, 80, 25,
  720. 160, 80, 25,
  721. 180, 0, 25,
  722. 240, 0, 25,
  723. 160,220, 25,
  724. 80,220, 25,
  725.  
  726. 80,100, 25,
  727. 160,100, 25,
  728. 140,180, 25,
  729. 100,180, 25,
  730.  
  731. 0, 0,-25,
  732. 60, 0,-25,
  733. 80, 80,-25,
  734. 160, 80,-25,
  735. 180, 0,-25,
  736. 240, 0,-25,
  737. 160,220,-25,
  738. 80,220,-25,
  739.  
  740. 80,100,-25,
  741. 160,100,-25,
  742. 140,180,-25,
  743. 100,180,-25
  744. };
  745.  
  746. const uint8_t face[ FACENUMBER ] = {
  747. 0,1, 1,2, 2,3, 3,4, 4,5, 5,6, 6,7, 7,0,
  748. 8,9, 9,10, 10,11, 11,8,
  749.  
  750. 12,13, 13,14, 14,15, 15,16, 16,17, 17,18, 18,19, 19,12,
  751. 20,21, 21,22, 22,23, 23,20,
  752.  
  753. 0,12, 1,13, 2,14, 3,15, 4,16, 5,17, 6,18, 7,19,
  754. 8,20, 9,21, 10,22, 11,23
  755.  
  756. };
  757.  
  758. const double _sin_tab[] = {
  759. 0.000000,0.017452,0.034899,0.052335,0.069756,0.087155,0.104528,0.121869,0.139173
  760. ,0.156434,0.173648,0.190808,0.207911,0.224951,0.241921,0.258819,0.275637,0.292371
  761. ,0.309016,0.325568,0.342020,0.358367,0.374606,0.390731,0.406736,0.422618,0.438371
  762. ,0.453990,0.469471,0.484809,0.499999,0.515038,0.529919,0.544639,0.559192,0.573576
  763. ,0.587785,0.601815,0.615661,0.629320,0.642787,0.656059,0.669130,0.681998,0.694658
  764. ,0.707106,0.719339,0.731353,0.743144,0.754709,0.766044,0.777145,0.788010,0.798635
  765. ,0.809016,0.819152,0.829037,0.838670,0.848048,0.857167,0.866025,0.874619,0.882947
  766. ,0.891006,0.898794,0.906307,0.913545,0.920504,0.927183,0.933580,0.939692,0.945518
  767. ,0.951056,0.956304,0.961261,0.965925,0.970295,0.974370,0.978147,0.981627,0.984807
  768. ,0.987688,0.990268,0.992546,0.994521,0.996194,0.997564,0.998629,0.999390,0.999847
  769. ,1.000000
  770. };
  771.  
  772. double _sin( int angle ) {
  773. if ( angle >= 0 && angle <= 90 ) {
  774. return _sin_tab[angle];
  775. }
  776. else if ( angle >= 91 && angle <= 180 ) {
  777. return _sin_tab[90 - (angle - 90)];
  778. }
  779. else if ( angle >= 181 && angle <= 270 ) {
  780. return - _sin_tab[angle - 180];
  781. }
  782. else if ( angle >= 271 && angle <= 360 ) {
  783. return - _sin_tab[90 - (angle - 270)];
  784. }
  785.  
  786. return 0;
  787. }
  788.  
  789. double _cos( int angle ) {
  790. return _sin((angle+90)%360);
  791. }
  792.  
  793. void Delay( int ms) {
  794. int i;
  795. while(ms--){
  796. i=2600; //empirically determined fudge factor 16mhz
  797. while(i--);
  798. }
  799. }
  800.  
  801. /**
  802. * [(1 ,0 ,0),
  803. * (0 ,cos(a) ,-sin(a)),
  804. * (0 ,sin(a) ,cos(a))]
  805. * @param Vector3D
  806. * @param theta
  807. */
  808. Vector3D rotateX(int x, int y, int z, int theta) {
  809. Vector3D newv;
  810. newv.x = x;
  811. newv.y = y * _cos(theta) + z * -_sin(theta);
  812. newv.z = y * _sin(theta) + z * _cos(theta);
  813. return newv;
  814. }
  815.  
  816. /**
  817. * [(cos(a) ,0 ,sin(a)),
  818. * (0 ,1 ,0),
  819. * (-sin(a),0 ,cos(a))]
  820. * @param Vector3D
  821. * @param theta
  822. */
  823. Vector3D rotateY(Vector3D vector, int theta) {
  824. Vector3D newv;
  825. newv.x = vector.x * _cos(theta) + vector.z * _sin(theta);
  826. newv.y = vector.y;
  827. newv.z = vector.x * -_sin(theta) + vector.z * _cos(theta);
  828. return newv;
  829. }
  830.  
  831. /**
  832. * [(cos(a),-sin(a),0),
  833. * (sin(a),cos(a) ,0),
  834. * (0 ,0 ,1)]
  835. * @param Vector3D
  836. * @param theta
  837. */
  838. Vector3D rotateZ(Vector3D vector, int theta) {
  839. Vector3D newv;
  840. newv.x = vector.x * _cos(theta) + vector.y * -_sin(theta);
  841. newv.y = vector.x * _sin(theta) + vector.y * _cos(theta);
  842. newv.z = vector.z;
  843. return newv;
  844. }
  845.  
  846. // -----------------------------------------------------------------------------
  847. ScreenPoint RotateFace( int faceNum, int angleX, int angleY, int angleZ ) {
  848. ScreenPoint screenPoint;
  849. Vector3D v3D;
  850.  
  851. v3D = rotateX(pontos[(face[faceNum] * 3)] - xCenter, pontos[(face[faceNum] * 3) + 1] - yCenter, pontos[(face[faceNum] * 3) + 2], angleX);
  852. v3D = rotateY(v3D, angleY);
  853. v3D = rotateZ(v3D, angleZ);
  854.  
  855. screenPoint.x = ((viewFov * v3D.x) / (v3D.z - zAxis)) + xAxis;
  856. screenPoint.y = ((viewFov * v3D.y) / (v3D.z - zAxis)) + yAxis;
  857. screenPoint.z = (int)v3D.z;
  858. return screenPoint;
  859. }
  860.  
  861. void DrawScreen( void ) {
  862. Clear_Window(0x00,0x83,0x00,0x83);
  863. delay(10);
  864. }
  865. void DrawClipLine(int xwmin,int ywmin,int xwmax,int ywmax, int x1,int y1,int x2,int y2, unsigned short int col);
  866. void DrawLine(int X1, int Y1, int X2, int Y2, uint16_t col) ;
  867.  
  868. void DrawDemo( void ) {
  869. uint8_t x = 0;
  870. uint8_t x1,y1,x2,y2;
  871. ScreenPoint screenPointA, screenPointB;
  872.  
  873. Clear_Window(0x00,0x83,0x00,0x83);
  874. // delay(10);
  875.  
  876. thetaX = thetaX + rotSpeed;
  877.  
  878. if (thetaX > 360) thetaX = 0;
  879.  
  880. do {
  881. screenPointA = RotateFace( x, thetaX, thetaX, thetaX );
  882. x++;
  883. screenPointB = RotateFace( x, thetaX, thetaX, thetaX );
  884. x++;
  885. DrawClipLine(10,10,120,120,screenPointA.x,screenPointA.y,screenPointB.x,screenPointB.y, MAKECOLOR64k(rand(), rand(),rand()));
  886. //DrawLine(screenPointA.x,screenPointA.y,screenPointB.x,screenPointB.y, MAKECOLOR64k(rand(), rand(),rand()));
  887.  
  888. }
  889. while ( x < FACENUMBER );
  890. delay(1);
  891. }
  892.  
  893. static int clipTest(float p,float q,float *u1,float *u2)
  894. {
  895. int flag = 1;
  896. float r;
  897. if(p<0.0)
  898. {
  899. r=q/p;
  900. if(r>*u2)
  901. flag=0;
  902. else if(r>*u1)
  903. *u1=r;
  904. }
  905. else if(p>0.0)
  906. {
  907. r=q/p;
  908. if(r<*u1)
  909. flag=0;
  910. else if(r<*u2)
  911. *u2=r;
  912. }
  913. else if(q<0.0)
  914. flag=0;
  915. return(flag);
  916. }
  917.  
  918. void DrawClipLine(int xwmin,int ywmin,int xwmax,int ywmax, int x1,int y1,int x2,int y2, unsigned short int col)
  919. {
  920. float u1=0.0,u2=1.0,dx=x2-x1,dy;
  921.  
  922. if(clipTest(-dx,x1-xwmin,&u1,&u2))
  923. if(clipTest(dx,xwmax-x1,&u1,&u2))
  924. {
  925. dy=y2-y1;
  926. if(clipTest(-dy,y1-ywmin,&u1,&u2))
  927. if(clipTest(dy,ywmax-y1,&u1,&u2))
  928. {
  929. if(u2<1.0)
  930. {
  931. x2=x1+u2*dx;
  932. y2=y1+u2*dy;
  933. }
  934. if(u1>0.0)
  935. {
  936. x1=x1+u1*dx;
  937. y1=y1+u1*dy;
  938. }
  939.  
  940. if (x1>x2 ||y1>y2)
  941. DrawLine(x1,y1,x2,y2,col);
  942. else
  943. Draw_Line64k(x1,y1,x2,y2, col);
  944. }
  945. }
  946. }
  947.  
  948. #define DrawPoint Draw_Point64k_Slow
  949. /* Draw_line : algorithm by Jack Bresenham */
  950. void DrawLine(int X1, int Y1, int X2, int Y2, uint16_t col)
  951. {
  952. int dy;
  953. int dx;
  954. int StepX, StepY;
  955. int Fraction;
  956.  
  957. dy = Y2 - Y1;
  958. dx = X2 - X1;
  959.  
  960. if (dy < 0)
  961. {
  962. dy = -dy;
  963. StepY = -1;
  964. }
  965. else
  966. StepY = 1;
  967.  
  968. if (dx < 0)
  969. {
  970. dx = -dx;
  971. StepX = -1;
  972. }
  973. else
  974. StepX = 1;
  975.  
  976. dy <<= 1; // dy is now 2*dy
  977. dx <<= 1; // dx is now 2*dx
  978. DrawPoint( X1, Y1, col);
  979.  
  980. if (dx > dy)
  981. {
  982. Fraction = dy - (dx >> 1); // same as 2*dy - dx
  983. while (X1 != X2)
  984. {
  985. if (Fraction >= 0)
  986. {
  987. Y1 += StepY;
  988. Fraction -= dx; // same as fraction -= 2*dx
  989. }
  990.  
  991. X1 += StepX;
  992. Fraction += dy; // same as fraction -= 2*dy
  993. DrawPoint( X1, Y1, col);
  994. }
  995. }
  996. else
  997. {
  998. Fraction = dx - (dy >> 1);
  999. while (Y1 != Y2)
  1000. {
  1001. if (Fraction >= 0)
  1002. {
  1003. X1 += StepX;
  1004. Fraction -= dy;
  1005. }
  1006. Y1 += StepY;
  1007. Fraction += dx;
  1008. DrawPoint( X1, Y1, col);
  1009. }
  1010. }
  1011. }
  1012.  
  1013. } //extern "C" {
  1014.  
  1015. // -----------------------------------------------------------------------------
  1016.  
  1017.  
  1018. void setup() {
  1019. long i;
  1020. // set the digital pin as output:
  1021. pinMode(RST_PIN, OUTPUT);
  1022. pinMode(CS_PIN, OUTPUT);
  1023. pinMode(DC_PIN, OUTPUT);
  1024. pinMode(DIN_PIN, OUTPUT);
  1025. pinMode(CLK_PIN, OUTPUT);
  1026. pinMode(HVEN_PIN, OUTPUT);
  1027.  
  1028. OLED_HVEN_1; //+12V on
  1029. OLED_InitIOs();
  1030. OLED_Init();
  1031.  
  1032. Clear_Window(0x00,0x83,0x00,0x83);
  1033. delay(10);
  1034.  
  1035. while(1)
  1036. {
  1037. DrawDemo();
  1038. }
  1039.  
  1040. draw_lines();
  1041.  
  1042. Clear_Window(0x00,0x83,0x00,0x83);
  1043. delay(10);
  1044. draw_rects();
  1045.  
  1046. Clear_Window(0x00,0x83,0x00,0x83);
  1047. delay(10);
  1048. draw_circles();
  1049.  
  1050. Clear_Window(0x00,0x83,0x00,0x83);
  1051. delay(10);
  1052. draw_wheels();
  1053.  
  1054. // do filling color
  1055. Fill_Block64k(0x00,0x00,Max_Column,Max_Row,MAKECOLOR64k(0x00,0x00,0x00));
  1056. delay(500);
  1057. Fill_Block64k(0x00,0x00,Max_Column,Max_Row,MAKECOLOR64k(0xFF,0x00,0x00));
  1058. delay(500);
  1059. Fill_Block64k(0x00,0x00,Max_Column,Max_Row,MAKECOLOR64k(0x00,0xFF,0x00));
  1060. delay(500);
  1061. Fill_Block64k(0x00,0x00,Max_Column,Max_Row,MAKECOLOR64k(0x00,0x00,0xFF));
  1062. delay(500);
  1063. Fill_Block64k(0x00,0x00,Max_Column,Max_Row,MAKECOLOR64k(0xFF,0xFF,0x00));
  1064. delay(500);
  1065. Fill_Block64k(0x00,0x00,Max_Column,Max_Row,MAKECOLOR64k(0x00,0xFF,0xFF));
  1066. delay(500);
  1067. Fill_Block64k(0x00,0x00,Max_Column,Max_Row,MAKECOLOR64k(0xFF,0x00,0xFF));
  1068. delay(500);
  1069. Fill_Block64k(0x00,0x00,Max_Column,Max_Row,MAKECOLOR64k(0xFF,0xFF,0xFF));
  1070. delay(500);
  1071.  
  1072. Clear_Window(0x00,0x83,0x00,0x83);
  1073. delay(10);
  1074. Rainbow();
  1075. delay(500);
  1076. // show icon
  1077. Show_64k_Pattern_LittleEndia((unsigned char *)Icon24x24x64k,50,50,50+23,50+23);
  1078. }
  1079.  
  1080. // do put code in loop func
  1081. void loop()
  1082. {
  1083. while(1)
  1084. {
  1085. }
  1086. }
Advertisement
Add Comment
Please, Sign In to add comment
Public Pastes
We use cookies for various purposes including analytics. By continuing to use Pastebin, you agree to our use of cookies as described in the Cookies Policy.  OK, I Understand
Not a member of Pastebin yet?
Sign Up, it unlocks many cool features!