Делаем синусную прошивку, подключаем дисплей

как и давно просили, сделал про дисплей, получилось коряво, вебка никакая, но надеюсь все видно все понятно, забыл добавить, что бы отображались символы в виде напряжения и тд нужно файле config.h в разделе VARIANT_HOVERCAR SETTINGS дописать строку #define SUPPORT_LCD, еще одно замечание, вывод параметров ,это костыль ,оно все выводит ,но влияет на скорость работы самой прошивки, у меня проявляется как ,не сразу сбрасывается скорость, так что все только в ознакомительных целях, как все сделать правильно ,я