WebSVN – Kolibri OS – Diff – /drivers/fdo.inc


;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;;                                                              ;;
;; Copyright (C) KolibriOS team 2004-2007. All rights reserved. ;;
;; Distributed under terms of the GNU General Public License    ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 
 
;
; Formatted Debug Output (FDO)
; Copyright (c) 2005-2006, mike.dld
; Created: 2005-01-29, Changed: 2006-11-10
;
; For questions and bug reports, mail to mike.dld@gmail.com
;
; Available format specifiers are: %s, %d, %u, %x (with partial width support)
;
 
; to be defined:
;   __DEBUG__ equ 1
;   __DEBUG_LEVEL__ equ 5
 
macro debug_func name {
 if used name
  name@of@func equ name
}
 
macro debug_beginf {
 align 4
 name@of@func:
}
 
debug_endf fix end if
 
macro DEBUGS _sign,[_str] {
 common
  local tp
  tp equ 0
  match _arg:_num,_str \{
   DEBUGS_N _sign,_num,_arg
   tp equ 1
  \}
  match =0 _arg,tp _str \{
   DEBUGS_N _sign,,_arg
  \}
}
 
macro DEBUGS_N _sign,_num,[_str] {
 common
  pushf
  pushad
  local ..str,..label,is_str
  is_str = 0
 forward
  if _str eqtype ''
   is_str = 1
  end if
 common
  if is_str = 1
   jmp ..label
   ..str db _str,0
   ..label:
   add	esp,4*8+4
   mov	edx,..str
   sub	esp,4*8+4
  else
   mov	edx,_str
  end if
  if ~_num eq
   if _num eqtype eax
    if _num in 
     mov esi,_num
    else if ~_num eq esi
     movzx esi,_num
    end if
   else if _num eqtype 0
    mov esi,_num
   else
    local tp
    tp equ 0
    match [_arg],_num \{
     mov esi,dword[_arg]
     tp equ 1
    \}
    match =0 =dword[_arg],tp _num \{
     mov esi,dword[_arg]
     tp equ 1
    \}
    match =0 =word[_arg],tp _num \{
     movzx esi,word[_arg]
     tp equ 1
    \}
    match =0 =byte[_arg],tp _num \{
     movzx esi,byte[_arg]
     tp equ 1
    \}
    match =0,tp \{
     'Error: specified string width is incorrect'
    \}
   end if
  else
   mov esi,0x7FFFFFFF
  end if
  call fdo_debug_outstr
  popad
  popf
}
 
macro DEBUGD _sign,_dec {
 local tp
 tp equ 0
 match _arg:_num,_dec \{
  DEBUGD_N _sign,_num,_arg
  tp equ 1
 \}
 match =0 _arg,tp _dec \{
  DEBUGD_N _sign,,_arg
 \}
}
 
macro DEBUGD_N _sign,_num,_dec {
 pushf
 pushad
 if (~_num eq)
  if (_dec eqtype eax | _dec eqtype 0)
   'Error: precision allowed only for in-memory variables'
  end if
  if (~_num in <1,2,4>)
   if _sign
    'Error: 1, 2 and 4 are only allowed for precision in %d'
   else
    'Error: 1, 2 and 4 are only allowed for precision in %u'
   end if
  end if
 end if
 if _dec eqtype eax
  if _dec in 
   mov eax,_dec
  else if ~_dec eq eax
   if _sign = 1
    movsx eax,_dec
   else
    movzx eax,_dec
   end if
  end if
 else if _dec eqtype 0
  mov eax,_dec
 else
  add esp,4*8+4
  if _num eq
   mov eax,dword _dec
  else if _num = 1
   if _sign = 1
    movsx eax,byte _dec
   else
    movzx eax,byte _dec
   end if
  else if _num = 2
   if _sign = 1
    movsx eax,word _dec
   else
    movzx eax,word _dec
   end if
  else
   mov eax,dword _dec
  end if
  sub esp,4*8+4
 end if
 mov cl,_sign
 call fdo_debug_outdec
 popad
 popf
}
 
