Model missing in HAL
There is no model implemented in the current HAL. The HAL just makes up some sensor data.
Add complete generation of sensor data (also GPS and so on).
Replace fake sensor data with the model's state.
Add noise onto the sensor data obtained from the model.