Fix findGround (off by one unit)