Local online planning of coordinated manipulation motion