Dealing with geometric uncertainty constraints when planning robot actions