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
if defined SysMsgBoard._pe_import
        invoke  SysMsgBoard
else
	stdcall SysMsgBoard
end if
	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
if defined SysMsgBoard._pe_import
        invoke  SysMsgBoard
else
	stdcall SysMsgBoard
end if
	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 3614	Rev 4418
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 ecx,al	237	movzx ecx,al
238	mov ebx,1	238	mov ebx,1
239	; mov ecx,sys_msg_board	239	if defined SysMsgBoard._pe_import
240	; call ecx ; sys_msg_board	240	invoke SysMsgBoard
-		241	else
241	stdcall SysMsgBoard	242	stdcall SysMsgBoard
-		243	end if
242	popad	244	popad
243	ret	245	ret
244	debug_endf	246	debug_endf
245		247
246	debug_func fdo_debug_outstr	248	debug_func fdo_debug_outstr
247	debug_beginf	249	debug_beginf
248	mov ebx,1	250	mov ebx,1
249	.l1: dec esi	251	.l1: dec esi
250	js .l2	252	js .l2
251	movzx ecx,byte[edx]	253	movzx ecx,byte[edx]
252	or cl,cl	254	or cl,cl
253	jz .l2	255	jz .l2
254	; mov ecx,sys_msg_board	256	if defined SysMsgBoard._pe_import
255	; call ecx ; sys_msg_board	257	invoke SysMsgBoard
-		258	else
256	stdcall SysMsgBoard	259	stdcall SysMsgBoard
-		260	end if
257	inc edx	261	inc edx
258	jmp .l1	262	jmp .l1
259	.l2: ret	263	.l2: ret
260	debug_endf	264	debug_endf
261		265
262	debug_func fdo_debug_outdec	266	debug_func fdo_debug_outdec
263	debug_beginf	267	debug_beginf
264	or cl,cl	268	or cl,cl
265	jz @f	269	jz @f
266	or eax,eax	270	or eax,eax
267	jns @f	271	jns @f
268	neg eax	272	neg eax
269	push eax	273	push eax
270	mov al,'-'	274	mov al,'-'
271	call fdo_debug_outchar	275	call fdo_debug_outchar
272	pop eax	276	pop eax
273	@@: push 10	277	@@: push 10
274	pop ecx	278	pop ecx
275	push -'0'	279	push -'0'
276	.l1: xor edx,edx	280	.l1: xor edx,edx
277	div ecx	281	div ecx
278	push edx	282	push edx
279	test eax,eax	283	test eax,eax
280	jnz .l1	284	jnz .l1
281	.l2: pop eax	285	.l2: pop eax
282	add al,'0'	286	add al,'0'
283	jz .l3	287	jz .l3
284	call fdo_debug_outchar	288	call fdo_debug_outchar
285	jmp .l2	289	jmp .l2
286	.l3: ret	290	.l3: ret
287	debug_endf	291	debug_endf
288		292
289	debug_func fdo_debug_outhex	293	debug_func fdo_debug_outhex
290	__fdo_hexdigits db '0123456789ABCDEF'	294	__fdo_hexdigits db '0123456789ABCDEF'
291	debug_beginf	295	debug_beginf
292	mov cl,dl	296	mov cl,dl
293	neg cl	297	neg cl
294	add cl,8	298	add cl,8
295	shl cl,2	299	shl cl,2
296	rol eax,cl	300	rol eax,cl
297	.l1: rol eax,4	301	.l1: rol eax,4
298	push eax	302	push eax
299	and eax,0x0000000F	303	and eax,0x0000000F
300	mov al,[__fdo_hexdigits+eax]	304	mov al,[__fdo_hexdigits+eax]
301	call fdo_debug_outchar	305	call fdo_debug_outchar
302	pop eax	306	pop eax
303	dec edx	307	dec edx
304	jnz .l1	308	jnz .l1
305	ret	309	ret
306	debug_endf	310	debug_endf
307		311
308	;-----------------------------------------------------------------------------	312	;-----------------------------------------------------------------------------
309		313
310	macro DEBUGF _level,_format,[_arg] {	314	macro DEBUGF _level,_format,[_arg] {
311	common	315	common
312	if __DEBUG__ = 1 & _level >= __DEBUG_LEVEL__	316	if __DEBUG__ = 1 & _level >= __DEBUG_LEVEL__
313	local ..f1,f2,a1,a2,c1,c2,c3,..lbl	317	local ..f1,f2,a1,a2,c1,c2,c3,..lbl
314	_debug_str_ equ __debug_str_ # a1	318	_debug_str_ equ __debug_str_ # a1
315	a1 = 0	319	a1 = 0
316	c2 = 0	320	c2 = 0
317	c3 = 0	321	c3 = 0
318	f2 = 0	322	f2 = 0
319	repeat ..lbl-..f1	323	repeat ..lbl-..f1
320	virtual at 0	324	virtual at 0
321	db _format,0,0	325	db _format,0,0
322	load c1 word from %-1	326	load c1 word from %-1
323	end virtual	327	end virtual
324	if c1 = '%s'	328	if c1 = '%s'
325	virtual at 0	329	virtual at 0
326	db _format,0,0	330	db _format,0,0
327	store word 0 at %-1	331	store word 0 at %-1
328	load c1 from f2-c2	332	load c1 from f2-c2
329	end virtual	333	end virtual
330	if c1 <> 0	334	if c1 <> 0
331	DEBUGS 0,_debug_str_+f2-c2	335	DEBUGS 0,_debug_str_+f2-c2
332	end if	336	end if
333	c2 = c2 + 1	337	c2 = c2 + 1
334	f2 = %+1	338	f2 = %+1
335	DEBUGF_HELPER S,a1,0,_arg	339	DEBUGF_HELPER S,a1,0,_arg
336	else if c1 = '%x'	340	else if c1 = '%x'
337	virtual at 0	341	virtual at 0
338	db _format,0,0	342	db _format,0,0
339	store word 0 at %-1	343	store word 0 at %-1
340	load c1 from f2-c2	344	load c1 from f2-c2
341	end virtual	345	end virtual
342	if c1 <> 0	346	if c1 <> 0
343	DEBUGS 0,_debug_str_+f2-c2	347	DEBUGS 0,_debug_str_+f2-c2
344	end if	348	end if
345	c2 = c2 + 1	349	c2 = c2 + 1
346	f2 = %+1	350	f2 = %+1
347	DEBUGF_HELPER H,a1,0,_arg	351	DEBUGF_HELPER H,a1,0,_arg
348	else if c1 = '%d' \| c1 = '%u'	352	else if c1 = '%d' \| c1 = '%u'
349	local c4	353	local c4
350	if c1 = '%d'	354	if c1 = '%d'
351	c4 = 1	355	c4 = 1
352	else	356	else
353	c4 = 0	357	c4 = 0
354	end if	358	end if
355	virtual at 0	359	virtual at 0
356	db _format,0,0	360	db _format,0,0
357	store word 0 at %-1	361	store word 0 at %-1
358	load c1 from f2-c2	362	load c1 from f2-c2
359	end virtual	363	end virtual
360	if c1 <> 0	364	if c1 <> 0
361	DEBUGS 0,_debug_str_+f2-c2	365	DEBUGS 0,_debug_str_+f2-c2
362	end if	366	end if
363	c2 = c2 + 1	367	c2 = c2 + 1
364	f2 = %+1	368	f2 = %+1
365	DEBUGF_HELPER D,a1,c4,_arg	369	DEBUGF_HELPER D,a1,c4,_arg
366	else if c1 = '\n'	370	else if c1 = '\n'
367	c3 = c3 + 1	371	c3 = c3 + 1
368	end if	372	end if
369	end repeat	373	end repeat
370	virtual at 0	374	virtual at 0
371	db _format,0,0	375	db _format,0,0
372	load c1 from f2-c2	376	load c1 from f2-c2
373	end virtual	377	end virtual
374	if (c1<>0)&(f2<>..lbl-..f1-1)	378	if (c1<>0)&(f2<>..lbl-..f1-1)
375	DEBUGS 0,_debug_str_+f2-c2	379	DEBUGS 0,_debug_str_+f2-c2
376	end if	380	end if
377	virtual at 0	381	virtual at 0
378	..f1 db _format,0	382	..f1 db _format,0
379	..lbl:	383	..lbl:
380	__debug_strings equ __debug_strings,_debug_str_,<_format>,..lbl-..f1-1-c2-c3	384	__debug_strings equ __debug_strings,_debug_str_,<_format>,..lbl-..f1-1-c2-c3
381	end virtual	385	end virtual
382	end if	386	end if
383	}	387	}
384		388
385	macro __include_debug_strings dummy,[_id,_fmt,_len] {	389	macro __include_debug_strings dummy,[_id,_fmt,_len] {
386	common	390	common
387	local c1,a1,a2	391	local c1,a1,a2
388	forward	392	forward
389	if defined _len & ~_len eq	393	if defined _len & ~_len eq
390	_id:	394	_id:
391	a1 = 0	395	a1 = 0
392	a2 = 0	396	a2 = 0
393	repeat _len	397	repeat _len
394	virtual at 0	398	virtual at 0
395	db _fmt,0,0	399	db _fmt,0,0
396	load c1 word from %+a2-1	400	load c1 word from %+a2-1
397	end virtual	401	end virtual
398	if (c1='%s')\|(c1='%x')\|(c1='%d')\|(c1='%u')	402	if (c1='%s')\|(c1='%x')\|(c1='%d')\|(c1='%u')
399	db 0	403	db 0
400	a2 = a2 + 1	404	a2 = a2 + 1
401	else if (c1='\n')	405	else if (c1='\n')
402	dw $0A0D	406	dw $0A0D
403	a1 = a1 + 1	407	a1 = a1 + 1
404	a2 = a2 + 1	408	a2 = a2 + 1
405	else	409	else
406	db c1 and 0x0FF	410	db c1 and 0x0FF
407	end if	411	end if
408	end repeat	412	end repeat
409	db 0	413	db 0
410	end if	414	end if
411	}	415	}
412		416
413	macro DEBUGF_HELPER _letter,_num,_sign,[_arg] {	417	macro DEBUGF_HELPER _letter,_num,_sign,[_arg] {
414	common	418	common
415	local num	419	local num
416	num = 0	420	num = 0
417	forward	421	forward
418	if num = _num	422	if num = _num
419	DEBUG#_letter _sign,_arg	423	DEBUG#_letter _sign,_arg
420	end if	424	end if
421	num = num+1	425	num = num+1
422	common	426	common
423	_num = _num+1	427	_num = _num+1
424	}	428	}
425		429
426	macro include_debug_strings {	430	macro include_debug_strings {
427	if __DEBUG__ = 1	431	if __DEBUG__ = 1
428	match dbg_str,__debug_strings \{	432	match dbg_str,__debug_strings \{
429	__include_debug_strings dbg_str	433	__include_debug_strings dbg_str
430	\}	434	\}
431	end if	435	end if
432	}	436	}

Subversion Repositories Kolibri OS

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