#include p16f877.inc
	__config h'3FF2'
DELAYT 		EQU H'20'		;USED FOR DELAY ROUTINE
DELAYT1		EQU H'21'
CURRENTBIT 	EQU H'22'
RSRECV 		EQU H'23'		;RECIVED SERIAL BYTE GOES HERE RS232
RSSEND		EQU H'24'		;byte to send RS232
PS2IN	 		EQU H'25'		;CURRENT STATUS OF PORTB
PS2OUT	 	EQU H'26'
PARITY		EQU H'27'		;BIT0 FOR PARITY, BIT1 FOR TIMEOUT
TIMEOUT_TIMER	EQU H'28'
P1				EQU H'29'		;PS2 PACKET FILES
P2				EQU H'2A'
P3				EQU H'2B'
P4				EQU H'2C'
P5				EQU H'2D'
P6				EQU H'2E'
XPOS_H		EQU H'2F'
XPOS_L		EQU H'30'

YPOS_H		EQU H'31'
YPOS_L		EQU H'32'
TEMP			EQU H'33'

HUNDREDS   	EQU H'34'	; BCD HUNDREDS RESULT

TENS_AND_ONES   EQU H'35'; BCD TENS AND ONES RESULT
BIN			EQU H'36'                
XPOS_8		EQU H'37'
YPOS_8		EQU H'38'
Z_VAL			EQU H'39'




PKNUM  		EQU H'3A'		;PACKET NUMBER
PKTEMP	  	EQU H'3B'   
PK1			EQU H'3C'		;RF OUTPUT PACKET
PK2			EQU H'3D'		;THESE MUST STAY IN ORDER!!!
PK3			EQU H'3E'
PK4 			EQU H'3F'
CRC_1			EQU H'40'		
CRC_2			EQU H'41'

CELL			EQU H'49'		;0 = NO CONTACT
									;(1-9) CELL ON TRACKPAD	
									;10 =VERT SCROLL, 11 = HORZ SCROLL	
VERT_S		EQU H'42'		;VERTICAL SCROL VALUE (0-90)
HORZ_S		EQU H'43'		;HORIZONTAL SCROLL VALUE (0-110)
CELL_OLD		EQU H'50'		;BUTTON THINGGYGYG, SET ME FREEEEEEEEEEEEEEE

TEMP1			EQU H'44'		;MORE TEMP VALUES FOR NESTED DELAYS ECT
TEMP2			EQU H'45'
TEMP3			EQU H'46'
TEMP_LOOP	EQU H'47'

MODE_OLD		EQU H'47'		;USED MY MODE SELECT

MODE			EQU H'48'		;CURRENT MODE DEVICE IS IN	
					;1 = MOUSE MODE
					;2 = WINAMP MODE
					;3 = RADIO
COUNTER		EQU H'51'
		

MOUSE_BUT		EQU H'52'	;MOUSE BUTTON STATE	
MOUSE_BUT_OLD 	EQU H'53'		

RSPORT		EQU	PORTE
RSTRIS		EQU	TRISE
RSTX			EQU	0		;RS232 TRANS
RSRE			EQU	1		;RS232 RECIVE


RFPORT		EQU	PORTA
RFTRIS		EQU	TRISA
RFDATA		EQU	0

LCDPORT		EQU	PORTA
LCDTRIS		EQU	TRISA
LCDRS			EQU	3
LCDRW			EQU	4
LCDE			EQU	5

LCD_BL_TRIS	EQU	TRISC
LCD_BL		EQU	2



LED_PORT		EQU	PORTB		
LED_TRIS		EQU	TRISB
Y_LED			EQU 	1
G_LED			EQU 	2
R_LED			EQU 	3

BUTTON_PORT	EQU	PORTB
BUTTON_TRIS	EQU	TRISB
BUT1			EQU	7
BUT2			EQU	6
BUT3			EQU	5
BUT4			EQU	4
	
P8PORT		EQU	PORTD
P8TRIS		EQU	TRISD



PS2PORT		EQU	PORTA
PS2TRIS		EQU	TRISA
PS2CLOCK	EQU	1
PS2DATA		EQU	2	
		;PROGRESS OF GETTING INFO
	ORG 0x00
	GOTO START
;;---------------INTERUPT GOES HERE-------------------------
	ORG 0x04

INTERPUT:
	BTFSC	INTCON,1
	CALL 	GETBYTE2


	CALL 	RESETINT1
	

	RETFIE  ;(return from interupt)
;-------------------------------------------------------------	
	;ORG 0x1F00,0x1FFF {}	

	ORG 0X10
