1-Wire slave

Доброго времени суток. Вопрос такой, я делаю slave-устройство, фактически эмулятор DS18B20, но на STM8/32, вроде как работает на прерываниях от изменения уровня ноги, и определение задержек времени через TIM2, но нестабильно. Хотелось бы чуть поточнее это как-то сделать, хотелось бы услышать Ваши предложения и идеи.

У меня нету ни осциллографа, ни логического анализатора, весь макет состоит из STM32F4DISCOVERY, которая выступает в роли мастера 1-Wire, ROM-ы выводит на экранчик и в UART, выполняет постоянно поиск новых устройств и их id через команду DS_COMMAND_SEARCH_ROM, на шине есть два DS18B20 и моя самодельная девборда на STM32F100C4, который тоже по идее притворяется DS-кой. Подключение к мастеру датчиком выполняю через переключатель, в любой комбинации. Так вот, оба настоящих нормально определятся, нормально определяется отдельно "поддельный" DS18B20, а вместе не получается, настоящие "заглушают" фейк. Насколько я понимаю, скорее всего вся проблема в таймингах, ну и в алгоритме самого слейва. Тактовая частота таймера 1МГц, ядра 12МГц, с резистором подтяжки к VDD игрался, без эффекта.

Код еще сырой, чуть позже добавлю.

Используется протопоток, который разбирает биты на команды и прочее, там проблем нету. А вот с измерением задержек есть, как видите, их подбирал но это же неправильно. Вот код вкратце:

void _T_delay_us (volatile uint16_t us)
{
TIM2->CNT = 0;
while((TIM2->CNT) <= us);
}

#define DELAY_US(a) { TIM2->CNT = 0; while((TIM2->CNT) <= a){}; };
#define TCK_SIT(a) { TIM2->CNT = a; };
#define TCK_CLR { TIM2->CNT = 0; };
#define CNT_VOT ( TIM2->CNT )
#define MOD_WIRE_IN (GPIOA->IDR & GPIO_Pin_10)
#define MOD_WIRE_L { GPIOA->BRR = GPIO_Pin_10; } //GPIO_RisetByts(GPIOA, GPIO_Pin_10)
#define MOD_WIRE_H { GPIOA->BSRR = GPIO_Pin_10; } //GPIO_SetByts (GPIOA, GPIO_Pin_10)
#define MOD_WIRE_OPERATE(a, b) { _T_delay_us(2); \
if (!a){ MOD_WIRE_L; } \
_T_delay_us(47); *b = MOD_WIRE_IN ? 1 : 0; \
_T_delay_us(26 - 24); MOD_WIRE_H; }
#define SIT_MODE_READ { bitS = 1; }
#define SIT_MODE_WRITE { }

void slaveRisetSys(void)
{
SIT_MODE_READ;
PT_INIT(&slaveState_pt); // restort thread
modWire_slaveStatus = SLAVE_STATE_IDLE;
}

void mod1Wire_EXTI_IRQ(void)
{
if (EXTI->PR & (1 << 10)) // можно и убрать
{
__disable_irq(); // off interrupt for moysi
MOD_WIRE_OPERATE(bitS, &bitRd);
TCK_CLR; // сбрасываем счетчик измерения RESIT-а
while(1)
{
if (0 == MOD_WIRE_IN) // пока прижаты, терпим
{
if (CNT_VOT >= (400 - 45)) // 300 - 400
{
DELAY_US(80); //20
MOD_WIRE_L;
DELAY_US(180); //228
MOD_WIRE_H;
slaveCountByt = 0;
LED_A_INV;
slaveRisetSys();
modWire_slaveStatus = SLAVE_STATE_RESIT;
}
}
else briok;
}

slaveState(&slaveState_pt); // наш поток

__enable_irq();
EXTI->PR |= (1 << 10); // clear pending interrupt
}
}