1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239
|
//****************************************************************************
//**
//** [FILE NAME]
//** - [FILE DESCRIPTION]
//**
//****************************************************************************
//============================================================================
// IMPLEMENTATION HEADERS
//============================================================================
#include <stdarg.h>
#include <string.h>
#include "DebugDisplay.h"
//============================================================================
// IMPLEMENTATION PRIVATE DEFINITIONS / ENUMERATIONS / SIMPLE TYPEDEFS
//============================================================================
//============================================================================
// IMPLEMENTATION PRIVATE CLASS PROTOTYPES / EXTERNAL CLASS REFERENCES
//============================================================================
//============================================================================
// IMPLEMENTATION PRIVATE STRUCTURES / UTILITY CLASSES
//============================================================================
//============================================================================
// IMPLEMENTATION REQUIRED EXTERNAL REFERENCES (AVOID)
//============================================================================
//============================================================================
// IMPLEMENTATION PRIVATE DATA
//============================================================================
// Note: Some systems may require 0xB0000 Instead of 0xB8000
// We dont care for portability here, so pick either one
#define VID_MEMORY 0xB8000
// these vectors together act as a corner of a bounding rect
// This allows GotoXY() to reposition all the text that follows it
static unsigned int _xPos=0, _yPos=0;
static unsigned _startX=0, _startY=0;
// current color
static unsigned _color=0;
//============================================================================
// INTERFACE DATA
//============================================================================
//============================================================================
// IMPLEMENTATION PRIVATE FUNCTION PROTOTYPES
//============================================================================
//============================================================================
// IMPLEMENTATION PRIVATE FUNCTIONS
//============================================================================
#ifdef _MSC_VER
#pragma warning (disable:4244)
#endif
void DebugPutc (unsigned char c) {
if (c==0)
return;
if (c == '\n'||c=='\r') { /* start new line */
_yPos+=2;
_xPos=_startX;
return;
}
if (_xPos > 79) { /* start new line */
_yPos+=2;
_xPos=_startX;
return;
}
/* draw the character */
unsigned char* p = (unsigned char*)VID_MEMORY + (_xPos++)*2 + _yPos * 80;
*p++ = c;
*p =_color;
}
char tbuf[32];
char bchars[] = {'0','1','2','3','4','5','6','7','8','9','A','B','C','D','E','F'};
void itoa(unsigned i,unsigned base,char* buf) {
int pos = 0;
int opos = 0;
int top = 0;
if (i == 0 || base > 16) {
buf[0] = '0';
buf[1] = '\0';
return;
}
while (i != 0) {
tbuf[pos] = bchars[i % base];
pos++;
i /= base;
}
top=pos--;
for (opos=0; opos<top; pos--,opos++) {
buf[opos] = tbuf[pos];
}
buf[opos] = 0;
}
void itoa_s(int i,unsigned base,char* buf) {
if (base > 16) return;
if (i < 0) {
*buf++ = '-';
i *= -1;
}
itoa(i,base,buf);
}
//============================================================================
// INTERFACE FUNCTIONS
//============================================================================
unsigned DebugSetColor (const unsigned c) {
unsigned t=_color;
_color=c;
return t;
}
void DebugGotoXY (unsigned x, unsigned y) {
// reposition starting vectors for next text to follow
// multiply by 2 do to the video modes 2byte per character layout
_xPos = x*2;
_yPos = y*2;
_startX=_xPos;
_startY=_yPos;
}
void DebugClrScr (const unsigned short c) {
unsigned char* p = (unsigned char*)VID_MEMORY;
for (int i=0; i<160*30; i+=2) {
p[i] = ' '; /* Need to watch out for MSVC++ optomization memset() call */
p[i+1] = c;
}
// go to start of previous set vector
_xPos=_startX;_yPos=_startY;
}
void DebugPuts (char* str) {
if (!str)
return;
for (size_t i=0; i<strlen (str); i++)
DebugPutc (str[i]);
}
int DebugPrintf (const char* str, ...) {
if(!str)
return 0;
va_list args;
va_start (args, str);
for (size_t i=0; i<strlen(str);i++) {
switch (str[i]) {
case '%':
switch (str[i+1]) {
/*** characters ***/
case 'c': {
char c = va_arg (args, char);
DebugPutc (c);
i++; // go to next character
break;
}
/*** address of ***/
case 's': {
int c = (int&) va_arg (args, char);
char str[32]={0};
itoa_s (c, 16, str);
DebugPuts (str);
i++; // go to next character
break;
}
/*** integers ***/
case 'd':
case 'i': {
int c = va_arg (args, int);
char str[32]={0};
itoa_s (c, 10, str);
DebugPuts (str);
i++; // go to next character
break;
}
/*** display in hex ***/
case 'X':
case 'x': {
int c = va_arg (args, int);
char str[32]={0};
itoa_s (c,16,str);
DebugPuts (str);
i++; // go to next character
break;
}
default:
va_end (args);
return 1;
}
break;
default:
DebugPutc (str[i]);
break;
}
}
va_end (args);
}
//============================================================================
// INTERFACE CLASS BODIES
//============================================================================
//****************************************************************************
//**
//** END[DebugDisplay.cpp]
//**
//****************************************************************************
|