resetint:

	bcf 	INTCON,0 ;(RBIF), SET WHEN PORTB CHANGEs
	bcf 	INTCON,1 ;set when rb0/int changes
	bcf 	INTCON,3 ;ENABLE PORTB INTERUPTS, RBIE
	bsf 	INTCON,4 ;enable rb0/int
	bsf 	OPTION_REG,6 ;(SET RB0.INT EDGE TRIGGER , (INTEDG??) (set=rising edge,low to high,clear=falling)
	bsf 	INTCON,7 ;ENABLE ALL INTERUPTS (GIE??)	
	return	

;----INT RESET------
RESETINT1:
	bcf 	INTCON,1 ;set when rb0/int changes
	bsf 	INTCON,7 ;ENABLE ALL INTERUPTS (GIE??)
	RETURN
;---DELAY ROUTINE---------
DELAY:			;;delay is (delayt X 3) + 5
	DECFSZ 	DELAYT,1
	GOTO 	DELAY 
	RETURN 




	
	

;;;;;;;;;STARTS HERE;;;;;;;;;;;;;;;;;;;;;
START:


	
	;;; SET PORTS UP;;;;;;;;;;
	CLRF 	PORTA
	CLRF 	PORTB
	CLRF	PORTC
	CLRF	PORTD
	CLRF	PORTE
	CLRF	MOUSE_BUT


        BSF     STATUS, RP0	;MEM1

	MOVLW	0X06	;MAKE ALL PORTS DIGITAL NOT ANALOGU
	MOVWF	ADCON1

        BSF	PS2TRIS,PS2CLOCK	;MAKE PS2 INPUTS
	BSF	PS2TRIS,PS2DATA

	BSF	RSTRIS,RSRE		;SETUP RS232 IO
	BCF	RSTRIS,RSTX

	BCF	LCDTRIS,LCDRS		;SETUP LCD IO TO OUTPUTS
	BCF	LCDTRIS,LCDRW
	BCF	LCDTRIS,LCDE
	
	BCF	LED_TRIS,Y_LED		;LEDS
	BCF	LED_TRIS,G_LED		;LEDS
	BCF	LED_TRIS,R_LED		;LEDS

	BSF	BUTTON_TRIS,BUT1	;SETUP BUTTON PORTS
	BSF	BUTTON_TRIS,BUT2	;SETUP BUTTON PORTS
	BSF	BUTTON_TRIS,BUT3	;SETUP BUTTON PORTS
	BSF	BUTTON_TRIS,BUT4	;SETUP BUTTON PORTS

	BCF	RFTRIS,RFDATA		;RF  OUTPUT

	BCF	LCD_BL_TRIS,LCD_BL	;BACKLIGHT AS OUTPUT

	BCF     STATUS, RP0	;MEM0


	MOVLW	D'15'				;SETUP PWM FOR LCD BACKLIGHT
	MOVWF	CCP1CON

	MOVLW	D'5'
	MOVWF	T2CON				;ENABLE TIMER2 FOR PWM

	MOVLW	D'128'
	MOVWF	CCPR1L			;DUTY CYCLE


	BSF	RSPORT,RSTX			;SET HIGH	
	BCF	LCDPORT,LCDE		;SET INITIAL LOW
	BCF	RFPORT,RFDATA		;LOW

	BSF	LED_PORT,G_LED		;GREEN LED ON
	BSF	LED_PORT,R_LED		;GREEN LED ON


	
;;;;;;;;;;;;;;;;;;;;;;;;;;;;

	;CALL 	resetint

;;;;;-----------------------MAIN LOOP---------------------;;;;;;;;;;
MAIN:
	MOVLW	D'85'
	MOVWF	PK1
	MOVLW	D'4'
	MOVWF	PK2
	MOVLW	D'8'
	MOVWF	PK3
	MOVLW	D'16'
	MOVWF	PK4

	CALL	SEND_RF
	

	CLRF	STATUS

	CALL	DELAY_1MS
	CALL	DELAY_1MS
	CALL	DELAY_1MS

	CALL 	PS2INPUT	;WAIT FOR PAD TO CALIBRATE
	CALL 	RESET_PS2
;---------50MS----------

	MOVLW	D'50'		;50MS WAIT
	MOVWF	TEMP
START_WAIT
	CALL	DELAY_1MS
	DECFSZ	TEMP,F
	GOTO START_WAIT
	
	
;---------------------

	CALL	SETUP_LCD
	CALL 	STARTUP_MESSAGE
	CALL 	MODE_SELECT
;----------------------------------------------------------------------
;----------------------------------------------------------------------
;----------------------------------------------------------------------
;-------------------------MODE SELECT----------------------------------
;----------------------------------------------------------------------
;----------------------------------------------------------------------
;----------------------------------------------------------------------

MODE_SELECT;			;MODE USED TO SELECT WHICH MODE TO GO INTO
	CALL 	CLEAR_DISPLAY

	MOVLW	B'10000001'		;FIRST LINE 
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY

	MOVLW	"<"			;DISPLAY "<SELECT MODE>"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"S"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"E"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"L"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"E"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"C"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"T"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"M"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"O"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"D"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"E"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	">"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	
	CLRF	MODE_OLD

	MOVLW	D'1'		;PUT INTO DEFAULT MODE 1 (MOUSE)
	MOVWF	MODE
		

MODE_SELECT_LOOP
	MOVF	MODE_OLD,W	;CHECK TO SEE IF MODE HAS CHANGED
	SUBWF	MODE,W
	BTFSS	STATUS,Z
	CALL	MODE_SELECT_DISPLAY_UPDATE

	MOVF	MODE,W
	MOVWF	MODE_OLD

	CALL	MODE_SELECT_NEW_MODE_TEST


	BTFSC	BUTTON_PORT,BUT1
	GOTO	MODE_SELECT_CHANGE

	GOTO 	MODE_SELECT_LOOP
;----------------CHANGE MODE----------

MODE_SELECT_CHANGE:
	MOVF	MODE,W
	SUBLW	D'1'		
	BTFSC	STATUS,Z
	GOTO	MOUSE_MODE

	MOVF	MODE,W
	SUBLW	D'2'		
	BTFSC	STATUS,Z
	GOTO	WINAMP_MODE

	MOVF	MODE,W
	SUBLW	D'3'		
	BTFSC	STATUS,Z
	GOTO	RADIO_MODE



;-----------------TEST FOR NEW MODE---------------
MODE_SELECT_NEW_MODE_TEST:
	
	CALL	GET_PS2_PACKET		;GET FINGER INFO FROM PAD
	CALL	PROCESSES_PACKET	;PROCESS FINGER INFORMATION


	CALL	PAD_CELL		;WORKOUT WHICH BUTTON BEING PRESSED
	
	MOVF	CELL,F			;TEST CELL TO SEE IF 0, IF 0 THE RETURN
	SKPNZ				;
	RETURN

MODE_SELECT_NEW_MODE_TEST_LOOP:

	
	CALL	GET_PS2_PACKET		;GET FINGER INFO FROM PAD
	CALL	PROCESSES_PACKET	;PROCESS FINGER INFORMATION
	CALL	PAD_CELL		;WORKOUT WHICH BUTTON BEING PRESSED


	MOVLW D'10'
	SUBWF	CELL,W
	BTFSC	STATUS,Z
	CALL	UPDATE_LCD_BL


	;CALL	MAKE_MOUSE_PACKET
	;CALL	SEND_RF


	MOVFW	CELL			;CHECK TO SEE IF VALIDE BUTTON (1..3)
	ADDLW 	D'252'			;255 - HI
	ADDLW 	D'3'			;(Hi - Lo) + 1

	SKPNC
	CALL	MODE_SELECT_NEW_MODE_TEST_UPDATE_MODE	

	MOVF	CELL,F			;TEST IF ZERO
	SKPNZ
	RETURN
	GOTO	MODE_SELECT_NEW_MODE_TEST_LOOP



MODE_SELECT_NEW_MODE_TEST_UPDATE_MODE:
	MOVFW	CELL
	MOVWF	MODE
	RETURN	



;---------UPDATE MODE DISPLAY-------

MODE_SELECT_DISPLAY_UPDATE:	;UPDATE DISPLAY
		
	MOVF	MODE,W
	SUBLW	D'1'		;IN MODE 1 (MOUSE)
	BTFSC	STATUS,Z
	GOTO	MODE_SELECT_DISPLAY_1

		
	MOVF	MODE,W
	SUBLW	D'2'		;IN MODE 2 (WINAMP)
	BTFSC	STATUS,Z
	GOTO	MODE_SELECT_DISPLAY_2

		
	MOVF	MODE,W
	SUBLW	D'3'		;IN MODE 3 (RADIO)
	BTFSC	STATUS,Z
	GOTO	MODE_SELECT_DISPLAY_3

MODE_SELECT_DISPLAY_1:

	MOVLW	B'11000101'		;SECOND LINE  5 ALONG
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY

	MOVLW	"M"			;DISPLAY "MOUSE"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"O"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"U"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"S"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"E"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	RETURN

MODE_SELECT_DISPLAY_2:

	MOVLW	B'11000101'		;SECOND LINE  5 ALONG
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY

	MOVLW	"W"			;DISPLAY "WINAMP"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"I"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"N"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"A"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"M"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"P"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	RETURN
	

MODE_SELECT_DISPLAY_3:

	MOVLW	B'11000101'		;SECOND LINE  5 ALONG
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY

	MOVLW	"R"			;DISPLAY "RADIO"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"A"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"D"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"I"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"O"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	RETURN
;-------------------------END-----------------------------


;----------------------------------------------------------------------
;----------------------------------------------------------------------
;----------------------------------------------------------------------
;-------------------------MOUSE MODE----------------------------------
;----------------------------------------------------------------------
;----------------------------------------------------------------------
;----------------------------------------------------------------------
MOUSE_MODE:
	CALL 	CLEAR_DISPLAY

	MOVLW	B'10000000'		;FIRST LINE 
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY

	MOVLW	"M"			;DISPLAY "<WINAMP>"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"O"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"U"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"S"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"E"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"M"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"O"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"D"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"E"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	":"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	")"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY




MOUSE_MODE_LOOP
	CALL	GET_PS2_PACKET		;GET FINGER INFO FROM PAD
	CALL	PROCESSES_PACKET	;PROCESS FINGER INFORMATION
	CALL	MOUSE_MODE_TEST_BUTTONS

	CALL	MAKE_MOUSE_PACKET
 
	MOVF 		Z_VAL,W		;MAKE SURE PRESSURE VALUE IS ABOVE 30, IF NOT RETURE
  	ADDLW 	D'226'       
  	SKPNC
	CALL	SEND_RF

	GOTO 	MOUSE_MODE_LOOP


MOUSE_MODE_TEST_BUTTONS
	;BSF	MOUSE_BUT,5


	BTFSC	BUTTON_PORT,BUT3
	BSF	MOUSE_BUT,7
	BTFSS	BUTTON_PORT,BUT3
	BCF	MOUSE_BUT,7


	BTFSC	BUTTON_PORT,BUT4
	BSF	MOUSE_BUT,6
	BTFSS	BUTTON_PORT,BUT4
	BCF	MOUSE_BUT,6

	MOVFW	MOUSE_BUT
	SUBWF	MOUSE_BUT_OLD,W
	BTFSS	STATUS,Z
	CALL	MOUSE_MOUSE_BUTTON_CHANGE
 	
	MOVFW	MOUSE_BUT
	MOVWF	MOUSE_BUT_OLD



	RETURN


MOUSE_MOUSE_BUTTON_CHANGE:
	CALL	MAKE_MOUSE_PACKET
	BSF	PK3,5
	CALL	MAKE_CRC
	CALL	SEND_RF

	RETURN



;----------------------------------------------------------------------
;----------------------------------------------------------------------
;----------------------------------------------------------------------
;-------------------------WINAMP MODE----------------------------------
;----------------------------------------------------------------------
;----------------------------------------------------------------------
;----------------------------------------------------------------------
WINAMP_MODE:
	CALL 	CLEAR_DISPLAY

	MOVLW	B'10000000'		;FIRST LINE 
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY

	MOVLW	"<"			;DISPLAY "<WINAMP>"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"W"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"I"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"N"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"A"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"M"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"P"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	">"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"V"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"o"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"l"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"="
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	
	CALL	WINAMP_MODE_VOLUME

WINAMP_MODE_LOOP:
	
	CALL WINAMP_MODE_BUTTON_TEST

	MOVF	CELL_OLD,F			;TEST IF ZERO, IF NO, SEND BUTTON
	BTFSS	STATUS,Z
	CALL	WINAMP_SEND_BUTTON




	GOTO 	WINAMP_MODE_LOOP


WINAMP_SEND_BUTTON:

	CALL 	MAKE_WINAMP_BUTTON_PACKET
	CALL 	SEND_RF

	CALL	WINAMP_CLEAR_BOTTOM_LINE

	RETURN


WINAMP_MODE_BUTTON_TEST	
	CALL	GET_PS2_PACKET		;GET FINGER INFO FROM PAD
	CALL	PROCESSES_PACKET	;PROCESS FINGER INFORMATION
	CALL	PAD_CELL				;WORKOUT WHICH BUTTON BEING PRESSED
	
	MOVF	CELL,F				;TEST CELL TO SEE IF 0, IF 0 THE RETURN
	SKPNZ			
	RETURN



	MOVLW	D'10'			;CHANGE VOLUME
	SUBWF	CELL,W
	BZ		WINAMP_MODE_VOLUME


	MOVLW	D'11'			;CHANGE POSITION
	SUBWF	CELL,W
	BZ		WINAMP_MODE_POSITION

WINAMP_MODE_BUTTON_TEST_LOOP
	CALL	GET_PS2_PACKET		;GET FINGER INFO FROM PAD
	CALL	PROCESSES_PACKET	;PROCESS FINGER INFORMATION
	CALL	PAD_CELL				;WORKOUT WHICH BUTTON BEING PRESSED

	MOVF	CELL,F				;TEST CELL TO SEE IF 0, IF 0 THE RETURN
	SKPNZ				;
	RETURN



	MOVLW	D'10'			;CHANGE VOLUME
	SUBWF	CELL,W
	BZ		WINAMP_MODE_VOLUME

	MOVFW	CELL
	MOVWF	CELL_OLD				;WILL RETURN WITH LAST CELL POS IN HERE



	MOVLW	D'5'					;PAUSE
	SUBWF	CELL,W
	BZ		WINAMP_MODE_PAUSE

	MOVLW	D'6'					;NEXT
	SUBWF	CELL,W
	BZ		WINAMP_MODE_NEXT
	
	MOVLW	D'4'					;BACK
	SUBWF	CELL,W
	BZ		WINAMP_MODE_BACK
	
	MOVLW	D'3'					;PLAY
	SUBWF	CELL,W
	BZ		WINAMP_MODE_PLAY


	MOVLW	D'1'					;STOP
	SUBWF	CELL,W
	BZ		WINAMP_MODE_STOP

	MOVLW	D'9'					;FAST FORWARD
	SUBWF	CELL,W
	BZ		WINAMP_MODE_FORW

	MOVLW	D'7'					;REWINDE
	SUBWF	CELL,W
	BZ		WINAMP_MODE_REVS





	GOTO	WINAMP_MODE_BUTTON_TEST_LOOP

WINAMP_MODE_PAUSE:

	MOVLW	B'11000001'			
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY
	MOVLW	"P"			;DISPLAY 
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"A"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"U"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"S"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"E"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	GOTO	WINAMP_MODE_BUTTON_TEST_LOOP 

WINAMP_MODE_PLAY:
	MOVLW	B'11000001'			
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY
	MOVLW	"P"			;DISPLAY 
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"L"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"A"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"Y"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY

	GOTO	WINAMP_MODE_BUTTON_TEST_LOOP


WINAMP_MODE_STOP:
	MOVLW	B'11000001'			
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY
	MOVLW	"S"			;DISPLAY 
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"T"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"O"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"P"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY

	GOTO	WINAMP_MODE_BUTTON_TEST_LOOP

WINAMP_MODE_NEXT:
	MOVLW	B'11000001'			
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY
	MOVLW	"N"			;DISPLAY 
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"E"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"X"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"T"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY

	GOTO	WINAMP_MODE_BUTTON_TEST_LOOP


WINAMP_MODE_BACK:
	MOVLW	B'11000001'			
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY
	MOVLW	"B"			;DISPLAY 
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"A"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"C"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"K"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY

	GOTO	WINAMP_MODE_BUTTON_TEST_LOOP

WINAMP_MODE_FORW:
	MOVLW	B'11000001'			
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY
	MOVLW	"F"			;DISPLAY 
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"O"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"R"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"W"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY

	GOTO	WINAMP_MODE_BUTTON_TEST_LOOP


WINAMP_MODE_REVS:
	MOVLW	B'11000001'			
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY
	MOVLW	"R"			;DISPLAY 
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"E"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"V"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"S"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY

	GOTO	WINAMP_MODE_BUTTON_TEST_LOOP


	
WINAMP_MODE_VOLUME:
	MOVLW	B'10001101'			;DISPLAY VOLUME
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY

	MOVF	VERT_S,W
	MOVWF	BIN

	CALL	BINARY_TO_BCD
	
	MOVF	HUNDREDS,W
	ADDLW	H'30'
	CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY

   SWAPF 	TENS_AND_ONES, W
   ANDLW	 H'F'
	ADDLW	H'30'
   CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY      

   MOVF 	TENS_AND_ONES, W
   ANDLW	 H'F'
	ADDLW	H'30'
   CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY  

	CALL	MAKE_WINAMP_VOLUME	;MAKE VOLUME PACKET
	
	CALL	SEND_RF			;SEND IT!!


 
	GOTO	WINAMP_MODE_LOOP





WINAMP_MODE_POSITION:
	MOVLW	B'11000000'			
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY
	MOVLW	"P"			;DISPLAY 
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"O"		
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"S"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"I"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"T"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"I"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"O"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"N"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	":"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"%"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
WINAMP_MODE_POSITION_LOOP:

	CALL	GET_PS2_PACKET		;GET FINGER INFO FROM PAD
	CALL	PROCESSES_PACKET	;PROCESS FINGER INFORMATION
	CALL	PAD_CELL				;WORKOUT WHICH BUTTON BEING PRESSED

	MOVLW	D'11'			;CHANGE POSITION
	SUBWF	CELL,W
	BNZ		WINAMP_CLEAR_BOTTOM_LINE




	MOVLW	B'11001010'			;DISPLAY VOLUME
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY

	MOVF	HORZ_S,W
	MOVWF	BIN

	CALL	BINARY_TO_BCD
	
	MOVF	HUNDREDS,W
	ADDLW	H'30'
	CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY

   SWAPF TENS_AND_ONES, W
   ANDLW	H'F'
	ADDLW	H'30'
   CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY      

   MOVF 	TENS_AND_ONES, W
   ANDLW	H'F'
	ADDLW	H'30'
   CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY 


	CALL	MAKE_WINAMP_POSITION	;MAKE POSITION PACKET
	
	CALL	SEND_RF			;SEND IT!!

	GOTO WINAMP_MODE_POSITION_LOOP


WINAMP_CLEAR_BOTTOM_LINE
	MOVLW D'16'
	MOVWF	COUNTER

	MOVLW	B'11000000'			
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY


WINAMP_CLEAR_BOTTOM_LINE_LOOP:
	MOVLW	" "
	CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY
	DECFSZ	COUNTER,F
	GOTO	WINAMP_CLEAR_BOTTOM_LINE_LOOP



	GOTO WINAMP_MODE_LOOP			;NOTE, ONLY GOES TO MAIN LOOP, MAY CHANGE
	RETURN
	



;----------------------------------------------------------------------
;----------------------------------------------------------------------
;----------------------------------------------------------------------
;-------------------------RADIO MODE----------------------------------
;----------------------------------------------------------------------
;----------------------------------------------------------------------
;----------------------------------------------------------------------
RADIO_MODE:
	
	GOTO	RADIO_MODE


	
MAIN_LOOP:

	
	

	CALL	GET_PS2_PACKET
	CALL	PROCESSES_PACKET

	MOVLW	D'40'

	SUBWF	Z_VAL,W
	
	BTFSC	STATUS,1
	BCF	LED_PORT,Y_LED


	BTFSS	STATUS,1
	BSF	LED_PORT,Y_LED

	MOVLW	B'11000000'		;SECOND LINE
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY

	MOVF	HORZ_S,W
	MOVWF	BIN

	CALL	BINARY_TO_BCD
	
	MOVF	HUNDREDS,W
	ADDLW	H'30'
	CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY

        SWAPF 	TENS_AND_ONES, W
        ANDLW	 H'F'
	ADDLW	H'30'
        CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY      

        MOVF 	TENS_AND_ONES, W
        ANDLW	 H'F'
	ADDLW	H'30'
     	CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY      

	MOVLW	B'10000000'		;FIRST LINE
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY

 	MOVF	VERT_S,W
	MOVWF	BIN

	CALL	BINARY_TO_BCD

	
	MOVF	HUNDREDS,W
	ADDLW	H'30'
	CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY


        SWAPF 	TENS_AND_ONES, W
        ANDLW	 H'F'
	ADDLW	H'30'
        CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY      

        MOVF 	TENS_AND_ONES, W
        ANDLW	 H'F'
	ADDLW	H'30'
     	CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY 

	MOVLW	B'10001101'		;TOP LINE, 13 THOUGH
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY

	MOVF	Z_VAL,W
	MOVWF	BIN

	CALL	BINARY_TO_BCD

	
	MOVF	HUNDREDS,W
	ADDLW	H'30'
	CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY


        SWAPF 	TENS_AND_ONES, W
        ANDLW	 H'F'
	ADDLW	H'30'
        CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY      

        MOVF 	TENS_AND_ONES, W
        ANDLW	 H'F'
	ADDLW	H'30'
     	CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY 


	MOVLW	B'11001101'		;BOTTOM LINE, 13 THOUGH
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY

	CALL 	PAD_CELL
	MOVF	CELL,W
	ADDLW	H'30'
	CALL	WRITE_LCD_DR
	CALL 	LCD_BUSY

	GOTO MAIN_LOOP
;---------------------------------------------------------------------	


	
;;;;;;;;ON INTERUPT, GET BYTE;;;;;;;;;;;

;----------------------------
GETBYTE2:
	MOVLW 	D'8'
	MOVWF 	CURRENTBIT	
	MOVLW 	D'121'	;;delay ONE AND A HALF a bits.. ops (already done about 6)
	NOP
	MOVWF	DELAYT
	CALL 	DELAY

BITLOOP:
	RRF 	RSRECV,1	;---MOVE ALL BITS TO THE RIGHT SO NEXT ONE CAN MOVE IN--
	BTFSS 	RSPORT,RSRE
	BSF 	RSRECV,7	;----SET TO 1-----
	BTFSC 	RSPORT,RSRE
	BCF 	RSRECV,7	;----SET TO 0-----

	
	MOVLW 	D'79'	;;delay ONE bit..250 ops (already done 4)
	MOVWF 	DELAYT
	CALL 	DELAY
	DECFSZ 	CURRENTBIT,F	;DECREMENT BIT COUNTER, EXIT IF O
	GOTO 	BITLOOP
	
	MOVLW	D'85'
	SUBWF	RSRECV,W
	BTFSC	STATUS,2
	CALL 	GET_PS2_PACKET
	

	RETURN
	;----CANT BE ARSED TO READ STOP BIT-----
;------------------------------
;------------SEND BYTE----------------------
SENDBYTE:
	MOVLW 	D'8'
	MOVWF 	CURRENTBIT	;SETUP BIT COUNTER
	BCF 	RSPORT,RSTX	;start bit
	NOP

	MOVLW 	D'171'	;;delay ONE bit..250 ops (already done 5)
	MOVWF 	DELAYT
	CALL 	DELAY
SENDBITLOOP:
	BTFSS 	RSSEND,0
	BCF 	RSPORT,RSTX
	NOP

	BTFSC 	RSSEND,0
	BSF 	RSPORT,RSTX

	RRF 	RSSEND,1	;RIGHT SHIFT SEND BYTE, BYTE IS DESTROYED!
	NOP
	MOVLW 	D'169'	;;delay ONE bit..250 ops (already done 5)
	MOVWF 	DELAYT
	CALL 	DELAY
	
	DECFSZ 	CURRENTBIT,1	;DECREMENT BIT COUNTER, EXIT IF O
	GOTO 	SENDBITLOOP		;LOOP
	
	BSF 	RSPORT,RSTX  	;STOP BIT
	MOVLW 	D'150'
	MOVWF 	DELAYT
	CALL 	DELAY

	RETURN

;------------------------------------------------------------------
;-----------------------------PS2 ROUTINES-------------------------
;------------------------------------------------------------------

;------100US TIMEOUT-----
WAIT_TILL_CLK_LOW:			
	MOVLW	D'100'			;TIMEOUT AFTER ABOUT 100US
	MOVWF	TIMEOUT_TIMER
LOW_LOOP:
	
	BTFSS	PS2PORT,PS2CLOCK
	RETURN


	DECFSZ	TIMEOUT_TIMER,F
	GOTO	LOW_LOOP
	
	GOTO 	TIMEOUT
	
;;


WAIT_TILL_CLK_HIGH:
	MOVLW	D'100'			;TIMEOUT AFTER ABOUT 100US
	MOVWF	TIMEOUT_TIMER
HIGH_LOOP:
	
	BTFSC	PS2PORT,PS2CLOCK
	RETURN


	DECFSZ	TIMEOUT_TIMER,F
	GOTO	HIGH_LOOP
	
	GOTO 	TIMEOUT

;;------------10MS TIMEOUT---------------

WAIT_TILL_CLK_LOW_10TIMEOUT:		;TIMEOUT AFTER ABOUT ABOUT 13MS
	MOVLW	D'50'
	MOVWF	DELAYT
	MOVLW	D'100'		
	MOVWF	TIMEOUT_TIMER	
LOW_LOOP_10:
	
LOW_LOOP_101:
	
	BTFSS	PS2PORT,PS2CLOCK
	RETURN
	
	DECFSZ	TIMEOUT_TIMER,f
	GOTO 	LOW_LOOP_101

	DECFSZ	DELAYT,f
	GOTO 	LOW_LOOP_10
	RETURN
;;-------

;;------------30MS TIMEOUT---------------

WAIT_TILL_CLK_LOW_30TIMEOUT:		;TIMEOUT AFTER ABOUT ABOUT 30MS
	MOVLW	D'120'
	MOVWF	DELAYT
	MOVLW	D'100'		
	MOVWF	TIMEOUT_TIMER	
LOW_LOOP_30:
	
LOW_LOOP_301:
	
	BTFSS	PS2PORT,PS2CLOCK
	RETURN
	
	DECFSZ	TIMEOUT_TIMER,f
	GOTO 	LOW_LOOP_301

	DECFSZ	DELAYT,f
	GOTO 	LOW_LOOP_30
	RETURN
;;-------



TIMEOUT:
	BCF	PARITY,1	;SET TIMOUT BIT
	RETURN			;RETURN TO CALLER

;-------------
DO_PARITY:			;WORKS OUT ODD PARITY
	BTFSC	PARITY,0	
	GOTO 	SET_P_0

	;BTFSC	PARITY,0	
	BSF	PARITY,0
	RETURN
SET_P_0:
	BCF	PARITY,0
	RETURN
;---------------------

PS2OUTPUT:
	;CALL DELAY_1MS
	;CALL DELAY_1MS
        
	BSF     STATUS, RP0		;MEM1
	BCF	PS2TRIS,PS2CLOCK
	NOP
	BSF	PS2TRIS,PS2DATA
	BCF     STATUS, RP0		;MEM0
	
	BCF	PS2PORT,PS2CLOCK		;PULL CLK LOW ...
	
	MOVLW 	D'82'		;DELAY CLK LOW FOR 100US
	MOVWF 	DELAYT
	CALL 	DELAY

	;


        BSF     STATUS, RP0	;RELEASE CLK SO DEVICE CAN PULSE,CLOCK NOW AS INPUT
	BSF	PS2TRIS,PS2CLOCK
	NOP
	BCF	PS2TRIS,PS2DATA
	BCF     STATUS, RP0
	
	BCF	PS2PORT,PS2DATA		;PULL DATALINE LOW
	
	MOVLW 	D'8'		;READY TO OUTPUT BYTE, SETUP COUNTER
	MOVWF 	CURRENTBIT	
	BCF 	PARITY,0		;ZERO PARITY BIT

	CALL WAIT_TILL_CLK_LOW_10TIMEOUT	;WAIT IN REQUEST TO SEND STATE FOR 15MS

PS2_BYTE_OUT:
	CALL WAIT_TILL_CLK_LOW	
	NOP
	NOP	;WAIT A BIT OF TIME
	NOP

	BTFSC	PS2OUT,0		;OUTPUT BIT
	BSF	PS2PORT,PS2DATA

	BTFSS	PS2OUT,0		;OUTPUT BIT
	BCF	PS2PORT,PS2DATA


	BTFSC	PS2OUT,0		;PARITY
	CALL 	DO_PARITY


	RRF	PS2OUT,F	;ROTATE RIGHT PS2OUT

	CALL 	WAIT_TILL_CLK_HIGH
	DECFSZ 	CURRENTBIT,F	;DECREMENT BIT COUNTER, EXIT IF O
	GOTO 	PS2_BYTE_OUT


	CALL 	WAIT_TILL_CLK_LOW		;OUTPUT PARITY BIT
	
	BTFSS	PARITY,0		
	BSF	PS2PORT,PS2DATA

	BTFSC	PARITY,0		
	BCF	PS2PORT,PS2DATA


	CALL 	WAIT_TILL_CLK_HIGH
	CALL	WAIT_TILL_CLK_LOW		;STOP BIT

  	BSF     STATUS, RP0			;RELASE CLK AND DATA, SO PULLED TO HIGH
	BSF	PS2TRIS,PS2CLOCK
	NOP
	BSF	PS2TRIS,PS2DATA
	BCF     STATUS, RP0

	CALL 	WAIT_TILL_CLK_HIGH
	CALL	WAIT_TILL_CLK_LOW
	CALL 	WAIT_TILL_CLK_HIGH

	;FINSHED!
	RETURN
;----------------------END OF PS2 OUTPUT------------------------------------
WAIT_TILL_CLK_LOW_FOREVER		;DONT USE THIS
	
	BTFSS	PS2PORT,PS2CLOCK
	RETURN
	GOTO 	WAIT_TILL_CLK_LOW_FOREVER


;-------------------------READ PS2------------------------
PS2INPUT:

	CALL	WAIT_TILL_CLK_LOW_30TIMEOUT
	
	BTFSC	PS2PORT,PS2DATA			;READ START BIT, IF NOT '0' THEN RETURN
	NOP
	;CALL	ERROR
	
	CALL	WAIT_TILL_CLK_HIGH

	MOVLW 	D'8'		;SETUP COUNTER
	MOVWF 	CURRENTBIT	
PS2_BYTE_IN:
	CALL	WAIT_TILL_CLK_LOW
	RRF	PS2IN,F
	BTFSC	PS2PORT,PS2DATA		;READ IN BITS
	BSF	PS2IN,7

	BTFSS	PS2PORT,PS2DATA		;READ IN BITS
	BCF	PS2IN,7
	
	
	CALL	WAIT_TILL_CLK_HIGH
	
	DECFSZ 	CURRENTBIT,F	;DECREMENT BIT COUNTER, EXIT IF O
	GOTO 	PS2_BYTE_IN

	CALL	WAIT_TILL_CLK_LOW
	CALL	WAIT_TILL_CLK_HIGH
	CALL	WAIT_TILL_CLK_LOW
	CALL	WAIT_TILL_CLK_HIGH
	
	;MOVF	PS2IN,W
	;MOVWF	SEND
	;CALL 	SENDBYTE
	RETURN
;----------------------DOHHHHHH---------------------
DELAY_1MS:
	MOVF	DELAYT,W
	MOVWF	TEMP1

	MOVLW	D'20'
	MOVWF	DELAYT
DELAY_1MS_1
	CALL DELAY_50US
	DECFSZ	DELAYT,F
	GOTO DELAY_1MS_1

	MOVF	TEMP1,W
	MOVWF	DELAYT

	RETURN

;--
DELAY_50US:
	MOVF	DELAYT,W
	MOVWF	TEMP

	MOVLW	D'48'
	MOVWF	DELAYT
DELAY_50US_1

	NOP
	NOP
	DECFSZ	DELAYT,F
	GOTO DELAY_50US_1


	MOVF	TEMP,W
	MOVWF	DELAYT
	RETURN
;--
DELAY_100MS
	MOVF	DELAYT,W
	MOVWF	TEMP2

	MOVLW	D'100'
	MOVWF	DELAYT
DELAY_100MS_1:
	CALL	DELAY_1MS

	DECFSZ	DELAYT,F
	GOTO DELAY_100MS_1

	MOVF	TEMP2,W
	MOVWF	DELAYT
	RETURN




;------------------------------------------------

ENABLE:
	MOVLW	H'F4'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT
	NOP
	NOP
	CALL 	PS2INPUT
	RETURN

RESET_PS2:
	MOVLW	H'E8'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT

	CALL PS2INPUT
;;
		
	MOVLW	H'03'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT

	CALL PS2INPUT
;;
	MOVLW	H'E8'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT

	
	CALL PS2INPUT
;;
	MOVLW	H'00'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT

	CALL PS2INPUT
;;
	MOVLW	H'E8'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT

	CALL PS2INPUT
;;
	MOVLW	H'00'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT

	
	CALL PS2INPUT
;;
	MOVLW	H'E8'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT


	CALL PS2INPUT
;;
	MOVLW	H'00'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT


	CALL PS2INPUT
;;
	MOVLW	H'F3'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT

	CALL PS2INPUT
;;
	MOVLW	H'14'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT

	CALL PS2INPUT
;;
	MOVLW	H'F4'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT

	CALL PS2INPUT	
	
	MOVLW	H'F0'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT

	CALL PS2INPUT

	RETURN

GET_PS2_PACKET:
	;BSF	LED_PORT,R_LED
	MOVLW	H'EB'
	MOVWF	PS2OUT
	CALL	PS2OUTPUT
	
	CALL 	PS2INPUT


	CALL 	PS2INPUT
	MOVF	PS2IN,W
	MOVWF	P1

	CALL 	PS2INPUT
	MOVF	PS2IN,W
	MOVWF	P2

	CALL 	PS2INPUT
	MOVF	PS2IN,W
	MOVWF	P3

	CALL 	PS2INPUT
	MOVF	PS2IN,W
	MOVWF	P4

	CALL 	PS2INPUT
	MOVF	PS2IN,W
	MOVWF	P5

	CALL 	PS2INPUT
	MOVF	PS2IN,W
	MOVWF	P6
	;BCF	LED_PORT,R_LED
	
;---

	;MOVF	P1,W
	;MOVWF	RSSEND
	;CALL	SENDBYTE
	;MOVF	P2,W
	;MOVWF	RSSEND
	;CALL	SENDBYTE
	;MOVF	P3,W
	;MOVWF	RSSEND
	;CALL	SENDBYTE
	;MOVF	P4,W
	;MOVWF	RSSEND
	;CALL	SENDBYTE
	;MOVF	P5,W
	;MOVWF	RSSEND
	;CALL	SENDBYTE
	;MOVF	P6,W
	;MOVWF	RSSEND
	;CALL	SENDBYTE


	RETURN

PROCESSES_PACKET:
	;------------Y POS------------
	MOVF	P6,W
	MOVWF	YPOS_L
	RRF	YPOS_L,F		;LOW BITS 7-2
	RRF	YPOS_L,F	

	BTFSC	P2,4			;LOW BIT 8
	BSF	YPOS_L,6
	BTFSS	P2,4			;LOW BIT 8
	BCF	YPOS_L,6

	BTFSC	P2,5			;LOW BIT 9
	BSF	YPOS_L,7
	BTFSS	P2,5			;LOW BIT 9
	BCF	YPOS_L,7

	MOVF	P2,W
	MOVWF	YPOS_H			;HIGH BITS 11-10
	SWAPF	YPOS_H,F
	RRF	YPOS_H,F
	RRF	YPOS_H,F
	MOVLW	B'00000011'
	ANDWF	YPOS_H,F


	BTFSC	P4,5			;HIGH BIT 12
	BSF	YPOS_H,2	
	BTFSS	P4,5			;HIGH BIT 12
	BCF	YPOS_H,2

	;---8 BIT Y POS--
	MOVF	YPOS_L,W
	MOVWF	YPOS_8
	RRF	YPOS_8,F
	RRF	YPOS_8,F
	RRF	YPOS_8,F
	MOVLW	B'00011111'
	ANDWF	YPOS_8,F
	SWAPF	YPOS_H,W
	MOVWF	TEMP
	RLF	TEMP,W
	ANDLW	B'11100000'
	IORWF	YPOS_8,F
	

;	----------------


	;------------X POS------------
	MOVF	P5,W
	MOVWF	XPOS_L
	RRF	XPOS_L,F		;LOW BITS 7-2
	RRF	XPOS_L,F	


	BTFSC	P2,0			;LOW BIT 8
	BSF	XPOS_L,6
	BTFSS	P2,0			;LOW BIT 8
	BCF	XPOS_L,6

	BTFSC	P2,1			;LOW BIT 9
	BSF	XPOS_L,7
	BTFSS	P2,1			;LOW BIT 9
	BCF	XPOS_L,7
	
	MOVF	P2,W			;HIGH BITS 11-10
	MOVWF	XPOS_H
	RRF	XPOS_H,F
	RRF	XPOS_H,F

	MOVLW	B'00000011'
	ANDWF	XPOS_H,F


	BTFSC	P4,4			;HIGH BIT 12
	BSF	XPOS_H,2	
	BTFSS	P4,4			;HIGH BIT 12
	BCF	XPOS_H,2
X8
	;---8 BIT X POS--
	MOVF	XPOS_L,W
	MOVWF	XPOS_8
	RRF	XPOS_8,F
	RRF	XPOS_8,F
	RRF	XPOS_8,F
	MOVLW	B'00011111'
	ANDWF	XPOS_8,F
	SWAPF	XPOS_H,W
	MOVWF	TEMP
	RLF	TEMP,W
	ANDLW	B'11100000'
	IORWF	XPOS_8,F

;----Z, PRESSURE VALUE---
	MOVF	P3,W
	MOVWF	Z_VAL



	;MOVF	XPOS_L,W
	;MOVWF	RSSEND
	;CALL	SENDBYTE
	
	;MOVF	XPOS_H,W
	;MOVWF	RSSEND
	;CALL	SENDBYTE

	;MOVF	YPOS_L,W
	;MOVWF	RSSEND
	;CALL	SENDBYTE
	
	;MOVF	YPOS_H,W
	;MOVWF	RSSEND
	;CALL	SENDBYTE

	RETURN
;------------------------------------------------------------------
;------------------------------------------------------------------
;-----------------------------LCD ROUTINES-------------------------
;------------------------------------------------------------------
;------------------------------------------------------------------

PULSE_E:				;PULSE ENABLE OF LCD
	BSF	LCDPORT,LCDE
	NOP
	NOP
	NOP
	NOP	

	BCF	LCDPORT,LCDE
	RETURN

;---------------------

WRITE_LCD_IR:
       
	BSF     STATUS, RP0		;MEM1	;SET TO OUTPUT
	CLRF	P8TRIS
	BCF     STATUS, RP0		;MEM0
	NOP
	BCF	LCDPORT,LCDRW
	NOP
	BCF	LCDPORT,LCDRS


	MOVWF	P8PORT
	NOP
	CALL	PULSE_E

	BSF     STATUS, RP0		;MEM1	;SET YO INPUT
	MOVLW	H'FF'
	MOVWF	P8TRIS
	BCF     STATUS, RP0		;MEM0

	RETURN


;----------------
WRITE_LCD_DR:
       
	BSF     STATUS, RP0		;MEM1	;SET TO OUTPUT
	CLRF	P8TRIS
	BCF     STATUS, RP0		;MEM0
	NOP
	BCF	LCDPORT,LCDRW
	NOP
	BSF	LCDPORT,LCDRS

	MOVWF	P8PORT
	NOP
	CALL	PULSE_E

	BSF     STATUS, RP0		;MEM1	;SET YO INPUT
	MOVLW	H'FF'
	MOVWF	P8TRIS
	BCF     STATUS, RP0		;MEM0
	NOP
	BCF	LCDPORT,LCDRW
	NOP
	BCF	LCDPORT,LCDRS
	NOP
	RETURN
;---------------------
LCD_BUSY:				;WAIT TILL LCD NOT BUSY
	       
	;BSF     STATUS, RP0		;MEM1	;SET TO INPUT
	;MOVLW	H'FF'
	;MOVWF	P8TRIS
	;BCF     STATUS, RP0		;MEM0
	;NOP
	;BSF	LCDPORT,LCDRW
	;NOP
	;BCF	LCDPORT,LCDRS
	;NOP
LCD_BUSY1:
	;BTFSC	P8PORT,7
	NOP	
	;GOTO 	LCD_BUSY1
	CALL DELAY_1MS
	;BCF	LCDPORT,LCDRW
	;BCF	LCDPORT,LCDRS

	RETURN
;--------------------
SETUP_LCD:
	CALL LCD_BUSY
	MOVLW	B'00111000'			;8 BIT, 2 LINES

	CALL	WRITE_LCD_IR

	CALL DELAY_1MS				;WAIT 5MS
	CALL DELAY_1MS
	CALL DELAY_1MS
	CALL DELAY_1MS
	CALL DELAY_1MS

	CALL LCD_BUSY				;WAIT TILL NOT BUSY

	MOVLW	B'00001100'			;DISPLAY ON, CURSOR OFF BLINKING OFF
	CALL	WRITE_LCD_IR
	CALL LCD_BUSY				;WAIT TILL NOT BUSY


	CALL DELAY_1MS
	CALL DELAY_1MS

	MOVLW	B'00000010'			;RETURN HOME
	CALL	WRITE_LCD_IR
	CALL LCD_BUSY	

	MOVLW	B'00000001'			;CLEAR DISPLAY
	CALL	WRITE_LCD_IR
	CALL LCD_BUSY	

	RETURN

CLEAR_DISPLAY
	MOVLW	B'00000001'			;CLEAR DISPLAY AND RETURN SCREEN
	CALL	WRITE_LCD_IR
	CALL LCD_BUSY

	MOVLW	B'00000010'			;CLEAR DISPLAY AND RETURN SCREEN
	CALL	WRITE_LCD_IR
	CALL LCD_BUSY
	RETURN
	
;---------
BINARY_TO_BCD:                     
	  CLRF HUNDREDS
	  SWAPF BIN, W
	  ADDWF BIN, W
	  ANDLW B'00001111'
	  SKPNDC
	  ADDLW 0X16
	  SKPNDC
	  ADDLW 0X06
	  ADDLW 0X06
	  SKPDC
	  ADDLW -0X06
	  BTFSC BIN,4
	  ADDLW 0X16 - 1 + 0X6
	  SKPDC
	  ADDLW -0X06
	  BTFSC BIN,5
	  ADDLW 0X30
	  BTFSC BIN, 6
	  ADDLW 0X60
	  BTFSC BIN,7
	  ADDLW 0X20
	  ADDLW 0X60
	  RLF HUNDREDS, F
	  BTFSS HUNDREDS, 0
	  ADDLW -0X60
	  MOVWF TENS_AND_ONES
	  BTFSC BIN,7
	  INCF HUNDREDS, F
	  RETURN

STARTUP_MESSAGE:

	CALL	CLEAR_DISPLAY
	MOVLW	B'10001011'		;FIRST LINE 11 THOUGH
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY



	MOVLW	"E"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"M"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"I"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"L"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"E"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"S"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY


	MOVLW	B'11001011'		;SECOND LINE 11 THOUGH
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY


	MOVLW	"R"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"E"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"M"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"O"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"T"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY
	MOVLW	"E"
	CALL	WRITE_LCD_DR
	CALL LCD_BUSY

	MOVLW	D'11'
	MOVWF	TEMP_LOOP
SHIFT_DISPLAY_LOOP_LEFT

	MOVLW	B'00011000'		;SHIFT DISPLAY LEFT 11
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY
	
	CALL	DELAY_100MS
	CALL	DELAY_100MS

	BTFSC	BUTTON_PORT,BUT2
	return

	DECFSZ	TEMP_LOOP,F
	GOTO SHIFT_DISPLAY_LOOP_LEFT

	MOVLW	D'5'
	MOVWF	TEMP_LOOP

SHIFT_DISPLAY_LOOP_RIGHT

	MOVLW	B'00011100'		;SHIFT DISPLAY RIGHT 
	CALL	WRITE_LCD_IR
	CALL 	LCD_BUSY
	
	CALL	DELAY_100MS
	CALL	DELAY_100MS

	BTFSC	BUTTON_PORT,BUT2
	return
	
	DECFSZ	TEMP_LOOP,F
	GOTO SHIFT_DISPLAY_LOOP_RIGHT

	CALL	DELAY_100MS		;WAIT 1 SECOND
	CALL	DELAY_100MS
	CALL	DELAY_100MS
	CALL	DELAY_100MS


	RETURN


PAD_CELL:			;CALCULATE WHICH BUTTON OR SCROLL IS BEING PRESSED
 	CLRF	CELL		;NO BUTTON PRESSED...


	BCF	LED_PORT,R_LED


  	MOVF 	Z_VAL,W		;MAKE SURE PRESSURE VALUE IS ABOVE 20, IF NOT RETURE
  	ADDLW 	D'236'   ;Z ONLY ABOVE 20 FOR HSCROLL    
  	SKPC
  	RETURN


	MOVF 	YPOS_8,W		;IF Y POS IF LESS THAN 55, GOTO H SCROLL
  	ADDLW 	D'199'       	
  	SKPC
  	GOTO 	H_SCROLL



  	MOVF 	Z_VAL,W		;MAKE SURE PRESSURE VALUE IS ABOVE 30, IF NOT RETURE
  	ADDLW 	D'226'       
  	SKPC
  	RETURN

	BSF	LED_PORT,R_LED



  	MOVF 	XPOS_8,W		;IF X POS IS GREATER THAN 150, GOTO V SCROLL
  	ADDLW 	D'105'           
  	SKPNC
  	GOTO 	V_SCROLL

	;--START OF CELL CALCULATION
	MOVF 	XPOS_8,W
	ADDLW 	D'142'            ; IF X > 113, GOTO COLUMB 3
	SKPNC
	GOTO 	COL_3

	MOVF 	XPOS_8,W
	ADDLW 	D'175'            ; IF X > 80, GOTO COLUMB 2
	SKPNC
	GOTO 	COL_2

	GOTO 	COL_1		;IF GOT HERE MUST BE IN COLUMB1

H_SCROLL:
	MOVLW	D'11'		;H SCROLL CODE
	MOVWF	CELL
	
	MOVF	XPOS_8,W
	SUBLW	D'35'		;NORMALISE..
	MOVWF	HORZ_S		;PUT VALUE INTO MEM
	COMF	HORZ_S,F	

	RETURN
V_SCROLL:
	MOVLW	D'10'		;V SCROLL CODE
	MOVWF	CELL
	
	MOVF	YPOS_8,W
	SUBLW	D'56'		;NORMALISE..
	MOVWF	VERT_S		;PUT VALUE INTO MEM
	COMF	VERT_S,F
	RETURN

COL_3:
	MOVF 	YPOS_8,W
	ADDLW 	D'170'            ; IF Y < 85, IN ROW 3
	SKPC
	GOTO	CELL_3_1

	MOVF 	YPOS_8,W
	ADDLW 	D'135'            ; IF Y < 120, IN ROW 2
	SKPC
	GOTO	CELL_3_2

CELL_3_3:
	MOVLW 	D'3'
	MOVWF	CELL
	RETURN

CELL_3_2:
	MOVLW 	D'6'
	MOVWF	CELL
	RETURN
CELL_3_1:
	MOVLW 	D'9'
	MOVWF	CELL
	RETURN
	
	

COL_2:

	MOVF 	YPOS_8,W
	ADDLW 	D'170'            ; IF Y < 85, IN ROW 3
	SKPC
	GOTO	CELL_2_1

	MOVF 	YPOS_8,W
	ADDLW 	D'135'            ; IF Y < 120, IN ROW 2
	SKPC
	GOTO	CELL_2_2

CELL_2_3:
	MOVLW 	D'2'
	MOVWF	CELL
	RETURN

CELL_2_2:
	MOVLW 	D'5'
	MOVWF	CELL
	RETURN
CELL_2_1:
	MOVLW 	D'8'
	MOVWF	CELL
	RETURN





COL_1:

	MOVF 	YPOS_8,W
	ADDLW 	D'170'            ; IF Y < 85, IN ROW 3
	SKPC
	GOTO	CELL_1_1

	MOVF 	YPOS_8,W
	ADDLW 	D'135'            ; IF Y < 120, IN ROW 2
	SKPC
	GOTO	CELL_1_2

CELL_1_3:
	MOVLW 	D'1'
	MOVWF	CELL
	RETURN

CELL_1_2:
	MOVLW 	D'4'
	MOVWF	CELL
	RETURN
CELL_1_1:
	MOVLW 	D'7'
	MOVWF	CELL


	
	RETURN




;----------------------------------------------
;---------------MAKE PACKET ROUTINES------------
;----------------------------------------------

CLEAR_PACKETS:
	CLRF	PK1
	CLRF	PK2
	CLRF	PK3
	CLRF	PK4
	RETURN


MAKE_MOUSE_PACKET:
	CALL	CLEAR_PACKETS

	MOVFW	XPOS_H
	MOVWF	PK1
	
	MOVFW	XPOS_L
	MOVWF	PK2

	MOVFW	YPOS_H
	MOVWF	PK3

	MOVFW	YPOS_L
	MOVWF	PK4

	BSF	PK1,7			;SET TO MODE "MOUSE"

	MOVFW	MOUSE_BUT
	XORWF	PK3,F			;SET MOUSE BUTTON STUFF

	CALL	MAKE_CRC

	RETURN



MAKE_WINAMP_VOLUME:
	CLRF	PK1
	BSF	PK1,6			;SET TO MODE "WINAMP"
	CLRF	PK3
	BSF	PK3,7			;SET TO MODE VOLUME

	MOVFW	VERT_S
	MOVWF	PK2			;PUT VOLUME VALUE INTO PK2
					;DOMT CARE ABOUT OTHER PACKETS
	CALL	MAKE_CRC

	RETURN

MAKE_WINAMP_POSITION
	CLRF	PK1
	BSF	PK1,6			;SET TO MODE "WINAMP"
	CLRF	PK3
	BSF	PK3,5			;SET TO MODE POS

	MOVFW	HORZ_S
	MOVWF	PK2			;PUT VOLUME VALUE INTO PK2
					;DOMT CARE ABOUT OTHER PACKETS
	CALL	MAKE_CRC


	RETURN



MAKE_WINAMP_BUTTON_PACKET:
	CLRF	PK1
	BSF	PK1,6			;SET TO MODE "WINAMP"
	CLRF	PK3
	BSF	PK3,6			;SET TO MODE BUTTON

	MOVFW	CELL_OLD
	MOVWF	PK2			;PUT CELL NUMBER INTO PK2

	CALL MAKE_CRC

	CLRF	CELL_OLD		;DONE SO STOPS SENDING.....JUST BELIVE IT

	RETURN


MAKE_CRC:
					;NOTE PK1 AND PK3 HAVE BEEN XORED WITH D'85'!!!!!
	MOVLW 	D'85'
	XORWF	PK1,F			;CHANCE OF STRING OF 000 IS HIGHER CHANCE, SO XOR


	MOVLW 	D'85'
	XORWF	PK3,F


	MOVFW	PK1			;ERROR CHECKINGGGGGG
	XORWF	PK2,W
	MOVWF	CRC_1

	MOVFW	PK3
	XORWF	PK4,W
	MOVWF	CRC_2

	RETURN



;----------------------------------------------
;---------------send rf packet-----------------
;----------------------------------------------
SEND_RF:
	BSF	LED_PORT,Y_LED		;YELLOW LED ON
	BSF	RFPORT,RFDATA		;START BIT
	CALL	DELAY_50US
	CALL	DELAY_50US
	CALL	DELAY_50US
	CALL	DELAY_50US
	MOVLW	D'13'
	MOVWF	DELAYT
	CALL	DELAY
	BCF	RFPORT,RFDATA
	CALL	DELAY_50US
	CALL	DELAY_50US
	CALL	DELAY_50US
	CALL	DELAY_50US
	MOVLW	D'13'
	MOVWF	DELAYT
	CALL	DELAY
	BSF	RFPORT,RFDATA
	CALL	DELAY_50US
	CALL	DELAY_50US
	CALL	DELAY_50US
	CALL	DELAY_50US
	MOVLW	D'13'
	MOVWF	DELAYT
	CALL	DELAY
	BCF	RFPORT,RFDATA
	CALL	DELAY_50US
	CALL	DELAY_50US
	CALL	DELAY_50US
	CALL	DELAY_50US
	MOVLW	D'13'
	MOVWF	DELAYT
	CALL	DELAY
	BSF	RFPORT,RFDATA		;____--__--__--
	CALL	DELAY_50US
	CALL	DELAY_50US
	CALL	DELAY_50US
	CALL	DELAY_50US
	MOVLW	D'0'			;MOVE 0
	MOVWF	PKNUM			;MOVE ADRESS TO TEMP FOR INDIRECT MEMORY ACCESS


SEND_RF_LOOP:
	MOVFW	PKNUM
	ADDLW	PK1
	MOVWF	FSR
	MOVFW	INDF
	MOVWF	PKTEMP

	MOVLW	D'8'	
	MOVWF	CURRENTBIT
SEND_RF_LOOP1:
	
	BTFSS 	PKTEMP,7
	BCF 	RFPORT,RFDATA
	NOP

	BTFSC 	PKTEMP,7
	BSF 	RFPORT,RFDATA

	RLF 	PKTEMP,1

	CALL	DELAY_50US
	CALL	DELAY_50US
	CALL	DELAY_50US
	CALL	DELAY_50US
	MOVLW	D'10'
	MOVWF	DELAYT
	CALL	DELAY

	
	DECFSZ 	CURRENTBIT,1	;DECREMENT BIT COUNTER, EXIT IF O
	GOTO 	SEND_RF_LOOP1
	
	INCF	PKNUM,F		;NEXT PACKET
	MOVLW	D'6'	
	SUBWF	PKNUM,W
	

	BTFSS	STATUS,Z
	GOTO 	SEND_RF_LOOP

	BCF	RFPORT,RFDATA	;STOP BIT
	BCF	LED_PORT,Y_LED		;YELLOW LED ON

	RETURN


UPDATE_LCD_BL:


	MOVFW	VERT_S
	ADDWF	VERT_S,W
	ADDWF	VERT_S,W

	MOVWF	CCPR1L

	MOVF 	VERT_S,W
	ADDLW 	D'171'            
	SKPC
	RETURN

	MOVLW	H'FF'



	MOVWF	CCPR1L
	RETURN


	END