]> git.sur5r.net Git - cc65/blob - libsrc/common/fwrite.s
Fixed _textcolor definition.
[cc65] / libsrc / common / fwrite.s
1 ;
2 ; Ullrich von Bassewitz, 22.11.2002
3 ;
4 ; size_t __fastcall__ fwrite (const void* buf, size_t size, size_t count, FILE* file);
5 ; /* Write to a file */
6 ;
7
8         .export         _fwrite
9
10         .import         _write
11         .import         pushax, incsp6, addysp, ldaxysp, pushwysp, return0
12         .import         tosumulax, tosudivax
13
14         .importzp       ptr1
15
16         .include        "errno.inc"
17         .include        "_file.inc"
18
19
20 ; ------------------------------------------------------------------------
21 ; Code
22                                                           
23 .proc   _fwrite
24
25 ; Save file and place it into ptr1
26
27         sta     file
28         sta     ptr1
29         stx     file+1
30         stx     ptr1+1
31
32 ; Check if the file is open
33
34         ldy     #_FILE::f_flags
35         lda     (ptr1),y
36         and     #_FOPEN                 ; Is the file open?
37         bne     @L2                     ; Branch if yes
38
39 ; File not open
40
41 @L1:    lda     #EBADF
42         jsr     __seterrno              ; Returns with A = 0
43         tax                             ; A = X = 0
44         jmp     incsp6
45
46 ; Check if the stream is in an error state
47
48 @L2:    lda     (ptr1),y                ; get file->f_flags again
49         and     #_FERROR
50         bne     @L1
51
52 ; Build the stackframe for write()
53
54         ldy     #_FILE::f_fd
55         lda     (ptr1),y
56         ldx     #$00
57         jsr     pushax                  ; file->f_fd
58
59         ldy     #9
60         jsr     pushwysp                ; buf
61
62 ; Stack is now: buf/size/count/file->fd/buf
63 ; Calculate the number of bytes to write: count * size
64
65         ldy     #7
66         jsr     pushwysp                ; count
67         ldy     #9
68         jsr     ldaxysp                 ; Get size
69         jsr     tosumulax               ; count * size -> a/x
70
71 ; Check if the number of bytes is zero. Don't call write in this case
72
73         cpx     #0
74         bne     @L3
75         cmp     #0
76         bne     @L3
77
78 ; The number of bytes to write is zero, just return count
79
80         ldy     #5
81         jsr     ldaxysp                 ; Get count
82         ldy     #10
83         jmp     addysp                  ; Drop params, return
84
85 ; Call write(). This will leave the original 3 params on the stack
86
87 @L3:    jsr     _write
88
89 ; Check for errors in write
90
91         cpx     #$FF
92         bne     @L4
93         cmp     #$FF
94         bne     @L4
95
96 ; Error in write. Set the stream error flag and bail out. errno is already
97 ; set by write().
98
99         lda     file
100         sta     ptr1
101         lda     file+1
102         sta     ptr1+1
103         ldy     #_FILE::f_flags
104         lda     (ptr1),y
105         ora     #_FERROR
106         sta     (ptr1),y
107         bne     @L1                     ; Return zero
108
109 ; Write was ok. Return the number of items successfully written. Since we've
110 ; checked for bytes == 0 above, size cannot be zero here, so the division is
111 ; safe.
112
113 @L4:    jsr     pushax                  ; Push number of bytes written
114         ldy     #5
115         jsr     ldaxysp                 ; Get size
116         jsr     tosudivax               ; bytes / size -> a/x
117         jmp     incsp6                  ; Drop params, return
118
119 .endproc
120
121 ; ------------------------------------------------------------------------
122 ; Data
123
124 .bss
125 file:   .res    2
126