.mmregs               
     .def start0
     .ref _INIT_PLL,_ODBYTECTR,_IDBYTECTR,_ODPTR
     .ref _init_gpio,_init_i2c,_write_i2c,_read_i2c
     .def _USER_FUNCTION
      		
			
LEN  .set	400         			;堆棧長度
BOS	 .usect "STK",LEN

;************************************************************************
; 主函數
;************************************************************************
     .text          
start0:    
	 STM	#BOS+LEN,SP             ;堆棧指針
     CALL	_INIT_PLL               ;初始化CPU時鐘
     RSBX	SXM						
     NOP                
     CALL	_init_gpio              ;將 McBSP 配置成通用IO口
     CALL	_init_i2c               ;初始化I2C
;************************************************************************

;********填充發送數據（SAA7111A寄存器地址和配置的寄存器數據)*************    
     CALL	_init_i2c               ;初始化I2C
     STM	#_ODPTR+1,AR2          	
     ST		#1,*AR2+				;第一個寄存器地址
   ST     #00H,*AR2+				;連續寫數據
    ST     #0C3H,*AR2+			 	
    ST     #33H,*AR2+				
    ST     #00H,*AR2+				
    ST     #00H,*AR2+				
    ST     #0EBH,*AR2+				
    ST     #0E0H,*AR2+
    ST     #88H,*AR2+
    ST     #01H,*AR2+
    ST     #80H,*AR2+
    ST     #47H,*AR2+
    ST     #40H,*AR2+
    ST     #00H,*AR2+
    ST     #01H,*AR2+
    ST     #00H,*AR2+
    ST    #00H,*AR2+ ;RGB565
    ;ST    #40H,*AR2+ ;YUV4:2:2
    ST     #1CH,*AR2+
    ST     #02H,*AR2+;ST     #0AH,*AR2+
    ST     #00H,*AR2+
    ST     #00H,*AR2+
    ST     #00H,*AR2+
    ST     #00H,*AR2+
    ST     #00H,*AR2+
    ST     #00H,*AR2+
    STM	   #_ODBYTECTR,AR1
    ST	   #19H,*AR1	    ;要發送的數據個數
	 CALL	_write_i2c 				;寫數據并使能全局中斷

     CALL	Delay                   

;*********發送SAA7111A	芯片地址*************************************
	 CALL	_init_i2c              
	 STM	#_ODPTR+1,AR1           
     ST		#1,*AR1+				
     NOP
     STM	#_ODBYTECTR,AR1
     ST		#1,*AR1					
	 CALL	_write_i2c	     		

	 CALL	Delay                   
     

;*********讀寄存器值***************************************
	 CALL	_init_i2c               
	 STM	#_IDBYTECTR,AR1	        
    ; ST		#18H,*AR1
     ST		#1FH,*AR1		                    
     CALL	_read_i2c  				


;*********結束*************************************************
STOPSTOP:
		B	STOPSTOP                                
		
;************************************************************************	
;***延時*****************************************************************			
;************************************************************************			
Delay:     
		NOP
		PSHM	AR5
		PSHM	AR6
		NOP
		STM		#2000,AR5
LOOP1:	STM		#2000,AR6
LOOP2:  NOP
	    NOP
		BANZ	LOOP2,*AR6-
		BANZ	LOOP1,*AR5-	  
		NOP
		POPM	AR6
		POPM	AR5
		NOP
		RET
;************************************************************************	
;************************************************************************			
_USER_FUNCTION:
		NOP
		RET
			
      .end