ControlSystem.java

/* Class Variables
	private final int NUMBER_OF_FLOORS = 5;
	private final int INITIAL_ELEVATOR_FLOOR = 1;
	private static boolean DOOR_OPEN;
	public Piston object;
	public FloorPanelState state;
	public Floor []floor;
	public EmergencyBreaks brake = new EmergencyBreaks();
	public Comparator<Floor> comparator = new ElevatorQueue();
	public PriorityQueue<Floor> queue = new PriorityQueue<Floor>(5, comparator);
	public ElevatorCar elevatorCar = new ElevatorCar();
	public ElevatorCarPiston piston = new ElevatorCarPiston(INITIAL_ELEVATOR_FLOOR, NUMBER_OF_FLOORS);
	
  Class Methods
	public ControlSystem();
	public void checkForFloorInput();
	public void removeFloorFromQueue(Floor obj);
	public void clearQueue();
	public int moveToFloor(int targetFloor);
	public double getElevatorSpeed();
	public void speedSafety();
	public void EM_Brake_Procedure();
	public void FireAlarmCheck();
	public void door_function();
	public void moveToNearestFloor();
	public void SystemInputCheck();
	
  Sub Class
  	public class ElevatorQueue extends ControlSystem implements Comparator<Floor>{}
*/
package Undergraduate_Project;
import Undergraduate_Project.Floor;
import Undergraduate_Project.Piston;
import Undergraduate_Project.FloorPanelState;
import Undergraduate_Project.EmergencyBreaks;
import Undergraduate_Project.Door;
import Undergraduate_Project.elevatorLight;
import Undergraduate_Project.ElevatorFan;
import Undergraduate_Project.fireAlarm;
import Undergraduate_Project.ElevatorCarWeightSensor;

import java.util.ArrayList;
import java.util.Comparator;
import java.util.PriorityQueue;
public class ControlSystem {
	private final int NUMBER_OF_FLOORS = 5;
	private final int INITIAL_ELEVATOR_FLOOR = 1;
	private static boolean DOOR_OPEN;
	
	//Used for comparator class
	//public enum Piston{MOVING_UP, STATIONARY, MOVING_DOWN}
//	public Piston object;
	public FloorPanelState state;
	
	//Floor Objects
	public Floor []floor = new Floor[5];
	
	//EM Brake Object
	public EmergencyBreaks brake = new EmergencyBreaks();
	
	//Queue
	public Comparator<Floor> comparator = new ElevatorQueue();
	public PriorityQueue<Floor> queue = new PriorityQueue<Floor>(5, comparator);
	public ArrayList<Integer> car_panel = new ArrayList<Integer>();
	
	public ElevatorCarWeightSensor weight = new ElevatorCarWeightSensor();
	public fireAlarm alarm = new fireAlarm();
	public ElevatorCar elevatorCar = new ElevatorCar();
	public ElevatorCarPiston piston = new ElevatorCarPiston(INITIAL_ELEVATOR_FLOOR, NUMBER_OF_FLOORS);
 	
	ControlSystem(){
		for(int i = 0; i < NUMBER_OF_FLOORS; i++)
			floor[i] = new Floor(i);	
	}
 	
	ControlSystem(PistonPanelGUI pp, FloorPanelGUI fp,CarPanelGUI cp,InputPanelGUI ip) throws InterruptedException {
 		this.pp = pp;
 		this.fp = fp;
 		this.cp = cp;
 		this.ip = ip;
		for(int i = 0; i < NUMBER_OF_FLOORS; i++)
			floor[i] = new Floor(i);
		while (true) {
			Thread.sleep(50);
			run();
		}
 	}
	
	/* Used to run the checking of all the states of the elevator
	 * 
	 * 
	 */
	public void run() {
 		checkForFloorInput();
 		cp.doorOpen();
 	}
	
 	
 	
 	
	/*
	 * Develop function to receive calls from Floor Panels. Then push the floor
	 * object to the queue.
	 *	-> queue.add(<floor object>) //Adds object to Queue
	 *	-> queue.remove(<floor object>) //Removes object from Queue
	 *	-> queue.clear() //Clears Queue
	 * 
	 * 	Always add the next highest or lowest floor first. 
	 */
	public void checkForFloorInput(){
		boolean floor_buttons[] = new boolean[5];
		floor_buttons = cp.getButtonsPressed();
		
		for(int i = 0; i < NUMBER_OF_FLOORS; i++){
			if(floor_buttons[i] == true) {
				queue.add(floor[i]);
				cp.flOn(i);
			}
		}
	}
	
