A geometrical Approach to planning Manipulation Tasks in robotics