Implement [NA_CPG](https://www.sciencedirect.com/science/article/pii/S2667379722000353) constraint function (CF) to limit angular velocity.