;******************************************************************************************
;  PIC24FJ64GA002 Sample Program
;   Project      :
;   Program Name :
;   Programer    :
;   Create date  :  Version 1.0    H21.04.05
;   History      :
;   Laungage     :  MPLAB ASM30 
;******************************************************************************************
;  (1)Description
;
;******************************************************************************************
.include "p24FJ64GA002.inc"

config __CONFIG1 , JTAGEN_OFF & GCP_OFF & GWRP_OFF & BKBUG_OFF & COE_OFF & ICS_PGx1 & FWDTEN_OFF & WINDIS_OFF & FWPSA_PR32 & WDTPS_PS1
config __CONFIG2 , IESO_OFF  & SOSCSEL_SOSC & WUTSEL_FST & FNOSC_FRC & FCKSM_CSDCMD & OSCIOFNC_OFF & IOL1WAY_OFF & I2C1SEL_PRI  & POSCMOD_NONE 

.bss 
.global __reset

.section data_area
LED_lst:   .space 2

;******************************************************************************************
;   Function Name : main
;   Title         : 
;   Input         :
;   Output        :
;******************************************************************************************
.text
__reset:
;*******************
; 1.Initialize
;*******************
; (0)Initialize Stack Pointer
    MOV #__SP_init, W15       ;Initalize the Stack Pointer
    MOV #__SPLIM_init, W0     ;Initialize the Stack Pointer Limit Register
    MOV W0, SPLIM
    NOP                       ;Add NOP to follow SPLIM initialization

; (1)Set All Digital Port  
    MOV.W #0xFFFF,W0
    MOV.W W0,AD1PCFG

; (2)Define PortA
    MOV.W #0xFFFF,W0
    MOV.W W0,TRISA

; (3)Define PortB
    MOV.W #0xFF00,W0
    MOV.W W0,TRISB

; (4)Set Initial Value LEDlst
    MOV.W #0x0001,W0
    MOV.W W0,LED_lst
;
    MOV.W LED_lst,W0
    MOV.W W0,PORTB

;*******************
; 2.Program main
;*******************
main_p:    
;  (1)Set furst loop value
    MOV.W #0x000A,W2

;  (2)Check push-sw
main_chk_sw:   
;   2-1)Count-up loop value
    MOV.W #0x0001,W3
    INC.W W2,W3
    MOV.W W3,W2

;   2-2)Check loop-value (9<W2<32)
    MOV.W #0x0020,W3
    SUB.W W2,W3,W4
    BRA LEU,main_chk_sw_1
    MOV.W #0x000A,W2

main_chk_sw_1:     
    MOV.W PORTA,W0
    MOV.W #3,W1
    AND.W W0,W1,W3
    SUB.W W3,#0,W1
    BRA NZ,main_loop_S
    BRA     main_chk_sw

;  (3)Move LED (W1:Loop Counter,W2:Loop Value)
main_loop_S:
    CLR.W W1

main_loop_0:
    MOV.W #0x0001,W3
    INC.W W1,W3
    MOV.W W3,W1
;
    SUB.W W1,W2,W4
    BRA LEU,main_loop_1
    BRA main_loop_E
;
main_loop_1: 
    CALL mvLED    
    MOV.W LED_lst,W0
    MOV.W W0,PORTB
    CALL wat
    BRA main_loop_0

main_loop_E: 
    BRA     main_p

;******************************************************************************************
;   Function Name : mvLED
;   Title         : Move LED function
;   Input         :
;   Output        :
;******************************************************************************************
mvLED:
; ******************
;  1.Initialize
; ******************
    PUSH.W W0
    PUSH.W W1
    PUSH.W W2
    PUSH.W W3
    PUSH.W W4
;
; ******************
;  2.Program main
; ******************
;  (1)Case LED_lst = 1
    MOV.W LED_lst,W1
    SUB.W W1,#1,W3
    BRA NZ,mvLED_2
    MOV.W #2,W2
    MOV.W W2,LED_lst
    BRA mvLED_end 

;  (2)Case LED_lst <= 127
mvLED_2:
    MOV.W LED_lst,W1
    MOV.W #127,W2
    SUB.W W1,W2,W3
    BRA LEU,mvLED_3
    MOV.W #1,W2
    MOV.W W2,LED_lst
    BRA mvLED_end 

;  (3)Case 1< LED_lst < 127
mvLED_3:
    MOV.W #1,W2
    SL.W  W1,W2,W1
    MOV.W W1,LED_lst
    BRA mvLED_end 

; ******************
;  3.End
; ******************
mvLED_end:
    POP.W W4
    POP.W W3
    POP.W W2
    POP.W W1
    POP.W W0
    RETURN

;******************************************************************************************
;  Function Name : wat
;  Title         : wait function
;  Input         :
;  Output        :
;  Description   :
;       W1:Timer_1,W2:Timer_2
;******************************************************************************************
wat:
; ******************
;  1.Initialize
; ******************
    PUSH.W W0
    PUSH.W W1
    PUSH.W W2
    PUSH.W W3
    PUSH.W W4

; ******************
;  2.Program main
; ******************
;  (1)Define T2CON Register
    MOV.W #0b1000000000100000,W0
    MOV.W W0,T2CON 

;  (2)Set PR2-Register
    MOV.W #0x30D4,W0   ; 5Hz (0x30D4;0d12500)   8MHz
    MOV.W W0,PR2    

    CLR.W TMR2 

;  (3)Timer
    BCLR.W IFS0,#(T2IF)
    CLR.W  W0
    BSET.W W0,#(T2IF)
wat_2:
    MOV.W IFS0,W1
    AND.W W0,W1,W2
    BRA Z,wat_2 
 
; ******************
;  3.End
; ******************
wat_e:
    POP.W W4
    POP.W W3
    POP.W W2
    POP.W W1
    POP.W W0
    RETURN