9 пиков, зачем? С такой структурой и не окончательно распределенным функционалом за месяц не отладить. ЧПУ на PLC545 под АРМом отлаживали почти пол года....
В матлабе есть функции апроксимации. Создается структура, содержащая коэффициенты полинома. Затем просто подставить их в аналитическую запись. Все это в пакете Spline toolbox вроде
Есть книжка неплохая по основным вопросам SL. Черных И.В. SIMULINK среда... С неё можно быстро начать. Параметры редактируются дабл-кликом на объекте. Для такой задачи главное определиться с пакетом где все это можно. Просто не между всеми пакетами есть совмещение.