With manipmaxvel, not tested yet