added fail-safe if the signal is still high after 100 ms
added fail-safe if the signal is still high after 100 ms

jenny5-robot/jenny5-firmware,ubbots/jenny5-firmware,jenny5-robot/jenny5-firmware,ubbots/jenny5-firmware