Index errors solved

Solucionados algunos problemas de búsqueda en los vectores y el heap
Merge branch 'master' of https://github.com/srodrb/UAVPathfinder

Conflicts:
	heap.c