Vzorové řešení jsem vám ukázal na cvičení. Na následujícím odkazu si můžete prohlédnout trochu čistější verzi s prvky C++11 https://gist.github.com/3768301