debug.c 4.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227
  1. #include <string.h>
  2. #include <stdarg.h>
  3. #include <stdio.h>
  4. #include <fcntl.h>
  5. #include "debug.h"
  6. #include "data.h"
  7. #include "pad.h"
  8. #include "PPU.h"
  9. #include "ressource.h"
  10. #define DEBUG_BUFFER_SIZE 256
  11. word debug_map[0x400];
  12. char debug_buffer[DEBUG_BUFFER_SIZE];
  13. //char screen_buffer[DEBUG_BUFFER_SIZE];
  14. void debug_init(void)
  15. {
  16. memset(debug_map, 0, 0x800);
  17. memset(debug_buffer, 0,DEBUG_BUFFER_SIZE);
  18. #if 0
  19. memset(screen_buffer, 0, DEBUG_BUFFER_SIZE);
  20. printfc("screen_buffer=%p\n",screen_buffer);
  21. printfc("debug_buffer=%p\n",debug_buffer);
  22. printfc("debug_map=%p\n",debug_map);
  23. #endif
  24. }
  25. void debug_enable(void)
  26. {
  27. VRAMLoad((word) debugFont_pic, 0x5000, 2048);
  28. VRAMLoad((word) debug_map, 0x4000, 0x0800);
  29. setTileMapLocation(0x4000, (byte) 0x00, (byte) 0);
  30. setCharacterLocation(0x5000, (byte) 0);
  31. *(byte *) 0x2100 = 0x0f; // enable background
  32. // Font Color
  33. // hex(24 << 10 | 24 << 5 | 24 ) = '0x6318'
  34. *(byte *) 0x2121 = 0x02;
  35. *(byte *) 0x2122 = 0xff;
  36. *(byte *) 0x2122 = 0x7f;
  37. // Font Border Color
  38. *(byte *) 0x2121 = 0x00;
  39. *(byte *) 0x2122 = 0x00;
  40. *(byte *) 0x2122 = 0x00;
  41. // Background Color
  42. *(byte *) 0x2121 = 0x01;
  43. *(byte *) 0x2122 = 0x05;
  44. *(byte *) 0x2122 = 0x29;
  45. }
  46. void clears(void)
  47. {
  48. word i, y;
  49. for (y = 0; y < 28; y++) {
  50. waitForVBlank();
  51. for (i = 0; i < 32; i++) {
  52. *(byte *) 0x2115 = 0x80;
  53. *(word *) 0x2116 = 0x4000 + i + (y * 0x20);
  54. *(byte *) 0x2118 = 0;
  55. }
  56. }
  57. }
  58. void _print_char(word y, word x, char c)
  59. {
  60. waitForVBlank();
  61. VRAMByteWrite((byte) (c - 32), (word) (0x4000 + x + (y * 0x20)));
  62. }
  63. void _print_screen(word y, char *buffer)
  64. {
  65. char l;
  66. unsigned int x;
  67. x = y * 0x20;
  68. l = strlen(buffer);
  69. waitForVBlank();
  70. while (*buffer) {
  71. if (*buffer == '\n') {
  72. while (x++ < 32) {
  73. *(byte *) 0x2115 = 0x80;
  74. *(word *) 0x2116 = 0x4000 + x + (y * 0x20);
  75. *(byte *) 0x2118 = 0;
  76. }
  77. y ++;
  78. x = y * 0x20;
  79. buffer++;
  80. waitForVBlank();
  81. continue;
  82. }
  83. *(byte *) 0x2115 = 0x80;
  84. *(word *) 0x2116 = 0x4000 + x;
  85. *(byte *) 0x2118 = *buffer - 32;
  86. x++;
  87. buffer++;
  88. #if 0
  89. waitForVBlank();
  90. #endif
  91. }
  92. }
  93. void _print_console(const char *buffer)
  94. {
  95. while (*buffer)
  96. *(byte *) 0x3000 = *buffer++;
  97. }
  98. void printfc(const char *fmt, ...)
  99. {
  100. va_list ap;
  101. va_start(ap, fmt);
  102. vsprintf(debug_buffer, fmt, ap);
  103. va_end(ap);
  104. _print_console(debug_buffer);
  105. //memset(debug_buffer, 0, DEBUG_BUFFER_SIZE);
  106. }
  107. void printfs(word y, const char *fmt, ...)
  108. {
  109. va_list ap;
  110. va_start(ap, fmt);
  111. vsprintf(debug_buffer, fmt, ap);
  112. va_end(ap);
  113. _print_screen(y, debug_buffer);
  114. //memset(debug_buffer, 0, DEBUG_BUFFER_SIZE);
  115. //memset(screen_buffer, 0, DEBUG_BUFFER_SIZE);
  116. }
  117. void printc_packet(unsigned long addr, unsigned int len, byte * packet)
  118. {
  119. unsigned int i, j;
  120. unsigned int sum = 0;
  121. unsigned int clear = 0;
  122. for (i = 0; i < len; i += 16) {
  123. sum = 0;
  124. for (j = 0; j < 16; j++) {
  125. sum += packet[i + j];
  126. }
  127. if (!sum) {
  128. clear = 1;
  129. continue;
  130. }
  131. if (clear) {
  132. printfc("*\n");
  133. clear = 0;
  134. }
  135. printfc("%06lX:", addr + i);
  136. for (j = 0; j < 16; j++) {
  137. printfc(" %x", packet[i + j]);
  138. }
  139. printfc(" |");
  140. for (j = 0; j < 16; j++) {
  141. if (packet[i + j] >= 33 && packet[i + j] <= 126)
  142. printfc("%c", packet[i + j]);
  143. else
  144. printfc(".");
  145. }
  146. printfc("|\n");
  147. }
  148. }
  149. /*
  150. * keep the linker happy
  151. */
  152. int open(const char *_name, int _mode)
  153. {
  154. _print_console("open called\n");
  155. return -1;
  156. }
  157. int close(int fd)
  158. {
  159. _print_console("close called\n");
  160. return -1;
  161. }
  162. size_t read(int fd, void *buff, size_t len)
  163. {
  164. _print_console("read called\n");
  165. return 0;
  166. }
  167. size_t write(int fd, void *buffer, size_t len)
  168. {
  169. _print_console("write called\n");
  170. return 0;
  171. }
  172. long lseek(int fd, long off, int count)
  173. {
  174. _print_console("lseek called\n");
  175. return 0;
  176. }
  177. int unlink(const char *name)
  178. {
  179. _print_console("unlink called\n");
  180. return -1;
  181. }
  182. int isatty()
  183. {
  184. _print_console("isatty called\n");
  185. return 1;
  186. }