TP: implement S-curve velocity profile at tcRunCycle(), tp.c