#include "movimentacao.h" // ja chama o tipos.h
#include "movimentacao.cc"
#include "Teletransporte.h"
#include "TeleSender.cc"

/*
*  Distancia de 3,5m em linha reta: 5s
*
*/

//TeleTransporte tele;
using namespace alfa;

Movimentacao movi;
int i = 0;
int j = 0;
int direcao[2] = {0, 1};

void ondeIr (int direcao) {
    /*
     * Considerando que pos retorna quanto falta para direita e pra cima...
     */
	if (direcao == 0 ) 
		movi.anda1();
	else
		movi.re ();
}

void contaTempoSeguro () {
	for(int x = 0; x < 0xFFFF; x++)
		for(int x = 0; x < 0x8A; x++); // = 5 segundos
}

int main (void) {
    coordenadas_t posicao[7]; //fazer um array de coordenadas_t
    int temp = 0;
    bool fim = true;
    int direcao = 0;

    posicao[0].x = 1;
    posicao[0].y = 3;
    posicao[1].x = 2;
    posicao[1].y = 3;
    posicao[2].x = 3;
    posicao[2].y = 3;
    posicao[3].x = 4;
    posicao[3].y = 3;
    posicao[4].x = 5;
    posicao[4].y = 3;
    posicao[5].x = 6;
    posicao[5].y = 3;
    posicao[6].x = 7;
    posicao[6].y = 3;

    init();

    while(!fim) {
	send (posicao[temp]); 
 
	contaTempoSeguro ();	// tempo seguro para enviar as fotos
	stop (); // 5 / 1
	
	ondeIr ( direcao);

	movi.para ();
	//fim = getFimTransmissao ();
	fim = false;

	if (direcao == 0 ) {
		temp++;

		if ( temp == 6) 
			direcao = 1;

	} else {
		temp--;

		if ( temp == 0) 
			direcao = 0;
		
	}

    }

    movi.fim ();

    return 0;
}


/*
int main(void) {
    bool fimImagem1 = false;
    bool fimImagem2 = false;

    sequencia (fimImagem1, 0); // envia a primeira imagem
    sequencia (fimImagem2, 1); // envia a segunda imagem

    return 0;
}
*/