Systemhealth fixes

Handles state estimation messages. Most of the files were already created but not handled properly.