Cliff detection logic + digging experiments