Нашел строчку в коде без которой вроде пока все работает. Строчка, где идет присвоение 1000000 для длительности импульсов на ШИМ выходы (DO1-DO4)