Compatible with Pelican, improved vel/acc calculation