macro DEBUGH _sign,_hex {
 local tp
 tp equ 0
 match _arg:_num,_hex \{
  DEBUGH_N _sign,_num,_arg
  tp equ 1
 \}
 match =0 _arg,tp _hex \{
  DEBUGH_N _sign,,_arg
 \}
}
 
macro DEBUGH_N _sign,_num,_hex {
 pushf
 pushad
 if (~_num eq) & (~_num in <1,2,3,4,5,6,7,8>)
  'Error: 1..8 are only allowed for precision in %x'
 end if
 if _hex eqtype eax
  if _hex in 
   if ~_hex eq eax
    mov eax,_hex
   end if
   mov edx,8
  else if _hex in 
   if ~_hex eq ax
    movzx eax,_hex
   end if
   if (_num eq)
    mov edx,4
   end if
  else if _hex in 
   if ~_hex eq al
    movzx eax,_hex
   end if
   if (_num eq)
    mov edx,2
   end if
  end if
 else if _hex eqtype 0
  mov eax,_hex
 else
  add esp,4*8+4
  mov eax,dword _hex
  sub esp,4*8+4
 end if
 if ~_num eq
  mov edx,_num
 else
  if ~_hex eqtype eax
   mov edx,8
  end if
 end if
 call fdo_debug_outhex
 popad
 popf
}
 
;-----------------------------------------------------------------------------
 
debug_func fdo_debug_outchar
debug_beginf
	pushad
	movzx	ecx,al
	mov	ebx,1
;        mov     ecx,sys_msg_board
;        call    ecx ; sys_msg_board
	stdcall  SysMsgBoard
	popad
	ret
debug_endf
 
debug_func fdo_debug_outstr
debug_beginf
	mov	ebx,1
  .l1:	dec	esi
	js	.l2
	movzx	ecx,byte[edx]
	or	cl,cl
	jz	.l2
;        mov     ecx,sys_msg_board
;        call    ecx ; sys_msg_board
	stdcall  SysMsgBoard
	inc	edx
	jmp	.l1
  .l2:	ret
debug_endf
 
debug_func fdo_debug_outdec
debug_beginf
	or	cl,cl
	jz	@f
	or	eax,eax
	jns	@f
	neg	eax
	push	eax
	mov	al,'-'
	call	fdo_debug_outchar
	pop	eax
    @@: push	10
	pop	ecx
	push	-'0'
  .l1:	xor	edx,edx
	div	ecx
	push	edx
	test	eax,eax
	jnz	.l1
  .l2:	pop	eax
	add	al,'0'
	jz	.l3
	call	fdo_debug_outchar
	jmp	.l2
  .l3:	ret
debug_endf
 
debug_func fdo_debug_outhex
  __fdo_hexdigits db '0123456789ABCDEF'
debug_beginf
	mov	cl,dl
	neg	cl
	add	cl,8
	shl	cl,2
	rol	eax,cl
  .l1:	rol	eax,4
	push	eax
	and	eax,0x0000000F
	mov	al,[__fdo_hexdigits+eax]
	call	fdo_debug_outchar
	pop	eax
	dec	edx
	jnz	.l1
	ret
debug_endf
 
;-----------------------------------------------------------------------------
 
macro DEBUGF _level,_format,[_arg] {
 common
 if __DEBUG__ = 1 & _level >= __DEBUG_LEVEL__
  local ..f1,f2,a1,a2,c1,c2,c3,..lbl
  _debug_str_ equ __debug_str_ # a1
  a1 = 0
  c2 = 0
  c3 = 0
  f2 = 0
  repeat ..lbl-..f1
   virtual at 0
    db _format,0,0
    load c1 word from %-1
   end virtual
   if c1 = '%s'
    virtual at 0
     db _format,0,0
     store word 0 at %-1
     load c1 from f2-c2
    end virtual
    if c1 <> 0
     DEBUGS 0,_debug_str_+f2-c2
    end if
    c2 = c2 + 1
    f2 = %+1
    DEBUGF_HELPER S,a1,0,_arg
   else if c1 = '%x'
    virtual at 0
     db _format,0,0
     store word 0 at %-1
     load c1 from f2-c2
    end virtual
    if c1 <> 0
     DEBUGS 0,_debug_str_+f2-c2
    end if
    c2 = c2 + 1
    f2 = %+1
    DEBUGF_HELPER H,a1,0,_arg
   else if c1 = '%d' | c1 = '%u'
    local c4
    if c1 = '%d'
     c4 = 1
    else
     c4 = 0
    end if
    virtual at 0
     db _format,0,0
     store word 0 at %-1
     load c1 from f2-c2
    end virtual
    if c1 <> 0
     DEBUGS 0,_debug_str_+f2-c2
    end if
    c2 = c2 + 1
    f2 = %+1
    DEBUGF_HELPER D,a1,c4,_arg
   else if c1 = '\n'
    c3 = c3 + 1
   end if
  end repeat
  virtual at 0
   db _format,0,0
   load c1 from f2-c2
  end virtual
  if (c1<>0)&(f2<>..lbl-..f1-1)
   DEBUGS 0,_debug_str_+f2-c2
  end if
  virtual at 0
   ..f1 db _format,0
   ..lbl:
   __debug_strings equ __debug_strings,_debug_str_,<_format>,..lbl-..f1-1-c2-c3
  end virtual
 end if
}
 
