Implemented working shunting yard algo