Added functionality

Cars can now be parked and added to the queue
Replaced some code with functions
Can now check if there is room for a car