We've released an open source C++ movement system here: https://www.projectborealis.com/blog...urce-movement/

Perhaps it will help you work...