Manipulation planning using wave variables