2009-09-27 12:11:05 +00:00
|
|
|
;
|
|
|
|
; int snprintf (char* buf, size_t size, const char* Format, ...);
|
|
|
|
;
|
|
|
|
; Ullrich von Bassewitz, 2009-09-26
|
|
|
|
;
|
|
|
|
|
2013-05-09 11:56:54 +00:00
|
|
|
.export _snprintf
|
|
|
|
.import pushax, addysp, decsp6, _vsnprintf
|
|
|
|
.importzp sp, ptr1
|
2009-09-27 12:11:05 +00:00
|
|
|
|
2013-05-09 11:56:54 +00:00
|
|
|
.macpack generic
|
2009-09-27 12:11:05 +00:00
|
|
|
|
|
|
|
; ----------------------------------------------------------------------------
|
|
|
|
; Data
|
|
|
|
|
|
|
|
.bss
|
|
|
|
|
2013-05-09 11:56:54 +00:00
|
|
|
ParamSize: .res 1 ; Number of parameter bytes
|
2009-09-27 12:11:05 +00:00
|
|
|
|
|
|
|
; ----------------------------------------------------------------------------
|
|
|
|
; Code
|
|
|
|
|
|
|
|
.code
|
|
|
|
|
|
|
|
|
|
|
|
_snprintf:
|
2013-05-09 11:56:54 +00:00
|
|
|
sty ParamSize ; Number of param bytes passed in Y
|
2009-09-27 12:11:05 +00:00
|
|
|
|
|
|
|
; We have to push buf/size/format, both in the order they already have on stack.
|
|
|
|
; To make this somewhat more efficient, we will create space on the stack and
|
|
|
|
; then do a copy of the complete block instead of pushing each parameter
|
|
|
|
; separately. Since the size of the arguments passed is the same as the size
|
|
|
|
; of the fixed arguments, this will allow us to calculate the pointer to the
|
|
|
|
; fixed size arguments easier (they're just ParamSize bytes away).
|
|
|
|
|
2013-05-09 11:56:54 +00:00
|
|
|
jsr decsp6
|
2009-09-27 12:11:05 +00:00
|
|
|
|
|
|
|
; Calculate a pointer to the Format argument
|
|
|
|
|
2013-05-09 11:56:54 +00:00
|
|
|
lda ParamSize
|
|
|
|
add sp
|
|
|
|
sta ptr1
|
|
|
|
ldx sp+1
|
|
|
|
bcc @L1
|
|
|
|
inx
|
|
|
|
@L1: stx ptr1+1
|
2009-09-27 12:11:05 +00:00
|
|
|
|
|
|
|
; Now copy buf/size/format
|
|
|
|
|
2013-05-09 11:56:54 +00:00
|
|
|
ldy #6-1
|
|
|
|
@L2: lda (ptr1),y
|
|
|
|
sta (sp),y
|
|
|
|
dey
|
|
|
|
bpl @L2
|
2009-09-27 12:11:05 +00:00
|
|
|
|
|
|
|
; Load va_list (last and __fastcall__ parameter to vsprintf)
|
|
|
|
|
2013-05-09 11:56:54 +00:00
|
|
|
lda ptr1
|
|
|
|
ldx ptr1+1
|
2009-09-27 12:11:05 +00:00
|
|
|
|
|
|
|
; Call vsnprintf
|
|
|
|
|
2013-05-09 11:56:54 +00:00
|
|
|
jsr _vsnprintf
|
2009-09-27 12:11:05 +00:00
|
|
|
|
|
|
|
; Cleanup the stack. We will return what we got from vsprintf
|
|
|
|
|
2013-05-09 11:56:54 +00:00
|
|
|
ldy ParamSize
|
|
|
|
jmp addysp
|
2009-09-27 12:11:05 +00:00
|
|
|
|