macro __include_debug_strings dummy,[_id,_fmt,_len] {
 common
  local c1,a1,a2
 forward
  if defined _len & ~_len eq
   _id:
   a1 = 0
   a2 = 0
   repeat _len
    virtual at 0
     db _fmt,0,0
     load c1 word from %+a2-1
    end virtual
    if (c1='%s')|(c1='%x')|(c1='%d')|(c1='%u')
     db 0
     a2 = a2 + 1
    else if (c1='\n')
     dw $0A0D
     a1 = a1 + 1
     a2 = a2 + 1
    else
     db c1 and 0x0FF
    end if
   end repeat
   db 0
  end if
}
 
macro DEBUGF_HELPER _letter,_num,_sign,[_arg] {
 common
  local num
  num = 0
 forward
  if num = _num
   DEBUG#_letter _sign,_arg
  end if
  num = num+1
 common
  _num = _num+1
}
 
macro include_debug_strings {
 if __DEBUG__ = 1
  match dbg_str,__debug_strings \{
   __include_debug_strings dbg_str
  \}
 end if
}

Rev 3545	Rev 3614
1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
2	;; ;;	2	;; ;;
3	;; Copyright (C) KolibriOS team 2004-2007. All rights reserved. ;;	3	;; Copyright (C) KolibriOS team 2004-2007. All rights reserved. ;;
4	;; Distributed under terms of the GNU General Public License ;;	4	;; Distributed under terms of the GNU General Public License ;;
5	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;	5	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
6		6
7		7
8	;	8	;
9	; Formatted Debug Output (FDO)	9	; Formatted Debug Output (FDO)
10	; Copyright (c) 2005-2006, mike.dld	10	; Copyright (c) 2005-2006, mike.dld
11	; Created: 2005-01-29, Changed: 2006-11-10	11	; Created: 2005-01-29, Changed: 2006-11-10
12	;	12	;
13	; For questions and bug reports, mail to mike.dld@gmail.com	13	; For questions and bug reports, mail to mike.dld@gmail.com
14	;	14	;
15	; Available format specifiers are: %s, %d, %u, %x (with partial width support)	15	; Available format specifiers are: %s, %d, %u, %x (with partial width support)
16	;	16	;
17		17
18	; to be defined:	18	; to be defined:
19	; __DEBUG__ equ 1	19	; __DEBUG__ equ 1
20	; __DEBUG_LEVEL__ equ 5	20	; __DEBUG_LEVEL__ equ 5
21		21
22	macro debug_func name {	22	macro debug_func name {
23	if used name	23	if used name
24	name@of@func equ name	24	name@of@func equ name
25	}	25	}
26		26
27	macro debug_beginf {	27	macro debug_beginf {
28	align 4	28	align 4
29	name@of@func:	29	name@of@func:
30	}	30	}
31		31
32	debug_endf fix end if	32	debug_endf fix end if
33		33
34	macro DEBUGS _sign,[_str] {	34	macro DEBUGS _sign,[_str] {
35	common	35	common
36	local tp	36	local tp
37	tp equ 0	37	tp equ 0
38	match _arg:_num,_str \{	38	match _arg:_num,_str \{
39	DEBUGS_N _sign,_num,_arg	39	DEBUGS_N _sign,_num,_arg
40	tp equ 1	40	tp equ 1
41	\}	41	\}
42	match =0 _arg,tp _str \{	42	match =0 _arg,tp _str \{
43	DEBUGS_N _sign,,_arg	43	DEBUGS_N _sign,,_arg
44	\}	44	\}
45	}	45	}
46		46
47	macro DEBUGS_N _sign,_num,[_str] {	47	macro DEBUGS_N _sign,_num,[_str] {
48	common	48	common
49	pushf	49	pushf
50	pushad	50	pushad
51	local ..str,..label,is_str	51	local ..str,..label,is_str
52	is_str = 0	52	is_str = 0
53	forward	53	forward
54	if _str eqtype ''	54	if _str eqtype ''
55	is_str = 1	55	is_str = 1
56	end if	56	end if
57	common	57	common
58	if is_str = 1	58	if is_str = 1
59	jmp ..label	59	jmp ..label
60	..str db _str,0	60	..str db _str,0
61	..label:	61	..label:
62	add esp,4*8+4	62	add esp,4*8+4
63	mov edx,..str	63	mov edx,..str
64	sub esp,4*8+4	64	sub esp,4*8+4
65	else	65	else
66	mov edx,_str	66	mov edx,_str
67	end if	67	end if
68	if ~_num eq	68	if ~_num eq
69	if _num eqtype eax	69	if _num eqtype eax
70	if _num in	70	if _num in
71	mov esi,_num	71	mov esi,_num
72	else if ~_num eq esi	72	else if ~_num eq esi
73	movzx esi,_num	73	movzx esi,_num
74	end if	74	end if
75	else if _num eqtype 0	75	else if _num eqtype 0
76	mov esi,_num	76	mov esi,_num
77	else	77	else
78	local tp	78	local tp
79	tp equ 0	79	tp equ 0
80	match [_arg],_num \{	80	match [_arg],_num \{
81	mov esi,dword[_arg]	81	mov esi,dword[_arg]
82	tp equ 1	82	tp equ 1
83	\}	83	\}
84	match =0 =dword[_arg],tp _num \{	84	match =0 =dword[_arg],tp _num \{
85	mov esi,dword[_arg]	85	mov esi,dword[_arg]
86	tp equ 1	86	tp equ 1
87	\}	87	\}
88	match =0 =word[_arg],tp _num \{	88	match =0 =word[_arg],tp _num \{
89	movzx esi,word[_arg]	89	movzx esi,word[_arg]
90	tp equ 1	90	tp equ 1
91	\}	91	\}
92	match =0 =byte[_arg],tp _num \{	92	match =0 =byte[_arg],tp _num \{
93	movzx esi,byte[_arg]	93	movzx esi,byte[_arg]
94	tp equ 1	94	tp equ 1
95	\}	95	\}
96	match =0,tp \{	96	match =0,tp \{
97	'Error: specified string width is incorrect'	97	'Error: specified string width is incorrect'
98	\}	98	\}
99	end if	99	end if
100	else	100	else
101	mov esi,0x7FFFFFFF	101	mov esi,0x7FFFFFFF
102	end if	102	end if
103	call fdo_debug_outstr	103	call fdo_debug_outstr
104	popad	104	popad
105	popf	105	popf
106	}	106	}
107		107
108	macro DEBUGD _sign,_dec {	108	macro DEBUGD _sign,_dec {
109	local tp	109	local tp
110	tp equ 0	110	tp equ 0
111	match _arg:_num,_dec \{	111	match _arg:_num,_dec \{
112	DEBUGD_N _sign,_num,_arg	112	DEBUGD_N _sign,_num,_arg
113	tp equ 1	113	tp equ 1
114	\}	114	\}
115	match =0 _arg,tp _dec \{	115	match =0 _arg,tp _dec \{
116	DEBUGD_N _sign,,_arg	116	DEBUGD_N _sign,,_arg
117	\}	117	\}
118	}	118	}
119		119
120	macro DEBUGD_N _sign,_num,_dec {	120	macro DEBUGD_N _sign,_num,_dec {
121	pushf	121	pushf
122	pushad	122	pushad
123	if (~_num eq)	123	if (~_num eq)
124	if (_dec eqtype eax \| _dec eqtype 0)	124	if (_dec eqtype eax \| _dec eqtype 0)
125	'Error: precision allowed only for in-memory variables'	125	'Error: precision allowed only for in-memory variables'
126	end if	126	end if
127	if (~_num in <1,2,4>)	127	if (~_num in <1,2,4>)
128	if _sign	128	if _sign
129	'Error: 1, 2 and 4 are only allowed for precision in %d'	129	'Error: 1, 2 and 4 are only allowed for precision in %d'
130	else	130	else
131	'Error: 1, 2 and 4 are only allowed for precision in %u'	131	'Error: 1, 2 and 4 are only allowed for precision in %u'
132	end if	132	end if
133	end if	133	end if
134	end if	134	end if
135	if _dec eqtype eax	135	if _dec eqtype eax
136	if _dec in	136	if _dec in
137	mov eax,_dec	137	mov eax,_dec
138	else if ~_dec eq eax	138	else if ~_dec eq eax
139	if _sign = 1	139	if _sign = 1
140	movsx eax,_dec	140	movsx eax,_dec
141	else	141	else
142	movzx eax,_dec	142	movzx eax,_dec
143	end if	143	end if
144	end if	144	end if
145	else if _dec eqtype 0	145	else if _dec eqtype 0
146	mov eax,_dec	146	mov eax,_dec
147	else	147	else
148	add esp,4*8+4	148	add esp,4*8+4
149	if _num eq	149	if _num eq
150	mov eax,dword _dec	150	mov eax,dword _dec
151	else if _num = 1	151	else if _num = 1
152	if _sign = 1	152	if _sign = 1
153	movsx eax,byte _dec	153	movsx eax,byte _dec
154	else	154	else
155	movzx eax,byte _dec	155	movzx eax,byte _dec
156	end if	156	end if
157	else if _num = 2	157	else if _num = 2
158	if _sign = 1	158	if _sign = 1
159	movsx eax,word _dec	159	movsx eax,word _dec
160	else	160	else
161	movzx eax,word _dec	161	movzx eax,word _dec
162	end if	162	end if
163	else	163	else
164	mov eax,dword _dec	164	mov eax,dword _dec
165	end if	165	end if
166	sub esp,4*8+4	166	sub esp,4*8+4
167	end if	167	end if
168	mov cl,_sign	168	mov cl,_sign
169	call fdo_debug_outdec	169	call fdo_debug_outdec
170	popad	170	popad
171	popf	171	popf
172	}	172	}
173		173
174	macro DEBUGH _sign,_hex {	174	macro DEBUGH _sign,_hex {
175	local tp	175	local tp
176	tp equ 0	176	tp equ 0
177	match _arg:_num,_hex \{	177	match _arg:_num,_hex \{
178	DEBUGH_N _sign,_num,_arg	178	DEBUGH_N _sign,_num,_arg
179	tp equ 1	179	tp equ 1
180	\}	180	\}
181	match =0 _arg,tp _hex \{	181	match =0 _arg,tp _hex \{
182	DEBUGH_N _sign,,_arg	182	DEBUGH_N _sign,,_arg
183	\}	183	\}
184	}	184	}
185		185
186	macro DEBUGH_N _sign,_num,_hex {	186	macro DEBUGH_N _sign,_num,_hex {
187	pushf	187	pushf
188	pushad	188	pushad
189	if (~_num eq) & (~_num in <1,2,3,4,5,6,7,8>)	189	if (~_num eq) & (~_num in <1,2,3,4,5,6,7,8>)
190	'Error: 1..8 are only allowed for precision in %x'	190	'Error: 1..8 are only allowed for precision in %x'
191	end if	191	end if
192	if _hex eqtype eax	192	if _hex eqtype eax
193	if _hex in	193	if _hex in
194	if ~_hex eq eax	194	if ~_hex eq eax
195	mov eax,_hex	195	mov eax,_hex
196	end if	196	end if
197	mov edx,8	197	mov edx,8
198	else if _hex in	198	else if _hex in
199	if ~_hex eq ax	199	if ~_hex eq ax
200	movzx eax,_hex	200	movzx eax,_hex
201	end if	201	end if
202	if (_num eq)	202	if (_num eq)
203	mov edx,4	203	mov edx,4
204	end if	204	end if
205	else if _hex in	205	else if _hex in
206	if ~_hex eq al	206	if ~_hex eq al
207	movzx eax,_hex	207	movzx eax,_hex
208	end if	208	end if
209	if (_num eq)	209	if (_num eq)
210	mov edx,2	210	mov edx,2
211	end if	211	end if
212	end if	212	end if
213	else if _hex eqtype 0	213	else if _hex eqtype 0
214	mov eax,_hex	214	mov eax,_hex
215	else	215	else
216	add esp,4*8+4	216	add esp,4*8+4
217	mov eax,dword _hex	217	mov eax,dword _hex
218	sub esp,4*8+4	218	sub esp,4*8+4
219	end if	219	end if
220	if ~_num eq	220	if ~_num eq
221	mov edx,_num	221	mov edx,_num
222	else	222	else
223	if ~_hex eqtype eax	223	if ~_hex eqtype eax
224	mov edx,8	224	mov edx,8
225	end if	225	end if
226	end if	226	end if
227	call fdo_debug_outhex	227	call fdo_debug_outhex
228	popad	228	popad
229	popf	229	popf
230	}	230	}
231		231
232	;-----------------------------------------------------------------------------	232	;-----------------------------------------------------------------------------
233		233
234	debug_func fdo_debug_outchar	234	debug_func fdo_debug_outchar
235	debug_beginf	235	debug_beginf
236	pushad	236	pushad
237	movzx ebx,al	237	movzx ecx,al
238	mov eax,1	238	mov ebx,1
239	; mov ecx,sys_msg_board	239	; mov ecx,sys_msg_board
240	; call ecx ; sys_msg_board	240	; call ecx ; sys_msg_board
241	stdcall SysMsgBoardChar	241	stdcall SysMsgBoard
242	popad	242	popad
243	ret	243	ret
244	debug_endf	244	debug_endf
245		245
246	debug_func fdo_debug_outstr	246	debug_func fdo_debug_outstr
247	debug_beginf	247	debug_beginf
248	mov eax,1	248	mov ebx,1
249	.l1: dec esi	249	.l1: dec esi
250	js .l2	250	js .l2
251	movzx ebx,byte[edx]	251	movzx ecx,byte[edx]
252	or bl,bl	252	or cl,cl
253	jz .l2	253	jz .l2
254	; mov ecx,sys_msg_board	254	; mov ecx,sys_msg_board
255	; call ecx ; sys_msg_board	255	; call ecx ; sys_msg_board
256	stdcall SysMsgBoardChar	256	stdcall SysMsgBoard
257	inc edx	257	inc edx
258	jmp .l1	258	jmp .l1
259	.l2: ret	259	.l2: ret
260	debug_endf	260	debug_endf
261		261
262	debug_func fdo_debug_outdec	262	debug_func fdo_debug_outdec
263	debug_beginf	263	debug_beginf
264	or cl,cl	264	or cl,cl
265	jz @f	265	jz @f
266	or eax,eax	266	or eax,eax
267	jns @f	267	jns @f
268	neg eax	268	neg eax
269	push eax	269	push eax
270	mov al,'-'	270	mov al,'-'
271	call fdo_debug_outchar	271	call fdo_debug_outchar
272	pop eax	272	pop eax
273	@@: push 10	273	@@: push 10
274	pop ecx	274	pop ecx
275	push -'0'	275	push -'0'
276	.l1: xor edx,edx	276	.l1: xor edx,edx
277	div ecx	277	div ecx
278	push edx	278	push edx
279	test eax,eax	279	test eax,eax
280	jnz .l1	280	jnz .l1
281	.l2: pop eax	281	.l2: pop eax
282	add al,'0'	282	add al,'0'
283	jz .l3	283	jz .l3
284	call fdo_debug_outchar	284	call fdo_debug_outchar
285	jmp .l2	285	jmp .l2
286	.l3: ret	286	.l3: ret
287	debug_endf	287	debug_endf
288		288
289	debug_func fdo_debug_outhex	289	debug_func fdo_debug_outhex
290	__fdo_hexdigits db '0123456789ABCDEF'	290	__fdo_hexdigits db '0123456789ABCDEF'
291	debug_beginf	291	debug_beginf
292	mov cl,dl	292	mov cl,dl
293	neg cl	293	neg cl
294	add cl,8	294	add cl,8
295	shl cl,2	295	shl cl,2
296	rol eax,cl	296	rol eax,cl
297	.l1: rol eax,4	297	.l1: rol eax,4
298	push eax	298	push eax
299	and eax,0x0000000F	299	and eax,0x0000000F
300	mov al,[__fdo_hexdigits+eax]	300	mov al,[__fdo_hexdigits+eax]
301	call fdo_debug_outchar	301	call fdo_debug_outchar
302	pop eax	302	pop eax
303	dec edx	303	dec edx
304	jnz .l1	304	jnz .l1
305	ret	305	ret
306	debug_endf	306	debug_endf
307		307
308	;-----------------------------------------------------------------------------	308	;-----------------------------------------------------------------------------
309		309
310	macro DEBUGF _level,_format,[_arg] {	310	macro DEBUGF _level,_format,[_arg] {
311	common	311	common
312	if __DEBUG__ = 1 & _level >= __DEBUG_LEVEL__	312	if __DEBUG__ = 1 & _level >= __DEBUG_LEVEL__
313	local ..f1,f2,a1,a2,c1,c2,c3,..lbl	313	local ..f1,f2,a1,a2,c1,c2,c3,..lbl
314	_debug_str_ equ __debug_str_ # a1	314	_debug_str_ equ __debug_str_ # a1
315	a1 = 0	315	a1 = 0
316	c2 = 0	316	c2 = 0
317	c3 = 0	317	c3 = 0
318	f2 = 0	318	f2 = 0
319	repeat ..lbl-..f1	319	repeat ..lbl-..f1
320	virtual at 0	320	virtual at 0
321	db _format,0,0	321	db _format,0,0
322	load c1 word from %-1	322	load c1 word from %-1
323	end virtual	323	end virtual
324	if c1 = '%s'	324	if c1 = '%s'
325	virtual at 0	325	virtual at 0
326	db _format,0,0	326	db _format,0,0
327	store word 0 at %-1	327	store word 0 at %-1
328	load c1 from f2-c2	328	load c1 from f2-c2
329	end virtual	329	end virtual
330	if c1 <> 0	330	if c1 <> 0
331	DEBUGS 0,_debug_str_+f2-c2	331	DEBUGS 0,_debug_str_+f2-c2
332	end if	332	end if
333	c2 = c2 + 1	333	c2 = c2 + 1
334	f2 = %+1	334	f2 = %+1
335	DEBUGF_HELPER S,a1,0,_arg	335	DEBUGF_HELPER S,a1,0,_arg
336	else if c1 = '%x'	336	else if c1 = '%x'
337	virtual at 0	337	virtual at 0
338	db _format,0,0	338	db _format,0,0
339	store word 0 at %-1	339	store word 0 at %-1
340	load c1 from f2-c2	340	load c1 from f2-c2
341	end virtual	341	end virtual
342	if c1 <> 0	342	if c1 <> 0
343	DEBUGS 0,_debug_str_+f2-c2	343	DEBUGS 0,_debug_str_+f2-c2
344	end if	344	end if
345	c2 = c2 + 1	345	c2 = c2 + 1
346	f2 = %+1	346	f2 = %+1
347	DEBUGF_HELPER H,a1,0,_arg	347	DEBUGF_HELPER H,a1,0,_arg
348	else if c1 = '%d' \| c1 = '%u'	348	else if c1 = '%d' \| c1 = '%u'
349	local c4	349	local c4
350	if c1 = '%d'	350	if c1 = '%d'
351	c4 = 1	351	c4 = 1
352	else	352	else
353	c4 = 0	353	c4 = 0
354	end if	354	end if
355	virtual at 0	355	virtual at 0
356	db _format,0,0	356	db _format,0,0
357	store word 0 at %-1	357	store word 0 at %-1
358	load c1 from f2-c2	358	load c1 from f2-c2
359	end virtual	359	end virtual
360	if c1 <> 0	360	if c1 <> 0
361	DEBUGS 0,_debug_str_+f2-c2	361	DEBUGS 0,_debug_str_+f2-c2
362	end if	362	end if
363	c2 = c2 + 1	363	c2 = c2 + 1
364	f2 = %+1	364	f2 = %+1
365	DEBUGF_HELPER D,a1,c4,_arg	365	DEBUGF_HELPER D,a1,c4,_arg
366	else if c1 = '\n'	366	else if c1 = '\n'
367	c3 = c3 + 1	367	c3 = c3 + 1
368	end if	368	end if
369	end repeat	369	end repeat
370	virtual at 0	370	virtual at 0
371	db _format,0,0	371	db _format,0,0
372	load c1 from f2-c2	372	load c1 from f2-c2
373	end virtual	373	end virtual
374	if (c1<>0)&(f2<>..lbl-..f1-1)	374	if (c1<>0)&(f2<>..lbl-..f1-1)
375	DEBUGS 0,_debug_str_+f2-c2	375	DEBUGS 0,_debug_str_+f2-c2
376	end if	376	end if
377	virtual at 0	377	virtual at 0
378	..f1 db _format,0	378	..f1 db _format,0
379	..lbl:	379	..lbl:
380	__debug_strings equ __debug_strings,_debug_str_,<_format>,..lbl-..f1-1-c2-c3	380	__debug_strings equ __debug_strings,_debug_str_,<_format>,..lbl-..f1-1-c2-c3
381	end virtual	381	end virtual
382	end if	382	end if
383	}	383	}
384		384
385	macro __include_debug_strings dummy,[_id,_fmt,_len] {	385	macro __include_debug_strings dummy,[_id,_fmt,_len] {
386	common	386	common
387	local c1,a1,a2	387	local c1,a1,a2
388	forward	388	forward
389	if defined _len & ~_len eq	389	if defined _len & ~_len eq
390	_id:	390	_id:
391	a1 = 0	391	a1 = 0
392	a2 = 0	392	a2 = 0
393	repeat _len	393	repeat _len
394	virtual at 0	394	virtual at 0
395	db _fmt,0,0	395	db _fmt,0,0
396	load c1 word from %+a2-1	396	load c1 word from %+a2-1
397	end virtual	397	end virtual
398	if (c1='%s')\|(c1='%x')\|(c1='%d')\|(c1='%u')	398	if (c1='%s')\|(c1='%x')\|(c1='%d')\|(c1='%u')
399	db 0	399	db 0
400	a2 = a2 + 1	400	a2 = a2 + 1
401	else if (c1='\n')	401	else if (c1='\n')
402	dw $0A0D	402	dw $0A0D
403	a1 = a1 + 1	403	a1 = a1 + 1
404	a2 = a2 + 1	404	a2 = a2 + 1
405	else	405	else
406	db c1 and 0x0FF	406	db c1 and 0x0FF
407	end if	407	end if
408	end repeat	408	end repeat
409	db 0	409	db 0
410	end if	410	end if
411	}	411	}
412		412
413	macro DEBUGF_HELPER _letter,_num,_sign,[_arg] {	413	macro DEBUGF_HELPER _letter,_num,_sign,[_arg] {
414	common	414	common
415	local num	415	local num
416	num = 0	416	num = 0
417	forward	417	forward
418	if num = _num	418	if num = _num
419	DEBUG#_letter _sign,_arg	419	DEBUG#_letter _sign,_arg
420	end if	420	end if
421	num = num+1	421	num = num+1
422	common	422	common
423	_num = _num+1	423	_num = _num+1
424	}	424	}
425		425
426	macro include_debug_strings {	426	macro include_debug_strings {
427	if __DEBUG__ = 1	427	if __DEBUG__ = 1
428	match dbg_str,__debug_strings \{	428	match dbg_str,__debug_strings \{
429	__include_debug_strings dbg_str	429	__include_debug_strings dbg_str
430	\}	430	\}
431	end if	431	end if
432	}	432	}

Subversion Repositories Kolibri OS

(root)/drivers/fdo.inc – Rev 3545 → 3614