Fix findGround (off by 2 units)