stm32 динамическая индикация по spi выделение точки

// Функция отображения температуры. Поддержка отрицательных значений. В общем 
// говорить тут особо нечего - тут куча математических вычислений
void printTemperature(float temp) {
    // Если число отрицательное - просто убираем минус и работаем как с обычным числом )
    if (temp < 0) {
        temp = fabs(temp);
        display_data[1] = divider_horizontal; // Но пририсуем минус во втором разряде
    } else {
        display_data[1] = 0x00; // Если положительное число - очищаем второй разряд
    }
    
    // Очищаем все остальное
    display_data[0] = 0x00;
    display_data[6] = 0x00;
    display_data[7] = 0x00;
    
    if (temp == 0.0F) { // Если температрура 0°, то...
        display_data[2] = digits[0] | (1 << 6); // Отображаем 0. в третьем разряде
        display_data[3] = digits[0]; // Ноль в четвертом разряде
        display_data[4] = cel_symbol; // Значек ° в пятом разряде
        display_data[5] = 0x00; // Очищаем шестой разряд, если там что-то было до этого
    } else if (temp >= 0.1F && temp <= 9.9F) { // Если температура больше 0.1° и меньше 9.9°, то...
        display_data[2] = digits[(unsigned char)temp] | (1 << 6); // Округляем значение до ближайшего и ставим точку после него
        display_data[3] = digits[(unsigned char)(temp * 10.0F) % 10]; // Умножаем число на 10 и остаток от деления на 10 - будет второй разряд 
        display_data[4] = cel_symbol; // Дальше значек цельсия
        display_data[5] = 0x00; // Если тут что-то было до этого, то удаляем
    } else if (temp >= 10.0F && temp <= 99.9F) { // Если температура больше или равна 10.0° и меньше или равна 99.9°, то...
        display_data[2] = digits[(unsigned char)(temp) % 100 / 10]; // Первый разряд это - остаток от деления на 100, разделенный на 10
        display_data[3] = digits[(unsigned char)(temp) % 10] | (1 << 6); // Второй разряд это остаток от деления на 10. так-же ставим точку
        display_data[4] = digits[(unsigned char)(temp * 10.0F) % 10]; // Третий разряд - это остаток от деления на десять, от числа умноженного на десять
        display_data[5] = cel_symbol; // Отображаем занчек цельсия
    }
}

/*
 * HC595SPIDisplay.c
 *
 * Created: 27.07.2022 8:56:20
 * Author : 123
 */ 
 
#define F_CPU 16000000UL
#include <avr/io.h>
#include <avr/interrupt.h>
#include <math.h>
 
#define DIO   PB3  // MOSI
#define SCLK  PB5  // SCK
#define RCLK  PB2  // SS
 
#define SS_HI PORTB |= (1 << RCLK)
#define SS_LO PORTB &= ~(1 << RCLK)
 
/* Динамическая индикация */
const int max_groups  = 4; // Минимальное колличество групп
volatile unsigned char display_pos = 0; // Текущая позиция отображения
volatile unsigned char display_data[4]; // Массив индикации
 
// Группы светодиодов
const unsigned char groups[4] = {
    0b00001000,
    0b00000100,
    0b00000010,
    0b00000001
};
// Данные цифр
const unsigned char digits[10] = {//        A
    0b11000000,                   //          ######### 
    0b11111001,                   //         #         #
    0b10100100,                   //       F #         # B
    0b10110000,                   //         #    G    #
    0b10011001,                   //          #########
    0b10010010,                   //         #         # 
    0b10000010,                   //       E #         # C
    0b11111000,                   //         #         #
    0b10000000,                   //          #########
    0b10010000                    //              D       ##
                                  //                      dp 
};
 
#define divider_horizontal 0b10111111
#define cel_symbol 0b10011100
 
void SPI_Init() {
    DDRB |= (1 << DIO) | (1 << SCLK) | (1 << RCLK);
    SPCR |= (1 << SPE) | (1 << MSTR);
}
 
void TIM1_Init() {
    // Инициализация таймера/счестчика 0 для динамической индикации
    TCCR0B |= (1 << CS02);
    TIMSK0 |= (1 << TOIE0);
}
 
void SPI_Write(unsigned char data) {
    SPDR = data;
    while (!(SPSR & (1 << SPIF)));
}
 
// Таймер динамической индикации
ISR (TIMER0_OVF_vect) {
    TCNT0 = 0x00;
    
    SS_LO; // Установка линии SS в 0
    SPI_Write(display_data[display_pos]); // Отправка того, что на жкране
    SPI_Write(groups[display_pos]); // Отправка текущего разряда
    SS_HI; // Установка линии SS в 1
 
    display_pos++; // прибавляем переменную display_pos (текущий разряд и текущие данные)
    if (display_pos >= max_groups) display_pos = 0; // Если достигли максимума - обнуляем
}
 
