Systemhealth fixes

Handles state estimation messages. Most of the files were already created but not handled properly.

Fixes:
#1196 
#1182 
#1174