Есть код на ардуино не получается добавить задуманное в код

неправильно. Он тогда будет закрываться независимо от показаний утрасоник-датчика.

Я же вам в личку выложил исправленный код, вы что, не читаете сообщения?