public void RespondToObstacle()
{
//Arrange
Point startingPoint = new Point(0, 0);
var obstacleCoords = new Point(0, 1);
var obstacles = new List <Point>()
{
obstacleCoords
};
MarsRover.CardinalDirection startingDirection = MarsRover.CardinalDirection.North;
var ObstacleDetector = new ObstacleDetector(obstacles);
MarsRover rover = new MarsRover(startingPoint, startingDirection, null, ObstacleDetector);
var moves = new[] { 'f' };
Point expectedCoordinates = startingPoint;
MarsRover.CardinalDirection expectedStartingDirection = startingDirection;
//Act
rover.Move(moves);
//Assert
Assert.AreEqual(expectedCoordinates, rover.Coordinates); //rover did not move
Assert.AreEqual(expectedStartingDirection, rover.Direction); //rover did not move
Assert.AreEqual($"obstacle detected at: ({obstacleCoords})", rover.Status.StatusMessage);
Assert.AreEqual(RoverStatus.RoverStatusCode.Fail, rover.Status.StatusCode);
}
static void Main(string[] args)
{
var obstacleMap = new List <Coordinates>()
{
Coordinates.Create(3, 5),
Coordinates.Create(6, 4)
};
var obstacleDetector = ObstacleDetector.Create(obstacleMap);
var rover = Rover.Create(1, 1, "N", obstacleDetector);
Console.WriteLine($"Welcome to Mars, you landed in x: {rover.Position.X} y: {rover.Position.Y} and your direction is {rover.Direction.Code}");
Console.WriteLine("Please insert commands:");
while (true)
{
var commandString = Console.ReadLine();
if (commandString == "Quit")
{
return;
}
var result = rover.ExecuteCommandSequence(commandString.ToCharArray());
Console.WriteLine(result.Result.ToString());
Console.WriteLine($"Your actual position is x: {rover.Position.X} y: {rover.Position.Y} and your direction is {rover.Direction.Code}");
Console.WriteLine(result.Message);
}
}
//ObstaclesDetector obstaclesDetector;
void Start()
{
inputEventHub.OnTapStarted += HandleTapStart;
inputEventHub.OnTapEnded += HandleTapEnd;
canShoot = true;
gamePlayEvents.OnProjectileDestoryed += HandleNextTurn;
movementDirection = (finishPoint.position - player.transform.position).normalized;
//obstaclesDetector = new ObstaclesDetector(player.transform, movementDirection, layerMask );
obstaclesDetector = GetComponent <ObstacleDetector>();
}
public void VerifyCoordinates()
{
var obstacleCoord = Coordinates.Create(1, 1);
var obstacleMap = new List <Coordinates>()
{
obstacleCoord
};
var obstacleDetector = ObstacleDetector.Create(obstacleMap);
var obstacleFound = obstacleDetector.VerifyCoordinates(obstacleCoord);
Assert.IsTrue(obstacleFound);
}
public void RoverBuilderTest()
{
int initialPositionX = 1;
int initialPositionY = 2;
string direction = "E";
var obstacleDetector = ObstacleDetector.Create(new List <Coordinates>());
var actual = new RoverBuilder().LandedIn(initialPositionX, initialPositionY)
.DirectedTowards(direction)
.Build();
Assert.AreEqual(direction, actual.Direction.Code);
Assert.AreEqual(initialPositionX, actual.Position.X);
Assert.AreEqual(initialPositionY, actual.Position.Y);
}
public void Create_VerifyObjectConfiguration()
{
int initialPositionX = 1;
int initialPositionY = 2;
string initialDirection = "N";
var obstacleDetector = ObstacleDetector.Create(new List <Coordinates>());
var initialPosition = Coordinates.Create(initialPositionX, initialPositionY);
var direction = DirectionsList.GetByCode(initialDirection);
var rover = Rover.Create(initialPositionX, initialPositionY, initialDirection, obstacleDetector);
Assert.AreEqual(direction, rover.Direction);
Assert.AreEqual(initialPosition, rover.Position);
}
public void DetectObstacleTest()
{
//Arrange
var obstacleCoords = new Point(0, 1);
IObstacleDetector obstacleDetector = new ObstacleDetector(new List <Point>()
{
obstacleCoords
});
//Act
var obstacleDetected = obstacleDetector.IsObstacleDetected(obstacleCoords);
//Assert
Assert.IsTrue(obstacleDetected, $"failed to identify obstacle at coordinates: {obstacleCoords}");
}
private void Awake()
{
transform.position = new Vector3(transform.position.x, _standardHeight, transform.position.z);
_obstacleDetector = GetComponent <ObstacleDetector>();
_playerDeath = GetComponent <PlayerDeath>();
_playerCharacter = GetComponent <PlayerCharacter>();
GameManager.instance.onGameStarts += GetAnimator;
_direction = PlayerDirection.NORTH;
_endPosition = transform.position;
_endRotation = transform.rotation;
_playerCharacter.playerEnabled = true;
_isMoving = false;
}
override public void OnStateEnter(Animator animator, AnimatorStateInfo stateInfo, int layerIndex)
{
obstacleDetector = animator.GetComponent <ObstacleDetector>();
}
public void Create_NullMap()
{
ObstacleDetector.Create(null);
}
static void Main()
{
//change the test file xml here and make sure it is in bin.
string startingXMLFile = "ETRL_03_07.xml";
//string startingXMLFile = "FloorPlanTest.xml";
//string startingOpenFile = "Sloan46_FINAL.xml";
double compassToMapOffset = 72.0;
// List of all the objects we'll be initializing.
// Default to null, as some of them will only
// be initialized conditionally e.g.
// vehicle is only initialized if
// there is a vehicle connected.
SerialPort sp = null;
IVehicle vehicle = null;
IImageStream depthStream = null;
IImageStream videoStream = null;
IObstacleDetector obstacleDetector = null;
ICartographer cartographer = null;
IOdometer odometer = null;
IInputDevice input = KeyboardInput.Instance;
ObstacleMap obstacleMap = null;
INavigator navigator = null;
MainWindow mainWindow = null;
Driver.Driver driver = null;
VisualInputGridPresenter uiInputPresenter = null;
ObstacleGridPresenter uiGridPresenter = null;
PositioningSystem ips = null;
OverlayRenderer overlayRenderer = null;
SensorArray sensorArray = null;
Pose pose = null;
IDoorDetector doorDetector = null;
ObstacleLocalizer obstacleLocalizer = null;
SonarDetector sonarDetector = null;
Config.Initialize();
Devices.Initialize();
//string wheelchair_com_port = Devices.IsWheelchairConnected();
string wheelchair_com_port = "COM3";//Devices.FindComPort("Arduino Uno");
bool WheelChairConnected = false;
if (wheelchair_com_port != "")
{
WheelChairConnected = true;
}
//bool WheelChairConnected = true;
bool EyeTribeConnected = true; // Devices.IsEyeTribeConnected();
bool ControllerConnected = true; //Devices.IsControllerConnected();
bool KinectConnected = true; //Devices.IsKinectConnected();
//Console.WriteLine("Kinect Connected: {0}", KinectConnected.ToString());
//Console.WriteLine("Eyetribe Connected: {0}", EyeTribeConnected.ToString());
//Console.WriteLine("Wheelchair Connected: {0}", WheelChairConnected.ToString());
//Console.WriteLine("Controller Connected: {0}", ControllerConnected.ToString());
// Initialize vehicle and serial connection if
// there is a vehicle connected.
if (WheelChairConnected)
{
//sp = new SerialPort(wheelchair_com_port, 9600);
vehicle = Wheelchair.Instance(wheelchair_com_port);
vehicle.initializeOffset(Properties.Settings.Default.CalibrationOffset);
}
else
{
vehicle = new MockVehicle();
MockVehicleWindow mockDisplay = new MockVehicleWindow((MockVehicle)vehicle);
mockDisplay.Show();
}
//initalize IPS here
IByteReader sensorReader = null;
try
{
//sensorReader = new SerialByteReader("Arduino Mega");
sensorReader = new SerialByteReader("COM4");
}
catch (Exception e)
{
MessageBox.Show(e.Message);
}
if (sensorReader != null)
{
ILogger logger = new NullLogger();
sensorArray = new SensorArray(sensorReader, logger);
sonarDetector = new SonarDetector();
}
else
{
sensorReader = new NullByteReader();
ILogger logger = new NullLogger();
sensorArray = new SensorArray(sensorReader, logger);
}
IByteReader byteReader = null;
try
{
//byteReader = new SerialByteReader(Devices.FindComPort("STMicroelectronics"));
byteReader = new SerialByteReader("COM3");
}
catch (Exception e)
{
MessageBox.Show(e.Message);
}
if (byteReader != null)
{
ILogger logger = new NullLogger();
ips = new MarvelMind(byteReader, logger);
}
else
{
//Setup Mock IPS
//IByteReader mockByteReader = new FileByteReader(@"C:\Users\Dana\Documents\Visual Studio 2013\Projects\UITests\UITests\Mock_IPS_Data.txt");
//IByteReader mockByteReader = new XLineFixedYByteReader(800, 100, 200);
IByteReader mockByteReader = new RandomByteReader(300, 299);
ILogger mockLogger = new NullLogger();
ips = new MarvelMind(mockByteReader, mockLogger);
}
//wait for an iteration of the IPS system that way
//we can get the starting location
while (false == ips.XUpdated && false == ips.YUpdated)
{
continue;
}
//Tuple<double, double> t = new Tuple<double, double>((double)ips.X, (double)ips.Y);
Tuple <double, double> t = new Tuple <double, double>((double)ips.Y, (double)ips.X);
mPoint startingLocationInXY = new mPoint(t);
// UI, input, object detection, navigation, and driver are initialized always,
// as they are not directly dependent on external hardware.
obstacleMap = new ObstacleMap();
//cartographer = new Cartographer(Directory.GetCurrentDirectory() + @"\FloorPlanTest.xml", ips);
// might need to be changed later. If the location is not in the starting room. add staring room.
//cartographer = new Cartographer(Directory.GetCurrentDirectory() + @"\FloorPlanTest.xml", startingLocationInXY);
OpenFileDialog ofd = new OpenFileDialog();
ofd.Filter = "XML | *.xml";
ofd.Title = "Open Map";
if (ofd.ShowDialog() == true)
{
startingXMLFile = ofd.FileName;
Console.WriteLine(startingXMLFile);
}
cartographer = new Cartographer(startingXMLFile, startingLocationInXY);
pose = new Pose(ips, cartographer.GetStartingRoom(), sensorArray.CompassDevice, compassToMapOffset);
overlayRenderer = new OverlayRenderer();
if (KinectConnected)
{
depthStream = DepthStream.Instance;
videoStream = VideoStream.Instance;
// Initialize depthstream if kinect is connected.
obstacleDetector = new ObstacleDetector(depthStream, false);
obstacleDetector.Start();
obstacleLocalizer = new ObstacleLocalizer(pose);
ObstaclesOverlay obstaclesOverlay = new ObstaclesOverlay(obstacleDetector);
overlayRenderer.Overlays.Add(obstaclesOverlay);
doorDetector = new DepthBasedDoorDetector();
doorDetector.RunAsync(depthStream);
try
{
sonarDetector.RunAsync(sensorArray);
}
catch (Exception e)
{
}
}
// Obstacle detector and driver are only run
// if both the vehicle and kinect are connected.
if (vehicle != null && KinectConnected)
{
Vector startPoint = new Vector(7 / 0.75f, 43 / 0.75f);
Vector startRotation = new Vector(-7, -43);
startRotation.Normalize();
odometer = new Odometer();
navigator = new Navigator(obstacleMap, obstacleDetector, obstacleLocalizer, cartographer, doorDetector, pose, sonarDetector, sensorArray);
driver = new Driver.Driver(input, vehicle, navigator);
driver.Start();
}
mainWindow = new MainWindow(pose, obstacleMap, cartographer, navigator, doorDetector, overlayRenderer, EyeTribeConnected, ControllerConnected, sensorArray);
uiInputPresenter = new VisualInputGridPresenter(mainWindow.visualInputGrid);
//This starts the program.
Application app = new Application();
app.ShutdownMode = ShutdownMode.OnMainWindowClose;
app.MainWindow = mainWindow;
app.MainWindow.Show();
app.Run();
}
