Handmades

#include <pic12f629.h>

#define CONFIG_WORD _CP_OFF & _MCLRE_OFF & _WDT_OFF & _INTRC_OSC_NOCLKOUT

unsigned int at 0x2007  __CONFIG = CONFIG_WORD;

void initialize()
{
_asm
	call	3ffh
	movwf 	OSCCAL
_endasm;

	CMCON = 0x7;
	TRISIO = 0x18;
}

void sleep(int tim)
{
	unsigned int i;
	unsigned int j;
	for (i=0; i<tim; i++)
		for (j=0; j<0xff; j++)
			;
}

readee(unsigned char ptr)
{
	EEADR = ptr;
	RD = 1;
	return EEDATA;
}

void writeee(unsigned char ptr, unsigned char value)
{
	// Set value and address
	EEDATA = value;		
	EEADR = ptr;

	// EEPROM MOJO
_asm
	bsf	EECON1_ADDR, 2		; Enable write: WREN = 2
	bcf	INTCON_ADDR, 7		; Disable INTs: GIE = 7
	movlw	0x55
	movwf	EECON2_ADDR
	movlw	0xaa
	movwf	EECON2_ADDR
	bsf	EECON1_ADDR, 1		; Start the write: WR = 1
	bcf	EECON1_ADDR, 2		; Disable write:   WREN = 2
	bsf	INTCON_ADDR, 7		; Enable INTS:     GIE = 7
_endasm;

}

#define MAXKEYBOUNCE	64
#define CURRPROG	0

unsigned char upcount;
unsigned char dncount;
unsigned char currprog;

void output()
{
	GPIO = (currprog & 0x7) | ((currprog & 0x8) << 2);
	writeee(0, currprog);
}

main()
{
	initialize();

	currprog = readee(0);
	upcount = 0;
	dncount = 0;

	output();

	while (1) {
		if (!GP4) {
			if (upcount > MAXKEYBOUNCE)
				continue;

			upcount++;
			if (upcount > MAXKEYBOUNCE) {
				++currprog;
				output();
			}
			continue;
		}

		upcount = 0;

		if (!GP3) {
			if (dncount > MAXKEYBOUNCE)
				continue;

			dncount++;
			if (dncount > MAXKEYBOUNCE) {
				--currprog;
				output();
			}
			continue;
		} 

		dncount = 0;
	}
}