Скорость из CAN берётся из SAUT_INFO_A.
Вместо IPD_STATE_A.
Подтянул последние изменения из master