Set kalman_demo to only publish when it has valid info.
Added missing flag, tested
Fixed selective publication update
Merge branch 'home_position' into sunday
Merge branch 'fault_detection' into sunday