Develop close loop S-cuve motion control Profile

Hello, I am currently working on an elevator project. I want to implement an s-curve motion control algorithm for my elevator system. I have already done encoder feedback and speed control of the motor part, now want to implement scurve motion algorithm mentioned in the attached research paper. I used the dsPic microcontroller. the block diagram is mentioned in the paper is applicable in my system as well.