надо учиться правильно писать программы)
в loop()
несколько раз вызывайте run() от ШД
в разных местах
типа первое условие , после него run
второе условие, после него run
опрос датчика - после него - run
...
это костыльное решение, но возможно поймёте что к чему