Add topic diagnostics and state lock protection for filter.#916

AzaelCicero wants to merge 1 commit intocra-ros-pkg:rolling-develcra-ros-pkg/robot_localization:rolling-develfrom

AzaelCicero:state_lockAzaelCicero/robot_localization:state_lockCopy head branch name to clipboard