PIC problem sa dugmadima

[Vuzee01]

Pozz svima, imam ovaj kod za PIC:

Code: Select all

#include <PIC.h>
#include "util.h"

__CONFIG(CP_OFF & WDTE_OFF & PWRTE_OFF & BOREN_OFF & FOSC_XT & CPD_OFF & LVP_OFF);

#define GORE RB0
#define DOLE RB1
#define LEVO RB2
#define DESNO RB3
#define STISNI RB4
#define PUSTI RB5
#define NAPRED RD0
#define NAZAD RD1
#define LEVOT RD2
#define DESNOT RD3


void resettockove() {
	RD4 = 0;
	RD5 = 0;
	RD6 = 0;
	RD7 = 0;
}

void kretanje(int kuda) {

	if(kuda == 1) { //napred
		RD4 = 1;
		RD6 = 1;
	//	RD5 = 0;
	//	RD7 = 0;
	}

}

void main(void) {
	PORTB = 0;
	PORTD = 0;
	TRISB = 0;
	TRISD = 0;
	while(1) {
		resettockove();
		if(GORE == 1) {	
			while(GORE == 1) {
				CLRWDT();
			}
		}
		if(DOLE == 1) {	
			while(DOLE == 1) {
				CLRWDT();
			}
		}
		if(LEVO == 1) {	
			while(LEVO == 1) {
				CLRWDT();
			}
		}
		if(DESNO == 1) {	
			while(DESNO == 1) {
				CLRWDT();
			}
		}
		if(STISNI == 1) {	
			while(STISNI == 1) {
				CLRWDT();
			}
		}
		if(PUSTI == 1) {	
			while(PUSTI == 1) {
				CLRWDT();
			}
		}
		if(NAPRED == 1) {
			kretanje(1);
			while(NAPRED == 1) {
				CLRWDT();
			}
		}
	}
}

i evo slika simulacije: http://i.imgur.com/GU4pCB5.png
i sad sva mi dugmad rade, i nije bitno sad na koji pin dodam jos jednog dugme, npr ovo dugme na RD0 ne radi, kada ga stisnem stalno mi ostane logicka jedinica i kad ga pustim, a ovo mi izbacuje za error cim stisnem dugme: http://prntscr.com/av1i0c