MAC0318/.metadata/.plugins/org.eclipse.core.resources/.history/1b/20730e7d21b80017145c9b6064c27648

package robots;

import lejos.robotics.mapping.LineMap;
import lejos.robotics.navigation.Pose;

public class VirtualRobot implements Robot {
	private Pose pose;
	private Simulate simthread;
	private RobotReturn rr;
	
	private class Simulate extends Thread {
		public boolean run = true;
		public void run() {
			int ang = 0;
			int add = 5;
			while(run) {
				System.out.println(ang);
				DataPose data = new DataPose();
				data.setDistance(100);
				data.setPose(pose);
				data.setSensorAngle(ang);
				
				rr.robotData(data);
				
				ang += add;
				if (ang == -90 || ang == 90) add *= -1;
				
				try {
					Thread.sleep(100);
				} catch (InterruptedException e) {
				}
			}
		}
		
	}

	public VirtualRobot(LineMap map) {
		simthread = new Simulate();
		pose = new Pose();
	}

	@Override
	public void moveForward() {
		// TODO Auto-generated method stub
		
	}

	@Override
	public void moveLeft() {
		// TODO Auto-generated method stub
		
	}

	@Override
	public void moveRight() {
		// TODO Auto-generated method stub
		
	}

	@Override
	public void moveBackward() {
		// TODO Auto-generated method stub
		
	}

	@Override
	public boolean connect(RobotReturn r) {
		rr = r;
		simthread.start();
		return true;
	}

	@Override
	public void stop() {		
	}

	@Override
	public void exit() {
		simthread.run = false;
		try {
			simthread.join();
		} catch (InterruptedException e) {
			// TODO Auto-generated catch block
			e.printStackTrace();
		}
		
	}

}