Updated cost function

Changed the cases slightly, and high cost means the elevator should get
the order