I2C. Передача слова конфигурации ведомому. Разрыв мозга!

//***********************************************************************************************
// Библиотека программной реализации шины I2C                                                                                                    *
//***********************************************************************************************
//***********************************<<<--Подключение заголовочных файлов-->>>********************************************************************
#include "stm32f10x.h"                      // Device header
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
//************************************<<<--Объявление макросов шины I2C-->>>**********************************************************************
#define SCL_H   GPIOA->BSRR |= GPIO_BSRR_BS6    // Установка PA6. Освобождение SCL.
#define SCL_L   GPIOA->BSRR |= GPIO_BSRR_BR6    // Сброс PA6. Захват SCL.
#define SDA_H   GPIOA->BSRR |= GPIO_BSRR_BS7    // Установка PA7. Освобождение SDA.
#define SDA_L   GPIOA->BSRR |= GPIO_BSRR_BR7    // Сброс PA7. Захват SDA.
#define SCLLVL  GPIOA->IDR & GPIO_IDR_IDR6  // Текущее состояние линии SCL.
#define SDALVL  GPIOA->IDR & GPIO_IDR_IDR7  // Текущее состояние линии SDA.
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
//********************************<<<--Служебные константы, переменные и флаги шины I2C-->>>******************************************************
const uint8_t TSC=6;        // TimeOfStartCondition. Тайминг фиксации старт/стоп условий.
const uint8_t TFBS=6;       // TimeOfFreeBusState. Тайминг фиксации свободного состояния шины.
const uint8_t TDRdy=2;  // TimeOfDataReady. Тайминг готовности данных
const uint8_t TRs=2;      // TimeOfRise. Тайминг фронта SDA и SCL.
const uint8_t TFl=5;      // TimeOfFall. Тайминг спада SDA и SCL. 
const uint8_t THClk=5;  // TimeOfHiClock. Тайминг HCLK.
const uint8_t TLClk=6;  // TimeOfLoClock. Тайминг LCLK.
uint8_t             S1AckFlg;   // Sensor1AcknowledgeFlag. Флаг бита AckS BME280 1.(Addr=0x76)
uint8_t             S2AckFlg;   // Sensor2AcknowledgeFlag. Флаг бита AckS BME280 2.(Addr=0x77)
uint8_t             RxBfr;      // ReceivedDataBuffer/ Буфер приёма байт
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
//*******************************<<<--Процедура формирования временных интервалов шины I2C-->>>***************************************************
//  Аргументы функции:                                                                                                                                                                                                                                                   *
//  [PSCVal] PrescalerValue. Значение предделителя таймера. Множитель длительности временного интервала.                                         *
//  [ARRVal] AutoReloadRegisterValue. Значение регистра автоперезагрузки таймера. Длительность временного интервала.                                   *
//************************************************************************************************************************************************
void I2C_Tmng(char PSCVal, char ARRVal)
{
    TIM3->CR1 |= TIM_CR1_OPM;               // Выбор режима таймера "OPM".
    TIM3->PSC = PSCVal;                             // Запись текущего значения PSC.
    TIM3->ARR = ARRVal-1;                     // Запись текущего значения ARR.
    TIM3->EGR |= TIM_EGR_UG;                    // Реинициализация счётчика. Обновление PSC и ARR.
    TIM3->CR1 |= TIM_CR1_CEN;               // Разрешение счётчика.
    while (TIM3->CR1 & TIM_CR1_CEN);    // Выход из функции по сбросу бита окончания счёта CEN.
}
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
//*********************************<<<--Процедура выдачи на шину старт-условия-->>>***************************************************************
void I2CStart()
{
    SDA_L;                      // Захват SDA. Начало Start-условия.
    I2C_Tmng (72,TSC);  // Тайминг действия Start-условия.
}
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
//*********************************<<<--Процедура выдачи на шину стоп-условия-->>>****************************************************************
void I2CStop()
{
  SDA_H;                        // Освобождение SDA. Начало стоп-условия.
    I2C_Tmng (72,TFBS); // Тайминг свободного состояния шины.
}
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
//***********************************<<<--Процедура приёма Ack/NAck SlaveX.-->>>******************************************************************
//  Аргумены функции:                                                                                                                            * 
//  [SlvX] SlaveX. Условный номер целевого BME280# [1,2]                                                                                         *
//  [Cmd] Command. Std[0] Стандартный приём (выход с SCL[LOW]). BSR[1] Формирование [пред]старта/стопа (выход с SCL[HI]).                        *
//************************************************************************************************************************************************
void I2CAckRX(char SlvX,char Cmd)
{
    SCL_H;                          // Фронт CLK. Начало тактирования приёма Ack/NAck.
  I2C_Tmng (72,TRs);    // Тайминг фронта SCL.
  if (SlvX==1)          // Проверка адресации Slave1.
{                       // Адресован Slave1.
  if (SDALVL)                       // Проверка состояния бита Ack/Nack Slave1.
    S1AckFlg=0;                     // Состояние бита "1", сброс флага S1AckFlg.
    else                                    // Состояние бита "0".
    S1AckFlg=1;                     // Установка флага S1AckFlg.
}
  if (SlvX==2)          // Проверка адресации Slave2.
{                       // Адресован Slave2.
  if (SDALVL)                       // Проверка состояния бита Ack/Nack Slave2.
    S2AckFlg=0;                     // Состояние бита "1". Сброс флага S2AckFlg.
    else                                    // Состояние бита "0".
    S2AckFlg=1;                     // Установка флага S2AckFlg.
}                       
    I2C_Tmng (72,THClk);  // Полупериод  HCLK. Тактирование приёма Ack/NAck.
  SCL_L;                            // Спад CLK. Захват SCL. Окончание тактирования приёма Ack/NAck. 
  I2C_Tmng (72,TLClk);  // Полупериод LCLK.
//------------------------<<<--Формирование [пред]стопового/повторного старта состояния шины-->>>-------------------------------------------------
  if (Cmd)              // Проверка наличия идентификатора формирования состояния [пред]стопа/повторного старта.
{
  SCL_H;                // Освобождение SCL.
    while   (!SCLLVL){}         // Ожидание освобождения SCL если её удерживает Slave.
  I2C_Tmng (72,TSC);    // Интервал фиксации стоп-условия
}
}
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
//*************************************<<<--Процедура передачи байта.-->>>************************************************************************
//  Аргумент функции: [Byte] Значение передаваемого байта                                                                                        *
//************************************************************************************************************************************************
void I2CByteTx(char Byte)
{
    uint8_t Nb;                     // NumberOfBits Счётчик передаваемых бит.
    uint8_t Ns=0;                   // NumberOfShifts Счётчик сдвигов буфера передачи.
    SCL_L;                            // Захват SCL.
  I2C_Tmng (7,TFl);     // Тайминг спада SCL.
    for (Nb=0;Nb<8;Nb++)    // Цикл передачи байта.
{
    if (Byte & 0x80)          // Проверка значения передаваемого бита адреса SlaveX.
    {SDA_H;}                          // Передаваемый бит "1". Установка SDA в "1".
    else                                  // Передаваемый бит "0".
    {SDA_L;}                          // Установка SDA в "0".
    I2C_Tmng (72,TDRdy);    // Тайминг готовности данных.
    SCL_H;                            // Фронт CLK. Начало тактирования передачи бита данных.
    I2C_Tmng (72,THClk);  // Полупериод  HCLK.
    SCL_L;                            // Спад CLK. Окончание тактирования передачи бита данных. Захват SCL.
  I2C_Tmng (72,TLClk);  // Полупериод LCLK.
  if (Ns<=6)            // Проверка количества сдвигов буфера передачи.
  {Byte<<=1;Ns++;}      // Не все сдвиги выполнены. Сдвиг буфера передачи на один бит влево. Инкремент счётчика сдвигов.          
}
  SDA_H;                              // Передача байта окончена. Освобождение линии SDA перед приёмом Ack/Nack.
  I2C_Tmng (72,TRs);    // Тайминг фронта SDA.
}
//************************************************************************************************************************************************
//****************************<<<--Процедура приёма байта из SlaveX и передачи бита AckM/NAckM-->>>***********************************************
//  Аргумент функции:    [AckCmd] Команда идентификации передачи бита AckM/NAckM. AckCmd=1: передача AckM; AckCmd=0: передача NAckM.                *
//************************************************************************************************************************************************
void I2CByteRX(char AckCmd)
{
    uint8_t Nb;                         // NumberOfBits Счётчик передаваемых бит.
    uint8_t Ns=0;                       // NumberOfShifts Счётчик сдвигов буфера приёма.
    RxBfr=0;                                // Очистка буфера приёма.
    SCL_L;                              // Захват SCL.
  I2C_Tmng (7,TFl);       // Тайминг спада SCL.
    for (Nb=0; Nb<8; Nb++)  // Цикл приёма байта.
{
    SCL_H;                              // Фронт CLK. Начало приёма бита.
  I2C_Tmng (72,TRs);      // Тайминг фронта SCL.
    if (SDALVL)                         // Проверка значения принимаемого бита.
    {RxBfr |= 0x01;}                // Принимаемый бит "1". Установка бита 0 буфера приёма.
    else                                        // Принимаемый бит "0".
    {RxBfr &= ~0x01;}               // Сброс бита 0 буфера приёма.
    I2C_Tmng (72,THClk);        // Полупериод HCLK. Тактирование приёма бита.
    SCL_L;                            // Спад CLK. Окончание приёма бита.
    I2C_Tmng (72,TLClk);    // Полупериод LCLK.
    if (Ns<=6)              // Проверка количества сдвигов буфера приёма.
  {RxBfr<<=1;Ns++;}       // Не все сдвиги выполнены. Сдвиг буфера приёма на один бит влево. Инкремент счётчика сдвигов буфера.                                
  else
{                                                   // Все сдвиги выполнены. Начало передачи AckM/NAckM
    if (AckCmd)                         // Проверка наличия команды выдачи AckM
{                         // Распознана команда выдачи AckM.
    SDA_L;                              // Значение AckCmd "1". Выдача на SDA AckM
  I2C_Tmng (7,TFl);       // Тайминг спада SDA.
    SCL_H;                              // Фронт CLK. Начало передачи бита AckM.
    I2C_Tmng (72,THClk);        // Полупериод  HCLK. Тактирование передачи AckM.
    SCL_L;                              // Спад CLK. Окончание передачи AckM.
    I2C_Tmng (72,TLClk);    // Полупериод LCLK.
    SDA_H;                              // Освобождение SDA.
  I2C_Tmng (72,TRs);      // Тайминг фронта SDA.
}                                           
  else                                      // Распознана команда выдачи NAckM.
{
    SDA_H;                              // Выдача на SDA NAckM.
  I2C_Tmng (72,TRs);      // Тайминг фронта SDA.
    SCL_H;                              // Фронт CLK. Начало передачи NAckM.
    I2C_Tmng (72,THClk);        // Полупериод  HCLK. Тактирование передачи NAckM.
    SCL_L;                              // Спад CLK. Окончание передачи NAckM.
    I2C_Tmng    (72,TLClk);     // Полупериод LCLK.
    SDA_L;                              // Захват SDA.
  I2C_Tmng (7,TFl);       // Тайминг спада SDA.
  //------------------------<<<--Формирование [пред]стопового/повторного старта состояния шины-->>>-----------------------------------------------
    SCL_H;                          // Освобождение SCL.
    while(!SCLLVL){}              // Ожидание свободного состояния SCL если её удерживает Slave.
  I2C_Tmng(72,TSC);       // Интервал фиксации стоп-условия.
}
}
}
}
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++