	public void CarPanelInput(){
		if(elevatorCar.getPanelCall() != -1)
			car_panel.add(elevatorCar.getPanelCall());
	}
	public PriorityQueue<Floor> return_queue(){
		return queue;	
	}
	
	public void removeFloorFromQueue(Floor obj){
		queue.remove(obj);
	}
	
	public void clearQueue(){
		queue.clear();	
	}
	
	int moveToFloor(int targetFloor) {
		int currentFloor = piston.movePistonToFloor(targetFloor);
		return currentFloor;
	}
	
	public double getElevatorSpeed(){
		return piston.getSpeed();
	}
	
	public double getElevatorPosition(){
		return piston.getCurrentPosition();	
	}
	
	public void speedSafety(){
		if(piston.getSpeed() > 2.0)
			this.EM_Brake_Procedure();
	}
	
	public void EM_Brake_Procedure(){
		brake.setBreaks(true);
		while(piston.getSpeed() > 0.0){
			piston.deacceleration();
			if(piston.getSpeed() <= 0.0)
				piston.setSpeed(0.0);
		}
		//Implement function to move elevator to closest floor
		brake.setBreaks(false);
		piston.resetSpeed();
	}
	
	public void FireAlarmCheck()throws InterruptedException{
		if(alarm.AlarmOn() == true){
			this.moveToNearestFloor();
			floor[piston.getCurrentFloor()].openFloorDoor();	
		}
	}
	
	public void checkWeight(){
		if(weight.overWeight() == true){}
			//Implement Safety Function here
	}
	
	//Opening Floor Door and elevator Door when destination is reached
	public void door_function()throws InterruptedException{
		//If elevator is still moving deny call to open door
		if(piston.getPistonState() != Piston.STATIONARY){
		
		//Check floor sensor. If piston position equals floor position then open floor door and elevator door
		}else if(piston.getCurrentPosition() == piston.getDestinationFloor()){
			elevatorCar.openElevatorDoor();
			floor[piston.getCurrentFloor()].openFloorDoor();
			//this.removeFloorFromQueue(floor[piston.getCurrentFloor()]);
			floor[piston.getCurrentFloor()].openFloorDoor();
		}
	}
	
	//Used for Emergency Functions
	public void moveToNearestFloor(){
		if(piston.getCurrentPosition() < 5.0)
			piston.movePistonToFloor(1);
		if(piston.getCurrentPosition() < 15.0)
			piston.movePistonToFloor(2);
		if(piston.getCurrentPosition() < 25.0)
			piston.movePistonToFloor(3);
		if(piston.getCurrentPosition() < 35.0)
			piston.movePistonToFloor(4);
		else
			piston.movePistonToFloor(5);
	}
	
	public void SystemInputCheck()throws InterruptedException{
		this.checkForFloorInput();
		this.speedSafety();
		this.FireAlarmCheck();
	}
	
	public class ElevatorQueue implements Comparator<Floor> {
		//May have to add function to check postion of floors compared to each other
		
		public int compare(Floor obj1, Floor obj2){
			if(piston.getPistonState() == Piston.MOVING_UP){
				if(obj1.getFloorPanelState() > obj2.getFloorPanelState())
					return 1;
				if(obj1.getFloorPanelState() < obj2.getFloorPanelState())  
					return -1;
				if(obj1.floorPosition < obj2.floorPosition && obj1.returnPanelStatus() == FloorPanelState.UP && obj1.floorPosition > piston.getCurrentPosition())
					return 1;
				else if(obj2.returnPanelStatus() == FloorPanelState.UP && obj2.floorPosition > piston.getCurrentPosition())
					return -1;
			
			}
			if(piston.getPistonState() == Piston.MOVING_DOWN){
				if(obj1.getFloorPanelState() < obj2.getFloorPanelState())
					return 1;
				if(obj1.getFloorPanelState() > obj2.getFloorPanelState())
					return -1;
				if(obj1.floorPosition > obj2.floorPosition && obj1.returnPanelStatus() == FloorPanelState.DOWN && obj1.floorPosition < piston.getCurrentPosition())
					return 1;
				else if(obj2.returnPanelStatus() == FloorPanelState.DOWN && obj2.floorPosition < piston.getCurrentPosition())
					return -1;
			}
			if(piston.getPistonState() == Piston.STATIONARY)
				return 1;
			return 0;
		}
	}

}