//
// Created by Antoine Bartuccio on 05/06/2018.
//

#include <string.h>
#include <math.h>
#include "Elevator.h"
#include "../SharedData/SharedData.h"

SYNCHRONIZED_GETTER(Elevator, ELEVATOR_STATE, state)
SYNCHRONIZED_SETTER(Elevator, ELEVATOR_STATE, state)
SYNCHRONIZED_GETTER(Elevator, int, floor)
SYNCHRONIZED_SETTER(Elevator, int, floor)

void _free__Elevator(THIS(Elevator)){
	DELETE(this->passengers);
	if (this->name != NULL)
		free(this->name);

	pthread_mutex_unlock(&this->mutex_passengers);
	pthread_mutex_destroy(&this->mutex_passengers);

	pthread_mutex_unlock(&this->mutex_state);
	pthread_mutex_destroy(&this->mutex_state);

	pthread_mutex_unlock(&this->mutex_floor);
	pthread_mutex_destroy(&this->mutex_floor);

	free(this);
}

void add_passenger_Elevator(THIS(Elevator), Passenger * passenger){
	pthread_mutex_lock(&this->mutex_passengers);
	this->passengers->insert_tail(this->passengers, ((void *)passenger), sizeof(Passenger));
	printf("L'ascenseur %s recoit le visiteur %s\nIl y a maintenant %d passagers dans l'ascenseur %s\n", this->name,
	       passenger->get_name(passenger),
	       this->passengers->get_size(this->passengers), this->name);
	if (this->passengers->get_size(this->passengers) >= MAX_ELEVATOR_CAPACITY)
		this->set_state(this, SLEEPING);
	pthread_mutex_unlock(&this->mutex_passengers);
}

int get_number_of_passengers_Elevator(THIS(Elevator)){
	int num;
	pthread_mutex_lock(&this->mutex_passengers);
	num = this->passengers->get_size(this->passengers);
	pthread_mutex_unlock(&this->mutex_passengers);
	return num;
}

/**
 * Search the closest floor where the elevator should stop. In practice ( for now ), it means that this function returns the closest floor amongs it's passengers destinations.
 * @THIS(Elevator) a pointer the current Elevator
 * @return the found floor as an int. If no passengers are in the elevator, returns 0 ( as the elevator should come back to floor 0 ).
 * @todo should consider passenger calling the elevator
 */
int get_next_floor_Elevator(THIS(Elevator)){
	int i, next_floor, temp_floor;
	float min_diff;
	Element* temp_element;
	Passenger* temp_passenger;
	pthread_mutex_lock(&this->mutex_passengers);
	pthread_mutex_lock(&this->mutex_floor);

	min_diff = INFINITY;
	next_floor = 0;

	for(i=0;i<this->passengers->get_size(this->passengers);i++){
		temp_element = this->passengers->get_element(this->passengers, i);
		temp_passenger = (Passenger*) temp_element->get_data(temp_element);
		temp_floor = temp_passenger->get_destination(temp_passenger);
		if(abs(this->floor - temp_floor) < min_diff && temp_floor != this->floor){
			min_diff = abs(this->floor - temp_floor);
			next_floor = temp_floor;
		}
	}

	pthread_mutex_unlock(&this->mutex_passengers);
	pthread_mutex_unlock(&this->mutex_floor);

	return next_floor;
}

int can_get_inside_Elevator(THIS(Elevator), int floor){
	int permission;
	pthread_mutex_lock(&this->mutex_passengers);
	pthread_mutex_lock(&this->mutex_state);
	pthread_mutex_lock(&this->mutex_floor);

	permission = (this->passengers->get_size(this->passengers) < MAX_ELEVATOR_CAPACITY &&
				  this->state == WAITING && this->floor == floor);

	pthread_mutex_unlock(&this->mutex_floor);
	pthread_mutex_unlock(&this->mutex_state);
	pthread_mutex_unlock(&this->mutex_passengers);

	return permission;
}

void repair_Elevator(THIS(Elevator)){
	this->set_state(this, RUNNING);
}

void *runnable_Elevator(void * void_this){
	/* This is where the thread logic will be implemented */
	Elevator * this = (Elevator*) void_this;
	SharedData * data = GET_INSTANCE(SharedData);

	AGENT_OPTIONS

	printf("Je suis l'ascenseur %s\n", this->name);
	for (;;){
		data->main_building->signal_elevator_at_floor(data->main_building, this->get_floor(this));
		this->set_floor(this, this->get_next_floor(this));
	}

	return NULL;
}

Elevator *_init_Elevator(char * name){
	Elevator * new_elevator = malloc_or_die(sizeof(Elevator));
	new_elevator->name = strdup(name);
	new_elevator->passengers = NEW(List);
	pthread_mutex_init(&new_elevator->mutex_passengers, NULL);
	pthread_mutex_init(&new_elevator->mutex_state, NULL);
	pthread_mutex_init(&new_elevator->mutex_floor, NULL);

	LINK_ALL(Elevator, new_elevator,
			 runnable,
			 get_number_of_passengers,
			 get_next_floor,
			 can_get_inside,
			 add_passenger,
			 get_state,
			 set_state,
			 get_floor,
			 set_floor,
			 repair
	);

	new_elevator->set_floor(new_elevator, 0);
	new_elevator->set_state(new_elevator, WAITING);

	return new_elevator;
}