Fix to HeightFieldUtils to work with a 2x2 hf (aroth)