This Romi Bot Code follows the repo that Zhiquan Yeo created which can be accessed through the following blog Trajectory planning on the Romi (and FRC robots)