Added first working piece of cpp code