[C++] Algorytm zliczający ilość wystąpień każdego z typów w drzewie

unsigned IleWDrzewie( int liczony, const Node * korzen )
{
    if( !korzen )
         return 0;
   
    unsigned wynik = 0;
    wynik += IleWDrzewie( liczony, korzen->left );
    wynik += IleWDrzewie( liczony, korzen->right );
    if( korzen->cos == liczony )
         ++wynik;
   
    return wynik;
}

//zwraca vector par {cos,ilosc}, gdzie 'cos' to, no wlasnie, cos ("kolor"?),
//a 'ilosc' to ilosc wierzcholkow z takim właśnie cosiem
vector < pair < int, unsigned >> IleWDrzewieWszystkich( const Node * korzen )
{
    vector < pair < int, unsigned >> wynik;
    IleWDrzewieWszystkich2( & wynik, korzen );
    return wynik;
}
//to samo, ale wynik zostaje przekazany przez pierwszy argument
//w ten sposób (może tylko mi) łatwiej zorganizować rekurencję
void IleWDrzewieWszystkich2( vector < pair < int, unsigned >>* miejsce_na_wynik, const Node * korzen )
{
    if( !korzen )
         return 0;
   
    const int cos_korzenia = korzen->cos;
   
    vector < pair < int, unsigned >>::iterator it =
    find_if( miejsce_na_wynik->begin(),
    miejsce_na_wynik->end(),
    [ cos_korzenia ]( const pair < int, unsigned >& p ) { return p.first() == cos_korzenia } );
   
    if( it == miejsce_na_wynik->end() )
    miejsce_na_wynik->push_back( { cos_korzenia, 1 } );
    else ++( it->second() );
   
    IleWDrzewieWszystkich2( miejsce_na_wynik, korzen->left );
    IleWDrzewieWszystkich2( miejsce_na_wynik, korzen->right );
}