domotica con udp

Buenas adjunto el codigo que tengo probado y que ha funcionado con lo que quiero hacer, pero tiene retraso por lo que no podre hacer pulsaciones largas y cortas.

Nose como optimizarlo ya que se lo justo y he creado todo esto a base de ir indagando y copiando a ver si me podeis ayudar un poquillo.

creo que el retraso viene porque por algun motivo no cierra comunicaciones y me satura de paquetes vacios.
la verificacion de si hay comunicacion con el elemento remoto no he podio activarlo no me funciona como yo quiero.

dejo el codigo aver quien me echa una manita.

CASA_ARDUINO.ino (15.5 KB)