Ищи схему с годографом, будет доволен, есть несколько схем.
Если надо могу посодействовать, но моя рекомендация, купить готовое решение (траханины с настройкой полные штаны)