/*
	This functions checks the sensor at a
	given floor to see if the elevator is at that floor.
*/
func checkFloor() int {
	if driver.IOReadBit(SENSOR_FLOOR1) {
		return 0
	} else if driver.IOReadBit(SENSOR_FLOOR2) {
		return 1
	} else if driver.IOReadBit(SENSOR_FLOOR3) {
		return 2
	} else if driver.IOReadBit(SENSOR_FLOOR4) {
		return 3
	} else {
		return -1
	}
}
/*
	This functions loops through the different types of buttons at all the
	floors and checks if any buttons are pressed.
*/
func checkButtonPressed(buttonType, floor int) bool {
	// TODO -> Do this better in terms of counter variable names and button types. Can this function be removed?
	if driver.IOReadBit(buttonChannelMatrix[floor][buttonType]) {
		return true
	} else {
		return false
	}
}
/*
	This function checks the status of the obstruction button/signal
*/
func checkObstructionSignal() bool {
	return driver.IOReadBit(OBSTRUCTION)
}
/*
	This function checks the status of the stop button
*/
func checkStopSignal() bool {
	return driver.IOReadBit(STOP)
}