[PIC24H][C+ASM] Kontroler do LCD mono 640x480 (S1D13705)

Connecting to MPLAB ICD 2
...Connected
Setting Vdd source to target
Target Device PIC24HJ256GP210 found, revision = Rev 0x3002
...Reading ICD Product ID
Running ICD Self Test
...Passed
MPLAB ICD 2 Ready

;———————————————————————————————————————————————————————————————————————————————;
; f_gfx_line_sloped                                                             ;
;                                                                               ;
; this functions puts a sloped line from (X1_REG,Y1_REG) to (X2_REG,Y2_REG).    ;
; valid positions are: x: (0,639), y: (0,479). the line mustn't be vertical!    ;
;_______________________________________________________________________________;

.global f_gfx_line_sloped
        
.text        
        
f_gfx_line_sloped:

    push.d  X2_REG                  ; store the ending cooridinates on the stack
    lnk     #8                      ; allocate a memory frame for local variables
    cpsgt   X1_REG,X2_REG           ; if x1>x2 - exchange the coordinates pairs
    bra     1f  
    exch    X1_REG,X2_REG
    exch    Y1_REG,Y2_REG
1:  sub     X2_REG,X1_REG,GFX_REG0  ; the horizontal distance
    mov     #40,GFX_REG1
    mov     GFX_REG1,[w14]          ; positive increment
    sub     Y2_REG,Y1_REG,GFX_REG1  ; the vertical distance
    bra     NN,2f                   ; if y2<y1 ...
    sub     Y1_REG,Y2_REG,GFX_REG1  ; ... calculate the vertical distance again
    neg     [w14],[w14]             ; negative increment
2:  push    [w14]                   ; store that for a while
    clr     [w14++]                 ; accumulator
    mov     GFX_REG0,[w14++]        ; half of integer
    sl      GFX_REG0,[w14++]        ; integer
    mov     GFX_REG1,Y2_REG         ; keep the vertical distance for tests
    sl      GFX_REG1,[w14--]        ; fractional part
    sub     #4,w14

    rcall   f_gfx_address           ; calculate the address of the first pixel
    rcall   f_gfx_px_pos            ; calculate the first pixel's position
    
    pop     GFX_REG1                ; restore the positive/negative increment
    
3:  mov     [w14+6],GFX_REG0        ; get the fractional part
    add     GFX_REG0,[w14],[w14]    ; and add it to accumulator
4:  rcall   f_s1d_or                ; print a pixel
    cp0     Y2_REG                  ; if all line changes were made - skip the...
    bra     Z,5f                    ; next block
    mov     [w14++],GFX_REG0        ; get accumulator
    cp      GFX_REG0,[w14--]        ; accumulator > (0.5*)integer ?
    bra     LTU,5f                  ; if not - just skip the line change block
    sub     GFX_REG0,[++w14],[--w14]    ; decrease the acc. by (0.5*)integer
    mov     [w14+4],GFX_REG0        ; get the integer
    mov     GFX_REG0,[w14+2]        ; replace half of integer with integer
    dec     Y2_REG,Y2_REG           ; decrement the number of line changes left
    add     S1D_ADR_REG,GFX_REG1,S1D_ADR_REG    ; change the line
    bra     N,5f                    ; (safety)
    mov     [w14++],GFX_REG0        ; get accumulator
    cp      GFX_REG0,[w14--]        ; is the accumulator still bigger than int.?
    bra     GEU,4b                  ; print a pixel just above/below
5:  inc     X1_REG,X1_REG           ; increase x
    swap    S1D_DATA_REG
    rrc     S1D_DATA_REG,S1D_DATA_REG   ; increase the pixel
    bra     NC,6f                   ; next word?
    rrc     S1D_DATA_REG,S1D_DATA_REG   ; yes -> insert the pixel to next word
    inc     S1D_ADR_REG,S1D_ADR_REG ; and increase the address
6:  swap    S1D_DATA_REG
    cp      X1_REG,X2_REG           ; is the line over?
    bra     LEU,3b                  ; if not - continue with the loop
    
    ulnk                            ; release the allocated memory frame
    pop.d     X2_REG                ; restore end coordinates
    
    return                          ; return to parent