Implement forward dynamics using inverse dynamics.