First attempt at shunting yard algorithm