// Заполнение дисплея
void fillDisplay(unsigned char symbol) {
    for (int i = 0; i < 4; i++) {
        display_data[i] = symbol;
    }
}
 
// Функция отображения температуры. Поддержка отрицательных значений. В общем
// говорить тут особо нечего - тут куча математических вычислений
void printTemperature(float temp) {
    // Если число отрицательное - просто убираем минус и работаем как с обычным числом )
    if (temp < 0) {
        temp = fabs(temp);
        display_data[0] = divider_horizontal; // Но пририсуем минус во втором разряде
    } else {
        display_data[0] = 0xFF; // Если положительное число - очищаем второй разряд
    }
    
    // Очищаем все остальное
    display_data[1] = 0xFF;
    display_data[2] = 0xFF;
    display_data[3] = 0xFF;
    
    if (temp == 0.0F) { // Если температрура 0°, то...
        display_data[1] = digits[0] & ~(1 << 7); // Отображаем 0. в третьем разряде
        display_data[2] = digits[0]; // Ноль в четвертом разряде
        display_data[3] = cel_symbol; // Значек ° в пятом разряде
        //display_data[4] = 0xFF; // Очищаем шестой разряд, если там что-то было до этого
    } else if (temp >= 0.1F && temp <= 9.9F) { // Если температура больше 0.1° и меньше 9.9°, то...
        display_data[1] = digits[(unsigned char)temp] & ~(1 << 7); // Округляем значение до ближайшего и ставим точку после него
        display_data[2] = digits[(unsigned char)(temp * 10.0F) % 10]; // Умножаем число на 10 и остаток от деления на 10 - будет второй разряд
        display_data[3] = cel_symbol; // Дальше значек цельсия
        //display_data[3] = 0xFF; // Если тут что-то было до этого, то удаляем
    } else if (temp >= 10.0F && temp <= 99.9F) { // Если температура больше или равна 10.0° и меньше или равна 99.9°, то...
        display_data[0] = digits[(unsigned char)(temp) % 100 / 10]; // Первый разряд это - остаток от деления на 100, разделенный на 10
        display_data[1] = digits[(unsigned char)(temp) % 10] & ~(1 << 7); // Второй разряд это остаток от деления на 10. так-же ставим точку
        display_data[2] = digits[(unsigned char)(temp * 10.0F) % 10]; // Третий разряд - это остаток от деления на десять, от числа умноженного на десять
        display_data[3] = cel_symbol; // Отображаем занчек цельсия
    }
}
 
int main (void) {
    cli(); // пока запретим прерывания
    SPI_Init(); // Инициализация SPI
    TIM1_Init(); // инициализация Таймера 0
    sei(); // Разрешаем прерывания
 
    fillDisplay(0xFF); // Очищаем дисплей
    printTemperature(-8.5); // Ченить отображаем
 
    // Вечный цикл
    while(1) {
 
    }
    
    return 0;
}

temp = fabs(temp);

temp = -temp;

// Функция отображения числа на дисплее
void printInt(int value) {
    char __signed_offset = 0;
    if (value < 0) {
        display_data[0] = divider_horizontal;
        value = -value;
        __signed_offset = 1;
    }
    if (value == 0) {
        display_data[0] = digits[0];
        display_data[1] = 0xFF;
    } else if (value >= 1 && value <= 9) {
        display_data[0 + __signed_offset] = digits[value];
        display_data[1 + __signed_offset] = 0xFF;
    } else if (value >= 10 && value <= 99) {
        display_data[0 + __signed_offset] = digits[(unsigned char)((value % 100) / 10)];
        display_data[1 + __signed_offset] = digits[(unsigned char)(value % 10)];
    } else if (value >= 100 && value <= 999) {
        display_data[0 + __signed_offset] = digits[(unsigned char)(value / 100)];
        display_data[1 + __signed_offset] = digits[(unsigned char)(value % 100 / 10)];
        display_data[2 + __signed_offset] = digits[(unsigned char)(value % 10)];
        if (! + __signed_offset) display_data[3] = 0xFF;
    } else if (value >= 1000 && value <= 9999) {
        display_data[0] = digits[(unsigned char)(value / 1000)];
        display_data[1] = digits[(unsigned char)(value / 100 % 10)];
        display_data[2] = digits[(unsigned char)(value % 100 / 10)];
        display_data[3] = digits[(unsigned char)(value % 10)];
    }
}