101 lines
4 KiB
Java
101 lines
4 KiB
Java
import java.util.concurrent.*;
|
|
|
|
public class Vehicle implements Runnable{
|
|
private Integer currentSpeed;
|
|
private Integer targetSpeed;
|
|
private double fuelLevel;
|
|
private double distanceRemaining;
|
|
public Route currentRoute = new Route();
|
|
|
|
public void run() {
|
|
navigateRoute();
|
|
}
|
|
|
|
public Vehicle() {
|
|
fuelLevel = getFuelLevel();
|
|
currentSpeed = 0;
|
|
currentRoute.setRouteDestination("250 Community College Pkwy SE, Palm Bay, FL 32909");
|
|
}
|
|
|
|
public void setTargetSpeed(int newSpeed) {targetSpeed = newSpeed;}
|
|
public int getCurrentSpeed() {return currentSpeed;}
|
|
public double getFuelLevel() {return fuelLevel;}
|
|
public void updateFuelLevel() {
|
|
//would check fuel sensor and update accordingly
|
|
fuelLevel = 0.75;
|
|
}
|
|
|
|
public void navigateRoute() {
|
|
System.out.println("Start navigation");
|
|
boolean turnCompleted = false;
|
|
|
|
for (String[] el : currentRoute.getSelectedRouteSteps()) {
|
|
RoadSensor trafficSensor = new RoadSensor();
|
|
if (targetSpeed > 20 && trafficSensor.detectTrafficLight() == 1 && el[0] != "STRAIGHT") {
|
|
//simulates stopping at traffic lights on major roadways
|
|
//for demo purposes, the spherical cow in a vacuum is that this only happens at turns
|
|
long sleepTime = Double.valueOf(Math.floor(Math.random()*15)).longValue();
|
|
while (sleepTime > 0) {
|
|
System.out.println("Traffic light detected, waiting...");
|
|
try {TimeUnit.SECONDS.sleep(1);} //sleep for 1-15 second to simulate traffic light
|
|
catch (InterruptedException e) {System.err.println("Sleep interrupted");}
|
|
}
|
|
System.out.println("Resuming navigation");
|
|
}
|
|
|
|
turnCompleted = false; //flag to validate completion of moveset instruction
|
|
distanceRemaining = Double.parseDouble(el[1]);
|
|
targetSpeed = Integer.parseInt(el[2]);
|
|
while (!turnCompleted) {
|
|
if (currentSpeed < 15 || el[0] == "STRAIGHT") {
|
|
changeDirection(el[0]);
|
|
turnCompleted = true;
|
|
} else {
|
|
applyBrakes();
|
|
}
|
|
}
|
|
|
|
while (distanceRemaining > 0) {
|
|
System.out.printf("%.2f miles to next instruction\n", distanceRemaining);
|
|
System.out.println("Current Speed: " + currentSpeed + " MPH");
|
|
controlThrottle();
|
|
distanceRemaining = distanceRemaining - (Double.valueOf(currentSpeed)/3600); //travel distance in one second
|
|
try {TimeUnit.SECONDS.sleep(1);} //sleep action for 1 second to simulate continuous movement
|
|
catch (InterruptedException e) {System.err.println("Sleep interrupted");}
|
|
}
|
|
}
|
|
System.out.println("Navigation complete, destination reached.");
|
|
}
|
|
|
|
public void changeDirection(String direction) {
|
|
switch (direction) {
|
|
case "LEFT":
|
|
System.out.println("Turning left...");
|
|
break;
|
|
case "RIGHT":
|
|
System.out.println("Turning right...");
|
|
break;
|
|
case "STRAIGHT":
|
|
System.out.println("Continuing straight...");
|
|
break;
|
|
}
|
|
}
|
|
|
|
public void controlThrottle() {
|
|
if (currentSpeed < targetSpeed && (targetSpeed - currentSpeed) > 6) { //normal acceleration
|
|
currentSpeed = currentSpeed + 6;
|
|
} else if (currentSpeed < targetSpeed && (targetSpeed - currentSpeed) <= 6) { //partial acceleration to reach speed limit
|
|
currentSpeed = currentSpeed + (targetSpeed - currentSpeed);
|
|
} else if (currentSpeed > targetSpeed) { //deceleration by coasting
|
|
currentSpeed--;
|
|
} else if (currentSpeed == targetSpeed) {
|
|
//do nothing
|
|
}
|
|
}
|
|
|
|
public void applyBrakes() {
|
|
System.out.println("Applying brakes");
|
|
if (currentSpeed >= 10) {currentSpeed -= 10;}
|
|
else if (currentSpeed < 10) {currentSpeed = 0;}
|
|
}
|
|
}
|