Набросал в карандаше. Если интересно сделаю в векторе.