алгоритм есть ,у меня сделано но неправильно, и самое главное что график типо подкачал
функция на картинке Нажмите для просмотра прикрепленного файла