import java.io.DataInputStream;
import lejos.nxt.Button;
import lejos.nxt.LCD;
import lejos.nxt.Motor;
import lejos.nxt.comm.BTConnection;
import lejos.nxt.comm.Bluetooth;


/**
 * Clase que establece la comunicacion con el dispositivo bluetooth cliente
 * @author Olga Godoy
 * @author Alejandro Homes
 * @author Sebastián Duque
 */
public class BTComunicacion {

    /**
     * Constructor
     */
    public BTComunicacion(){ }

    /**
     * Metodo que establece la coneccion 
     */
    void Conectar(){
        
    Motor motor_A = Motor.A;
    Motor motor_C = Motor.C;
    
    Motores m = new Motores();
    LCD.drawString("waiting...",0,0);
    LCD.refresh();

    BTConnection btc = Bluetooth.waitForConnection();

    LCD.clear();
    LCD.drawString("connected",0,0);
    LCD.refresh();	
    DataInputStream dis = btc.openDataInputStream();

    while(!Button.ESCAPE.isPressed())
    {
        try{
            int n = dis.readInt();

            if ((int)(n%100) == 93){
                LCD.drawString("up     ", 0, 5);LCD.refresh();  
                m.avanza();
                motor_A.forward();
                motor_C.forward();
            }else if ((int)(n%100) == 94){
                LCD.drawString("down    ", 0, 5);LCD.refresh();
                m.retrocede();
            }else  if ((int)(n%100) == 95){
                LCD.drawString("left   ", 0, 5);LCD.refresh();        
                m.izquierda();
            }else  if ((int)(n%100) == 96){
                LCD.drawString("rigth   ", 0, 5);LCD.refresh();        
                m.derecha();
            }else if ((int)(n%100) == 97){
                LCD.drawString("center  ", 0, 5);LCD.refresh();     
                m.parar();
            }

        }catch(Exception e){
            btc.close();
            break;
        }
    }
    }
}