Finally finished basic shunting yard implementation