przepisanie algorytmu na jezyk cpp