Finished up FCFS function as well as fixing helper functions