Programovani v C

Zdravim, potreboval bych pomoct s programovaním. Do skoly mame za ukol udelat dvoukolove autonomni vozitko se dvema motory. Mam napsane funkce pro jezdeni dopredu, dozadu, doleva, doprava. Chtel bych sle jeste k tomu pridelat LED diody, ktere budou slouzit jako blikace. Kdyz to pojede doleva tak bude blikat dioda a kdyz doprava tak bude blikat druha. Nevim jak to napsat aby to bblikalo kdyz to nekam pojede. Muzete my pomoct nekdo prosim? Pouzivam Pic16f877A a L293D na motory a pisu to v C HI-Techu. Zde je program co mam.

#include <pic.h>	//Navrhnete obvod, vyvojovy diagram, a program pro dvoukolove autonomni vozitko.Jako pohon pouzijte k tomu 2 DC motory. Pri signalu 1500ms kola stoji.
#define _XTAL_FREQ 4000000

int vpred(){
	RB1 = 1 ;			//aktivacni, levy motor
	RB2	= 1 ;			//dopredu
	RB3 = 0 ;			//dozadu
	__delay_ms(2000);	//casy by se musely vyzkouset
	RC1 = 1 ;			//aktivacni, pravy motor
	RC2 = 1 ;			//dopredu
	RC3 = 0;			//dozadu
	__delay_ms(2000);
}
int vzad(){
	RB1 = 1;			//aktivacni, levy motor
	RB2	= 0;			//dopredu			
	RB3 = 1;			//dozadu
	__delay_ms(2000);
	RC1 = 1;			//aktivacni, pravy motor
	RC2 = 0;			//dopredu
	RC3 = 1;			//dozadu
	__delay_ms(2000);
}
int vlevo(){
	RB1 = 1;			//aktivacni, levy motor
	RB2	= 0;			//dopredu
	RB3 = 1;			//dozadu
	__delay_ms(2000);
	RC1 = 1;			//aktivacni, pravy motor
	RC2 = 1;			//dopredu
	RC3 = 0;			//dozadu
	__delay_ms(2000);
}
int vpravo(){
	RB1 = 1;			//aktivacni, levy motor
	RB2	= 1;			//dopredu
	RB3 = 0;			//dozadu
	__delay_ms(2000);
	RC1 = 1;			//aktivacni, pravy motor
	RC2 = 0;			//dopredu
	RC3 = 1;			//dozadu
	__delay_ms(2000);	
}	



void main (){
	TRISB = 0;
	TRISC = 0;
	ANS12 = 0;

while(1){
	vpred();
	vpred();
	vpred();
	vzad();
	vlevo();
	vlevo();
	vpred();
	vpravo();
	vpred();
}
}